Cartesian servoing controller for Baxter