Arms, RobotMap and Finger code

I worked mostly on the Arms code. Please check to make sure it is correct.