Some code cleanups
Okay, basic functionality of physics engine works.