Added Autonomous

The autonomous code drives forward, launches, spins El Toro, and shoots
again. Also fixed the const initializations in CIMPult.cpp.