Update TODO

Clean deletion of Fixtures

Fix calcmassInertia formula

Fix calcmassInertia call

Remove prints

setmassfromshapes --> my function

Fixed destroyed fixture

rename stupid variable

rename variable to make sense

Remove unnecessary variable

Some formatting

Fixed some scope, suppressed warnings

Removed redundant initialization

Removed dead code

Clarified wallshapes keys