Tested several RoboSapien commands on the robot, a few fixes as
necessary