I think we might be ready for testing. Going through baxter_controller.py one more time.
Need to test on the robot.