fixed and tested for homing on PSM
started implementation of joint/cartesian direct/trajectory commands.  untested