Fixed CMake and package to include kinematics_msgs