Diogo Almeida / LIS3DH

LIS3DH / STMicroelectronics / MEMS motion sensor, 3-axis accelerometer library

Dependents:   STM32_teste_5

LIS3DH.cpp@7:50ac3372def2, 2015-12-12 (annotated)

Committer:
kenjiArai
Date:
Sat Dec 12 06:06:43 2015 +0000
Revision:
7:50ac3372def2
Parent:
6:e269772dad35
Child:
8:0999d25ed7bc
bug fix (divided by 15 & unit mg)

Who changed what in which revision?

UserRevisionLine numberNew contents of line
kenjiArai 0:5d5aac272642 1 /*
kenjiArai 6:e269772dad35 2 * mbed library program
kenjiArai 0:5d5aac272642 3 * LIS3DH MEMS motion sensor: 3-axis "nano" accelerometer, made by STMicroelectronics
kenjiArai 0:5d5aac272642 4 * http://www.st-japan.co.jp/web/jp/catalog/sense_power/FM89/SC444/PF250725
kenjiArai 0:5d5aac272642 5 *
kenjiArai 5:725df775f168 6 * Copyright (c) 2014,'15 Kenji Arai / JH1PJL
kenjiArai 0:5d5aac272642 7 * http://www.page.sannet.ne.jp/kenjia/index.html
kenjiArai 0:5d5aac272642 8 * http://mbed.org/users/kenjiArai/
kenjiArai 6:e269772dad35 9 * Created: July 14th, 2014
kenjiArai 7:50ac3372def2 10 * Revised: December 12th, 2015
kenjiArai 0:5d5aac272642 11 *
kenjiArai 0:5d5aac272642 12 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED,
kenjiArai 0:5d5aac272642 13 * INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE
kenjiArai 0:5d5aac272642 14 * AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM,
kenjiArai 0:5d5aac272642 15 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
kenjiArai 0:5d5aac272642 16 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
kenjiArai 0:5d5aac272642 17 */
kenjiArai 0:5d5aac272642 18
kenjiArai 0:5d5aac272642 19 #include "LIS3DH.h"
kenjiArai 0:5d5aac272642 20
kenjiArai 0:5d5aac272642 21 LIS3DH::LIS3DH (PinName p_sda, PinName p_scl,
kenjiArai 6:e269772dad35 22 uint8_t addr, uint8_t data_rate, uint8_t fullscale) : _i2c(p_sda, p_scl)
kenjiArai 6:e269772dad35 23 {
kenjiArai 6:e269772dad35 24 _i2c.frequency(400000);
kenjiArai 0:5d5aac272642 25 initialize (addr, data_rate, fullscale);
kenjiArai 0:5d5aac272642 26 }
kenjiArai 0:5d5aac272642 27
kenjiArai 6:e269772dad35 28 LIS3DH::LIS3DH (PinName p_sda, PinName p_scl, uint8_t addr) : _i2c(p_sda, p_scl)
kenjiArai 6:e269772dad35 29 {
kenjiArai 6:e269772dad35 30 _i2c.frequency(400000);
kenjiArai 5:725df775f168 31 initialize (addr, LIS3DH_DR_NR_LP_50HZ, LIS3DH_FS_8G);
kenjiArai 5:725df775f168 32 }
kenjiArai 5:725df775f168 33
kenjiArai 0:5d5aac272642 34 LIS3DH::LIS3DH (I2C& p_i2c,
kenjiArai 6:e269772dad35 35 uint8_t addr, uint8_t data_rate, uint8_t fullscale) : _i2c(p_i2c)
kenjiArai 6:e269772dad35 36 {
kenjiArai 6:e269772dad35 37 _i2c.frequency(400000);
kenjiArai 0:5d5aac272642 38 initialize (addr, data_rate, fullscale);
kenjiArai 0:5d5aac272642 39 }
kenjiArai 0:5d5aac272642 40
kenjiArai 6:e269772dad35 41 LIS3DH::LIS3DH (I2C& p_i2c, uint8_t addr) : _i2c(p_i2c)
kenjiArai 6:e269772dad35 42 {
kenjiArai 6:e269772dad35 43 _i2c.frequency(400000);
kenjiArai 5:725df775f168 44 initialize (addr, LIS3DH_DR_NR_LP_50HZ, LIS3DH_FS_8G);
kenjiArai 5:725df775f168 45 }
kenjiArai 5:725df775f168 46
kenjiArai 6:e269772dad35 47 void LIS3DH::initialize (uint8_t addr, uint8_t data_rate, uint8_t fullscale)
kenjiArai 6:e269772dad35 48 {
kenjiArai 0:5d5aac272642 49 // Check acc is available of not
kenjiArai 0:5d5aac272642 50 acc_addr = addr;
kenjiArai 6:e269772dad35 51 dt[0] = LIS3DH_WHO_AM_I;
kenjiArai 5:725df775f168 52 _i2c.write(acc_addr, dt, 1, true);
kenjiArai 5:725df775f168 53 _i2c.read(acc_addr, dt, 1, false);
kenjiArai 6:e269772dad35 54 if (dt[0] == I_AM_LIS3DH) {
kenjiArai 0:5d5aac272642 55 acc_ready = 1;
kenjiArai 0:5d5aac272642 56 } else {
kenjiArai 0:5d5aac272642 57 acc_ready = 0;
kenjiArai 0:5d5aac272642 58 return; // acc chip is NOT on I2C line then terminate
kenjiArai 0:5d5aac272642 59 }
kenjiArai 0:5d5aac272642 60 // Reg.1
kenjiArai 5:725df775f168 61 dt[0] = LIS3DH_CTRL_REG1;
kenjiArai 5:725df775f168 62 dt[1] = 0x07;
kenjiArai 5:725df775f168 63 dt[1] |= data_rate << 4;
kenjiArai 5:725df775f168 64 _i2c.write(acc_addr, dt, 2, false);
kenjiArai 6:e269772dad35 65 // Reg.4
kenjiArai 5:725df775f168 66 dt[0] = LIS3DH_CTRL_REG4;
kenjiArai 5:725df775f168 67 dt[1] = 0x08; // High resolution
kenjiArai 5:725df775f168 68 dt[1] |= fullscale << 4;
kenjiArai 5:725df775f168 69 _i2c.write(acc_addr, dt, 2, false);
kenjiArai 6:e269772dad35 70 switch (fullscale) {
kenjiArai 6:e269772dad35 71 case LIS3DH_FS_2G:
kenjiArai 6:e269772dad35 72 fs_factor = LIS3DH_SENSITIVITY_2G;
kenjiArai 6:e269772dad35 73 break;
kenjiArai 6:e269772dad35 74 case LIS3DH_FS_4G:
kenjiArai 6:e269772dad35 75 fs_factor = LIS3DH_SENSITIVITY_4G;
kenjiArai 6:e269772dad35 76 break;
kenjiArai 6:e269772dad35 77 case LIS3DH_FS_8G:
kenjiArai 6:e269772dad35 78 fs_factor = LIS3DH_SENSITIVITY_8G;
kenjiArai 6:e269772dad35 79 break;
kenjiArai 6:e269772dad35 80 case LIS3DH_FS_16G:
kenjiArai 6:e269772dad35 81 fs_factor = LIS3DH_SENSITIVITY_16G;
kenjiArai 6:e269772dad35 82 break;
kenjiArai 6:e269772dad35 83 default:
kenjiArai 6:e269772dad35 84 ;
kenjiArai 6:e269772dad35 85 }
kenjiArai 0:5d5aac272642 86 }
kenjiArai 0:5d5aac272642 87
kenjiArai 6:e269772dad35 88 void LIS3DH::read_reg_data(char *data)
kenjiArai 6:e269772dad35 89 {
kenjiArai 0:5d5aac272642 90 // X,Y & Z
kenjiArai 6:e269772dad35 91 // manual said that
kenjiArai 6:e269772dad35 92 // In order to read multiple bytes, it is necessary to assert the most significant bit
kenjiArai 6:e269772dad35 93 // of the subaddress field.
kenjiArai 6:e269772dad35 94 // In other words, SUB(7) must be equal to ‘1’ while SUB(6-0) represents the address
kenjiArai 6:e269772dad35 95 // of the first register to be read.
kenjiArai 6:e269772dad35 96 dt[0] = LIS3DH_OUT_X_L | 0x80;
kenjiArai 5:725df775f168 97 _i2c.write(acc_addr, dt, 1, true);
kenjiArai 5:725df775f168 98 _i2c.read(acc_addr, data, 6, false);
kenjiArai 0:5d5aac272642 99 }
kenjiArai 0:5d5aac272642 100
kenjiArai 6:e269772dad35 101 void LIS3DH::read_mg_data(float *dt_usr)
kenjiArai 6:e269772dad35 102 {
kenjiArai 6:e269772dad35 103 char data[6];
kenjiArai 0:5d5aac272642 104
kenjiArai 6:e269772dad35 105 if (acc_ready == 0) {
kenjiArai 5:725df775f168 106 dt_usr[0] = 0;
kenjiArai 5:725df775f168 107 dt_usr[1] = 0;
kenjiArai 5:725df775f168 108 dt_usr[2] = 0;
kenjiArai 6:e269772dad35 109 return;
kenjiArai 0:5d5aac272642 110 }
kenjiArai 0:5d5aac272642 111 read_reg_data(data);
kenjiArai 0:5d5aac272642 112 // change data type
kenjiArai 7:50ac3372def2 113 #if OLD_REV // Fixed bugs -> (1) unit is not mg but g (2) shift right 4bit = /16
kenjiArai 5:725df775f168 114 dt_usr[0] = float(short((data[1] << 8) | data[0])) * fs_factor / 15;
kenjiArai 5:725df775f168 115 dt_usr[1] = float(short((data[3] << 8) | data[2])) * fs_factor / 15;
kenjiArai 5:725df775f168 116 dt_usr[2] = float(short((data[5] << 8) | data[4])) * fs_factor / 15;
kenjiArai 7:50ac3372def2 117 #else
kenjiArai 7:50ac3372def2 118 dt_usr[0] = float(short((data[1] << 8) | data[0]) >> 4) * fs_factor;
kenjiArai 7:50ac3372def2 119 dt_usr[1] = float(short((data[3] << 8) | data[2]) >> 4) * fs_factor;
kenjiArai 7:50ac3372def2 120 dt_usr[2] = float(short((data[5] << 8) | data[4]) >> 4) * fs_factor;
kenjiArai 7:50ac3372def2 121 #endif
kenjiArai 0:5d5aac272642 122 }
kenjiArai 0:5d5aac272642 123
kenjiArai 6:e269772dad35 124 void LIS3DH::read_data(float *dt_usr)
kenjiArai 6:e269772dad35 125 {
kenjiArai 6:e269772dad35 126 char data[6];
kenjiArai 6:e269772dad35 127
kenjiArai 6:e269772dad35 128 if (acc_ready == 0) {
kenjiArai 5:725df775f168 129 dt_usr[0] = 0;
kenjiArai 5:725df775f168 130 dt_usr[1] = 0;
kenjiArai 5:725df775f168 131 dt_usr[2] = 0;
kenjiArai 6:e269772dad35 132 return;
kenjiArai 0:5d5aac272642 133 }
kenjiArai 0:5d5aac272642 134 read_reg_data(data);
kenjiArai 0:5d5aac272642 135 // change data type
kenjiArai 7:50ac3372def2 136 #if OLD_REV // Fixed bugs -> shift right 4bit = /16 (not /15)
kenjiArai 5:725df775f168 137 dt_usr[0] = float(short((data[1] << 8) | data[0])) * fs_factor / 15 * GRAVITY;
kenjiArai 5:725df775f168 138 dt_usr[1] = float(short((data[3] << 8) | data[2])) * fs_factor / 15 * GRAVITY;
kenjiArai 5:725df775f168 139 dt_usr[2] = float(short((data[5] << 8) | data[4])) * fs_factor / 15 * GRAVITY;
kenjiArai 7:50ac3372def2 140 #else
kenjiArai 7:50ac3372def2 141 dt_usr[0] = float(short((data[1] << 8) | data[0]) >> 4) * fs_factor * GRAVITY;
kenjiArai 7:50ac3372def2 142 dt_usr[1] = float(short((data[3] << 8) | data[2]) >> 4) * fs_factor * GRAVITY;
kenjiArai 7:50ac3372def2 143 dt_usr[2] = float(short((data[5] << 8) | data[4]) >> 4) * fs_factor * GRAVITY;
kenjiArai 7:50ac3372def2 144 #endif
kenjiArai 0:5d5aac272642 145 }
kenjiArai 0:5d5aac272642 146
kenjiArai 6:e269772dad35 147 uint8_t LIS3DH::read_id()
kenjiArai 6:e269772dad35 148 {
kenjiArai 6:e269772dad35 149 dt[0] = LIS3DH_WHO_AM_I;
kenjiArai 5:725df775f168 150 _i2c.write(acc_addr, dt, 1, true);
kenjiArai 5:725df775f168 151 _i2c.read(acc_addr, dt, 1, false);
kenjiArai 5:725df775f168 152 return (uint8_t)dt[0];
kenjiArai 0:5d5aac272642 153 }
kenjiArai 0:5d5aac272642 154
kenjiArai 6:e269772dad35 155 uint8_t LIS3DH::data_ready()
kenjiArai 6:e269772dad35 156 {
kenjiArai 6:e269772dad35 157 if (acc_ready == 1) {
kenjiArai 6:e269772dad35 158 dt[0] = LIS3DH_STATUS_REG_AUX;
kenjiArai 6:e269772dad35 159 _i2c.write(acc_addr, dt, 1, true);
kenjiArai 5:725df775f168 160 _i2c.read(acc_addr, dt, 1, false);
kenjiArai 6:e269772dad35 161 if (!(dt[0] & 0x01)) {
kenjiArai 0:5d5aac272642 162 return 0;
kenjiArai 0:5d5aac272642 163 }
kenjiArai 0:5d5aac272642 164 }
kenjiArai 0:5d5aac272642 165 return 1;
kenjiArai 0:5d5aac272642 166 }
kenjiArai 0:5d5aac272642 167
kenjiArai 6:e269772dad35 168 void LIS3DH::frequency(int hz)
kenjiArai 6:e269772dad35 169 {
kenjiArai 5:725df775f168 170 _i2c.frequency(hz);
kenjiArai 1:d4d569952436 171 }
kenjiArai 1:d4d569952436 172
kenjiArai 6:e269772dad35 173 uint8_t LIS3DH::read_reg(uint8_t addr)
kenjiArai 6:e269772dad35 174 {
kenjiArai 6:e269772dad35 175 if (acc_ready == 1) {
kenjiArai 6:e269772dad35 176 dt[0] = addr;
kenjiArai 6:e269772dad35 177 _i2c.write(acc_addr, dt, 1, true);
kenjiArai 5:725df775f168 178 _i2c.read(acc_addr, dt, 1, false);
kenjiArai 0:5d5aac272642 179 } else {
kenjiArai 5:725df775f168 180 dt[0] = 0xff;
kenjiArai 0:5d5aac272642 181 }
kenjiArai 5:725df775f168 182 return (uint8_t)dt[0];
kenjiArai 0:5d5aac272642 183 }
kenjiArai 0:5d5aac272642 184
kenjiArai 6:e269772dad35 185 void LIS3DH::write_reg(uint8_t addr, uint8_t data)
kenjiArai 6:e269772dad35 186 {
kenjiArai 6:e269772dad35 187 if (acc_ready == 1) {
kenjiArai 5:725df775f168 188 dt[0] = addr;
kenjiArai 6:e269772dad35 189 dt[1] = data;
kenjiArai 6:e269772dad35 190 _i2c.write(acc_addr, dt, 2, false);
kenjiArai 0:5d5aac272642 191 }
kenjiArai 0:5d5aac272642 192 }