BRIX5

#include <Wire.h>

#include <Adafruit_Sensor.h>

#include <Adafruit_BNO055.h>

#include <utility/imumaths.h>

/* This driver uses the Adafruit unified sensor library (Adafruit_Sensor),

   which provides a common 'type' for sensor data and some helper functions.

   To use this driver you will also need to download the Adafruit_Sensor

   library and include it in your libraries folder.

   You should also assign a unique ID to this sensor for use with

   the Adafruit Sensor API so that you can identify this particular

   sensor in any data logs, etc.  To assign a unique ID, simply

   provide an appropriate value in the constructor below (12345

   is used by default in this example).

   Connections

   ===========

   Connect SCL to analog 5

   Connect SDA to analog 4

   Connect VDD to 3.3-5V DC

   Connect GROUND to common ground

   History

   =======

   2015/MAR/03  - First release (KTOWN)

*/

/* Set the delay between fresh samples */

uint16_t BNO055_SAMPLERATE_DELAY_MS = 100;

Adafruit_BNO055 bno = Adafruit_BNO055(55);

void setup(void)

{

  Serial.begin(115200);

  Serial.println("Orientation Sensor Test"); Serial.println("");

  /* Initialise the sensor */

  if (!bno.begin())

  {

    /* There was a problem detecting the BNO055 ... check your connections */

    Serial.print("Ooops, no BNO055 detected ... Check your wiring or I2C ADDR!");

    while (1);

  }

  delay(1000);

}

void loop(void)

{

  //could add VECTOR_ACCELEROMETER, VECTOR_MAGNETOMETER,VECTOR_GRAVITY...

  sensors_event_t orientationData , angVelocityData , linearAccelData;

  bno.getEvent(&orientationData, Adafruit_BNO055::VECTOR_EULER);

  bno.getEvent(&angVelocityData, Adafruit_BNO055::VECTOR_GYROSCOPE);

  bno.getEvent(&linearAccelData, Adafruit_BNO055::VECTOR_LINEARACCEL);

  printEvent(&orientationData);

  printEvent(&angVelocityData);

  printEvent(&linearAccelData);

  int8_t boardTemp = bno.getTemp();

  Serial.print(F("temperature: "));

  Serial.println(boardTemp);

  delay(BNO055_SAMPLERATE_DELAY_MS);

}

void printEvent(sensors_event_t* event) {

  Serial.println();

  Serial.print(event->type);

  double x = -1000000, y = -1000000 , z = -1000000; //dumb values, easy to spot problem

  if (event->type == SENSOR_TYPE_ACCELEROMETER) {

    x = event->acceleration.x;

    y = event->acceleration.y;

    z = event->acceleration.z;

  }

  else if (event->type == SENSOR_TYPE_ORIENTATION) {

    x = event->orientation.x;

    y = event->orientation.y;

    z = event->orientation.z;

  }

  else if (event->type == SENSOR_TYPE_MAGNETIC_FIELD) {

    x = event->magnetic.x;

    y = event->magnetic.y;

    z = event->magnetic.z;

  }

  else if ((event->type == SENSOR_TYPE_GYROSCOPE) || (event->type == SENSOR_TYPE_ROTATION_VECTOR)) {

    x = event->gyro.x;

    y = event->gyro.y;

    z = event->gyro.z;

  }

  Serial.print(": x= ");

  Serial.print(x);

  Serial.print(" | y= ");

  Serial.print(y);

  Serial.print(" | z= ");

  Serial.println(z);

}