[Greg McKaskle]

Is this LV based or C++ based?

If LV, use probes or the panel displays to determine the actual colors and such.

From your description, it sounds like you may even have the servos hooked up different from what the SW expects. You might try disconnecting one and see if the movement doesn't indicate the bug. Also, turning off the servo movement and looking at the error terms and the value that would be sent to the servo is useful for debugging.

Greg McKaskle