Add a start for implementing forward and inverse dynamics from Cooper and Ballard.