Update testEquationOfMotion
- Remove performance test part
- Add tests for M, MInv, C, Cg
- Some skel files couldn't pass this test are disabled
Merge branch 'origin/test_equation_of_motion'