tool/mbed/mbed-sdk/libraries/tests/mbed/i2c_MMA8451Q/main.cpp

   1 #include "mbed.h"
   2 #include "MMA8451Q.h"
   3 #include "test_env.h"
   4
   5 #ifdef TARGET_KL05Z
   6 #define SDA     PTB4
   7 #define SCL     PTB3
   8
   9 #elif TARGET_K20D50M
  10 #define SDA     PTB1
  11 #define SCL     PTB0
  12
  13 #else
  14 #define SDA     PTE25
  15 #define SCL     PTE24
  16 #endif
  17
  18 namespace {
  19     const int MMA8451_I2C_ADDRESS = 0x1D << 1;          // I2C bus address
  20     const float MMA8451_DIGITAL_SENSITIVITY = 4096.0;   // Counts/g
  21 }
  22
  23 float calc_3d_vector_len(float x, float y, float z) {
  24     return sqrt(x*x + y*y + z*z);
  25 }
  26
  27 #define TEST_ITERATIONS                 25
  28 #define TEST_ITERATIONS_SKIP            5
  29 #define MEASURE_DEVIATION_TOLERANCE     0.025   // 2.5%
  30
  31 int main(void) {
  32     MBED_HOSTTEST_TIMEOUT(15);
  33     MBED_HOSTTEST_SELECT(default_auto);
  34     MBED_HOSTTEST_DESCRIPTION(MMA8451Q accelerometer);
  35     MBED_HOSTTEST_START("KL25Z_5");
  36
  37     DigitalOut led(LED_GREEN);
  38     MMA8451Q acc(SDA, SCL, MMA8451_I2C_ADDRESS);
  39     bool result = true;
  40     printf("WHO AM I: 0x%2X\r\n\n", acc.getWhoAmI());
  41
  42     for (int i = 0; i < TEST_ITERATIONS; i++) {
  43         if (i < TEST_ITERATIONS_SKIP) {
  44             // Skip first 5 measurements
  45             continue;
  46         }
  47         const float g_vect_len = calc_3d_vector_len(acc.getAccX(), acc.getAccY(), acc.getAccZ()) / MMA8451_DIGITAL_SENSITIVITY;
  48         const float deviation = fabs(g_vect_len - 1.0);
  49         const char *succes_str = deviation <= MEASURE_DEVIATION_TOLERANCE ? "[OK]" : "[FAIL]";
  50         result = result && (deviation <= MEASURE_DEVIATION_TOLERANCE);
  51         printf("X:% 6d Y:% 6d Z:% 5d GF:%0.3fg, dev:%0.3f ... %s\r\n", acc.getAccX(), acc.getAccY(), acc.getAccZ(), g_vect_len, deviation, succes_str);
  52         wait(0.5);
  53         led = !led;
  54     }
  55     MBED_HOSTTEST_RESULT(result);
  56 }