Baxter_controller.py is up to date, need to test on real robot. Hopefully this improves performance.