Restore and refactor testDynamics.cpp
- Some sub-tests are not implemented yet.
- Some sub-tests are disabled.
- Details are described in the file as TODO list.
Use dirty flag for body node's time derivative of body Jacobian