Example of tilt detection for LSM6DSL in X-NUCLEO-IKS01A2

Dependencies:   X_NUCLEO_IKS01A2 mbed

Fork of Tilt_IKS01A2 by ST Expansion SW Team

Tilt Detection Demo Application based on sensor expansion board X-NUCLEO-IKS01A2

Main function is to show how to detect the tilt event 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 tilt the board and then view the notification using an hyper terminal. When the tilt event is detected, the LED is switched on for a while.
- the user button can be used to enable/disable the tilt detection feature.

Committer:
cparata
Date:
Fri Aug 12 13:42:49 2016 +0000
Revision:
0:489965565a0d
First release of Tilt Detection for LSM6DSL in IKS01A2

Who changed what in which revision?

UserRevisionLine numberNew contents of line
cparata 0:489965565a0d 1 /**
cparata 0:489965565a0d 2 *******************************************************************************
cparata 0:489965565a0d 3 * @file LSM303AGR_MAG_driver.c
cparata 0:489965565a0d 4 * @author MEMS Application Team
cparata 0:489965565a0d 5 * @version V1.1
cparata 0:489965565a0d 6 * @date 25-February-2016
cparata 0:489965565a0d 7 * @brief LSM303AGR Magnetometer driver file
cparata 0:489965565a0d 8 *******************************************************************************
cparata 0:489965565a0d 9 * @attention
cparata 0:489965565a0d 10 *
cparata 0:489965565a0d 11 * <h2><center>&copy; COPYRIGHT(c) 2016 STMicroelectronics</center></h2>
cparata 0:489965565a0d 12 *
cparata 0:489965565a0d 13 * Redistribution and use in source and binary forms, with or without modification,
cparata 0:489965565a0d 14 * are permitted provided that the following conditions are met:
cparata 0:489965565a0d 15 * 1. Redistributions of source code must retain the above copyright notice,
cparata 0:489965565a0d 16 * this list of conditions and the following disclaimer.
cparata 0:489965565a0d 17 * 2. Redistributions in binary form must reproduce the above copyright notice,
cparata 0:489965565a0d 18 * this list of conditions and the following disclaimer in the documentation
cparata 0:489965565a0d 19 * and/or other materials provided with the distribution.
cparata 0:489965565a0d 20 * 3. Neither the name of STMicroelectronics nor the names of its contributors
cparata 0:489965565a0d 21 * may be used to endorse or promote products derived from this software
cparata 0:489965565a0d 22 * without specific prior written permission.
cparata 0:489965565a0d 23 *
cparata 0:489965565a0d 24 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
cparata 0:489965565a0d 25 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
cparata 0:489965565a0d 26 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
cparata 0:489965565a0d 27 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
cparata 0:489965565a0d 28 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
cparata 0:489965565a0d 29 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
cparata 0:489965565a0d 30 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
cparata 0:489965565a0d 31 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
cparata 0:489965565a0d 32 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
cparata 0:489965565a0d 33 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
cparata 0:489965565a0d 34 *
cparata 0:489965565a0d 35 ******************************************************************************
cparata 0:489965565a0d 36 */
cparata 0:489965565a0d 37
cparata 0:489965565a0d 38 /* Includes ------------------------------------------------------------------*/
cparata 0:489965565a0d 39 #include "LSM303AGR_MAG_driver.h"
cparata 0:489965565a0d 40
cparata 0:489965565a0d 41 /* Imported function prototypes ----------------------------------------------*/
cparata 0:489965565a0d 42 extern uint8_t LSM303AGR_MAG_IO_Write(void *handle, uint8_t WriteAddr, uint8_t *pBuffer, uint16_t nBytesToWrite);
cparata 0:489965565a0d 43 extern uint8_t LSM303AGR_MAG_IO_Read(void *handle, uint8_t ReadAddr, uint8_t *pBuffer, uint16_t nBytesToRead);
cparata 0:489965565a0d 44
cparata 0:489965565a0d 45 /* Private typedef -----------------------------------------------------------*/
cparata 0:489965565a0d 46
cparata 0:489965565a0d 47 /* Private define ------------------------------------------------------------*/
cparata 0:489965565a0d 48
cparata 0:489965565a0d 49 /* Private macro -------------------------------------------------------------*/
cparata 0:489965565a0d 50
cparata 0:489965565a0d 51 /* Private variables ---------------------------------------------------------*/
cparata 0:489965565a0d 52
cparata 0:489965565a0d 53 /* Private functions ---------------------------------------------------------*/
cparata 0:489965565a0d 54
cparata 0:489965565a0d 55 /*******************************************************************************
cparata 0:489965565a0d 56 * Function Name : LSM303AGR_MAG_ReadReg
cparata 0:489965565a0d 57 * Description : Generic Reading function. It must be fullfilled with either
cparata 0:489965565a0d 58 * : I2C or SPI reading functions
cparata 0:489965565a0d 59 * Input : Register Address
cparata 0:489965565a0d 60 * Output : Data REad
cparata 0:489965565a0d 61 * Return : None
cparata 0:489965565a0d 62 *******************************************************************************/
cparata 0:489965565a0d 63 status_t LSM303AGR_MAG_ReadReg( void *handle, u8_t Reg, u8_t* Data )
cparata 0:489965565a0d 64 {
cparata 0:489965565a0d 65
cparata 0:489965565a0d 66 if (LSM303AGR_MAG_IO_Read(handle, Reg, Data, 1))
cparata 0:489965565a0d 67 {
cparata 0:489965565a0d 68 return MEMS_ERROR;
cparata 0:489965565a0d 69 }
cparata 0:489965565a0d 70 else
cparata 0:489965565a0d 71 {
cparata 0:489965565a0d 72 return MEMS_SUCCESS;
cparata 0:489965565a0d 73 }
cparata 0:489965565a0d 74 }
cparata 0:489965565a0d 75
cparata 0:489965565a0d 76 /*******************************************************************************
cparata 0:489965565a0d 77 * Function Name : LSM303AGR_MAG_WriteReg
cparata 0:489965565a0d 78 * Description : Generic Writing function. It must be fullfilled with either
cparata 0:489965565a0d 79 * : I2C or SPI writing function
cparata 0:489965565a0d 80 * Input : Register Address, Data to be written
cparata 0:489965565a0d 81 * Output : None
cparata 0:489965565a0d 82 * Return : None
cparata 0:489965565a0d 83 *******************************************************************************/
cparata 0:489965565a0d 84 status_t LSM303AGR_MAG_WriteReg( void *handle, u8_t Reg, u8_t Data )
cparata 0:489965565a0d 85 {
cparata 0:489965565a0d 86
cparata 0:489965565a0d 87 if (LSM303AGR_MAG_IO_Write(handle, Reg, &Data, 1))
cparata 0:489965565a0d 88 {
cparata 0:489965565a0d 89 return MEMS_ERROR;
cparata 0:489965565a0d 90 }
cparata 0:489965565a0d 91 else
cparata 0:489965565a0d 92 {
cparata 0:489965565a0d 93 return MEMS_SUCCESS;
cparata 0:489965565a0d 94 }
cparata 0:489965565a0d 95 }
cparata 0:489965565a0d 96
cparata 0:489965565a0d 97 /*******************************************************************************
cparata 0:489965565a0d 98 * Function Name : SwapHighLowByte
cparata 0:489965565a0d 99 * Description : Swap High/low byte in multiple byte values
cparata 0:489965565a0d 100 * It works with minimum 2 byte for every dimension.
cparata 0:489965565a0d 101 * Example x,y,z with 2 byte for every dimension
cparata 0:489965565a0d 102 *
cparata 0:489965565a0d 103 * Input : bufferToSwap -> buffer to swap
cparata 0:489965565a0d 104 * numberOfByte -> the buffer length in byte
cparata 0:489965565a0d 105 * dimension -> number of dimension
cparata 0:489965565a0d 106 *
cparata 0:489965565a0d 107 * Output : bufferToSwap -> buffer swapped
cparata 0:489965565a0d 108 * Return : None
cparata 0:489965565a0d 109 *******************************************************************************/
cparata 0:489965565a0d 110 void LSM303AGR_MAG_SwapHighLowByte(u8_t *bufferToSwap, u8_t numberOfByte, u8_t dimension)
cparata 0:489965565a0d 111 {
cparata 0:489965565a0d 112
cparata 0:489965565a0d 113 u8_t numberOfByteForDimension, i, j;
cparata 0:489965565a0d 114 u8_t tempValue[10];
cparata 0:489965565a0d 115
cparata 0:489965565a0d 116 numberOfByteForDimension=numberOfByte/dimension;
cparata 0:489965565a0d 117
cparata 0:489965565a0d 118 for (i=0; i<dimension;i++ )
cparata 0:489965565a0d 119 {
cparata 0:489965565a0d 120 for (j=0; j<numberOfByteForDimension;j++ )
cparata 0:489965565a0d 121 tempValue[j]=bufferToSwap[j+i*numberOfByteForDimension];
cparata 0:489965565a0d 122 for (j=0; j<numberOfByteForDimension;j++ )
cparata 0:489965565a0d 123 *(bufferToSwap+i*(numberOfByteForDimension)+j)=*(tempValue+(numberOfByteForDimension-1)-j);
cparata 0:489965565a0d 124 }
cparata 0:489965565a0d 125 }
cparata 0:489965565a0d 126
cparata 0:489965565a0d 127 /* Exported functions ---------------------------------------------------------*/
cparata 0:489965565a0d 128
cparata 0:489965565a0d 129 /*******************************************************************************
cparata 0:489965565a0d 130 * Function Name : LSM303AGR_MAG_W_OFF_X_L
cparata 0:489965565a0d 131 * Description : Write OFF_X_L
cparata 0:489965565a0d 132 * Input : u8_t
cparata 0:489965565a0d 133 * Output : None
cparata 0:489965565a0d 134 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 135 *******************************************************************************/
cparata 0:489965565a0d 136 status_t LSM303AGR_MAG_W_OFF_X_L(void *handle, u8_t newValue)
cparata 0:489965565a0d 137 {
cparata 0:489965565a0d 138 u8_t value;
cparata 0:489965565a0d 139
cparata 0:489965565a0d 140 newValue = newValue << LSM303AGR_MAG_OFF_X_L_POSITION; //mask
cparata 0:489965565a0d 141 newValue &= LSM303AGR_MAG_OFF_X_L_MASK; //coerce
cparata 0:489965565a0d 142
cparata 0:489965565a0d 143 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_OFFSET_X_REG_L, &value) )
cparata 0:489965565a0d 144 return MEMS_ERROR;
cparata 0:489965565a0d 145
cparata 0:489965565a0d 146 value &= (u8_t)~LSM303AGR_MAG_OFF_X_L_MASK;
cparata 0:489965565a0d 147 value |= newValue;
cparata 0:489965565a0d 148
cparata 0:489965565a0d 149 if( !LSM303AGR_MAG_WriteReg(handle, LSM303AGR_MAG_OFFSET_X_REG_L, value) )
cparata 0:489965565a0d 150 return MEMS_ERROR;
cparata 0:489965565a0d 151
cparata 0:489965565a0d 152 return MEMS_SUCCESS;
cparata 0:489965565a0d 153 }
cparata 0:489965565a0d 154
cparata 0:489965565a0d 155 /*******************************************************************************
cparata 0:489965565a0d 156 * Function Name : LSM303AGR_MAG_R_OFF_X_L
cparata 0:489965565a0d 157 * Description : Read OFF_X_L
cparata 0:489965565a0d 158 * Input : Pointer to u8_t
cparata 0:489965565a0d 159 * Output : Status of OFF_X_L
cparata 0:489965565a0d 160 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 161 *******************************************************************************/
cparata 0:489965565a0d 162
cparata 0:489965565a0d 163 status_t LSM303AGR_MAG_R_OFF_X_L(void *handle, u8_t *value)
cparata 0:489965565a0d 164 {
cparata 0:489965565a0d 165 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_OFFSET_X_REG_L, (u8_t *)value) )
cparata 0:489965565a0d 166 return MEMS_ERROR;
cparata 0:489965565a0d 167
cparata 0:489965565a0d 168 *value &= LSM303AGR_MAG_OFF_X_L_MASK; //coerce
cparata 0:489965565a0d 169 *value = *value >> LSM303AGR_MAG_OFF_X_L_POSITION; //mask
cparata 0:489965565a0d 170
cparata 0:489965565a0d 171 return MEMS_SUCCESS;
cparata 0:489965565a0d 172 }
cparata 0:489965565a0d 173 /*******************************************************************************
cparata 0:489965565a0d 174 * Function Name : LSM303AGR_MAG_W_OFF_X_H
cparata 0:489965565a0d 175 * Description : Write OFF_X_H
cparata 0:489965565a0d 176 * Input : u8_t
cparata 0:489965565a0d 177 * Output : None
cparata 0:489965565a0d 178 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 179 *******************************************************************************/
cparata 0:489965565a0d 180 status_t LSM303AGR_MAG_W_OFF_X_H(void *handle, u8_t newValue)
cparata 0:489965565a0d 181 {
cparata 0:489965565a0d 182 u8_t value;
cparata 0:489965565a0d 183
cparata 0:489965565a0d 184 newValue = newValue << LSM303AGR_MAG_OFF_X_H_POSITION; //mask
cparata 0:489965565a0d 185 newValue &= LSM303AGR_MAG_OFF_X_H_MASK; //coerce
cparata 0:489965565a0d 186
cparata 0:489965565a0d 187 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_OFFSET_X_REG_H, &value) )
cparata 0:489965565a0d 188 return MEMS_ERROR;
cparata 0:489965565a0d 189
cparata 0:489965565a0d 190 value &= (u8_t)~LSM303AGR_MAG_OFF_X_H_MASK;
cparata 0:489965565a0d 191 value |= newValue;
cparata 0:489965565a0d 192
cparata 0:489965565a0d 193 if( !LSM303AGR_MAG_WriteReg(handle, LSM303AGR_MAG_OFFSET_X_REG_H, value) )
cparata 0:489965565a0d 194 return MEMS_ERROR;
cparata 0:489965565a0d 195
cparata 0:489965565a0d 196 return MEMS_SUCCESS;
cparata 0:489965565a0d 197 }
cparata 0:489965565a0d 198
cparata 0:489965565a0d 199 /*******************************************************************************
cparata 0:489965565a0d 200 * Function Name : LSM303AGR_MAG_R_OFF_X_H
cparata 0:489965565a0d 201 * Description : Read OFF_X_H
cparata 0:489965565a0d 202 * Input : Pointer to u8_t
cparata 0:489965565a0d 203 * Output : Status of OFF_X_H
cparata 0:489965565a0d 204 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 205 *******************************************************************************/
cparata 0:489965565a0d 206
cparata 0:489965565a0d 207 status_t LSM303AGR_MAG_R_OFF_X_H(void *handle, u8_t *value)
cparata 0:489965565a0d 208 {
cparata 0:489965565a0d 209 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_OFFSET_X_REG_H, (u8_t *)value) )
cparata 0:489965565a0d 210 return MEMS_ERROR;
cparata 0:489965565a0d 211
cparata 0:489965565a0d 212 *value &= LSM303AGR_MAG_OFF_X_H_MASK; //coerce
cparata 0:489965565a0d 213 *value = *value >> LSM303AGR_MAG_OFF_X_H_POSITION; //mask
cparata 0:489965565a0d 214
cparata 0:489965565a0d 215 return MEMS_SUCCESS;
cparata 0:489965565a0d 216 }
cparata 0:489965565a0d 217 /*******************************************************************************
cparata 0:489965565a0d 218 * Function Name : LSM303AGR_MAG_W_OFF_Y_L
cparata 0:489965565a0d 219 * Description : Write OFF_Y_L
cparata 0:489965565a0d 220 * Input : u8_t
cparata 0:489965565a0d 221 * Output : None
cparata 0:489965565a0d 222 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 223 *******************************************************************************/
cparata 0:489965565a0d 224 status_t LSM303AGR_MAG_W_OFF_Y_L(void *handle, u8_t newValue)
cparata 0:489965565a0d 225 {
cparata 0:489965565a0d 226 u8_t value;
cparata 0:489965565a0d 227
cparata 0:489965565a0d 228 newValue = newValue << LSM303AGR_MAG_OFF_Y_L_POSITION; //mask
cparata 0:489965565a0d 229 newValue &= LSM303AGR_MAG_OFF_Y_L_MASK; //coerce
cparata 0:489965565a0d 230
cparata 0:489965565a0d 231 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_OFFSET_Y_REG_L, &value) )
cparata 0:489965565a0d 232 return MEMS_ERROR;
cparata 0:489965565a0d 233
cparata 0:489965565a0d 234 value &= (u8_t)~LSM303AGR_MAG_OFF_Y_L_MASK;
cparata 0:489965565a0d 235 value |= newValue;
cparata 0:489965565a0d 236
cparata 0:489965565a0d 237 if( !LSM303AGR_MAG_WriteReg(handle, LSM303AGR_MAG_OFFSET_Y_REG_L, value) )
cparata 0:489965565a0d 238 return MEMS_ERROR;
cparata 0:489965565a0d 239
cparata 0:489965565a0d 240 return MEMS_SUCCESS;
cparata 0:489965565a0d 241 }
cparata 0:489965565a0d 242
cparata 0:489965565a0d 243 /*******************************************************************************
cparata 0:489965565a0d 244 * Function Name : LSM303AGR_MAG_R_OFF_Y_L
cparata 0:489965565a0d 245 * Description : Read OFF_Y_L
cparata 0:489965565a0d 246 * Input : Pointer to u8_t
cparata 0:489965565a0d 247 * Output : Status of OFF_Y_L
cparata 0:489965565a0d 248 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 249 *******************************************************************************/
cparata 0:489965565a0d 250
cparata 0:489965565a0d 251 status_t LSM303AGR_MAG_R_OFF_Y_L(void *handle, u8_t *value)
cparata 0:489965565a0d 252 {
cparata 0:489965565a0d 253 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_OFFSET_Y_REG_L, (u8_t *)value) )
cparata 0:489965565a0d 254 return MEMS_ERROR;
cparata 0:489965565a0d 255
cparata 0:489965565a0d 256 *value &= LSM303AGR_MAG_OFF_Y_L_MASK; //coerce
cparata 0:489965565a0d 257 *value = *value >> LSM303AGR_MAG_OFF_Y_L_POSITION; //mask
cparata 0:489965565a0d 258
cparata 0:489965565a0d 259 return MEMS_SUCCESS;
cparata 0:489965565a0d 260 }
cparata 0:489965565a0d 261 /*******************************************************************************
cparata 0:489965565a0d 262 * Function Name : LSM303AGR_MAG_W_OFF_Y_H
cparata 0:489965565a0d 263 * Description : Write OFF_Y_H
cparata 0:489965565a0d 264 * Input : u8_t
cparata 0:489965565a0d 265 * Output : None
cparata 0:489965565a0d 266 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 267 *******************************************************************************/
cparata 0:489965565a0d 268 status_t LSM303AGR_MAG_W_OFF_Y_H(void *handle, u8_t newValue)
cparata 0:489965565a0d 269 {
cparata 0:489965565a0d 270 u8_t value;
cparata 0:489965565a0d 271
cparata 0:489965565a0d 272 newValue = newValue << LSM303AGR_MAG_OFF_Y_H_POSITION; //mask
cparata 0:489965565a0d 273 newValue &= LSM303AGR_MAG_OFF_Y_H_MASK; //coerce
cparata 0:489965565a0d 274
cparata 0:489965565a0d 275 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_OFFSET_Y_REG_H, &value) )
cparata 0:489965565a0d 276 return MEMS_ERROR;
cparata 0:489965565a0d 277
cparata 0:489965565a0d 278 value &= (u8_t)~LSM303AGR_MAG_OFF_Y_H_MASK;
cparata 0:489965565a0d 279 value |= newValue;
cparata 0:489965565a0d 280
cparata 0:489965565a0d 281 if( !LSM303AGR_MAG_WriteReg(handle, LSM303AGR_MAG_OFFSET_Y_REG_H, value) )
cparata 0:489965565a0d 282 return MEMS_ERROR;
cparata 0:489965565a0d 283
cparata 0:489965565a0d 284 return MEMS_SUCCESS;
cparata 0:489965565a0d 285 }
cparata 0:489965565a0d 286
cparata 0:489965565a0d 287 /*******************************************************************************
cparata 0:489965565a0d 288 * Function Name : LSM303AGR_MAG_R_OFF_Y_H
cparata 0:489965565a0d 289 * Description : Read OFF_Y_H
cparata 0:489965565a0d 290 * Input : Pointer to u8_t
cparata 0:489965565a0d 291 * Output : Status of OFF_Y_H
cparata 0:489965565a0d 292 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 293 *******************************************************************************/
cparata 0:489965565a0d 294
cparata 0:489965565a0d 295 status_t LSM303AGR_MAG_R_OFF_Y_H(void *handle, u8_t *value)
cparata 0:489965565a0d 296 {
cparata 0:489965565a0d 297 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_OFFSET_Y_REG_H, (u8_t *)value) )
cparata 0:489965565a0d 298 return MEMS_ERROR;
cparata 0:489965565a0d 299
cparata 0:489965565a0d 300 *value &= LSM303AGR_MAG_OFF_Y_H_MASK; //coerce
cparata 0:489965565a0d 301 *value = *value >> LSM303AGR_MAG_OFF_Y_H_POSITION; //mask
cparata 0:489965565a0d 302
cparata 0:489965565a0d 303 return MEMS_SUCCESS;
cparata 0:489965565a0d 304 }
cparata 0:489965565a0d 305 /*******************************************************************************
cparata 0:489965565a0d 306 * Function Name : LSM303AGR_MAG_W_OFF_Z_L
cparata 0:489965565a0d 307 * Description : Write OFF_Z_L
cparata 0:489965565a0d 308 * Input : u8_t
cparata 0:489965565a0d 309 * Output : None
cparata 0:489965565a0d 310 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 311 *******************************************************************************/
cparata 0:489965565a0d 312 status_t LSM303AGR_MAG_W_OFF_Z_L(void *handle, u8_t newValue)
cparata 0:489965565a0d 313 {
cparata 0:489965565a0d 314 u8_t value;
cparata 0:489965565a0d 315
cparata 0:489965565a0d 316 newValue = newValue << LSM303AGR_MAG_OFF_Z_L_POSITION; //mask
cparata 0:489965565a0d 317 newValue &= LSM303AGR_MAG_OFF_Z_L_MASK; //coerce
cparata 0:489965565a0d 318
cparata 0:489965565a0d 319 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_OFFSET_Z_REG_L, &value) )
cparata 0:489965565a0d 320 return MEMS_ERROR;
cparata 0:489965565a0d 321
cparata 0:489965565a0d 322 value &= (u8_t)~LSM303AGR_MAG_OFF_Z_L_MASK;
cparata 0:489965565a0d 323 value |= newValue;
cparata 0:489965565a0d 324
cparata 0:489965565a0d 325 if( !LSM303AGR_MAG_WriteReg(handle, LSM303AGR_MAG_OFFSET_Z_REG_L, value) )
cparata 0:489965565a0d 326 return MEMS_ERROR;
cparata 0:489965565a0d 327
cparata 0:489965565a0d 328 return MEMS_SUCCESS;
cparata 0:489965565a0d 329 }
cparata 0:489965565a0d 330
cparata 0:489965565a0d 331 /*******************************************************************************
cparata 0:489965565a0d 332 * Function Name : LSM303AGR_MAG_R_OFF_Z_L
cparata 0:489965565a0d 333 * Description : Read OFF_Z_L
cparata 0:489965565a0d 334 * Input : Pointer to u8_t
cparata 0:489965565a0d 335 * Output : Status of OFF_Z_L
cparata 0:489965565a0d 336 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 337 *******************************************************************************/
cparata 0:489965565a0d 338
cparata 0:489965565a0d 339 status_t LSM303AGR_MAG_R_OFF_Z_L(void *handle, u8_t *value)
cparata 0:489965565a0d 340 {
cparata 0:489965565a0d 341 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_OFFSET_Z_REG_L, (u8_t *)value) )
cparata 0:489965565a0d 342 return MEMS_ERROR;
cparata 0:489965565a0d 343
cparata 0:489965565a0d 344 *value &= LSM303AGR_MAG_OFF_Z_L_MASK; //coerce
cparata 0:489965565a0d 345 *value = *value >> LSM303AGR_MAG_OFF_Z_L_POSITION; //mask
cparata 0:489965565a0d 346
cparata 0:489965565a0d 347 return MEMS_SUCCESS;
cparata 0:489965565a0d 348 }
cparata 0:489965565a0d 349 /*******************************************************************************
cparata 0:489965565a0d 350 * Function Name : LSM303AGR_MAG_W_OFF_Z_H
cparata 0:489965565a0d 351 * Description : Write OFF_Z_H
cparata 0:489965565a0d 352 * Input : u8_t
cparata 0:489965565a0d 353 * Output : None
cparata 0:489965565a0d 354 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 355 *******************************************************************************/
cparata 0:489965565a0d 356 status_t LSM303AGR_MAG_W_OFF_Z_H(void *handle, u8_t newValue)
cparata 0:489965565a0d 357 {
cparata 0:489965565a0d 358 u8_t value;
cparata 0:489965565a0d 359
cparata 0:489965565a0d 360 newValue = newValue << LSM303AGR_MAG_OFF_Z_H_POSITION; //mask
cparata 0:489965565a0d 361 newValue &= LSM303AGR_MAG_OFF_Z_H_MASK; //coerce
cparata 0:489965565a0d 362
cparata 0:489965565a0d 363 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_OFFSET_Z_REG_H, &value) )
cparata 0:489965565a0d 364 return MEMS_ERROR;
cparata 0:489965565a0d 365
cparata 0:489965565a0d 366 value &= (u8_t)~LSM303AGR_MAG_OFF_Z_H_MASK;
cparata 0:489965565a0d 367 value |= newValue;
cparata 0:489965565a0d 368
cparata 0:489965565a0d 369 if( !LSM303AGR_MAG_WriteReg(handle, LSM303AGR_MAG_OFFSET_Z_REG_H, value) )
cparata 0:489965565a0d 370 return MEMS_ERROR;
cparata 0:489965565a0d 371
cparata 0:489965565a0d 372 return MEMS_SUCCESS;
cparata 0:489965565a0d 373 }
cparata 0:489965565a0d 374
cparata 0:489965565a0d 375 /*******************************************************************************
cparata 0:489965565a0d 376 * Set/Get the Magnetic offsets
cparata 0:489965565a0d 377 *******************************************************************************/
cparata 0:489965565a0d 378 status_t LSM303AGR_MAG_Get_MagOff(void *handle, u16_t *magx_off, u16_t *magy_off, u16_t *magz_off)
cparata 0:489965565a0d 379 {
cparata 0:489965565a0d 380 u8_t reg_l, reg_h;
cparata 0:489965565a0d 381
cparata 0:489965565a0d 382 /* read mag_x_off */
cparata 0:489965565a0d 383 //LSM303AGR_MAG_R_OFF_X_L(&reg_l);
cparata 0:489965565a0d 384 //LSM303AGR_MAG_R_OFF_X_H(&reg_h);
cparata 0:489965565a0d 385 LSM303AGR_MAG_R_OFF_X_L(handle, &reg_l);
cparata 0:489965565a0d 386 LSM303AGR_MAG_R_OFF_X_H(handle, &reg_h);
cparata 0:489965565a0d 387 *magx_off = ((reg_h << 8) & 0xff00) | reg_l;
cparata 0:489965565a0d 388
cparata 0:489965565a0d 389 /* read mag_y_off */
cparata 0:489965565a0d 390 //LSM303AGR_MAG_R_OFF_Y_L(&reg_l);
cparata 0:489965565a0d 391 //LSM303AGR_MAG_R_OFF_Y_H(&reg_h);
cparata 0:489965565a0d 392 LSM303AGR_MAG_R_OFF_Y_L(handle, &reg_l);
cparata 0:489965565a0d 393 LSM303AGR_MAG_R_OFF_Y_H(handle, &reg_h);
cparata 0:489965565a0d 394 *magy_off = ((reg_h << 8) & 0xff00) | reg_l;
cparata 0:489965565a0d 395
cparata 0:489965565a0d 396 /* read mag_z_off */
cparata 0:489965565a0d 397 //LSM303AGR_MAG_R_OFF_Z_L(&reg_l);
cparata 0:489965565a0d 398 //LSM303AGR_MAG_R_OFF_Z_H(&reg_h);
cparata 0:489965565a0d 399 LSM303AGR_MAG_R_OFF_Z_L(handle, &reg_l);
cparata 0:489965565a0d 400 LSM303AGR_MAG_R_OFF_Z_H(handle, &reg_h);
cparata 0:489965565a0d 401 *magz_off = ((reg_h << 8) & 0xff00) | reg_l;
cparata 0:489965565a0d 402
cparata 0:489965565a0d 403 return MEMS_SUCCESS;
cparata 0:489965565a0d 404 }
cparata 0:489965565a0d 405
cparata 0:489965565a0d 406 status_t LSM303AGR_MAG_Set_MagOff(void *handle, u16_t magx_off, u16_t magy_off, u16_t magz_off)
cparata 0:489965565a0d 407 {
cparata 0:489965565a0d 408 /* write mag_x_off */
cparata 0:489965565a0d 409 //LSM303AGR_MAG_W_OFF_X_L(magx_off & 0xff);
cparata 0:489965565a0d 410 //LSM303AGR_MAG_W_OFF_X_H((magx_off >> 8) & 0xff);
cparata 0:489965565a0d 411 LSM303AGR_MAG_W_OFF_X_L(handle, magx_off & 0xff);
cparata 0:489965565a0d 412 LSM303AGR_MAG_W_OFF_X_H(handle, (magx_off >> 8) & 0xff);
cparata 0:489965565a0d 413
cparata 0:489965565a0d 414 /* write mag_y_off */
cparata 0:489965565a0d 415 //LSM303AGR_MAG_W_OFF_Y_L(magy_off & 0xff);
cparata 0:489965565a0d 416 //LSM303AGR_MAG_W_OFF_Y_H((magy_off >> 8) & 0xff);
cparata 0:489965565a0d 417 LSM303AGR_MAG_W_OFF_Y_L(handle, magy_off & 0xff);
cparata 0:489965565a0d 418 LSM303AGR_MAG_W_OFF_Y_H(handle, (magy_off >> 8) & 0xff);
cparata 0:489965565a0d 419
cparata 0:489965565a0d 420 /* write mag_z_off */
cparata 0:489965565a0d 421 //LSM303AGR_MAG_W_OFF_Z_L(magz_off & 0xff);
cparata 0:489965565a0d 422 //LSM303AGR_MAG_W_OFF_Z_H((magz_off >> 8) & 0xff);
cparata 0:489965565a0d 423 LSM303AGR_MAG_W_OFF_Z_L(handle, magz_off & 0xff);
cparata 0:489965565a0d 424 LSM303AGR_MAG_W_OFF_Z_H(handle, (magz_off >> 8) & 0xff);
cparata 0:489965565a0d 425
cparata 0:489965565a0d 426 return MEMS_SUCCESS;
cparata 0:489965565a0d 427 }
cparata 0:489965565a0d 428
cparata 0:489965565a0d 429 /*******************************************************************************
cparata 0:489965565a0d 430 * Function Name : LSM303AGR_MAG_R_OFF_Z_H
cparata 0:489965565a0d 431 * Description : Read OFF_Z_H
cparata 0:489965565a0d 432 * Input : Pointer to u8_t
cparata 0:489965565a0d 433 * Output : Status of OFF_Z_H
cparata 0:489965565a0d 434 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 435 *******************************************************************************/
cparata 0:489965565a0d 436
cparata 0:489965565a0d 437 status_t LSM303AGR_MAG_R_OFF_Z_H(void *handle, u8_t *value)
cparata 0:489965565a0d 438 {
cparata 0:489965565a0d 439 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_OFFSET_Z_REG_H, (u8_t *)value) )
cparata 0:489965565a0d 440 return MEMS_ERROR;
cparata 0:489965565a0d 441
cparata 0:489965565a0d 442 *value &= LSM303AGR_MAG_OFF_Z_H_MASK; //coerce
cparata 0:489965565a0d 443 *value = *value >> LSM303AGR_MAG_OFF_Z_H_POSITION; //mask
cparata 0:489965565a0d 444
cparata 0:489965565a0d 445 return MEMS_SUCCESS;
cparata 0:489965565a0d 446 }
cparata 0:489965565a0d 447 /*******************************************************************************
cparata 0:489965565a0d 448 * Function Name : LSM303AGR_MAG_R_WHO_AM_I
cparata 0:489965565a0d 449 * Description : Read WHO_AM_I
cparata 0:489965565a0d 450 * Input : Pointer to u8_t
cparata 0:489965565a0d 451 * Output : Status of WHO_AM_I
cparata 0:489965565a0d 452 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 453 *******************************************************************************/
cparata 0:489965565a0d 454
cparata 0:489965565a0d 455 status_t LSM303AGR_MAG_R_WHO_AM_I(void *handle, u8_t *value)
cparata 0:489965565a0d 456 {
cparata 0:489965565a0d 457 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_WHO_AM_I_REG, (u8_t *)value) )
cparata 0:489965565a0d 458 return MEMS_ERROR;
cparata 0:489965565a0d 459
cparata 0:489965565a0d 460 *value &= LSM303AGR_MAG_WHO_AM_I_MASK; //coerce
cparata 0:489965565a0d 461 *value = *value >> LSM303AGR_MAG_WHO_AM_I_POSITION; //mask
cparata 0:489965565a0d 462
cparata 0:489965565a0d 463 return MEMS_SUCCESS;
cparata 0:489965565a0d 464 }
cparata 0:489965565a0d 465 /*******************************************************************************
cparata 0:489965565a0d 466 * Function Name : LSM303AGR_MAG_W_MD
cparata 0:489965565a0d 467 * Description : Write MD
cparata 0:489965565a0d 468 * Input : LSM303AGR_MAG_MD_t
cparata 0:489965565a0d 469 * Output : None
cparata 0:489965565a0d 470 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 471 *******************************************************************************/
cparata 0:489965565a0d 472 status_t LSM303AGR_MAG_W_MD(void *handle, LSM303AGR_MAG_MD_t newValue)
cparata 0:489965565a0d 473 {
cparata 0:489965565a0d 474 u8_t value;
cparata 0:489965565a0d 475
cparata 0:489965565a0d 476 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_CFG_REG_A, &value) )
cparata 0:489965565a0d 477 return MEMS_ERROR;
cparata 0:489965565a0d 478
cparata 0:489965565a0d 479 value &= ~LSM303AGR_MAG_MD_MASK;
cparata 0:489965565a0d 480 value |= newValue;
cparata 0:489965565a0d 481
cparata 0:489965565a0d 482 if( !LSM303AGR_MAG_WriteReg(handle, LSM303AGR_MAG_CFG_REG_A, value) )
cparata 0:489965565a0d 483 return MEMS_ERROR;
cparata 0:489965565a0d 484
cparata 0:489965565a0d 485 return MEMS_SUCCESS;
cparata 0:489965565a0d 486 }
cparata 0:489965565a0d 487
cparata 0:489965565a0d 488 /*******************************************************************************
cparata 0:489965565a0d 489 * Function Name : LSM303AGR_MAG_R_MD
cparata 0:489965565a0d 490 * Description : Read MD
cparata 0:489965565a0d 491 * Input : Pointer to LSM303AGR_MAG_MD_t
cparata 0:489965565a0d 492 * Output : Status of MD see LSM303AGR_MAG_MD_t
cparata 0:489965565a0d 493 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 494 *******************************************************************************/
cparata 0:489965565a0d 495
cparata 0:489965565a0d 496 status_t LSM303AGR_MAG_R_MD(void *handle, LSM303AGR_MAG_MD_t *value)
cparata 0:489965565a0d 497 {
cparata 0:489965565a0d 498 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_CFG_REG_A, (u8_t *)value) )
cparata 0:489965565a0d 499 return MEMS_ERROR;
cparata 0:489965565a0d 500
cparata 0:489965565a0d 501 *value &= LSM303AGR_MAG_MD_MASK; //mask
cparata 0:489965565a0d 502
cparata 0:489965565a0d 503 return MEMS_SUCCESS;
cparata 0:489965565a0d 504 }
cparata 0:489965565a0d 505 /*******************************************************************************
cparata 0:489965565a0d 506 * Function Name : LSM303AGR_MAG_W_ODR
cparata 0:489965565a0d 507 * Description : Write ODR
cparata 0:489965565a0d 508 * Input : LSM303AGR_MAG_ODR_t
cparata 0:489965565a0d 509 * Output : None
cparata 0:489965565a0d 510 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 511 *******************************************************************************/
cparata 0:489965565a0d 512 status_t LSM303AGR_MAG_W_ODR(void *handle, LSM303AGR_MAG_ODR_t newValue)
cparata 0:489965565a0d 513 {
cparata 0:489965565a0d 514 u8_t value;
cparata 0:489965565a0d 515
cparata 0:489965565a0d 516 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_CFG_REG_A, &value) )
cparata 0:489965565a0d 517 return MEMS_ERROR;
cparata 0:489965565a0d 518
cparata 0:489965565a0d 519 value &= ~LSM303AGR_MAG_ODR_MASK;
cparata 0:489965565a0d 520 value |= newValue;
cparata 0:489965565a0d 521
cparata 0:489965565a0d 522 if( !LSM303AGR_MAG_WriteReg(handle, LSM303AGR_MAG_CFG_REG_A, value) )
cparata 0:489965565a0d 523 return MEMS_ERROR;
cparata 0:489965565a0d 524
cparata 0:489965565a0d 525 return MEMS_SUCCESS;
cparata 0:489965565a0d 526 }
cparata 0:489965565a0d 527
cparata 0:489965565a0d 528 /*******************************************************************************
cparata 0:489965565a0d 529 * Function Name : LSM303AGR_MAG_R_ODR
cparata 0:489965565a0d 530 * Description : Read ODR
cparata 0:489965565a0d 531 * Input : Pointer to LSM303AGR_MAG_ODR_t
cparata 0:489965565a0d 532 * Output : Status of ODR see LSM303AGR_MAG_ODR_t
cparata 0:489965565a0d 533 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 534 *******************************************************************************/
cparata 0:489965565a0d 535
cparata 0:489965565a0d 536 status_t LSM303AGR_MAG_R_ODR(void *handle, LSM303AGR_MAG_ODR_t *value)
cparata 0:489965565a0d 537 {
cparata 0:489965565a0d 538 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_CFG_REG_A, (u8_t *)value) )
cparata 0:489965565a0d 539 return MEMS_ERROR;
cparata 0:489965565a0d 540
cparata 0:489965565a0d 541 *value &= LSM303AGR_MAG_ODR_MASK; //mask
cparata 0:489965565a0d 542
cparata 0:489965565a0d 543 return MEMS_SUCCESS;
cparata 0:489965565a0d 544 }
cparata 0:489965565a0d 545 /*******************************************************************************
cparata 0:489965565a0d 546 * Function Name : LSM303AGR_MAG_W_LP
cparata 0:489965565a0d 547 * Description : Write LP
cparata 0:489965565a0d 548 * Input : LSM303AGR_MAG_LP_t
cparata 0:489965565a0d 549 * Output : None
cparata 0:489965565a0d 550 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 551 *******************************************************************************/
cparata 0:489965565a0d 552 status_t LSM303AGR_MAG_W_LP(void *handle, LSM303AGR_MAG_LP_t newValue)
cparata 0:489965565a0d 553 {
cparata 0:489965565a0d 554 u8_t value;
cparata 0:489965565a0d 555
cparata 0:489965565a0d 556 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_CFG_REG_A, &value) )
cparata 0:489965565a0d 557 return MEMS_ERROR;
cparata 0:489965565a0d 558
cparata 0:489965565a0d 559 value &= ~LSM303AGR_MAG_LP_MASK;
cparata 0:489965565a0d 560 value |= newValue;
cparata 0:489965565a0d 561
cparata 0:489965565a0d 562 if( !LSM303AGR_MAG_WriteReg(handle, LSM303AGR_MAG_CFG_REG_A, value) )
cparata 0:489965565a0d 563 return MEMS_ERROR;
cparata 0:489965565a0d 564
cparata 0:489965565a0d 565 return MEMS_SUCCESS;
cparata 0:489965565a0d 566 }
cparata 0:489965565a0d 567
cparata 0:489965565a0d 568 /*******************************************************************************
cparata 0:489965565a0d 569 * Function Name : LSM303AGR_MAG_R_LP
cparata 0:489965565a0d 570 * Description : Read LP
cparata 0:489965565a0d 571 * Input : Pointer to LSM303AGR_MAG_LP_t
cparata 0:489965565a0d 572 * Output : Status of LP see LSM303AGR_MAG_LP_t
cparata 0:489965565a0d 573 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 574 *******************************************************************************/
cparata 0:489965565a0d 575
cparata 0:489965565a0d 576 status_t LSM303AGR_MAG_R_LP(void *handle, LSM303AGR_MAG_LP_t *value)
cparata 0:489965565a0d 577 {
cparata 0:489965565a0d 578 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_CFG_REG_A, (u8_t *)value) )
cparata 0:489965565a0d 579 return MEMS_ERROR;
cparata 0:489965565a0d 580
cparata 0:489965565a0d 581 *value &= LSM303AGR_MAG_LP_MASK; //mask
cparata 0:489965565a0d 582
cparata 0:489965565a0d 583 return MEMS_SUCCESS;
cparata 0:489965565a0d 584 }
cparata 0:489965565a0d 585 /*******************************************************************************
cparata 0:489965565a0d 586 * Function Name : LSM303AGR_MAG_W_SOFT_RST
cparata 0:489965565a0d 587 * Description : Write SOFT_RST
cparata 0:489965565a0d 588 * Input : LSM303AGR_MAG_SOFT_RST_t
cparata 0:489965565a0d 589 * Output : None
cparata 0:489965565a0d 590 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 591 *******************************************************************************/
cparata 0:489965565a0d 592 status_t LSM303AGR_MAG_W_SOFT_RST(void *handle, LSM303AGR_MAG_SOFT_RST_t newValue)
cparata 0:489965565a0d 593 {
cparata 0:489965565a0d 594 u8_t value;
cparata 0:489965565a0d 595
cparata 0:489965565a0d 596 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_CFG_REG_A, &value) )
cparata 0:489965565a0d 597 return MEMS_ERROR;
cparata 0:489965565a0d 598
cparata 0:489965565a0d 599 value &= ~LSM303AGR_MAG_SOFT_RST_MASK;
cparata 0:489965565a0d 600 value |= newValue;
cparata 0:489965565a0d 601
cparata 0:489965565a0d 602 if( !LSM303AGR_MAG_WriteReg(handle, LSM303AGR_MAG_CFG_REG_A, value) )
cparata 0:489965565a0d 603 return MEMS_ERROR;
cparata 0:489965565a0d 604
cparata 0:489965565a0d 605 return MEMS_SUCCESS;
cparata 0:489965565a0d 606 }
cparata 0:489965565a0d 607
cparata 0:489965565a0d 608 /*******************************************************************************
cparata 0:489965565a0d 609 * Function Name : LSM303AGR_MAG_R_SOFT_RST
cparata 0:489965565a0d 610 * Description : Read SOFT_RST
cparata 0:489965565a0d 611 * Input : Pointer to LSM303AGR_MAG_SOFT_RST_t
cparata 0:489965565a0d 612 * Output : Status of SOFT_RST see LSM303AGR_MAG_SOFT_RST_t
cparata 0:489965565a0d 613 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 614 *******************************************************************************/
cparata 0:489965565a0d 615
cparata 0:489965565a0d 616 status_t LSM303AGR_MAG_R_SOFT_RST(void *handle, LSM303AGR_MAG_SOFT_RST_t *value)
cparata 0:489965565a0d 617 {
cparata 0:489965565a0d 618 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_CFG_REG_A, (u8_t *)value) )
cparata 0:489965565a0d 619 return MEMS_ERROR;
cparata 0:489965565a0d 620
cparata 0:489965565a0d 621 *value &= LSM303AGR_MAG_SOFT_RST_MASK; //mask
cparata 0:489965565a0d 622
cparata 0:489965565a0d 623 return MEMS_SUCCESS;
cparata 0:489965565a0d 624 }
cparata 0:489965565a0d 625 /*******************************************************************************
cparata 0:489965565a0d 626 * Function Name : LSM303AGR_MAG_W_LPF
cparata 0:489965565a0d 627 * Description : Write LPF
cparata 0:489965565a0d 628 * Input : LSM303AGR_MAG_LPF_t
cparata 0:489965565a0d 629 * Output : None
cparata 0:489965565a0d 630 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 631 *******************************************************************************/
cparata 0:489965565a0d 632 status_t LSM303AGR_MAG_W_LPF(void *handle, LSM303AGR_MAG_LPF_t newValue)
cparata 0:489965565a0d 633 {
cparata 0:489965565a0d 634 u8_t value;
cparata 0:489965565a0d 635
cparata 0:489965565a0d 636 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_CFG_REG_B, &value) )
cparata 0:489965565a0d 637 return MEMS_ERROR;
cparata 0:489965565a0d 638
cparata 0:489965565a0d 639 value &= ~LSM303AGR_MAG_LPF_MASK;
cparata 0:489965565a0d 640 value |= newValue;
cparata 0:489965565a0d 641
cparata 0:489965565a0d 642 if( !LSM303AGR_MAG_WriteReg(handle, LSM303AGR_MAG_CFG_REG_B, value) )
cparata 0:489965565a0d 643 return MEMS_ERROR;
cparata 0:489965565a0d 644
cparata 0:489965565a0d 645 return MEMS_SUCCESS;
cparata 0:489965565a0d 646 }
cparata 0:489965565a0d 647
cparata 0:489965565a0d 648 /*******************************************************************************
cparata 0:489965565a0d 649 * Function Name : LSM303AGR_MAG_R_LPF
cparata 0:489965565a0d 650 * Description : Read LPF
cparata 0:489965565a0d 651 * Input : Pointer to LSM303AGR_MAG_LPF_t
cparata 0:489965565a0d 652 * Output : Status of LPF see LSM303AGR_MAG_LPF_t
cparata 0:489965565a0d 653 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 654 *******************************************************************************/
cparata 0:489965565a0d 655
cparata 0:489965565a0d 656 status_t LSM303AGR_MAG_R_LPF(void *handle, LSM303AGR_MAG_LPF_t *value)
cparata 0:489965565a0d 657 {
cparata 0:489965565a0d 658 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_CFG_REG_B, (u8_t *)value) )
cparata 0:489965565a0d 659 return MEMS_ERROR;
cparata 0:489965565a0d 660
cparata 0:489965565a0d 661 *value &= LSM303AGR_MAG_LPF_MASK; //mask
cparata 0:489965565a0d 662
cparata 0:489965565a0d 663 return MEMS_SUCCESS;
cparata 0:489965565a0d 664 }
cparata 0:489965565a0d 665 /*******************************************************************************
cparata 0:489965565a0d 666 * Function Name : LSM303AGR_MAG_W_OFF_CANC
cparata 0:489965565a0d 667 * Description : Write OFF_CANC
cparata 0:489965565a0d 668 * Input : LSM303AGR_MAG_OFF_CANC_t
cparata 0:489965565a0d 669 * Output : None
cparata 0:489965565a0d 670 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 671 *******************************************************************************/
cparata 0:489965565a0d 672 status_t LSM303AGR_MAG_W_OFF_CANC(void *handle, LSM303AGR_MAG_OFF_CANC_t newValue)
cparata 0:489965565a0d 673 {
cparata 0:489965565a0d 674 u8_t value;
cparata 0:489965565a0d 675
cparata 0:489965565a0d 676 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_CFG_REG_B, &value) )
cparata 0:489965565a0d 677 return MEMS_ERROR;
cparata 0:489965565a0d 678
cparata 0:489965565a0d 679 value &= ~LSM303AGR_MAG_OFF_CANC_MASK;
cparata 0:489965565a0d 680 value |= newValue;
cparata 0:489965565a0d 681
cparata 0:489965565a0d 682 if( !LSM303AGR_MAG_WriteReg(handle, LSM303AGR_MAG_CFG_REG_B, value) )
cparata 0:489965565a0d 683 return MEMS_ERROR;
cparata 0:489965565a0d 684
cparata 0:489965565a0d 685 return MEMS_SUCCESS;
cparata 0:489965565a0d 686 }
cparata 0:489965565a0d 687
cparata 0:489965565a0d 688 /*******************************************************************************
cparata 0:489965565a0d 689 * Function Name : LSM303AGR_MAG_R_OFF_CANC
cparata 0:489965565a0d 690 * Description : Read OFF_CANC
cparata 0:489965565a0d 691 * Input : Pointer to LSM303AGR_MAG_OFF_CANC_t
cparata 0:489965565a0d 692 * Output : Status of OFF_CANC see LSM303AGR_MAG_OFF_CANC_t
cparata 0:489965565a0d 693 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 694 *******************************************************************************/
cparata 0:489965565a0d 695
cparata 0:489965565a0d 696 status_t LSM303AGR_MAG_R_OFF_CANC(void *handle, LSM303AGR_MAG_OFF_CANC_t *value)
cparata 0:489965565a0d 697 {
cparata 0:489965565a0d 698 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_CFG_REG_B, (u8_t *)value) )
cparata 0:489965565a0d 699 return MEMS_ERROR;
cparata 0:489965565a0d 700
cparata 0:489965565a0d 701 *value &= LSM303AGR_MAG_OFF_CANC_MASK; //mask
cparata 0:489965565a0d 702
cparata 0:489965565a0d 703 return MEMS_SUCCESS;
cparata 0:489965565a0d 704 }
cparata 0:489965565a0d 705 /*******************************************************************************
cparata 0:489965565a0d 706 * Function Name : LSM303AGR_MAG_W_SET_FREQ
cparata 0:489965565a0d 707 * Description : Write SET_FREQ
cparata 0:489965565a0d 708 * Input : LSM303AGR_MAG_SET_FREQ_t
cparata 0:489965565a0d 709 * Output : None
cparata 0:489965565a0d 710 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 711 *******************************************************************************/
cparata 0:489965565a0d 712 status_t LSM303AGR_MAG_W_SET_FREQ(void *handle, LSM303AGR_MAG_SET_FREQ_t newValue)
cparata 0:489965565a0d 713 {
cparata 0:489965565a0d 714 u8_t value;
cparata 0:489965565a0d 715
cparata 0:489965565a0d 716 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_CFG_REG_B, &value) )
cparata 0:489965565a0d 717 return MEMS_ERROR;
cparata 0:489965565a0d 718
cparata 0:489965565a0d 719 value &= ~LSM303AGR_MAG_SET_FREQ_MASK;
cparata 0:489965565a0d 720 value |= newValue;
cparata 0:489965565a0d 721
cparata 0:489965565a0d 722 if( !LSM303AGR_MAG_WriteReg(handle, LSM303AGR_MAG_CFG_REG_B, value) )
cparata 0:489965565a0d 723 return MEMS_ERROR;
cparata 0:489965565a0d 724
cparata 0:489965565a0d 725 return MEMS_SUCCESS;
cparata 0:489965565a0d 726 }
cparata 0:489965565a0d 727
cparata 0:489965565a0d 728 /*******************************************************************************
cparata 0:489965565a0d 729 * Function Name : LSM303AGR_MAG_R_SET_FREQ
cparata 0:489965565a0d 730 * Description : Read SET_FREQ
cparata 0:489965565a0d 731 * Input : Pointer to LSM303AGR_MAG_SET_FREQ_t
cparata 0:489965565a0d 732 * Output : Status of SET_FREQ see LSM303AGR_MAG_SET_FREQ_t
cparata 0:489965565a0d 733 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 734 *******************************************************************************/
cparata 0:489965565a0d 735
cparata 0:489965565a0d 736 status_t LSM303AGR_MAG_R_SET_FREQ(void *handle, LSM303AGR_MAG_SET_FREQ_t *value)
cparata 0:489965565a0d 737 {
cparata 0:489965565a0d 738 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_CFG_REG_B, (u8_t *)value) )
cparata 0:489965565a0d 739 return MEMS_ERROR;
cparata 0:489965565a0d 740
cparata 0:489965565a0d 741 *value &= LSM303AGR_MAG_SET_FREQ_MASK; //mask
cparata 0:489965565a0d 742
cparata 0:489965565a0d 743 return MEMS_SUCCESS;
cparata 0:489965565a0d 744 }
cparata 0:489965565a0d 745 /*******************************************************************************
cparata 0:489965565a0d 746 * Function Name : LSM303AGR_MAG_W_INT_ON_DATAOFF
cparata 0:489965565a0d 747 * Description : Write INT_ON_DATAOFF
cparata 0:489965565a0d 748 * Input : LSM303AGR_MAG_INT_ON_DATAOFF_t
cparata 0:489965565a0d 749 * Output : None
cparata 0:489965565a0d 750 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 751 *******************************************************************************/
cparata 0:489965565a0d 752 status_t LSM303AGR_MAG_W_INT_ON_DATAOFF(void *handle, LSM303AGR_MAG_INT_ON_DATAOFF_t newValue)
cparata 0:489965565a0d 753 {
cparata 0:489965565a0d 754 u8_t value;
cparata 0:489965565a0d 755
cparata 0:489965565a0d 756 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_CFG_REG_B, &value) )
cparata 0:489965565a0d 757 return MEMS_ERROR;
cparata 0:489965565a0d 758
cparata 0:489965565a0d 759 value &= ~LSM303AGR_MAG_INT_ON_DATAOFF_MASK;
cparata 0:489965565a0d 760 value |= newValue;
cparata 0:489965565a0d 761
cparata 0:489965565a0d 762 if( !LSM303AGR_MAG_WriteReg(handle, LSM303AGR_MAG_CFG_REG_B, value) )
cparata 0:489965565a0d 763 return MEMS_ERROR;
cparata 0:489965565a0d 764
cparata 0:489965565a0d 765 return MEMS_SUCCESS;
cparata 0:489965565a0d 766 }
cparata 0:489965565a0d 767
cparata 0:489965565a0d 768 /*******************************************************************************
cparata 0:489965565a0d 769 * Function Name : LSM303AGR_MAG_R_INT_ON_DATAOFF
cparata 0:489965565a0d 770 * Description : Read INT_ON_DATAOFF
cparata 0:489965565a0d 771 * Input : Pointer to LSM303AGR_MAG_INT_ON_DATAOFF_t
cparata 0:489965565a0d 772 * Output : Status of INT_ON_DATAOFF see LSM303AGR_MAG_INT_ON_DATAOFF_t
cparata 0:489965565a0d 773 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 774 *******************************************************************************/
cparata 0:489965565a0d 775
cparata 0:489965565a0d 776 status_t LSM303AGR_MAG_R_INT_ON_DATAOFF(void *handle, LSM303AGR_MAG_INT_ON_DATAOFF_t *value)
cparata 0:489965565a0d 777 {
cparata 0:489965565a0d 778 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_CFG_REG_B, (u8_t *)value) )
cparata 0:489965565a0d 779 return MEMS_ERROR;
cparata 0:489965565a0d 780
cparata 0:489965565a0d 781 *value &= LSM303AGR_MAG_INT_ON_DATAOFF_MASK; //mask
cparata 0:489965565a0d 782
cparata 0:489965565a0d 783 return MEMS_SUCCESS;
cparata 0:489965565a0d 784 }
cparata 0:489965565a0d 785 /*******************************************************************************
cparata 0:489965565a0d 786 * Function Name : LSM303AGR_MAG_W_INT_MAG
cparata 0:489965565a0d 787 * Description : Write INT_MAG
cparata 0:489965565a0d 788 * Input : LSM303AGR_MAG_INT_MAG_t
cparata 0:489965565a0d 789 * Output : None
cparata 0:489965565a0d 790 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 791 *******************************************************************************/
cparata 0:489965565a0d 792 status_t LSM303AGR_MAG_W_INT_MAG(void *handle, LSM303AGR_MAG_INT_MAG_t newValue)
cparata 0:489965565a0d 793 {
cparata 0:489965565a0d 794 u8_t value;
cparata 0:489965565a0d 795
cparata 0:489965565a0d 796 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_CFG_REG_C, &value) )
cparata 0:489965565a0d 797 return MEMS_ERROR;
cparata 0:489965565a0d 798
cparata 0:489965565a0d 799 value &= ~LSM303AGR_MAG_INT_MAG_MASK;
cparata 0:489965565a0d 800 value |= newValue;
cparata 0:489965565a0d 801
cparata 0:489965565a0d 802 if( !LSM303AGR_MAG_WriteReg(handle, LSM303AGR_MAG_CFG_REG_C, value) )
cparata 0:489965565a0d 803 return MEMS_ERROR;
cparata 0:489965565a0d 804
cparata 0:489965565a0d 805 return MEMS_SUCCESS;
cparata 0:489965565a0d 806 }
cparata 0:489965565a0d 807
cparata 0:489965565a0d 808 /*******************************************************************************
cparata 0:489965565a0d 809 * Function Name : LSM303AGR_MAG_R_INT_MAG
cparata 0:489965565a0d 810 * Description : Read INT_MAG
cparata 0:489965565a0d 811 * Input : Pointer to LSM303AGR_MAG_INT_MAG_t
cparata 0:489965565a0d 812 * Output : Status of INT_MAG see LSM303AGR_MAG_INT_MAG_t
cparata 0:489965565a0d 813 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 814 *******************************************************************************/
cparata 0:489965565a0d 815
cparata 0:489965565a0d 816 status_t LSM303AGR_MAG_R_INT_MAG(void *handle, LSM303AGR_MAG_INT_MAG_t *value)
cparata 0:489965565a0d 817 {
cparata 0:489965565a0d 818 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_CFG_REG_C, (u8_t *)value) )
cparata 0:489965565a0d 819 return MEMS_ERROR;
cparata 0:489965565a0d 820
cparata 0:489965565a0d 821 *value &= LSM303AGR_MAG_INT_MAG_MASK; //mask
cparata 0:489965565a0d 822
cparata 0:489965565a0d 823 return MEMS_SUCCESS;
cparata 0:489965565a0d 824 }
cparata 0:489965565a0d 825 /*******************************************************************************
cparata 0:489965565a0d 826 * Function Name : LSM303AGR_MAG_W_ST
cparata 0:489965565a0d 827 * Description : Write ST
cparata 0:489965565a0d 828 * Input : LSM303AGR_MAG_ST_t
cparata 0:489965565a0d 829 * Output : None
cparata 0:489965565a0d 830 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 831 *******************************************************************************/
cparata 0:489965565a0d 832 status_t LSM303AGR_MAG_W_ST(void *handle, LSM303AGR_MAG_ST_t newValue)
cparata 0:489965565a0d 833 {
cparata 0:489965565a0d 834 u8_t value;
cparata 0:489965565a0d 835
cparata 0:489965565a0d 836 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_CFG_REG_C, &value) )
cparata 0:489965565a0d 837 return MEMS_ERROR;
cparata 0:489965565a0d 838
cparata 0:489965565a0d 839 value &= ~LSM303AGR_MAG_ST_MASK;
cparata 0:489965565a0d 840 value |= newValue;
cparata 0:489965565a0d 841
cparata 0:489965565a0d 842 if( !LSM303AGR_MAG_WriteReg(handle, LSM303AGR_MAG_CFG_REG_C, value) )
cparata 0:489965565a0d 843 return MEMS_ERROR;
cparata 0:489965565a0d 844
cparata 0:489965565a0d 845 return MEMS_SUCCESS;
cparata 0:489965565a0d 846 }
cparata 0:489965565a0d 847
cparata 0:489965565a0d 848 /*******************************************************************************
cparata 0:489965565a0d 849 * Function Name : LSM303AGR_MAG_R_ST
cparata 0:489965565a0d 850 * Description : Read ST
cparata 0:489965565a0d 851 * Input : Pointer to LSM303AGR_MAG_ST_t
cparata 0:489965565a0d 852 * Output : Status of ST see LSM303AGR_MAG_ST_t
cparata 0:489965565a0d 853 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 854 *******************************************************************************/
cparata 0:489965565a0d 855
cparata 0:489965565a0d 856 status_t LSM303AGR_MAG_R_ST(void *handle, LSM303AGR_MAG_ST_t *value)
cparata 0:489965565a0d 857 {
cparata 0:489965565a0d 858 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_CFG_REG_C, (u8_t *)value) )
cparata 0:489965565a0d 859 return MEMS_ERROR;
cparata 0:489965565a0d 860
cparata 0:489965565a0d 861 *value &= LSM303AGR_MAG_ST_MASK; //mask
cparata 0:489965565a0d 862
cparata 0:489965565a0d 863 return MEMS_SUCCESS;
cparata 0:489965565a0d 864 }
cparata 0:489965565a0d 865 /*******************************************************************************
cparata 0:489965565a0d 866 * Function Name : LSM303AGR_MAG_W_BLE
cparata 0:489965565a0d 867 * Description : Write BLE
cparata 0:489965565a0d 868 * Input : LSM303AGR_MAG_BLE_t
cparata 0:489965565a0d 869 * Output : None
cparata 0:489965565a0d 870 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 871 *******************************************************************************/
cparata 0:489965565a0d 872 status_t LSM303AGR_MAG_W_BLE(void *handle, LSM303AGR_MAG_BLE_t newValue)
cparata 0:489965565a0d 873 {
cparata 0:489965565a0d 874 u8_t value;
cparata 0:489965565a0d 875
cparata 0:489965565a0d 876 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_CFG_REG_C, &value) )
cparata 0:489965565a0d 877 return MEMS_ERROR;
cparata 0:489965565a0d 878
cparata 0:489965565a0d 879 value &= ~LSM303AGR_MAG_BLE_MASK;
cparata 0:489965565a0d 880 value |= newValue;
cparata 0:489965565a0d 881
cparata 0:489965565a0d 882 if( !LSM303AGR_MAG_WriteReg(handle, LSM303AGR_MAG_CFG_REG_C, value) )
cparata 0:489965565a0d 883 return MEMS_ERROR;
cparata 0:489965565a0d 884
cparata 0:489965565a0d 885 return MEMS_SUCCESS;
cparata 0:489965565a0d 886 }
cparata 0:489965565a0d 887
cparata 0:489965565a0d 888 /*******************************************************************************
cparata 0:489965565a0d 889 * Function Name : LSM303AGR_MAG_R_BLE
cparata 0:489965565a0d 890 * Description : Read BLE
cparata 0:489965565a0d 891 * Input : Pointer to LSM303AGR_MAG_BLE_t
cparata 0:489965565a0d 892 * Output : Status of BLE see LSM303AGR_MAG_BLE_t
cparata 0:489965565a0d 893 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 894 *******************************************************************************/
cparata 0:489965565a0d 895
cparata 0:489965565a0d 896 status_t LSM303AGR_MAG_R_BLE(void *handle, LSM303AGR_MAG_BLE_t *value)
cparata 0:489965565a0d 897 {
cparata 0:489965565a0d 898 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_CFG_REG_C, (u8_t *)value) )
cparata 0:489965565a0d 899 return MEMS_ERROR;
cparata 0:489965565a0d 900
cparata 0:489965565a0d 901 *value &= LSM303AGR_MAG_BLE_MASK; //mask
cparata 0:489965565a0d 902
cparata 0:489965565a0d 903 return MEMS_SUCCESS;
cparata 0:489965565a0d 904 }
cparata 0:489965565a0d 905 /*******************************************************************************
cparata 0:489965565a0d 906 * Function Name : LSM303AGR_MAG_W_BDU
cparata 0:489965565a0d 907 * Description : Write BDU
cparata 0:489965565a0d 908 * Input : LSM303AGR_MAG_BDU_t
cparata 0:489965565a0d 909 * Output : None
cparata 0:489965565a0d 910 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 911 *******************************************************************************/
cparata 0:489965565a0d 912 status_t LSM303AGR_MAG_W_BDU(void *handle, LSM303AGR_MAG_BDU_t newValue)
cparata 0:489965565a0d 913 {
cparata 0:489965565a0d 914 u8_t value;
cparata 0:489965565a0d 915
cparata 0:489965565a0d 916 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_CFG_REG_C, &value) )
cparata 0:489965565a0d 917 return MEMS_ERROR;
cparata 0:489965565a0d 918
cparata 0:489965565a0d 919 value &= ~LSM303AGR_MAG_BDU_MASK;
cparata 0:489965565a0d 920 value |= newValue;
cparata 0:489965565a0d 921
cparata 0:489965565a0d 922 if( !LSM303AGR_MAG_WriteReg(handle, LSM303AGR_MAG_CFG_REG_C, value) )
cparata 0:489965565a0d 923 return MEMS_ERROR;
cparata 0:489965565a0d 924
cparata 0:489965565a0d 925 return MEMS_SUCCESS;
cparata 0:489965565a0d 926 }
cparata 0:489965565a0d 927
cparata 0:489965565a0d 928 /*******************************************************************************
cparata 0:489965565a0d 929 * Function Name : LSM303AGR_MAG_R_BDU
cparata 0:489965565a0d 930 * Description : Read BDU
cparata 0:489965565a0d 931 * Input : Pointer to LSM303AGR_MAG_BDU_t
cparata 0:489965565a0d 932 * Output : Status of BDU see LSM303AGR_MAG_BDU_t
cparata 0:489965565a0d 933 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 934 *******************************************************************************/
cparata 0:489965565a0d 935
cparata 0:489965565a0d 936 status_t LSM303AGR_MAG_R_BDU(void *handle, LSM303AGR_MAG_BDU_t *value)
cparata 0:489965565a0d 937 {
cparata 0:489965565a0d 938 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_CFG_REG_C, (u8_t *)value) )
cparata 0:489965565a0d 939 return MEMS_ERROR;
cparata 0:489965565a0d 940
cparata 0:489965565a0d 941 *value &= LSM303AGR_MAG_BDU_MASK; //mask
cparata 0:489965565a0d 942
cparata 0:489965565a0d 943 return MEMS_SUCCESS;
cparata 0:489965565a0d 944 }
cparata 0:489965565a0d 945 /*******************************************************************************
cparata 0:489965565a0d 946 * Function Name : LSM303AGR_MAG_W_I2C_DIS
cparata 0:489965565a0d 947 * Description : Write I2C_DIS
cparata 0:489965565a0d 948 * Input : LSM303AGR_MAG_I2C_DIS_t
cparata 0:489965565a0d 949 * Output : None
cparata 0:489965565a0d 950 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 951 *******************************************************************************/
cparata 0:489965565a0d 952 status_t LSM303AGR_MAG_W_I2C_DIS(void *handle, LSM303AGR_MAG_I2C_DIS_t newValue)
cparata 0:489965565a0d 953 {
cparata 0:489965565a0d 954 u8_t value;
cparata 0:489965565a0d 955
cparata 0:489965565a0d 956 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_CFG_REG_C, &value) )
cparata 0:489965565a0d 957 return MEMS_ERROR;
cparata 0:489965565a0d 958
cparata 0:489965565a0d 959 value &= ~LSM303AGR_MAG_I2C_DIS_MASK;
cparata 0:489965565a0d 960 value |= newValue;
cparata 0:489965565a0d 961
cparata 0:489965565a0d 962 if( !LSM303AGR_MAG_WriteReg(handle, LSM303AGR_MAG_CFG_REG_C, value) )
cparata 0:489965565a0d 963 return MEMS_ERROR;
cparata 0:489965565a0d 964
cparata 0:489965565a0d 965 return MEMS_SUCCESS;
cparata 0:489965565a0d 966 }
cparata 0:489965565a0d 967
cparata 0:489965565a0d 968 /*******************************************************************************
cparata 0:489965565a0d 969 * Function Name : LSM303AGR_MAG_R_I2C_DIS
cparata 0:489965565a0d 970 * Description : Read I2C_DIS
cparata 0:489965565a0d 971 * Input : Pointer to LSM303AGR_MAG_I2C_DIS_t
cparata 0:489965565a0d 972 * Output : Status of I2C_DIS see LSM303AGR_MAG_I2C_DIS_t
cparata 0:489965565a0d 973 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 974 *******************************************************************************/
cparata 0:489965565a0d 975
cparata 0:489965565a0d 976 status_t LSM303AGR_MAG_R_I2C_DIS(void *handle, LSM303AGR_MAG_I2C_DIS_t *value)
cparata 0:489965565a0d 977 {
cparata 0:489965565a0d 978 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_CFG_REG_C, (u8_t *)value) )
cparata 0:489965565a0d 979 return MEMS_ERROR;
cparata 0:489965565a0d 980
cparata 0:489965565a0d 981 *value &= LSM303AGR_MAG_I2C_DIS_MASK; //mask
cparata 0:489965565a0d 982
cparata 0:489965565a0d 983 return MEMS_SUCCESS;
cparata 0:489965565a0d 984 }
cparata 0:489965565a0d 985 /*******************************************************************************
cparata 0:489965565a0d 986 * Function Name : LSM303AGR_MAG_W_INT_MAG_PIN
cparata 0:489965565a0d 987 * Description : Write INT_MAG_PIN
cparata 0:489965565a0d 988 * Input : LSM303AGR_MAG_INT_MAG_PIN_t
cparata 0:489965565a0d 989 * Output : None
cparata 0:489965565a0d 990 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 991 *******************************************************************************/
cparata 0:489965565a0d 992 status_t LSM303AGR_MAG_W_INT_MAG_PIN(void *handle, LSM303AGR_MAG_INT_MAG_PIN_t newValue)
cparata 0:489965565a0d 993 {
cparata 0:489965565a0d 994 u8_t value;
cparata 0:489965565a0d 995
cparata 0:489965565a0d 996 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_CFG_REG_C, &value) )
cparata 0:489965565a0d 997 return MEMS_ERROR;
cparata 0:489965565a0d 998
cparata 0:489965565a0d 999 value &= ~LSM303AGR_MAG_INT_MAG_PIN_MASK;
cparata 0:489965565a0d 1000 value |= newValue;
cparata 0:489965565a0d 1001
cparata 0:489965565a0d 1002 if( !LSM303AGR_MAG_WriteReg(handle, LSM303AGR_MAG_CFG_REG_C, value) )
cparata 0:489965565a0d 1003 return MEMS_ERROR;
cparata 0:489965565a0d 1004
cparata 0:489965565a0d 1005 return MEMS_SUCCESS;
cparata 0:489965565a0d 1006 }
cparata 0:489965565a0d 1007
cparata 0:489965565a0d 1008 /*******************************************************************************
cparata 0:489965565a0d 1009 * Function Name : LSM303AGR_MAG_R_INT_MAG_PIN
cparata 0:489965565a0d 1010 * Description : Read INT_MAG_PIN
cparata 0:489965565a0d 1011 * Input : Pointer to LSM303AGR_MAG_INT_MAG_PIN_t
cparata 0:489965565a0d 1012 * Output : Status of INT_MAG_PIN see LSM303AGR_MAG_INT_MAG_PIN_t
cparata 0:489965565a0d 1013 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 1014 *******************************************************************************/
cparata 0:489965565a0d 1015
cparata 0:489965565a0d 1016 status_t LSM303AGR_MAG_R_INT_MAG_PIN(void *handle, LSM303AGR_MAG_INT_MAG_PIN_t *value)
cparata 0:489965565a0d 1017 {
cparata 0:489965565a0d 1018 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_CFG_REG_C, (u8_t *)value) )
cparata 0:489965565a0d 1019 return MEMS_ERROR;
cparata 0:489965565a0d 1020
cparata 0:489965565a0d 1021 *value &= LSM303AGR_MAG_INT_MAG_PIN_MASK; //mask
cparata 0:489965565a0d 1022
cparata 0:489965565a0d 1023 return MEMS_SUCCESS;
cparata 0:489965565a0d 1024 }
cparata 0:489965565a0d 1025 /*******************************************************************************
cparata 0:489965565a0d 1026 * Function Name : LSM303AGR_MAG_W_IEN
cparata 0:489965565a0d 1027 * Description : Write IEN
cparata 0:489965565a0d 1028 * Input : LSM303AGR_MAG_IEN_t
cparata 0:489965565a0d 1029 * Output : None
cparata 0:489965565a0d 1030 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 1031 *******************************************************************************/
cparata 0:489965565a0d 1032 status_t LSM303AGR_MAG_W_IEN(void *handle, LSM303AGR_MAG_IEN_t newValue)
cparata 0:489965565a0d 1033 {
cparata 0:489965565a0d 1034 u8_t value;
cparata 0:489965565a0d 1035
cparata 0:489965565a0d 1036 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_INT_CTRL_REG, &value) )
cparata 0:489965565a0d 1037 return MEMS_ERROR;
cparata 0:489965565a0d 1038
cparata 0:489965565a0d 1039 value &= ~LSM303AGR_MAG_IEN_MASK;
cparata 0:489965565a0d 1040 value |= newValue;
cparata 0:489965565a0d 1041
cparata 0:489965565a0d 1042 if( !LSM303AGR_MAG_WriteReg(handle, LSM303AGR_MAG_INT_CTRL_REG, value) )
cparata 0:489965565a0d 1043 return MEMS_ERROR;
cparata 0:489965565a0d 1044
cparata 0:489965565a0d 1045 return MEMS_SUCCESS;
cparata 0:489965565a0d 1046 }
cparata 0:489965565a0d 1047
cparata 0:489965565a0d 1048 /*******************************************************************************
cparata 0:489965565a0d 1049 * Function Name : LSM303AGR_MAG_R_IEN
cparata 0:489965565a0d 1050 * Description : Read IEN
cparata 0:489965565a0d 1051 * Input : Pointer to LSM303AGR_MAG_IEN_t
cparata 0:489965565a0d 1052 * Output : Status of IEN see LSM303AGR_MAG_IEN_t
cparata 0:489965565a0d 1053 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 1054 *******************************************************************************/
cparata 0:489965565a0d 1055
cparata 0:489965565a0d 1056 status_t LSM303AGR_MAG_R_IEN(void *handle, LSM303AGR_MAG_IEN_t *value)
cparata 0:489965565a0d 1057 {
cparata 0:489965565a0d 1058 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_INT_CTRL_REG, (u8_t *)value) )
cparata 0:489965565a0d 1059 return MEMS_ERROR;
cparata 0:489965565a0d 1060
cparata 0:489965565a0d 1061 *value &= LSM303AGR_MAG_IEN_MASK; //mask
cparata 0:489965565a0d 1062
cparata 0:489965565a0d 1063 return MEMS_SUCCESS;
cparata 0:489965565a0d 1064 }
cparata 0:489965565a0d 1065 /*******************************************************************************
cparata 0:489965565a0d 1066 * Function Name : LSM303AGR_MAG_W_IEL
cparata 0:489965565a0d 1067 * Description : Write IEL
cparata 0:489965565a0d 1068 * Input : LSM303AGR_MAG_IEL_t
cparata 0:489965565a0d 1069 * Output : None
cparata 0:489965565a0d 1070 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 1071 *******************************************************************************/
cparata 0:489965565a0d 1072 status_t LSM303AGR_MAG_W_IEL(void *handle, LSM303AGR_MAG_IEL_t newValue)
cparata 0:489965565a0d 1073 {
cparata 0:489965565a0d 1074 u8_t value;
cparata 0:489965565a0d 1075
cparata 0:489965565a0d 1076 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_INT_CTRL_REG, &value) )
cparata 0:489965565a0d 1077 return MEMS_ERROR;
cparata 0:489965565a0d 1078
cparata 0:489965565a0d 1079 value &= ~LSM303AGR_MAG_IEL_MASK;
cparata 0:489965565a0d 1080 value |= newValue;
cparata 0:489965565a0d 1081
cparata 0:489965565a0d 1082 if( !LSM303AGR_MAG_WriteReg(handle, LSM303AGR_MAG_INT_CTRL_REG, value) )
cparata 0:489965565a0d 1083 return MEMS_ERROR;
cparata 0:489965565a0d 1084
cparata 0:489965565a0d 1085 return MEMS_SUCCESS;
cparata 0:489965565a0d 1086 }
cparata 0:489965565a0d 1087
cparata 0:489965565a0d 1088 /*******************************************************************************
cparata 0:489965565a0d 1089 * Function Name : LSM303AGR_MAG_R_IEL
cparata 0:489965565a0d 1090 * Description : Read IEL
cparata 0:489965565a0d 1091 * Input : Pointer to LSM303AGR_MAG_IEL_t
cparata 0:489965565a0d 1092 * Output : Status of IEL see LSM303AGR_MAG_IEL_t
cparata 0:489965565a0d 1093 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 1094 *******************************************************************************/
cparata 0:489965565a0d 1095
cparata 0:489965565a0d 1096 status_t LSM303AGR_MAG_R_IEL(void *handle, LSM303AGR_MAG_IEL_t *value)
cparata 0:489965565a0d 1097 {
cparata 0:489965565a0d 1098 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_INT_CTRL_REG, (u8_t *)value) )
cparata 0:489965565a0d 1099 return MEMS_ERROR;
cparata 0:489965565a0d 1100
cparata 0:489965565a0d 1101 *value &= LSM303AGR_MAG_IEL_MASK; //mask
cparata 0:489965565a0d 1102
cparata 0:489965565a0d 1103 return MEMS_SUCCESS;
cparata 0:489965565a0d 1104 }
cparata 0:489965565a0d 1105 /*******************************************************************************
cparata 0:489965565a0d 1106 * Function Name : LSM303AGR_MAG_W_IEA
cparata 0:489965565a0d 1107 * Description : Write IEA
cparata 0:489965565a0d 1108 * Input : LSM303AGR_MAG_IEA_t
cparata 0:489965565a0d 1109 * Output : None
cparata 0:489965565a0d 1110 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 1111 *******************************************************************************/
cparata 0:489965565a0d 1112 status_t LSM303AGR_MAG_W_IEA(void *handle, LSM303AGR_MAG_IEA_t newValue)
cparata 0:489965565a0d 1113 {
cparata 0:489965565a0d 1114 u8_t value;
cparata 0:489965565a0d 1115
cparata 0:489965565a0d 1116 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_INT_CTRL_REG, &value) )
cparata 0:489965565a0d 1117 return MEMS_ERROR;
cparata 0:489965565a0d 1118
cparata 0:489965565a0d 1119 value &= ~LSM303AGR_MAG_IEA_MASK;
cparata 0:489965565a0d 1120 value |= newValue;
cparata 0:489965565a0d 1121
cparata 0:489965565a0d 1122 if( !LSM303AGR_MAG_WriteReg(handle, LSM303AGR_MAG_INT_CTRL_REG, value) )
cparata 0:489965565a0d 1123 return MEMS_ERROR;
cparata 0:489965565a0d 1124
cparata 0:489965565a0d 1125 return MEMS_SUCCESS;
cparata 0:489965565a0d 1126 }
cparata 0:489965565a0d 1127
cparata 0:489965565a0d 1128 /*******************************************************************************
cparata 0:489965565a0d 1129 * Function Name : LSM303AGR_MAG_R_IEA
cparata 0:489965565a0d 1130 * Description : Read IEA
cparata 0:489965565a0d 1131 * Input : Pointer to LSM303AGR_MAG_IEA_t
cparata 0:489965565a0d 1132 * Output : Status of IEA see LSM303AGR_MAG_IEA_t
cparata 0:489965565a0d 1133 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 1134 *******************************************************************************/
cparata 0:489965565a0d 1135
cparata 0:489965565a0d 1136 status_t LSM303AGR_MAG_R_IEA(void *handle, LSM303AGR_MAG_IEA_t *value)
cparata 0:489965565a0d 1137 {
cparata 0:489965565a0d 1138 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_INT_CTRL_REG, (u8_t *)value) )
cparata 0:489965565a0d 1139 return MEMS_ERROR;
cparata 0:489965565a0d 1140
cparata 0:489965565a0d 1141 *value &= LSM303AGR_MAG_IEA_MASK; //mask
cparata 0:489965565a0d 1142
cparata 0:489965565a0d 1143 return MEMS_SUCCESS;
cparata 0:489965565a0d 1144 }
cparata 0:489965565a0d 1145 /*******************************************************************************
cparata 0:489965565a0d 1146 * Function Name : LSM303AGR_MAG_W_ZIEN
cparata 0:489965565a0d 1147 * Description : Write ZIEN
cparata 0:489965565a0d 1148 * Input : LSM303AGR_MAG_ZIEN_t
cparata 0:489965565a0d 1149 * Output : None
cparata 0:489965565a0d 1150 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 1151 *******************************************************************************/
cparata 0:489965565a0d 1152 status_t LSM303AGR_MAG_W_ZIEN(void *handle, LSM303AGR_MAG_ZIEN_t newValue)
cparata 0:489965565a0d 1153 {
cparata 0:489965565a0d 1154 u8_t value;
cparata 0:489965565a0d 1155
cparata 0:489965565a0d 1156 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_INT_CTRL_REG, &value) )
cparata 0:489965565a0d 1157 return MEMS_ERROR;
cparata 0:489965565a0d 1158
cparata 0:489965565a0d 1159 value &= ~LSM303AGR_MAG_ZIEN_MASK;
cparata 0:489965565a0d 1160 value |= newValue;
cparata 0:489965565a0d 1161
cparata 0:489965565a0d 1162 if( !LSM303AGR_MAG_WriteReg(handle, LSM303AGR_MAG_INT_CTRL_REG, value) )
cparata 0:489965565a0d 1163 return MEMS_ERROR;
cparata 0:489965565a0d 1164
cparata 0:489965565a0d 1165 return MEMS_SUCCESS;
cparata 0:489965565a0d 1166 }
cparata 0:489965565a0d 1167
cparata 0:489965565a0d 1168 /*******************************************************************************
cparata 0:489965565a0d 1169 * Function Name : LSM303AGR_MAG_R_ZIEN
cparata 0:489965565a0d 1170 * Description : Read ZIEN
cparata 0:489965565a0d 1171 * Input : Pointer to LSM303AGR_MAG_ZIEN_t
cparata 0:489965565a0d 1172 * Output : Status of ZIEN see LSM303AGR_MAG_ZIEN_t
cparata 0:489965565a0d 1173 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 1174 *******************************************************************************/
cparata 0:489965565a0d 1175
cparata 0:489965565a0d 1176 status_t LSM303AGR_MAG_R_ZIEN(void *handle, LSM303AGR_MAG_ZIEN_t *value)
cparata 0:489965565a0d 1177 {
cparata 0:489965565a0d 1178 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_INT_CTRL_REG, (u8_t *)value) )
cparata 0:489965565a0d 1179 return MEMS_ERROR;
cparata 0:489965565a0d 1180
cparata 0:489965565a0d 1181 *value &= LSM303AGR_MAG_ZIEN_MASK; //mask
cparata 0:489965565a0d 1182
cparata 0:489965565a0d 1183 return MEMS_SUCCESS;
cparata 0:489965565a0d 1184 }
cparata 0:489965565a0d 1185 /*******************************************************************************
cparata 0:489965565a0d 1186 * Function Name : LSM303AGR_MAG_W_YIEN
cparata 0:489965565a0d 1187 * Description : Write YIEN
cparata 0:489965565a0d 1188 * Input : LSM303AGR_MAG_YIEN_t
cparata 0:489965565a0d 1189 * Output : None
cparata 0:489965565a0d 1190 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 1191 *******************************************************************************/
cparata 0:489965565a0d 1192 status_t LSM303AGR_MAG_W_YIEN(void *handle, LSM303AGR_MAG_YIEN_t newValue)
cparata 0:489965565a0d 1193 {
cparata 0:489965565a0d 1194 u8_t value;
cparata 0:489965565a0d 1195
cparata 0:489965565a0d 1196 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_INT_CTRL_REG, &value) )
cparata 0:489965565a0d 1197 return MEMS_ERROR;
cparata 0:489965565a0d 1198
cparata 0:489965565a0d 1199 value &= ~LSM303AGR_MAG_YIEN_MASK;
cparata 0:489965565a0d 1200 value |= newValue;
cparata 0:489965565a0d 1201
cparata 0:489965565a0d 1202 if( !LSM303AGR_MAG_WriteReg(handle, LSM303AGR_MAG_INT_CTRL_REG, value) )
cparata 0:489965565a0d 1203 return MEMS_ERROR;
cparata 0:489965565a0d 1204
cparata 0:489965565a0d 1205 return MEMS_SUCCESS;
cparata 0:489965565a0d 1206 }
cparata 0:489965565a0d 1207
cparata 0:489965565a0d 1208 /*******************************************************************************
cparata 0:489965565a0d 1209 * Function Name : LSM303AGR_MAG_R_YIEN
cparata 0:489965565a0d 1210 * Description : Read YIEN
cparata 0:489965565a0d 1211 * Input : Pointer to LSM303AGR_MAG_YIEN_t
cparata 0:489965565a0d 1212 * Output : Status of YIEN see LSM303AGR_MAG_YIEN_t
cparata 0:489965565a0d 1213 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 1214 *******************************************************************************/
cparata 0:489965565a0d 1215
cparata 0:489965565a0d 1216 status_t LSM303AGR_MAG_R_YIEN(void *handle, LSM303AGR_MAG_YIEN_t *value)
cparata 0:489965565a0d 1217 {
cparata 0:489965565a0d 1218 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_INT_CTRL_REG, (u8_t *)value) )
cparata 0:489965565a0d 1219 return MEMS_ERROR;
cparata 0:489965565a0d 1220
cparata 0:489965565a0d 1221 *value &= LSM303AGR_MAG_YIEN_MASK; //mask
cparata 0:489965565a0d 1222
cparata 0:489965565a0d 1223 return MEMS_SUCCESS;
cparata 0:489965565a0d 1224 }
cparata 0:489965565a0d 1225 /*******************************************************************************
cparata 0:489965565a0d 1226 * Function Name : LSM303AGR_MAG_W_XIEN
cparata 0:489965565a0d 1227 * Description : Write XIEN
cparata 0:489965565a0d 1228 * Input : LSM303AGR_MAG_XIEN_t
cparata 0:489965565a0d 1229 * Output : None
cparata 0:489965565a0d 1230 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 1231 *******************************************************************************/
cparata 0:489965565a0d 1232 status_t LSM303AGR_MAG_W_XIEN(void *handle, LSM303AGR_MAG_XIEN_t newValue)
cparata 0:489965565a0d 1233 {
cparata 0:489965565a0d 1234 u8_t value;
cparata 0:489965565a0d 1235
cparata 0:489965565a0d 1236 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_INT_CTRL_REG, &value) )
cparata 0:489965565a0d 1237 return MEMS_ERROR;
cparata 0:489965565a0d 1238
cparata 0:489965565a0d 1239 value &= ~LSM303AGR_MAG_XIEN_MASK;
cparata 0:489965565a0d 1240 value |= newValue;
cparata 0:489965565a0d 1241
cparata 0:489965565a0d 1242 if( !LSM303AGR_MAG_WriteReg(handle, LSM303AGR_MAG_INT_CTRL_REG, value) )
cparata 0:489965565a0d 1243 return MEMS_ERROR;
cparata 0:489965565a0d 1244
cparata 0:489965565a0d 1245 return MEMS_SUCCESS;
cparata 0:489965565a0d 1246 }
cparata 0:489965565a0d 1247
cparata 0:489965565a0d 1248 /*******************************************************************************
cparata 0:489965565a0d 1249 * Function Name : LSM303AGR_MAG_R_XIEN
cparata 0:489965565a0d 1250 * Description : Read XIEN
cparata 0:489965565a0d 1251 * Input : Pointer to LSM303AGR_MAG_XIEN_t
cparata 0:489965565a0d 1252 * Output : Status of XIEN see LSM303AGR_MAG_XIEN_t
cparata 0:489965565a0d 1253 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 1254 *******************************************************************************/
cparata 0:489965565a0d 1255
cparata 0:489965565a0d 1256 status_t LSM303AGR_MAG_R_XIEN(void *handle, LSM303AGR_MAG_XIEN_t *value)
cparata 0:489965565a0d 1257 {
cparata 0:489965565a0d 1258 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_INT_CTRL_REG, (u8_t *)value) )
cparata 0:489965565a0d 1259 return MEMS_ERROR;
cparata 0:489965565a0d 1260
cparata 0:489965565a0d 1261 *value &= LSM303AGR_MAG_XIEN_MASK; //mask
cparata 0:489965565a0d 1262
cparata 0:489965565a0d 1263 return MEMS_SUCCESS;
cparata 0:489965565a0d 1264 }
cparata 0:489965565a0d 1265 /*******************************************************************************
cparata 0:489965565a0d 1266 * Function Name : LSM303AGR_MAG_R_INT
cparata 0:489965565a0d 1267 * Description : Read INT
cparata 0:489965565a0d 1268 * Input : Pointer to LSM303AGR_MAG_INT_t
cparata 0:489965565a0d 1269 * Output : Status of INT see LSM303AGR_MAG_INT_t
cparata 0:489965565a0d 1270 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 1271 *******************************************************************************/
cparata 0:489965565a0d 1272
cparata 0:489965565a0d 1273 status_t LSM303AGR_MAG_R_INT(void *handle, LSM303AGR_MAG_INT_t *value)
cparata 0:489965565a0d 1274 {
cparata 0:489965565a0d 1275 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_INT_SOURCE_REG, (u8_t *)value) )
cparata 0:489965565a0d 1276 return MEMS_ERROR;
cparata 0:489965565a0d 1277
cparata 0:489965565a0d 1278 *value &= LSM303AGR_MAG_INT_MASK; //mask
cparata 0:489965565a0d 1279
cparata 0:489965565a0d 1280 return MEMS_SUCCESS;
cparata 0:489965565a0d 1281 }
cparata 0:489965565a0d 1282 /*******************************************************************************
cparata 0:489965565a0d 1283 * Function Name : LSM303AGR_MAG_R_MROI
cparata 0:489965565a0d 1284 * Description : Read MROI
cparata 0:489965565a0d 1285 * Input : Pointer to LSM303AGR_MAG_MROI_t
cparata 0:489965565a0d 1286 * Output : Status of MROI see LSM303AGR_MAG_MROI_t
cparata 0:489965565a0d 1287 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 1288 *******************************************************************************/
cparata 0:489965565a0d 1289
cparata 0:489965565a0d 1290 status_t LSM303AGR_MAG_R_MROI(void *handle, LSM303AGR_MAG_MROI_t *value)
cparata 0:489965565a0d 1291 {
cparata 0:489965565a0d 1292 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_INT_SOURCE_REG, (u8_t *)value) )
cparata 0:489965565a0d 1293 return MEMS_ERROR;
cparata 0:489965565a0d 1294
cparata 0:489965565a0d 1295 *value &= LSM303AGR_MAG_MROI_MASK; //mask
cparata 0:489965565a0d 1296
cparata 0:489965565a0d 1297 return MEMS_SUCCESS;
cparata 0:489965565a0d 1298 }
cparata 0:489965565a0d 1299 /*******************************************************************************
cparata 0:489965565a0d 1300 * Function Name : LSM303AGR_MAG_R_N_TH_S_Z
cparata 0:489965565a0d 1301 * Description : Read N_TH_S_Z
cparata 0:489965565a0d 1302 * Input : Pointer to LSM303AGR_MAG_N_TH_S_Z_t
cparata 0:489965565a0d 1303 * Output : Status of N_TH_S_Z see LSM303AGR_MAG_N_TH_S_Z_t
cparata 0:489965565a0d 1304 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 1305 *******************************************************************************/
cparata 0:489965565a0d 1306
cparata 0:489965565a0d 1307 status_t LSM303AGR_MAG_R_N_TH_S_Z(void *handle, LSM303AGR_MAG_N_TH_S_Z_t *value)
cparata 0:489965565a0d 1308 {
cparata 0:489965565a0d 1309 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_INT_SOURCE_REG, (u8_t *)value) )
cparata 0:489965565a0d 1310 return MEMS_ERROR;
cparata 0:489965565a0d 1311
cparata 0:489965565a0d 1312 *value &= LSM303AGR_MAG_N_TH_S_Z_MASK; //mask
cparata 0:489965565a0d 1313
cparata 0:489965565a0d 1314 return MEMS_SUCCESS;
cparata 0:489965565a0d 1315 }
cparata 0:489965565a0d 1316 /*******************************************************************************
cparata 0:489965565a0d 1317 * Function Name : LSM303AGR_MAG_R_N_TH_S_Y
cparata 0:489965565a0d 1318 * Description : Read N_TH_S_Y
cparata 0:489965565a0d 1319 * Input : Pointer to LSM303AGR_MAG_N_TH_S_Y_t
cparata 0:489965565a0d 1320 * Output : Status of N_TH_S_Y see LSM303AGR_MAG_N_TH_S_Y_t
cparata 0:489965565a0d 1321 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 1322 *******************************************************************************/
cparata 0:489965565a0d 1323
cparata 0:489965565a0d 1324 status_t LSM303AGR_MAG_R_N_TH_S_Y(void *handle, LSM303AGR_MAG_N_TH_S_Y_t *value)
cparata 0:489965565a0d 1325 {
cparata 0:489965565a0d 1326 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_INT_SOURCE_REG, (u8_t *)value) )
cparata 0:489965565a0d 1327 return MEMS_ERROR;
cparata 0:489965565a0d 1328
cparata 0:489965565a0d 1329 *value &= LSM303AGR_MAG_N_TH_S_Y_MASK; //mask
cparata 0:489965565a0d 1330
cparata 0:489965565a0d 1331 return MEMS_SUCCESS;
cparata 0:489965565a0d 1332 }
cparata 0:489965565a0d 1333 /*******************************************************************************
cparata 0:489965565a0d 1334 * Function Name : LSM303AGR_MAG_R_N_TH_S_X
cparata 0:489965565a0d 1335 * Description : Read N_TH_S_X
cparata 0:489965565a0d 1336 * Input : Pointer to LSM303AGR_MAG_N_TH_S_X_t
cparata 0:489965565a0d 1337 * Output : Status of N_TH_S_X see LSM303AGR_MAG_N_TH_S_X_t
cparata 0:489965565a0d 1338 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 1339 *******************************************************************************/
cparata 0:489965565a0d 1340
cparata 0:489965565a0d 1341 status_t LSM303AGR_MAG_R_N_TH_S_X(void *handle, LSM303AGR_MAG_N_TH_S_X_t *value)
cparata 0:489965565a0d 1342 {
cparata 0:489965565a0d 1343 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_INT_SOURCE_REG, (u8_t *)value) )
cparata 0:489965565a0d 1344 return MEMS_ERROR;
cparata 0:489965565a0d 1345
cparata 0:489965565a0d 1346 *value &= LSM303AGR_MAG_N_TH_S_X_MASK; //mask
cparata 0:489965565a0d 1347
cparata 0:489965565a0d 1348 return MEMS_SUCCESS;
cparata 0:489965565a0d 1349 }
cparata 0:489965565a0d 1350 /*******************************************************************************
cparata 0:489965565a0d 1351 * Function Name : LSM303AGR_MAG_R_P_TH_S_Z
cparata 0:489965565a0d 1352 * Description : Read P_TH_S_Z
cparata 0:489965565a0d 1353 * Input : Pointer to LSM303AGR_MAG_P_TH_S_Z_t
cparata 0:489965565a0d 1354 * Output : Status of P_TH_S_Z see LSM303AGR_MAG_P_TH_S_Z_t
cparata 0:489965565a0d 1355 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 1356 *******************************************************************************/
cparata 0:489965565a0d 1357
cparata 0:489965565a0d 1358 status_t LSM303AGR_MAG_R_P_TH_S_Z(void *handle, LSM303AGR_MAG_P_TH_S_Z_t *value)
cparata 0:489965565a0d 1359 {
cparata 0:489965565a0d 1360 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_INT_SOURCE_REG, (u8_t *)value) )
cparata 0:489965565a0d 1361 return MEMS_ERROR;
cparata 0:489965565a0d 1362
cparata 0:489965565a0d 1363 *value &= LSM303AGR_MAG_P_TH_S_Z_MASK; //mask
cparata 0:489965565a0d 1364
cparata 0:489965565a0d 1365 return MEMS_SUCCESS;
cparata 0:489965565a0d 1366 }
cparata 0:489965565a0d 1367 /*******************************************************************************
cparata 0:489965565a0d 1368 * Function Name : LSM303AGR_MAG_R_P_TH_S_Y
cparata 0:489965565a0d 1369 * Description : Read P_TH_S_Y
cparata 0:489965565a0d 1370 * Input : Pointer to LSM303AGR_MAG_P_TH_S_Y_t
cparata 0:489965565a0d 1371 * Output : Status of P_TH_S_Y see LSM303AGR_MAG_P_TH_S_Y_t
cparata 0:489965565a0d 1372 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 1373 *******************************************************************************/
cparata 0:489965565a0d 1374
cparata 0:489965565a0d 1375 status_t LSM303AGR_MAG_R_P_TH_S_Y(void *handle, LSM303AGR_MAG_P_TH_S_Y_t *value)
cparata 0:489965565a0d 1376 {
cparata 0:489965565a0d 1377 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_INT_SOURCE_REG, (u8_t *)value) )
cparata 0:489965565a0d 1378 return MEMS_ERROR;
cparata 0:489965565a0d 1379
cparata 0:489965565a0d 1380 *value &= LSM303AGR_MAG_P_TH_S_Y_MASK; //mask
cparata 0:489965565a0d 1381
cparata 0:489965565a0d 1382 return MEMS_SUCCESS;
cparata 0:489965565a0d 1383 }
cparata 0:489965565a0d 1384 /*******************************************************************************
cparata 0:489965565a0d 1385 * Function Name : LSM303AGR_MAG_R_P_TH_S_X
cparata 0:489965565a0d 1386 * Description : Read P_TH_S_X
cparata 0:489965565a0d 1387 * Input : Pointer to LSM303AGR_MAG_P_TH_S_X_t
cparata 0:489965565a0d 1388 * Output : Status of P_TH_S_X see LSM303AGR_MAG_P_TH_S_X_t
cparata 0:489965565a0d 1389 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 1390 *******************************************************************************/
cparata 0:489965565a0d 1391
cparata 0:489965565a0d 1392 status_t LSM303AGR_MAG_R_P_TH_S_X(void *handle, LSM303AGR_MAG_P_TH_S_X_t *value)
cparata 0:489965565a0d 1393 {
cparata 0:489965565a0d 1394 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_INT_SOURCE_REG, (u8_t *)value) )
cparata 0:489965565a0d 1395 return MEMS_ERROR;
cparata 0:489965565a0d 1396
cparata 0:489965565a0d 1397 *value &= LSM303AGR_MAG_P_TH_S_X_MASK; //mask
cparata 0:489965565a0d 1398
cparata 0:489965565a0d 1399 return MEMS_SUCCESS;
cparata 0:489965565a0d 1400 }
cparata 0:489965565a0d 1401
cparata 0:489965565a0d 1402 /*******************************************************************************
cparata 0:489965565a0d 1403 * Function Name : LSM303AGR_MAG_R_XDA
cparata 0:489965565a0d 1404 * Description : Read XDA
cparata 0:489965565a0d 1405 * Input : Pointer to LSM303AGR_MAG_XDA_t
cparata 0:489965565a0d 1406 * Output : Status of XDA see LSM303AGR_MAG_XDA_t
cparata 0:489965565a0d 1407 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 1408 *******************************************************************************/
cparata 0:489965565a0d 1409
cparata 0:489965565a0d 1410 status_t LSM303AGR_MAG_R_XDA(void *handle, LSM303AGR_MAG_XDA_t *value)
cparata 0:489965565a0d 1411 {
cparata 0:489965565a0d 1412 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_STATUS_REG, (u8_t *)value) )
cparata 0:489965565a0d 1413 return MEMS_ERROR;
cparata 0:489965565a0d 1414
cparata 0:489965565a0d 1415 *value &= LSM303AGR_MAG_XDA_MASK; //mask
cparata 0:489965565a0d 1416
cparata 0:489965565a0d 1417 return MEMS_SUCCESS;
cparata 0:489965565a0d 1418 }
cparata 0:489965565a0d 1419 /*******************************************************************************
cparata 0:489965565a0d 1420 * Function Name : LSM303AGR_MAG_R_YDA
cparata 0:489965565a0d 1421 * Description : Read YDA
cparata 0:489965565a0d 1422 * Input : Pointer to LSM303AGR_MAG_YDA_t
cparata 0:489965565a0d 1423 * Output : Status of YDA see LSM303AGR_MAG_YDA_t
cparata 0:489965565a0d 1424 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 1425 *******************************************************************************/
cparata 0:489965565a0d 1426
cparata 0:489965565a0d 1427 status_t LSM303AGR_MAG_R_YDA(void *handle, LSM303AGR_MAG_YDA_t *value)
cparata 0:489965565a0d 1428 {
cparata 0:489965565a0d 1429 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_STATUS_REG, (u8_t *)value) )
cparata 0:489965565a0d 1430 return MEMS_ERROR;
cparata 0:489965565a0d 1431
cparata 0:489965565a0d 1432 *value &= LSM303AGR_MAG_YDA_MASK; //mask
cparata 0:489965565a0d 1433
cparata 0:489965565a0d 1434 return MEMS_SUCCESS;
cparata 0:489965565a0d 1435 }
cparata 0:489965565a0d 1436 /*******************************************************************************
cparata 0:489965565a0d 1437 * Function Name : LSM303AGR_MAG_R_ZDA
cparata 0:489965565a0d 1438 * Description : Read ZDA
cparata 0:489965565a0d 1439 * Input : Pointer to LSM303AGR_MAG_ZDA_t
cparata 0:489965565a0d 1440 * Output : Status of ZDA see LSM303AGR_MAG_ZDA_t
cparata 0:489965565a0d 1441 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 1442 *******************************************************************************/
cparata 0:489965565a0d 1443
cparata 0:489965565a0d 1444 status_t LSM303AGR_MAG_R_ZDA(void *handle, LSM303AGR_MAG_ZDA_t *value)
cparata 0:489965565a0d 1445 {
cparata 0:489965565a0d 1446 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_STATUS_REG, (u8_t *)value) )
cparata 0:489965565a0d 1447 return MEMS_ERROR;
cparata 0:489965565a0d 1448
cparata 0:489965565a0d 1449 *value &= LSM303AGR_MAG_ZDA_MASK; //mask
cparata 0:489965565a0d 1450
cparata 0:489965565a0d 1451 return MEMS_SUCCESS;
cparata 0:489965565a0d 1452 }
cparata 0:489965565a0d 1453 /*******************************************************************************
cparata 0:489965565a0d 1454 * Function Name : LSM303AGR_MAG_R_ZYXDA
cparata 0:489965565a0d 1455 * Description : Read ZYXDA
cparata 0:489965565a0d 1456 * Input : Pointer to LSM303AGR_MAG_ZYXDA_t
cparata 0:489965565a0d 1457 * Output : Status of ZYXDA see LSM303AGR_MAG_ZYXDA_t
cparata 0:489965565a0d 1458 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 1459 *******************************************************************************/
cparata 0:489965565a0d 1460
cparata 0:489965565a0d 1461 status_t LSM303AGR_MAG_R_ZYXDA(void *handle, LSM303AGR_MAG_ZYXDA_t *value)
cparata 0:489965565a0d 1462 {
cparata 0:489965565a0d 1463 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_STATUS_REG, (u8_t *)value) )
cparata 0:489965565a0d 1464 return MEMS_ERROR;
cparata 0:489965565a0d 1465
cparata 0:489965565a0d 1466 *value &= LSM303AGR_MAG_ZYXDA_MASK; //mask
cparata 0:489965565a0d 1467
cparata 0:489965565a0d 1468 return MEMS_SUCCESS;
cparata 0:489965565a0d 1469 }
cparata 0:489965565a0d 1470 /*******************************************************************************
cparata 0:489965565a0d 1471 * Function Name : LSM303AGR_MAG_R_XOR
cparata 0:489965565a0d 1472 * Description : Read XOR
cparata 0:489965565a0d 1473 * Input : Pointer to LSM303AGR_MAG_XOR_t
cparata 0:489965565a0d 1474 * Output : Status of XOR see LSM303AGR_MAG_XOR_t
cparata 0:489965565a0d 1475 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 1476 *******************************************************************************/
cparata 0:489965565a0d 1477
cparata 0:489965565a0d 1478 status_t LSM303AGR_MAG_R_XOR(void *handle, LSM303AGR_MAG_XOR_t *value)
cparata 0:489965565a0d 1479 {
cparata 0:489965565a0d 1480 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_STATUS_REG, (u8_t *)value) )
cparata 0:489965565a0d 1481 return MEMS_ERROR;
cparata 0:489965565a0d 1482
cparata 0:489965565a0d 1483 *value &= LSM303AGR_MAG_XOR_MASK; //mask
cparata 0:489965565a0d 1484
cparata 0:489965565a0d 1485 return MEMS_SUCCESS;
cparata 0:489965565a0d 1486 }
cparata 0:489965565a0d 1487 /*******************************************************************************
cparata 0:489965565a0d 1488 * Function Name : LSM303AGR_MAG_R_YOR
cparata 0:489965565a0d 1489 * Description : Read YOR
cparata 0:489965565a0d 1490 * Input : Pointer to LSM303AGR_MAG_YOR_t
cparata 0:489965565a0d 1491 * Output : Status of YOR see LSM303AGR_MAG_YOR_t
cparata 0:489965565a0d 1492 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 1493 *******************************************************************************/
cparata 0:489965565a0d 1494
cparata 0:489965565a0d 1495 status_t LSM303AGR_MAG_R_YOR(void *handle, LSM303AGR_MAG_YOR_t *value)
cparata 0:489965565a0d 1496 {
cparata 0:489965565a0d 1497 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_STATUS_REG, (u8_t *)value) )
cparata 0:489965565a0d 1498 return MEMS_ERROR;
cparata 0:489965565a0d 1499
cparata 0:489965565a0d 1500 *value &= LSM303AGR_MAG_YOR_MASK; //mask
cparata 0:489965565a0d 1501
cparata 0:489965565a0d 1502 return MEMS_SUCCESS;
cparata 0:489965565a0d 1503 }
cparata 0:489965565a0d 1504 /*******************************************************************************
cparata 0:489965565a0d 1505 * Function Name : LSM303AGR_MAG_R_ZOR
cparata 0:489965565a0d 1506 * Description : Read ZOR
cparata 0:489965565a0d 1507 * Input : Pointer to LSM303AGR_MAG_ZOR_t
cparata 0:489965565a0d 1508 * Output : Status of ZOR see LSM303AGR_MAG_ZOR_t
cparata 0:489965565a0d 1509 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 1510 *******************************************************************************/
cparata 0:489965565a0d 1511
cparata 0:489965565a0d 1512 status_t LSM303AGR_MAG_R_ZOR(void *handle, LSM303AGR_MAG_ZOR_t *value)
cparata 0:489965565a0d 1513 {
cparata 0:489965565a0d 1514 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_STATUS_REG, (u8_t *)value) )
cparata 0:489965565a0d 1515 return MEMS_ERROR;
cparata 0:489965565a0d 1516
cparata 0:489965565a0d 1517 *value &= LSM303AGR_MAG_ZOR_MASK; //mask
cparata 0:489965565a0d 1518
cparata 0:489965565a0d 1519 return MEMS_SUCCESS;
cparata 0:489965565a0d 1520 }
cparata 0:489965565a0d 1521 /*******************************************************************************
cparata 0:489965565a0d 1522 * Function Name : LSM303AGR_MAG_R_ZYXOR
cparata 0:489965565a0d 1523 * Description : Read ZYXOR
cparata 0:489965565a0d 1524 * Input : Pointer to LSM303AGR_MAG_ZYXOR_t
cparata 0:489965565a0d 1525 * Output : Status of ZYXOR see LSM303AGR_MAG_ZYXOR_t
cparata 0:489965565a0d 1526 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 1527 *******************************************************************************/
cparata 0:489965565a0d 1528
cparata 0:489965565a0d 1529 status_t LSM303AGR_MAG_R_ZYXOR(void *handle, LSM303AGR_MAG_ZYXOR_t *value)
cparata 0:489965565a0d 1530 {
cparata 0:489965565a0d 1531 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_STATUS_REG, (u8_t *)value) )
cparata 0:489965565a0d 1532 return MEMS_ERROR;
cparata 0:489965565a0d 1533
cparata 0:489965565a0d 1534 *value &= LSM303AGR_MAG_ZYXOR_MASK; //mask
cparata 0:489965565a0d 1535
cparata 0:489965565a0d 1536 return MEMS_SUCCESS;
cparata 0:489965565a0d 1537 }
cparata 0:489965565a0d 1538 /*******************************************************************************
cparata 0:489965565a0d 1539 * Function Name : status_t LSM303AGR_MAG_Get_Raw_Magnetic(u8_t *buff)
cparata 0:489965565a0d 1540 * Description : Read Magnetic output register
cparata 0:489965565a0d 1541 * Input : pointer to [u8_t]
cparata 0:489965565a0d 1542 * Output : Magnetic buffer u8_t
cparata 0:489965565a0d 1543 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 1544 *******************************************************************************/
cparata 0:489965565a0d 1545 status_t LSM303AGR_MAG_Get_Raw_Magnetic(void *handle, u8_t *buff)
cparata 0:489965565a0d 1546 {
cparata 0:489965565a0d 1547 u8_t i, j, k;
cparata 0:489965565a0d 1548 u8_t numberOfByteForDimension;
cparata 0:489965565a0d 1549
cparata 0:489965565a0d 1550 numberOfByteForDimension=6/3;
cparata 0:489965565a0d 1551
cparata 0:489965565a0d 1552 k=0;
cparata 0:489965565a0d 1553 for (i=0; i<3;i++ )
cparata 0:489965565a0d 1554 {
cparata 0:489965565a0d 1555 for (j=0; j<numberOfByteForDimension;j++ )
cparata 0:489965565a0d 1556 {
cparata 0:489965565a0d 1557 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_OUTX_L_REG+k, &buff[k]))
cparata 0:489965565a0d 1558 return MEMS_ERROR;
cparata 0:489965565a0d 1559 k++;
cparata 0:489965565a0d 1560 }
cparata 0:489965565a0d 1561 }
cparata 0:489965565a0d 1562
cparata 0:489965565a0d 1563 return MEMS_SUCCESS;
cparata 0:489965565a0d 1564 }
cparata 0:489965565a0d 1565
cparata 0:489965565a0d 1566 #define LSM303AGR_MAG_SENSITIVITY 15/10
cparata 0:489965565a0d 1567
cparata 0:489965565a0d 1568 status_t LSM303AGR_MAG_Get_Magnetic(void *handle, int *buff)
cparata 0:489965565a0d 1569 {
cparata 0:489965565a0d 1570 Type3Axis16bit_U raw_data_tmp;
cparata 0:489965565a0d 1571
cparata 0:489965565a0d 1572 /* Read out raw magnetometer samples */
cparata 0:489965565a0d 1573 if(!LSM303AGR_MAG_Get_Raw_Magnetic(handle, raw_data_tmp.u8bit)) {
cparata 0:489965565a0d 1574 return MEMS_ERROR;
cparata 0:489965565a0d 1575 }
cparata 0:489965565a0d 1576
cparata 0:489965565a0d 1577 /* Applysensitivity */
cparata 0:489965565a0d 1578 buff[0] = raw_data_tmp.i16bit[0] * LSM303AGR_MAG_SENSITIVITY;
cparata 0:489965565a0d 1579 buff[1] = raw_data_tmp.i16bit[1] * LSM303AGR_MAG_SENSITIVITY;
cparata 0:489965565a0d 1580 buff[2] = raw_data_tmp.i16bit[2] * LSM303AGR_MAG_SENSITIVITY;
cparata 0:489965565a0d 1581
cparata 0:489965565a0d 1582 return MEMS_SUCCESS;
cparata 0:489965565a0d 1583 }
cparata 0:489965565a0d 1584
cparata 0:489965565a0d 1585 /*******************************************************************************
cparata 0:489965565a0d 1586 * Function Name : status_t LSM303AGR_MAG_Get_IntThreshld(u8_t *buff)
cparata 0:489965565a0d 1587 * Description : Read IntThreshld output register
cparata 0:489965565a0d 1588 * Input : pointer to [u8_t]
cparata 0:489965565a0d 1589 * Output : IntThreshld buffer u8_t
cparata 0:489965565a0d 1590 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 1591 *******************************************************************************/
cparata 0:489965565a0d 1592 status_t LSM303AGR_MAG_Get_IntThreshld(void *handle, u8_t *buff)
cparata 0:489965565a0d 1593 {
cparata 0:489965565a0d 1594 u8_t i, j, k;
cparata 0:489965565a0d 1595 u8_t numberOfByteForDimension;
cparata 0:489965565a0d 1596
cparata 0:489965565a0d 1597 numberOfByteForDimension=2/1;
cparata 0:489965565a0d 1598
cparata 0:489965565a0d 1599 k=0;
cparata 0:489965565a0d 1600 for (i=0; i<1;i++ )
cparata 0:489965565a0d 1601 {
cparata 0:489965565a0d 1602 for (j=0; j<numberOfByteForDimension;j++ )
cparata 0:489965565a0d 1603 {
cparata 0:489965565a0d 1604 if( !LSM303AGR_MAG_ReadReg(handle, LSM303AGR_MAG_INT_THS_L_REG+k, &buff[k]))
cparata 0:489965565a0d 1605 return MEMS_ERROR;
cparata 0:489965565a0d 1606 k++;
cparata 0:489965565a0d 1607 }
cparata 0:489965565a0d 1608 }
cparata 0:489965565a0d 1609
cparata 0:489965565a0d 1610 return MEMS_SUCCESS;
cparata 0:489965565a0d 1611 }
cparata 0:489965565a0d 1612
cparata 0:489965565a0d 1613 /*******************************************************************************
cparata 0:489965565a0d 1614 * Function Name : status_t LSM303AGR_MAG_Set_IntThreshld(u8_t *buff)
cparata 0:489965565a0d 1615 * Description : Write IntThreshld output register
cparata 0:489965565a0d 1616 * Input : pointer to [u8_t]
cparata 0:489965565a0d 1617 * Output : IntThreshld buffer u8_t
cparata 0:489965565a0d 1618 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:489965565a0d 1619 *******************************************************************************/
cparata 0:489965565a0d 1620 status_t LSM303AGR_MAG_Set_IntThreshld(void *handle, u8_t *buff)
cparata 0:489965565a0d 1621 {
cparata 0:489965565a0d 1622 u8_t i, j, k;
cparata 0:489965565a0d 1623 u8_t numberOfByteForDimension;
cparata 0:489965565a0d 1624
cparata 0:489965565a0d 1625 numberOfByteForDimension=2/1;
cparata 0:489965565a0d 1626
cparata 0:489965565a0d 1627 k=0;
cparata 0:489965565a0d 1628 for (i=0; i<1;i++ )
cparata 0:489965565a0d 1629 {
cparata 0:489965565a0d 1630 for (j=0; j<numberOfByteForDimension;j++ )
cparata 0:489965565a0d 1631 {
cparata 0:489965565a0d 1632 if( !LSM303AGR_MAG_WriteReg(handle, LSM303AGR_MAG_INT_THS_L_REG+k, buff[k]))
cparata 0:489965565a0d 1633 return MEMS_ERROR;
cparata 0:489965565a0d 1634 k++;
cparata 0:489965565a0d 1635 }
cparata 0:489965565a0d 1636 }
cparata 0:489965565a0d 1637
cparata 0:489965565a0d 1638 return MEMS_SUCCESS;
cparata 0:489965565a0d 1639 }