6DOrientation_IKS01A2 - Example of 6D orientation recognition for LSM6DSL…

ST » Code » 6DOrientation_IKS01A2

ST / Mbed 2 deprecated 6DOrientation_IKS01A2

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

Fork of 6DOrientation_IKS01A2 by ST Expansion SW Team

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

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

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

Committer:: cparata
Date:: Fri Aug 19 12:23:23 2016 +0000
Revision:: 2:ae74845fa96a
Parent:: 0:485458fca2bd

Add interfaces to all components

Who changed what in which revision?

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

Repository toolbox

Export to desktop IDE

Build repository

Repository details

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

The code in this repository is Apache licensed.

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

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

Who changed what in which revision?

Repository toolbox

Repository details

Important Information for this Arm website

Access Warning