Fixed physics stuff, added UnitHelper.java and better collision debugging

Box2D uses half-dimensions for setAsBox() apparently