Example of free fall detection for LSM6DSL in X-NUCLEO-IKS01A2

Dependencies:   X_NUCLEO_IKS01A2 mbed

Fork of FreeFall_IKS01A2 by ST Expansion SW Team

Free Fall Detection Demo Application based on sensor expansion board X-NUCLEO-IKS01A2

Main function is to show how to detect the free fall event using the sensor expansion board and send a notification using UART to a connected PC or Desktop and display it on terminal applications like TeraTerm.
After connection has been established:
- the user can try to leave falling the board and then view the notification using an hyper terminal. When the free fall is detected, the LED is switched on for a while.
- the user button can be used to enable/disable the free fall detection feature.

Committer:
cparata
Date:
Fri Aug 19 12:26:01 2016 +0000
Revision:
2:8308cb42bc49
Add interfaces to all components

Who changed what in which revision?

UserRevisionLine numberNew contents of line
cparata 2:8308cb42bc49 1 /**
cparata 2:8308cb42bc49 2 ******************************************************************************
cparata 2:8308cb42bc49 3 * @file LPS22HBSensor.cpp
cparata 2:8308cb42bc49 4 * @author AST
cparata 2:8308cb42bc49 5 * @version V1.0.0
cparata 2:8308cb42bc49 6 * @date 5 August 2016
cparata 2:8308cb42bc49 7 * @brief Implementation of an LPS22HB Pressure sensor.
cparata 2:8308cb42bc49 8 ******************************************************************************
cparata 2:8308cb42bc49 9 * @attention
cparata 2:8308cb42bc49 10 *
cparata 2:8308cb42bc49 11 * <h2><center>&copy; COPYRIGHT(c) 2016 STMicroelectronics</center></h2>
cparata 2:8308cb42bc49 12 *
cparata 2:8308cb42bc49 13 * Redistribution and use in source and binary forms, with or without modification,
cparata 2:8308cb42bc49 14 * are permitted provided that the following conditions are met:
cparata 2:8308cb42bc49 15 * 1. Redistributions of source code must retain the above copyright notice,
cparata 2:8308cb42bc49 16 * this list of conditions and the following disclaimer.
cparata 2:8308cb42bc49 17 * 2. Redistributions in binary form must reproduce the above copyright notice,
cparata 2:8308cb42bc49 18 * this list of conditions and the following disclaimer in the documentation
cparata 2:8308cb42bc49 19 * and/or other materials provided with the distribution.
cparata 2:8308cb42bc49 20 * 3. Neither the name of STMicroelectronics nor the names of its contributors
cparata 2:8308cb42bc49 21 * may be used to endorse or promote products derived from this software
cparata 2:8308cb42bc49 22 * without specific prior written permission.
cparata 2:8308cb42bc49 23 *
cparata 2:8308cb42bc49 24 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
cparata 2:8308cb42bc49 25 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
cparata 2:8308cb42bc49 26 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
cparata 2:8308cb42bc49 27 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
cparata 2:8308cb42bc49 28 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
cparata 2:8308cb42bc49 29 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
cparata 2:8308cb42bc49 30 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
cparata 2:8308cb42bc49 31 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
cparata 2:8308cb42bc49 32 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
cparata 2:8308cb42bc49 33 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
cparata 2:8308cb42bc49 34 *
cparata 2:8308cb42bc49 35 ******************************************************************************
cparata 2:8308cb42bc49 36 */
cparata 2:8308cb42bc49 37
cparata 2:8308cb42bc49 38
cparata 2:8308cb42bc49 39 /* Includes ------------------------------------------------------------------*/
cparata 2:8308cb42bc49 40
cparata 2:8308cb42bc49 41 #include "mbed.h"
cparata 2:8308cb42bc49 42 #include "DevI2C.h"
cparata 2:8308cb42bc49 43 #include "LPS22HBSensor.h"
cparata 2:8308cb42bc49 44 #include "LPS22HB_Driver.h"
cparata 2:8308cb42bc49 45
cparata 2:8308cb42bc49 46
cparata 2:8308cb42bc49 47 /* Class Implementation ------------------------------------------------------*/
cparata 2:8308cb42bc49 48
cparata 2:8308cb42bc49 49 /** Constructor
cparata 2:8308cb42bc49 50 * @param i2c object of an helper class which handles the I2C peripheral
cparata 2:8308cb42bc49 51 * @param address the address of the component's instance
cparata 2:8308cb42bc49 52 */
cparata 2:8308cb42bc49 53 LPS22HBSensor::LPS22HBSensor(DevI2C &i2c) : dev_i2c(i2c)
cparata 2:8308cb42bc49 54 {
cparata 2:8308cb42bc49 55 address = LPS22HB_ADDRESS_HIGH;
cparata 2:8308cb42bc49 56 };
cparata 2:8308cb42bc49 57
cparata 2:8308cb42bc49 58
cparata 2:8308cb42bc49 59 /** Constructor
cparata 2:8308cb42bc49 60 * @param i2c object of an helper class which handles the I2C peripheral
cparata 2:8308cb42bc49 61 * @param address the address of the component's instance
cparata 2:8308cb42bc49 62 */
cparata 2:8308cb42bc49 63 LPS22HBSensor::LPS22HBSensor(DevI2C &i2c, uint8_t address) : dev_i2c(i2c), address(address)
cparata 2:8308cb42bc49 64 {
cparata 2:8308cb42bc49 65
cparata 2:8308cb42bc49 66 };
cparata 2:8308cb42bc49 67
cparata 2:8308cb42bc49 68 /**
cparata 2:8308cb42bc49 69 * @brief Initializing the component.
cparata 2:8308cb42bc49 70 * @param[in] init pointer to device specific initalization structure.
cparata 2:8308cb42bc49 71 * @retval "0" in case of success, an error code otherwise.
cparata 2:8308cb42bc49 72 */
cparata 2:8308cb42bc49 73 int LPS22HBSensor::Init(void *init)
cparata 2:8308cb42bc49 74 {
cparata 2:8308cb42bc49 75 if ( LPS22HB_Set_PowerMode( (void *)this, LPS22HB_LowPower) == LPS22HB_ERROR )
cparata 2:8308cb42bc49 76 {
cparata 2:8308cb42bc49 77 return 1;
cparata 2:8308cb42bc49 78 }
cparata 2:8308cb42bc49 79
cparata 2:8308cb42bc49 80 /* Power down the device */
cparata 2:8308cb42bc49 81 if ( LPS22HB_Set_Odr( (void *)this, LPS22HB_ODR_ONE_SHOT ) == LPS22HB_ERROR )
cparata 2:8308cb42bc49 82 {
cparata 2:8308cb42bc49 83 return 1;
cparata 2:8308cb42bc49 84 }
cparata 2:8308cb42bc49 85
cparata 2:8308cb42bc49 86 /* Disable low-pass filter on LPS22HB pressure data */
cparata 2:8308cb42bc49 87 if( LPS22HB_Set_LowPassFilter( (void *)this, LPS22HB_DISABLE) == LPS22HB_ERROR )
cparata 2:8308cb42bc49 88 {
cparata 2:8308cb42bc49 89 return 1;
cparata 2:8308cb42bc49 90 }
cparata 2:8308cb42bc49 91
cparata 2:8308cb42bc49 92 /* Set low-pass filter cutoff configuration*/
cparata 2:8308cb42bc49 93 if( LPS22HB_Set_LowPassFilterCutoff( (void *)this, LPS22HB_ODR_9) == LPS22HB_ERROR )
cparata 2:8308cb42bc49 94 {
cparata 2:8308cb42bc49 95 return 1;
cparata 2:8308cb42bc49 96 }
cparata 2:8308cb42bc49 97
cparata 2:8308cb42bc49 98 /* Set block data update mode */
cparata 2:8308cb42bc49 99 if ( LPS22HB_Set_Bdu( (void *)this, LPS22HB_BDU_NO_UPDATE ) == LPS22HB_ERROR )
cparata 2:8308cb42bc49 100 {
cparata 2:8308cb42bc49 101 return 1;
cparata 2:8308cb42bc49 102 }
cparata 2:8308cb42bc49 103
cparata 2:8308cb42bc49 104 /* Set automatic increment for multi-byte read/write */
cparata 2:8308cb42bc49 105 if( LPS22HB_Set_AutomaticIncrementRegAddress( (void *)this, LPS22HB_ENABLE) == LPS22HB_ERROR )
cparata 2:8308cb42bc49 106 {
cparata 2:8308cb42bc49 107 return 1;
cparata 2:8308cb42bc49 108 }
cparata 2:8308cb42bc49 109
cparata 2:8308cb42bc49 110 isEnabled = 0;
cparata 2:8308cb42bc49 111 Last_ODR = 25.0f;
cparata 2:8308cb42bc49 112
cparata 2:8308cb42bc49 113 return 0;
cparata 2:8308cb42bc49 114 }
cparata 2:8308cb42bc49 115
cparata 2:8308cb42bc49 116
cparata 2:8308cb42bc49 117 /**
cparata 2:8308cb42bc49 118 * @brief Enable LPS22HB
cparata 2:8308cb42bc49 119 * @retval 0 in case of success, an error code otherwise
cparata 2:8308cb42bc49 120 */
cparata 2:8308cb42bc49 121 int LPS22HBSensor::Enable(void)
cparata 2:8308cb42bc49 122 {
cparata 2:8308cb42bc49 123 /* Check if the component is already enabled */
cparata 2:8308cb42bc49 124 if ( isEnabled == 1 )
cparata 2:8308cb42bc49 125 {
cparata 2:8308cb42bc49 126 return 0;
cparata 2:8308cb42bc49 127 }
cparata 2:8308cb42bc49 128
cparata 2:8308cb42bc49 129 if(Set_ODR_When_Enabled(Last_ODR) == 1)
cparata 2:8308cb42bc49 130 {
cparata 2:8308cb42bc49 131 return 1;
cparata 2:8308cb42bc49 132 }
cparata 2:8308cb42bc49 133
cparata 2:8308cb42bc49 134 isEnabled = 1;
cparata 2:8308cb42bc49 135
cparata 2:8308cb42bc49 136 return 0;
cparata 2:8308cb42bc49 137 }
cparata 2:8308cb42bc49 138
cparata 2:8308cb42bc49 139 /**
cparata 2:8308cb42bc49 140 * @brief Disable LPS22HB
cparata 2:8308cb42bc49 141 * @retval 0 in case of success, an error code otherwise
cparata 2:8308cb42bc49 142 */
cparata 2:8308cb42bc49 143 int LPS22HBSensor::Disable(void)
cparata 2:8308cb42bc49 144 {
cparata 2:8308cb42bc49 145 /* Check if the component is already disabled */
cparata 2:8308cb42bc49 146 if ( isEnabled == 0 )
cparata 2:8308cb42bc49 147 {
cparata 2:8308cb42bc49 148 return 0;
cparata 2:8308cb42bc49 149 }
cparata 2:8308cb42bc49 150
cparata 2:8308cb42bc49 151 /* Power down the device */
cparata 2:8308cb42bc49 152 if ( LPS22HB_Set_Odr( (void *)this, LPS22HB_ODR_ONE_SHOT ) == LPS22HB_ERROR )
cparata 2:8308cb42bc49 153 {
cparata 2:8308cb42bc49 154 return 1;
cparata 2:8308cb42bc49 155 }
cparata 2:8308cb42bc49 156
cparata 2:8308cb42bc49 157 isEnabled = 0;
cparata 2:8308cb42bc49 158
cparata 2:8308cb42bc49 159 return 0;
cparata 2:8308cb42bc49 160 }
cparata 2:8308cb42bc49 161
cparata 2:8308cb42bc49 162 /**
cparata 2:8308cb42bc49 163 * @brief Read ID address of LPS22HB
cparata 2:8308cb42bc49 164 * @param id the pointer where the ID of the device is stored
cparata 2:8308cb42bc49 165 * @retval 0 in case of success, an error code otherwise
cparata 2:8308cb42bc49 166 */
cparata 2:8308cb42bc49 167 int LPS22HBSensor::ReadID(uint8_t *id)
cparata 2:8308cb42bc49 168 {
cparata 2:8308cb42bc49 169 if(!id)
cparata 2:8308cb42bc49 170 {
cparata 2:8308cb42bc49 171 return 1;
cparata 2:8308cb42bc49 172 }
cparata 2:8308cb42bc49 173
cparata 2:8308cb42bc49 174 /* Read WHO AM I register */
cparata 2:8308cb42bc49 175 if ( LPS22HB_Get_DeviceID( (void *)this, id ) == LPS22HB_ERROR )
cparata 2:8308cb42bc49 176 {
cparata 2:8308cb42bc49 177 return 1;
cparata 2:8308cb42bc49 178 }
cparata 2:8308cb42bc49 179
cparata 2:8308cb42bc49 180 return 0;
cparata 2:8308cb42bc49 181 }
cparata 2:8308cb42bc49 182
cparata 2:8308cb42bc49 183 /**
cparata 2:8308cb42bc49 184 * @brief Reboot memory content of LPS22HB
cparata 2:8308cb42bc49 185 * @param None
cparata 2:8308cb42bc49 186 * @retval 0 in case of success, an error code otherwise
cparata 2:8308cb42bc49 187 */
cparata 2:8308cb42bc49 188 int LPS22HBSensor::Reset(void)
cparata 2:8308cb42bc49 189 {
cparata 2:8308cb42bc49 190 /* Read WHO AM I register */
cparata 2:8308cb42bc49 191 if ( LPS22HB_MemoryBoot((void *)this) == LPS22HB_ERROR )
cparata 2:8308cb42bc49 192 {
cparata 2:8308cb42bc49 193 return 1;
cparata 2:8308cb42bc49 194 }
cparata 2:8308cb42bc49 195
cparata 2:8308cb42bc49 196 return 0;
cparata 2:8308cb42bc49 197 }
cparata 2:8308cb42bc49 198
cparata 2:8308cb42bc49 199 /**
cparata 2:8308cb42bc49 200 * @brief Read LPS22HB output register, and calculate the pressure in mbar
cparata 2:8308cb42bc49 201 * @param pfData the pressure value in mbar
cparata 2:8308cb42bc49 202 * @retval 0 in case of success, an error code otherwise
cparata 2:8308cb42bc49 203 */
cparata 2:8308cb42bc49 204 int LPS22HBSensor::GetPressure(float* pfData)
cparata 2:8308cb42bc49 205 {
cparata 2:8308cb42bc49 206 int32_t int32data = 0;
cparata 2:8308cb42bc49 207
cparata 2:8308cb42bc49 208 /* Read data from LPS22HB. */
cparata 2:8308cb42bc49 209 if ( LPS22HB_Get_Pressure( (void *)this, &int32data ) == LPS22HB_ERROR )
cparata 2:8308cb42bc49 210 {
cparata 2:8308cb42bc49 211 return 1;
cparata 2:8308cb42bc49 212 }
cparata 2:8308cb42bc49 213
cparata 2:8308cb42bc49 214 *pfData = ( float )int32data / 100.0f;
cparata 2:8308cb42bc49 215
cparata 2:8308cb42bc49 216 return 0;
cparata 2:8308cb42bc49 217 }
cparata 2:8308cb42bc49 218
cparata 2:8308cb42bc49 219 /**
cparata 2:8308cb42bc49 220 * @brief Read LPS22HB output register, and calculate the temperature
cparata 2:8308cb42bc49 221 * @param pfData the temperature value
cparata 2:8308cb42bc49 222 * @retval 0 in case of success, an error code otherwise
cparata 2:8308cb42bc49 223 */
cparata 2:8308cb42bc49 224 int LPS22HBSensor::GetTemperature(float *pfData)
cparata 2:8308cb42bc49 225 {
cparata 2:8308cb42bc49 226 int16_t int16data = 0;
cparata 2:8308cb42bc49 227
cparata 2:8308cb42bc49 228 /* Read data from LPS22HB. */
cparata 2:8308cb42bc49 229 if ( LPS22HB_Get_Temperature( (void *)this, &int16data ) == LPS22HB_ERROR )
cparata 2:8308cb42bc49 230 {
cparata 2:8308cb42bc49 231 return 1;
cparata 2:8308cb42bc49 232 }
cparata 2:8308cb42bc49 233
cparata 2:8308cb42bc49 234 *pfData = ( float )int16data / 10.0f;
cparata 2:8308cb42bc49 235
cparata 2:8308cb42bc49 236 return 0;
cparata 2:8308cb42bc49 237 }
cparata 2:8308cb42bc49 238
cparata 2:8308cb42bc49 239 /**
cparata 2:8308cb42bc49 240 * @brief Read LPS22HB output data rate
cparata 2:8308cb42bc49 241 * @param odr the pointer to the output data rate
cparata 2:8308cb42bc49 242 * @retval 0 in case of success, an error code otherwise
cparata 2:8308cb42bc49 243 */
cparata 2:8308cb42bc49 244 int LPS22HBSensor::Get_ODR(float* odr)
cparata 2:8308cb42bc49 245 {
cparata 2:8308cb42bc49 246 LPS22HB_Odr_et odr_low_level;
cparata 2:8308cb42bc49 247
cparata 2:8308cb42bc49 248 if ( LPS22HB_Get_Odr( (void *)this, &odr_low_level ) == LPS22HB_ERROR )
cparata 2:8308cb42bc49 249 {
cparata 2:8308cb42bc49 250 return 1;
cparata 2:8308cb42bc49 251 }
cparata 2:8308cb42bc49 252
cparata 2:8308cb42bc49 253 switch( odr_low_level )
cparata 2:8308cb42bc49 254 {
cparata 2:8308cb42bc49 255 case LPS22HB_ODR_ONE_SHOT:
cparata 2:8308cb42bc49 256 *odr = 0.0f;
cparata 2:8308cb42bc49 257 break;
cparata 2:8308cb42bc49 258 case LPS22HB_ODR_1HZ:
cparata 2:8308cb42bc49 259 *odr = 1.0f;
cparata 2:8308cb42bc49 260 break;
cparata 2:8308cb42bc49 261 case LPS22HB_ODR_10HZ:
cparata 2:8308cb42bc49 262 *odr = 10.0f;
cparata 2:8308cb42bc49 263 break;
cparata 2:8308cb42bc49 264 case LPS22HB_ODR_25HZ:
cparata 2:8308cb42bc49 265 *odr = 25.0f;
cparata 2:8308cb42bc49 266 break;
cparata 2:8308cb42bc49 267 case LPS22HB_ODR_50HZ:
cparata 2:8308cb42bc49 268 *odr = 50.0f;
cparata 2:8308cb42bc49 269 break;
cparata 2:8308cb42bc49 270 case LPS22HB_ODR_75HZ:
cparata 2:8308cb42bc49 271 *odr = 75.0f;
cparata 2:8308cb42bc49 272 break;
cparata 2:8308cb42bc49 273 default:
cparata 2:8308cb42bc49 274 *odr = -1.0f;
cparata 2:8308cb42bc49 275 return 1;
cparata 2:8308cb42bc49 276 }
cparata 2:8308cb42bc49 277
cparata 2:8308cb42bc49 278 return 0;
cparata 2:8308cb42bc49 279 }
cparata 2:8308cb42bc49 280
cparata 2:8308cb42bc49 281 /**
cparata 2:8308cb42bc49 282 * @brief Set ODR
cparata 2:8308cb42bc49 283 * @param odr the output data rate to be set
cparata 2:8308cb42bc49 284 * @retval 0 in case of success, an error code otherwise
cparata 2:8308cb42bc49 285 */
cparata 2:8308cb42bc49 286 int LPS22HBSensor::Set_ODR(float odr)
cparata 2:8308cb42bc49 287 {
cparata 2:8308cb42bc49 288 if(isEnabled == 1)
cparata 2:8308cb42bc49 289 {
cparata 2:8308cb42bc49 290 if(Set_ODR_When_Enabled(odr) == 1)
cparata 2:8308cb42bc49 291 {
cparata 2:8308cb42bc49 292 return 1;
cparata 2:8308cb42bc49 293 }
cparata 2:8308cb42bc49 294 }
cparata 2:8308cb42bc49 295 else
cparata 2:8308cb42bc49 296 {
cparata 2:8308cb42bc49 297 if(Set_ODR_When_Disabled(odr) == 1)
cparata 2:8308cb42bc49 298 {
cparata 2:8308cb42bc49 299 return 1;
cparata 2:8308cb42bc49 300 }
cparata 2:8308cb42bc49 301 }
cparata 2:8308cb42bc49 302
cparata 2:8308cb42bc49 303 return 0;
cparata 2:8308cb42bc49 304 }
cparata 2:8308cb42bc49 305
cparata 2:8308cb42bc49 306
cparata 2:8308cb42bc49 307 /**
cparata 2:8308cb42bc49 308 * @brief Set the LPS22HB sensor output data rate when enabled
cparata 2:8308cb42bc49 309 * @param odr the functional output data rate to be set
cparata 2:8308cb42bc49 310 * @retval 0 in case of success
cparata 2:8308cb42bc49 311 * @retval 1 in case of failure
cparata 2:8308cb42bc49 312 */
cparata 2:8308cb42bc49 313 int LPS22HBSensor::Set_ODR_When_Enabled( float odr )
cparata 2:8308cb42bc49 314 {
cparata 2:8308cb42bc49 315 LPS22HB_Odr_et new_odr;
cparata 2:8308cb42bc49 316
cparata 2:8308cb42bc49 317 new_odr = ( odr <= 1.0f ) ? LPS22HB_ODR_1HZ
cparata 2:8308cb42bc49 318 : ( odr <= 10.0f ) ? LPS22HB_ODR_10HZ
cparata 2:8308cb42bc49 319 : ( odr <= 25.0f ) ? LPS22HB_ODR_25HZ
cparata 2:8308cb42bc49 320 : ( odr <= 50.0f ) ? LPS22HB_ODR_50HZ
cparata 2:8308cb42bc49 321 : LPS22HB_ODR_75HZ;
cparata 2:8308cb42bc49 322
cparata 2:8308cb42bc49 323 if ( LPS22HB_Set_Odr( (void *)this, new_odr ) == LPS22HB_ERROR )
cparata 2:8308cb42bc49 324 {
cparata 2:8308cb42bc49 325 return 1;
cparata 2:8308cb42bc49 326 }
cparata 2:8308cb42bc49 327
cparata 2:8308cb42bc49 328 if ( Get_ODR( &Last_ODR ) == 1 )
cparata 2:8308cb42bc49 329 {
cparata 2:8308cb42bc49 330 return 1;
cparata 2:8308cb42bc49 331 }
cparata 2:8308cb42bc49 332
cparata 2:8308cb42bc49 333 return 0;
cparata 2:8308cb42bc49 334 }
cparata 2:8308cb42bc49 335
cparata 2:8308cb42bc49 336 /**
cparata 2:8308cb42bc49 337 * @brief Set the LPS22HB sensor output data rate when disabled
cparata 2:8308cb42bc49 338 * @param odr the functional output data rate to be set
cparata 2:8308cb42bc49 339 * @retval 0 in case of success
cparata 2:8308cb42bc49 340 * @retval 1 in case of failure
cparata 2:8308cb42bc49 341 */
cparata 2:8308cb42bc49 342 int LPS22HBSensor::Set_ODR_When_Disabled( float odr )
cparata 2:8308cb42bc49 343 {
cparata 2:8308cb42bc49 344 Last_ODR = ( odr <= 1.0f ) ? 1.0f
cparata 2:8308cb42bc49 345 : ( odr <= 10.0f ) ? 10.0f
cparata 2:8308cb42bc49 346 : ( odr <= 25.0f ) ? 25.0f
cparata 2:8308cb42bc49 347 : ( odr <= 50.0f ) ? 50.0f
cparata 2:8308cb42bc49 348 : 75.0f;
cparata 2:8308cb42bc49 349
cparata 2:8308cb42bc49 350 return 0;
cparata 2:8308cb42bc49 351 }
cparata 2:8308cb42bc49 352
cparata 2:8308cb42bc49 353
cparata 2:8308cb42bc49 354 /**
cparata 2:8308cb42bc49 355 * @brief Read the data from register
cparata 2:8308cb42bc49 356 * @param reg register address
cparata 2:8308cb42bc49 357 * @param data register data
cparata 2:8308cb42bc49 358 * @retval 0 in case of success
cparata 2:8308cb42bc49 359 * @retval 1 in case of failure
cparata 2:8308cb42bc49 360 */
cparata 2:8308cb42bc49 361 int LPS22HBSensor::ReadReg( uint8_t reg, uint8_t *data )
cparata 2:8308cb42bc49 362 {
cparata 2:8308cb42bc49 363
cparata 2:8308cb42bc49 364 if ( LPS22HB_ReadReg( (void *)this, reg, 1, data ) == LPS22HB_ERROR )
cparata 2:8308cb42bc49 365 {
cparata 2:8308cb42bc49 366 return 1;
cparata 2:8308cb42bc49 367 }
cparata 2:8308cb42bc49 368
cparata 2:8308cb42bc49 369 return 0;
cparata 2:8308cb42bc49 370 }
cparata 2:8308cb42bc49 371
cparata 2:8308cb42bc49 372 /**
cparata 2:8308cb42bc49 373 * @brief Write the data to register
cparata 2:8308cb42bc49 374 * @param reg register address
cparata 2:8308cb42bc49 375 * @param data register data
cparata 2:8308cb42bc49 376 * @retval 0 in case of success
cparata 2:8308cb42bc49 377 * @retval 1 in case of failure
cparata 2:8308cb42bc49 378 */
cparata 2:8308cb42bc49 379 int LPS22HBSensor::WriteReg( uint8_t reg, uint8_t data )
cparata 2:8308cb42bc49 380 {
cparata 2:8308cb42bc49 381
cparata 2:8308cb42bc49 382 if ( LPS22HB_WriteReg( (void *)this, reg, 1, &data ) == LPS22HB_ERROR )
cparata 2:8308cb42bc49 383 {
cparata 2:8308cb42bc49 384 return 1;
cparata 2:8308cb42bc49 385 }
cparata 2:8308cb42bc49 386
cparata 2:8308cb42bc49 387 return 0;
cparata 2:8308cb42bc49 388 }
cparata 2:8308cb42bc49 389
cparata 2:8308cb42bc49 390
cparata 2:8308cb42bc49 391 uint8_t LPS22HB_IO_Write( void *handle, uint8_t WriteAddr, uint8_t *pBuffer, uint16_t nBytesToWrite )
cparata 2:8308cb42bc49 392 {
cparata 2:8308cb42bc49 393 return ((LPS22HBSensor *)handle)->IO_Write(pBuffer, WriteAddr, nBytesToWrite);
cparata 2:8308cb42bc49 394 }
cparata 2:8308cb42bc49 395
cparata 2:8308cb42bc49 396 uint8_t LPS22HB_IO_Read( void *handle, uint8_t ReadAddr, uint8_t *pBuffer, uint16_t nBytesToRead )
cparata 2:8308cb42bc49 397 {
cparata 2:8308cb42bc49 398 return ((LPS22HBSensor *)handle)->IO_Read(pBuffer, ReadAddr, nBytesToRead);
cparata 2:8308cb42bc49 399 }