Add inertia tensor, fix linear velocity change when rotating