bma422_accelerometer.ino

Go to the documentation of this file.

 
#include <AccelerometerDrv.hpp>
 
#ifndef SENSOR_SDA
#define SENSOR_SDA  21
#endif
 
#ifndef SENSOR_SCL
#define SENSOR_SCL  22
#endif
 
#ifndef SENSOR_IRQ
#define SENSOR_IRQ  39
#endif
 
SensorBMA422 accelSensor;
 
volatile bool isInterruptTriggered = false;
 
void setup()
{
    bool rslt;
 
    Serial.begin(115200);
    while (!Serial);
 
    pinMode(SENSOR_IRQ, INPUT);
    attachInterrupt(SENSOR_IRQ, +[]() {
        isInterruptTriggered = true;
    }, RISING);
 
    // Sensor initialization
    rslt = accelSensor.begin(Wire, BMA4XX_I2C_ADDR_SDO_HIGH, SENSOR_SDA, SENSOR_SCL);
    if (!rslt) {
        while (1) {
            Serial.println("BMA4xx sensor initialization failed");
            delay(1000);
        }
    }
 
    Serial.print(accelSensor.getModelName());
    Serial.println(" Sensor initialized successfully");
 
    // Set sensor orientation, based on the hardware placement setting
    rslt = accelSensor.setRemapAxes(SensorRemap::TOP_LAYER_RIGHT_CORNER);
    if (!rslt) {
        Serial.println("Failed to set remap axes");
    }
 
    // Accelerometer configuration
    // The desired operation mode. Allowed values are SUSPEND, NORMAL.
    OperationMode operationMode = OperationMode::NORMAL;
    // The desired full-scale range. Allowed values are FS_2G, FS_4G, FS_8G, FS_16G.
    AccelFullScaleRange fullScaleRange = AccelFullScaleRange::FS_2G;
    // The desired bandwidth. Allowed values are OSR4_AVG1, OSR2_AVG2, NORMAL_AVG4, etc.
    AccelBandwidth bandwidth = AccelBandwidth::OSR2_AVG2;
    // The desired data rate in Hz. Allowed values are 0.78, 1.56, 3.12, 6.25, 12.5, 25, 50, 100, 200, 400, 800, 1600.
    float data_rate_hz = 100.0f;
    // The desired performance mode. Allowed values are CIC_AVG_MODE, CONTINUOUS_MODE
    AccelPerfMode perfMode = AccelPerfMode::CIC_AVG_MODE;
 
    if (!accelSensor.configAccelerometer(operationMode, fullScaleRange, data_rate_hz, bandwidth, perfMode)) {
        Serial.println("Failed to configure accelerometer");
        while (1);
    }
 
    // Enable data ready feature
    rslt = accelSensor.enableDataReady(true);
    if (!rslt) {
        Serial.println("Failed to enable data ready");
        while (1);
    }
 
    delay(3000);
 
    Serial.println("Now read accelerometer data form sensor");
}
 
void loop()
{
    AccelerometerData  accelData;
    if (accelSensor.isDataReady()) {
        // Read the accelerometer data
        if (accelSensor.readData(accelData)) {
            Serial.print("Temperature: ");
            Serial.print(accelData.temperature);
            Serial.print(" °C, Acc_Raw: (");
            Serial.print(accelData.raw.x);
            Serial.print(", ");
            Serial.print(accelData.raw.y);
            Serial.print(", ");
            Serial.print(accelData.raw.z);
            Serial.print("), Acc_ms2: (");
            Serial.print(accelData.mps2.x, 2);
            Serial.print(", ");
            Serial.print(accelData.mps2.y, 2);
            Serial.print(", ");
            Serial.print(accelData.mps2.z, 2);
            Serial.print(") ");
            uint32_t timeSampleMs = accelSensor.getTimeSampleMs();
            Serial.print(timeSampleMs);
            Serial.print("(ms)/");
            Serial.print(millis());
            Serial.println(" ");
        } else {
            Serial.println("Failed to read accelerometer data");
        }
    }
}