Garage Door Monitor and Opener
Dependencies: X_NUCLEO_COMMON ST_INTERFACES
Introduction
This system implements a simple garage door opener and environmental monitor. The hardware connects to the internet using Wi-Fi then on to the Pelion Device Management Platform which provides device monitoring and secure firmware updates over the air (FOTA). Pelion Device Management provides a flexible set of REST APIs which we will use to communicate to a web application running on an EC-2 instance in AWS. The web application will serve a web page where we can monitor and control our garage..
This project is intended to work on the DISCO-L475VG-IOT01A from ST Microelectronics It implements a simple actuator to drive a relay to simulate pushing the "open" button on older style garage doors which do not use a rolling code interface.
The system is designed to be mounted over the door so that the on board time of flight sensor can be used to detect if the door is open or closed.
The system also monitors temperature, humidity and barometric pressure.
Hardware Requirements:
DISCO-L475G-IOT01A https://os.mbed.com/platforms/ST-Discovery-L475E-IOT01A/
Seeed Studio Grove Relay module https://www.seeedstudio.com/Grove-Relay.html
Seeed Studio Grove cable, I used this one: https://www.seeedstudio.com/Grove-4-pin-Male-Jumper-to-Grove-4-pin-Conversion-Cable-5-PCs-per-Pack.html
Connect to the PMOD connector like this:
This shows how I installed so that the time of flight sensor can detect when the door is open
To use the project:
You will also need a Pelion developers account.
I suggest you first use the Pelion quick state to become familiar with Pelion Device Management. https://os.mbed.com/guides/connect-device-to-pelion/1/?board=ST-Discovery-L475E-IOT01A
Web Interface
For my web interface I am running node-red under Ubuntu in an EC2 instance on AWS. This can run for 12 month within the constraints of their free tier. Here is a tutorial: https://nodered.org/docs/getting-started/aws
You will also need to install several node-red add ons:
sudo npm install -g node-red-dashboard
sudo npm install -g node-red-contrib-mbed-cloud
sudo npm istall -g node-red-contrib-moment
After starting node-red import the contents of GarageFlow.txt from the project, pin the flow into the page.
To enable your web app to access your Pelion account you need an API key.
First you will neet to use your Pelion account to create an API key.
Now we need to apply that API key to your Node-Red flow.
sensors/LIS3MDL/lis3mdl_class.cpp@37:ec1124e5ec1f, 2019-12-05 (annotated)
- Committer:
- JimCarver
- Date:
- Thu Dec 05 19:03:48 2019 +0000
- Revision:
- 37:ec1124e5ec1f
- Parent:
- 18:a15bfe7aaebd
Bug fix
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
screamer | 18:a15bfe7aaebd | 1 | /** |
screamer | 18:a15bfe7aaebd | 2 | ****************************************************************************** |
screamer | 18:a15bfe7aaebd | 3 | * @file lis3mdl_class.cpp |
screamer | 18:a15bfe7aaebd | 4 | * @author AST / EST |
screamer | 18:a15bfe7aaebd | 5 | * @version V0.0.1 |
screamer | 18:a15bfe7aaebd | 6 | * @date 14-April-2015 |
screamer | 18:a15bfe7aaebd | 7 | * @brief Implementation file for the LIS3MDL driver class |
screamer | 18:a15bfe7aaebd | 8 | ****************************************************************************** |
screamer | 18:a15bfe7aaebd | 9 | * @attention |
screamer | 18:a15bfe7aaebd | 10 | * |
screamer | 18:a15bfe7aaebd | 11 | * <h2><center>© COPYRIGHT(c) 2015 STMicroelectronics</center></h2> |
screamer | 18:a15bfe7aaebd | 12 | * |
screamer | 18:a15bfe7aaebd | 13 | * Redistribution and use in source and binary forms, with or without modification, |
screamer | 18:a15bfe7aaebd | 14 | * are permitted provided that the following conditions are met: |
screamer | 18:a15bfe7aaebd | 15 | * 1. Redistributions of source code must retain the above copyright notice, |
screamer | 18:a15bfe7aaebd | 16 | * this list of conditions and the following disclaimer. |
screamer | 18:a15bfe7aaebd | 17 | * 2. Redistributions in binary form must reproduce the above copyright notice, |
screamer | 18:a15bfe7aaebd | 18 | * this list of conditions and the following disclaimer in the documentation |
screamer | 18:a15bfe7aaebd | 19 | * and/or other materials provided with the distribution. |
screamer | 18:a15bfe7aaebd | 20 | * 3. Neither the name of STMicroelectronics nor the names of its contributors |
screamer | 18:a15bfe7aaebd | 21 | * may be used to endorse or promote products derived from this software |
screamer | 18:a15bfe7aaebd | 22 | * without specific prior written permission. |
screamer | 18:a15bfe7aaebd | 23 | * |
screamer | 18:a15bfe7aaebd | 24 | * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" |
screamer | 18:a15bfe7aaebd | 25 | * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
screamer | 18:a15bfe7aaebd | 26 | * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE |
screamer | 18:a15bfe7aaebd | 27 | * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE |
screamer | 18:a15bfe7aaebd | 28 | * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL |
screamer | 18:a15bfe7aaebd | 29 | * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR |
screamer | 18:a15bfe7aaebd | 30 | * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER |
screamer | 18:a15bfe7aaebd | 31 | * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, |
screamer | 18:a15bfe7aaebd | 32 | * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE |
screamer | 18:a15bfe7aaebd | 33 | * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
screamer | 18:a15bfe7aaebd | 34 | * |
screamer | 18:a15bfe7aaebd | 35 | ****************************************************************************** |
screamer | 18:a15bfe7aaebd | 36 | */ |
screamer | 18:a15bfe7aaebd | 37 | |
screamer | 18:a15bfe7aaebd | 38 | /* Includes ------------------------------------------------------------------*/ |
screamer | 18:a15bfe7aaebd | 39 | #include "lis3mdl_class.h" |
screamer | 18:a15bfe7aaebd | 40 | #include "lis3mdl.h" |
screamer | 18:a15bfe7aaebd | 41 | |
screamer | 18:a15bfe7aaebd | 42 | /* Methods -------------------------------------------------------------------*/ |
screamer | 18:a15bfe7aaebd | 43 | /* betzw - based on: |
screamer | 18:a15bfe7aaebd | 44 | X-CUBE-MEMS1/trunk/Drivers/BSP/Components/lis3mdl/lis3mdl.c: revision #400, |
screamer | 18:a15bfe7aaebd | 45 | X-CUBE-MEMS1/trunk: revision #416 |
screamer | 18:a15bfe7aaebd | 46 | */ |
screamer | 18:a15bfe7aaebd | 47 | |
screamer | 18:a15bfe7aaebd | 48 | LIS3MDL::LIS3MDL(SPI *spi, PinName cs_pin, PinName int_pin, SPI_type_t spi_type) : |
screamer | 18:a15bfe7aaebd | 49 | _dev_spi(spi), _cs_pin(cs_pin), _int_pin(int_pin), _spi_type(spi_type) |
screamer | 18:a15bfe7aaebd | 50 | { |
screamer | 18:a15bfe7aaebd | 51 | assert (spi); |
screamer | 18:a15bfe7aaebd | 52 | if (cs_pin == NC) |
screamer | 18:a15bfe7aaebd | 53 | { |
screamer | 18:a15bfe7aaebd | 54 | printf ("ERROR LIS3MDL CS MUST NOT BE NC\n\r"); |
screamer | 18:a15bfe7aaebd | 55 | _dev_spi = NULL; |
screamer | 18:a15bfe7aaebd | 56 | _dev_i2c=NULL; |
screamer | 18:a15bfe7aaebd | 57 | return; |
screamer | 18:a15bfe7aaebd | 58 | } |
screamer | 18:a15bfe7aaebd | 59 | |
screamer | 18:a15bfe7aaebd | 60 | _cs_pin = 0; |
screamer | 18:a15bfe7aaebd | 61 | _dev_i2c=NULL; |
screamer | 18:a15bfe7aaebd | 62 | |
screamer | 18:a15bfe7aaebd | 63 | if (_spi_type == SPI3W) LIS3MDL_Set_SpiInterface ((void *)this, LIS3MDL_SPI_3_WIRE); |
screamer | 18:a15bfe7aaebd | 64 | else if (_spi_type == SPI4W) LIS3MDL_Set_SpiInterface ((void *)this, LIS3MDL_SPI_4_WIRE); |
screamer | 18:a15bfe7aaebd | 65 | } |
screamer | 18:a15bfe7aaebd | 66 | |
screamer | 18:a15bfe7aaebd | 67 | LIS3MDL::LIS3MDL(DevI2C *i2c, uint8_t address, PinName int_pin) : |
screamer | 18:a15bfe7aaebd | 68 | _dev_i2c(i2c), _address(address), _cs_pin(NC), _int_pin(int_pin) |
screamer | 18:a15bfe7aaebd | 69 | { |
screamer | 18:a15bfe7aaebd | 70 | assert (i2c); |
screamer | 18:a15bfe7aaebd | 71 | _dev_spi = NULL; |
screamer | 18:a15bfe7aaebd | 72 | } |
screamer | 18:a15bfe7aaebd | 73 | |
screamer | 18:a15bfe7aaebd | 74 | |
screamer | 18:a15bfe7aaebd | 75 | MAGNETO_StatusTypeDef LIS3MDL::LIS3MDL_Set_SpiInterface (void *handle, LIS3MDL_SPIMode_t spimode) |
screamer | 18:a15bfe7aaebd | 76 | { |
screamer | 18:a15bfe7aaebd | 77 | uint8_t tmp=0x03; //deft LIS3MDL_CTRL_REG3 value |
screamer | 18:a15bfe7aaebd | 78 | |
screamer | 18:a15bfe7aaebd | 79 | tmp |= (uint8_t)spimode; |
screamer | 18:a15bfe7aaebd | 80 | if (LIS3MDL_IO_Write(&tmp, LIS3MDL_M_CTRL_REG3_M, 1) != MAGNETO_OK) return MAGNETO_ERROR; |
screamer | 18:a15bfe7aaebd | 81 | return MAGNETO_OK; |
screamer | 18:a15bfe7aaebd | 82 | } |
screamer | 18:a15bfe7aaebd | 83 | |
screamer | 18:a15bfe7aaebd | 84 | /** |
screamer | 18:a15bfe7aaebd | 85 | * @brief Set LIS3MDL Initialization |
screamer | 18:a15bfe7aaebd | 86 | * @param LIS3MDL_Init the configuration setting for the LIS3MDL |
screamer | 18:a15bfe7aaebd | 87 | * @retval MAGNETO_OK in case of success, an error code otherwise |
screamer | 18:a15bfe7aaebd | 88 | */ |
screamer | 18:a15bfe7aaebd | 89 | MAGNETO_StatusTypeDef LIS3MDL::LIS3MDL_Init(MAGNETO_InitTypeDef *LIS3MDL_Init) |
screamer | 18:a15bfe7aaebd | 90 | { |
screamer | 18:a15bfe7aaebd | 91 | uint8_t tmp1 = 0x00; |
screamer | 18:a15bfe7aaebd | 92 | MAGNETO_InitTypeDef *initStructure = LIS3MDL_Init; |
screamer | 18:a15bfe7aaebd | 93 | MAGNETO_InitTypeDef tempInit; |
screamer | 18:a15bfe7aaebd | 94 | |
screamer | 18:a15bfe7aaebd | 95 | if (initStructure == NULL) {// default params |
screamer | 18:a15bfe7aaebd | 96 | tempInit.M_FullScale = LIS3MDL_M_FS_4; |
screamer | 18:a15bfe7aaebd | 97 | tempInit.M_OperatingMode = LIS3MDL_M_MD_CONTINUOUS; |
screamer | 18:a15bfe7aaebd | 98 | tempInit.M_XYOperativeMode = LIS3MDL_M_OM_HP; |
screamer | 18:a15bfe7aaebd | 99 | tempInit.M_OutputDataRate = LIS3MDL_M_DO_80; |
screamer | 18:a15bfe7aaebd | 100 | initStructure = &tempInit; |
screamer | 18:a15bfe7aaebd | 101 | } |
screamer | 18:a15bfe7aaebd | 102 | |
screamer | 18:a15bfe7aaebd | 103 | |
screamer | 18:a15bfe7aaebd | 104 | /* Configure the low level interface ---------------------------------------*/ |
screamer | 18:a15bfe7aaebd | 105 | if(LIS3MDL_IO_Init() != MAGNETO_OK) |
screamer | 18:a15bfe7aaebd | 106 | { |
screamer | 18:a15bfe7aaebd | 107 | return MAGNETO_ERROR; |
screamer | 18:a15bfe7aaebd | 108 | } |
screamer | 18:a15bfe7aaebd | 109 | |
screamer | 18:a15bfe7aaebd | 110 | /****** Magnetic sensor *******/ |
screamer | 18:a15bfe7aaebd | 111 | |
screamer | 18:a15bfe7aaebd | 112 | if(LIS3MDL_IO_Read(&tmp1, LIS3MDL_M_CTRL_REG3_M, 1) != MAGNETO_OK) |
screamer | 18:a15bfe7aaebd | 113 | { |
screamer | 18:a15bfe7aaebd | 114 | return MAGNETO_ERROR; |
screamer | 18:a15bfe7aaebd | 115 | } |
screamer | 18:a15bfe7aaebd | 116 | |
screamer | 18:a15bfe7aaebd | 117 | /* Conversion mode selection */ |
screamer | 18:a15bfe7aaebd | 118 | tmp1 &= ~(LIS3MDL_M_MD_MASK); |
screamer | 18:a15bfe7aaebd | 119 | tmp1 |= initStructure->M_OperatingMode; |
screamer | 18:a15bfe7aaebd | 120 | |
screamer | 18:a15bfe7aaebd | 121 | if(LIS3MDL_IO_Write(&tmp1, LIS3MDL_M_CTRL_REG3_M, 1) != MAGNETO_OK) |
screamer | 18:a15bfe7aaebd | 122 | { |
screamer | 18:a15bfe7aaebd | 123 | return MAGNETO_ERROR; |
screamer | 18:a15bfe7aaebd | 124 | } |
screamer | 18:a15bfe7aaebd | 125 | |
screamer | 18:a15bfe7aaebd | 126 | if(LIS3MDL_IO_Read(&tmp1, LIS3MDL_M_CTRL_REG1_M, 1) != MAGNETO_OK) |
screamer | 18:a15bfe7aaebd | 127 | { |
screamer | 18:a15bfe7aaebd | 128 | return MAGNETO_ERROR; |
screamer | 18:a15bfe7aaebd | 129 | } |
screamer | 18:a15bfe7aaebd | 130 | |
screamer | 18:a15bfe7aaebd | 131 | /* Output data rate selection */ |
screamer | 18:a15bfe7aaebd | 132 | tmp1 &= ~(LIS3MDL_M_DO_MASK); |
screamer | 18:a15bfe7aaebd | 133 | tmp1 |= initStructure->M_OutputDataRate; |
screamer | 18:a15bfe7aaebd | 134 | |
screamer | 18:a15bfe7aaebd | 135 | /* X and Y axes Operative mode selection */ |
screamer | 18:a15bfe7aaebd | 136 | tmp1 &= ~(LIS3MDL_M_OM_MASK); |
screamer | 18:a15bfe7aaebd | 137 | tmp1 |= initStructure->M_XYOperativeMode; |
screamer | 18:a15bfe7aaebd | 138 | |
screamer | 18:a15bfe7aaebd | 139 | if(LIS3MDL_IO_Write(&tmp1, LIS3MDL_M_CTRL_REG1_M, 1) != MAGNETO_OK) |
screamer | 18:a15bfe7aaebd | 140 | { |
screamer | 18:a15bfe7aaebd | 141 | return MAGNETO_ERROR; |
screamer | 18:a15bfe7aaebd | 142 | } |
screamer | 18:a15bfe7aaebd | 143 | |
screamer | 18:a15bfe7aaebd | 144 | if(LIS3MDL_IO_Read(&tmp1, LIS3MDL_M_CTRL_REG2_M, 1) != MAGNETO_OK) |
screamer | 18:a15bfe7aaebd | 145 | { |
screamer | 18:a15bfe7aaebd | 146 | return MAGNETO_ERROR; |
screamer | 18:a15bfe7aaebd | 147 | } |
screamer | 18:a15bfe7aaebd | 148 | |
screamer | 18:a15bfe7aaebd | 149 | /* Full scale selection */ |
screamer | 18:a15bfe7aaebd | 150 | tmp1 &= ~(LIS3MDL_M_FS_MASK); |
screamer | 18:a15bfe7aaebd | 151 | tmp1 |= initStructure->M_FullScale; |
screamer | 18:a15bfe7aaebd | 152 | |
screamer | 18:a15bfe7aaebd | 153 | if(LIS3MDL_IO_Write(&tmp1, LIS3MDL_M_CTRL_REG2_M, 1) != MAGNETO_OK) |
screamer | 18:a15bfe7aaebd | 154 | { |
screamer | 18:a15bfe7aaebd | 155 | return MAGNETO_ERROR; |
screamer | 18:a15bfe7aaebd | 156 | } |
screamer | 18:a15bfe7aaebd | 157 | |
screamer | 18:a15bfe7aaebd | 158 | /* Configure interrupt lines */ |
screamer | 18:a15bfe7aaebd | 159 | LIS3MDL_IO_ITConfig(); |
screamer | 18:a15bfe7aaebd | 160 | |
screamer | 18:a15bfe7aaebd | 161 | return MAGNETO_OK; |
screamer | 18:a15bfe7aaebd | 162 | |
screamer | 18:a15bfe7aaebd | 163 | /******************************/ |
screamer | 18:a15bfe7aaebd | 164 | } |
screamer | 18:a15bfe7aaebd | 165 | |
screamer | 18:a15bfe7aaebd | 166 | |
screamer | 18:a15bfe7aaebd | 167 | /** |
screamer | 18:a15bfe7aaebd | 168 | * @brief Read ID of LIS3MDL Magnetic sensor |
screamer | 18:a15bfe7aaebd | 169 | * @param m_id the pointer where the ID of the device is stored |
screamer | 18:a15bfe7aaebd | 170 | * @retval MAGNETO_OK in case of success, an error code otherwise |
screamer | 18:a15bfe7aaebd | 171 | */ |
screamer | 18:a15bfe7aaebd | 172 | MAGNETO_StatusTypeDef LIS3MDL::LIS3MDL_Read_M_ID(uint8_t *m_id) |
screamer | 18:a15bfe7aaebd | 173 | { |
screamer | 18:a15bfe7aaebd | 174 | if(!m_id) |
screamer | 18:a15bfe7aaebd | 175 | { |
screamer | 18:a15bfe7aaebd | 176 | return MAGNETO_ERROR; |
screamer | 18:a15bfe7aaebd | 177 | } |
screamer | 18:a15bfe7aaebd | 178 | |
screamer | 18:a15bfe7aaebd | 179 | return LIS3MDL_IO_Read(m_id, LIS3MDL_M_WHO_AM_I_ADDR, 1); |
screamer | 18:a15bfe7aaebd | 180 | } |
screamer | 18:a15bfe7aaebd | 181 | |
screamer | 18:a15bfe7aaebd | 182 | |
screamer | 18:a15bfe7aaebd | 183 | /** |
screamer | 18:a15bfe7aaebd | 184 | * @brief Read raw data from LIS3MDL Magnetic sensor output register |
screamer | 18:a15bfe7aaebd | 185 | * @param pData the pointer where the magnetometer raw data are stored |
screamer | 18:a15bfe7aaebd | 186 | * @retval MAGNETO_OK in case of success, an error code otherwise |
screamer | 18:a15bfe7aaebd | 187 | */ |
screamer | 18:a15bfe7aaebd | 188 | MAGNETO_StatusTypeDef LIS3MDL::LIS3MDL_M_GetAxesRaw(int16_t *pData) |
screamer | 18:a15bfe7aaebd | 189 | { |
screamer | 18:a15bfe7aaebd | 190 | uint8_t tempReg[2] = {0, 0}; |
screamer | 18:a15bfe7aaebd | 191 | |
screamer | 18:a15bfe7aaebd | 192 | if(LIS3MDL_IO_Read(&tempReg[0], (LIS3MDL_M_OUT_X_L_M | LIS3MDL_I2C_MULTIPLEBYTE_CMD), |
screamer | 18:a15bfe7aaebd | 193 | 2) != MAGNETO_OK) |
screamer | 18:a15bfe7aaebd | 194 | { |
screamer | 18:a15bfe7aaebd | 195 | return MAGNETO_ERROR; |
screamer | 18:a15bfe7aaebd | 196 | } |
screamer | 18:a15bfe7aaebd | 197 | |
screamer | 18:a15bfe7aaebd | 198 | pData[0] = ((((int16_t)tempReg[1]) << 8) + (int16_t)tempReg[0]); |
screamer | 18:a15bfe7aaebd | 199 | |
screamer | 18:a15bfe7aaebd | 200 | if(LIS3MDL_IO_Read(&tempReg[0], (LIS3MDL_M_OUT_Y_L_M | LIS3MDL_I2C_MULTIPLEBYTE_CMD), |
screamer | 18:a15bfe7aaebd | 201 | 2) != MAGNETO_OK) |
screamer | 18:a15bfe7aaebd | 202 | { |
screamer | 18:a15bfe7aaebd | 203 | return MAGNETO_ERROR; |
screamer | 18:a15bfe7aaebd | 204 | } |
screamer | 18:a15bfe7aaebd | 205 | |
screamer | 18:a15bfe7aaebd | 206 | pData[1] = ((((int16_t)tempReg[1]) << 8) + (int16_t)tempReg[0]); |
screamer | 18:a15bfe7aaebd | 207 | |
screamer | 18:a15bfe7aaebd | 208 | if(LIS3MDL_IO_Read(&tempReg[0], (LIS3MDL_M_OUT_Z_L_M | LIS3MDL_I2C_MULTIPLEBYTE_CMD), |
screamer | 18:a15bfe7aaebd | 209 | 2) != MAGNETO_OK) |
screamer | 18:a15bfe7aaebd | 210 | { |
screamer | 18:a15bfe7aaebd | 211 | return MAGNETO_ERROR; |
screamer | 18:a15bfe7aaebd | 212 | } |
screamer | 18:a15bfe7aaebd | 213 | |
screamer | 18:a15bfe7aaebd | 214 | pData[2] = ((((int16_t)tempReg[1]) << 8) + (int16_t)tempReg[0]); |
screamer | 18:a15bfe7aaebd | 215 | |
screamer | 18:a15bfe7aaebd | 216 | return MAGNETO_OK; |
screamer | 18:a15bfe7aaebd | 217 | } |
screamer | 18:a15bfe7aaebd | 218 | |
screamer | 18:a15bfe7aaebd | 219 | |
screamer | 18:a15bfe7aaebd | 220 | /** |
screamer | 18:a15bfe7aaebd | 221 | * @brief Read data from LIS3MDL Magnetic sensor and calculate Magnetic in mgauss |
screamer | 18:a15bfe7aaebd | 222 | * @param pData the pointer where the magnetometer data are stored |
screamer | 18:a15bfe7aaebd | 223 | * @retval MAGNETO_OK in case of success, an error code otherwise |
screamer | 18:a15bfe7aaebd | 224 | */ |
screamer | 18:a15bfe7aaebd | 225 | MAGNETO_StatusTypeDef LIS3MDL::LIS3MDL_M_GetAxes(int32_t *pData) |
screamer | 18:a15bfe7aaebd | 226 | { |
screamer | 18:a15bfe7aaebd | 227 | uint8_t tempReg = 0x00; |
screamer | 18:a15bfe7aaebd | 228 | int16_t pDataRaw[3]; |
screamer | 18:a15bfe7aaebd | 229 | float sensitivity = 0; |
screamer | 18:a15bfe7aaebd | 230 | |
screamer | 18:a15bfe7aaebd | 231 | if(LIS3MDL_M_GetAxesRaw(pDataRaw) != MAGNETO_OK) |
screamer | 18:a15bfe7aaebd | 232 | { |
screamer | 18:a15bfe7aaebd | 233 | return MAGNETO_ERROR; |
screamer | 18:a15bfe7aaebd | 234 | } |
screamer | 18:a15bfe7aaebd | 235 | |
screamer | 18:a15bfe7aaebd | 236 | if(LIS3MDL_IO_Read(&tempReg, LIS3MDL_M_CTRL_REG2_M, 1) != MAGNETO_OK) |
screamer | 18:a15bfe7aaebd | 237 | { |
screamer | 18:a15bfe7aaebd | 238 | return MAGNETO_ERROR; |
screamer | 18:a15bfe7aaebd | 239 | } |
screamer | 18:a15bfe7aaebd | 240 | |
screamer | 18:a15bfe7aaebd | 241 | tempReg &= LIS3MDL_M_FS_MASK; |
screamer | 18:a15bfe7aaebd | 242 | |
screamer | 18:a15bfe7aaebd | 243 | switch(tempReg) |
screamer | 18:a15bfe7aaebd | 244 | { |
screamer | 18:a15bfe7aaebd | 245 | case LIS3MDL_M_FS_4: |
screamer | 18:a15bfe7aaebd | 246 | sensitivity = 0.14; |
screamer | 18:a15bfe7aaebd | 247 | break; |
screamer | 18:a15bfe7aaebd | 248 | case LIS3MDL_M_FS_8: |
screamer | 18:a15bfe7aaebd | 249 | sensitivity = 0.29; |
screamer | 18:a15bfe7aaebd | 250 | break; |
screamer | 18:a15bfe7aaebd | 251 | case LIS3MDL_M_FS_12: |
screamer | 18:a15bfe7aaebd | 252 | sensitivity = 0.43; |
screamer | 18:a15bfe7aaebd | 253 | break; |
screamer | 18:a15bfe7aaebd | 254 | case LIS3MDL_M_FS_16: |
screamer | 18:a15bfe7aaebd | 255 | sensitivity = 0.58; |
screamer | 18:a15bfe7aaebd | 256 | break; |
screamer | 18:a15bfe7aaebd | 257 | } |
screamer | 18:a15bfe7aaebd | 258 | |
screamer | 18:a15bfe7aaebd | 259 | pData[0] = (int32_t)(pDataRaw[0] * sensitivity); |
screamer | 18:a15bfe7aaebd | 260 | pData[1] = (int32_t)(pDataRaw[1] * sensitivity); |
screamer | 18:a15bfe7aaebd | 261 | pData[2] = (int32_t)(pDataRaw[2] * sensitivity); |
screamer | 18:a15bfe7aaebd | 262 | |
screamer | 18:a15bfe7aaebd | 263 | return MAGNETO_OK; |
screamer | 18:a15bfe7aaebd | 264 | } |
screamer | 18:a15bfe7aaebd | 265 | |
screamer | 18:a15bfe7aaebd | 266 | /************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/ |