Create kinematics_server.cpp