4 Dof Robot Arm Code