
Mbed OS and Pelion Device Management example over WIFI for DISCO_L475VG_IOT01 board
Dependencies: X_NUCLEO_COMMON ST_INTERFACES
DEPRECATED
This example application is not maintained and not recommended. It uses an old version of Mbed OS, Pelion DM and Arm toolchain. It doesn't work with Mbed Studio.
Please use: https://os.mbed.com/teams/mbed-os-examples/code/mbed-os-example-pelion/
This example is known to work on the following platforms:
- DISCO_L475E_IOT01A over WiFI and using onboard QSPI flash.
Follow the Quick-Start instructions: https://cloud.mbed.com/quick-start
Example functionality
This example showcases the following device functionality:
- Read onboard temperature and humidity sensors, and report them as Pelion LWM2M resources (see image below).
- On user button click, increment Pelion LWM2M button resource.
- Allow the user to change the state of the board LED from Pelion LWM2M led_state resource and PUT request.
- Uses all onboard sensors and reports them as Pelion LWM2M resources.
Use this example with Mbed CLI
1. Import the application into your desktop:
mbed import https://os.mbed.com/teams/ST/code/pelion-example-disco-iot01 cd pelion-example-disco-iot01
2. Install the CLOUD_SDK_API_KEY
mbed config -G CLOUD_SDK_API_KEY <PELION_DM_API_KEY>
For instructions on how to generate your API key, please see the documentation.
3. Initialize firmware credentials (done once per repository). You can use the following command:
mbed dm init -d "<your company name in Pelion DM>" --model-name "<product model identifier>" -q --force
If above command do not work for your Mbed CLI, please consider upgrading Mbed CLI to version 1.8.x or above.
4. Compile and program:
mbed compile -t <toolchain> -m DISCO_L475VG_IOT01A
(supported toolchains : GCC_ARM / ARM / IAR)
5. You can connect on a virtual terminal/COM port to the platform using:
mbed sterm -b 115200
This should give you an output similar to:
[BOOT] Mbed Bootloader [BOOT] ARM: 00000000000000000000 [BOOT] OEM: 00000000000000000000 [BOOT] Layout: 0 80096F4 [BOOT] Active firmware integrity check: [BOOT] SHA256: 0660E360D432225D5251461998FD8617B017098C5F1F90D5FB607BF8C27ED530 [BOOT] Version: 1553615309 [BOOT] Slot 0 is empty [BOOT] Active firmware up-to-date [BOOT] Application's start address: 0x8010400 [BOOT] Application's jump address: 0x8011041 [BOOT] Application's stack address: 0x20018000 [BOOT] Forwarding to application... Starting Simple Pelion Device Management Client example You can hold the user button during boot to format the storage and change the device identity. Sensors configuration: Invalid new address! HTS221 humidity & temperature = 0xBC LPS22HB pressure & temperature = 0xB1 LIS3MDL magnetometer = 0x3D LSM6DSL accelerometer & gyroscope = 0x6A Connecting to the network using Wifi... Connected to the network successfully. IP address: 192.168.1.3 Initializing Pelion Device Management Client... Initialized Pelion Client. Registering... Registered to Pelion Device Management. Endpoint Name: 0169********************001002d5 ADC temp: 23.0037 C, vref: 0.3661 V HTS221 temp: 28.700 C, humidity: 31.90 % LPS22HB temp: 29.600 C, pressure: 1032.01 mbar LIS3MDL mag: 0.217 x, -0.284 y, -0.053 z [gauss] LSM6DSL acc: 0.005 x, -0.014 y, 1.029 z [g] LSM6DSL gyro: 0.910 x, -0.910 y, 1.120 z [dps] VL53L0X dist: 1855 mm
sensors/LPS22HB/LPS22HBSensor.cpp@36:aaf44d2a6c33, 2020-03-13 (annotated)
- Committer:
- chris
- Date:
- Fri Mar 13 13:18:07 2020 +0000
- Revision:
- 36:aaf44d2a6c33
- Parent:
- 18:a15bfe7aaebd
First revision
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
screamer | 18:a15bfe7aaebd | 1 | /** |
screamer | 18:a15bfe7aaebd | 2 | ****************************************************************************** |
screamer | 18:a15bfe7aaebd | 3 | * @file LPS22HBSensor.cpp |
screamer | 18:a15bfe7aaebd | 4 | * @author CLab |
screamer | 18:a15bfe7aaebd | 5 | * @version V1.0.0 |
screamer | 18:a15bfe7aaebd | 6 | * @date 5 August 2016 |
screamer | 18:a15bfe7aaebd | 7 | * @brief Implementation of an LPS22HB Pressure sensor. |
screamer | 18:a15bfe7aaebd | 8 | ****************************************************************************** |
screamer | 18:a15bfe7aaebd | 9 | * @attention |
screamer | 18:a15bfe7aaebd | 10 | * |
screamer | 18:a15bfe7aaebd | 11 | * <h2><center>© COPYRIGHT(c) 2016 STMicroelectronics</center></h2> |
screamer | 18:a15bfe7aaebd | 12 | * |
screamer | 18:a15bfe7aaebd | 13 | * Redistribution and use in source and binary forms, with or without modification, |
screamer | 18:a15bfe7aaebd | 14 | * are permitted provided that the following conditions are met: |
screamer | 18:a15bfe7aaebd | 15 | * 1. Redistributions of source code must retain the above copyright notice, |
screamer | 18:a15bfe7aaebd | 16 | * this list of conditions and the following disclaimer. |
screamer | 18:a15bfe7aaebd | 17 | * 2. Redistributions in binary form must reproduce the above copyright notice, |
screamer | 18:a15bfe7aaebd | 18 | * this list of conditions and the following disclaimer in the documentation |
screamer | 18:a15bfe7aaebd | 19 | * and/or other materials provided with the distribution. |
screamer | 18:a15bfe7aaebd | 20 | * 3. Neither the name of STMicroelectronics nor the names of its contributors |
screamer | 18:a15bfe7aaebd | 21 | * may be used to endorse or promote products derived from this software |
screamer | 18:a15bfe7aaebd | 22 | * without specific prior written permission. |
screamer | 18:a15bfe7aaebd | 23 | * |
screamer | 18:a15bfe7aaebd | 24 | * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" |
screamer | 18:a15bfe7aaebd | 25 | * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
screamer | 18:a15bfe7aaebd | 26 | * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE |
screamer | 18:a15bfe7aaebd | 27 | * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE |
screamer | 18:a15bfe7aaebd | 28 | * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL |
screamer | 18:a15bfe7aaebd | 29 | * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR |
screamer | 18:a15bfe7aaebd | 30 | * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER |
screamer | 18:a15bfe7aaebd | 31 | * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, |
screamer | 18:a15bfe7aaebd | 32 | * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE |
screamer | 18:a15bfe7aaebd | 33 | * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
screamer | 18:a15bfe7aaebd | 34 | * |
screamer | 18:a15bfe7aaebd | 35 | ****************************************************************************** |
screamer | 18:a15bfe7aaebd | 36 | */ |
screamer | 18:a15bfe7aaebd | 37 | |
screamer | 18:a15bfe7aaebd | 38 | |
screamer | 18:a15bfe7aaebd | 39 | /* Includes ------------------------------------------------------------------*/ |
screamer | 18:a15bfe7aaebd | 40 | |
screamer | 18:a15bfe7aaebd | 41 | |
screamer | 18:a15bfe7aaebd | 42 | #include "LPS22HBSensor.h" |
screamer | 18:a15bfe7aaebd | 43 | |
screamer | 18:a15bfe7aaebd | 44 | |
screamer | 18:a15bfe7aaebd | 45 | /* Class Implementation ------------------------------------------------------*/ |
screamer | 18:a15bfe7aaebd | 46 | |
screamer | 18:a15bfe7aaebd | 47 | LPS22HBSensor::LPS22HBSensor(SPI *spi, PinName cs_pin, PinName int_pin, SPI_type_t spi_type) : _dev_spi(spi), _cs_pin(cs_pin), _int_pin(int_pin), _spi_type(spi_type) |
screamer | 18:a15bfe7aaebd | 48 | { |
screamer | 18:a15bfe7aaebd | 49 | assert (spi); |
screamer | 18:a15bfe7aaebd | 50 | if (cs_pin == NC) |
screamer | 18:a15bfe7aaebd | 51 | { |
screamer | 18:a15bfe7aaebd | 52 | printf ("ERROR LPS22HBSensor CS MUST NOT BE NC\n\r"); |
screamer | 18:a15bfe7aaebd | 53 | _dev_spi = NULL; |
screamer | 18:a15bfe7aaebd | 54 | _dev_i2c=NULL; |
screamer | 18:a15bfe7aaebd | 55 | return; |
screamer | 18:a15bfe7aaebd | 56 | } |
screamer | 18:a15bfe7aaebd | 57 | |
screamer | 18:a15bfe7aaebd | 58 | _cs_pin = 1; |
screamer | 18:a15bfe7aaebd | 59 | _dev_i2c=NULL; |
screamer | 18:a15bfe7aaebd | 60 | |
screamer | 18:a15bfe7aaebd | 61 | if (_spi_type == SPI3W) LPS22HB_Set_SpiInterface ((void *)this, LPS22HB_SPI_3_WIRE); |
screamer | 18:a15bfe7aaebd | 62 | else if (_spi_type == SPI4W) LPS22HB_Set_SpiInterface ((void *)this, LPS22HB_SPI_4_WIRE); |
screamer | 18:a15bfe7aaebd | 63 | |
screamer | 18:a15bfe7aaebd | 64 | LPS22HB_Set_I2C ((void *)this, LPS22HB_DISABLE); |
screamer | 18:a15bfe7aaebd | 65 | } |
screamer | 18:a15bfe7aaebd | 66 | |
screamer | 18:a15bfe7aaebd | 67 | /** Constructor |
screamer | 18:a15bfe7aaebd | 68 | * @param i2c object of an helper class which handles the I2C peripheral |
screamer | 18:a15bfe7aaebd | 69 | * @param address the address of the component's instance |
screamer | 18:a15bfe7aaebd | 70 | */ |
screamer | 18:a15bfe7aaebd | 71 | LPS22HBSensor::LPS22HBSensor(DevI2C *i2c, uint8_t address, PinName int_pin) : |
screamer | 18:a15bfe7aaebd | 72 | _dev_i2c(i2c), _address(address), _cs_pin(NC), _int_pin(int_pin) |
screamer | 18:a15bfe7aaebd | 73 | { |
screamer | 18:a15bfe7aaebd | 74 | assert (i2c); |
screamer | 18:a15bfe7aaebd | 75 | _dev_spi = NULL; |
screamer | 18:a15bfe7aaebd | 76 | LPS22HB_Set_I2C ((void *)this, LPS22HB_ENABLE); |
screamer | 18:a15bfe7aaebd | 77 | }; |
screamer | 18:a15bfe7aaebd | 78 | |
screamer | 18:a15bfe7aaebd | 79 | /** |
screamer | 18:a15bfe7aaebd | 80 | * @brief Initializing the component. |
screamer | 18:a15bfe7aaebd | 81 | * @param[in] init pointer to device specific initalization structure. |
screamer | 18:a15bfe7aaebd | 82 | * @retval "0" in case of success, an error code otherwise. |
screamer | 18:a15bfe7aaebd | 83 | */ |
screamer | 18:a15bfe7aaebd | 84 | int LPS22HBSensor::init(void *init) |
screamer | 18:a15bfe7aaebd | 85 | { |
screamer | 18:a15bfe7aaebd | 86 | if ( LPS22HB_Set_PowerMode( (void *)this, LPS22HB_LowPower) == LPS22HB_ERROR ) |
screamer | 18:a15bfe7aaebd | 87 | { |
screamer | 18:a15bfe7aaebd | 88 | return 1; |
screamer | 18:a15bfe7aaebd | 89 | } |
screamer | 18:a15bfe7aaebd | 90 | |
screamer | 18:a15bfe7aaebd | 91 | /* Power down the device */ |
screamer | 18:a15bfe7aaebd | 92 | if ( LPS22HB_Set_Odr( (void *)this, LPS22HB_ODR_ONE_SHOT ) == LPS22HB_ERROR ) |
screamer | 18:a15bfe7aaebd | 93 | { |
screamer | 18:a15bfe7aaebd | 94 | return 1; |
screamer | 18:a15bfe7aaebd | 95 | } |
screamer | 18:a15bfe7aaebd | 96 | |
screamer | 18:a15bfe7aaebd | 97 | /* Disable low-pass filter on LPS22HB pressure data */ |
screamer | 18:a15bfe7aaebd | 98 | if( LPS22HB_Set_LowPassFilter( (void *)this, LPS22HB_DISABLE) == LPS22HB_ERROR ) |
screamer | 18:a15bfe7aaebd | 99 | { |
screamer | 18:a15bfe7aaebd | 100 | return 1; |
screamer | 18:a15bfe7aaebd | 101 | } |
screamer | 18:a15bfe7aaebd | 102 | |
screamer | 18:a15bfe7aaebd | 103 | /* Set low-pass filter cutoff configuration*/ |
screamer | 18:a15bfe7aaebd | 104 | if( LPS22HB_Set_LowPassFilterCutoff( (void *)this, LPS22HB_ODR_9) == LPS22HB_ERROR ) |
screamer | 18:a15bfe7aaebd | 105 | { |
screamer | 18:a15bfe7aaebd | 106 | return 1; |
screamer | 18:a15bfe7aaebd | 107 | } |
screamer | 18:a15bfe7aaebd | 108 | |
screamer | 18:a15bfe7aaebd | 109 | /* Set block data update mode */ |
screamer | 18:a15bfe7aaebd | 110 | if ( LPS22HB_Set_Bdu( (void *)this, LPS22HB_BDU_NO_UPDATE ) == LPS22HB_ERROR ) |
screamer | 18:a15bfe7aaebd | 111 | { |
screamer | 18:a15bfe7aaebd | 112 | return 1; |
screamer | 18:a15bfe7aaebd | 113 | } |
screamer | 18:a15bfe7aaebd | 114 | |
screamer | 18:a15bfe7aaebd | 115 | /* Set automatic increment for multi-byte read/write */ |
screamer | 18:a15bfe7aaebd | 116 | if( LPS22HB_Set_AutomaticIncrementRegAddress( (void *)this, LPS22HB_ENABLE) == LPS22HB_ERROR ) |
screamer | 18:a15bfe7aaebd | 117 | { |
screamer | 18:a15bfe7aaebd | 118 | return 1; |
screamer | 18:a15bfe7aaebd | 119 | } |
screamer | 18:a15bfe7aaebd | 120 | |
screamer | 18:a15bfe7aaebd | 121 | _is_enabled = 0; |
screamer | 18:a15bfe7aaebd | 122 | _last_odr = 25.0f; |
screamer | 18:a15bfe7aaebd | 123 | |
screamer | 18:a15bfe7aaebd | 124 | return 0; |
screamer | 18:a15bfe7aaebd | 125 | } |
screamer | 18:a15bfe7aaebd | 126 | |
screamer | 18:a15bfe7aaebd | 127 | |
screamer | 18:a15bfe7aaebd | 128 | /** |
screamer | 18:a15bfe7aaebd | 129 | * @brief Enable LPS22HB |
screamer | 18:a15bfe7aaebd | 130 | * @retval 0 in case of success, an error code otherwise |
screamer | 18:a15bfe7aaebd | 131 | */ |
screamer | 18:a15bfe7aaebd | 132 | int LPS22HBSensor::enable(void) |
screamer | 18:a15bfe7aaebd | 133 | { |
screamer | 18:a15bfe7aaebd | 134 | /* Check if the component is already enabled */ |
screamer | 18:a15bfe7aaebd | 135 | if ( _is_enabled == 1 ) |
screamer | 18:a15bfe7aaebd | 136 | { |
screamer | 18:a15bfe7aaebd | 137 | return 0; |
screamer | 18:a15bfe7aaebd | 138 | } |
screamer | 18:a15bfe7aaebd | 139 | |
screamer | 18:a15bfe7aaebd | 140 | if(Set_ODR_When_Enabled(_last_odr) == 1) |
screamer | 18:a15bfe7aaebd | 141 | { |
screamer | 18:a15bfe7aaebd | 142 | return 1; |
screamer | 18:a15bfe7aaebd | 143 | } |
screamer | 18:a15bfe7aaebd | 144 | |
screamer | 18:a15bfe7aaebd | 145 | _is_enabled = 1; |
screamer | 18:a15bfe7aaebd | 146 | |
screamer | 18:a15bfe7aaebd | 147 | return 0; |
screamer | 18:a15bfe7aaebd | 148 | } |
screamer | 18:a15bfe7aaebd | 149 | |
screamer | 18:a15bfe7aaebd | 150 | /** |
screamer | 18:a15bfe7aaebd | 151 | * @brief Disable LPS22HB |
screamer | 18:a15bfe7aaebd | 152 | * @retval 0 in case of success, an error code otherwise |
screamer | 18:a15bfe7aaebd | 153 | */ |
screamer | 18:a15bfe7aaebd | 154 | int LPS22HBSensor::disable(void) |
screamer | 18:a15bfe7aaebd | 155 | { |
screamer | 18:a15bfe7aaebd | 156 | /* Check if the component is already disabled */ |
screamer | 18:a15bfe7aaebd | 157 | if ( _is_enabled == 0 ) |
screamer | 18:a15bfe7aaebd | 158 | { |
screamer | 18:a15bfe7aaebd | 159 | return 0; |
screamer | 18:a15bfe7aaebd | 160 | } |
screamer | 18:a15bfe7aaebd | 161 | |
screamer | 18:a15bfe7aaebd | 162 | /* Power down the device */ |
screamer | 18:a15bfe7aaebd | 163 | if ( LPS22HB_Set_Odr( (void *)this, LPS22HB_ODR_ONE_SHOT ) == LPS22HB_ERROR ) |
screamer | 18:a15bfe7aaebd | 164 | { |
screamer | 18:a15bfe7aaebd | 165 | return 1; |
screamer | 18:a15bfe7aaebd | 166 | } |
screamer | 18:a15bfe7aaebd | 167 | |
screamer | 18:a15bfe7aaebd | 168 | _is_enabled = 0; |
screamer | 18:a15bfe7aaebd | 169 | |
screamer | 18:a15bfe7aaebd | 170 | return 0; |
screamer | 18:a15bfe7aaebd | 171 | } |
screamer | 18:a15bfe7aaebd | 172 | |
screamer | 18:a15bfe7aaebd | 173 | /** |
screamer | 18:a15bfe7aaebd | 174 | * @brief Read ID address of LPS22HB |
screamer | 18:a15bfe7aaebd | 175 | * @param id the pointer where the ID of the device is stored |
screamer | 18:a15bfe7aaebd | 176 | * @retval 0 in case of success, an error code otherwise |
screamer | 18:a15bfe7aaebd | 177 | */ |
screamer | 18:a15bfe7aaebd | 178 | int LPS22HBSensor::read_id(uint8_t *id) |
screamer | 18:a15bfe7aaebd | 179 | { |
screamer | 18:a15bfe7aaebd | 180 | if(!id) |
screamer | 18:a15bfe7aaebd | 181 | { |
screamer | 18:a15bfe7aaebd | 182 | return 1; |
screamer | 18:a15bfe7aaebd | 183 | } |
screamer | 18:a15bfe7aaebd | 184 | |
screamer | 18:a15bfe7aaebd | 185 | /* Read WHO AM I register */ |
screamer | 18:a15bfe7aaebd | 186 | if ( LPS22HB_Get_DeviceID( (void *)this, id ) == LPS22HB_ERROR ) |
screamer | 18:a15bfe7aaebd | 187 | { |
screamer | 18:a15bfe7aaebd | 188 | return 1; |
screamer | 18:a15bfe7aaebd | 189 | } |
screamer | 18:a15bfe7aaebd | 190 | |
screamer | 18:a15bfe7aaebd | 191 | return 0; |
screamer | 18:a15bfe7aaebd | 192 | } |
screamer | 18:a15bfe7aaebd | 193 | |
screamer | 18:a15bfe7aaebd | 194 | /** |
screamer | 18:a15bfe7aaebd | 195 | * @brief Reboot memory content of LPS22HB |
screamer | 18:a15bfe7aaebd | 196 | * @param None |
screamer | 18:a15bfe7aaebd | 197 | * @retval 0 in case of success, an error code otherwise |
screamer | 18:a15bfe7aaebd | 198 | */ |
screamer | 18:a15bfe7aaebd | 199 | int LPS22HBSensor::reset(void) |
screamer | 18:a15bfe7aaebd | 200 | { |
screamer | 18:a15bfe7aaebd | 201 | /* Read WHO AM I register */ |
screamer | 18:a15bfe7aaebd | 202 | if ( LPS22HB_MemoryBoot((void *)this) == LPS22HB_ERROR ) |
screamer | 18:a15bfe7aaebd | 203 | { |
screamer | 18:a15bfe7aaebd | 204 | return 1; |
screamer | 18:a15bfe7aaebd | 205 | } |
screamer | 18:a15bfe7aaebd | 206 | |
screamer | 18:a15bfe7aaebd | 207 | return 0; |
screamer | 18:a15bfe7aaebd | 208 | } |
screamer | 18:a15bfe7aaebd | 209 | |
screamer | 18:a15bfe7aaebd | 210 | /** |
screamer | 18:a15bfe7aaebd | 211 | * @brief Read LPS22HB output register, and calculate the pressure in mbar |
screamer | 18:a15bfe7aaebd | 212 | * @param pfData the pressure value in mbar |
screamer | 18:a15bfe7aaebd | 213 | * @retval 0 in case of success, an error code otherwise |
screamer | 18:a15bfe7aaebd | 214 | */ |
screamer | 18:a15bfe7aaebd | 215 | int LPS22HBSensor::get_pressure(float* pfData) |
screamer | 18:a15bfe7aaebd | 216 | { |
screamer | 18:a15bfe7aaebd | 217 | int32_t int32data = 0; |
screamer | 18:a15bfe7aaebd | 218 | |
screamer | 18:a15bfe7aaebd | 219 | /* Read data from LPS22HB. */ |
screamer | 18:a15bfe7aaebd | 220 | if ( LPS22HB_Get_Pressure( (void *)this, &int32data ) == LPS22HB_ERROR ) |
screamer | 18:a15bfe7aaebd | 221 | { |
screamer | 18:a15bfe7aaebd | 222 | return 1; |
screamer | 18:a15bfe7aaebd | 223 | } |
screamer | 18:a15bfe7aaebd | 224 | |
screamer | 18:a15bfe7aaebd | 225 | *pfData = ( float )int32data / 100.0f; |
screamer | 18:a15bfe7aaebd | 226 | |
screamer | 18:a15bfe7aaebd | 227 | return 0; |
screamer | 18:a15bfe7aaebd | 228 | } |
screamer | 18:a15bfe7aaebd | 229 | |
screamer | 18:a15bfe7aaebd | 230 | /** |
screamer | 18:a15bfe7aaebd | 231 | * @brief Read LPS22HB output register, and calculate the temperature |
screamer | 18:a15bfe7aaebd | 232 | * @param pfData the temperature value |
screamer | 18:a15bfe7aaebd | 233 | * @retval 0 in case of success, an error code otherwise |
screamer | 18:a15bfe7aaebd | 234 | */ |
screamer | 18:a15bfe7aaebd | 235 | int LPS22HBSensor::get_temperature(float *pfData) |
screamer | 18:a15bfe7aaebd | 236 | { |
screamer | 18:a15bfe7aaebd | 237 | int16_t int16data = 0; |
screamer | 18:a15bfe7aaebd | 238 | |
screamer | 18:a15bfe7aaebd | 239 | /* Read data from LPS22HB. */ |
screamer | 18:a15bfe7aaebd | 240 | if ( LPS22HB_Get_Temperature( (void *)this, &int16data ) == LPS22HB_ERROR ) |
screamer | 18:a15bfe7aaebd | 241 | { |
screamer | 18:a15bfe7aaebd | 242 | return 1; |
screamer | 18:a15bfe7aaebd | 243 | } |
screamer | 18:a15bfe7aaebd | 244 | |
screamer | 18:a15bfe7aaebd | 245 | *pfData = ( float )int16data / 10.0f; |
screamer | 18:a15bfe7aaebd | 246 | |
screamer | 18:a15bfe7aaebd | 247 | return 0; |
screamer | 18:a15bfe7aaebd | 248 | } |
screamer | 18:a15bfe7aaebd | 249 | |
screamer | 18:a15bfe7aaebd | 250 | /** |
screamer | 18:a15bfe7aaebd | 251 | * @brief Read LPS22HB output data rate |
screamer | 18:a15bfe7aaebd | 252 | * @param odr the pointer to the output data rate |
screamer | 18:a15bfe7aaebd | 253 | * @retval 0 in case of success, an error code otherwise |
screamer | 18:a15bfe7aaebd | 254 | */ |
screamer | 18:a15bfe7aaebd | 255 | int LPS22HBSensor::get_odr(float* odr) |
screamer | 18:a15bfe7aaebd | 256 | { |
screamer | 18:a15bfe7aaebd | 257 | LPS22HB_Odr_et odr_low_level; |
screamer | 18:a15bfe7aaebd | 258 | |
screamer | 18:a15bfe7aaebd | 259 | if ( LPS22HB_Get_Odr( (void *)this, &odr_low_level ) == LPS22HB_ERROR ) |
screamer | 18:a15bfe7aaebd | 260 | { |
screamer | 18:a15bfe7aaebd | 261 | return 1; |
screamer | 18:a15bfe7aaebd | 262 | } |
screamer | 18:a15bfe7aaebd | 263 | |
screamer | 18:a15bfe7aaebd | 264 | switch( odr_low_level ) |
screamer | 18:a15bfe7aaebd | 265 | { |
screamer | 18:a15bfe7aaebd | 266 | case LPS22HB_ODR_ONE_SHOT: |
screamer | 18:a15bfe7aaebd | 267 | *odr = 0.0f; |
screamer | 18:a15bfe7aaebd | 268 | break; |
screamer | 18:a15bfe7aaebd | 269 | case LPS22HB_ODR_1HZ: |
screamer | 18:a15bfe7aaebd | 270 | *odr = 1.0f; |
screamer | 18:a15bfe7aaebd | 271 | break; |
screamer | 18:a15bfe7aaebd | 272 | case LPS22HB_ODR_10HZ: |
screamer | 18:a15bfe7aaebd | 273 | *odr = 10.0f; |
screamer | 18:a15bfe7aaebd | 274 | break; |
screamer | 18:a15bfe7aaebd | 275 | case LPS22HB_ODR_25HZ: |
screamer | 18:a15bfe7aaebd | 276 | *odr = 25.0f; |
screamer | 18:a15bfe7aaebd | 277 | break; |
screamer | 18:a15bfe7aaebd | 278 | case LPS22HB_ODR_50HZ: |
screamer | 18:a15bfe7aaebd | 279 | *odr = 50.0f; |
screamer | 18:a15bfe7aaebd | 280 | break; |
screamer | 18:a15bfe7aaebd | 281 | case LPS22HB_ODR_75HZ: |
screamer | 18:a15bfe7aaebd | 282 | *odr = 75.0f; |
screamer | 18:a15bfe7aaebd | 283 | break; |
screamer | 18:a15bfe7aaebd | 284 | default: |
screamer | 18:a15bfe7aaebd | 285 | *odr = -1.0f; |
screamer | 18:a15bfe7aaebd | 286 | return 1; |
screamer | 18:a15bfe7aaebd | 287 | } |
screamer | 18:a15bfe7aaebd | 288 | |
screamer | 18:a15bfe7aaebd | 289 | return 0; |
screamer | 18:a15bfe7aaebd | 290 | } |
screamer | 18:a15bfe7aaebd | 291 | |
screamer | 18:a15bfe7aaebd | 292 | /** |
screamer | 18:a15bfe7aaebd | 293 | * @brief Set ODR |
screamer | 18:a15bfe7aaebd | 294 | * @param odr the output data rate to be set |
screamer | 18:a15bfe7aaebd | 295 | * @retval 0 in case of success, an error code otherwise |
screamer | 18:a15bfe7aaebd | 296 | */ |
screamer | 18:a15bfe7aaebd | 297 | int LPS22HBSensor::set_odr(float odr) |
screamer | 18:a15bfe7aaebd | 298 | { |
screamer | 18:a15bfe7aaebd | 299 | if(_is_enabled == 1) |
screamer | 18:a15bfe7aaebd | 300 | { |
screamer | 18:a15bfe7aaebd | 301 | if(Set_ODR_When_Enabled(odr) == 1) |
screamer | 18:a15bfe7aaebd | 302 | { |
screamer | 18:a15bfe7aaebd | 303 | return 1; |
screamer | 18:a15bfe7aaebd | 304 | } |
screamer | 18:a15bfe7aaebd | 305 | } |
screamer | 18:a15bfe7aaebd | 306 | else |
screamer | 18:a15bfe7aaebd | 307 | { |
screamer | 18:a15bfe7aaebd | 308 | if(Set_ODR_When_Disabled(odr) == 1) |
screamer | 18:a15bfe7aaebd | 309 | { |
screamer | 18:a15bfe7aaebd | 310 | return 1; |
screamer | 18:a15bfe7aaebd | 311 | } |
screamer | 18:a15bfe7aaebd | 312 | } |
screamer | 18:a15bfe7aaebd | 313 | |
screamer | 18:a15bfe7aaebd | 314 | return 0; |
screamer | 18:a15bfe7aaebd | 315 | } |
screamer | 18:a15bfe7aaebd | 316 | |
screamer | 18:a15bfe7aaebd | 317 | |
screamer | 18:a15bfe7aaebd | 318 | /** |
screamer | 18:a15bfe7aaebd | 319 | * @brief Set the LPS22HB sensor output data rate when enabled |
screamer | 18:a15bfe7aaebd | 320 | * @param odr the functional output data rate to be set |
screamer | 18:a15bfe7aaebd | 321 | * @retval 0 in case of success |
screamer | 18:a15bfe7aaebd | 322 | * @retval 1 in case of failure |
screamer | 18:a15bfe7aaebd | 323 | */ |
screamer | 18:a15bfe7aaebd | 324 | int LPS22HBSensor::Set_ODR_When_Enabled( float odr ) |
screamer | 18:a15bfe7aaebd | 325 | { |
screamer | 18:a15bfe7aaebd | 326 | LPS22HB_Odr_et new_odr; |
screamer | 18:a15bfe7aaebd | 327 | |
screamer | 18:a15bfe7aaebd | 328 | new_odr = ( odr <= 1.0f ) ? LPS22HB_ODR_1HZ |
screamer | 18:a15bfe7aaebd | 329 | : ( odr <= 10.0f ) ? LPS22HB_ODR_10HZ |
screamer | 18:a15bfe7aaebd | 330 | : ( odr <= 25.0f ) ? LPS22HB_ODR_25HZ |
screamer | 18:a15bfe7aaebd | 331 | : ( odr <= 50.0f ) ? LPS22HB_ODR_50HZ |
screamer | 18:a15bfe7aaebd | 332 | : LPS22HB_ODR_75HZ; |
screamer | 18:a15bfe7aaebd | 333 | |
screamer | 18:a15bfe7aaebd | 334 | if ( LPS22HB_Set_Odr( (void *)this, new_odr ) == LPS22HB_ERROR ) |
screamer | 18:a15bfe7aaebd | 335 | { |
screamer | 18:a15bfe7aaebd | 336 | return 1; |
screamer | 18:a15bfe7aaebd | 337 | } |
screamer | 18:a15bfe7aaebd | 338 | |
screamer | 18:a15bfe7aaebd | 339 | if ( get_odr( &_last_odr ) == 1 ) |
screamer | 18:a15bfe7aaebd | 340 | { |
screamer | 18:a15bfe7aaebd | 341 | return 1; |
screamer | 18:a15bfe7aaebd | 342 | } |
screamer | 18:a15bfe7aaebd | 343 | |
screamer | 18:a15bfe7aaebd | 344 | return 0; |
screamer | 18:a15bfe7aaebd | 345 | } |
screamer | 18:a15bfe7aaebd | 346 | |
screamer | 18:a15bfe7aaebd | 347 | /** |
screamer | 18:a15bfe7aaebd | 348 | * @brief Set the LPS22HB sensor output data rate when disabled |
screamer | 18:a15bfe7aaebd | 349 | * @param odr the functional output data rate to be set |
screamer | 18:a15bfe7aaebd | 350 | * @retval 0 in case of success |
screamer | 18:a15bfe7aaebd | 351 | * @retval 1 in case of failure |
screamer | 18:a15bfe7aaebd | 352 | */ |
screamer | 18:a15bfe7aaebd | 353 | int LPS22HBSensor::Set_ODR_When_Disabled( float odr ) |
screamer | 18:a15bfe7aaebd | 354 | { |
screamer | 18:a15bfe7aaebd | 355 | _last_odr = ( odr <= 1.0f ) ? 1.0f |
screamer | 18:a15bfe7aaebd | 356 | : ( odr <= 10.0f ) ? 10.0f |
screamer | 18:a15bfe7aaebd | 357 | : ( odr <= 25.0f ) ? 25.0f |
screamer | 18:a15bfe7aaebd | 358 | : ( odr <= 50.0f ) ? 50.0f |
screamer | 18:a15bfe7aaebd | 359 | : 75.0f; |
screamer | 18:a15bfe7aaebd | 360 | |
screamer | 18:a15bfe7aaebd | 361 | return 0; |
screamer | 18:a15bfe7aaebd | 362 | } |
screamer | 18:a15bfe7aaebd | 363 | |
screamer | 18:a15bfe7aaebd | 364 | |
screamer | 18:a15bfe7aaebd | 365 | /** |
screamer | 18:a15bfe7aaebd | 366 | * @brief Read the data from register |
screamer | 18:a15bfe7aaebd | 367 | * @param reg register address |
screamer | 18:a15bfe7aaebd | 368 | * @param data register data |
screamer | 18:a15bfe7aaebd | 369 | * @retval 0 in case of success |
screamer | 18:a15bfe7aaebd | 370 | * @retval 1 in case of failure |
screamer | 18:a15bfe7aaebd | 371 | */ |
screamer | 18:a15bfe7aaebd | 372 | int LPS22HBSensor::read_reg( uint8_t reg, uint8_t *data ) |
screamer | 18:a15bfe7aaebd | 373 | { |
screamer | 18:a15bfe7aaebd | 374 | |
screamer | 18:a15bfe7aaebd | 375 | if ( LPS22HB_read_reg( (void *)this, reg, 1, data ) == LPS22HB_ERROR ) |
screamer | 18:a15bfe7aaebd | 376 | { |
screamer | 18:a15bfe7aaebd | 377 | return 1; |
screamer | 18:a15bfe7aaebd | 378 | } |
screamer | 18:a15bfe7aaebd | 379 | |
screamer | 18:a15bfe7aaebd | 380 | return 0; |
screamer | 18:a15bfe7aaebd | 381 | } |
screamer | 18:a15bfe7aaebd | 382 | |
screamer | 18:a15bfe7aaebd | 383 | /** |
screamer | 18:a15bfe7aaebd | 384 | * @brief Write the data to register |
screamer | 18:a15bfe7aaebd | 385 | * @param reg register address |
screamer | 18:a15bfe7aaebd | 386 | * @param data register data |
screamer | 18:a15bfe7aaebd | 387 | * @retval 0 in case of success |
screamer | 18:a15bfe7aaebd | 388 | * @retval 1 in case of failure |
screamer | 18:a15bfe7aaebd | 389 | */ |
screamer | 18:a15bfe7aaebd | 390 | int LPS22HBSensor::write_reg( uint8_t reg, uint8_t data ) |
screamer | 18:a15bfe7aaebd | 391 | { |
screamer | 18:a15bfe7aaebd | 392 | |
screamer | 18:a15bfe7aaebd | 393 | if ( LPS22HB_write_reg( (void *)this, reg, 1, &data ) == LPS22HB_ERROR ) |
screamer | 18:a15bfe7aaebd | 394 | { |
screamer | 18:a15bfe7aaebd | 395 | return 1; |
screamer | 18:a15bfe7aaebd | 396 | } |
screamer | 18:a15bfe7aaebd | 397 | |
screamer | 18:a15bfe7aaebd | 398 | return 0; |
screamer | 18:a15bfe7aaebd | 399 | } |
screamer | 18:a15bfe7aaebd | 400 | |
screamer | 18:a15bfe7aaebd | 401 | |
screamer | 18:a15bfe7aaebd | 402 | uint8_t LPS22HB_io_write( void *handle, uint8_t WriteAddr, uint8_t *pBuffer, uint16_t nBytesToWrite ) |
screamer | 18:a15bfe7aaebd | 403 | { |
screamer | 18:a15bfe7aaebd | 404 | return ((LPS22HBSensor *)handle)->io_write(pBuffer, WriteAddr, nBytesToWrite); |
screamer | 18:a15bfe7aaebd | 405 | } |
screamer | 18:a15bfe7aaebd | 406 | |
screamer | 18:a15bfe7aaebd | 407 | uint8_t LPS22HB_io_read( void *handle, uint8_t ReadAddr, uint8_t *pBuffer, uint16_t nBytesToRead ) |
screamer | 18:a15bfe7aaebd | 408 | { |
screamer | 18:a15bfe7aaebd | 409 | return ((LPS22HBSensor *)handle)->io_read(pBuffer, ReadAddr, nBytesToRead); |
screamer | 18:a15bfe7aaebd | 410 | } |