Math and Collission Engine test cases written. Still have more Collission engine stuff to do with moving objects.