ST / Mbed 2 deprecated Pedometer_IKS01A2

Example of pedometer for LSM6DSL in X-NUCLEO-IKS01A2

Dependencies:   X_NUCLEO_IKS01A2 mbed

Fork of Pedometer_IKS01A2 by ST Expansion SW Team

Pedometer Demo Application based on sensor expansion board X-NUCLEO-IKS01A2

Main function is to show how to count steps 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 shake the board to simulate the steps and then view the notification using an hyper terminal. When a new step is detected, the LED is switched on for a while.
- the user button can be used to reset the step counter.

X_NUCLEO_IKS01A2/Components/LPS22HBSensor/LPS22HBSensor.cpp@2:67af0ad3ea2e, 2016-08-19 (annotated)

Committer:
cparata
Date:
Fri Aug 19 12:29:08 2016 +0000
Revision:
2:67af0ad3ea2e
Add interfaces to all components

Who changed what in which revision?

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