Fleshing out the state machine. Adding TODO comments.
Adding TODO comments.
Revised to better show odometry/encoder/imu split. Added TODO comments.
Added some better comments.
Tweaked robot dimensions.