RigidBody: add initial forces at wake up, mutualise functions with RigidDebris