added calibration, homing, testing and code for command processing