Jim Carver / Mbed OS pelion-workshop

Workshop example

Dependencies:   X_NUCLEO_COMMON ST_INTERFACES

sensors/LPS22HB/LPS22HBSensor.cpp@35:42b3fba640b1, 2019-05-21 (annotated)

Committer:
JimCarver
Date:
Tue May 21 21:16:24 2019 +0000
Revision:
35:42b3fba640b1
Parent:
18:a15bfe7aaebd 
Simple version for workshop

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 }