Merge pull request #48 from dwhswenson/decouple_dynamics

Decouple dynamics engine
Merge remote-tracking branch 'upstream/master' into toy_dynamics