ST / Mbed 2 deprecated 6DOrientation_IKS01A2

Example of 6D orientation recognition for LSM6DSL in X-NUCLEO-IKS01A2

Dependencies:   X_NUCLEO_IKS01A2 mbed

Fork of 6DOrientation_IKS01A2 by ST Expansion SW Team

6D Orientation Demo Application based on sensor expansion board X-NUCLEO-IKS01A2

Main function is to show how to use sensor expansion board to find out the 6D orientation and send data using UART to a connected PC or Desktop and display it on terminal applications like TeraTerm.
After connection has been established:
- the user can rotate the board to change the 6D orientation and then view the data using an hyper terminal.
- the user button can be used to display the current 6D orientation.

X_NUCLEO_IKS01A2/Components/LSM303AGRSensor/LSM303AGR_MAG_driver.c@0:485458fca2bd, 2016-08-12 (annotated)

Committer:
cparata
Date:
Fri Aug 12 13:37:49 2016 +0000
Revision:
0:485458fca2bd
First release of 6D orientation for LSM6DSL in IKS01A2

Who changed what in which revision?

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