teleop working with RobotKin kinematics server