ST / Mbed 2 deprecated 6DOrientation_IKS01A2

Example of 6D orientation recognition for LSM6DSL in X-NUCLEO-IKS01A2

Dependencies:   X_NUCLEO_IKS01A2 mbed

Fork of 6DOrientation_IKS01A2 by ST Expansion SW Team

6D Orientation Demo Application based on sensor expansion board X-NUCLEO-IKS01A2

Main function is to show how to use sensor expansion board to find out the 6D orientation and send data using UART to a connected PC or Desktop and display it on terminal applications like TeraTerm.
After connection has been established:
- the user can rotate the board to change the 6D orientation and then view the data using an hyper terminal.
- the user button can be used to display the current 6D orientation.

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

Committer:
cparata
Date:
Fri Aug 19 12:23:23 2016 +0000
Revision:
2:ae74845fa96a
Add interfaces to all components

Who changed what in which revision?

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