Update README.md
Trying to fix bugs in mass inverse calculation
Merge branch 'origin/master'
Fix calculation of inverse mass matrix for weld joints
Trying to fix bugs in mass inverse calculation