Method get_data

src/custom_sensor/IMU_Sensor.cpp:25–56

}

void IMU_Sensor::get_data(int sensorID, byte *data) {
    float x, y, z;

    if (sensorID != ACC_GYRO_MAG) {
        memset(data, 0, 36);
        return;
    }

    get_all();

    int index = 0;
    float * floatArray = (float*)data;

    get_acc(x,y,z);
    floatArray[0+index] = x;
    floatArray[1+index] = y;
    floatArray[2+index] = z;

    index += 3;

    get_gyro(x,y,z);
    floatArray[0+index] = x;
    floatArray[1+index] = y;
    floatArray[2+index] = z;

    index += 3;

    get_mag(x,y,z);
    floatArray[0+index] = x;
    floatArray[1+index] = y;
    floatArray[2+index] = z;
}

void IMU_Sensor::get_acc(float &x, float &y, float &z) {
    if (!available) return;