Statistics
| Branch: | Revision:

adafruit_bno055 / examples / rawdata / rawdata.ino @ 8cee904f

History | View | Annotate | Download (2.413 KB)

1
#include <Wire.h>
2
#include <Adafruit_Sensor.h>
3
#include <Adafruit_BNO055.h>
4
#include <utility/imumaths.h>
5

    
6
/* This driver reads raw data from the BNO055
7

    
8
   Connections
9
   ===========
10
   Connect SCL to analog 5
11
   Connect SDA to analog 4
12
   Connect VDD to 3.3V DC
13
   Connect GROUND to common ground
14
    
15
   History
16
   =======
17
   2015/MAR/03  - First release (KTOWN)
18
*/
19

    
20
/* Set the delay between fresh samples */
21
#define BNO055_SAMPLERATE_DELAY_MS (100)
22
   
23
Adafruit_BNO055 bno = Adafruit_BNO055();
24

    
25
/**************************************************************************/
26
/*
27
    Arduino setup function (automatically called at startup)
28
*/
29
/**************************************************************************/
30
void setup(void) 
31
{
32
  Serial.begin(9600);
33
  Serial.println("Orientation Sensor Raw Data Test"); Serial.println("");
34
  
35
  /* Initialise the sensor */
36
  if(!bno.begin())
37
  {
38
    /* There was a problem detecting the BNO055 ... check your connections */
39
    Serial.print("Ooops, no BNO055 detected ... Check your wiring or I2C ADDR!");
40
    while(1);
41
  }
42
  
43
  delay(1000);
44
    
45
  /* Display the current temperature */
46
  int8_t temp = bno.getTemp();
47
  Serial.print("Current Temperature: ");
48
  Serial.print(temp);
49
  Serial.println(" C");
50
  Serial.println("");
51
  
52
  bno.setExtCrystalUse(true);
53
}
54

    
55
/**************************************************************************/
56
/*
57
    Arduino loop function, called once 'setup' is complete (your own code
58
    should go here)
59
*/
60
/**************************************************************************/
61
void loop(void) 
62
{
63
  // Possible vector values can be:
64
  // - VECTOR_ACCELEROMETER - m/s^2
65
  // - VECTOR_MAGNETOMETER  - uT
66
  // - VECTOR_GYROSCOPE     - rad/s
67
  // - VECTOR_EULER         - degrees
68
  // - VECTOR_LINEARACCEL   - m/s^2
69
  // - VECTOR_GRAVITY       - m/s^2
70
  imu::Vector<3> euler = bno.getVector(Adafruit_BNO055::VECTOR_EULER);
71
  
72
  /* Display the floating point data */
73
  Serial.print("X: ");
74
  Serial.print(euler.x());
75
  Serial.print(" Y: ");
76
  Serial.print(euler.y());
77
  Serial.print(" Z: ");
78
  Serial.print(euler.z());
79
  Serial.println("");
80

    
81
  /*
82
  // Quaternion data
83
  imu::Quaternion quat = bno.getQuat();
84
  Serial.print("qW: ");
85
  Serial.print(quat.w(), 4);
86
  Serial.print(" qX: ");
87
  Serial.print(quat.y(), 4);
88
  Serial.print(" qY: ");
89
  Serial.print(quat.x(), 4);
90
  Serial.print(" qZ: ");
91
  Serial.print(quat.z(), 4);
92
  Serial.println("");
93
  */
94
  
95
  delay(BNO055_SAMPLERATE_DELAY_MS);
96
}