Algortithm

I've added my old fsae algorithm diagram, but its got both longitudinal and lateral control, and i think it only applies to ice builds. Open to suggestions or replacements.