Bug fix & control PLOT statements

Fixed bug to do with direction of the motors when sensors are activated.
Added ability for each group of PLOT statements to be turned on and off
separately.