General version of dynamics equations
Merge branch 'master' of https://github.com/quangounet/TOPP
Small change to torquelimist.h
Added test for quadratic constraints