Updated comments and rearranged code to group by function (i.e. all drive functions grouped in the same section).
Also, added in the maneuvers if statement to only run if collect, collect reverse, and shoot are all false.
Added additional comments on what to add in later code