Handle movable and immovable bodies separately.
Stabilized the physics a bit.
Fix error in cleanup that removed time diffs.