Corrected a bug (not filling the right drive mode in control_logic)
Another drive_mode I wasn't setting properly
Wall follower now stops after losing wall it was following.
Bug correction