Maxim Integrated / Mbed OS HSP_RPC_GUI

MAX32620HSP (MAXREFDES100) RPC Example for Graphical User Interface

Dependencies:   USBDevice

Fork of HSP_Release by Jerry Bradshaw

This is an example program for the MAX32620HSP (MAXREFDES100 Health Sensor Platform). It demonstrates all the features of the platform and works with a companion graphical user interface (GUI) to help evaluate/configure/monitor the board. Go to the MAXREFDES100 product page and click on "design resources" to download the companion software. The GUI connects to the board through an RPC interface on a virtual serial port over the USB interface.

The RPC interface provides access to all the features of the board and is available to interface with other development environments such Matlab. This firmware provides realtime data streaming through the RPC interface over USB, and also provides the ability to log the data to flash for untethered battery operation. The data logging settings are configured through the GUI, and the GUI also provides the interface to download logged data.

Details on the RPC interface can be found here: HSP RPC Interface Documentation

Windows

With this program loaded, the MAX32620HSP will appear on your computer as a serial port. On Mac and Linux, this will happen by default. For Windows, you need to install a driver: HSP serial port windows driver

For more details about this platform and how to use it, see the MAXREFDES100 product page.

HSP/Devices/LIS2DH/LIS2DH/LIS2DH.cpp@3:8e9b9f5818aa, 2017-04-25 (annotated)

Committer:
jbradshaw
Date:
Tue Apr 25 10:47:10 2017 -0500
Revision:
3:8e9b9f5818aa
Parent:
1:9490836294ea 
Removed Bulk Erasing, instead a small number of bytes are sampled from each and every page to determine if sector is "dirty", if so sector is erased

Prevents device from sleeping when the firmware detects a series of binary flash page RPC transfers, this increases flash page transfers by %450

  when 200mS elapse with the last flash page transfer, normal sleep behaviour is resumed

Who changed what in which revision?

UserRevisionLine numberNew contents of line
jbradshaw 0:e4a10ed6eb92 1 /*******************************************************************************
jbradshaw 0:e4a10ed6eb92 2 * Copyright (C) 2016 Maxim Integrated Products, Inc., All Rights Reserved.
jbradshaw 0:e4a10ed6eb92 3 *
jbradshaw 0:e4a10ed6eb92 4 * Permission is hereby granted, free of charge, to any person obtaining a
jbradshaw 0:e4a10ed6eb92 5 * copy of this software and associated documentation files (the "Software"),
jbradshaw 0:e4a10ed6eb92 6 * to deal in the Software without restriction, including without limitation
jbradshaw 0:e4a10ed6eb92 7 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
jbradshaw 0:e4a10ed6eb92 8 * and/or sell copies of the Software, and to permit persons to whom the
jbradshaw 0:e4a10ed6eb92 9 * Software is furnished to do so, subject to the following conditions:
jbradshaw 0:e4a10ed6eb92 10 *
jbradshaw 0:e4a10ed6eb92 11 * The above copyright notice and this permission notice shall be included
jbradshaw 0:e4a10ed6eb92 12 * in all copies or substantial portions of the Software.
jbradshaw 0:e4a10ed6eb92 13 *
jbradshaw 0:e4a10ed6eb92 14 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
jbradshaw 0:e4a10ed6eb92 15 * OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
jbradshaw 0:e4a10ed6eb92 16 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
jbradshaw 0:e4a10ed6eb92 17 * IN NO EVENT SHALL MAXIM INTEGRATED BE LIABLE FOR ANY CLAIM, DAMAGES
jbradshaw 0:e4a10ed6eb92 18 * OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
jbradshaw 0:e4a10ed6eb92 19 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
jbradshaw 0:e4a10ed6eb92 20 * OTHER DEALINGS IN THE SOFTWARE.
jbradshaw 0:e4a10ed6eb92 21 *
jbradshaw 0:e4a10ed6eb92 22 * Except as contained in this notice, the name of Maxim Integrated
jbradshaw 0:e4a10ed6eb92 23 * Products, Inc. shall not be used except as stated in the Maxim Integrated
jbradshaw 0:e4a10ed6eb92 24 * Products, Inc. Branding Policy.
jbradshaw 0:e4a10ed6eb92 25 *
jbradshaw 0:e4a10ed6eb92 26 * The mere transfer of this software does not imply any licenses
jbradshaw 0:e4a10ed6eb92 27 * of trade secrets, proprietary technology, copyrights, patents,
jbradshaw 0:e4a10ed6eb92 28 * trademarks, maskwork rights, or any other form of intellectual
jbradshaw 0:e4a10ed6eb92 29 * property whatsoever. Maxim Integrated Products, Inc. retains all
jbradshaw 0:e4a10ed6eb92 30 * ownership rights.
jbradshaw 0:e4a10ed6eb92 31 *******************************************************************************
jbradshaw 0:e4a10ed6eb92 32 */
jbradshaw 0:e4a10ed6eb92 33
jbradshaw 0:e4a10ed6eb92 34 #include "LIS2DH.h"
jbradshaw 0:e4a10ed6eb92 35 #include "Streaming.h"
jbradshaw 0:e4a10ed6eb92 36 #include "Peripherals.h"
jbradshaw 0:e4a10ed6eb92 37
jbradshaw 0:e4a10ed6eb92 38 void lis2dh_int_handler(void);
jbradshaw 1:9490836294ea 39 /**
jbradshaw 1:9490836294ea 40 * @brief buffer array to hold fifo contents for packetizing
jbradshaw 1:9490836294ea 41 */
jbradshaw 0:e4a10ed6eb92 42 uint32_t lis2dh_buffer[LIS2DH_MAX_DATA_SIZE];
jbradshaw 0:e4a10ed6eb92 43
jbradshaw 0:e4a10ed6eb92 44 int16_t motion_cached[3];
jbradshaw 0:e4a10ed6eb92 45 LIS2DH *LIS2DH::instance = NULL;
jbradshaw 0:e4a10ed6eb92 46
jbradshaw 0:e4a10ed6eb92 47 //******************************************************************************
jbradshaw 0:e4a10ed6eb92 48 LIS2DH::LIS2DH(PinName sda, PinName scl, int slaveAddress) :
jbradshaw 0:e4a10ed6eb92 49 slaveAddress(slaveAddress) {
jbradshaw 0:e4a10ed6eb92 50 i2c = new I2C(sda, scl);
jbradshaw 0:e4a10ed6eb92 51 i2c->frequency(400000);
jbradshaw 0:e4a10ed6eb92 52 isOwner = true;
jbradshaw 0:e4a10ed6eb92 53 instance = this;
jbradshaw 0:e4a10ed6eb92 54 }
jbradshaw 0:e4a10ed6eb92 55
jbradshaw 0:e4a10ed6eb92 56 //******************************************************************************
jbradshaw 0:e4a10ed6eb92 57 LIS2DH::LIS2DH(I2C *i2c, int slaveAddress) :
jbradshaw 0:e4a10ed6eb92 58 slaveAddress(slaveAddress) {
jbradshaw 0:e4a10ed6eb92 59 this->i2c = i2c;
jbradshaw 0:e4a10ed6eb92 60 i2c->frequency(400000);
jbradshaw 0:e4a10ed6eb92 61 isOwner = false;
jbradshaw 0:e4a10ed6eb92 62 instance = this;
jbradshaw 0:e4a10ed6eb92 63 }
jbradshaw 0:e4a10ed6eb92 64
jbradshaw 0:e4a10ed6eb92 65 //******************************************************************************
jbradshaw 0:e4a10ed6eb92 66 LIS2DH::~LIS2DH(void) {
jbradshaw 0:e4a10ed6eb92 67 if (isOwner == true) {
jbradshaw 0:e4a10ed6eb92 68 delete i2c;
jbradshaw 0:e4a10ed6eb92 69 }
jbradshaw 0:e4a10ed6eb92 70 }
jbradshaw 0:e4a10ed6eb92 71
jbradshaw 0:e4a10ed6eb92 72 //******************************************************************************
jbradshaw 1:9490836294ea 73 int LIS2DH::writeReg(LIS2DH_REG_map_t reg, char value) {
jbradshaw 0:e4a10ed6eb92 74 int result;
jbradshaw 0:e4a10ed6eb92 75 char cmdData[2] = {(char)reg, value};
jbradshaw 0:e4a10ed6eb92 76 result = i2c->write(slaveAddress, cmdData, 2);
jbradshaw 1:9490836294ea 77 if (result != 0) {
jbradshaw 0:e4a10ed6eb92 78 return -1;
jbradshaw 1:9490836294ea 79 }
jbradshaw 0:e4a10ed6eb92 80 return 0;
jbradshaw 0:e4a10ed6eb92 81 }
jbradshaw 0:e4a10ed6eb92 82
jbradshaw 0:e4a10ed6eb92 83 //******************************************************************************
jbradshaw 1:9490836294ea 84 int LIS2DH::readReg(LIS2DH_REG_map_t reg, char *value) {
jbradshaw 0:e4a10ed6eb92 85 int result;
jbradshaw 0:e4a10ed6eb92 86 char cmdData[1] = {(char)reg};
jbradshaw 0:e4a10ed6eb92 87
jbradshaw 0:e4a10ed6eb92 88 result = i2c->write(slaveAddress, cmdData, 1);
jbradshaw 1:9490836294ea 89 if (result != 0) {
jbradshaw 0:e4a10ed6eb92 90 return -1;
jbradshaw 1:9490836294ea 91 }
jbradshaw 0:e4a10ed6eb92 92 result = i2c->read(slaveAddress, value, 1);
jbradshaw 1:9490836294ea 93 if (result != 0) {
jbradshaw 0:e4a10ed6eb92 94 return -1;
jbradshaw 1:9490836294ea 95 }
jbradshaw 0:e4a10ed6eb92 96 return 0;
jbradshaw 0:e4a10ed6eb92 97 }
jbradshaw 0:e4a10ed6eb92 98
jbradshaw 0:e4a10ed6eb92 99 //******************************************************************************
jbradshaw 0:e4a10ed6eb92 100 static void I2c_Reset(uint8_t index, int speed) {
jbradshaw 0:e4a10ed6eb92 101 mxc_i2cm_regs_t *regs = MXC_I2CM_GET_I2CM(index);
jbradshaw 0:e4a10ed6eb92 102 /* reset module */
jbradshaw 0:e4a10ed6eb92 103 regs->ctrl = MXC_F_I2CM_CTRL_MSTR_RESET_EN;
jbradshaw 0:e4a10ed6eb92 104 regs->ctrl = 0;
jbradshaw 0:e4a10ed6eb92 105 /* enable tx_fifo and rx_fifo */
jbradshaw 0:e4a10ed6eb92 106 regs->ctrl |= (MXC_F_I2CM_CTRL_TX_FIFO_EN | MXC_F_I2CM_CTRL_RX_FIFO_EN);
jbradshaw 0:e4a10ed6eb92 107 }
jbradshaw 0:e4a10ed6eb92 108
jbradshaw 0:e4a10ed6eb92 109 //******************************************************************************
jbradshaw 1:9490836294ea 110 /// Interrupt handler, this empties the hardware fifo and packetizes it for
jbradshaw 1:9490836294ea 111 /// streaming
jbradshaw 0:e4a10ed6eb92 112 void LIS2DH::int_handler(void) {
jbradshaw 0:e4a10ed6eb92 113 char fifo_src;
jbradshaw 0:e4a10ed6eb92 114 int16_t valueX;
jbradshaw 0:e4a10ed6eb92 115 int16_t valueY;
jbradshaw 0:e4a10ed6eb92 116 int16_t valueZ;
jbradshaw 0:e4a10ed6eb92 117 int num;
jbradshaw 0:e4a10ed6eb92 118 int index;
jbradshaw 0:e4a10ed6eb92 119
jbradshaw 0:e4a10ed6eb92 120 I2c_Reset(2, 1);
jbradshaw 0:e4a10ed6eb92 121 num = 0;
jbradshaw 0:e4a10ed6eb92 122 index = 0;
jbradshaw 0:e4a10ed6eb92 123 fifo_src = 0;
jbradshaw 0:e4a10ed6eb92 124 while ((fifo_src & 0x20) != 0x20) {
jbradshaw 0:e4a10ed6eb92 125 get_motion_fifo(&valueX, &valueY, &valueZ);
jbradshaw 0:e4a10ed6eb92 126 lis2dh_buffer[index++] = valueX;
jbradshaw 0:e4a10ed6eb92 127 lis2dh_buffer[index++] = valueY;
jbradshaw 0:e4a10ed6eb92 128 lis2dh_buffer[index++] = valueZ;
jbradshaw 0:e4a10ed6eb92 129 readReg(LIS2DH_FIFO_SRC_REG, &fifo_src);
jbradshaw 0:e4a10ed6eb92 130 num++;
jbradshaw 1:9490836294ea 131 if (num >= 32) {
jbradshaw 0:e4a10ed6eb92 132 break;
jbradshaw 1:9490836294ea 133 }
jbradshaw 0:e4a10ed6eb92 134 }
jbradshaw 0:e4a10ed6eb92 135 motion_cached[0] = valueX;
jbradshaw 0:e4a10ed6eb92 136 motion_cached[1] = valueY;
jbradshaw 0:e4a10ed6eb92 137 motion_cached[2] = valueZ;
jbradshaw 0:e4a10ed6eb92 138
jbradshaw 0:e4a10ed6eb92 139 StreamPacketUint32(PACKET_LIS2DH, lis2dh_buffer, index);
jbradshaw 0:e4a10ed6eb92 140 }
jbradshaw 0:e4a10ed6eb92 141
jbradshaw 0:e4a10ed6eb92 142 //******************************************************************************
jbradshaw 0:e4a10ed6eb92 143 void LIS2DH::init(void) {
jbradshaw 0:e4a10ed6eb92 144 stop();
jbradshaw 0:e4a10ed6eb92 145 configure_interrupt();
jbradshaw 0:e4a10ed6eb92 146 }
jbradshaw 0:e4a10ed6eb92 147
jbradshaw 0:e4a10ed6eb92 148 //******************************************************************************
jbradshaw 0:e4a10ed6eb92 149 void LIS2DH::configure_interrupt(void) {
jbradshaw 1:9490836294ea 150
jbradshaw 1:9490836294ea 151 lis2dh_ctrl_reg6_t ctrl_reg6;
jbradshaw 1:9490836294ea 152 ///< interrupt enabled on INT1, interrupt active low
jbradshaw 1:9490836294ea 153 ctrl_reg6.all = 0;
jbradshaw 1:9490836294ea 154 ctrl_reg6.bit.I2_INT1 = 1; ///< interrupt 1 function enabled on int1 pin
jbradshaw 1:9490836294ea 155 ctrl_reg6.bit.H_LACTIVE = 1; ///< interrupt active low
jbradshaw 1:9490836294ea 156 writeReg(LIS2DH_CTRL_REG6, ctrl_reg6.all);
jbradshaw 0:e4a10ed6eb92 157 }
jbradshaw 0:e4a10ed6eb92 158
jbradshaw 0:e4a10ed6eb92 159 //******************************************************************************
jbradshaw 0:e4a10ed6eb92 160 int LIS2DH::initStart(int dataRate, int fifoThreshold) {
jbradshaw 1:9490836294ea 161
jbradshaw 1:9490836294ea 162 lis2dh_ctrl_reg5_t ctrl_reg5;
jbradshaw 1:9490836294ea 163 lis2dh_fifo_ctrl_reg_t fifo_ctrl_reg;
jbradshaw 1:9490836294ea 164 lis2dh_ctrl_reg1_t ctrl_reg1;
jbradshaw 1:9490836294ea 165 lis2dh_ctrl_reg3_t ctrl_reg3;
jbradshaw 1:9490836294ea 166
jbradshaw 0:e4a10ed6eb92 167 __disable_irq();
jbradshaw 0:e4a10ed6eb92 168
jbradshaw 0:e4a10ed6eb92 169 configure_interrupt();
jbradshaw 1:9490836294ea 170 ///
jbradshaw 1:9490836294ea 171 /// enable FIFO
jbradshaw 1:9490836294ea 172 ///
jbradshaw 1:9490836294ea 173 ctrl_reg5.all = 0x0;
jbradshaw 1:9490836294ea 174 ctrl_reg5.bit.FIFO_EN = 0x1;
jbradshaw 1:9490836294ea 175 if (writeReg(LIS2DH_CTRL_REG5, ctrl_reg5.all) == -1) {
jbradshaw 1:9490836294ea 176 __enable_irq();
jbradshaw 1:9490836294ea 177 return -1;
jbradshaw 1:9490836294ea 178 }
jbradshaw 1:9490836294ea 179
jbradshaw 1:9490836294ea 180 ///
jbradshaw 1:9490836294ea 181 /// set FIFO to stream mode, trigger select INT1
jbradshaw 1:9490836294ea 182 ///
jbradshaw 1:9490836294ea 183 fifo_ctrl_reg.all = 0x0;
jbradshaw 1:9490836294ea 184 fifo_ctrl_reg.bit.FTH = fifoThreshold;
jbradshaw 1:9490836294ea 185 fifo_ctrl_reg.bit.FM = LIS2DH_FIFOMODE_STREAM;
jbradshaw 1:9490836294ea 186 fifo_ctrl_reg.bit.TR = 0x0;
jbradshaw 1:9490836294ea 187 if (writeReg(LIS2DH_FIFO_CTRL_REG, fifo_ctrl_reg.all) == -1) {
jbradshaw 0:e4a10ed6eb92 188 __enable_irq();
jbradshaw 0:e4a10ed6eb92 189 return -1;
jbradshaw 0:e4a10ed6eb92 190 }
jbradshaw 0:e4a10ed6eb92 191
jbradshaw 1:9490836294ea 192 ///
jbradshaw 1:9490836294ea 193 /// set HR (high resolution)
jbradshaw 1:9490836294ea 194 ///
jbradshaw 0:e4a10ed6eb92 195 if (writeReg(LIS2DH_CTRL_REG4, 0x8) == -1) {
jbradshaw 0:e4a10ed6eb92 196 __enable_irq();
jbradshaw 0:e4a10ed6eb92 197 return -1;
jbradshaw 0:e4a10ed6eb92 198 }
jbradshaw 0:e4a10ed6eb92 199
jbradshaw 1:9490836294ea 200 ///
jbradshaw 1:9490836294ea 201 /// set the data rate, enable all axis
jbradshaw 1:9490836294ea 202 ///
jbradshaw 0:e4a10ed6eb92 203 dataRate = dataRate & 0xF;
jbradshaw 1:9490836294ea 204 if (dataRate > 0x9) {
jbradshaw 1:9490836294ea 205 dataRate = 0x9;
jbradshaw 1:9490836294ea 206 }
jbradshaw 1:9490836294ea 207
jbradshaw 1:9490836294ea 208 ctrl_reg1.bit.ODR = dataRate; ///< set the data rate
jbradshaw 1:9490836294ea 209 ctrl_reg1.bit.LPen = 0x0; ///< disable low power mode
jbradshaw 1:9490836294ea 210 ctrl_reg1.bit.Zen = 0x1; ///< enable z
jbradshaw 1:9490836294ea 211 ctrl_reg1.bit.Yen = 0x1; ///< enable y
jbradshaw 1:9490836294ea 212 ctrl_reg1.bit.Xen = 0x1; ///< enable x
jbradshaw 1:9490836294ea 213 if (writeReg(LIS2DH_CTRL_REG1, ctrl_reg1.all) == -1) {
jbradshaw 0:e4a10ed6eb92 214 __enable_irq();
jbradshaw 0:e4a10ed6eb92 215 return -1;
jbradshaw 0:e4a10ed6eb92 216 }
jbradshaw 0:e4a10ed6eb92 217
jbradshaw 1:9490836294ea 218 ///
jbradshaw 1:9490836294ea 219 /// enable watermark interrupt
jbradshaw 1:9490836294ea 220 ///
jbradshaw 1:9490836294ea 221 ctrl_reg3.all = 0x00;
jbradshaw 1:9490836294ea 222 ctrl_reg3.bit.I1_WTM = 0x1;
jbradshaw 1:9490836294ea 223 if (writeReg(LIS2DH_CTRL_REG3, ctrl_reg3.all) == -1) {
jbradshaw 0:e4a10ed6eb92 224 __enable_irq();
jbradshaw 0:e4a10ed6eb92 225 return -1;
jbradshaw 0:e4a10ed6eb92 226 }
jbradshaw 0:e4a10ed6eb92 227 __enable_irq();
jbradshaw 0:e4a10ed6eb92 228
jbradshaw 0:e4a10ed6eb92 229 return 0;
jbradshaw 0:e4a10ed6eb92 230 }
jbradshaw 0:e4a10ed6eb92 231
jbradshaw 0:e4a10ed6eb92 232 //******************************************************************************
jbradshaw 0:e4a10ed6eb92 233 int LIS2DH::detect(char *detected) {
jbradshaw 0:e4a10ed6eb92 234 char val;
jbradshaw 0:e4a10ed6eb92 235 *detected = 0;
jbradshaw 1:9490836294ea 236 if (readReg(LIS2DH_WHO_AM_I, &val) == -1) {
jbradshaw 0:e4a10ed6eb92 237 return -1;
jbradshaw 1:9490836294ea 238 }
jbradshaw 1:9490836294ea 239
jbradshaw 1:9490836294ea 240 if (val == LIS2DH_ID) {
jbradshaw 1:9490836294ea 241 *detected = 1;
jbradshaw 1:9490836294ea 242 }
jbradshaw 1:9490836294ea 243
jbradshaw 0:e4a10ed6eb92 244 return 0;
jbradshaw 0:e4a10ed6eb92 245 }
jbradshaw 0:e4a10ed6eb92 246
jbradshaw 0:e4a10ed6eb92 247 //******************************************************************************
jbradshaw 0:e4a10ed6eb92 248 int LIS2DH::get_motion_cached(int16_t *valueX, int16_t *valueY,
jbradshaw 0:e4a10ed6eb92 249 int16_t *valueZ) {
jbradshaw 0:e4a10ed6eb92 250 *valueX = motion_cached[0];
jbradshaw 0:e4a10ed6eb92 251 *valueY = motion_cached[1];
jbradshaw 0:e4a10ed6eb92 252 *valueZ = motion_cached[2];
jbradshaw 0:e4a10ed6eb92 253 return 0;
jbradshaw 0:e4a10ed6eb92 254 }
jbradshaw 0:e4a10ed6eb92 255
jbradshaw 0:e4a10ed6eb92 256 //******************************************************************************
jbradshaw 0:e4a10ed6eb92 257 int LIS2DH::get_motion_fifo(int16_t *valueX, int16_t *valueY, int16_t *valueZ) {
jbradshaw 0:e4a10ed6eb92 258 char reg = LIS2DH_OUT_X_L | 0x80;
jbradshaw 0:e4a10ed6eb92 259 char values[6];
jbradshaw 0:e4a10ed6eb92 260 int i;
jbradshaw 0:e4a10ed6eb92 261
jbradshaw 0:e4a10ed6eb92 262 reg = LIS2DH_OUT_X_L;
jbradshaw 0:e4a10ed6eb92 263 for (i = 0; i < 6; i++) {
jbradshaw 1:9490836294ea 264 if (readReg((LIS2DH_REG_map_t)reg, &values[i]) != 0) {
jbradshaw 0:e4a10ed6eb92 265 return -1;
jbradshaw 0:e4a10ed6eb92 266 }
jbradshaw 0:e4a10ed6eb92 267 reg++;
jbradshaw 0:e4a10ed6eb92 268 }
jbradshaw 0:e4a10ed6eb92 269
jbradshaw 0:e4a10ed6eb92 270 *valueX = ((short)values[1] << 8) + values[0];
jbradshaw 0:e4a10ed6eb92 271 *valueY = ((short)values[3] << 8) + values[2];
jbradshaw 0:e4a10ed6eb92 272 *valueZ = ((short)values[5] << 8) + values[4];
jbradshaw 0:e4a10ed6eb92 273 motion_cached[0] = *valueX;
jbradshaw 0:e4a10ed6eb92 274 motion_cached[1] = *valueY;
jbradshaw 0:e4a10ed6eb92 275 motion_cached[2] = *valueZ;
jbradshaw 0:e4a10ed6eb92 276 return 0;
jbradshaw 0:e4a10ed6eb92 277 }
jbradshaw 0:e4a10ed6eb92 278
jbradshaw 0:e4a10ed6eb92 279 //******************************************************************************
jbradshaw 0:e4a10ed6eb92 280 char LIS2DH::readId(void) {
jbradshaw 0:e4a10ed6eb92 281 char val;
jbradshaw 0:e4a10ed6eb92 282 readReg(LIS2DH_WHO_AM_I, &val);
jbradshaw 0:e4a10ed6eb92 283 return val;
jbradshaw 0:e4a10ed6eb92 284 }
jbradshaw 0:e4a10ed6eb92 285
jbradshaw 0:e4a10ed6eb92 286 //******************************************************************************
jbradshaw 0:e4a10ed6eb92 287 void LIS2DH::stop(void) {
jbradshaw 0:e4a10ed6eb92 288 __disable_irq();
jbradshaw 0:e4a10ed6eb92 289 writeReg(LIS2DH_CTRL_REG3, 0x00); // Disable watermark interrupt
jbradshaw 0:e4a10ed6eb92 290 writeReg(LIS2DH_CTRL_REG1, 0x00); // Data rate = 0Hz
jbradshaw 0:e4a10ed6eb92 291 writeReg(LIS2DH_FIFO_CTRL_REG,
jbradshaw 0:e4a10ed6eb92 292 0x00); // set to bypass mode... clears FIFO_SRC_REG
jbradshaw 0:e4a10ed6eb92 293 __enable_irq();
jbradshaw 0:e4a10ed6eb92 294 }
jbradshaw 0:e4a10ed6eb92 295
jbradshaw 0:e4a10ed6eb92 296 //******************************************************************************
jbradshaw 0:e4a10ed6eb92 297 void LIS2DHIntHandler(void) {
jbradshaw 0:e4a10ed6eb92 298 char value;
jbradshaw 1:9490836294ea 299 ///
jbradshaw 1:9490836294ea 300 /// read the data rate axis enable register, if this is zero then just return,
jbradshaw 1:9490836294ea 301 /// we are not ready for interrupts
jbradshaw 1:9490836294ea 302 ///
jbradshaw 1:9490836294ea 303 LIS2DH::instance->readReg(LIS2DH::LIS2DH_CTRL_REG1, &value);
jbradshaw 0:e4a10ed6eb92 304 if (value == 0x0) {
jbradshaw 0:e4a10ed6eb92 305 return;
jbradshaw 0:e4a10ed6eb92 306 }
jbradshaw 0:e4a10ed6eb92 307 LIS2DH::instance->int_handler();
jbradshaw 0:e4a10ed6eb92 308 }