STATUS_OK
if (priv->cmd_status == STATUS_OK)
if (status == STATUS_OK &&
status = (buf[0] == 1) ? STATUS_OK : STATUS_FAIL;
bno055_ser_handle_rx(priv, STATUS_OK);