Updated the mass matrices and various and fixed world coordinates
Merge pull request #7 from vinayyadav3016/master

Updated the mass matrices and various and fixed world coordinates