BRIX5

/*

    Prints a float or double with the specified number of decimal places.

    'precision' should be 1 followed by a zero for every decimal place

    desired, so '100' will produce two decimal places:

    print_double(3.1415, 100); // Output = 3.14

*/

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

void Adafruit_BNO055::printDouble(double val, unsigned int precision)

{

  /* Print the integer portion */

  Serial.print (int(val));

  Serial.print(".");

  /* Print the fraction portion */

  unsigned int frac;

  if(val >= 0)

  {

    frac = (val - int(val)) * precision;

  }

  else

  {

    frac = (int(val)- val ) * precision;

  }

  Serial.println(frac,DEC) ;

}

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

  event->timestamp = millis();

  /* Get a Euler angle sample for orientation */

  imu::Vector<3> euler = getVector(Adafruit_BNO055::VECTOR_EULER);

  event->orientation.x = euler.x();

  event->orientation.y = euler.y();

  event->orientation.z = euler.z();

    void  printDouble         ( double val, unsigned int precision );

#include <Wire.h>

#include <Adafruit_Sensor.h>

#include <Adafruit_BNO055.h>

#include <utility/imumaths.h>

/* This driver reads raw data from the BNO055

   Connections

   ===========

   Connect SCL to analog 5

   Connect SDA to analog 4

   Connect VDD to 3.3V DC

   Connect GROUND to common ground

   History

   =======

   2015/MAR/03  - First release (KTOWN)

*/

/* Set the delay between fresh samples */

#define BNO055_SAMPLERATE_DELAY_MS (500)

Adafruit_BNO055 bno = Adafruit_BNO055();

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

/*

    Arduino setup function (automatically called at startup)

*/

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

void setup(void) 

{

  Serial.begin(9600);

  Serial.println("Orientation Sensor Raw Data 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);

  /* Display chip revision details (optional) */

  bno.displayRevInfo();

  Serial.println("");

}

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

/*

    Arduino loop function, called once 'setup' is complete (your own code

    should go here)

*/

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

void loop(void) 

{

  // Possible vector values can be:

  // - VECTOR_ACCELEROMETER - m/s^2

  // - VECTOR_MAGNETOMETER  - uT

  // - VECTOR_GYROSCOPE     - rad/s

  // - VECTOR_EULER         - degrees

  // - VECTOR_LINEARACCEL   - m/s^2

  // - VECTOR_GRAVITY       - m/s^2

  imu::Vector<3> euler = bno.getVector(Adafruit_BNO055::VECTOR_EULER);

  /* Display the floating point data */

  Serial.print("X: ");

  bno.printDouble(euler.x(), 1000);

  Serial.print("Y: ");

  bno.printDouble(euler.y(), 1000);

  Serial.print("Z: ");

  bno.printDouble(euler.z(), 1000);

  Serial.println("");

  /*

  // Quaternion data

  imu::Quaternion quat = bno.getQuat();

  Serial.print("qW: ");

  bno.printDouble(quat.w(), 1000);

  Serial.print("qX: ");

  bno.printDouble(quat.y(), 1000);

  Serial.print("qY: ");

  bno.printDouble(quat.x(), 1000);

  Serial.print("qZ: ");

  bno.printDouble(quat.z(), 1000);

  Serial.println("");

  */

  delay(BNO055_SAMPLERATE_DELAY_MS);

}

  // bno.displaySystemStatus();

  // Serial.println("");

  // bno.displayRevInfo();

  // Serial.println("");

  /* Get a new sensor event */ 

  sensors_event_t event; 

  bno.getEvent(&event);

  /* Display the floating point data */

  bno.printDouble(event.orientation.x, 1000);

  bno.printDouble(event.orientation.y, 1000);

  bno.printDouble(event.orientation.z, 1000);