AMiRo-OS

void shellRequestErrorInfo(BaseSequentialStream *chp, int argc, char *argv[]){

  // Print out the error info collected. Clear buffer after calling

  chprintf(chp, "Error Info\n");

  chprintf(chp, "\n");

  int IDLE                = 0;

  int FOLLOW_LINE         = 1;

  int DETECT_STATION      = 2;

  int REVERSE             = 3;

  int PUSH_BACK           = 4;

  int CHECK_POSITIONING   = 5;

  int CHECK_VOLTAGE       = 6;

  int CHARGING            = 7;

  int RELEASE             = 8;

  int RELEASE_TO_CORRECT  = 9;

  int CORRECT_POSITIONING = 10;

  int TURN                = 12;

  int INACTIVE            = 13;

  int CALIBRATION         = 14;

  int CALIBRATION_CHECK   = 15;

  int DEVIATION_CORRECTION = 16;

  int DOCKING_ERROR       = 16+1;

  int REVERSE_TIMEOUT_ERROR   = 16+2;

  int CALIBRATION_ERROR   = 16+3;

  int WHITE_DETECTION_ERROR   = 16+4;

  int PROXY_DETECTION_ERROR   = 16+5;

  int NO_CHARGING_POWER_ERROR   = 16+6;

  int UNKNOWN_STATE_ERROR   = 16+7;

  chprintf(chp, "IDLE: %d\n", global.stateTracker[IDLE]);

  chprintf(chp, "FOLLOW_LINE: %d\n", global.stateTracker[FOLLOW_LINE]);

  chprintf(chp, "DETECT_STATION: %d\n", global.stateTracker[DETECT_STATION]);

  chprintf(chp, "REVERSE: %d\n", global.stateTracker[REVERSE]);

  chprintf(chp, "PUSH_BACK: %d\n", global.stateTracker[PUSH_BACK]);

  chprintf(chp, "CHECK_POSITIONING: %d\n", global.stateTracker[CHECK_POSITIONING]);

  chprintf(chp, "CHECK_VOLTAGE: %d\n", global.stateTracker[CHECK_VOLTAGE]);

  chprintf(chp, "CHARGING: %d\n", global.stateTracker[CHARGING]);

  chprintf(chp, "RELEASE: %d\n", global.stateTracker[RELEASE]);

  chprintf(chp, "RELEASE_TO_CORRECT: %d\n", global.stateTracker[RELEASE_TO_CORRECT]);

  chprintf(chp, "CORRECT_POSITIONING: %d\n", global.stateTracker[CORRECT_POSITIONING]);

  chprintf(chp, "TURN: %d\n", global.stateTracker[TURN]);

  chprintf(chp, "INACTIVE: %d\n", global.stateTracker[INACTIVE]);

  chprintf(chp, "CALIBRATION: %d\n", global.stateTracker[CALIBRATION]);

  chprintf(chp, "CALIBRATION_CHECK: %d\n", global.stateTracker[CALIBRATION_CHECK]);

  chprintf(chp, "DEVIATION_CORRECTION: %d\n", global.stateTracker[DEVIATION_CORRECTION]);

  chprintf(chp, "DOCKING_ERROR: %d\n", global.stateTracker[DOCKING_ERROR]);

  chprintf(chp, "REVERSE_TIMEOUT_ERROR: %d\n", global.stateTracker[REVERSE_TIMEOUT_ERROR]);

  chprintf(chp, "CALIBRATION_ERROR: %d\n", global.stateTracker[CALIBRATION_ERROR]);

  chprintf(chp, "WHITE_DETECTION_ERROR: %d\n", global.stateTracker[WHITE_DETECTION_ERROR]);

  chprintf(chp, "PROXY_DETECTION_ERROR: %d\n", global.stateTracker[PROXY_DETECTION_ERROR]);

  chprintf(chp, "NO_CHARGING_POWER_ERROR: %d\n", global.stateTracker[NO_CHARGING_POWER_ERROR]);

  chprintf(chp, "UNKNOWN_STATE_ERROR: %d\n", global.stateTracker[UNKNOWN_STATE_ERROR]);

  for (int i=0; i<24;i++){

    global.stateTracker[i] = 0;

  }

}

  {"infos", shellRequestErrorInfo},