Nonholonomic Mechanics and Control [Book Review]