Odometry

Position/angle tracking, and then feed this into shooting so we don't have to manually point at the hub.

Two methods for automatic shooting:
- Turn off the shooter motors when we are not facing high goal
- Disable ballgate control when we are not facing high goal