Mass physics added
Corrected time integration
Draft of wheel physics
Testing wheel physics
Added wheeltest output
Wheel physics improved