Reworked some systems.  Added a class for complex math / collisions ect along with a class for input.

Commiting for benchmark tests.