ST / Mbed 2 deprecated SingleDoubleTap_IKS01A2

Example of single tap and double tap detection for LSM6DSL in X-NUCLEO-IKS01A2

Dependencies:   X_NUCLEO_IKS01A2 mbed

Fork of SingleDoubleTap_IKS01A2 by ST Expansion SW Team

Single and Double Tap Demo Application based on sensor expansion board X-NUCLEO-IKS01A2

Main function is to show how to detect the single and double tap events 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 tap the board and then view the notification using an hyper terminal. When the single tap is detected, the LED is switched on for a while.
- the user can press the user button to pass from the single tap detection to the double tap detection feature. The user can try to double tap the board and then view the notification using an hyper terminal. When the double tap is detected, the LED is switched on twice for a while.
- the user can press again the user button to disable the single and double tap detection feature.
- the user can press the user button to enable again the single tap detection feature and so on.

X_NUCLEO_IKS01A2/Components/LSM303AGRSensor/LSM303AGR_MAG_Sensor.cpp@0:e4f89df7a7a5, 2016-08-12 (annotated)

Committer:
cparata
Date:
Fri Aug 12 13:42:02 2016 +0000
Revision:
0:e4f89df7a7a5
First release of Single/Double Tap for LSM6DSL in IKS01A2

Who changed what in which revision?

UserRevisionLine numberNew contents of line
cparata 0:e4f89df7a7a5 1 /**
cparata 0:e4f89df7a7a5 2 ******************************************************************************
cparata 0:e4f89df7a7a5 3 * @file LSM303AGR_MAG_Sensor.cpp
cparata 0:e4f89df7a7a5 4 * @author AST
cparata 0:e4f89df7a7a5 5 * @version V1.0.0
cparata 0:e4f89df7a7a5 6 * @date 5 August 2016
cparata 0:e4f89df7a7a5 7 * @brief Implementation an LSM303AGR magnetometer sensor.
cparata 0:e4f89df7a7a5 8 ******************************************************************************
cparata 0:e4f89df7a7a5 9 * @attention
cparata 0:e4f89df7a7a5 10 *
cparata 0:e4f89df7a7a5 11 * <h2><center>&copy; COPYRIGHT(c) 2016 STMicroelectronics</center></h2>
cparata 0:e4f89df7a7a5 12 *
cparata 0:e4f89df7a7a5 13 * Redistribution and use in source and binary forms, with or without modification,
cparata 0:e4f89df7a7a5 14 * are permitted provided that the following conditions are met:
cparata 0:e4f89df7a7a5 15 * 1. Redistributions of source code must retain the above copyright notice,
cparata 0:e4f89df7a7a5 16 * this list of conditions and the following disclaimer.
cparata 0:e4f89df7a7a5 17 * 2. Redistributions in binary form must reproduce the above copyright notice,
cparata 0:e4f89df7a7a5 18 * this list of conditions and the following disclaimer in the documentation
cparata 0:e4f89df7a7a5 19 * and/or other materials provided with the distribution.
cparata 0:e4f89df7a7a5 20 * 3. Neither the name of STMicroelectronics nor the names of its contributors
cparata 0:e4f89df7a7a5 21 * may be used to endorse or promote products derived from this software
cparata 0:e4f89df7a7a5 22 * without specific prior written permission.
cparata 0:e4f89df7a7a5 23 *
cparata 0:e4f89df7a7a5 24 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
cparata 0:e4f89df7a7a5 25 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
cparata 0:e4f89df7a7a5 26 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
cparata 0:e4f89df7a7a5 27 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
cparata 0:e4f89df7a7a5 28 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
cparata 0:e4f89df7a7a5 29 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
cparata 0:e4f89df7a7a5 30 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
cparata 0:e4f89df7a7a5 31 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
cparata 0:e4f89df7a7a5 32 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
cparata 0:e4f89df7a7a5 33 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
cparata 0:e4f89df7a7a5 34 *
cparata 0:e4f89df7a7a5 35 ******************************************************************************
cparata 0:e4f89df7a7a5 36 */
cparata 0:e4f89df7a7a5 37
cparata 0:e4f89df7a7a5 38
cparata 0:e4f89df7a7a5 39 /* Includes ------------------------------------------------------------------*/
cparata 0:e4f89df7a7a5 40
cparata 0:e4f89df7a7a5 41 #include "mbed.h"
cparata 0:e4f89df7a7a5 42 #include "DevI2C.h"
cparata 0:e4f89df7a7a5 43 #include "LSM303AGR_MAG_Sensor.h"
cparata 0:e4f89df7a7a5 44 #include "LSM303AGR_MAG_driver.h"
cparata 0:e4f89df7a7a5 45
cparata 0:e4f89df7a7a5 46
cparata 0:e4f89df7a7a5 47 /* Class Implementation ------------------------------------------------------*/
cparata 0:e4f89df7a7a5 48
cparata 0:e4f89df7a7a5 49 /** Constructor
cparata 0:e4f89df7a7a5 50 * @param i2c object of an helper class which handles the I2C peripheral
cparata 0:e4f89df7a7a5 51 * @param address the address of the component's instance
cparata 0:e4f89df7a7a5 52 */
cparata 0:e4f89df7a7a5 53 LSM303AGR_MAG_Sensor::LSM303AGR_MAG_Sensor(DevI2C &i2c) : dev_i2c(i2c)
cparata 0:e4f89df7a7a5 54 {
cparata 0:e4f89df7a7a5 55 address = LSM303AGR_MAG_I2C_ADDRESS;
cparata 0:e4f89df7a7a5 56
cparata 0:e4f89df7a7a5 57 /* Operating mode selection - power down */
cparata 0:e4f89df7a7a5 58 if ( LSM303AGR_MAG_W_MD( (void *)this, LSM303AGR_MAG_MD_IDLE1_MODE ) == MEMS_ERROR )
cparata 0:e4f89df7a7a5 59 {
cparata 0:e4f89df7a7a5 60 return;
cparata 0:e4f89df7a7a5 61 }
cparata 0:e4f89df7a7a5 62
cparata 0:e4f89df7a7a5 63 /* Enable BDU */
cparata 0:e4f89df7a7a5 64 if ( LSM303AGR_MAG_W_BDU( (void *)this, LSM303AGR_MAG_BDU_ENABLED ) == MEMS_ERROR )
cparata 0:e4f89df7a7a5 65 {
cparata 0:e4f89df7a7a5 66 return;
cparata 0:e4f89df7a7a5 67 }
cparata 0:e4f89df7a7a5 68
cparata 0:e4f89df7a7a5 69 if ( SetODR( 100.0f ) == LSM303AGR_MAG_STATUS_ERROR )
cparata 0:e4f89df7a7a5 70 {
cparata 0:e4f89df7a7a5 71 return;
cparata 0:e4f89df7a7a5 72 }
cparata 0:e4f89df7a7a5 73
cparata 0:e4f89df7a7a5 74 if ( SetFS( 50.0f ) == LSM303AGR_MAG_STATUS_ERROR )
cparata 0:e4f89df7a7a5 75 {
cparata 0:e4f89df7a7a5 76 return;
cparata 0:e4f89df7a7a5 77 }
cparata 0:e4f89df7a7a5 78
cparata 0:e4f89df7a7a5 79 if ( LSM303AGR_MAG_W_ST( (void *)this, LSM303AGR_MAG_ST_DISABLED ) == MEMS_ERROR )
cparata 0:e4f89df7a7a5 80 {
cparata 0:e4f89df7a7a5 81 return;
cparata 0:e4f89df7a7a5 82 }
cparata 0:e4f89df7a7a5 83 };
cparata 0:e4f89df7a7a5 84
cparata 0:e4f89df7a7a5 85 /** Constructor
cparata 0:e4f89df7a7a5 86 * @param i2c object of an helper class which handles the I2C peripheral
cparata 0:e4f89df7a7a5 87 * @param address the address of the component's instance
cparata 0:e4f89df7a7a5 88 */
cparata 0:e4f89df7a7a5 89 LSM303AGR_MAG_Sensor::LSM303AGR_MAG_Sensor(DevI2C &i2c, uint8_t address) : dev_i2c(i2c), address(address)
cparata 0:e4f89df7a7a5 90 {
cparata 0:e4f89df7a7a5 91 /* Operating mode selection - power down */
cparata 0:e4f89df7a7a5 92 if ( LSM303AGR_MAG_W_MD( (void *)this, LSM303AGR_MAG_MD_IDLE1_MODE ) == MEMS_ERROR )
cparata 0:e4f89df7a7a5 93 {
cparata 0:e4f89df7a7a5 94 return;
cparata 0:e4f89df7a7a5 95 }
cparata 0:e4f89df7a7a5 96
cparata 0:e4f89df7a7a5 97 /* Enable BDU */
cparata 0:e4f89df7a7a5 98 if ( LSM303AGR_MAG_W_BDU( (void *)this, LSM303AGR_MAG_BDU_ENABLED ) == MEMS_ERROR )
cparata 0:e4f89df7a7a5 99 {
cparata 0:e4f89df7a7a5 100 return;
cparata 0:e4f89df7a7a5 101 }
cparata 0:e4f89df7a7a5 102
cparata 0:e4f89df7a7a5 103 if ( SetODR( 100.0f ) == LSM303AGR_MAG_STATUS_ERROR )
cparata 0:e4f89df7a7a5 104 {
cparata 0:e4f89df7a7a5 105 return;
cparata 0:e4f89df7a7a5 106 }
cparata 0:e4f89df7a7a5 107
cparata 0:e4f89df7a7a5 108 if ( SetFS( 50.0f ) == LSM303AGR_MAG_STATUS_ERROR )
cparata 0:e4f89df7a7a5 109 {
cparata 0:e4f89df7a7a5 110 return;
cparata 0:e4f89df7a7a5 111 }
cparata 0:e4f89df7a7a5 112
cparata 0:e4f89df7a7a5 113 if ( LSM303AGR_MAG_W_ST( (void *)this, LSM303AGR_MAG_ST_DISABLED ) == MEMS_ERROR )
cparata 0:e4f89df7a7a5 114 {
cparata 0:e4f89df7a7a5 115 return;
cparata 0:e4f89df7a7a5 116 }
cparata 0:e4f89df7a7a5 117 };
cparata 0:e4f89df7a7a5 118
cparata 0:e4f89df7a7a5 119 /**
cparata 0:e4f89df7a7a5 120 * @brief Enable LSM303AGR magnetometer
cparata 0:e4f89df7a7a5 121 * @retval LSM303AGR_MAG_STATUS_OK in case of success, an error code otherwise
cparata 0:e4f89df7a7a5 122 */
cparata 0:e4f89df7a7a5 123 LSM303AGR_MAG_StatusTypeDef LSM303AGR_MAG_Sensor::Enable(void)
cparata 0:e4f89df7a7a5 124 {
cparata 0:e4f89df7a7a5 125 /* Operating mode selection */
cparata 0:e4f89df7a7a5 126 if ( LSM303AGR_MAG_W_MD( (void *)this, LSM303AGR_MAG_MD_CONTINUOS_MODE ) == MEMS_ERROR )
cparata 0:e4f89df7a7a5 127 {
cparata 0:e4f89df7a7a5 128 return LSM303AGR_MAG_STATUS_ERROR;
cparata 0:e4f89df7a7a5 129 }
cparata 0:e4f89df7a7a5 130
cparata 0:e4f89df7a7a5 131 return LSM303AGR_MAG_STATUS_OK;
cparata 0:e4f89df7a7a5 132 }
cparata 0:e4f89df7a7a5 133
cparata 0:e4f89df7a7a5 134 /**
cparata 0:e4f89df7a7a5 135 * @brief Disable LSM303AGR magnetometer
cparata 0:e4f89df7a7a5 136 * @retval LSM303AGR_MAG_STATUS_OK in case of success, an error code otherwise
cparata 0:e4f89df7a7a5 137 */
cparata 0:e4f89df7a7a5 138 LSM303AGR_MAG_StatusTypeDef LSM303AGR_MAG_Sensor::Disable(void)
cparata 0:e4f89df7a7a5 139 {
cparata 0:e4f89df7a7a5 140 /* Operating mode selection - power down */
cparata 0:e4f89df7a7a5 141 if ( LSM303AGR_MAG_W_MD( (void *)this, LSM303AGR_MAG_MD_IDLE1_MODE ) == MEMS_ERROR )
cparata 0:e4f89df7a7a5 142 {
cparata 0:e4f89df7a7a5 143 return LSM303AGR_MAG_STATUS_ERROR;
cparata 0:e4f89df7a7a5 144 }
cparata 0:e4f89df7a7a5 145
cparata 0:e4f89df7a7a5 146 return LSM303AGR_MAG_STATUS_OK;
cparata 0:e4f89df7a7a5 147 }
cparata 0:e4f89df7a7a5 148
cparata 0:e4f89df7a7a5 149 /**
cparata 0:e4f89df7a7a5 150 * @brief Read ID of LSM303AGR Magnetometer
cparata 0:e4f89df7a7a5 151 * @param p_id the pointer where the ID of the device is stored
cparata 0:e4f89df7a7a5 152 * @retval LSM303AGR_MAG_STATUS_OK in case of success, an error code otherwise
cparata 0:e4f89df7a7a5 153 */
cparata 0:e4f89df7a7a5 154 LSM303AGR_MAG_StatusTypeDef LSM303AGR_MAG_Sensor::ReadID(uint8_t *p_id)
cparata 0:e4f89df7a7a5 155 {
cparata 0:e4f89df7a7a5 156 if(!p_id)
cparata 0:e4f89df7a7a5 157 {
cparata 0:e4f89df7a7a5 158 return LSM303AGR_MAG_STATUS_ERROR;
cparata 0:e4f89df7a7a5 159 }
cparata 0:e4f89df7a7a5 160
cparata 0:e4f89df7a7a5 161 /* Read WHO AM I register */
cparata 0:e4f89df7a7a5 162 if ( LSM303AGR_MAG_R_WHO_AM_I( (void *)this, p_id ) == MEMS_ERROR )
cparata 0:e4f89df7a7a5 163 {
cparata 0:e4f89df7a7a5 164 return LSM303AGR_MAG_STATUS_ERROR;
cparata 0:e4f89df7a7a5 165 }
cparata 0:e4f89df7a7a5 166
cparata 0:e4f89df7a7a5 167 return LSM303AGR_MAG_STATUS_OK;
cparata 0:e4f89df7a7a5 168 }
cparata 0:e4f89df7a7a5 169
cparata 0:e4f89df7a7a5 170 /**
cparata 0:e4f89df7a7a5 171 * @brief Read data from LSM303AGR Magnetometer
cparata 0:e4f89df7a7a5 172 * @param pData the pointer where the magnetometer data are stored
cparata 0:e4f89df7a7a5 173 * @retval LSM303AGR_MAG_STATUS_OK in case of success, an error code otherwise
cparata 0:e4f89df7a7a5 174 */
cparata 0:e4f89df7a7a5 175 LSM303AGR_MAG_StatusTypeDef LSM303AGR_MAG_Sensor::GetAxes(int32_t *pData)
cparata 0:e4f89df7a7a5 176 {
cparata 0:e4f89df7a7a5 177 int16_t pDataRaw[3];
cparata 0:e4f89df7a7a5 178 float sensitivity = 0;
cparata 0:e4f89df7a7a5 179
cparata 0:e4f89df7a7a5 180 /* Read raw data from LSM303AGR output register. */
cparata 0:e4f89df7a7a5 181 if ( GetAxesRaw( pDataRaw ) == LSM303AGR_MAG_STATUS_ERROR )
cparata 0:e4f89df7a7a5 182 {
cparata 0:e4f89df7a7a5 183 return LSM303AGR_MAG_STATUS_ERROR;
cparata 0:e4f89df7a7a5 184 }
cparata 0:e4f89df7a7a5 185
cparata 0:e4f89df7a7a5 186 /* Get LSM303AGR actual sensitivity. */
cparata 0:e4f89df7a7a5 187 if ( GetSensitivity( &sensitivity ) == LSM303AGR_MAG_STATUS_ERROR )
cparata 0:e4f89df7a7a5 188 {
cparata 0:e4f89df7a7a5 189 return LSM303AGR_MAG_STATUS_ERROR;
cparata 0:e4f89df7a7a5 190 }
cparata 0:e4f89df7a7a5 191
cparata 0:e4f89df7a7a5 192 /* Calculate the data. */
cparata 0:e4f89df7a7a5 193 pData[0] = ( int32_t )( pDataRaw[0] * sensitivity );
cparata 0:e4f89df7a7a5 194 pData[1] = ( int32_t )( pDataRaw[1] * sensitivity );
cparata 0:e4f89df7a7a5 195 pData[2] = ( int32_t )( pDataRaw[2] * sensitivity );
cparata 0:e4f89df7a7a5 196
cparata 0:e4f89df7a7a5 197 return LSM303AGR_MAG_STATUS_OK;
cparata 0:e4f89df7a7a5 198 }
cparata 0:e4f89df7a7a5 199
cparata 0:e4f89df7a7a5 200 /**
cparata 0:e4f89df7a7a5 201 * @brief Read Magnetometer Sensitivity
cparata 0:e4f89df7a7a5 202 * @param pfData the pointer where the magnetometer sensitivity is stored
cparata 0:e4f89df7a7a5 203 * @retval LSM303AGR_MAG_STATUS_OK in case of success, an error code otherwise
cparata 0:e4f89df7a7a5 204 */
cparata 0:e4f89df7a7a5 205 LSM303AGR_MAG_StatusTypeDef LSM303AGR_MAG_Sensor::GetSensitivity(float *pfData)
cparata 0:e4f89df7a7a5 206 {
cparata 0:e4f89df7a7a5 207 *pfData = 1.5f;
cparata 0:e4f89df7a7a5 208
cparata 0:e4f89df7a7a5 209 return LSM303AGR_MAG_STATUS_OK;
cparata 0:e4f89df7a7a5 210 }
cparata 0:e4f89df7a7a5 211
cparata 0:e4f89df7a7a5 212 /**
cparata 0:e4f89df7a7a5 213 * @brief Read raw data from LSM303AGR Magnetometer
cparata 0:e4f89df7a7a5 214 * @param pData the pointer where the magnetomer raw data are stored
cparata 0:e4f89df7a7a5 215 * @retval LSM303AGR_MAG_STATUS_OK in case of success, an error code otherwise
cparata 0:e4f89df7a7a5 216 */
cparata 0:e4f89df7a7a5 217 LSM303AGR_MAG_StatusTypeDef LSM303AGR_MAG_Sensor::GetAxesRaw(int16_t *pData)
cparata 0:e4f89df7a7a5 218 {
cparata 0:e4f89df7a7a5 219 uint8_t regValue[6] = {0, 0, 0, 0, 0, 0};
cparata 0:e4f89df7a7a5 220 int16_t *regValueInt16;
cparata 0:e4f89df7a7a5 221
cparata 0:e4f89df7a7a5 222 /* Read output registers from LSM303AGR_MAG_OUTX_L to LSM303AGR_MAG_OUTZ_H. */
cparata 0:e4f89df7a7a5 223 if ( LSM303AGR_MAG_Get_Raw_Magnetic( (void *)this, regValue ) == MEMS_ERROR )
cparata 0:e4f89df7a7a5 224 {
cparata 0:e4f89df7a7a5 225 return LSM303AGR_MAG_STATUS_ERROR;
cparata 0:e4f89df7a7a5 226 }
cparata 0:e4f89df7a7a5 227
cparata 0:e4f89df7a7a5 228 regValueInt16 = (int16_t *)regValue;
cparata 0:e4f89df7a7a5 229
cparata 0:e4f89df7a7a5 230 /* Format the data. */
cparata 0:e4f89df7a7a5 231 pData[0] = regValueInt16[0];
cparata 0:e4f89df7a7a5 232 pData[1] = regValueInt16[1];
cparata 0:e4f89df7a7a5 233 pData[2] = regValueInt16[2];
cparata 0:e4f89df7a7a5 234
cparata 0:e4f89df7a7a5 235 return LSM303AGR_MAG_STATUS_OK;
cparata 0:e4f89df7a7a5 236 }
cparata 0:e4f89df7a7a5 237
cparata 0:e4f89df7a7a5 238 /**
cparata 0:e4f89df7a7a5 239 * @brief Read LSM303AGR Magnetometer output data rate
cparata 0:e4f89df7a7a5 240 * @param odr the pointer to the output data rate
cparata 0:e4f89df7a7a5 241 * @retval LSM303AGR_MAG_STATUS_OK in case of success, an error code otherwise
cparata 0:e4f89df7a7a5 242 */
cparata 0:e4f89df7a7a5 243 LSM303AGR_MAG_StatusTypeDef LSM303AGR_MAG_Sensor::GetODR(float* odr)
cparata 0:e4f89df7a7a5 244 {
cparata 0:e4f89df7a7a5 245 LSM303AGR_MAG_ODR_t odr_low_level;
cparata 0:e4f89df7a7a5 246
cparata 0:e4f89df7a7a5 247 if ( LSM303AGR_MAG_R_ODR( (void *)this, &odr_low_level ) == MEMS_ERROR )
cparata 0:e4f89df7a7a5 248 {
cparata 0:e4f89df7a7a5 249 return LSM303AGR_MAG_STATUS_ERROR;
cparata 0:e4f89df7a7a5 250 }
cparata 0:e4f89df7a7a5 251
cparata 0:e4f89df7a7a5 252 switch( odr_low_level )
cparata 0:e4f89df7a7a5 253 {
cparata 0:e4f89df7a7a5 254 case LSM303AGR_MAG_ODR_10Hz:
cparata 0:e4f89df7a7a5 255 *odr = 10.000f;
cparata 0:e4f89df7a7a5 256 break;
cparata 0:e4f89df7a7a5 257 case LSM303AGR_MAG_ODR_20Hz:
cparata 0:e4f89df7a7a5 258 *odr = 20.000f;
cparata 0:e4f89df7a7a5 259 break;
cparata 0:e4f89df7a7a5 260 case LSM303AGR_MAG_ODR_50Hz:
cparata 0:e4f89df7a7a5 261 *odr = 50.000f;
cparata 0:e4f89df7a7a5 262 break;
cparata 0:e4f89df7a7a5 263 case LSM303AGR_MAG_ODR_100Hz:
cparata 0:e4f89df7a7a5 264 *odr = 100.000f;
cparata 0:e4f89df7a7a5 265 break;
cparata 0:e4f89df7a7a5 266 default:
cparata 0:e4f89df7a7a5 267 *odr = -1.000f;
cparata 0:e4f89df7a7a5 268 return LSM303AGR_MAG_STATUS_ERROR;
cparata 0:e4f89df7a7a5 269 }
cparata 0:e4f89df7a7a5 270 return LSM303AGR_MAG_STATUS_OK;
cparata 0:e4f89df7a7a5 271 }
cparata 0:e4f89df7a7a5 272
cparata 0:e4f89df7a7a5 273 /**
cparata 0:e4f89df7a7a5 274 * @brief Set ODR
cparata 0:e4f89df7a7a5 275 * @param odr the output data rate to be set
cparata 0:e4f89df7a7a5 276 * @retval LSM303AGR_MAG_STATUS_OK in case of success, an error code otherwise
cparata 0:e4f89df7a7a5 277 */
cparata 0:e4f89df7a7a5 278 LSM303AGR_MAG_StatusTypeDef LSM303AGR_MAG_Sensor::SetODR(float odr)
cparata 0:e4f89df7a7a5 279 {
cparata 0:e4f89df7a7a5 280 LSM303AGR_MAG_ODR_t new_odr;
cparata 0:e4f89df7a7a5 281
cparata 0:e4f89df7a7a5 282 new_odr = ( odr <= 10.000f ) ? LSM303AGR_MAG_ODR_10Hz
cparata 0:e4f89df7a7a5 283 : ( odr <= 20.000f ) ? LSM303AGR_MAG_ODR_20Hz
cparata 0:e4f89df7a7a5 284 : ( odr <= 50.000f ) ? LSM303AGR_MAG_ODR_50Hz
cparata 0:e4f89df7a7a5 285 : LSM303AGR_MAG_ODR_100Hz;
cparata 0:e4f89df7a7a5 286
cparata 0:e4f89df7a7a5 287 if ( LSM303AGR_MAG_W_ODR( (void *)this, new_odr ) == MEMS_ERROR )
cparata 0:e4f89df7a7a5 288 {
cparata 0:e4f89df7a7a5 289 return LSM303AGR_MAG_STATUS_ERROR;
cparata 0:e4f89df7a7a5 290 }
cparata 0:e4f89df7a7a5 291
cparata 0:e4f89df7a7a5 292 return LSM303AGR_MAG_STATUS_OK;
cparata 0:e4f89df7a7a5 293 }
cparata 0:e4f89df7a7a5 294
cparata 0:e4f89df7a7a5 295
cparata 0:e4f89df7a7a5 296 /**
cparata 0:e4f89df7a7a5 297 * @brief Read LSM303AGR Magnetometer full scale
cparata 0:e4f89df7a7a5 298 * @param fullScale the pointer to the output data rate
cparata 0:e4f89df7a7a5 299 * @retval LSM303AGR_MAG_STATUS_OK in case of success, an error code otherwise
cparata 0:e4f89df7a7a5 300 */
cparata 0:e4f89df7a7a5 301 LSM303AGR_MAG_StatusTypeDef LSM303AGR_MAG_Sensor::GetFS(float* fullScale)
cparata 0:e4f89df7a7a5 302 {
cparata 0:e4f89df7a7a5 303 *fullScale = 50.0f;
cparata 0:e4f89df7a7a5 304
cparata 0:e4f89df7a7a5 305 return LSM303AGR_MAG_STATUS_OK;
cparata 0:e4f89df7a7a5 306 }
cparata 0:e4f89df7a7a5 307
cparata 0:e4f89df7a7a5 308 /**
cparata 0:e4f89df7a7a5 309 * @brief Set full scale
cparata 0:e4f89df7a7a5 310 * @param fullScale the full scale to be set
cparata 0:e4f89df7a7a5 311 * @retval LSM303AGR_MAG_STATUS_OK in case of success, an error code otherwise
cparata 0:e4f89df7a7a5 312 */
cparata 0:e4f89df7a7a5 313 LSM303AGR_MAG_StatusTypeDef LSM303AGR_MAG_Sensor::SetFS(float fullScale)
cparata 0:e4f89df7a7a5 314 {
cparata 0:e4f89df7a7a5 315 return LSM303AGR_MAG_STATUS_OK;
cparata 0:e4f89df7a7a5 316 }
cparata 0:e4f89df7a7a5 317
cparata 0:e4f89df7a7a5 318
cparata 0:e4f89df7a7a5 319 /**
cparata 0:e4f89df7a7a5 320 * @brief Read magnetometer data from register
cparata 0:e4f89df7a7a5 321 * @param reg register address
cparata 0:e4f89df7a7a5 322 * @param data register data
cparata 0:e4f89df7a7a5 323 * @retval LSM303AGR_MAG_STATUS_OK in case of success
cparata 0:e4f89df7a7a5 324 * @retval LSM303AGR_MAG_STATUS_ERROR in case of failure
cparata 0:e4f89df7a7a5 325 */
cparata 0:e4f89df7a7a5 326 LSM303AGR_MAG_StatusTypeDef LSM303AGR_MAG_Sensor::ReadReg( uint8_t reg, uint8_t *data )
cparata 0:e4f89df7a7a5 327 {
cparata 0:e4f89df7a7a5 328 if ( LSM303AGR_MAG_ReadReg( (void *)this, reg, data ) == MEMS_ERROR )
cparata 0:e4f89df7a7a5 329 {
cparata 0:e4f89df7a7a5 330 return LSM303AGR_MAG_STATUS_ERROR;
cparata 0:e4f89df7a7a5 331 }
cparata 0:e4f89df7a7a5 332
cparata 0:e4f89df7a7a5 333 return LSM303AGR_MAG_STATUS_OK;
cparata 0:e4f89df7a7a5 334 }
cparata 0:e4f89df7a7a5 335
cparata 0:e4f89df7a7a5 336
cparata 0:e4f89df7a7a5 337 /**
cparata 0:e4f89df7a7a5 338 * @brief Write magnetometer data to register
cparata 0:e4f89df7a7a5 339 * @param reg register address
cparata 0:e4f89df7a7a5 340 * @param data register data
cparata 0:e4f89df7a7a5 341 * @retval LSM303AGR_MAG_STATUS_OK in case of success
cparata 0:e4f89df7a7a5 342 * @retval LSM303AGR_MAG_STATUS_ERROR in case of failure
cparata 0:e4f89df7a7a5 343 */
cparata 0:e4f89df7a7a5 344 LSM303AGR_MAG_StatusTypeDef LSM303AGR_MAG_Sensor::WriteReg( uint8_t reg, uint8_t data )
cparata 0:e4f89df7a7a5 345 {
cparata 0:e4f89df7a7a5 346 if ( LSM303AGR_MAG_WriteReg( (void *)this, reg, data ) == MEMS_ERROR )
cparata 0:e4f89df7a7a5 347 {
cparata 0:e4f89df7a7a5 348 return LSM303AGR_MAG_STATUS_ERROR;
cparata 0:e4f89df7a7a5 349 }
cparata 0:e4f89df7a7a5 350
cparata 0:e4f89df7a7a5 351 return LSM303AGR_MAG_STATUS_OK;
cparata 0:e4f89df7a7a5 352 }
cparata 0:e4f89df7a7a5 353
cparata 0:e4f89df7a7a5 354 uint8_t LSM303AGR_MAG_IO_Write( void *handle, uint8_t WriteAddr, uint8_t *pBuffer, uint16_t nBytesToWrite )
cparata 0:e4f89df7a7a5 355 {
cparata 0:e4f89df7a7a5 356 return ((LSM303AGR_MAG_Sensor *)handle)->IO_Write(pBuffer, WriteAddr, nBytesToWrite);
cparata 0:e4f89df7a7a5 357 }
cparata 0:e4f89df7a7a5 358
cparata 0:e4f89df7a7a5 359 uint8_t LSM303AGR_MAG_IO_Read( void *handle, uint8_t ReadAddr, uint8_t *pBuffer, uint16_t nBytesToRead )
cparata 0:e4f89df7a7a5 360 {
cparata 0:e4f89df7a7a5 361 return ((LSM303AGR_MAG_Sensor *)handle)->IO_Read(pBuffer, ReadAddr, nBytesToRead);
cparata 0:e4f89df7a7a5 362 }