Add rotational dynamics, remove Shape class
Add inertia tensor, fix linear velocity change when rotating