BRIX5

   2015/AUG/27  - Added calibration and system status helpers

    Display sensor calibration status

*/

/**************************************************************************/

void displayCalStatus(void)

{

  /* Get the four calibration values (0..3) */

  /* Any sensor data reporting 0 should be ignored, */

  /* 3 means 'fully calibrated" */

  uint8_t system, gyro, accel, mag;

  system = gyro = accel = mag = 0;

  bno.getCalibration(&system, &gyro, &accel, &mag);

  /* The data should be ignored until the system calibration is > 0 */

  Serial.print("\t");

  if (!system)

  {

    Serial.print("! ");

  }

  /* Display the individual values */

  Serial.print("Sys:");

  Serial.print(system, DEC);

  Serial.print(" G:");

  Serial.print(gyro, DEC);

  Serial.print(" A:");

  Serial.print(accel, DEC);

  Serial.print(" M:");

  Serial.println(mag, DEC);

}

/**************************************************************************/

/*

  /* Optional: Display calibration status */

  // displayCalStatus();

  /* New line for the next sample */

  /* Wait the specified delay before requesting nex data */