changed code so system goes directly from MODE_OFF back to MODE_PID-CONTROL