Revision 94d672fd
Adafruit_BNO055.cpp | ||
---|---|---|
148 | 148 |
/**************************************************************************/ |
149 | 149 |
void Adafruit_BNO055::getSystemStatus(uint8_t *system_status, uint8_t *self_test_result, uint8_t *system_error) |
150 | 150 |
{ |
151 |
adafruit_bno055_opmode_t backupmode = _mode; |
|
152 |
|
|
153 |
setMode(OPERATION_MODE_CONFIG); |
|
154 |
delay(20); |
|
155 | 151 |
write8(BNO055_PAGE_ID_ADDR, 0); |
156 | 152 |
|
157 |
write8(BNO055_SYS_TRIGGER_ADDR, read8(BNO055_SYS_TRIGGER_ADDR) | 0x1); |
|
158 |
delay(1000); |
|
159 |
|
|
160 | 153 |
/* System Status (see section 4.3.58) |
161 | 154 |
--------------------------------- |
162 | 155 |
0 = Idle |
... | ... | |
201 | 194 |
if (system_error != 0) |
202 | 195 |
*system_error = read8(BNO055_SYS_ERR_ADDR); |
203 | 196 |
|
204 |
setMode(backupmode); |
|
205 |
delay(20); |
|
197 |
delay(200); |
|
206 | 198 |
} |
207 | 199 |
|
208 | 200 |
/**************************************************************************/ |
Also available in: Unified diff