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/LSM303AGRSensor/LSM303AGR_MAG_Sensor.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 LSM303AGR_MAG_Sensor.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 an LSM303AGR magnetometer 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 "LSM303AGR_MAG_Sensor.h" |
| cparata | 0:69566eea0fba | 44 | #include "LSM303AGR_MAG_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 | LSM303AGR_MAG_Sensor::LSM303AGR_MAG_Sensor(DevI2C &i2c) : dev_i2c(i2c) |
| cparata | 0:69566eea0fba | 54 | { |
| cparata | 0:69566eea0fba | 55 | address = LSM303AGR_MAG_I2C_ADDRESS; |
| cparata | 0:69566eea0fba | 56 | }; |
| cparata | 0:69566eea0fba | 57 | |
| cparata | 0:69566eea0fba | 58 | /** Constructor |
| cparata | 0:69566eea0fba | 59 | * @param i2c object of an helper class which handles the I2C peripheral |
| cparata | 0:69566eea0fba | 60 | * @param address the address of the component's instance |
| cparata | 0:69566eea0fba | 61 | */ |
| cparata | 0:69566eea0fba | 62 | LSM303AGR_MAG_Sensor::LSM303AGR_MAG_Sensor(DevI2C &i2c, uint8_t address) : dev_i2c(i2c), address(address) |
| cparata | 0:69566eea0fba | 63 | { |
| cparata | 2:f23b144da50a | 64 | |
| cparata | 2:f23b144da50a | 65 | }; |
| cparata | 2:f23b144da50a | 66 | |
| cparata | 2:f23b144da50a | 67 | /** |
| cparata | 2:f23b144da50a | 68 | * @brief Initializing the component. |
| cparata | 2:f23b144da50a | 69 | * @param[in] init pointer to device specific initalization structure. |
| cparata | 2:f23b144da50a | 70 | * @retval "0" in case of success, an error code otherwise. |
| cparata | 2:f23b144da50a | 71 | */ |
| cparata | 2:f23b144da50a | 72 | int LSM303AGR_MAG_Sensor::Init(void *init) |
| cparata | 2:f23b144da50a | 73 | { |
| cparata | 0:69566eea0fba | 74 | /* Operating mode selection - power down */ |
| cparata | 0:69566eea0fba | 75 | if ( LSM303AGR_MAG_W_MD( (void *)this, LSM303AGR_MAG_MD_IDLE1_MODE ) == MEMS_ERROR ) |
| cparata | 0:69566eea0fba | 76 | { |
| cparata | 2:f23b144da50a | 77 | return 1; |
| cparata | 0:69566eea0fba | 78 | } |
| cparata | 0:69566eea0fba | 79 | |
| cparata | 0:69566eea0fba | 80 | /* Enable BDU */ |
| cparata | 0:69566eea0fba | 81 | if ( LSM303AGR_MAG_W_BDU( (void *)this, LSM303AGR_MAG_BDU_ENABLED ) == MEMS_ERROR ) |
| cparata | 0:69566eea0fba | 82 | { |
| cparata | 2:f23b144da50a | 83 | return 1; |
| cparata | 0:69566eea0fba | 84 | } |
| cparata | 0:69566eea0fba | 85 | |
| cparata | 2:f23b144da50a | 86 | if ( Set_M_ODR( 100.0f ) == 1 ) |
| cparata | 0:69566eea0fba | 87 | { |
| cparata | 2:f23b144da50a | 88 | return 1; |
| cparata | 0:69566eea0fba | 89 | } |
| cparata | 0:69566eea0fba | 90 | |
| cparata | 2:f23b144da50a | 91 | if ( Set_M_FS( 50.0f ) == 1 ) |
| cparata | 0:69566eea0fba | 92 | { |
| cparata | 2:f23b144da50a | 93 | return 1; |
| cparata | 0:69566eea0fba | 94 | } |
| cparata | 0:69566eea0fba | 95 | |
| cparata | 0:69566eea0fba | 96 | if ( LSM303AGR_MAG_W_ST( (void *)this, LSM303AGR_MAG_ST_DISABLED ) == MEMS_ERROR ) |
| cparata | 0:69566eea0fba | 97 | { |
| cparata | 2:f23b144da50a | 98 | return 1; |
| cparata | 0:69566eea0fba | 99 | } |
| cparata | 2:f23b144da50a | 100 | |
| cparata | 2:f23b144da50a | 101 | return 0; |
| cparata | 2:f23b144da50a | 102 | } |
| cparata | 0:69566eea0fba | 103 | |
| cparata | 0:69566eea0fba | 104 | /** |
| cparata | 0:69566eea0fba | 105 | * @brief Enable LSM303AGR magnetometer |
| cparata | 2:f23b144da50a | 106 | * @retval 0 in case of success, an error code otherwise |
| cparata | 0:69566eea0fba | 107 | */ |
| cparata | 2:f23b144da50a | 108 | int LSM303AGR_MAG_Sensor::Enable(void) |
| cparata | 0:69566eea0fba | 109 | { |
| cparata | 0:69566eea0fba | 110 | /* Operating mode selection */ |
| cparata | 0:69566eea0fba | 111 | if ( LSM303AGR_MAG_W_MD( (void *)this, LSM303AGR_MAG_MD_CONTINUOS_MODE ) == MEMS_ERROR ) |
| cparata | 0:69566eea0fba | 112 | { |
| cparata | 2:f23b144da50a | 113 | return 1; |
| cparata | 0:69566eea0fba | 114 | } |
| cparata | 0:69566eea0fba | 115 | |
| cparata | 2:f23b144da50a | 116 | return 0; |
| cparata | 0:69566eea0fba | 117 | } |
| cparata | 0:69566eea0fba | 118 | |
| cparata | 0:69566eea0fba | 119 | /** |
| cparata | 0:69566eea0fba | 120 | * @brief Disable LSM303AGR magnetometer |
| cparata | 2:f23b144da50a | 121 | * @retval 0 in case of success, an error code otherwise |
| cparata | 0:69566eea0fba | 122 | */ |
| cparata | 2:f23b144da50a | 123 | int LSM303AGR_MAG_Sensor::Disable(void) |
| cparata | 0:69566eea0fba | 124 | { |
| cparata | 0:69566eea0fba | 125 | /* Operating mode selection - power down */ |
| cparata | 0:69566eea0fba | 126 | if ( LSM303AGR_MAG_W_MD( (void *)this, LSM303AGR_MAG_MD_IDLE1_MODE ) == MEMS_ERROR ) |
| cparata | 0:69566eea0fba | 127 | { |
| cparata | 2:f23b144da50a | 128 | return 1; |
| cparata | 0:69566eea0fba | 129 | } |
| cparata | 0:69566eea0fba | 130 | |
| cparata | 2:f23b144da50a | 131 | return 0; |
| cparata | 0:69566eea0fba | 132 | } |
| cparata | 0:69566eea0fba | 133 | |
| cparata | 0:69566eea0fba | 134 | /** |
| cparata | 0:69566eea0fba | 135 | * @brief Read ID of LSM303AGR Magnetometer |
| cparata | 0:69566eea0fba | 136 | * @param p_id the pointer where the ID of the device is stored |
| cparata | 2:f23b144da50a | 137 | * @retval 0 in case of success, an error code otherwise |
| cparata | 0:69566eea0fba | 138 | */ |
| cparata | 2:f23b144da50a | 139 | int LSM303AGR_MAG_Sensor::ReadID(uint8_t *id) |
| cparata | 0:69566eea0fba | 140 | { |
| cparata | 2:f23b144da50a | 141 | if(!id) |
| cparata | 0:69566eea0fba | 142 | { |
| cparata | 2:f23b144da50a | 143 | return 1; |
| cparata | 0:69566eea0fba | 144 | } |
| cparata | 0:69566eea0fba | 145 | |
| cparata | 0:69566eea0fba | 146 | /* Read WHO AM I register */ |
| cparata | 2:f23b144da50a | 147 | if ( LSM303AGR_MAG_R_WHO_AM_I( (void *)this, id ) == MEMS_ERROR ) |
| cparata | 0:69566eea0fba | 148 | { |
| cparata | 2:f23b144da50a | 149 | return 1; |
| cparata | 0:69566eea0fba | 150 | } |
| cparata | 0:69566eea0fba | 151 | |
| cparata | 2:f23b144da50a | 152 | return 0; |
| cparata | 0:69566eea0fba | 153 | } |
| cparata | 0:69566eea0fba | 154 | |
| cparata | 0:69566eea0fba | 155 | /** |
| cparata | 0:69566eea0fba | 156 | * @brief Read data from LSM303AGR Magnetometer |
| cparata | 0:69566eea0fba | 157 | * @param pData the pointer where the magnetometer data are stored |
| cparata | 2:f23b144da50a | 158 | * @retval 0 in case of success, an error code otherwise |
| cparata | 0:69566eea0fba | 159 | */ |
| cparata | 2:f23b144da50a | 160 | int LSM303AGR_MAG_Sensor::Get_M_Axes(int32_t *pData) |
| cparata | 0:69566eea0fba | 161 | { |
| cparata | 0:69566eea0fba | 162 | int16_t pDataRaw[3]; |
| cparata | 0:69566eea0fba | 163 | float sensitivity = 0; |
| cparata | 0:69566eea0fba | 164 | |
| cparata | 0:69566eea0fba | 165 | /* Read raw data from LSM303AGR output register. */ |
| cparata | 2:f23b144da50a | 166 | if ( Get_M_AxesRaw( pDataRaw ) == 1 ) |
| cparata | 0:69566eea0fba | 167 | { |
| cparata | 2:f23b144da50a | 168 | return 1; |
| cparata | 0:69566eea0fba | 169 | } |
| cparata | 0:69566eea0fba | 170 | |
| cparata | 0:69566eea0fba | 171 | /* Get LSM303AGR actual sensitivity. */ |
| cparata | 2:f23b144da50a | 172 | if ( Get_M_Sensitivity( &sensitivity ) == 1 ) |
| cparata | 0:69566eea0fba | 173 | { |
| cparata | 2:f23b144da50a | 174 | return 1; |
| cparata | 0:69566eea0fba | 175 | } |
| cparata | 0:69566eea0fba | 176 | |
| cparata | 0:69566eea0fba | 177 | /* Calculate the data. */ |
| cparata | 0:69566eea0fba | 178 | pData[0] = ( int32_t )( pDataRaw[0] * sensitivity ); |
| cparata | 0:69566eea0fba | 179 | pData[1] = ( int32_t )( pDataRaw[1] * sensitivity ); |
| cparata | 0:69566eea0fba | 180 | pData[2] = ( int32_t )( pDataRaw[2] * sensitivity ); |
| cparata | 0:69566eea0fba | 181 | |
| cparata | 2:f23b144da50a | 182 | return 0; |
| cparata | 0:69566eea0fba | 183 | } |
| cparata | 0:69566eea0fba | 184 | |
| cparata | 0:69566eea0fba | 185 | /** |
| cparata | 0:69566eea0fba | 186 | * @brief Read Magnetometer Sensitivity |
| cparata | 0:69566eea0fba | 187 | * @param pfData the pointer where the magnetometer sensitivity is stored |
| cparata | 2:f23b144da50a | 188 | * @retval 0 in case of success, an error code otherwise |
| cparata | 0:69566eea0fba | 189 | */ |
| cparata | 2:f23b144da50a | 190 | int LSM303AGR_MAG_Sensor::Get_M_Sensitivity(float *pfData) |
| cparata | 0:69566eea0fba | 191 | { |
| cparata | 0:69566eea0fba | 192 | *pfData = 1.5f; |
| cparata | 0:69566eea0fba | 193 | |
| cparata | 2:f23b144da50a | 194 | return 0; |
| cparata | 0:69566eea0fba | 195 | } |
| cparata | 0:69566eea0fba | 196 | |
| cparata | 0:69566eea0fba | 197 | /** |
| cparata | 0:69566eea0fba | 198 | * @brief Read raw data from LSM303AGR Magnetometer |
| cparata | 0:69566eea0fba | 199 | * @param pData the pointer where the magnetomer raw data are stored |
| cparata | 2:f23b144da50a | 200 | * @retval 0 in case of success, an error code otherwise |
| cparata | 0:69566eea0fba | 201 | */ |
| cparata | 2:f23b144da50a | 202 | int LSM303AGR_MAG_Sensor::Get_M_AxesRaw(int16_t *pData) |
| cparata | 0:69566eea0fba | 203 | { |
| cparata | 0:69566eea0fba | 204 | uint8_t regValue[6] = {0, 0, 0, 0, 0, 0}; |
| cparata | 0:69566eea0fba | 205 | int16_t *regValueInt16; |
| cparata | 0:69566eea0fba | 206 | |
| cparata | 0:69566eea0fba | 207 | /* Read output registers from LSM303AGR_MAG_OUTX_L to LSM303AGR_MAG_OUTZ_H. */ |
| cparata | 0:69566eea0fba | 208 | if ( LSM303AGR_MAG_Get_Raw_Magnetic( (void *)this, regValue ) == MEMS_ERROR ) |
| cparata | 0:69566eea0fba | 209 | { |
| cparata | 2:f23b144da50a | 210 | return 1; |
| cparata | 0:69566eea0fba | 211 | } |
| cparata | 0:69566eea0fba | 212 | |
| cparata | 0:69566eea0fba | 213 | regValueInt16 = (int16_t *)regValue; |
| cparata | 0:69566eea0fba | 214 | |
| cparata | 0:69566eea0fba | 215 | /* Format the data. */ |
| cparata | 0:69566eea0fba | 216 | pData[0] = regValueInt16[0]; |
| cparata | 0:69566eea0fba | 217 | pData[1] = regValueInt16[1]; |
| cparata | 0:69566eea0fba | 218 | pData[2] = regValueInt16[2]; |
| cparata | 0:69566eea0fba | 219 | |
| cparata | 2:f23b144da50a | 220 | return 0; |
| cparata | 0:69566eea0fba | 221 | } |
| cparata | 0:69566eea0fba | 222 | |
| cparata | 0:69566eea0fba | 223 | /** |
| cparata | 0:69566eea0fba | 224 | * @brief Read LSM303AGR Magnetometer output data rate |
| cparata | 0:69566eea0fba | 225 | * @param odr the pointer to the output data rate |
| cparata | 2:f23b144da50a | 226 | * @retval 0 in case of success, an error code otherwise |
| cparata | 0:69566eea0fba | 227 | */ |
| cparata | 2:f23b144da50a | 228 | int LSM303AGR_MAG_Sensor::Get_M_ODR(float* odr) |
| cparata | 0:69566eea0fba | 229 | { |
| cparata | 0:69566eea0fba | 230 | LSM303AGR_MAG_ODR_t odr_low_level; |
| cparata | 0:69566eea0fba | 231 | |
| cparata | 0:69566eea0fba | 232 | if ( LSM303AGR_MAG_R_ODR( (void *)this, &odr_low_level ) == MEMS_ERROR ) |
| cparata | 0:69566eea0fba | 233 | { |
| cparata | 2:f23b144da50a | 234 | return 1; |
| cparata | 0:69566eea0fba | 235 | } |
| cparata | 0:69566eea0fba | 236 | |
| cparata | 0:69566eea0fba | 237 | switch( odr_low_level ) |
| cparata | 0:69566eea0fba | 238 | { |
| cparata | 0:69566eea0fba | 239 | case LSM303AGR_MAG_ODR_10Hz: |
| cparata | 0:69566eea0fba | 240 | *odr = 10.000f; |
| cparata | 0:69566eea0fba | 241 | break; |
| cparata | 0:69566eea0fba | 242 | case LSM303AGR_MAG_ODR_20Hz: |
| cparata | 0:69566eea0fba | 243 | *odr = 20.000f; |
| cparata | 0:69566eea0fba | 244 | break; |
| cparata | 0:69566eea0fba | 245 | case LSM303AGR_MAG_ODR_50Hz: |
| cparata | 0:69566eea0fba | 246 | *odr = 50.000f; |
| cparata | 0:69566eea0fba | 247 | break; |
| cparata | 0:69566eea0fba | 248 | case LSM303AGR_MAG_ODR_100Hz: |
| cparata | 0:69566eea0fba | 249 | *odr = 100.000f; |
| cparata | 0:69566eea0fba | 250 | break; |
| cparata | 0:69566eea0fba | 251 | default: |
| cparata | 0:69566eea0fba | 252 | *odr = -1.000f; |
| cparata | 2:f23b144da50a | 253 | return 1; |
| cparata | 0:69566eea0fba | 254 | } |
| cparata | 2:f23b144da50a | 255 | return 0; |
| cparata | 0:69566eea0fba | 256 | } |
| cparata | 0:69566eea0fba | 257 | |
| cparata | 0:69566eea0fba | 258 | /** |
| cparata | 0:69566eea0fba | 259 | * @brief Set ODR |
| cparata | 0:69566eea0fba | 260 | * @param odr the output data rate to be set |
| cparata | 2:f23b144da50a | 261 | * @retval 0 in case of success, an error code otherwise |
| cparata | 0:69566eea0fba | 262 | */ |
| cparata | 2:f23b144da50a | 263 | int LSM303AGR_MAG_Sensor::Set_M_ODR(float odr) |
| cparata | 0:69566eea0fba | 264 | { |
| cparata | 0:69566eea0fba | 265 | LSM303AGR_MAG_ODR_t new_odr; |
| cparata | 0:69566eea0fba | 266 | |
| cparata | 0:69566eea0fba | 267 | new_odr = ( odr <= 10.000f ) ? LSM303AGR_MAG_ODR_10Hz |
| cparata | 0:69566eea0fba | 268 | : ( odr <= 20.000f ) ? LSM303AGR_MAG_ODR_20Hz |
| cparata | 0:69566eea0fba | 269 | : ( odr <= 50.000f ) ? LSM303AGR_MAG_ODR_50Hz |
| cparata | 0:69566eea0fba | 270 | : LSM303AGR_MAG_ODR_100Hz; |
| cparata | 0:69566eea0fba | 271 | |
| cparata | 0:69566eea0fba | 272 | if ( LSM303AGR_MAG_W_ODR( (void *)this, new_odr ) == MEMS_ERROR ) |
| cparata | 0:69566eea0fba | 273 | { |
| cparata | 2:f23b144da50a | 274 | return 1; |
| cparata | 0:69566eea0fba | 275 | } |
| cparata | 0:69566eea0fba | 276 | |
| cparata | 2:f23b144da50a | 277 | return 0; |
| cparata | 0:69566eea0fba | 278 | } |
| cparata | 0:69566eea0fba | 279 | |
| cparata | 0:69566eea0fba | 280 | |
| cparata | 0:69566eea0fba | 281 | /** |
| cparata | 0:69566eea0fba | 282 | * @brief Read LSM303AGR Magnetometer full scale |
| cparata | 0:69566eea0fba | 283 | * @param fullScale the pointer to the output data rate |
| cparata | 2:f23b144da50a | 284 | * @retval 0 in case of success, an error code otherwise |
| cparata | 0:69566eea0fba | 285 | */ |
| cparata | 2:f23b144da50a | 286 | int LSM303AGR_MAG_Sensor::Get_M_FS(float* fullScale) |
| cparata | 0:69566eea0fba | 287 | { |
| cparata | 0:69566eea0fba | 288 | *fullScale = 50.0f; |
| cparata | 0:69566eea0fba | 289 | |
| cparata | 2:f23b144da50a | 290 | return 0; |
| cparata | 0:69566eea0fba | 291 | } |
| cparata | 0:69566eea0fba | 292 | |
| cparata | 0:69566eea0fba | 293 | /** |
| cparata | 0:69566eea0fba | 294 | * @brief Set full scale |
| cparata | 0:69566eea0fba | 295 | * @param fullScale the full scale to be set |
| cparata | 2:f23b144da50a | 296 | * @retval 0 in case of success, an error code otherwise |
| cparata | 0:69566eea0fba | 297 | */ |
| cparata | 2:f23b144da50a | 298 | int LSM303AGR_MAG_Sensor::Set_M_FS(float fullScale) |
| cparata | 0:69566eea0fba | 299 | { |
| cparata | 2:f23b144da50a | 300 | return 0; |
| cparata | 0:69566eea0fba | 301 | } |
| cparata | 0:69566eea0fba | 302 | |
| cparata | 0:69566eea0fba | 303 | |
| cparata | 0:69566eea0fba | 304 | /** |
| cparata | 0:69566eea0fba | 305 | * @brief Read magnetometer data from register |
| cparata | 0:69566eea0fba | 306 | * @param reg register address |
| cparata | 0:69566eea0fba | 307 | * @param data register data |
| cparata | 2:f23b144da50a | 308 | * @retval 0 in case of success |
| cparata | 2:f23b144da50a | 309 | * @retval 1 in case of failure |
| cparata | 0:69566eea0fba | 310 | */ |
| cparata | 2:f23b144da50a | 311 | int LSM303AGR_MAG_Sensor::ReadReg( uint8_t reg, uint8_t *data ) |
| cparata | 0:69566eea0fba | 312 | { |
| cparata | 0:69566eea0fba | 313 | if ( LSM303AGR_MAG_ReadReg( (void *)this, reg, data ) == MEMS_ERROR ) |
| cparata | 0:69566eea0fba | 314 | { |
| cparata | 2:f23b144da50a | 315 | return 1; |
| cparata | 0:69566eea0fba | 316 | } |
| cparata | 0:69566eea0fba | 317 | |
| cparata | 2:f23b144da50a | 318 | return 0; |
| cparata | 0:69566eea0fba | 319 | } |
| cparata | 0:69566eea0fba | 320 | |
| cparata | 0:69566eea0fba | 321 | |
| cparata | 0:69566eea0fba | 322 | /** |
| cparata | 0:69566eea0fba | 323 | * @brief Write magnetometer data to register |
| cparata | 0:69566eea0fba | 324 | * @param reg register address |
| cparata | 0:69566eea0fba | 325 | * @param data register data |
| cparata | 2:f23b144da50a | 326 | * @retval 0 in case of success |
| cparata | 2:f23b144da50a | 327 | * @retval 1 in case of failure |
| cparata | 0:69566eea0fba | 328 | */ |
| cparata | 2:f23b144da50a | 329 | int LSM303AGR_MAG_Sensor::WriteReg( uint8_t reg, uint8_t data ) |
| cparata | 0:69566eea0fba | 330 | { |
| cparata | 0:69566eea0fba | 331 | if ( LSM303AGR_MAG_WriteReg( (void *)this, reg, data ) == MEMS_ERROR ) |
| cparata | 0:69566eea0fba | 332 | { |
| cparata | 2:f23b144da50a | 333 | return 1; |
| cparata | 0:69566eea0fba | 334 | } |
| cparata | 0:69566eea0fba | 335 | |
| cparata | 2:f23b144da50a | 336 | return 0; |
| cparata | 0:69566eea0fba | 337 | } |
| cparata | 0:69566eea0fba | 338 | |
| cparata | 0:69566eea0fba | 339 | uint8_t LSM303AGR_MAG_IO_Write( void *handle, uint8_t WriteAddr, uint8_t *pBuffer, uint16_t nBytesToWrite ) |
| cparata | 0:69566eea0fba | 340 | { |
| cparata | 0:69566eea0fba | 341 | return ((LSM303AGR_MAG_Sensor *)handle)->IO_Write(pBuffer, WriteAddr, nBytesToWrite); |
| cparata | 0:69566eea0fba | 342 | } |
| cparata | 0:69566eea0fba | 343 | |
| cparata | 0:69566eea0fba | 344 | uint8_t LSM303AGR_MAG_IO_Read( void *handle, uint8_t ReadAddr, uint8_t *pBuffer, uint16_t nBytesToRead ) |
| cparata | 0:69566eea0fba | 345 | { |
| cparata | 0:69566eea0fba | 346 | return ((LSM303AGR_MAG_Sensor *)handle)->IO_Read(pBuffer, ReadAddr, nBytesToRead); |
| cparata | 0:69566eea0fba | 347 | } |

X-NUCLEO-IKS01A2 Motion MEMS and Environmental Sensor