Mechanism Design for Robotic Systems