This code would be better if the origin didn't have to be placed at the model's feet. If the origin is at the model's feet, the model will easily move through ceilings and stuff, which looks really bad.

You should create bounding boxes for your entities instead, and leave their origin in the center.