Example of pedometer for LSM6DSL in X-NUCLEO-IKS01A2

Dependencies:   X_NUCLEO_IKS01A2 mbed

Fork of Pedometer_IKS01A2 by ST Expansion SW Team

Pedometer Demo Application based on sensor expansion board X-NUCLEO-IKS01A2

Main function is to show how to count steps 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 shake the board to simulate the steps and then view the notification using an hyper terminal. When a new step is detected, the LED is switched on for a while.
- the user button can be used to reset the step counter.

Committer:
cparata
Date:
Fri Aug 12 13:41:14 2016 +0000
Revision:
0:b189540a70e2
First release of Pedometer for LSM6DSL in IKS01A2

Who changed what in which revision?

UserRevisionLine numberNew contents of line
cparata 0:b189540a70e2 1 /**
cparata 0:b189540a70e2 2 ******************************************************************************
cparata 0:b189540a70e2 3 * @file HTS221Sensor.cpp
cparata 0:b189540a70e2 4 * @author AST
cparata 0:b189540a70e2 5 * @version V1.0.0
cparata 0:b189540a70e2 6 * @date 5 August 2016
cparata 0:b189540a70e2 7 * @brief Implementation of an HTS221 Humidity and Temperature sensor.
cparata 0:b189540a70e2 8 ******************************************************************************
cparata 0:b189540a70e2 9 * @attention
cparata 0:b189540a70e2 10 *
cparata 0:b189540a70e2 11 * <h2><center>&copy; COPYRIGHT(c) 2016 STMicroelectronics</center></h2>
cparata 0:b189540a70e2 12 *
cparata 0:b189540a70e2 13 * Redistribution and use in source and binary forms, with or without modification,
cparata 0:b189540a70e2 14 * are permitted provided that the following conditions are met:
cparata 0:b189540a70e2 15 * 1. Redistributions of source code must retain the above copyright notice,
cparata 0:b189540a70e2 16 * this list of conditions and the following disclaimer.
cparata 0:b189540a70e2 17 * 2. Redistributions in binary form must reproduce the above copyright notice,
cparata 0:b189540a70e2 18 * this list of conditions and the following disclaimer in the documentation
cparata 0:b189540a70e2 19 * and/or other materials provided with the distribution.
cparata 0:b189540a70e2 20 * 3. Neither the name of STMicroelectronics nor the names of its contributors
cparata 0:b189540a70e2 21 * may be used to endorse or promote products derived from this software
cparata 0:b189540a70e2 22 * without specific prior written permission.
cparata 0:b189540a70e2 23 *
cparata 0:b189540a70e2 24 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
cparata 0:b189540a70e2 25 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
cparata 0:b189540a70e2 26 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
cparata 0:b189540a70e2 27 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
cparata 0:b189540a70e2 28 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
cparata 0:b189540a70e2 29 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
cparata 0:b189540a70e2 30 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
cparata 0:b189540a70e2 31 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
cparata 0:b189540a70e2 32 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
cparata 0:b189540a70e2 33 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
cparata 0:b189540a70e2 34 *
cparata 0:b189540a70e2 35 ******************************************************************************
cparata 0:b189540a70e2 36 */
cparata 0:b189540a70e2 37
cparata 0:b189540a70e2 38
cparata 0:b189540a70e2 39 /* Includes ------------------------------------------------------------------*/
cparata 0:b189540a70e2 40
cparata 0:b189540a70e2 41 #include "mbed.h"
cparata 0:b189540a70e2 42 #include "DevI2C.h"
cparata 0:b189540a70e2 43 #include "HTS221Sensor.h"
cparata 0:b189540a70e2 44 #include "HTS221_Driver.h"
cparata 0:b189540a70e2 45
cparata 0:b189540a70e2 46
cparata 0:b189540a70e2 47 /* Class Implementation ------------------------------------------------------*/
cparata 0:b189540a70e2 48
cparata 0:b189540a70e2 49 /** Constructor
cparata 0:b189540a70e2 50 * @param i2c object of an helper class which handles the I2C peripheral
cparata 0:b189540a70e2 51 * @param address the address of the component's instance
cparata 0:b189540a70e2 52 */
cparata 0:b189540a70e2 53 HTS221Sensor::HTS221Sensor(DevI2C &i2c) : dev_i2c(i2c)
cparata 0:b189540a70e2 54 {
cparata 0:b189540a70e2 55 address = HTS221_I2C_ADDRESS;
cparata 0:b189540a70e2 56
cparata 0:b189540a70e2 57 /* Power down the device */
cparata 0:b189540a70e2 58 if ( HTS221_DeActivate( (void *)this ) == HTS221_ERROR )
cparata 0:b189540a70e2 59 {
cparata 0:b189540a70e2 60 return;
cparata 0:b189540a70e2 61 }
cparata 0:b189540a70e2 62
cparata 0:b189540a70e2 63 /* Enable BDU */
cparata 0:b189540a70e2 64 if ( HTS221_Set_BduMode( (void *)this, HTS221_ENABLE ) == HTS221_ERROR )
cparata 0:b189540a70e2 65 {
cparata 0:b189540a70e2 66 return;
cparata 0:b189540a70e2 67 }
cparata 0:b189540a70e2 68
cparata 0:b189540a70e2 69 if(SetODR(1.0f) == HTS221_STATUS_ERROR)
cparata 0:b189540a70e2 70 {
cparata 0:b189540a70e2 71 return;
cparata 0:b189540a70e2 72 }
cparata 0:b189540a70e2 73 };
cparata 0:b189540a70e2 74
cparata 0:b189540a70e2 75
cparata 0:b189540a70e2 76 /** Constructor
cparata 0:b189540a70e2 77 * @param i2c object of an helper class which handles the I2C peripheral
cparata 0:b189540a70e2 78 * @param address the address of the component's instance
cparata 0:b189540a70e2 79 */
cparata 0:b189540a70e2 80 HTS221Sensor::HTS221Sensor(DevI2C &i2c, uint8_t address) : dev_i2c(i2c), address(address)
cparata 0:b189540a70e2 81 {
cparata 0:b189540a70e2 82 /* Power down the device */
cparata 0:b189540a70e2 83 if ( HTS221_DeActivate( (void *)this ) == HTS221_ERROR )
cparata 0:b189540a70e2 84 {
cparata 0:b189540a70e2 85 return;
cparata 0:b189540a70e2 86 }
cparata 0:b189540a70e2 87
cparata 0:b189540a70e2 88 /* Enable BDU */
cparata 0:b189540a70e2 89 if ( HTS221_Set_BduMode( (void *)this, HTS221_ENABLE ) == HTS221_ERROR )
cparata 0:b189540a70e2 90 {
cparata 0:b189540a70e2 91 return;
cparata 0:b189540a70e2 92 }
cparata 0:b189540a70e2 93
cparata 0:b189540a70e2 94 if(SetODR(1.0f) == HTS221_STATUS_ERROR)
cparata 0:b189540a70e2 95 {
cparata 0:b189540a70e2 96 return;
cparata 0:b189540a70e2 97 }
cparata 0:b189540a70e2 98 };
cparata 0:b189540a70e2 99
cparata 0:b189540a70e2 100 /**
cparata 0:b189540a70e2 101 * @brief Enable HTS221
cparata 0:b189540a70e2 102 * @retval HTS221_STATUS_OK in case of success, an error code otherwise
cparata 0:b189540a70e2 103 */
cparata 0:b189540a70e2 104 HTS221StatusTypeDef HTS221Sensor::Enable(void)
cparata 0:b189540a70e2 105 {
cparata 0:b189540a70e2 106 /* Power up the device */
cparata 0:b189540a70e2 107 if ( HTS221_Activate( (void *)this ) == HTS221_ERROR )
cparata 0:b189540a70e2 108 {
cparata 0:b189540a70e2 109 return HTS221_STATUS_ERROR;
cparata 0:b189540a70e2 110 }
cparata 0:b189540a70e2 111
cparata 0:b189540a70e2 112 return HTS221_STATUS_OK;
cparata 0:b189540a70e2 113 }
cparata 0:b189540a70e2 114
cparata 0:b189540a70e2 115 /**
cparata 0:b189540a70e2 116 * @brief Disable HTS221
cparata 0:b189540a70e2 117 * @retval HTS221_STATUS_OK in case of success, an error code otherwise
cparata 0:b189540a70e2 118 */
cparata 0:b189540a70e2 119 HTS221StatusTypeDef HTS221Sensor::Disable(void)
cparata 0:b189540a70e2 120 {
cparata 0:b189540a70e2 121 /* Power up the device */
cparata 0:b189540a70e2 122 if ( HTS221_DeActivate( (void *)this ) == HTS221_ERROR )
cparata 0:b189540a70e2 123 {
cparata 0:b189540a70e2 124 return HTS221_STATUS_ERROR;
cparata 0:b189540a70e2 125 }
cparata 0:b189540a70e2 126
cparata 0:b189540a70e2 127 return HTS221_STATUS_OK;
cparata 0:b189540a70e2 128 }
cparata 0:b189540a70e2 129
cparata 0:b189540a70e2 130 /**
cparata 0:b189540a70e2 131 * @brief Read ID address of HTS221
cparata 0:b189540a70e2 132 * @param ht_id the pointer where the ID of the device is stored
cparata 0:b189540a70e2 133 * @retval HTS221_STATUS_OK in case of success, an error code otherwise
cparata 0:b189540a70e2 134 */
cparata 0:b189540a70e2 135 HTS221StatusTypeDef HTS221Sensor::ReadID(uint8_t *ht_id)
cparata 0:b189540a70e2 136 {
cparata 0:b189540a70e2 137 /* Read WHO AM I register */
cparata 0:b189540a70e2 138 if ( HTS221_Get_DeviceID( (void *)this, ht_id ) == HTS221_ERROR )
cparata 0:b189540a70e2 139 {
cparata 0:b189540a70e2 140 return HTS221_STATUS_ERROR;
cparata 0:b189540a70e2 141 }
cparata 0:b189540a70e2 142
cparata 0:b189540a70e2 143 return HTS221_STATUS_OK;
cparata 0:b189540a70e2 144 }
cparata 0:b189540a70e2 145
cparata 0:b189540a70e2 146 /**
cparata 0:b189540a70e2 147 * @brief Reboot memory content of HTS221
cparata 0:b189540a70e2 148 * @param None
cparata 0:b189540a70e2 149 * @retval HTS221_STATUS_OK in case of success, an error code otherwise
cparata 0:b189540a70e2 150 */
cparata 0:b189540a70e2 151 HTS221StatusTypeDef HTS221Sensor::Reset(void)
cparata 0:b189540a70e2 152 {
cparata 0:b189540a70e2 153 uint8_t tmpreg;
cparata 0:b189540a70e2 154
cparata 0:b189540a70e2 155 /* Read CTRL_REG2 register */
cparata 0:b189540a70e2 156 if (ReadReg(HTS221_CTRL_REG2, &tmpreg) != HTS221_STATUS_OK)
cparata 0:b189540a70e2 157 {
cparata 0:b189540a70e2 158 return HTS221_STATUS_ERROR;
cparata 0:b189540a70e2 159 }
cparata 0:b189540a70e2 160
cparata 0:b189540a70e2 161 /* Enable or Disable the reboot memory */
cparata 0:b189540a70e2 162 tmpreg |= (0x01 << HTS221_BOOT_BIT);
cparata 0:b189540a70e2 163
cparata 0:b189540a70e2 164 /* Write value to MEMS CTRL_REG2 regsister */
cparata 0:b189540a70e2 165 if (WriteReg(HTS221_CTRL_REG2, tmpreg) != HTS221_STATUS_OK)
cparata 0:b189540a70e2 166 {
cparata 0:b189540a70e2 167 return HTS221_STATUS_ERROR;
cparata 0:b189540a70e2 168 }
cparata 0:b189540a70e2 169
cparata 0:b189540a70e2 170 return HTS221_STATUS_OK;
cparata 0:b189540a70e2 171 }
cparata 0:b189540a70e2 172
cparata 0:b189540a70e2 173 /**
cparata 0:b189540a70e2 174 * @brief Read HTS221 output register, and calculate the humidity
cparata 0:b189540a70e2 175 * @param pfData the pointer to data output
cparata 0:b189540a70e2 176 * @retval HTS221_STATUS_OK in case of success, an error code otherwise
cparata 0:b189540a70e2 177 */
cparata 0:b189540a70e2 178 HTS221StatusTypeDef HTS221Sensor::GetHumidity(float* pfData)
cparata 0:b189540a70e2 179 {
cparata 0:b189540a70e2 180 uint16_t uint16data = 0;
cparata 0:b189540a70e2 181
cparata 0:b189540a70e2 182 /* Read data from HTS221. */
cparata 0:b189540a70e2 183 if ( HTS221_Get_Humidity( (void *)this, &uint16data ) == HTS221_ERROR )
cparata 0:b189540a70e2 184 {
cparata 0:b189540a70e2 185 return HTS221_STATUS_ERROR;
cparata 0:b189540a70e2 186 }
cparata 0:b189540a70e2 187
cparata 0:b189540a70e2 188 *pfData = ( float )uint16data / 10.0f;
cparata 0:b189540a70e2 189
cparata 0:b189540a70e2 190 return HTS221_STATUS_OK;
cparata 0:b189540a70e2 191 }
cparata 0:b189540a70e2 192
cparata 0:b189540a70e2 193 /**
cparata 0:b189540a70e2 194 * @brief Read HTS221 output register, and calculate the temperature
cparata 0:b189540a70e2 195 * @param pfData the pointer to data output
cparata 0:b189540a70e2 196 * @retval HTS221_STATUS_OK in case of success, an error code otherwise
cparata 0:b189540a70e2 197 */
cparata 0:b189540a70e2 198 HTS221StatusTypeDef HTS221Sensor::GetTemperature(float* pfData)
cparata 0:b189540a70e2 199 {
cparata 0:b189540a70e2 200 int16_t int16data = 0;
cparata 0:b189540a70e2 201
cparata 0:b189540a70e2 202 /* Read data from HTS221. */
cparata 0:b189540a70e2 203 if ( HTS221_Get_Temperature( (void *)this, &int16data ) == HTS221_ERROR )
cparata 0:b189540a70e2 204 {
cparata 0:b189540a70e2 205 return HTS221_STATUS_ERROR;
cparata 0:b189540a70e2 206 }
cparata 0:b189540a70e2 207
cparata 0:b189540a70e2 208 *pfData = ( float )int16data / 10.0f;
cparata 0:b189540a70e2 209
cparata 0:b189540a70e2 210 return HTS221_STATUS_OK;
cparata 0:b189540a70e2 211 }
cparata 0:b189540a70e2 212
cparata 0:b189540a70e2 213 /**
cparata 0:b189540a70e2 214 * @brief Read HTS221 output register, and calculate the humidity
cparata 0:b189540a70e2 215 * @param odr the pointer to the output data rate
cparata 0:b189540a70e2 216 * @retval HTS221_STATUS_OK in case of success, an error code otherwise
cparata 0:b189540a70e2 217 */
cparata 0:b189540a70e2 218 HTS221StatusTypeDef HTS221Sensor::GetODR(float* odr)
cparata 0:b189540a70e2 219 {
cparata 0:b189540a70e2 220 HTS221_Odr_et odr_low_level;
cparata 0:b189540a70e2 221
cparata 0:b189540a70e2 222 if ( HTS221_Get_Odr( (void *)this, &odr_low_level ) == HTS221_ERROR )
cparata 0:b189540a70e2 223 {
cparata 0:b189540a70e2 224 return HTS221_STATUS_ERROR;
cparata 0:b189540a70e2 225 }
cparata 0:b189540a70e2 226
cparata 0:b189540a70e2 227 switch( odr_low_level )
cparata 0:b189540a70e2 228 {
cparata 0:b189540a70e2 229 case HTS221_ODR_ONE_SHOT:
cparata 0:b189540a70e2 230 *odr = 0.0f;
cparata 0:b189540a70e2 231 break;
cparata 0:b189540a70e2 232 case HTS221_ODR_1HZ :
cparata 0:b189540a70e2 233 *odr = 1.0f;
cparata 0:b189540a70e2 234 break;
cparata 0:b189540a70e2 235 case HTS221_ODR_7HZ :
cparata 0:b189540a70e2 236 *odr = 7.0f;
cparata 0:b189540a70e2 237 break;
cparata 0:b189540a70e2 238 case HTS221_ODR_12_5HZ :
cparata 0:b189540a70e2 239 *odr = 12.5f;
cparata 0:b189540a70e2 240 break;
cparata 0:b189540a70e2 241 default :
cparata 0:b189540a70e2 242 *odr = -1.0f;
cparata 0:b189540a70e2 243 return HTS221_STATUS_ERROR;
cparata 0:b189540a70e2 244 }
cparata 0:b189540a70e2 245
cparata 0:b189540a70e2 246 return HTS221_STATUS_OK;
cparata 0:b189540a70e2 247 }
cparata 0:b189540a70e2 248
cparata 0:b189540a70e2 249 /**
cparata 0:b189540a70e2 250 * @brief Set ODR
cparata 0:b189540a70e2 251 * @param odr the output data rate to be set
cparata 0:b189540a70e2 252 * @retval HTS221_STATUS_OK in case of success, an error code otherwise
cparata 0:b189540a70e2 253 */
cparata 0:b189540a70e2 254 HTS221StatusTypeDef HTS221Sensor::SetODR(float odr)
cparata 0:b189540a70e2 255 {
cparata 0:b189540a70e2 256 HTS221_Odr_et new_odr;
cparata 0:b189540a70e2 257
cparata 0:b189540a70e2 258 new_odr = ( odr <= 1.0f ) ? HTS221_ODR_1HZ
cparata 0:b189540a70e2 259 : ( odr <= 7.0f ) ? HTS221_ODR_7HZ
cparata 0:b189540a70e2 260 : HTS221_ODR_12_5HZ;
cparata 0:b189540a70e2 261
cparata 0:b189540a70e2 262 if ( HTS221_Set_Odr( (void *)this, new_odr ) == HTS221_ERROR )
cparata 0:b189540a70e2 263 {
cparata 0:b189540a70e2 264 return HTS221_STATUS_ERROR;
cparata 0:b189540a70e2 265 }
cparata 0:b189540a70e2 266
cparata 0:b189540a70e2 267 return HTS221_STATUS_OK;
cparata 0:b189540a70e2 268 }
cparata 0:b189540a70e2 269
cparata 0:b189540a70e2 270
cparata 0:b189540a70e2 271 /**
cparata 0:b189540a70e2 272 * @brief Read the data from register
cparata 0:b189540a70e2 273 * @param reg register address
cparata 0:b189540a70e2 274 * @param data register data
cparata 0:b189540a70e2 275 * @retval HTS221_STATUS_OK in case of success
cparata 0:b189540a70e2 276 * @retval HTS221_STATUS_ERROR in case of failure
cparata 0:b189540a70e2 277 */
cparata 0:b189540a70e2 278 HTS221StatusTypeDef HTS221Sensor::ReadReg( uint8_t reg, uint8_t *data )
cparata 0:b189540a70e2 279 {
cparata 0:b189540a70e2 280
cparata 0:b189540a70e2 281 if ( HTS221_ReadReg( (void *)this, reg, 1, data ) == HTS221_ERROR )
cparata 0:b189540a70e2 282 {
cparata 0:b189540a70e2 283 return HTS221_STATUS_ERROR;
cparata 0:b189540a70e2 284 }
cparata 0:b189540a70e2 285
cparata 0:b189540a70e2 286 return HTS221_STATUS_OK;
cparata 0:b189540a70e2 287 }
cparata 0:b189540a70e2 288
cparata 0:b189540a70e2 289 /**
cparata 0:b189540a70e2 290 * @brief Write the data to register
cparata 0:b189540a70e2 291 * @param reg register address
cparata 0:b189540a70e2 292 * @param data register data
cparata 0:b189540a70e2 293 * @retval HTS221_STATUS_OK in case of success
cparata 0:b189540a70e2 294 * @retval HTS221_STATUS_ERROR in case of failure
cparata 0:b189540a70e2 295 */
cparata 0:b189540a70e2 296 HTS221StatusTypeDef HTS221Sensor::WriteReg( uint8_t reg, uint8_t data )
cparata 0:b189540a70e2 297 {
cparata 0:b189540a70e2 298
cparata 0:b189540a70e2 299 if ( HTS221_WriteReg( (void *)this, reg, 1, &data ) == HTS221_ERROR )
cparata 0:b189540a70e2 300 {
cparata 0:b189540a70e2 301 return HTS221_STATUS_ERROR;
cparata 0:b189540a70e2 302 }
cparata 0:b189540a70e2 303
cparata 0:b189540a70e2 304 return HTS221_STATUS_OK;
cparata 0:b189540a70e2 305 }
cparata 0:b189540a70e2 306
cparata 0:b189540a70e2 307 uint8_t HTS221_IO_Write( void *handle, uint8_t WriteAddr, uint8_t *pBuffer, uint16_t nBytesToWrite )
cparata 0:b189540a70e2 308 {
cparata 0:b189540a70e2 309 return ((HTS221Sensor *)handle)->IO_Write(pBuffer, WriteAddr, nBytesToWrite);
cparata 0:b189540a70e2 310 }
cparata 0:b189540a70e2 311
cparata 0:b189540a70e2 312 uint8_t HTS221_IO_Read( void *handle, uint8_t ReadAddr, uint8_t *pBuffer, uint16_t nBytesToRead )
cparata 0:b189540a70e2 313 {
cparata 0:b189540a70e2 314 return ((HTS221Sensor *)handle)->IO_Read(pBuffer, ReadAddr, nBytesToRead);
cparata 0:b189540a70e2 315 }