Added velocity controller for Baxter