fixed calibration code, added code to control the arm
major changes have been made see the log