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