Code for Controlling the ARM of NXT robot