Pedometer_IKS01A2 - Example of pedometer for LSM6DSL in X-NUCLEO-IKS0…

ST » Code » Pedometer_IKS01A2

ST / Mbed 2 deprecated Pedometer_IKS01A2

Example of pedometer for LSM6DSL in X-NUCLEO-IKS01A2

Fork of Pedometer_IKS01A2 by ST Expansion SW Team

Pedometer Demo Application based on sensor expansion board X-NUCLEO-IKS01A2

Main function is to show how to count steps using the sensor expansion board and send a notification using UART to a connected PC or Desktop and display it on terminal applications like TeraTerm.
After connection has been established:
- the user can try to shake the board to simulate the steps and then view the notification using an hyper terminal. When a new step is detected, the LED is switched on for a while.
- the user button can be used to reset the step counter.

X_NUCLEO_IKS01A2/Components/LSM303AGRSensor/LSM303AGR_MAG_driver.c@2:67af0ad3ea2e, 2016-08-19 (annotated)

Committer:: cparata
Date:: Fri Aug 19 12:29:08 2016 +0000
Revision:: 2:67af0ad3ea2e
Parent:: 0:b189540a70e2

Add interfaces to all components

Who changed what in which revision?

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

Repository toolbox

Export to desktop IDE

Build repository

Repository details

Type:	Program
Mbed OS support:	Mbed 2 deprecated
Created:	16 Dec 2016
Imports:	98
Forks:	0
Commits:	17
Dependents:	0
Dependencies:	2
Followers:	401

The code in this repository is Apache licensed.

Pedometer Demo Application based on sensor expansion board X-NUCLEO-IKS01A2

X_NUCLEO_IKS01A2/Components/LSM303AGRSensor/LSM303AGR_MAG_driver.c@2:67af0ad3ea2e, 2016-08-19 (annotated)

Who changed what in which revision?

Repository toolbox

Repository details

Important Information for this Arm website

Access Warning