fixed second equation for theta3
IK for left arm finished
IK rightArm
progress for IK left leg