Added in length of arm

Forgot to add in arm length, and made it able to go to a point.  Plan
on testing soon.