[Maxpower57]

Im not familiar with that code, sorry.
I'd add some printf's and see if you can find why the servos are moving when they do.
did you transplant this code from the demo into your code? cause if you did, i'd make sure to destroy the environment and make sure nothing else is affecting the servos.