I will suggest you to have only two write of register in the wake up function:
/* Enter Normal Mode to wake up*/ reg[0] = BNO055_PWR_MODE_ADDR; reg[1] = BNO055_POWER_MODE_NORMAL; m_xfer_done = false; twi_reg_write(BNO055_I2C_ADDR1, reg, 2); nrf_delay_ms(650);
/* Operation Mode */ reg[0] = BNO055_OPR_MODE_ADDR; reg[1] = BNO055_OPERATION_MODE_NDOF; m_xfer_done = false; twi_reg_write(BNO055_I2C_ADDR1, reg, 2); nrf_delay_ms(650);
... View more