Fix Object Properties

[kmhswimgirl]

fix/update inertia matrix and other object properties

[kmhswimgirl]

inertia matrices are slightly more realistic after #15 , however there could still be some changes made.