Mostly finished the elbow mechanism

Still need to add dynamixel mounting holes