Example of wake up detection for LSM6DSL in X-NUCLEO-IKS01A2

Dependencies:   X_NUCLEO_IKS01A2 mbed

Fork of WakeUp_IKS01A2 by ST Expansion SW Team

Wake up Demo Application based on sensor expansion board X-NUCLEO-IKS01A2

Main function is to show how to detect the wake up event using the sensor expansion board and send a notification using UART to a connected PC or Desktop and display it on terminal applications like TeraTerm.
After connection has been established:
- the user can try to shake the board and then view the notification using an hyper terminal. When the wake up event is detected, the LED is switched on for a while.
- the user button can be used to enable/disable the wake up detection feature.

Committer:
cparata
Date:
Fri Aug 19 12:35:45 2016 +0000
Revision:
2:7ad7571557a5
Parent:
0:e7e920b85676
Add interfaces to all components

Who changed what in which revision?

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