Add manipulator to baxter model and add baxter's forward kinematics cpp.