OCD Formatting and readablility stuff
OCD Formatting and readablility stuff

Removed old TODOs, made certain comments more visible, added comments to
blocks, deeper organized controller comments

EastRobotics/2616E,EastRobotics/2616E