#include "mbed.h"
#include "mbed_trace.h"
#include "GyroAttr.h"

#define TRACE_GROUP  "Main"

I2C i2c(I2C_SDA, I2C_SCL);
BMI160_I2C *imu = NULL;
GyroAttr *gyro = NULL;

int main() {
    char *js = NULL;

    mbed_trace_init();

    i2c.frequency(400000);
    imu = new BMI160_I2C(i2c, BMI160_I2C::I2C_ADRS_SDO_LO);
    gyro = new GyroAttr(imu);

    gyro->sensor_init();
    gyro->start_sensor_update(500);

    while(true) {

        js = cJSON_PrintUnformatted(gyro->get_gyro());

        if (js) {
            printf("%s\n", js);
            free(js);
        }

        ThisThread::sleep_for(2000);

    }

    return 0;

}