Body collision now supports moving heavy body

I should check the math though.