Inital Commit

Simulation steps and solves for a plane/sphere collision. Other collision types not yet translated, no testing done yet.