Cleanup

[ColdIV]

When the project is finished we should go through it and make sure that we have a consistent style and that everything looks nice. Maybe even add some comments to explain functions.

[ColdIV]

Some Objects still use float, they should be replaced with double