ST / Mbed 2 deprecated MultiEvent_IKS01A2

Example of multiple event detection for LSM6DSL in X-NUCLEO-IKS01A2

Dependencies:   X_NUCLEO_IKS01A2 mbed

Fork of MultiEvent_IKS01A2 by ST Expansion SW Team

Multi Event Demo Application based on sensor expansion board X-NUCLEO-IKS01A2

Main function is to show how to detect the free fall, tap, double tap, tilt, wake up, 6D Orientation and step events using the sensor expansion board and send a notification using UART to a connected PC or Desktop and display it on terminal applications like TeraTerm.
After connection has been established:
- the user can simulate all the events and then view the notification using an hyper terminal.
- the user button can be used to enable/disable all hardware features.

X_NUCLEO_IKS01A2/Components/LSM303AGRSensor/LSM303AGR_MAG_driver.c@0:763b80993db4, 2016-11-24 (annotated)

Committer:
cparata
Date:
Thu Nov 24 15:42:24 2016 +0000
Revision:
0:763b80993db4
Add multi event example

Who changed what in which revision?

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