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.

https://os.mbed.com/media/uploads/JimCarver/garageopener.jpg

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:

https://os.mbed.com/media/uploads/JimCarver/opener.jpg

This shows how I installed so that the time of flight sensor can detect when the door is open

https://os.mbed.com/media/uploads/JimCarver/opener1.jpg https://os.mbed.com/media/uploads/JimCarver/opener2.jpg

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.

https://os.mbed.com/media/uploads/JimCarver/api_portal.jpg

Now we need to apply that API key to your Node-Red flow.

https://os.mbed.com/media/uploads/JimCarver/api_node-red.jpg

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?

UserRevisionLine numberNew contents of line
screamer 18:a15bfe7aaebd 1 /**
screamer 18:a15bfe7aaebd 2 ******************************************************************************
screamer 18:a15bfe7aaebd 3 * @file LPS22HBSensor.cpp
screamer 18:a15bfe7aaebd 4 * @author CLab
screamer 18:a15bfe7aaebd 5 * @version V1.0.0
screamer 18:a15bfe7aaebd 6 * @date 5 August 2016
screamer 18:a15bfe7aaebd 7 * @brief Implementation of an LPS22HB Pressure sensor.
screamer 18:a15bfe7aaebd 8 ******************************************************************************
screamer 18:a15bfe7aaebd 9 * @attention
screamer 18:a15bfe7aaebd 10 *
screamer 18:a15bfe7aaebd 11 * <h2><center>&copy; COPYRIGHT(c) 2016 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
screamer 18:a15bfe7aaebd 39 /* Includes ------------------------------------------------------------------*/
screamer 18:a15bfe7aaebd 40
screamer 18:a15bfe7aaebd 41
screamer 18:a15bfe7aaebd 42 #include "LPS22HBSensor.h"
screamer 18:a15bfe7aaebd 43
screamer 18:a15bfe7aaebd 44
screamer 18:a15bfe7aaebd 45 /* Class Implementation ------------------------------------------------------*/
screamer 18:a15bfe7aaebd 46
screamer 18:a15bfe7aaebd 47 LPS22HBSensor::LPS22HBSensor(SPI *spi, PinName cs_pin, PinName int_pin, SPI_type_t spi_type) : _dev_spi(spi), _cs_pin(cs_pin), _int_pin(int_pin), _spi_type(spi_type)
screamer 18:a15bfe7aaebd 48 {
screamer 18:a15bfe7aaebd 49 assert (spi);
screamer 18:a15bfe7aaebd 50 if (cs_pin == NC)
screamer 18:a15bfe7aaebd 51 {
screamer 18:a15bfe7aaebd 52 printf ("ERROR LPS22HBSensor CS MUST NOT BE NC\n\r");
screamer 18:a15bfe7aaebd 53 _dev_spi = NULL;
screamer 18:a15bfe7aaebd 54 _dev_i2c=NULL;
screamer 18:a15bfe7aaebd 55 return;
screamer 18:a15bfe7aaebd 56 }
screamer 18:a15bfe7aaebd 57
screamer 18:a15bfe7aaebd 58 _cs_pin = 1;
screamer 18:a15bfe7aaebd 59 _dev_i2c=NULL;
screamer 18:a15bfe7aaebd 60
screamer 18:a15bfe7aaebd 61 if (_spi_type == SPI3W) LPS22HB_Set_SpiInterface ((void *)this, LPS22HB_SPI_3_WIRE);
screamer 18:a15bfe7aaebd 62 else if (_spi_type == SPI4W) LPS22HB_Set_SpiInterface ((void *)this, LPS22HB_SPI_4_WIRE);
screamer 18:a15bfe7aaebd 63
screamer 18:a15bfe7aaebd 64 LPS22HB_Set_I2C ((void *)this, LPS22HB_DISABLE);
screamer 18:a15bfe7aaebd 65 }
screamer 18:a15bfe7aaebd 66
screamer 18:a15bfe7aaebd 67 /** Constructor
screamer 18:a15bfe7aaebd 68 * @param i2c object of an helper class which handles the I2C peripheral
screamer 18:a15bfe7aaebd 69 * @param address the address of the component's instance
screamer 18:a15bfe7aaebd 70 */
screamer 18:a15bfe7aaebd 71 LPS22HBSensor::LPS22HBSensor(DevI2C *i2c, uint8_t address, PinName int_pin) :
screamer 18:a15bfe7aaebd 72 _dev_i2c(i2c), _address(address), _cs_pin(NC), _int_pin(int_pin)
screamer 18:a15bfe7aaebd 73 {
screamer 18:a15bfe7aaebd 74 assert (i2c);
screamer 18:a15bfe7aaebd 75 _dev_spi = NULL;
screamer 18:a15bfe7aaebd 76 LPS22HB_Set_I2C ((void *)this, LPS22HB_ENABLE);
screamer 18:a15bfe7aaebd 77 };
screamer 18:a15bfe7aaebd 78
screamer 18:a15bfe7aaebd 79 /**
screamer 18:a15bfe7aaebd 80 * @brief Initializing the component.
screamer 18:a15bfe7aaebd 81 * @param[in] init pointer to device specific initalization structure.
screamer 18:a15bfe7aaebd 82 * @retval "0" in case of success, an error code otherwise.
screamer 18:a15bfe7aaebd 83 */
screamer 18:a15bfe7aaebd 84 int LPS22HBSensor::init(void *init)
screamer 18:a15bfe7aaebd 85 {
screamer 18:a15bfe7aaebd 86 if ( LPS22HB_Set_PowerMode( (void *)this, LPS22HB_LowPower) == LPS22HB_ERROR )
screamer 18:a15bfe7aaebd 87 {
screamer 18:a15bfe7aaebd 88 return 1;
screamer 18:a15bfe7aaebd 89 }
screamer 18:a15bfe7aaebd 90
screamer 18:a15bfe7aaebd 91 /* Power down the device */
screamer 18:a15bfe7aaebd 92 if ( LPS22HB_Set_Odr( (void *)this, LPS22HB_ODR_ONE_SHOT ) == LPS22HB_ERROR )
screamer 18:a15bfe7aaebd 93 {
screamer 18:a15bfe7aaebd 94 return 1;
screamer 18:a15bfe7aaebd 95 }
screamer 18:a15bfe7aaebd 96
screamer 18:a15bfe7aaebd 97 /* Disable low-pass filter on LPS22HB pressure data */
screamer 18:a15bfe7aaebd 98 if( LPS22HB_Set_LowPassFilter( (void *)this, LPS22HB_DISABLE) == LPS22HB_ERROR )
screamer 18:a15bfe7aaebd 99 {
screamer 18:a15bfe7aaebd 100 return 1;
screamer 18:a15bfe7aaebd 101 }
screamer 18:a15bfe7aaebd 102
screamer 18:a15bfe7aaebd 103 /* Set low-pass filter cutoff configuration*/
screamer 18:a15bfe7aaebd 104 if( LPS22HB_Set_LowPassFilterCutoff( (void *)this, LPS22HB_ODR_9) == LPS22HB_ERROR )
screamer 18:a15bfe7aaebd 105 {
screamer 18:a15bfe7aaebd 106 return 1;
screamer 18:a15bfe7aaebd 107 }
screamer 18:a15bfe7aaebd 108
screamer 18:a15bfe7aaebd 109 /* Set block data update mode */
screamer 18:a15bfe7aaebd 110 if ( LPS22HB_Set_Bdu( (void *)this, LPS22HB_BDU_NO_UPDATE ) == LPS22HB_ERROR )
screamer 18:a15bfe7aaebd 111 {
screamer 18:a15bfe7aaebd 112 return 1;
screamer 18:a15bfe7aaebd 113 }
screamer 18:a15bfe7aaebd 114
screamer 18:a15bfe7aaebd 115 /* Set automatic increment for multi-byte read/write */
screamer 18:a15bfe7aaebd 116 if( LPS22HB_Set_AutomaticIncrementRegAddress( (void *)this, LPS22HB_ENABLE) == LPS22HB_ERROR )
screamer 18:a15bfe7aaebd 117 {
screamer 18:a15bfe7aaebd 118 return 1;
screamer 18:a15bfe7aaebd 119 }
screamer 18:a15bfe7aaebd 120
screamer 18:a15bfe7aaebd 121 _is_enabled = 0;
screamer 18:a15bfe7aaebd 122 _last_odr = 25.0f;
screamer 18:a15bfe7aaebd 123
screamer 18:a15bfe7aaebd 124 return 0;
screamer 18:a15bfe7aaebd 125 }
screamer 18:a15bfe7aaebd 126
screamer 18:a15bfe7aaebd 127
screamer 18:a15bfe7aaebd 128 /**
screamer 18:a15bfe7aaebd 129 * @brief Enable LPS22HB
screamer 18:a15bfe7aaebd 130 * @retval 0 in case of success, an error code otherwise
screamer 18:a15bfe7aaebd 131 */
screamer 18:a15bfe7aaebd 132 int LPS22HBSensor::enable(void)
screamer 18:a15bfe7aaebd 133 {
screamer 18:a15bfe7aaebd 134 /* Check if the component is already enabled */
screamer 18:a15bfe7aaebd 135 if ( _is_enabled == 1 )
screamer 18:a15bfe7aaebd 136 {
screamer 18:a15bfe7aaebd 137 return 0;
screamer 18:a15bfe7aaebd 138 }
screamer 18:a15bfe7aaebd 139
screamer 18:a15bfe7aaebd 140 if(Set_ODR_When_Enabled(_last_odr) == 1)
screamer 18:a15bfe7aaebd 141 {
screamer 18:a15bfe7aaebd 142 return 1;
screamer 18:a15bfe7aaebd 143 }
screamer 18:a15bfe7aaebd 144
screamer 18:a15bfe7aaebd 145 _is_enabled = 1;
screamer 18:a15bfe7aaebd 146
screamer 18:a15bfe7aaebd 147 return 0;
screamer 18:a15bfe7aaebd 148 }
screamer 18:a15bfe7aaebd 149
screamer 18:a15bfe7aaebd 150 /**
screamer 18:a15bfe7aaebd 151 * @brief Disable LPS22HB
screamer 18:a15bfe7aaebd 152 * @retval 0 in case of success, an error code otherwise
screamer 18:a15bfe7aaebd 153 */
screamer 18:a15bfe7aaebd 154 int LPS22HBSensor::disable(void)
screamer 18:a15bfe7aaebd 155 {
screamer 18:a15bfe7aaebd 156 /* Check if the component is already disabled */
screamer 18:a15bfe7aaebd 157 if ( _is_enabled == 0 )
screamer 18:a15bfe7aaebd 158 {
screamer 18:a15bfe7aaebd 159 return 0;
screamer 18:a15bfe7aaebd 160 }
screamer 18:a15bfe7aaebd 161
screamer 18:a15bfe7aaebd 162 /* Power down the device */
screamer 18:a15bfe7aaebd 163 if ( LPS22HB_Set_Odr( (void *)this, LPS22HB_ODR_ONE_SHOT ) == LPS22HB_ERROR )
screamer 18:a15bfe7aaebd 164 {
screamer 18:a15bfe7aaebd 165 return 1;
screamer 18:a15bfe7aaebd 166 }
screamer 18:a15bfe7aaebd 167
screamer 18:a15bfe7aaebd 168 _is_enabled = 0;
screamer 18:a15bfe7aaebd 169
screamer 18:a15bfe7aaebd 170 return 0;
screamer 18:a15bfe7aaebd 171 }
screamer 18:a15bfe7aaebd 172
screamer 18:a15bfe7aaebd 173 /**
screamer 18:a15bfe7aaebd 174 * @brief Read ID address of LPS22HB
screamer 18:a15bfe7aaebd 175 * @param id the pointer where the ID of the device is stored
screamer 18:a15bfe7aaebd 176 * @retval 0 in case of success, an error code otherwise
screamer 18:a15bfe7aaebd 177 */
screamer 18:a15bfe7aaebd 178 int LPS22HBSensor::read_id(uint8_t *id)
screamer 18:a15bfe7aaebd 179 {
screamer 18:a15bfe7aaebd 180 if(!id)
screamer 18:a15bfe7aaebd 181 {
screamer 18:a15bfe7aaebd 182 return 1;
screamer 18:a15bfe7aaebd 183 }
screamer 18:a15bfe7aaebd 184
screamer 18:a15bfe7aaebd 185 /* Read WHO AM I register */
screamer 18:a15bfe7aaebd 186 if ( LPS22HB_Get_DeviceID( (void *)this, id ) == LPS22HB_ERROR )
screamer 18:a15bfe7aaebd 187 {
screamer 18:a15bfe7aaebd 188 return 1;
screamer 18:a15bfe7aaebd 189 }
screamer 18:a15bfe7aaebd 190
screamer 18:a15bfe7aaebd 191 return 0;
screamer 18:a15bfe7aaebd 192 }
screamer 18:a15bfe7aaebd 193
screamer 18:a15bfe7aaebd 194 /**
screamer 18:a15bfe7aaebd 195 * @brief Reboot memory content of LPS22HB
screamer 18:a15bfe7aaebd 196 * @param None
screamer 18:a15bfe7aaebd 197 * @retval 0 in case of success, an error code otherwise
screamer 18:a15bfe7aaebd 198 */
screamer 18:a15bfe7aaebd 199 int LPS22HBSensor::reset(void)
screamer 18:a15bfe7aaebd 200 {
screamer 18:a15bfe7aaebd 201 /* Read WHO AM I register */
screamer 18:a15bfe7aaebd 202 if ( LPS22HB_MemoryBoot((void *)this) == LPS22HB_ERROR )
screamer 18:a15bfe7aaebd 203 {
screamer 18:a15bfe7aaebd 204 return 1;
screamer 18:a15bfe7aaebd 205 }
screamer 18:a15bfe7aaebd 206
screamer 18:a15bfe7aaebd 207 return 0;
screamer 18:a15bfe7aaebd 208 }
screamer 18:a15bfe7aaebd 209
screamer 18:a15bfe7aaebd 210 /**
screamer 18:a15bfe7aaebd 211 * @brief Read LPS22HB output register, and calculate the pressure in mbar
screamer 18:a15bfe7aaebd 212 * @param pfData the pressure value in mbar
screamer 18:a15bfe7aaebd 213 * @retval 0 in case of success, an error code otherwise
screamer 18:a15bfe7aaebd 214 */
screamer 18:a15bfe7aaebd 215 int LPS22HBSensor::get_pressure(float* pfData)
screamer 18:a15bfe7aaebd 216 {
screamer 18:a15bfe7aaebd 217 int32_t int32data = 0;
screamer 18:a15bfe7aaebd 218
screamer 18:a15bfe7aaebd 219 /* Read data from LPS22HB. */
screamer 18:a15bfe7aaebd 220 if ( LPS22HB_Get_Pressure( (void *)this, &int32data ) == LPS22HB_ERROR )
screamer 18:a15bfe7aaebd 221 {
screamer 18:a15bfe7aaebd 222 return 1;
screamer 18:a15bfe7aaebd 223 }
screamer 18:a15bfe7aaebd 224
screamer 18:a15bfe7aaebd 225 *pfData = ( float )int32data / 100.0f;
screamer 18:a15bfe7aaebd 226
screamer 18:a15bfe7aaebd 227 return 0;
screamer 18:a15bfe7aaebd 228 }
screamer 18:a15bfe7aaebd 229
screamer 18:a15bfe7aaebd 230 /**
screamer 18:a15bfe7aaebd 231 * @brief Read LPS22HB output register, and calculate the temperature
screamer 18:a15bfe7aaebd 232 * @param pfData the temperature value
screamer 18:a15bfe7aaebd 233 * @retval 0 in case of success, an error code otherwise
screamer 18:a15bfe7aaebd 234 */
screamer 18:a15bfe7aaebd 235 int LPS22HBSensor::get_temperature(float *pfData)
screamer 18:a15bfe7aaebd 236 {
screamer 18:a15bfe7aaebd 237 int16_t int16data = 0;
screamer 18:a15bfe7aaebd 238
screamer 18:a15bfe7aaebd 239 /* Read data from LPS22HB. */
screamer 18:a15bfe7aaebd 240 if ( LPS22HB_Get_Temperature( (void *)this, &int16data ) == LPS22HB_ERROR )
screamer 18:a15bfe7aaebd 241 {
screamer 18:a15bfe7aaebd 242 return 1;
screamer 18:a15bfe7aaebd 243 }
screamer 18:a15bfe7aaebd 244
screamer 18:a15bfe7aaebd 245 *pfData = ( float )int16data / 10.0f;
screamer 18:a15bfe7aaebd 246
screamer 18:a15bfe7aaebd 247 return 0;
screamer 18:a15bfe7aaebd 248 }
screamer 18:a15bfe7aaebd 249
screamer 18:a15bfe7aaebd 250 /**
screamer 18:a15bfe7aaebd 251 * @brief Read LPS22HB output data rate
screamer 18:a15bfe7aaebd 252 * @param odr the pointer to the output data rate
screamer 18:a15bfe7aaebd 253 * @retval 0 in case of success, an error code otherwise
screamer 18:a15bfe7aaebd 254 */
screamer 18:a15bfe7aaebd 255 int LPS22HBSensor::get_odr(float* odr)
screamer 18:a15bfe7aaebd 256 {
screamer 18:a15bfe7aaebd 257 LPS22HB_Odr_et odr_low_level;
screamer 18:a15bfe7aaebd 258
screamer 18:a15bfe7aaebd 259 if ( LPS22HB_Get_Odr( (void *)this, &odr_low_level ) == LPS22HB_ERROR )
screamer 18:a15bfe7aaebd 260 {
screamer 18:a15bfe7aaebd 261 return 1;
screamer 18:a15bfe7aaebd 262 }
screamer 18:a15bfe7aaebd 263
screamer 18:a15bfe7aaebd 264 switch( odr_low_level )
screamer 18:a15bfe7aaebd 265 {
screamer 18:a15bfe7aaebd 266 case LPS22HB_ODR_ONE_SHOT:
screamer 18:a15bfe7aaebd 267 *odr = 0.0f;
screamer 18:a15bfe7aaebd 268 break;
screamer 18:a15bfe7aaebd 269 case LPS22HB_ODR_1HZ:
screamer 18:a15bfe7aaebd 270 *odr = 1.0f;
screamer 18:a15bfe7aaebd 271 break;
screamer 18:a15bfe7aaebd 272 case LPS22HB_ODR_10HZ:
screamer 18:a15bfe7aaebd 273 *odr = 10.0f;
screamer 18:a15bfe7aaebd 274 break;
screamer 18:a15bfe7aaebd 275 case LPS22HB_ODR_25HZ:
screamer 18:a15bfe7aaebd 276 *odr = 25.0f;
screamer 18:a15bfe7aaebd 277 break;
screamer 18:a15bfe7aaebd 278 case LPS22HB_ODR_50HZ:
screamer 18:a15bfe7aaebd 279 *odr = 50.0f;
screamer 18:a15bfe7aaebd 280 break;
screamer 18:a15bfe7aaebd 281 case LPS22HB_ODR_75HZ:
screamer 18:a15bfe7aaebd 282 *odr = 75.0f;
screamer 18:a15bfe7aaebd 283 break;
screamer 18:a15bfe7aaebd 284 default:
screamer 18:a15bfe7aaebd 285 *odr = -1.0f;
screamer 18:a15bfe7aaebd 286 return 1;
screamer 18:a15bfe7aaebd 287 }
screamer 18:a15bfe7aaebd 288
screamer 18:a15bfe7aaebd 289 return 0;
screamer 18:a15bfe7aaebd 290 }
screamer 18:a15bfe7aaebd 291
screamer 18:a15bfe7aaebd 292 /**
screamer 18:a15bfe7aaebd 293 * @brief Set ODR
screamer 18:a15bfe7aaebd 294 * @param odr the output data rate to be set
screamer 18:a15bfe7aaebd 295 * @retval 0 in case of success, an error code otherwise
screamer 18:a15bfe7aaebd 296 */
screamer 18:a15bfe7aaebd 297 int LPS22HBSensor::set_odr(float odr)
screamer 18:a15bfe7aaebd 298 {
screamer 18:a15bfe7aaebd 299 if(_is_enabled == 1)
screamer 18:a15bfe7aaebd 300 {
screamer 18:a15bfe7aaebd 301 if(Set_ODR_When_Enabled(odr) == 1)
screamer 18:a15bfe7aaebd 302 {
screamer 18:a15bfe7aaebd 303 return 1;
screamer 18:a15bfe7aaebd 304 }
screamer 18:a15bfe7aaebd 305 }
screamer 18:a15bfe7aaebd 306 else
screamer 18:a15bfe7aaebd 307 {
screamer 18:a15bfe7aaebd 308 if(Set_ODR_When_Disabled(odr) == 1)
screamer 18:a15bfe7aaebd 309 {
screamer 18:a15bfe7aaebd 310 return 1;
screamer 18:a15bfe7aaebd 311 }
screamer 18:a15bfe7aaebd 312 }
screamer 18:a15bfe7aaebd 313
screamer 18:a15bfe7aaebd 314 return 0;
screamer 18:a15bfe7aaebd 315 }
screamer 18:a15bfe7aaebd 316
screamer 18:a15bfe7aaebd 317
screamer 18:a15bfe7aaebd 318 /**
screamer 18:a15bfe7aaebd 319 * @brief Set the LPS22HB sensor output data rate when enabled
screamer 18:a15bfe7aaebd 320 * @param odr the functional output data rate to be set
screamer 18:a15bfe7aaebd 321 * @retval 0 in case of success
screamer 18:a15bfe7aaebd 322 * @retval 1 in case of failure
screamer 18:a15bfe7aaebd 323 */
screamer 18:a15bfe7aaebd 324 int LPS22HBSensor::Set_ODR_When_Enabled( float odr )
screamer 18:a15bfe7aaebd 325 {
screamer 18:a15bfe7aaebd 326 LPS22HB_Odr_et new_odr;
screamer 18:a15bfe7aaebd 327
screamer 18:a15bfe7aaebd 328 new_odr = ( odr <= 1.0f ) ? LPS22HB_ODR_1HZ
screamer 18:a15bfe7aaebd 329 : ( odr <= 10.0f ) ? LPS22HB_ODR_10HZ
screamer 18:a15bfe7aaebd 330 : ( odr <= 25.0f ) ? LPS22HB_ODR_25HZ
screamer 18:a15bfe7aaebd 331 : ( odr <= 50.0f ) ? LPS22HB_ODR_50HZ
screamer 18:a15bfe7aaebd 332 : LPS22HB_ODR_75HZ;
screamer 18:a15bfe7aaebd 333
screamer 18:a15bfe7aaebd 334 if ( LPS22HB_Set_Odr( (void *)this, new_odr ) == LPS22HB_ERROR )
screamer 18:a15bfe7aaebd 335 {
screamer 18:a15bfe7aaebd 336 return 1;
screamer 18:a15bfe7aaebd 337 }
screamer 18:a15bfe7aaebd 338
screamer 18:a15bfe7aaebd 339 if ( get_odr( &_last_odr ) == 1 )
screamer 18:a15bfe7aaebd 340 {
screamer 18:a15bfe7aaebd 341 return 1;
screamer 18:a15bfe7aaebd 342 }
screamer 18:a15bfe7aaebd 343
screamer 18:a15bfe7aaebd 344 return 0;
screamer 18:a15bfe7aaebd 345 }
screamer 18:a15bfe7aaebd 346
screamer 18:a15bfe7aaebd 347 /**
screamer 18:a15bfe7aaebd 348 * @brief Set the LPS22HB sensor output data rate when disabled
screamer 18:a15bfe7aaebd 349 * @param odr the functional output data rate to be set
screamer 18:a15bfe7aaebd 350 * @retval 0 in case of success
screamer 18:a15bfe7aaebd 351 * @retval 1 in case of failure
screamer 18:a15bfe7aaebd 352 */
screamer 18:a15bfe7aaebd 353 int LPS22HBSensor::Set_ODR_When_Disabled( float odr )
screamer 18:a15bfe7aaebd 354 {
screamer 18:a15bfe7aaebd 355 _last_odr = ( odr <= 1.0f ) ? 1.0f
screamer 18:a15bfe7aaebd 356 : ( odr <= 10.0f ) ? 10.0f
screamer 18:a15bfe7aaebd 357 : ( odr <= 25.0f ) ? 25.0f
screamer 18:a15bfe7aaebd 358 : ( odr <= 50.0f ) ? 50.0f
screamer 18:a15bfe7aaebd 359 : 75.0f;
screamer 18:a15bfe7aaebd 360
screamer 18:a15bfe7aaebd 361 return 0;
screamer 18:a15bfe7aaebd 362 }
screamer 18:a15bfe7aaebd 363
screamer 18:a15bfe7aaebd 364
screamer 18:a15bfe7aaebd 365 /**
screamer 18:a15bfe7aaebd 366 * @brief Read the data from register
screamer 18:a15bfe7aaebd 367 * @param reg register address
screamer 18:a15bfe7aaebd 368 * @param data register data
screamer 18:a15bfe7aaebd 369 * @retval 0 in case of success
screamer 18:a15bfe7aaebd 370 * @retval 1 in case of failure
screamer 18:a15bfe7aaebd 371 */
screamer 18:a15bfe7aaebd 372 int LPS22HBSensor::read_reg( uint8_t reg, uint8_t *data )
screamer 18:a15bfe7aaebd 373 {
screamer 18:a15bfe7aaebd 374
screamer 18:a15bfe7aaebd 375 if ( LPS22HB_read_reg( (void *)this, reg, 1, data ) == LPS22HB_ERROR )
screamer 18:a15bfe7aaebd 376 {
screamer 18:a15bfe7aaebd 377 return 1;
screamer 18:a15bfe7aaebd 378 }
screamer 18:a15bfe7aaebd 379
screamer 18:a15bfe7aaebd 380 return 0;
screamer 18:a15bfe7aaebd 381 }
screamer 18:a15bfe7aaebd 382
screamer 18:a15bfe7aaebd 383 /**
screamer 18:a15bfe7aaebd 384 * @brief Write the data to register
screamer 18:a15bfe7aaebd 385 * @param reg register address
screamer 18:a15bfe7aaebd 386 * @param data register data
screamer 18:a15bfe7aaebd 387 * @retval 0 in case of success
screamer 18:a15bfe7aaebd 388 * @retval 1 in case of failure
screamer 18:a15bfe7aaebd 389 */
screamer 18:a15bfe7aaebd 390 int LPS22HBSensor::write_reg( uint8_t reg, uint8_t data )
screamer 18:a15bfe7aaebd 391 {
screamer 18:a15bfe7aaebd 392
screamer 18:a15bfe7aaebd 393 if ( LPS22HB_write_reg( (void *)this, reg, 1, &data ) == LPS22HB_ERROR )
screamer 18:a15bfe7aaebd 394 {
screamer 18:a15bfe7aaebd 395 return 1;
screamer 18:a15bfe7aaebd 396 }
screamer 18:a15bfe7aaebd 397
screamer 18:a15bfe7aaebd 398 return 0;
screamer 18:a15bfe7aaebd 399 }
screamer 18:a15bfe7aaebd 400
screamer 18:a15bfe7aaebd 401
screamer 18:a15bfe7aaebd 402 uint8_t LPS22HB_io_write( void *handle, uint8_t WriteAddr, uint8_t *pBuffer, uint16_t nBytesToWrite )
screamer 18:a15bfe7aaebd 403 {
screamer 18:a15bfe7aaebd 404 return ((LPS22HBSensor *)handle)->io_write(pBuffer, WriteAddr, nBytesToWrite);
screamer 18:a15bfe7aaebd 405 }
screamer 18:a15bfe7aaebd 406
screamer 18:a15bfe7aaebd 407 uint8_t LPS22HB_io_read( void *handle, uint8_t ReadAddr, uint8_t *pBuffer, uint16_t nBytesToRead )
screamer 18:a15bfe7aaebd 408 {
screamer 18:a15bfe7aaebd 409 return ((LPS22HBSensor *)handle)->io_read(pBuffer, ReadAddr, nBytesToRead);
screamer 18:a15bfe7aaebd 410 }