Near finished Code for Robotic Arm

We was able to build the code without errors for the dynamixels for the
Robotic Arm.