python做上位机监控_MPU-6050使用Python上位机监控实时动作

#ifdef COMPASS_ENABLED

void send_status_compass() {

long data[3] = { 0 };

int8_t accuracy = { 0 };

unsigned long timestamp;

inv_get_compass_set(data, &accuracy, (inv_time_t*) &timestamp);

MPL_LOGI("Compass: %7.4f %7.4f %7.4f ",

data[0]/65536.f, data[1]/65536.f, data[2]/65536.f);

MPL_LOGI("Accuracy= %d\r\n", accuracy);

}

#endif

/* Handle sensor on/off combinations. */

static void setup_gyro(void)

{

unsigned char mask = 0, lp_accel_was_on = 0;

if (hal.sensors & ACCEL_ON)

mask |= INV_XYZ_ACCEL;

if (hal.sensors & GYRO_ON) {

mask |= INV_XYZ_GYRO;

lp_accel_was_on |= hal.lp_accel_mode;

}

#ifdef COMPASS_ENABLED

if (hal.sensors & COMPASS_ON) {

mask |= INV