Added kinematics model of the robot. Is a node, but  will probably be used as a service.