Example of single tap and double tap detection for LSM6DSL in X-NUCLEO-IKS01A2

Dependencies:   X_NUCLEO_IKS01A2 mbed

Fork of SingleDoubleTap_IKS01A2 by ST Expansion SW Team

Single and Double Tap Demo Application based on sensor expansion board X-NUCLEO-IKS01A2

Main function is to show how to detect the single and double tap events 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 tap the board and then view the notification using an hyper terminal. When the single tap is detected, the LED is switched on for a while.
- the user can press the user button to pass from the single tap detection to the double tap detection feature. The user can try to double tap the board and then view the notification using an hyper terminal. When the double tap is detected, the LED is switched on twice for a while.
- the user can press again the user button to disable the single and double tap detection feature.
- the user can press the user button to enable again the single tap detection feature and so on.

Committer:
cparata
Date:
Fri Aug 12 13:42:02 2016 +0000
Revision:
0:e4f89df7a7a5
First release of Single/Double Tap for LSM6DSL in IKS01A2

Who changed what in which revision?

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