HelloWorld_IKS01A2 - Example of hello world for X-NUCLEO-IKS01A2

ST » Code » HelloWorld_IKS01A2

ST / Mbed 2 deprecated HelloWorld_IKS01A2

Example of hello world for X-NUCLEO-IKS01A2

Fork of HelloWorld_IKS01A2 by ST Expansion SW Team

Hello World Demo Application based on sensor expansion board X-NUCLEO-IKS01A2

Main function is to show how to get humidity, temperature, pressure, accelerometer, magnetomer and gyroscope data using the sensor expansion board and send them using UART to a connected PC or Desktop and display it on terminal applications like TeraTerm.

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

Committer:: cparata
Date:: Fri Aug 12 13:40:12 2016 +0000
Revision:: 0:69566eea0fba

First release of Hello World for IKS01A2

Who changed what in which revision?

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

Repository toolbox

Export to desktop IDE

Build repository

Repository details

Type:	Program
Mbed OS support:	Mbed 2 deprecated
Created:	16 Dec 2016
Imports:	2535
Forks:	6
Commits:	18
Dependents:	0
Dependencies:	2
Followers:	400

The code in this repository is Apache licensed.

Components

X-NUCLEO-IKS01A2 Motion MEMS and Environmental Sensor