Updated math design, toying around with own physics engine.