baxter model
Merge branch 'bsp_collision' of https://github.com/dementrock/trajopt into bsp_collision
Merge branch 'bsp_collision' of https://github.com/dementrock/trajopt into bsp_collision