Started documenting code.

Also: maybe worked out why gimbal doesn't face down in auto mode.
Probably fixed (needs testing).