What am I doing wrong here? Program to servo issue.

Projects General Guidance
2

  1. What is the 9V supply?

  2. #define pi 3.14159265358979323846
    that many digits is kind of pointless. Arduino/avr-gcc only implements float which only has 6 or 7 digits of precision.

  3. #define twopi (2pi)
    floating point is slow, don't make the processor calculate this constant every time you want to use it. put "2    3.141592" into your calculator and then make a macro with that number.

  4. "All that happens is the servos turn to the right and don't move..."
    So they move to the right or they don't move? I don't understand how they can move and don't move.