case SWITCH_TO_STATUS:
uoled_switch_mode_rep(MODE_STATUS, CHANGE_MODE_STATUS);
wait_flag = true;
- printf("changing mode to status\n");
return MODE_STATUS;
break;
case SWITCH_TO_CONTROL:
uoled_switch_mode_rep(MODE_STATUS, CHANGE_MODE_CONTROL);
wait_flag = true;
- printf("changing mode to control\n");
return MODE_CONTROL;
break;
case SWITCH_TO_STATUS_DONE:
break;
case SWITCH_TO_CONTROL_DONE:
wait_flag = false;
- printf("wait flag = false\n");
mode_to_go = MODE_CONTROL;
break;
case ACTUATORS:
if(wait_flag)
break;
else {
- printf("wait flag cleared\n");
if(mode_to_go==MODE_STATUS)
FSM_TRANSITION(status);
else if(mode_to_go==MODE_CONTROL)