WIP Arm movement test 1

Testing arm movements, to correct the concept of the parts, such as modeling or constraints