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

[MichaelMeissner]

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

GCC will optimize 2*pi at compile time.