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

EmbodiedCognition/pagoda,EmbodiedCognition/pagoda