Finished arm code

The angle scaling is approximate; It should be re-calibrated when we can
measure angle accurately.