Add connectOCartesianPose and sendCartesianPose