MtConnect04S Bike Proximity Lock

Diff: BMA250/BMA250.cpp

Revision:

2:7920d3227906

Parent:

1:9f5ecbaa7606

--- a/BMA250/BMA250.cpp	Thu Nov 24 07:55:46 2016 +0000
+++ /dev/null	Thu Jan 01 00:00:00 1970 +0000
@@ -1,127 +0,0 @@
-#include "BMA250.h"
-
-  
-BMA250::BMA250(PinName sda, PinName scl, PinName int1, PinName int2) : 
-_i2c(sda, scl), _int1(int1), _int2(int2) {
-    /* Basic */
-    RegWrite(0x14, 0xB6);   // softreset
-    RegWrite(0x0F, 0x03);   // range((+/-)2G)
-    RegWrite(0x10, 0x0C);   // bandwidth(125Hz)
-    
-    /* Interrupt */
-    RegWrite(0x16, 0x00);   // Disable all interrupts
-    RegWrite(0x17, 0x00);   // 
-    RegWrite(0x20, 0x00);   // int1_od(PP), int1_lvl(Low active), int2_od(PP), int2_lvl(Low active)
-    RegWrite(0x21, 0x80);   // reset_int, latch_int(non_latched)
-}
-
-void BMA250::ReadXYZ(int16_t *xyz) {
-    char val[6];
-
-    /* Read raw data */
-    RegRead(0x02, val, sizeof(val));
-    xyz[0] = ((int16_t)val[1] << 8) | (val[0] & 0xC0);
-    xyz[1] = ((int16_t)val[3] << 8) | (val[2] & 0xC0);
-    xyz[2] = ((int16_t)val[5] << 8) | (val[4] & 0xC0);
-
-    /* Align right */
-    xyz[0] >>= 6;
-    xyz[1] >>= 6;
-    xyz[2] >>= 6;
-}
-
-void BMA250::NewData(void(*fptr)(void), int int_n) {
-    // TODO
-}
-void BMA250::AnyMotion(void(*fptr)(void), int int_n) {
-    // TODO
-}
-void BMA250::TapSening(void(*fptr)(void), int int_n, bool double_tap) {
-    RegWrite(0x2A, 0x04);   // tap_quiet(30ms), tap_shock(50ms), tap_dur(250ms)
-    RegWrite(0x2B, 0x0A);   // tap_samp(2samples), tap_th(0x0A)
-
-    if (int_n == 1) {
-        /* Interrupt 1 */
-        if (double_tap) {
-            /* Double tap */
-            RegReadModifyWrite(0x19, 0x30, 0x10);   // int1_d_tap
-            RegReadModifyWrite(0x16, 0x30, 0x10);   // d_tap_en
-        } else {
-            /* Single tap */
-            RegReadModifyWrite(0x19, 0x30, 0x20);   // int1_s_tap
-            RegReadModifyWrite(0x16, 0x30, 0x20);   // s_tap_en
-        }
-        _int1.mode(PullUp);
-        _int1.fall(fptr);
-    } else {
-        /* Interrupt 2 */
-        if (double_tap) {
-            /* Double tap */
-            RegReadModifyWrite(0x1B, 0x30, 0x10);   // int2_d_tap
-            RegReadModifyWrite(0x16, 0x30, 0x10);   // d_tap_en
-        } else {
-            /* Single tap */
-            RegReadModifyWrite(0x1B, 0x30, 0x20);   // int2_s_tap
-            RegReadModifyWrite(0x16, 0x30, 0x20);   // s_tap_en
-        }
-        _int2.mode(PullUp);
-        _int2.fall(fptr);
-    }
-}
-void BMA250::OrientationRecognition(void(*fptr)(void), int int_n) {
-    // TODO
-}
-void BMA250::FlatDetection(void(*fptr)(void), int int_n) {
-    // TODO
-}
-void BMA250::LowHighGDetection(void(*fptr)(void), int int_n, bool high_g) {
-    // TODO
-}
-void BMA250::ShakeDetection(void(*fptr)(void), int int_n) {
-    RegWrite(0x28, 0x64);   // slope_th(100)
-
-    if (int_n == 1) {
-        /* Interrupt 1 */
-        RegReadModifyWrite(0x19, 0x04, 0x04);   // int1_slope
-        RegReadModifyWrite(0x16, 0x07, 0x07);   // slope_en_z/y/x
-        _int1.mode(PullUp);
-        _int1.fall(fptr);
-    } else {
-        /* Interrupt 2 */
-        RegReadModifyWrite(0x1B, 0x04, 0x04);   // int2_slope
-        RegReadModifyWrite(0x16, 0x07, 0x07);   // slope_en_z/y/x
-        _int2.mode(PullUp);
-        _int2.fall(fptr);
-    }
-}
-
-void BMA250::EnterStandbyMode(void)
-{
-    RegReadModifyWrite(0x12, 0x40, 0x40);   // lowpower_mode(1)
-    RegReadModifyWrite(0x11, 0x80, 0x80);   // suspend(1)
-}
-
-void BMA250::LeaveStandbyMode(void)
-{
-    RegReadModifyWrite(0x12, 0x40, 0x40);   // lowpower_mode(1)
-    RegReadModifyWrite(0x11, 0x80, 0x00);   // suspend(0)
-}
-
-void BMA250::RegWrite(char reg, char val) {
-    char data[2];
-    data[0] = reg;
-    data[1] = val;
-    _i2c.write(BMA250_SLAVE_ADDR, data, 2, 0);
-}
-
-void BMA250::RegRead(char reg, char *val, int len) {
-    _i2c.write(BMA250_SLAVE_ADDR, &reg, 1, 0);
-    _i2c.read (BMA250_SLAVE_ADDR, val, len);
-}
-
-void BMA250::RegReadModifyWrite(char reg, char clr_mask, char set_mask) {
-    char val;
-    RegRead (reg, &val, 1);             // Read
-    val = (val & ~clr_mask) | set_mask; // Modify
-    RegWrite(reg, val);                 // Write
-}