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

X-NUCLEO-IKS01A2 Motion MEMS and Environmental Sensor