I have updated the function for computing the values to send to the robot.  It should handle that relatively well now.  Busy, can't make pretty comments.