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

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.

/media/uploads/screamer/pelion_st_humidity_reading.png?v=2

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
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?

UserRevisionLine numberNew 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>&copy; 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 }