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