[tsaksa]

That looks like a very long and heavy arm for such a small servo. It is possible that the problem is mechanical or electrical, and programming related at all. The servo may have even been damaged by being pushed into too heave of a load. Do you have any way of testing the servo separate from your code and the CRio?

Does your team have an RC controller or servo tester? If not, do you have another servo to try? If so, I would suggest trying a new servo with nothing attached to test your code and only then introducing something with a mechanical actuator. That way you decouple any mechanical problems from the software debug.