Physics improvements

- more accurate integration (2-step)
- helper methods to RigidBody
- optimize Vector2