Small modifications for stability
Combine Vision and Dynamixel control. Stability fixes.