http://ocw.mit.edu/courses/mechanical-engineering/2-12-introduction-to-robotics-fall-2005