Controller work
Finished Baxter API position controller
Updated README