Kinematic control of constrained robotic systems