Catkinized simple_robot_kinematics