Updated the README. Has new TODO's. Need to test merged changes on Baxter.