Tilt_IKS01A2 - Example of tilt detection for LSM6DSL in X-NUCLEO…

ST » Code » Tilt_IKS01A2

Example of tilt detection for LSM6DSL in X-NUCLEO-IKS01A2

Fork of Tilt_IKS01A2 by ST Expansion SW Team

Tilt Detection Demo Application based on sensor expansion board X-NUCLEO-IKS01A2

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

X_NUCLEO_IKS01A2/Components/LSM6DSLSensor/LSM6DSLSensor.cpp@2:39ad2a393143, 2016-08-19 (annotated)

Committer:: cparata
Date:: Fri Aug 19 12:34:01 2016 +0000
Revision:: 2:39ad2a393143
Child:: 4:49b63c3f26ae

Add interfaces to all components

Who changed what in which revision?

User	Revision	Line number	New contents of line
cparata	2:39ad2a393143	1	/**
cparata	2:39ad2a393143	2	******************************************************************************
cparata	2:39ad2a393143	3	* @file LSM6DSLSensor.cpp
cparata	2:39ad2a393143	4	* @author AST
cparata	2:39ad2a393143	5	* @version V1.0.0
cparata	2:39ad2a393143	6	* @date 5 August 2016
cparata	2:39ad2a393143	7	* @brief Implementation of an LSM6DSL Inertial Measurement Unit (IMU) 6 axes
cparata	2:39ad2a393143	8	* sensor.
cparata	2:39ad2a393143	9	******************************************************************************
cparata	2:39ad2a393143	10	* @attention
cparata	2:39ad2a393143	11	*
cparata	2:39ad2a393143	12	* <h2><center>© COPYRIGHT(c) 2016 STMicroelectronics</center></h2>
cparata	2:39ad2a393143	13	*
cparata	2:39ad2a393143	14	* Redistribution and use in source and binary forms, with or without modification,
cparata	2:39ad2a393143	15	* are permitted provided that the following conditions are met:
cparata	2:39ad2a393143	16	* 1. Redistributions of source code must retain the above copyright notice,
cparata	2:39ad2a393143	17	* this list of conditions and the following disclaimer.
cparata	2:39ad2a393143	18	* 2. Redistributions in binary form must reproduce the above copyright notice,
cparata	2:39ad2a393143	19	* this list of conditions and the following disclaimer in the documentation
cparata	2:39ad2a393143	20	* and/or other materials provided with the distribution.
cparata	2:39ad2a393143	21	* 3. Neither the name of STMicroelectronics nor the names of its contributors
cparata	2:39ad2a393143	22	* may be used to endorse or promote products derived from this software
cparata	2:39ad2a393143	23	* without specific prior written permission.
cparata	2:39ad2a393143	24	*
cparata	2:39ad2a393143	25	* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
cparata	2:39ad2a393143	26	* AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
cparata	2:39ad2a393143	27	* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
cparata	2:39ad2a393143	28	* DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
cparata	2:39ad2a393143	29	* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
cparata	2:39ad2a393143	30	* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
cparata	2:39ad2a393143	31	* SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
cparata	2:39ad2a393143	32	* CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
cparata	2:39ad2a393143	33	* OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
cparata	2:39ad2a393143	34	* OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
cparata	2:39ad2a393143	35	*
cparata	2:39ad2a393143	36	******************************************************************************
cparata	2:39ad2a393143	37	*/
cparata	2:39ad2a393143	38
cparata	2:39ad2a393143	39
cparata	2:39ad2a393143	40	/* Includes ------------------------------------------------------------------*/
cparata	2:39ad2a393143	41
cparata	2:39ad2a393143	42	#include "mbed.h"
cparata	2:39ad2a393143	43	#include "DevI2C.h"
cparata	2:39ad2a393143	44	#include "LSM6DSLSensor.h"
cparata	2:39ad2a393143	45	#include "LSM6DSL_ACC_GYRO_driver.h"
cparata	2:39ad2a393143	46
cparata	2:39ad2a393143	47
cparata	2:39ad2a393143	48	/* Class Implementation ------------------------------------------------------*/
cparata	2:39ad2a393143	49
cparata	2:39ad2a393143	50	/** Constructor
cparata	2:39ad2a393143	51	* @param i2c object of an helper class which handles the I2C peripheral
cparata	2:39ad2a393143	52	* @param address the address of the component's instance
cparata	2:39ad2a393143	53	*/
cparata	2:39ad2a393143	54	LSM6DSLSensor::LSM6DSLSensor(DevI2C &i2c) : dev_i2c(i2c)
cparata	2:39ad2a393143	55	{
cparata	2:39ad2a393143	56	address = LSM6DSL_ACC_GYRO_I2C_ADDRESS_HIGH;
cparata	2:39ad2a393143	57	};
cparata	2:39ad2a393143	58
cparata	2:39ad2a393143	59	/** Constructor
cparata	2:39ad2a393143	60	* @param i2c object of an helper class which handles the I2C peripheral
cparata	2:39ad2a393143	61	* @param address the address of the component's instance
cparata	2:39ad2a393143	62	*/
cparata	2:39ad2a393143	63	LSM6DSLSensor::LSM6DSLSensor(DevI2C &i2c, uint8_t address) : dev_i2c(i2c), address(address)
cparata	2:39ad2a393143	64	{
cparata	2:39ad2a393143	65
cparata	2:39ad2a393143	66	};
cparata	2:39ad2a393143	67
cparata	2:39ad2a393143	68	/**
cparata	2:39ad2a393143	69	* @brief Initializing the component.
cparata	2:39ad2a393143	70	* @param[in] init pointer to device specific initalization structure.
cparata	2:39ad2a393143	71	* @retval "0" in case of success, an error code otherwise.
cparata	2:39ad2a393143	72	*/
cparata	2:39ad2a393143	73	int LSM6DSLSensor::Init(void *init)
cparata	2:39ad2a393143	74	{
cparata	2:39ad2a393143	75	/* Enable register address automatically incremented during a multiple byte
cparata	2:39ad2a393143	76	access with a serial interface. */
cparata	2:39ad2a393143	77	if ( LSM6DSL_ACC_GYRO_W_IF_Addr_Incr( (void *)this, LSM6DSL_ACC_GYRO_IF_INC_ENABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	78	{
cparata	2:39ad2a393143	79	return 1;
cparata	2:39ad2a393143	80	}
cparata	2:39ad2a393143	81
cparata	2:39ad2a393143	82	/* Enable BDU */
cparata	2:39ad2a393143	83	if ( LSM6DSL_ACC_GYRO_W_BDU( (void *)this, LSM6DSL_ACC_GYRO_BDU_BLOCK_UPDATE ) == MEMS_ERROR )
cparata	2:39ad2a393143	84	{
cparata	2:39ad2a393143	85	return 1;
cparata	2:39ad2a393143	86	}
cparata	2:39ad2a393143	87
cparata	2:39ad2a393143	88	/* FIFO mode selection */
cparata	2:39ad2a393143	89	if ( LSM6DSL_ACC_GYRO_W_FIFO_MODE( (void *)this, LSM6DSL_ACC_GYRO_FIFO_MODE_BYPASS ) == MEMS_ERROR )
cparata	2:39ad2a393143	90	{
cparata	2:39ad2a393143	91	return 1;
cparata	2:39ad2a393143	92	}
cparata	2:39ad2a393143	93
cparata	2:39ad2a393143	94	/* Output data rate selection - power down. */
cparata	2:39ad2a393143	95	if ( LSM6DSL_ACC_GYRO_W_ODR_XL( (void *)this, LSM6DSL_ACC_GYRO_ODR_XL_POWER_DOWN ) == MEMS_ERROR )
cparata	2:39ad2a393143	96	{
cparata	2:39ad2a393143	97	return 1;
cparata	2:39ad2a393143	98	}
cparata	2:39ad2a393143	99
cparata	2:39ad2a393143	100	/* Full scale selection. */
cparata	2:39ad2a393143	101	if ( Set_X_FS( 2.0f ) == 1 )
cparata	2:39ad2a393143	102	{
cparata	2:39ad2a393143	103	return 1;
cparata	2:39ad2a393143	104	}
cparata	2:39ad2a393143	105
cparata	2:39ad2a393143	106	/* Output data rate selection - power down */
cparata	2:39ad2a393143	107	if ( LSM6DSL_ACC_GYRO_W_ODR_G( (void *)this, LSM6DSL_ACC_GYRO_ODR_G_POWER_DOWN ) == MEMS_ERROR )
cparata	2:39ad2a393143	108	{
cparata	2:39ad2a393143	109	return 1;
cparata	2:39ad2a393143	110	}
cparata	2:39ad2a393143	111
cparata	2:39ad2a393143	112	/* Full scale selection. */
cparata	2:39ad2a393143	113	if ( Set_G_FS( 2000.0f ) == 1 )
cparata	2:39ad2a393143	114	{
cparata	2:39ad2a393143	115	return 1;
cparata	2:39ad2a393143	116	}
cparata	2:39ad2a393143	117
cparata	2:39ad2a393143	118	X_Last_ODR = 104.0f;
cparata	2:39ad2a393143	119
cparata	2:39ad2a393143	120	X_isEnabled = 0;
cparata	2:39ad2a393143	121
cparata	2:39ad2a393143	122	G_Last_ODR = 104.0f;
cparata	2:39ad2a393143	123
cparata	2:39ad2a393143	124	G_isEnabled = 0;
cparata	2:39ad2a393143	125
cparata	2:39ad2a393143	126	return 0;
cparata	2:39ad2a393143	127	}
cparata	2:39ad2a393143	128
cparata	2:39ad2a393143	129	/**
cparata	2:39ad2a393143	130	* @brief Enable LSM6DSL Accelerator
cparata	2:39ad2a393143	131	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	132	*/
cparata	2:39ad2a393143	133	int LSM6DSLSensor::Enable_X(void)
cparata	2:39ad2a393143	134	{
cparata	2:39ad2a393143	135	/* Check if the component is already enabled */
cparata	2:39ad2a393143	136	if ( X_isEnabled == 1 )
cparata	2:39ad2a393143	137	{
cparata	2:39ad2a393143	138	return 0;
cparata	2:39ad2a393143	139	}
cparata	2:39ad2a393143	140
cparata	2:39ad2a393143	141	/* Output data rate selection. */
cparata	2:39ad2a393143	142	if ( Set_X_ODR_When_Enabled( X_Last_ODR ) == 1 )
cparata	2:39ad2a393143	143	{
cparata	2:39ad2a393143	144	return 1;
cparata	2:39ad2a393143	145	}
cparata	2:39ad2a393143	146
cparata	2:39ad2a393143	147	X_isEnabled = 1;
cparata	2:39ad2a393143	148
cparata	2:39ad2a393143	149	return 0;
cparata	2:39ad2a393143	150	}
cparata	2:39ad2a393143	151
cparata	2:39ad2a393143	152	/**
cparata	2:39ad2a393143	153	* @brief Enable LSM6DSL Gyroscope
cparata	2:39ad2a393143	154	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	155	*/
cparata	2:39ad2a393143	156	int LSM6DSLSensor::Enable_G(void)
cparata	2:39ad2a393143	157	{
cparata	2:39ad2a393143	158	/* Check if the component is already enabled */
cparata	2:39ad2a393143	159	if ( G_isEnabled == 1 )
cparata	2:39ad2a393143	160	{
cparata	2:39ad2a393143	161	return 0;
cparata	2:39ad2a393143	162	}
cparata	2:39ad2a393143	163
cparata	2:39ad2a393143	164	/* Output data rate selection. */
cparata	2:39ad2a393143	165	if ( Set_G_ODR_When_Enabled( G_Last_ODR ) == 1 )
cparata	2:39ad2a393143	166	{
cparata	2:39ad2a393143	167	return 1;
cparata	2:39ad2a393143	168	}
cparata	2:39ad2a393143	169
cparata	2:39ad2a393143	170	G_isEnabled = 1;
cparata	2:39ad2a393143	171
cparata	2:39ad2a393143	172	return 0;
cparata	2:39ad2a393143	173	}
cparata	2:39ad2a393143	174
cparata	2:39ad2a393143	175	/**
cparata	2:39ad2a393143	176	* @brief Disable LSM6DSL Accelerator
cparata	2:39ad2a393143	177	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	178	*/
cparata	2:39ad2a393143	179	int LSM6DSLSensor::Disable_X(void)
cparata	2:39ad2a393143	180	{
cparata	2:39ad2a393143	181	/* Check if the component is already disabled */
cparata	2:39ad2a393143	182	if ( X_isEnabled == 0 )
cparata	2:39ad2a393143	183	{
cparata	2:39ad2a393143	184	return 0;
cparata	2:39ad2a393143	185	}
cparata	2:39ad2a393143	186
cparata	2:39ad2a393143	187	/* Store actual output data rate. */
cparata	2:39ad2a393143	188	if ( Get_X_ODR( &X_Last_ODR ) == 1 )
cparata	2:39ad2a393143	189	{
cparata	2:39ad2a393143	190	return 1;
cparata	2:39ad2a393143	191	}
cparata	2:39ad2a393143	192
cparata	2:39ad2a393143	193	/* Output data rate selection - power down. */
cparata	2:39ad2a393143	194	if ( LSM6DSL_ACC_GYRO_W_ODR_XL( (void *)this, LSM6DSL_ACC_GYRO_ODR_XL_POWER_DOWN ) == MEMS_ERROR )
cparata	2:39ad2a393143	195	{
cparata	2:39ad2a393143	196	return 1;
cparata	2:39ad2a393143	197	}
cparata	2:39ad2a393143	198
cparata	2:39ad2a393143	199	X_isEnabled = 0;
cparata	2:39ad2a393143	200
cparata	2:39ad2a393143	201	return 0;
cparata	2:39ad2a393143	202	}
cparata	2:39ad2a393143	203
cparata	2:39ad2a393143	204	/**
cparata	2:39ad2a393143	205	* @brief Disable LSM6DSL Gyroscope
cparata	2:39ad2a393143	206	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	207	*/
cparata	2:39ad2a393143	208	int LSM6DSLSensor::Disable_G(void)
cparata	2:39ad2a393143	209	{
cparata	2:39ad2a393143	210	/* Check if the component is already disabled */
cparata	2:39ad2a393143	211	if ( G_isEnabled == 0 )
cparata	2:39ad2a393143	212	{
cparata	2:39ad2a393143	213	return 0;
cparata	2:39ad2a393143	214	}
cparata	2:39ad2a393143	215
cparata	2:39ad2a393143	216	/* Store actual output data rate. */
cparata	2:39ad2a393143	217	if ( Get_G_ODR( &G_Last_ODR ) == 1 )
cparata	2:39ad2a393143	218	{
cparata	2:39ad2a393143	219	return 1;
cparata	2:39ad2a393143	220	}
cparata	2:39ad2a393143	221
cparata	2:39ad2a393143	222	/* Output data rate selection - power down */
cparata	2:39ad2a393143	223	if ( LSM6DSL_ACC_GYRO_W_ODR_G( (void *)this, LSM6DSL_ACC_GYRO_ODR_G_POWER_DOWN ) == MEMS_ERROR )
cparata	2:39ad2a393143	224	{
cparata	2:39ad2a393143	225	return 1;
cparata	2:39ad2a393143	226	}
cparata	2:39ad2a393143	227
cparata	2:39ad2a393143	228	G_isEnabled = 0;
cparata	2:39ad2a393143	229
cparata	2:39ad2a393143	230	return 0;
cparata	2:39ad2a393143	231	}
cparata	2:39ad2a393143	232
cparata	2:39ad2a393143	233	/**
cparata	2:39ad2a393143	234	* @brief Read ID of LSM6DSL Accelerometer and Gyroscope
cparata	2:39ad2a393143	235	* @param p_id the pointer where the ID of the device is stored
cparata	2:39ad2a393143	236	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	237	*/
cparata	2:39ad2a393143	238	int LSM6DSLSensor::ReadID(uint8_t *id)
cparata	2:39ad2a393143	239	{
cparata	2:39ad2a393143	240	if(!id)
cparata	2:39ad2a393143	241	{
cparata	2:39ad2a393143	242	return 1;
cparata	2:39ad2a393143	243	}
cparata	2:39ad2a393143	244
cparata	2:39ad2a393143	245	/* Read WHO AM I register */
cparata	2:39ad2a393143	246	if ( LSM6DSL_ACC_GYRO_R_WHO_AM_I( (void *)this, id ) == MEMS_ERROR )
cparata	2:39ad2a393143	247	{
cparata	2:39ad2a393143	248	return 1;
cparata	2:39ad2a393143	249	}
cparata	2:39ad2a393143	250
cparata	2:39ad2a393143	251	return 0;
cparata	2:39ad2a393143	252	}
cparata	2:39ad2a393143	253
cparata	2:39ad2a393143	254	/**
cparata	2:39ad2a393143	255	* @brief Read data from LSM6DSL Accelerometer
cparata	2:39ad2a393143	256	* @param pData the pointer where the accelerometer data are stored
cparata	2:39ad2a393143	257	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	258	*/
cparata	2:39ad2a393143	259	int LSM6DSLSensor::Get_X_Axes(int32_t *pData)
cparata	2:39ad2a393143	260	{
cparata	2:39ad2a393143	261	int16_t dataRaw[3];
cparata	2:39ad2a393143	262	float sensitivity = 0;
cparata	2:39ad2a393143	263
cparata	2:39ad2a393143	264	/* Read raw data from LSM6DSL output register. */
cparata	2:39ad2a393143	265	if ( Get_X_AxesRaw( dataRaw ) == 1 )
cparata	2:39ad2a393143	266	{
cparata	2:39ad2a393143	267	return 1;
cparata	2:39ad2a393143	268	}
cparata	2:39ad2a393143	269
cparata	2:39ad2a393143	270	/* Get LSM6DSL actual sensitivity. */
cparata	2:39ad2a393143	271	if ( Get_X_Sensitivity( &sensitivity ) == 1 )
cparata	2:39ad2a393143	272	{
cparata	2:39ad2a393143	273	return 1;
cparata	2:39ad2a393143	274	}
cparata	2:39ad2a393143	275
cparata	2:39ad2a393143	276	/* Calculate the data. */
cparata	2:39ad2a393143	277	pData[0] = ( int32_t )( dataRaw[0] * sensitivity );
cparata	2:39ad2a393143	278	pData[1] = ( int32_t )( dataRaw[1] * sensitivity );
cparata	2:39ad2a393143	279	pData[2] = ( int32_t )( dataRaw[2] * sensitivity );
cparata	2:39ad2a393143	280
cparata	2:39ad2a393143	281	return 0;
cparata	2:39ad2a393143	282	}
cparata	2:39ad2a393143	283
cparata	2:39ad2a393143	284	/**
cparata	2:39ad2a393143	285	* @brief Read data from LSM6DSL Gyroscope
cparata	2:39ad2a393143	286	* @param pData the pointer where the gyroscope data are stored
cparata	2:39ad2a393143	287	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	288	*/
cparata	2:39ad2a393143	289	int LSM6DSLSensor::Get_G_Axes(int32_t *pData)
cparata	2:39ad2a393143	290	{
cparata	2:39ad2a393143	291	int16_t dataRaw[3];
cparata	2:39ad2a393143	292	float sensitivity = 0;
cparata	2:39ad2a393143	293
cparata	2:39ad2a393143	294	/* Read raw data from LSM6DSL output register. */
cparata	2:39ad2a393143	295	if ( Get_G_AxesRaw( dataRaw ) == 1 )
cparata	2:39ad2a393143	296	{
cparata	2:39ad2a393143	297	return 1;
cparata	2:39ad2a393143	298	}
cparata	2:39ad2a393143	299
cparata	2:39ad2a393143	300	/* Get LSM6DSL actual sensitivity. */
cparata	2:39ad2a393143	301	if ( Get_G_Sensitivity( &sensitivity ) == 1 )
cparata	2:39ad2a393143	302	{
cparata	2:39ad2a393143	303	return 1;
cparata	2:39ad2a393143	304	}
cparata	2:39ad2a393143	305
cparata	2:39ad2a393143	306	/* Calculate the data. */
cparata	2:39ad2a393143	307	pData[0] = ( int32_t )( dataRaw[0] * sensitivity );
cparata	2:39ad2a393143	308	pData[1] = ( int32_t )( dataRaw[1] * sensitivity );
cparata	2:39ad2a393143	309	pData[2] = ( int32_t )( dataRaw[2] * sensitivity );
cparata	2:39ad2a393143	310
cparata	2:39ad2a393143	311	return 0;
cparata	2:39ad2a393143	312	}
cparata	2:39ad2a393143	313
cparata	2:39ad2a393143	314	/**
cparata	2:39ad2a393143	315	* @brief Read Accelerometer Sensitivity
cparata	2:39ad2a393143	316	* @param pfData the pointer where the accelerometer sensitivity is stored
cparata	2:39ad2a393143	317	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	318	*/
cparata	2:39ad2a393143	319	int LSM6DSLSensor::Get_X_Sensitivity(float *pfData)
cparata	2:39ad2a393143	320	{
cparata	2:39ad2a393143	321	LSM6DSL_ACC_GYRO_FS_XL_t fullScale;
cparata	2:39ad2a393143	322
cparata	2:39ad2a393143	323	/* Read actual full scale selection from sensor. */
cparata	2:39ad2a393143	324	if ( LSM6DSL_ACC_GYRO_R_FS_XL( (void *)this, &fullScale ) == MEMS_ERROR )
cparata	2:39ad2a393143	325	{
cparata	2:39ad2a393143	326	return 1;
cparata	2:39ad2a393143	327	}
cparata	2:39ad2a393143	328
cparata	2:39ad2a393143	329	/* Store the sensitivity based on actual full scale. */
cparata	2:39ad2a393143	330	switch( fullScale )
cparata	2:39ad2a393143	331	{
cparata	2:39ad2a393143	332	case LSM6DSL_ACC_GYRO_FS_XL_2g:
cparata	2:39ad2a393143	333	*pfData = ( float )LSM6DSL_ACC_SENSITIVITY_FOR_FS_2G;
cparata	2:39ad2a393143	334	break;
cparata	2:39ad2a393143	335	case LSM6DSL_ACC_GYRO_FS_XL_4g:
cparata	2:39ad2a393143	336	*pfData = ( float )LSM6DSL_ACC_SENSITIVITY_FOR_FS_4G;
cparata	2:39ad2a393143	337	break;
cparata	2:39ad2a393143	338	case LSM6DSL_ACC_GYRO_FS_XL_8g:
cparata	2:39ad2a393143	339	*pfData = ( float )LSM6DSL_ACC_SENSITIVITY_FOR_FS_8G;
cparata	2:39ad2a393143	340	break;
cparata	2:39ad2a393143	341	case LSM6DSL_ACC_GYRO_FS_XL_16g:
cparata	2:39ad2a393143	342	*pfData = ( float )LSM6DSL_ACC_SENSITIVITY_FOR_FS_16G;
cparata	2:39ad2a393143	343	break;
cparata	2:39ad2a393143	344	default:
cparata	2:39ad2a393143	345	*pfData = -1.0f;
cparata	2:39ad2a393143	346	return 1;
cparata	2:39ad2a393143	347	}
cparata	2:39ad2a393143	348
cparata	2:39ad2a393143	349	return 0;
cparata	2:39ad2a393143	350	}
cparata	2:39ad2a393143	351
cparata	2:39ad2a393143	352	/**
cparata	2:39ad2a393143	353	* @brief Read Gyroscope Sensitivity
cparata	2:39ad2a393143	354	* @param pfData the pointer where the gyroscope sensitivity is stored
cparata	2:39ad2a393143	355	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	356	*/
cparata	2:39ad2a393143	357	int LSM6DSLSensor::Get_G_Sensitivity(float *pfData)
cparata	2:39ad2a393143	358	{
cparata	2:39ad2a393143	359	LSM6DSL_ACC_GYRO_FS_125_t fullScale125;
cparata	2:39ad2a393143	360	LSM6DSL_ACC_GYRO_FS_G_t fullScale;
cparata	2:39ad2a393143	361
cparata	2:39ad2a393143	362	/* Read full scale 125 selection from sensor. */
cparata	2:39ad2a393143	363	if ( LSM6DSL_ACC_GYRO_R_FS_125( (void *)this, &fullScale125 ) == MEMS_ERROR )
cparata	2:39ad2a393143	364	{
cparata	2:39ad2a393143	365	return 1;
cparata	2:39ad2a393143	366	}
cparata	2:39ad2a393143	367
cparata	2:39ad2a393143	368	if ( fullScale125 == LSM6DSL_ACC_GYRO_FS_125_ENABLED )
cparata	2:39ad2a393143	369	{
cparata	2:39ad2a393143	370	*pfData = ( float )LSM6DSL_GYRO_SENSITIVITY_FOR_FS_125DPS;
cparata	2:39ad2a393143	371	}
cparata	2:39ad2a393143	372
cparata	2:39ad2a393143	373	else
cparata	2:39ad2a393143	374	{
cparata	2:39ad2a393143	375
cparata	2:39ad2a393143	376	/* Read actual full scale selection from sensor. */
cparata	2:39ad2a393143	377	if ( LSM6DSL_ACC_GYRO_R_FS_G( (void *)this, &fullScale ) == MEMS_ERROR )
cparata	2:39ad2a393143	378	{
cparata	2:39ad2a393143	379	return 1;
cparata	2:39ad2a393143	380	}
cparata	2:39ad2a393143	381
cparata	2:39ad2a393143	382	/* Store the sensitivity based on actual full scale. */
cparata	2:39ad2a393143	383	switch( fullScale )
cparata	2:39ad2a393143	384	{
cparata	2:39ad2a393143	385	case LSM6DSL_ACC_GYRO_FS_G_245dps:
cparata	2:39ad2a393143	386	*pfData = ( float )LSM6DSL_GYRO_SENSITIVITY_FOR_FS_245DPS;
cparata	2:39ad2a393143	387	break;
cparata	2:39ad2a393143	388	case LSM6DSL_ACC_GYRO_FS_G_500dps:
cparata	2:39ad2a393143	389	*pfData = ( float )LSM6DSL_GYRO_SENSITIVITY_FOR_FS_500DPS;
cparata	2:39ad2a393143	390	break;
cparata	2:39ad2a393143	391	case LSM6DSL_ACC_GYRO_FS_G_1000dps:
cparata	2:39ad2a393143	392	*pfData = ( float )LSM6DSL_GYRO_SENSITIVITY_FOR_FS_1000DPS;
cparata	2:39ad2a393143	393	break;
cparata	2:39ad2a393143	394	case LSM6DSL_ACC_GYRO_FS_G_2000dps:
cparata	2:39ad2a393143	395	*pfData = ( float )LSM6DSL_GYRO_SENSITIVITY_FOR_FS_2000DPS;
cparata	2:39ad2a393143	396	break;
cparata	2:39ad2a393143	397	default:
cparata	2:39ad2a393143	398	*pfData = -1.0f;
cparata	2:39ad2a393143	399	return 1;
cparata	2:39ad2a393143	400	}
cparata	2:39ad2a393143	401	}
cparata	2:39ad2a393143	402
cparata	2:39ad2a393143	403	return 0;
cparata	2:39ad2a393143	404	}
cparata	2:39ad2a393143	405
cparata	2:39ad2a393143	406	/**
cparata	2:39ad2a393143	407	* @brief Read raw data from LSM6DSL Accelerometer
cparata	2:39ad2a393143	408	* @param pData the pointer where the accelerometer raw data are stored
cparata	2:39ad2a393143	409	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	410	*/
cparata	2:39ad2a393143	411	int LSM6DSLSensor::Get_X_AxesRaw(int16_t *pData)
cparata	2:39ad2a393143	412	{
cparata	2:39ad2a393143	413	uint8_t regValue[6] = {0, 0, 0, 0, 0, 0};
cparata	2:39ad2a393143	414
cparata	2:39ad2a393143	415	/* Read output registers from LSM6DSL_ACC_GYRO_OUTX_L_XL to LSM6DSL_ACC_GYRO_OUTZ_H_XL. */
cparata	2:39ad2a393143	416	if ( LSM6DSL_ACC_GYRO_GetRawAccData( (void *)this, regValue ) == MEMS_ERROR )
cparata	2:39ad2a393143	417	{
cparata	2:39ad2a393143	418	return 1;
cparata	2:39ad2a393143	419	}
cparata	2:39ad2a393143	420
cparata	2:39ad2a393143	421	/* Format the data. */
cparata	2:39ad2a393143	422	pData[0] = ( ( ( ( int16_t )regValue[1] ) << 8 ) + ( int16_t )regValue[0] );
cparata	2:39ad2a393143	423	pData[1] = ( ( ( ( int16_t )regValue[3] ) << 8 ) + ( int16_t )regValue[2] );
cparata	2:39ad2a393143	424	pData[2] = ( ( ( ( int16_t )regValue[5] ) << 8 ) + ( int16_t )regValue[4] );
cparata	2:39ad2a393143	425
cparata	2:39ad2a393143	426	return 0;
cparata	2:39ad2a393143	427	}
cparata	2:39ad2a393143	428
cparata	2:39ad2a393143	429	/**
cparata	2:39ad2a393143	430	* @brief Read raw data from LSM6DSL Gyroscope
cparata	2:39ad2a393143	431	* @param pData the pointer where the gyroscope raw data are stored
cparata	2:39ad2a393143	432	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	433	*/
cparata	2:39ad2a393143	434	int LSM6DSLSensor::Get_G_AxesRaw(int16_t *pData)
cparata	2:39ad2a393143	435	{
cparata	2:39ad2a393143	436	uint8_t regValue[6] = {0, 0, 0, 0, 0, 0};
cparata	2:39ad2a393143	437
cparata	2:39ad2a393143	438	/* Read output registers from LSM6DSL_ACC_GYRO_OUTX_L_G to LSM6DSL_ACC_GYRO_OUTZ_H_G. */
cparata	2:39ad2a393143	439	if ( LSM6DSL_ACC_GYRO_GetRawGyroData( (void *)this, regValue ) == MEMS_ERROR )
cparata	2:39ad2a393143	440	{
cparata	2:39ad2a393143	441	return 1;
cparata	2:39ad2a393143	442	}
cparata	2:39ad2a393143	443
cparata	2:39ad2a393143	444	/* Format the data. */
cparata	2:39ad2a393143	445	pData[0] = ( ( ( ( int16_t )regValue[1] ) << 8 ) + ( int16_t )regValue[0] );
cparata	2:39ad2a393143	446	pData[1] = ( ( ( ( int16_t )regValue[3] ) << 8 ) + ( int16_t )regValue[2] );
cparata	2:39ad2a393143	447	pData[2] = ( ( ( ( int16_t )regValue[5] ) << 8 ) + ( int16_t )regValue[4] );
cparata	2:39ad2a393143	448
cparata	2:39ad2a393143	449	return 0;
cparata	2:39ad2a393143	450	}
cparata	2:39ad2a393143	451
cparata	2:39ad2a393143	452	/**
cparata	2:39ad2a393143	453	* @brief Read LSM6DSL Accelerometer output data rate
cparata	2:39ad2a393143	454	* @param odr the pointer to the output data rate
cparata	2:39ad2a393143	455	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	456	*/
cparata	2:39ad2a393143	457	int LSM6DSLSensor::Get_X_ODR(float* odr)
cparata	2:39ad2a393143	458	{
cparata	2:39ad2a393143	459	LSM6DSL_ACC_GYRO_ODR_XL_t odr_low_level;
cparata	2:39ad2a393143	460
cparata	2:39ad2a393143	461	if ( LSM6DSL_ACC_GYRO_R_ODR_XL( (void *)this, &odr_low_level ) == MEMS_ERROR )
cparata	2:39ad2a393143	462	{
cparata	2:39ad2a393143	463	return 1;
cparata	2:39ad2a393143	464	}
cparata	2:39ad2a393143	465
cparata	2:39ad2a393143	466	switch( odr_low_level )
cparata	2:39ad2a393143	467	{
cparata	2:39ad2a393143	468	case LSM6DSL_ACC_GYRO_ODR_XL_POWER_DOWN:
cparata	2:39ad2a393143	469	*odr = 0.0f;
cparata	2:39ad2a393143	470	break;
cparata	2:39ad2a393143	471	case LSM6DSL_ACC_GYRO_ODR_XL_13Hz:
cparata	2:39ad2a393143	472	*odr = 13.0f;
cparata	2:39ad2a393143	473	break;
cparata	2:39ad2a393143	474	case LSM6DSL_ACC_GYRO_ODR_XL_26Hz:
cparata	2:39ad2a393143	475	*odr = 26.0f;
cparata	2:39ad2a393143	476	break;
cparata	2:39ad2a393143	477	case LSM6DSL_ACC_GYRO_ODR_XL_52Hz:
cparata	2:39ad2a393143	478	*odr = 52.0f;
cparata	2:39ad2a393143	479	break;
cparata	2:39ad2a393143	480	case LSM6DSL_ACC_GYRO_ODR_XL_104Hz:
cparata	2:39ad2a393143	481	*odr = 104.0f;
cparata	2:39ad2a393143	482	break;
cparata	2:39ad2a393143	483	case LSM6DSL_ACC_GYRO_ODR_XL_208Hz:
cparata	2:39ad2a393143	484	*odr = 208.0f;
cparata	2:39ad2a393143	485	break;
cparata	2:39ad2a393143	486	case LSM6DSL_ACC_GYRO_ODR_XL_416Hz:
cparata	2:39ad2a393143	487	*odr = 416.0f;
cparata	2:39ad2a393143	488	break;
cparata	2:39ad2a393143	489	case LSM6DSL_ACC_GYRO_ODR_XL_833Hz:
cparata	2:39ad2a393143	490	*odr = 833.0f;
cparata	2:39ad2a393143	491	break;
cparata	2:39ad2a393143	492	case LSM6DSL_ACC_GYRO_ODR_XL_1660Hz:
cparata	2:39ad2a393143	493	*odr = 1660.0f;
cparata	2:39ad2a393143	494	break;
cparata	2:39ad2a393143	495	case LSM6DSL_ACC_GYRO_ODR_XL_3330Hz:
cparata	2:39ad2a393143	496	*odr = 3330.0f;
cparata	2:39ad2a393143	497	break;
cparata	2:39ad2a393143	498	case LSM6DSL_ACC_GYRO_ODR_XL_6660Hz:
cparata	2:39ad2a393143	499	*odr = 6660.0f;
cparata	2:39ad2a393143	500	break;
cparata	2:39ad2a393143	501	default:
cparata	2:39ad2a393143	502	*odr = -1.0f;
cparata	2:39ad2a393143	503	return 1;
cparata	2:39ad2a393143	504	}
cparata	2:39ad2a393143	505
cparata	2:39ad2a393143	506	return 0;
cparata	2:39ad2a393143	507	}
cparata	2:39ad2a393143	508
cparata	2:39ad2a393143	509	/**
cparata	2:39ad2a393143	510	* @brief Read LSM6DSL Gyroscope output data rate
cparata	2:39ad2a393143	511	* @param odr the pointer to the output data rate
cparata	2:39ad2a393143	512	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	513	*/
cparata	2:39ad2a393143	514	int LSM6DSLSensor::Get_G_ODR(float* odr)
cparata	2:39ad2a393143	515	{
cparata	2:39ad2a393143	516	LSM6DSL_ACC_GYRO_ODR_G_t odr_low_level;
cparata	2:39ad2a393143	517
cparata	2:39ad2a393143	518	if ( LSM6DSL_ACC_GYRO_R_ODR_G( (void *)this, &odr_low_level ) == MEMS_ERROR )
cparata	2:39ad2a393143	519	{
cparata	2:39ad2a393143	520	return 1;
cparata	2:39ad2a393143	521	}
cparata	2:39ad2a393143	522
cparata	2:39ad2a393143	523	switch( odr_low_level )
cparata	2:39ad2a393143	524	{
cparata	2:39ad2a393143	525	case LSM6DSL_ACC_GYRO_ODR_G_POWER_DOWN:
cparata	2:39ad2a393143	526	*odr = 0.0f;
cparata	2:39ad2a393143	527	break;
cparata	2:39ad2a393143	528	case LSM6DSL_ACC_GYRO_ODR_G_13Hz:
cparata	2:39ad2a393143	529	*odr = 13.0f;
cparata	2:39ad2a393143	530	break;
cparata	2:39ad2a393143	531	case LSM6DSL_ACC_GYRO_ODR_G_26Hz:
cparata	2:39ad2a393143	532	*odr = 26.0f;
cparata	2:39ad2a393143	533	break;
cparata	2:39ad2a393143	534	case LSM6DSL_ACC_GYRO_ODR_G_52Hz:
cparata	2:39ad2a393143	535	*odr = 52.0f;
cparata	2:39ad2a393143	536	break;
cparata	2:39ad2a393143	537	case LSM6DSL_ACC_GYRO_ODR_G_104Hz:
cparata	2:39ad2a393143	538	*odr = 104.0f;
cparata	2:39ad2a393143	539	break;
cparata	2:39ad2a393143	540	case LSM6DSL_ACC_GYRO_ODR_G_208Hz:
cparata	2:39ad2a393143	541	*odr = 208.0f;
cparata	2:39ad2a393143	542	break;
cparata	2:39ad2a393143	543	case LSM6DSL_ACC_GYRO_ODR_G_416Hz:
cparata	2:39ad2a393143	544	*odr = 416.0f;
cparata	2:39ad2a393143	545	break;
cparata	2:39ad2a393143	546	case LSM6DSL_ACC_GYRO_ODR_G_833Hz:
cparata	2:39ad2a393143	547	*odr = 833.0f;
cparata	2:39ad2a393143	548	break;
cparata	2:39ad2a393143	549	case LSM6DSL_ACC_GYRO_ODR_G_1660Hz:
cparata	2:39ad2a393143	550	*odr = 1660.0f;
cparata	2:39ad2a393143	551	break;
cparata	2:39ad2a393143	552	case LSM6DSL_ACC_GYRO_ODR_G_3330Hz:
cparata	2:39ad2a393143	553	*odr = 3330.0f;
cparata	2:39ad2a393143	554	break;
cparata	2:39ad2a393143	555	case LSM6DSL_ACC_GYRO_ODR_G_6660Hz:
cparata	2:39ad2a393143	556	*odr = 6660.0f;
cparata	2:39ad2a393143	557	break;
cparata	2:39ad2a393143	558	default:
cparata	2:39ad2a393143	559	*odr = -1.0f;
cparata	2:39ad2a393143	560	return 1;
cparata	2:39ad2a393143	561	}
cparata	2:39ad2a393143	562
cparata	2:39ad2a393143	563	return 0;
cparata	2:39ad2a393143	564	}
cparata	2:39ad2a393143	565
cparata	2:39ad2a393143	566	/**
cparata	2:39ad2a393143	567	* @brief Set LSM6DSL Accelerometer output data rate
cparata	2:39ad2a393143	568	* @param odr the output data rate to be set
cparata	2:39ad2a393143	569	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	570	*/
cparata	2:39ad2a393143	571	int LSM6DSLSensor::Set_X_ODR(float odr)
cparata	2:39ad2a393143	572	{
cparata	2:39ad2a393143	573	if(X_isEnabled == 1)
cparata	2:39ad2a393143	574	{
cparata	2:39ad2a393143	575	if(Set_X_ODR_When_Enabled(odr) == 1)
cparata	2:39ad2a393143	576	{
cparata	2:39ad2a393143	577	return 1;
cparata	2:39ad2a393143	578	}
cparata	2:39ad2a393143	579	}
cparata	2:39ad2a393143	580	else
cparata	2:39ad2a393143	581	{
cparata	2:39ad2a393143	582	if(Set_X_ODR_When_Disabled(odr) == 1)
cparata	2:39ad2a393143	583	{
cparata	2:39ad2a393143	584	return 1;
cparata	2:39ad2a393143	585	}
cparata	2:39ad2a393143	586	}
cparata	2:39ad2a393143	587
cparata	2:39ad2a393143	588	return 0;
cparata	2:39ad2a393143	589	}
cparata	2:39ad2a393143	590
cparata	2:39ad2a393143	591	/**
cparata	2:39ad2a393143	592	* @brief Set LSM6DSL Accelerometer output data rate when enabled
cparata	2:39ad2a393143	593	* @param odr the output data rate to be set
cparata	2:39ad2a393143	594	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	595	*/
cparata	2:39ad2a393143	596	int LSM6DSLSensor::Set_X_ODR_When_Enabled(float odr)
cparata	2:39ad2a393143	597	{
cparata	2:39ad2a393143	598	LSM6DSL_ACC_GYRO_ODR_XL_t new_odr;
cparata	2:39ad2a393143	599
cparata	2:39ad2a393143	600	new_odr = ( odr <= 13.0f ) ? LSM6DSL_ACC_GYRO_ODR_XL_13Hz
cparata	2:39ad2a393143	601	: ( odr <= 26.0f ) ? LSM6DSL_ACC_GYRO_ODR_XL_26Hz
cparata	2:39ad2a393143	602	: ( odr <= 52.0f ) ? LSM6DSL_ACC_GYRO_ODR_XL_52Hz
cparata	2:39ad2a393143	603	: ( odr <= 104.0f ) ? LSM6DSL_ACC_GYRO_ODR_XL_104Hz
cparata	2:39ad2a393143	604	: ( odr <= 208.0f ) ? LSM6DSL_ACC_GYRO_ODR_XL_208Hz
cparata	2:39ad2a393143	605	: ( odr <= 416.0f ) ? LSM6DSL_ACC_GYRO_ODR_XL_416Hz
cparata	2:39ad2a393143	606	: ( odr <= 833.0f ) ? LSM6DSL_ACC_GYRO_ODR_XL_833Hz
cparata	2:39ad2a393143	607	: ( odr <= 1660.0f ) ? LSM6DSL_ACC_GYRO_ODR_XL_1660Hz
cparata	2:39ad2a393143	608	: ( odr <= 3330.0f ) ? LSM6DSL_ACC_GYRO_ODR_XL_3330Hz
cparata	2:39ad2a393143	609	: LSM6DSL_ACC_GYRO_ODR_XL_6660Hz;
cparata	2:39ad2a393143	610
cparata	2:39ad2a393143	611	if ( LSM6DSL_ACC_GYRO_W_ODR_XL( (void *)this, new_odr ) == MEMS_ERROR )
cparata	2:39ad2a393143	612	{
cparata	2:39ad2a393143	613	return 1;
cparata	2:39ad2a393143	614	}
cparata	2:39ad2a393143	615
cparata	2:39ad2a393143	616	return 0;
cparata	2:39ad2a393143	617	}
cparata	2:39ad2a393143	618
cparata	2:39ad2a393143	619	/**
cparata	2:39ad2a393143	620	* @brief Set LSM6DSL Accelerometer output data rate when disabled
cparata	2:39ad2a393143	621	* @param odr the output data rate to be set
cparata	2:39ad2a393143	622	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	623	*/
cparata	2:39ad2a393143	624	int LSM6DSLSensor::Set_X_ODR_When_Disabled(float odr)
cparata	2:39ad2a393143	625	{
cparata	2:39ad2a393143	626	X_Last_ODR = ( odr <= 13.0f ) ? 13.0f
cparata	2:39ad2a393143	627	: ( odr <= 26.0f ) ? 26.0f
cparata	2:39ad2a393143	628	: ( odr <= 52.0f ) ? 52.0f
cparata	2:39ad2a393143	629	: ( odr <= 104.0f ) ? 104.0f
cparata	2:39ad2a393143	630	: ( odr <= 208.0f ) ? 208.0f
cparata	2:39ad2a393143	631	: ( odr <= 416.0f ) ? 416.0f
cparata	2:39ad2a393143	632	: ( odr <= 833.0f ) ? 833.0f
cparata	2:39ad2a393143	633	: ( odr <= 1660.0f ) ? 1660.0f
cparata	2:39ad2a393143	634	: ( odr <= 3330.0f ) ? 3330.0f
cparata	2:39ad2a393143	635	: 6660.0f;
cparata	2:39ad2a393143	636
cparata	2:39ad2a393143	637	return 0;
cparata	2:39ad2a393143	638	}
cparata	2:39ad2a393143	639
cparata	2:39ad2a393143	640	/**
cparata	2:39ad2a393143	641	* @brief Set LSM6DSL Gyroscope output data rate
cparata	2:39ad2a393143	642	* @param odr the output data rate to be set
cparata	2:39ad2a393143	643	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	644	*/
cparata	2:39ad2a393143	645	int LSM6DSLSensor::Set_G_ODR(float odr)
cparata	2:39ad2a393143	646	{
cparata	2:39ad2a393143	647	if(G_isEnabled == 1)
cparata	2:39ad2a393143	648	{
cparata	2:39ad2a393143	649	if(Set_G_ODR_When_Enabled(odr) == 1)
cparata	2:39ad2a393143	650	{
cparata	2:39ad2a393143	651	return 1;
cparata	2:39ad2a393143	652	}
cparata	2:39ad2a393143	653	}
cparata	2:39ad2a393143	654	else
cparata	2:39ad2a393143	655	{
cparata	2:39ad2a393143	656	if(Set_G_ODR_When_Disabled(odr) == 1)
cparata	2:39ad2a393143	657	{
cparata	2:39ad2a393143	658	return 1;
cparata	2:39ad2a393143	659	}
cparata	2:39ad2a393143	660	}
cparata	2:39ad2a393143	661
cparata	2:39ad2a393143	662	return 0;
cparata	2:39ad2a393143	663	}
cparata	2:39ad2a393143	664
cparata	2:39ad2a393143	665	/**
cparata	2:39ad2a393143	666	* @brief Set LSM6DSL Gyroscope output data rate when enabled
cparata	2:39ad2a393143	667	* @param odr the output data rate to be set
cparata	2:39ad2a393143	668	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	669	*/
cparata	2:39ad2a393143	670	int LSM6DSLSensor::Set_G_ODR_When_Enabled(float odr)
cparata	2:39ad2a393143	671	{
cparata	2:39ad2a393143	672	LSM6DSL_ACC_GYRO_ODR_G_t new_odr;
cparata	2:39ad2a393143	673
cparata	2:39ad2a393143	674	new_odr = ( odr <= 13.0f ) ? LSM6DSL_ACC_GYRO_ODR_G_13Hz
cparata	2:39ad2a393143	675	: ( odr <= 26.0f ) ? LSM6DSL_ACC_GYRO_ODR_G_26Hz
cparata	2:39ad2a393143	676	: ( odr <= 52.0f ) ? LSM6DSL_ACC_GYRO_ODR_G_52Hz
cparata	2:39ad2a393143	677	: ( odr <= 104.0f ) ? LSM6DSL_ACC_GYRO_ODR_G_104Hz
cparata	2:39ad2a393143	678	: ( odr <= 208.0f ) ? LSM6DSL_ACC_GYRO_ODR_G_208Hz
cparata	2:39ad2a393143	679	: ( odr <= 416.0f ) ? LSM6DSL_ACC_GYRO_ODR_G_416Hz
cparata	2:39ad2a393143	680	: ( odr <= 833.0f ) ? LSM6DSL_ACC_GYRO_ODR_G_833Hz
cparata	2:39ad2a393143	681	: ( odr <= 1660.0f ) ? LSM6DSL_ACC_GYRO_ODR_G_1660Hz
cparata	2:39ad2a393143	682	: ( odr <= 3330.0f ) ? LSM6DSL_ACC_GYRO_ODR_G_3330Hz
cparata	2:39ad2a393143	683	: LSM6DSL_ACC_GYRO_ODR_G_6660Hz;
cparata	2:39ad2a393143	684
cparata	2:39ad2a393143	685	if ( LSM6DSL_ACC_GYRO_W_ODR_G( (void *)this, new_odr ) == MEMS_ERROR )
cparata	2:39ad2a393143	686	{
cparata	2:39ad2a393143	687	return 1;
cparata	2:39ad2a393143	688	}
cparata	2:39ad2a393143	689
cparata	2:39ad2a393143	690	return 0;
cparata	2:39ad2a393143	691	}
cparata	2:39ad2a393143	692
cparata	2:39ad2a393143	693	/**
cparata	2:39ad2a393143	694	* @brief Set LSM6DSL Gyroscope output data rate when disabled
cparata	2:39ad2a393143	695	* @param odr the output data rate to be set
cparata	2:39ad2a393143	696	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	697	*/
cparata	2:39ad2a393143	698	int LSM6DSLSensor::Set_G_ODR_When_Disabled(float odr)
cparata	2:39ad2a393143	699	{
cparata	2:39ad2a393143	700	G_Last_ODR = ( odr <= 13.0f ) ? 13.0f
cparata	2:39ad2a393143	701	: ( odr <= 26.0f ) ? 26.0f
cparata	2:39ad2a393143	702	: ( odr <= 52.0f ) ? 52.0f
cparata	2:39ad2a393143	703	: ( odr <= 104.0f ) ? 104.0f
cparata	2:39ad2a393143	704	: ( odr <= 208.0f ) ? 208.0f
cparata	2:39ad2a393143	705	: ( odr <= 416.0f ) ? 416.0f
cparata	2:39ad2a393143	706	: ( odr <= 833.0f ) ? 833.0f
cparata	2:39ad2a393143	707	: ( odr <= 1660.0f ) ? 1660.0f
cparata	2:39ad2a393143	708	: ( odr <= 3330.0f ) ? 3330.0f
cparata	2:39ad2a393143	709	: 6660.0f;
cparata	2:39ad2a393143	710
cparata	2:39ad2a393143	711	return 0;
cparata	2:39ad2a393143	712	}
cparata	2:39ad2a393143	713
cparata	2:39ad2a393143	714	/**
cparata	2:39ad2a393143	715	* @brief Read LSM6DSL Accelerometer full scale
cparata	2:39ad2a393143	716	* @param fullScale the pointer to the full scale
cparata	2:39ad2a393143	717	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	718	*/
cparata	2:39ad2a393143	719	int LSM6DSLSensor::Get_X_FS(float* fullScale)
cparata	2:39ad2a393143	720	{
cparata	2:39ad2a393143	721	LSM6DSL_ACC_GYRO_FS_XL_t fs_low_level;
cparata	2:39ad2a393143	722
cparata	2:39ad2a393143	723	if ( LSM6DSL_ACC_GYRO_R_FS_XL( (void *)this, &fs_low_level ) == MEMS_ERROR )
cparata	2:39ad2a393143	724	{
cparata	2:39ad2a393143	725	return 1;
cparata	2:39ad2a393143	726	}
cparata	2:39ad2a393143	727
cparata	2:39ad2a393143	728	switch( fs_low_level )
cparata	2:39ad2a393143	729	{
cparata	2:39ad2a393143	730	case LSM6DSL_ACC_GYRO_FS_XL_2g:
cparata	2:39ad2a393143	731	*fullScale = 2.0f;
cparata	2:39ad2a393143	732	break;
cparata	2:39ad2a393143	733	case LSM6DSL_ACC_GYRO_FS_XL_4g:
cparata	2:39ad2a393143	734	*fullScale = 4.0f;
cparata	2:39ad2a393143	735	break;
cparata	2:39ad2a393143	736	case LSM6DSL_ACC_GYRO_FS_XL_8g:
cparata	2:39ad2a393143	737	*fullScale = 8.0f;
cparata	2:39ad2a393143	738	break;
cparata	2:39ad2a393143	739	case LSM6DSL_ACC_GYRO_FS_XL_16g:
cparata	2:39ad2a393143	740	*fullScale = 16.0f;
cparata	2:39ad2a393143	741	break;
cparata	2:39ad2a393143	742	default:
cparata	2:39ad2a393143	743	*fullScale = -1.0f;
cparata	2:39ad2a393143	744	return 1;
cparata	2:39ad2a393143	745	}
cparata	2:39ad2a393143	746
cparata	2:39ad2a393143	747	return 0;
cparata	2:39ad2a393143	748	}
cparata	2:39ad2a393143	749
cparata	2:39ad2a393143	750	/**
cparata	2:39ad2a393143	751	* @brief Read LSM6DSL Gyroscope full scale
cparata	2:39ad2a393143	752	* @param fullScale the pointer to the full scale
cparata	2:39ad2a393143	753	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	754	*/
cparata	2:39ad2a393143	755	int LSM6DSLSensor::Get_G_FS(float* fullScale)
cparata	2:39ad2a393143	756	{
cparata	2:39ad2a393143	757	LSM6DSL_ACC_GYRO_FS_G_t fs_low_level;
cparata	2:39ad2a393143	758	LSM6DSL_ACC_GYRO_FS_125_t fs_125;
cparata	2:39ad2a393143	759
cparata	2:39ad2a393143	760	if ( LSM6DSL_ACC_GYRO_R_FS_125( (void *)this, &fs_125 ) == MEMS_ERROR )
cparata	2:39ad2a393143	761	{
cparata	2:39ad2a393143	762	return 1;
cparata	2:39ad2a393143	763	}
cparata	2:39ad2a393143	764	if ( LSM6DSL_ACC_GYRO_R_FS_G( (void *)this, &fs_low_level ) == MEMS_ERROR )
cparata	2:39ad2a393143	765	{
cparata	2:39ad2a393143	766	return 1;
cparata	2:39ad2a393143	767	}
cparata	2:39ad2a393143	768
cparata	2:39ad2a393143	769	if ( fs_125 == LSM6DSL_ACC_GYRO_FS_125_ENABLED )
cparata	2:39ad2a393143	770	{
cparata	2:39ad2a393143	771	*fullScale = 125.0f;
cparata	2:39ad2a393143	772	}
cparata	2:39ad2a393143	773
cparata	2:39ad2a393143	774	else
cparata	2:39ad2a393143	775	{
cparata	2:39ad2a393143	776	switch( fs_low_level )
cparata	2:39ad2a393143	777	{
cparata	2:39ad2a393143	778	case LSM6DSL_ACC_GYRO_FS_G_245dps:
cparata	2:39ad2a393143	779	*fullScale = 245.0f;
cparata	2:39ad2a393143	780	break;
cparata	2:39ad2a393143	781	case LSM6DSL_ACC_GYRO_FS_G_500dps:
cparata	2:39ad2a393143	782	*fullScale = 500.0f;
cparata	2:39ad2a393143	783	break;
cparata	2:39ad2a393143	784	case LSM6DSL_ACC_GYRO_FS_G_1000dps:
cparata	2:39ad2a393143	785	*fullScale = 1000.0f;
cparata	2:39ad2a393143	786	break;
cparata	2:39ad2a393143	787	case LSM6DSL_ACC_GYRO_FS_G_2000dps:
cparata	2:39ad2a393143	788	*fullScale = 2000.0f;
cparata	2:39ad2a393143	789	break;
cparata	2:39ad2a393143	790	default:
cparata	2:39ad2a393143	791	*fullScale = -1.0f;
cparata	2:39ad2a393143	792	return 1;
cparata	2:39ad2a393143	793	}
cparata	2:39ad2a393143	794	}
cparata	2:39ad2a393143	795
cparata	2:39ad2a393143	796	return 0;
cparata	2:39ad2a393143	797	}
cparata	2:39ad2a393143	798
cparata	2:39ad2a393143	799	/**
cparata	2:39ad2a393143	800	* @brief Set LSM6DSL Accelerometer full scale
cparata	2:39ad2a393143	801	* @param fullScale the full scale to be set
cparata	2:39ad2a393143	802	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	803	*/
cparata	2:39ad2a393143	804	int LSM6DSLSensor::Set_X_FS(float fullScale)
cparata	2:39ad2a393143	805	{
cparata	2:39ad2a393143	806	LSM6DSL_ACC_GYRO_FS_XL_t new_fs;
cparata	2:39ad2a393143	807
cparata	2:39ad2a393143	808	new_fs = ( fullScale <= 2.0f ) ? LSM6DSL_ACC_GYRO_FS_XL_2g
cparata	2:39ad2a393143	809	: ( fullScale <= 4.0f ) ? LSM6DSL_ACC_GYRO_FS_XL_4g
cparata	2:39ad2a393143	810	: ( fullScale <= 8.0f ) ? LSM6DSL_ACC_GYRO_FS_XL_8g
cparata	2:39ad2a393143	811	: LSM6DSL_ACC_GYRO_FS_XL_16g;
cparata	2:39ad2a393143	812
cparata	2:39ad2a393143	813	if ( LSM6DSL_ACC_GYRO_W_FS_XL( (void *)this, new_fs ) == MEMS_ERROR )
cparata	2:39ad2a393143	814	{
cparata	2:39ad2a393143	815	return 1;
cparata	2:39ad2a393143	816	}
cparata	2:39ad2a393143	817
cparata	2:39ad2a393143	818	return 0;
cparata	2:39ad2a393143	819	}
cparata	2:39ad2a393143	820
cparata	2:39ad2a393143	821	/**
cparata	2:39ad2a393143	822	* @brief Set LSM6DSL Gyroscope full scale
cparata	2:39ad2a393143	823	* @param fullScale the full scale to be set
cparata	2:39ad2a393143	824	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	825	*/
cparata	2:39ad2a393143	826	int LSM6DSLSensor::Set_G_FS(float fullScale)
cparata	2:39ad2a393143	827	{
cparata	2:39ad2a393143	828	LSM6DSL_ACC_GYRO_FS_G_t new_fs;
cparata	2:39ad2a393143	829
cparata	2:39ad2a393143	830	if ( fullScale <= 125.0f )
cparata	2:39ad2a393143	831	{
cparata	2:39ad2a393143	832	if ( LSM6DSL_ACC_GYRO_W_FS_125( (void *)this, LSM6DSL_ACC_GYRO_FS_125_ENABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	833	{
cparata	2:39ad2a393143	834	return 1;
cparata	2:39ad2a393143	835	}
cparata	2:39ad2a393143	836	}
cparata	2:39ad2a393143	837	else
cparata	2:39ad2a393143	838	{
cparata	2:39ad2a393143	839	new_fs = ( fullScale <= 245.0f ) ? LSM6DSL_ACC_GYRO_FS_G_245dps
cparata	2:39ad2a393143	840	: ( fullScale <= 500.0f ) ? LSM6DSL_ACC_GYRO_FS_G_500dps
cparata	2:39ad2a393143	841	: ( fullScale <= 1000.0f ) ? LSM6DSL_ACC_GYRO_FS_G_1000dps
cparata	2:39ad2a393143	842	: LSM6DSL_ACC_GYRO_FS_G_2000dps;
cparata	2:39ad2a393143	843
cparata	2:39ad2a393143	844	if ( LSM6DSL_ACC_GYRO_W_FS_125( (void *)this, LSM6DSL_ACC_GYRO_FS_125_DISABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	845	{
cparata	2:39ad2a393143	846	return 1;
cparata	2:39ad2a393143	847	}
cparata	2:39ad2a393143	848	if ( LSM6DSL_ACC_GYRO_W_FS_G( (void *)this, new_fs ) == MEMS_ERROR )
cparata	2:39ad2a393143	849	{
cparata	2:39ad2a393143	850	return 1;
cparata	2:39ad2a393143	851	}
cparata	2:39ad2a393143	852	}
cparata	2:39ad2a393143	853
cparata	2:39ad2a393143	854	return 0;
cparata	2:39ad2a393143	855	}
cparata	2:39ad2a393143	856
cparata	2:39ad2a393143	857	/**
cparata	2:39ad2a393143	858	* @brief Enable free fall detection
cparata	2:39ad2a393143	859	* @note This function sets the LSM6DSL accelerometer ODR to 416Hz and the LSM6DSL accelerometer full scale to 2g
cparata	2:39ad2a393143	860	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	861	*/
cparata	2:39ad2a393143	862	int LSM6DSLSensor::Enable_Free_Fall_Detection(void)
cparata	2:39ad2a393143	863	{
cparata	2:39ad2a393143	864	/* Output Data Rate selection */
cparata	2:39ad2a393143	865	if(Set_X_ODR(416.0f) == 1)
cparata	2:39ad2a393143	866	{
cparata	2:39ad2a393143	867	return 1;
cparata	2:39ad2a393143	868	}
cparata	2:39ad2a393143	869
cparata	2:39ad2a393143	870	/* Full scale selection */
cparata	2:39ad2a393143	871	if ( LSM6DSL_ACC_GYRO_W_FS_XL( (void *)this, LSM6DSL_ACC_GYRO_FS_XL_2g ) == MEMS_ERROR )
cparata	2:39ad2a393143	872	{
cparata	2:39ad2a393143	873	return 1;
cparata	2:39ad2a393143	874	}
cparata	2:39ad2a393143	875
cparata	2:39ad2a393143	876	/* FF_DUR setting */
cparata	2:39ad2a393143	877	if ( LSM6DSL_ACC_GYRO_W_FF_Duration( (void *)this, 0x06 ) == MEMS_ERROR )
cparata	2:39ad2a393143	878	{
cparata	2:39ad2a393143	879	return 1;
cparata	2:39ad2a393143	880	}
cparata	2:39ad2a393143	881
cparata	2:39ad2a393143	882	/* WAKE_DUR setting */
cparata	2:39ad2a393143	883	if ( LSM6DSL_ACC_GYRO_W_WAKE_DUR( (void *)this, 0x00 ) == MEMS_ERROR )
cparata	2:39ad2a393143	884	{
cparata	2:39ad2a393143	885	return 1;
cparata	2:39ad2a393143	886	}
cparata	2:39ad2a393143	887
cparata	2:39ad2a393143	888	/* TIMER_HR setting */
cparata	2:39ad2a393143	889	if ( LSM6DSL_ACC_GYRO_W_TIMER_HR( (void *)this, LSM6DSL_ACC_GYRO_TIMER_HR_6_4ms ) == MEMS_ERROR )
cparata	2:39ad2a393143	890	{
cparata	2:39ad2a393143	891	return 1;
cparata	2:39ad2a393143	892	}
cparata	2:39ad2a393143	893
cparata	2:39ad2a393143	894	/* SLEEP_DUR setting */
cparata	2:39ad2a393143	895	if ( LSM6DSL_ACC_GYRO_W_SLEEP_DUR( (void *)this, 0x00 ) == MEMS_ERROR )
cparata	2:39ad2a393143	896	{
cparata	2:39ad2a393143	897	return 1;
cparata	2:39ad2a393143	898	}
cparata	2:39ad2a393143	899
cparata	2:39ad2a393143	900	/* FF_THS setting */
cparata	2:39ad2a393143	901	if ( LSM6DSL_ACC_GYRO_W_FF_THS( (void *)this, LSM6DSL_ACC_GYRO_FF_THS_312mg ) == MEMS_ERROR )
cparata	2:39ad2a393143	902	{
cparata	2:39ad2a393143	903	return 1;
cparata	2:39ad2a393143	904	}
cparata	2:39ad2a393143	905
cparata	2:39ad2a393143	906	/* Enable basic Interrupts */
cparata	2:39ad2a393143	907	if ( LSM6DSL_ACC_GYRO_W_BASIC_INT( (void *)this, LSM6DSL_ACC_GYRO_BASIC_INT_ENABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	908	{
cparata	2:39ad2a393143	909	return 1;
cparata	2:39ad2a393143	910	}
cparata	2:39ad2a393143	911
cparata	2:39ad2a393143	912	/* INT1_FF setting */
cparata	2:39ad2a393143	913	if ( LSM6DSL_ACC_GYRO_W_FFEvOnInt1( (void *)this, LSM6DSL_ACC_GYRO_INT1_FF_ENABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	914	{
cparata	2:39ad2a393143	915	return 1;
cparata	2:39ad2a393143	916	}
cparata	2:39ad2a393143	917
cparata	2:39ad2a393143	918	return 0;
cparata	2:39ad2a393143	919	}
cparata	2:39ad2a393143	920
cparata	2:39ad2a393143	921	/**
cparata	2:39ad2a393143	922	* @brief Disable free fall detection
cparata	2:39ad2a393143	923	* @param None
cparata	2:39ad2a393143	924	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	925	*/
cparata	2:39ad2a393143	926	int LSM6DSLSensor::Disable_Free_Fall_Detection(void)
cparata	2:39ad2a393143	927	{
cparata	2:39ad2a393143	928	/* INT1_FF setting */
cparata	2:39ad2a393143	929	if ( LSM6DSL_ACC_GYRO_W_FFEvOnInt1( (void *)this, LSM6DSL_ACC_GYRO_INT1_FF_DISABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	930	{
cparata	2:39ad2a393143	931	return 1;
cparata	2:39ad2a393143	932	}
cparata	2:39ad2a393143	933
cparata	2:39ad2a393143	934	/* Disable basic Interrupts */
cparata	2:39ad2a393143	935	if ( LSM6DSL_ACC_GYRO_W_BASIC_INT( (void *)this, LSM6DSL_ACC_GYRO_BASIC_INT_DISABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	936	{
cparata	2:39ad2a393143	937	return 1;
cparata	2:39ad2a393143	938	}
cparata	2:39ad2a393143	939
cparata	2:39ad2a393143	940	/* FF_DUR setting */
cparata	2:39ad2a393143	941	if ( LSM6DSL_ACC_GYRO_W_FF_Duration( (void *)this, 0x00 ) == MEMS_ERROR )
cparata	2:39ad2a393143	942	{
cparata	2:39ad2a393143	943	return 1;
cparata	2:39ad2a393143	944	}
cparata	2:39ad2a393143	945
cparata	2:39ad2a393143	946	/* FF_THS setting */
cparata	2:39ad2a393143	947	if ( LSM6DSL_ACC_GYRO_W_FF_THS( (void *)this, LSM6DSL_ACC_GYRO_FF_THS_156mg ) == MEMS_ERROR )
cparata	2:39ad2a393143	948	{
cparata	2:39ad2a393143	949	return 1;
cparata	2:39ad2a393143	950	}
cparata	2:39ad2a393143	951
cparata	2:39ad2a393143	952	return 0;
cparata	2:39ad2a393143	953	}
cparata	2:39ad2a393143	954
cparata	2:39ad2a393143	955	/**
cparata	2:39ad2a393143	956	* @brief Get status of free fall detection
cparata	2:39ad2a393143	957	* @param status the pointer where the status of free fall detection is stored; 0 means no detection, 1 means detection happened
cparata	2:39ad2a393143	958	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	959	*/
cparata	2:39ad2a393143	960	int LSM6DSLSensor::Get_Status_Free_Fall_Detection(uint8_t *status)
cparata	2:39ad2a393143	961	{
cparata	2:39ad2a393143	962	LSM6DSL_ACC_GYRO_FF_EV_STATUS_t free_fall_status;
cparata	2:39ad2a393143	963
cparata	2:39ad2a393143	964	if ( LSM6DSL_ACC_GYRO_R_FF_EV_STATUS( (void *)this, &free_fall_status ) == MEMS_ERROR )
cparata	2:39ad2a393143	965	{
cparata	2:39ad2a393143	966	return 1;
cparata	2:39ad2a393143	967	}
cparata	2:39ad2a393143	968
cparata	2:39ad2a393143	969	switch( free_fall_status )
cparata	2:39ad2a393143	970	{
cparata	2:39ad2a393143	971	case LSM6DSL_ACC_GYRO_FF_EV_STATUS_DETECTED:
cparata	2:39ad2a393143	972	*status = 1;
cparata	2:39ad2a393143	973	break;
cparata	2:39ad2a393143	974	case LSM6DSL_ACC_GYRO_FF_EV_STATUS_NOT_DETECTED:
cparata	2:39ad2a393143	975	*status = 0;
cparata	2:39ad2a393143	976	break;
cparata	2:39ad2a393143	977	default:
cparata	2:39ad2a393143	978	return 1;
cparata	2:39ad2a393143	979	}
cparata	2:39ad2a393143	980
cparata	2:39ad2a393143	981	return 0;
cparata	2:39ad2a393143	982	}
cparata	2:39ad2a393143	983
cparata	2:39ad2a393143	984	/**
cparata	2:39ad2a393143	985	* @brief Set the free fall detection threshold for LSM6DSL accelerometer sensor
cparata	2:39ad2a393143	986	* @param thr the threshold to be set
cparata	2:39ad2a393143	987	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	988	*/
cparata	2:39ad2a393143	989	int LSM6DSLSensor::Set_Free_Fall_Threshold(uint8_t thr)
cparata	2:39ad2a393143	990	{
cparata	2:39ad2a393143	991
cparata	2:39ad2a393143	992	if ( LSM6DSL_ACC_GYRO_W_FF_THS( (void *)this, (LSM6DSL_ACC_GYRO_FF_THS_t)thr ) == MEMS_ERROR )
cparata	2:39ad2a393143	993	{
cparata	2:39ad2a393143	994	return 1;
cparata	2:39ad2a393143	995	}
cparata	2:39ad2a393143	996
cparata	2:39ad2a393143	997	return 0;
cparata	2:39ad2a393143	998	}
cparata	2:39ad2a393143	999
cparata	2:39ad2a393143	1000	/**
cparata	2:39ad2a393143	1001	* @brief Enable the pedometer feature for LSM6DSL accelerometer sensor
cparata	2:39ad2a393143	1002	* @note This function sets the LSM6DSL accelerometer ODR to 26Hz and the LSM6DSL accelerometer full scale to 2g
cparata	2:39ad2a393143	1003	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	1004	*/
cparata	2:39ad2a393143	1005	int LSM6DSLSensor::Enable_Pedometer(void)
cparata	2:39ad2a393143	1006	{
cparata	2:39ad2a393143	1007	/* Output Data Rate selection */
cparata	2:39ad2a393143	1008	if( Set_X_ODR(26.0f) == 1 )
cparata	2:39ad2a393143	1009	{
cparata	2:39ad2a393143	1010	return 1;
cparata	2:39ad2a393143	1011	}
cparata	2:39ad2a393143	1012
cparata	2:39ad2a393143	1013	/* Full scale selection. */
cparata	2:39ad2a393143	1014	if( Set_X_FS(2.0f) == 1 )
cparata	2:39ad2a393143	1015	{
cparata	2:39ad2a393143	1016	return 1;
cparata	2:39ad2a393143	1017	}
cparata	2:39ad2a393143	1018
cparata	2:39ad2a393143	1019	/* Set pedometer threshold. */
cparata	2:39ad2a393143	1020	if ( Set_Pedometer_Threshold(LSM6DSL_PEDOMETER_THRESHOLD_MID_HIGH) == 1 )
cparata	2:39ad2a393143	1021	{
cparata	2:39ad2a393143	1022	return 1;
cparata	2:39ad2a393143	1023	}
cparata	2:39ad2a393143	1024
cparata	2:39ad2a393143	1025	/* Enable embedded functionalities. */
cparata	2:39ad2a393143	1026	if ( LSM6DSL_ACC_GYRO_W_FUNC_EN( (void *)this, LSM6DSL_ACC_GYRO_FUNC_EN_ENABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1027	{
cparata	2:39ad2a393143	1028	return 1;
cparata	2:39ad2a393143	1029	}
cparata	2:39ad2a393143	1030
cparata	2:39ad2a393143	1031	/* Enable pedometer algorithm. */
cparata	2:39ad2a393143	1032	if ( LSM6DSL_ACC_GYRO_W_PEDO( (void *)this, LSM6DSL_ACC_GYRO_PEDO_ENABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1033	{
cparata	2:39ad2a393143	1034	return 1;
cparata	2:39ad2a393143	1035	}
cparata	2:39ad2a393143	1036
cparata	2:39ad2a393143	1037	/* Enable pedometer on INT1. */
cparata	2:39ad2a393143	1038	if ( LSM6DSL_ACC_GYRO_W_STEP_DET_on_INT1( (void *)this, LSM6DSL_ACC_GYRO_INT1_PEDO_ENABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1039	{
cparata	2:39ad2a393143	1040	return 1;
cparata	2:39ad2a393143	1041	}
cparata	2:39ad2a393143	1042
cparata	2:39ad2a393143	1043	return 0;
cparata	2:39ad2a393143	1044	}
cparata	2:39ad2a393143	1045
cparata	2:39ad2a393143	1046	/**
cparata	2:39ad2a393143	1047	* @brief Disable the pedometer feature for LSM6DSL accelerometer sensor
cparata	2:39ad2a393143	1048	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	1049	*/
cparata	2:39ad2a393143	1050	int LSM6DSLSensor::Disable_Pedometer(void)
cparata	2:39ad2a393143	1051	{
cparata	2:39ad2a393143	1052	/* Disable pedometer on INT1. */
cparata	2:39ad2a393143	1053	if ( LSM6DSL_ACC_GYRO_W_STEP_DET_on_INT1( (void *)this, LSM6DSL_ACC_GYRO_INT1_PEDO_DISABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1054	{
cparata	2:39ad2a393143	1055	return 1;
cparata	2:39ad2a393143	1056	}
cparata	2:39ad2a393143	1057
cparata	2:39ad2a393143	1058	/* Disable pedometer algorithm. */
cparata	2:39ad2a393143	1059	if ( LSM6DSL_ACC_GYRO_W_PEDO( (void *)this, LSM6DSL_ACC_GYRO_PEDO_DISABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1060	{
cparata	2:39ad2a393143	1061	return 1;
cparata	2:39ad2a393143	1062	}
cparata	2:39ad2a393143	1063
cparata	2:39ad2a393143	1064	/* Disable embedded functionalities. */
cparata	2:39ad2a393143	1065	if ( LSM6DSL_ACC_GYRO_W_FUNC_EN( (void *)this, LSM6DSL_ACC_GYRO_FUNC_EN_DISABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1066	{
cparata	2:39ad2a393143	1067	return 1;
cparata	2:39ad2a393143	1068	}
cparata	2:39ad2a393143	1069
cparata	2:39ad2a393143	1070	/* Reset pedometer threshold. */
cparata	2:39ad2a393143	1071	if ( Set_Pedometer_Threshold(0x0) == 1 )
cparata	2:39ad2a393143	1072	{
cparata	2:39ad2a393143	1073	return 1;
cparata	2:39ad2a393143	1074	}
cparata	2:39ad2a393143	1075
cparata	2:39ad2a393143	1076	return 0;
cparata	2:39ad2a393143	1077	}
cparata	2:39ad2a393143	1078
cparata	2:39ad2a393143	1079	/**
cparata	2:39ad2a393143	1080	* @brief Get the pedometer status for LSM6DSL accelerometer sensor
cparata	2:39ad2a393143	1081	* @param status the pointer to the pedometer status: 0 means no step detected, 1 means step detected
cparata	2:39ad2a393143	1082	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	1083	*/
cparata	2:39ad2a393143	1084	int LSM6DSLSensor::Get_Status_Pedometer(uint8_t *status)
cparata	2:39ad2a393143	1085	{
cparata	2:39ad2a393143	1086	LSM6DSL_ACC_GYRO_PEDO_EV_STATUS_t pedometer_status;
cparata	2:39ad2a393143	1087
cparata	2:39ad2a393143	1088	if ( LSM6DSL_ACC_GYRO_R_PEDO_EV_STATUS( (void *)this, &pedometer_status ) == MEMS_ERROR )
cparata	2:39ad2a393143	1089	{
cparata	2:39ad2a393143	1090	return 1;
cparata	2:39ad2a393143	1091	}
cparata	2:39ad2a393143	1092
cparata	2:39ad2a393143	1093	switch( pedometer_status )
cparata	2:39ad2a393143	1094	{
cparata	2:39ad2a393143	1095	case LSM6DSL_ACC_GYRO_PEDO_EV_STATUS_DETECTED:
cparata	2:39ad2a393143	1096	*status = 1;
cparata	2:39ad2a393143	1097	break;
cparata	2:39ad2a393143	1098	case LSM6DSL_ACC_GYRO_PEDO_EV_STATUS_NOT_DETECTED:
cparata	2:39ad2a393143	1099	*status = 0;
cparata	2:39ad2a393143	1100	break;
cparata	2:39ad2a393143	1101	default:
cparata	2:39ad2a393143	1102	return 1;
cparata	2:39ad2a393143	1103	}
cparata	2:39ad2a393143	1104
cparata	2:39ad2a393143	1105	return 0;
cparata	2:39ad2a393143	1106	}
cparata	2:39ad2a393143	1107
cparata	2:39ad2a393143	1108	/**
cparata	2:39ad2a393143	1109	* @brief Get the step counter for LSM6DSL accelerometer sensor
cparata	2:39ad2a393143	1110	* @param step_count the pointer to the step counter
cparata	2:39ad2a393143	1111	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	1112	*/
cparata	2:39ad2a393143	1113	int LSM6DSLSensor::Get_Step_Counter(uint16_t *step_count)
cparata	2:39ad2a393143	1114	{
cparata	2:39ad2a393143	1115	if ( LSM6DSL_ACC_GYRO_Get_GetStepCounter( (void )this, ( uint8_t )step_count ) == MEMS_ERROR )
cparata	2:39ad2a393143	1116	{
cparata	2:39ad2a393143	1117	return 1;
cparata	2:39ad2a393143	1118	}
cparata	2:39ad2a393143	1119
cparata	2:39ad2a393143	1120	return 0;
cparata	2:39ad2a393143	1121	}
cparata	2:39ad2a393143	1122
cparata	2:39ad2a393143	1123	/**
cparata	2:39ad2a393143	1124	* @brief Reset of the step counter for LSM6DSL accelerometer sensor
cparata	2:39ad2a393143	1125	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	1126	*/
cparata	2:39ad2a393143	1127	int LSM6DSLSensor::Reset_Step_Counter(void)
cparata	2:39ad2a393143	1128	{
cparata	2:39ad2a393143	1129	if ( LSM6DSL_ACC_GYRO_W_PedoStepReset( (void *)this, LSM6DSL_ACC_GYRO_PEDO_RST_STEP_ENABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1130	{
cparata	2:39ad2a393143	1131	return 1;
cparata	2:39ad2a393143	1132	}
cparata	2:39ad2a393143	1133
cparata	2:39ad2a393143	1134	wait_ms(10);
cparata	2:39ad2a393143	1135
cparata	2:39ad2a393143	1136	if ( LSM6DSL_ACC_GYRO_W_PedoStepReset( (void *)this, LSM6DSL_ACC_GYRO_PEDO_RST_STEP_DISABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1137	{
cparata	2:39ad2a393143	1138	return 1;
cparata	2:39ad2a393143	1139	}
cparata	2:39ad2a393143	1140
cparata	2:39ad2a393143	1141	return 0;
cparata	2:39ad2a393143	1142	}
cparata	2:39ad2a393143	1143
cparata	2:39ad2a393143	1144	/**
cparata	2:39ad2a393143	1145	* @brief Set the pedometer threshold for LSM6DSL accelerometer sensor
cparata	2:39ad2a393143	1146	* @param thr the threshold to be set
cparata	2:39ad2a393143	1147	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	1148	*/
cparata	2:39ad2a393143	1149	int LSM6DSLSensor::Set_Pedometer_Threshold(uint8_t thr)
cparata	2:39ad2a393143	1150	{
cparata	2:39ad2a393143	1151	if ( LSM6DSL_ACC_GYRO_W_PedoThreshold( (void *)this, thr ) == MEMS_ERROR )
cparata	2:39ad2a393143	1152	{
cparata	2:39ad2a393143	1153	return 1;
cparata	2:39ad2a393143	1154	}
cparata	2:39ad2a393143	1155
cparata	2:39ad2a393143	1156	return 0;
cparata	2:39ad2a393143	1157	}
cparata	2:39ad2a393143	1158
cparata	2:39ad2a393143	1159	/**
cparata	2:39ad2a393143	1160	* @brief Enable the tilt detection for LSM6DSL accelerometer sensor
cparata	2:39ad2a393143	1161	* @note This function sets the LSM6DSL accelerometer ODR to 26Hz and the LSM6DSL accelerometer full scale to 2g
cparata	2:39ad2a393143	1162	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	1163	*/
cparata	2:39ad2a393143	1164	int LSM6DSLSensor::Enable_Tilt_Detection(void)
cparata	2:39ad2a393143	1165	{
cparata	2:39ad2a393143	1166	/* Output Data Rate selection */
cparata	2:39ad2a393143	1167	if( Set_X_ODR(26.0f) == 1 )
cparata	2:39ad2a393143	1168	{
cparata	2:39ad2a393143	1169	return 1;
cparata	2:39ad2a393143	1170	}
cparata	2:39ad2a393143	1171
cparata	2:39ad2a393143	1172	/* Full scale selection. */
cparata	2:39ad2a393143	1173	if( Set_X_FS(2.0f) == 1 )
cparata	2:39ad2a393143	1174	{
cparata	2:39ad2a393143	1175	return 1;
cparata	2:39ad2a393143	1176	}
cparata	2:39ad2a393143	1177
cparata	2:39ad2a393143	1178	/* Enable embedded functionalities */
cparata	2:39ad2a393143	1179	if ( LSM6DSL_ACC_GYRO_W_FUNC_EN( (void *)this, LSM6DSL_ACC_GYRO_FUNC_EN_ENABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1180	{
cparata	2:39ad2a393143	1181	return 1;
cparata	2:39ad2a393143	1182	}
cparata	2:39ad2a393143	1183
cparata	2:39ad2a393143	1184	/* Enable tilt calculation. */
cparata	2:39ad2a393143	1185	if ( LSM6DSL_ACC_GYRO_W_TILT( (void *)this, LSM6DSL_ACC_GYRO_TILT_ENABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1186	{
cparata	2:39ad2a393143	1187	return 1;
cparata	2:39ad2a393143	1188	}
cparata	2:39ad2a393143	1189
cparata	2:39ad2a393143	1190	/* Enable tilt event on INT1. */
cparata	2:39ad2a393143	1191	if ( LSM6DSL_ACC_GYRO_W_TiltEvOnInt1( (void *)this, LSM6DSL_ACC_GYRO_INT1_TILT_ENABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1192	{
cparata	2:39ad2a393143	1193	return 1;
cparata	2:39ad2a393143	1194	}
cparata	2:39ad2a393143	1195
cparata	2:39ad2a393143	1196	return 0;
cparata	2:39ad2a393143	1197	}
cparata	2:39ad2a393143	1198
cparata	2:39ad2a393143	1199	/**
cparata	2:39ad2a393143	1200	* @brief Disable the tilt detection for LSM6DSL accelerometer sensor
cparata	2:39ad2a393143	1201	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	1202	*/
cparata	2:39ad2a393143	1203	int LSM6DSLSensor::Disable_Tilt_Detection(void)
cparata	2:39ad2a393143	1204	{
cparata	2:39ad2a393143	1205	/* Disable tilt event on INT1. */
cparata	2:39ad2a393143	1206	if ( LSM6DSL_ACC_GYRO_W_TiltEvOnInt1( (void *)this, LSM6DSL_ACC_GYRO_INT1_TILT_DISABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1207	{
cparata	2:39ad2a393143	1208	return 1;
cparata	2:39ad2a393143	1209	}
cparata	2:39ad2a393143	1210
cparata	2:39ad2a393143	1211	/* Disable tilt calculation. */
cparata	2:39ad2a393143	1212	if ( LSM6DSL_ACC_GYRO_W_TILT( (void *)this, LSM6DSL_ACC_GYRO_TILT_DISABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1213	{
cparata	2:39ad2a393143	1214	return 1;
cparata	2:39ad2a393143	1215	}
cparata	2:39ad2a393143	1216
cparata	2:39ad2a393143	1217	/* Disable embedded functionalities */
cparata	2:39ad2a393143	1218	if ( LSM6DSL_ACC_GYRO_W_FUNC_EN( (void *)this, LSM6DSL_ACC_GYRO_FUNC_EN_DISABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1219	{
cparata	2:39ad2a393143	1220	return 1;
cparata	2:39ad2a393143	1221	}
cparata	2:39ad2a393143	1222
cparata	2:39ad2a393143	1223	return 0;
cparata	2:39ad2a393143	1224	}
cparata	2:39ad2a393143	1225
cparata	2:39ad2a393143	1226	/**
cparata	2:39ad2a393143	1227	* @brief Get the tilt detection status for LSM6DSL accelerometer sensor
cparata	2:39ad2a393143	1228	* @param status the pointer to the tilt detection status: 0 means no tilt detected, 1 means tilt detected
cparata	2:39ad2a393143	1229	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	1230	*/
cparata	2:39ad2a393143	1231	int LSM6DSLSensor::Get_Status_Tilt_Detection(uint8_t *status)
cparata	2:39ad2a393143	1232	{
cparata	2:39ad2a393143	1233	LSM6DSL_ACC_GYRO_TILT_EV_STATUS_t tilt_status;
cparata	2:39ad2a393143	1234
cparata	2:39ad2a393143	1235	if ( LSM6DSL_ACC_GYRO_R_TILT_EV_STATUS( (void *)this, &tilt_status ) == MEMS_ERROR )
cparata	2:39ad2a393143	1236	{
cparata	2:39ad2a393143	1237	return 1;
cparata	2:39ad2a393143	1238	}
cparata	2:39ad2a393143	1239
cparata	2:39ad2a393143	1240	switch( tilt_status )
cparata	2:39ad2a393143	1241	{
cparata	2:39ad2a393143	1242	case LSM6DSL_ACC_GYRO_TILT_EV_STATUS_DETECTED:
cparata	2:39ad2a393143	1243	*status = 1;
cparata	2:39ad2a393143	1244	break;
cparata	2:39ad2a393143	1245	case LSM6DSL_ACC_GYRO_TILT_EV_STATUS_NOT_DETECTED:
cparata	2:39ad2a393143	1246	*status = 0;
cparata	2:39ad2a393143	1247	break;
cparata	2:39ad2a393143	1248	default:
cparata	2:39ad2a393143	1249	return 1;
cparata	2:39ad2a393143	1250	}
cparata	2:39ad2a393143	1251
cparata	2:39ad2a393143	1252	return 0;
cparata	2:39ad2a393143	1253	}
cparata	2:39ad2a393143	1254
cparata	2:39ad2a393143	1255	/**
cparata	2:39ad2a393143	1256	* @brief Enable the wake up detection for LSM6DSL accelerometer sensor
cparata	2:39ad2a393143	1257	* @note This function sets the LSM6DSL accelerometer ODR to 416Hz and the LSM6DSL accelerometer full scale to 2g
cparata	2:39ad2a393143	1258	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	1259	*/
cparata	2:39ad2a393143	1260	int LSM6DSLSensor::Enable_Wake_Up_Detection(void)
cparata	2:39ad2a393143	1261	{
cparata	2:39ad2a393143	1262	/* Output Data Rate selection */
cparata	2:39ad2a393143	1263	if( Set_X_ODR(416.0f) == 1 )
cparata	2:39ad2a393143	1264	{
cparata	2:39ad2a393143	1265	return 1;
cparata	2:39ad2a393143	1266	}
cparata	2:39ad2a393143	1267
cparata	2:39ad2a393143	1268	/* Full scale selection. */
cparata	2:39ad2a393143	1269	if( Set_X_FS(2.0f) == 1 )
cparata	2:39ad2a393143	1270	{
cparata	2:39ad2a393143	1271	return 1;
cparata	2:39ad2a393143	1272	}
cparata	2:39ad2a393143	1273
cparata	2:39ad2a393143	1274	/* WAKE_DUR setting */
cparata	2:39ad2a393143	1275	if ( LSM6DSL_ACC_GYRO_W_WAKE_DUR( (void *)this, 0x00 ) == MEMS_ERROR )
cparata	2:39ad2a393143	1276	{
cparata	2:39ad2a393143	1277	return 1;
cparata	2:39ad2a393143	1278	}
cparata	2:39ad2a393143	1279
cparata	2:39ad2a393143	1280	/* Set wake up threshold. */
cparata	2:39ad2a393143	1281	if ( LSM6DSL_ACC_GYRO_W_WK_THS( (void *)this, 0x02 ) == MEMS_ERROR )
cparata	2:39ad2a393143	1282	{
cparata	2:39ad2a393143	1283	return 1;
cparata	2:39ad2a393143	1284	}
cparata	2:39ad2a393143	1285
cparata	2:39ad2a393143	1286	/* Enable basic Interrupts */
cparata	2:39ad2a393143	1287	if ( LSM6DSL_ACC_GYRO_W_BASIC_INT( (void *)this, LSM6DSL_ACC_GYRO_BASIC_INT_ENABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1288	{
cparata	2:39ad2a393143	1289	return 1;
cparata	2:39ad2a393143	1290	}
cparata	2:39ad2a393143	1291
cparata	2:39ad2a393143	1292	/* INT1_WU setting */
cparata	2:39ad2a393143	1293	if ( LSM6DSL_ACC_GYRO_W_WUEvOnInt1( (void *)this, LSM6DSL_ACC_GYRO_INT1_WU_ENABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1294	{
cparata	2:39ad2a393143	1295	return 1;
cparata	2:39ad2a393143	1296	}
cparata	2:39ad2a393143	1297
cparata	2:39ad2a393143	1298	return 0;
cparata	2:39ad2a393143	1299	}
cparata	2:39ad2a393143	1300
cparata	2:39ad2a393143	1301	/**
cparata	2:39ad2a393143	1302	* @brief Disable the wake up detection for LSM6DSL accelerometer sensor
cparata	2:39ad2a393143	1303	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	1304	*/
cparata	2:39ad2a393143	1305	int LSM6DSLSensor::Disable_Wake_Up_Detection(void)
cparata	2:39ad2a393143	1306	{
cparata	2:39ad2a393143	1307	/* INT1_WU setting */
cparata	2:39ad2a393143	1308	if ( LSM6DSL_ACC_GYRO_W_WUEvOnInt1( (void *)this, LSM6DSL_ACC_GYRO_INT1_WU_DISABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1309	{
cparata	2:39ad2a393143	1310	return 1;
cparata	2:39ad2a393143	1311	}
cparata	2:39ad2a393143	1312
cparata	2:39ad2a393143	1313	/* Disable basic Interrupts */
cparata	2:39ad2a393143	1314	if ( LSM6DSL_ACC_GYRO_W_BASIC_INT( (void *)this, LSM6DSL_ACC_GYRO_BASIC_INT_DISABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1315	{
cparata	2:39ad2a393143	1316	return 1;
cparata	2:39ad2a393143	1317	}
cparata	2:39ad2a393143	1318
cparata	2:39ad2a393143	1319	/* WU_DUR setting */
cparata	2:39ad2a393143	1320	if ( LSM6DSL_ACC_GYRO_W_WAKE_DUR( (void *)this, 0x00 ) == MEMS_ERROR )
cparata	2:39ad2a393143	1321	{
cparata	2:39ad2a393143	1322	return 1;
cparata	2:39ad2a393143	1323	}
cparata	2:39ad2a393143	1324
cparata	2:39ad2a393143	1325	/* WU_THS setting */
cparata	2:39ad2a393143	1326	if ( LSM6DSL_ACC_GYRO_W_WK_THS( (void *)this, 0x00 ) == MEMS_ERROR )
cparata	2:39ad2a393143	1327	{
cparata	2:39ad2a393143	1328	return 1;
cparata	2:39ad2a393143	1329	}
cparata	2:39ad2a393143	1330
cparata	2:39ad2a393143	1331	return 0;
cparata	2:39ad2a393143	1332	}
cparata	2:39ad2a393143	1333
cparata	2:39ad2a393143	1334	/**
cparata	2:39ad2a393143	1335	* @brief Get the status of the wake up detection for LSM6DSL accelerometer sensor
cparata	2:39ad2a393143	1336	* @param status the pointer to the status of the wake up detection: 0 means no detection, 1 means detection happened
cparata	2:39ad2a393143	1337	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	1338	*/
cparata	2:39ad2a393143	1339	int LSM6DSLSensor::Get_Status_Wake_Up_Detection(uint8_t *status)
cparata	2:39ad2a393143	1340	{
cparata	2:39ad2a393143	1341	LSM6DSL_ACC_GYRO_WU_EV_STATUS_t wake_up_status;
cparata	2:39ad2a393143	1342
cparata	2:39ad2a393143	1343	if ( LSM6DSL_ACC_GYRO_R_WU_EV_STATUS( (void *)this, &wake_up_status ) == MEMS_ERROR )
cparata	2:39ad2a393143	1344	{
cparata	2:39ad2a393143	1345	return 1;
cparata	2:39ad2a393143	1346	}
cparata	2:39ad2a393143	1347
cparata	2:39ad2a393143	1348	switch( wake_up_status )
cparata	2:39ad2a393143	1349	{
cparata	2:39ad2a393143	1350	case LSM6DSL_ACC_GYRO_WU_EV_STATUS_DETECTED:
cparata	2:39ad2a393143	1351	*status = 1;
cparata	2:39ad2a393143	1352	break;
cparata	2:39ad2a393143	1353	case LSM6DSL_ACC_GYRO_WU_EV_STATUS_NOT_DETECTED:
cparata	2:39ad2a393143	1354	*status = 0;
cparata	2:39ad2a393143	1355	break;
cparata	2:39ad2a393143	1356	default:
cparata	2:39ad2a393143	1357	return 1;
cparata	2:39ad2a393143	1358	}
cparata	2:39ad2a393143	1359
cparata	2:39ad2a393143	1360	return 0;
cparata	2:39ad2a393143	1361	}
cparata	2:39ad2a393143	1362
cparata	2:39ad2a393143	1363	/**
cparata	2:39ad2a393143	1364	* @brief Set the wake up threshold for LSM6DSL accelerometer sensor
cparata	2:39ad2a393143	1365	* @param thr the threshold to be set
cparata	2:39ad2a393143	1366	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	1367	*/
cparata	2:39ad2a393143	1368	int LSM6DSLSensor::Set_Wake_Up_Threshold(uint8_t thr)
cparata	2:39ad2a393143	1369	{
cparata	2:39ad2a393143	1370	if ( LSM6DSL_ACC_GYRO_W_WK_THS( (void *)this, thr ) == MEMS_ERROR )
cparata	2:39ad2a393143	1371	{
cparata	2:39ad2a393143	1372	return 1;
cparata	2:39ad2a393143	1373	}
cparata	2:39ad2a393143	1374
cparata	2:39ad2a393143	1375	return 0;
cparata	2:39ad2a393143	1376	}
cparata	2:39ad2a393143	1377
cparata	2:39ad2a393143	1378	/**
cparata	2:39ad2a393143	1379	* @brief Enable the single tap detection for LSM6DSL accelerometer sensor
cparata	2:39ad2a393143	1380	* @note This function sets the LSM6DSL accelerometer ODR to 416Hz and the LSM6DSL accelerometer full scale to 2g
cparata	2:39ad2a393143	1381	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	1382	*/
cparata	2:39ad2a393143	1383	int LSM6DSLSensor::Enable_Single_Tap_Detection(void)
cparata	2:39ad2a393143	1384	{
cparata	2:39ad2a393143	1385	/* Output Data Rate selection */
cparata	2:39ad2a393143	1386	if( Set_X_ODR(416.0f) == 1 )
cparata	2:39ad2a393143	1387	{
cparata	2:39ad2a393143	1388	return 1;
cparata	2:39ad2a393143	1389	}
cparata	2:39ad2a393143	1390
cparata	2:39ad2a393143	1391	/* Full scale selection. */
cparata	2:39ad2a393143	1392	if( Set_X_FS(2.0f) == 1 )
cparata	2:39ad2a393143	1393	{
cparata	2:39ad2a393143	1394	return 1;
cparata	2:39ad2a393143	1395	}
cparata	2:39ad2a393143	1396
cparata	2:39ad2a393143	1397	/* Enable X direction in tap recognition. */
cparata	2:39ad2a393143	1398	if ( LSM6DSL_ACC_GYRO_W_TAP_X_EN( (void *)this, LSM6DSL_ACC_GYRO_TAP_X_EN_ENABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1399	{
cparata	2:39ad2a393143	1400	return 1;
cparata	2:39ad2a393143	1401	}
cparata	2:39ad2a393143	1402
cparata	2:39ad2a393143	1403	/* Enable Y direction in tap recognition. */
cparata	2:39ad2a393143	1404	if ( LSM6DSL_ACC_GYRO_W_TAP_Y_EN( (void *)this, LSM6DSL_ACC_GYRO_TAP_Y_EN_ENABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1405	{
cparata	2:39ad2a393143	1406	return 1;
cparata	2:39ad2a393143	1407	}
cparata	2:39ad2a393143	1408
cparata	2:39ad2a393143	1409	/* Enable Z direction in tap recognition. */
cparata	2:39ad2a393143	1410	if ( LSM6DSL_ACC_GYRO_W_TAP_Z_EN( (void *)this, LSM6DSL_ACC_GYRO_TAP_Z_EN_ENABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1411	{
cparata	2:39ad2a393143	1412	return 1;
cparata	2:39ad2a393143	1413	}
cparata	2:39ad2a393143	1414
cparata	2:39ad2a393143	1415	/* Set tap threshold. */
cparata	2:39ad2a393143	1416	if ( Set_Tap_Threshold( LSM6DSL_TAP_THRESHOLD_MID_LOW ) == 1 )
cparata	2:39ad2a393143	1417	{
cparata	2:39ad2a393143	1418	return 1;
cparata	2:39ad2a393143	1419	}
cparata	2:39ad2a393143	1420
cparata	2:39ad2a393143	1421	/* Set tap shock time window. */
cparata	2:39ad2a393143	1422	if ( Set_Tap_Shock_Time( LSM6DSL_TAP_SHOCK_TIME_MID_HIGH ) == 1 )
cparata	2:39ad2a393143	1423	{
cparata	2:39ad2a393143	1424	return 1;
cparata	2:39ad2a393143	1425	}
cparata	2:39ad2a393143	1426
cparata	2:39ad2a393143	1427	/* Set tap quiet time window. */
cparata	2:39ad2a393143	1428	if ( Set_Tap_Quiet_Time( LSM6DSL_TAP_QUIET_TIME_MID_LOW ) == 1 )
cparata	2:39ad2a393143	1429	{
cparata	2:39ad2a393143	1430	return 1;
cparata	2:39ad2a393143	1431	}
cparata	2:39ad2a393143	1432
cparata	2:39ad2a393143	1433	/* _NOTE_: Tap duration time window - don't care for single tap. */
cparata	2:39ad2a393143	1434
cparata	2:39ad2a393143	1435	/* _NOTE_: Single/Double Tap event - don't care of this flag for single tap. */
cparata	2:39ad2a393143	1436
cparata	2:39ad2a393143	1437	/* Enable basic Interrupts */
cparata	2:39ad2a393143	1438	if ( LSM6DSL_ACC_GYRO_W_BASIC_INT( (void *)this, LSM6DSL_ACC_GYRO_BASIC_INT_ENABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1439	{
cparata	2:39ad2a393143	1440	return 1;
cparata	2:39ad2a393143	1441	}
cparata	2:39ad2a393143	1442
cparata	2:39ad2a393143	1443	/* Enable single tap interrupt on INT1 pin. */
cparata	2:39ad2a393143	1444	if ( LSM6DSL_ACC_GYRO_W_SingleTapOnInt1( (void *)this, LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_ENABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1445	{
cparata	2:39ad2a393143	1446	return 1;
cparata	2:39ad2a393143	1447	}
cparata	2:39ad2a393143	1448
cparata	2:39ad2a393143	1449	return 0;
cparata	2:39ad2a393143	1450	}
cparata	2:39ad2a393143	1451
cparata	2:39ad2a393143	1452	/**
cparata	2:39ad2a393143	1453	* @brief Disable the single tap detection for LSM6DSL accelerometer sensor
cparata	2:39ad2a393143	1454	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	1455	*/
cparata	2:39ad2a393143	1456	int LSM6DSLSensor::Disable_Single_Tap_Detection(void)
cparata	2:39ad2a393143	1457	{
cparata	2:39ad2a393143	1458	/* Disable single tap interrupt on INT1 pin. */
cparata	2:39ad2a393143	1459	if ( LSM6DSL_ACC_GYRO_W_SingleTapOnInt1( (void *)this, LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_DISABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1460	{
cparata	2:39ad2a393143	1461	return 1;
cparata	2:39ad2a393143	1462	}
cparata	2:39ad2a393143	1463
cparata	2:39ad2a393143	1464	/* Disable basic Interrupts */
cparata	2:39ad2a393143	1465	if ( LSM6DSL_ACC_GYRO_W_BASIC_INT( (void *)this, LSM6DSL_ACC_GYRO_BASIC_INT_DISABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1466	{
cparata	2:39ad2a393143	1467	return 1;
cparata	2:39ad2a393143	1468	}
cparata	2:39ad2a393143	1469
cparata	2:39ad2a393143	1470	/* Reset tap threshold. */
cparata	2:39ad2a393143	1471	if ( Set_Tap_Threshold( 0x0 ) == 1 )
cparata	2:39ad2a393143	1472	{
cparata	2:39ad2a393143	1473	return 1;
cparata	2:39ad2a393143	1474	}
cparata	2:39ad2a393143	1475
cparata	2:39ad2a393143	1476	/* Reset tap shock time window. */
cparata	2:39ad2a393143	1477	if ( Set_Tap_Shock_Time( 0x0 ) == 1 )
cparata	2:39ad2a393143	1478	{
cparata	2:39ad2a393143	1479	return 1;
cparata	2:39ad2a393143	1480	}
cparata	2:39ad2a393143	1481
cparata	2:39ad2a393143	1482	/* Reset tap quiet time window. */
cparata	2:39ad2a393143	1483	if ( Set_Tap_Quiet_Time( 0x0 ) == 1 )
cparata	2:39ad2a393143	1484	{
cparata	2:39ad2a393143	1485	return 1;
cparata	2:39ad2a393143	1486	}
cparata	2:39ad2a393143	1487
cparata	2:39ad2a393143	1488	/* _NOTE_: Tap duration time window - don't care for single tap. */
cparata	2:39ad2a393143	1489
cparata	2:39ad2a393143	1490	/* _NOTE_: Single/Double Tap event - don't care of this flag for single tap. */
cparata	2:39ad2a393143	1491
cparata	2:39ad2a393143	1492	/* Disable Z direction in tap recognition. */
cparata	2:39ad2a393143	1493	if ( LSM6DSL_ACC_GYRO_W_TAP_Z_EN( (void *)this, LSM6DSL_ACC_GYRO_TAP_Z_EN_DISABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1494	{
cparata	2:39ad2a393143	1495	return 1;
cparata	2:39ad2a393143	1496	}
cparata	2:39ad2a393143	1497
cparata	2:39ad2a393143	1498	/* Disable Y direction in tap recognition. */
cparata	2:39ad2a393143	1499	if ( LSM6DSL_ACC_GYRO_W_TAP_Y_EN( (void *)this, LSM6DSL_ACC_GYRO_TAP_Y_EN_DISABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1500	{
cparata	2:39ad2a393143	1501	return 1;
cparata	2:39ad2a393143	1502	}
cparata	2:39ad2a393143	1503
cparata	2:39ad2a393143	1504	/* Disable X direction in tap recognition. */
cparata	2:39ad2a393143	1505	if ( LSM6DSL_ACC_GYRO_W_TAP_X_EN( (void *)this, LSM6DSL_ACC_GYRO_TAP_X_EN_DISABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1506	{
cparata	2:39ad2a393143	1507	return 1;
cparata	2:39ad2a393143	1508	}
cparata	2:39ad2a393143	1509
cparata	2:39ad2a393143	1510	return 0;
cparata	2:39ad2a393143	1511	}
cparata	2:39ad2a393143	1512
cparata	2:39ad2a393143	1513	/**
cparata	2:39ad2a393143	1514	* @brief Get the single tap detection status for LSM6DSL accelerometer sensor
cparata	2:39ad2a393143	1515	* @param status the pointer to the single tap detection status: 0 means no single tap detected, 1 means single tap detected
cparata	2:39ad2a393143	1516	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	1517	*/
cparata	2:39ad2a393143	1518	int LSM6DSLSensor::Get_Status_Single_Tap_Detection(uint8_t *status)
cparata	2:39ad2a393143	1519	{
cparata	2:39ad2a393143	1520	LSM6DSL_ACC_GYRO_SINGLE_TAP_EV_STATUS_t tap_status;
cparata	2:39ad2a393143	1521
cparata	2:39ad2a393143	1522	if ( LSM6DSL_ACC_GYRO_R_SINGLE_TAP_EV_STATUS( (void *)this, &tap_status ) == MEMS_ERROR )
cparata	2:39ad2a393143	1523	{
cparata	2:39ad2a393143	1524	return 1;
cparata	2:39ad2a393143	1525	}
cparata	2:39ad2a393143	1526
cparata	2:39ad2a393143	1527	switch( tap_status )
cparata	2:39ad2a393143	1528	{
cparata	2:39ad2a393143	1529	case LSM6DSL_ACC_GYRO_SINGLE_TAP_EV_STATUS_DETECTED:
cparata	2:39ad2a393143	1530	*status = 1;
cparata	2:39ad2a393143	1531	break;
cparata	2:39ad2a393143	1532
cparata	2:39ad2a393143	1533	case LSM6DSL_ACC_GYRO_SINGLE_TAP_EV_STATUS_NOT_DETECTED:
cparata	2:39ad2a393143	1534	*status = 0;
cparata	2:39ad2a393143	1535	break;
cparata	2:39ad2a393143	1536
cparata	2:39ad2a393143	1537	default:
cparata	2:39ad2a393143	1538	return 1;
cparata	2:39ad2a393143	1539	}
cparata	2:39ad2a393143	1540
cparata	2:39ad2a393143	1541	return 0;
cparata	2:39ad2a393143	1542	}
cparata	2:39ad2a393143	1543
cparata	2:39ad2a393143	1544	/**
cparata	2:39ad2a393143	1545	* @brief Enable the double tap detection for LSM6DSL accelerometer sensor
cparata	2:39ad2a393143	1546	* @note This function sets the LSM6DSL accelerometer ODR to 416Hz and the LSM6DSL accelerometer full scale to 2g
cparata	2:39ad2a393143	1547	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	1548	*/
cparata	2:39ad2a393143	1549	int LSM6DSLSensor::Enable_Double_Tap_Detection(void)
cparata	2:39ad2a393143	1550	{
cparata	2:39ad2a393143	1551	/* Output Data Rate selection */
cparata	2:39ad2a393143	1552	if( Set_X_ODR(416.0f) == 1 )
cparata	2:39ad2a393143	1553	{
cparata	2:39ad2a393143	1554	return 1;
cparata	2:39ad2a393143	1555	}
cparata	2:39ad2a393143	1556
cparata	2:39ad2a393143	1557	/* Full scale selection. */
cparata	2:39ad2a393143	1558	if( Set_X_FS(2.0f) == 1 )
cparata	2:39ad2a393143	1559	{
cparata	2:39ad2a393143	1560	return 1;
cparata	2:39ad2a393143	1561	}
cparata	2:39ad2a393143	1562
cparata	2:39ad2a393143	1563	/* Enable X direction in tap recognition. */
cparata	2:39ad2a393143	1564	if ( LSM6DSL_ACC_GYRO_W_TAP_X_EN( (void *)this, LSM6DSL_ACC_GYRO_TAP_X_EN_ENABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1565	{
cparata	2:39ad2a393143	1566	return 1;
cparata	2:39ad2a393143	1567	}
cparata	2:39ad2a393143	1568
cparata	2:39ad2a393143	1569	/* Enable Y direction in tap recognition. */
cparata	2:39ad2a393143	1570	if ( LSM6DSL_ACC_GYRO_W_TAP_Y_EN( (void *)this, LSM6DSL_ACC_GYRO_TAP_Y_EN_ENABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1571	{
cparata	2:39ad2a393143	1572	return 1;
cparata	2:39ad2a393143	1573	}
cparata	2:39ad2a393143	1574
cparata	2:39ad2a393143	1575	/* Enable Z direction in tap recognition. */
cparata	2:39ad2a393143	1576	if ( LSM6DSL_ACC_GYRO_W_TAP_Z_EN( (void *)this, LSM6DSL_ACC_GYRO_TAP_Z_EN_ENABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1577	{
cparata	2:39ad2a393143	1578	return 1;
cparata	2:39ad2a393143	1579	}
cparata	2:39ad2a393143	1580
cparata	2:39ad2a393143	1581	/* Set tap threshold. */
cparata	2:39ad2a393143	1582	if ( Set_Tap_Threshold( LSM6DSL_TAP_THRESHOLD_MID_LOW ) == 1 )
cparata	2:39ad2a393143	1583	{
cparata	2:39ad2a393143	1584	return 1;
cparata	2:39ad2a393143	1585	}
cparata	2:39ad2a393143	1586
cparata	2:39ad2a393143	1587	/* Set tap shock time window. */
cparata	2:39ad2a393143	1588	if ( Set_Tap_Shock_Time( LSM6DSL_TAP_SHOCK_TIME_HIGH ) == 1 )
cparata	2:39ad2a393143	1589	{
cparata	2:39ad2a393143	1590	return 1;
cparata	2:39ad2a393143	1591	}
cparata	2:39ad2a393143	1592
cparata	2:39ad2a393143	1593	/* Set tap quiet time window. */
cparata	2:39ad2a393143	1594	if ( Set_Tap_Quiet_Time( LSM6DSL_TAP_QUIET_TIME_HIGH ) == 1 )
cparata	2:39ad2a393143	1595	{
cparata	2:39ad2a393143	1596	return 1;
cparata	2:39ad2a393143	1597	}
cparata	2:39ad2a393143	1598
cparata	2:39ad2a393143	1599	/* Set tap duration time window. */
cparata	2:39ad2a393143	1600	if ( Set_Tap_Duration_Time( LSM6DSL_TAP_DURATION_TIME_MID ) == 1 )
cparata	2:39ad2a393143	1601	{
cparata	2:39ad2a393143	1602	return 1;
cparata	2:39ad2a393143	1603	}
cparata	2:39ad2a393143	1604
cparata	2:39ad2a393143	1605	/* Single and double tap enabled. */
cparata	2:39ad2a393143	1606	if ( LSM6DSL_ACC_GYRO_W_SINGLE_DOUBLE_TAP_EV( (void *)this, LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_DOUBLE_TAP ) == MEMS_ERROR )
cparata	2:39ad2a393143	1607	{
cparata	2:39ad2a393143	1608	return 1;
cparata	2:39ad2a393143	1609	}
cparata	2:39ad2a393143	1610
cparata	2:39ad2a393143	1611	/* Enable basic Interrupts */
cparata	2:39ad2a393143	1612	if ( LSM6DSL_ACC_GYRO_W_BASIC_INT( (void *)this, LSM6DSL_ACC_GYRO_BASIC_INT_ENABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1613	{
cparata	2:39ad2a393143	1614	return 1;
cparata	2:39ad2a393143	1615	}
cparata	2:39ad2a393143	1616
cparata	2:39ad2a393143	1617	/* Enable double tap interrupt on INT1 pin. */
cparata	2:39ad2a393143	1618	if ( LSM6DSL_ACC_GYRO_W_TapEvOnInt1( (void *)this, LSM6DSL_ACC_GYRO_INT1_TAP_ENABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1619	{
cparata	2:39ad2a393143	1620	return 1;
cparata	2:39ad2a393143	1621	}
cparata	2:39ad2a393143	1622
cparata	2:39ad2a393143	1623	return 0;
cparata	2:39ad2a393143	1624	}
cparata	2:39ad2a393143	1625
cparata	2:39ad2a393143	1626	/**
cparata	2:39ad2a393143	1627	* @brief Disable the double tap detection for LSM6DSL accelerometer sensor
cparata	2:39ad2a393143	1628	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	1629	*/
cparata	2:39ad2a393143	1630	int LSM6DSLSensor::Disable_Double_Tap_Detection(void)
cparata	2:39ad2a393143	1631	{
cparata	2:39ad2a393143	1632	/* Disable double tap interrupt on INT1 pin. */
cparata	2:39ad2a393143	1633	if ( LSM6DSL_ACC_GYRO_W_TapEvOnInt1( (void *)this, LSM6DSL_ACC_GYRO_INT1_TAP_DISABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1634	{
cparata	2:39ad2a393143	1635	return 1;
cparata	2:39ad2a393143	1636	}
cparata	2:39ad2a393143	1637
cparata	2:39ad2a393143	1638	/* Disable basic Interrupts */
cparata	2:39ad2a393143	1639	if ( LSM6DSL_ACC_GYRO_W_BASIC_INT( (void *)this, LSM6DSL_ACC_GYRO_BASIC_INT_DISABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1640	{
cparata	2:39ad2a393143	1641	return 1;
cparata	2:39ad2a393143	1642	}
cparata	2:39ad2a393143	1643
cparata	2:39ad2a393143	1644	/* Reset tap threshold. */
cparata	2:39ad2a393143	1645	if ( Set_Tap_Threshold( 0x0 ) == 1 )
cparata	2:39ad2a393143	1646	{
cparata	2:39ad2a393143	1647	return 1;
cparata	2:39ad2a393143	1648	}
cparata	2:39ad2a393143	1649
cparata	2:39ad2a393143	1650	/* Reset tap shock time window. */
cparata	2:39ad2a393143	1651	if ( Set_Tap_Shock_Time( 0x0 ) == 1 )
cparata	2:39ad2a393143	1652	{
cparata	2:39ad2a393143	1653	return 1;
cparata	2:39ad2a393143	1654	}
cparata	2:39ad2a393143	1655
cparata	2:39ad2a393143	1656	/* Reset tap quiet time window. */
cparata	2:39ad2a393143	1657	if ( Set_Tap_Quiet_Time( 0x0 ) == 1 )
cparata	2:39ad2a393143	1658	{
cparata	2:39ad2a393143	1659	return 1;
cparata	2:39ad2a393143	1660	}
cparata	2:39ad2a393143	1661
cparata	2:39ad2a393143	1662	/* Reset tap duration time window. */
cparata	2:39ad2a393143	1663	if ( Set_Tap_Duration_Time( 0x0 ) == 1 )
cparata	2:39ad2a393143	1664	{
cparata	2:39ad2a393143	1665	return 1;
cparata	2:39ad2a393143	1666	}
cparata	2:39ad2a393143	1667
cparata	2:39ad2a393143	1668	/* Only single tap enabled. */
cparata	2:39ad2a393143	1669	if ( LSM6DSL_ACC_GYRO_W_SINGLE_DOUBLE_TAP_EV( (void *)this, LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_SINGLE_TAP ) == MEMS_ERROR )
cparata	2:39ad2a393143	1670	{
cparata	2:39ad2a393143	1671	return 1;
cparata	2:39ad2a393143	1672	}
cparata	2:39ad2a393143	1673
cparata	2:39ad2a393143	1674	/* Disable Z direction in tap recognition. */
cparata	2:39ad2a393143	1675	if ( LSM6DSL_ACC_GYRO_W_TAP_Z_EN( (void *)this, LSM6DSL_ACC_GYRO_TAP_Z_EN_DISABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1676	{
cparata	2:39ad2a393143	1677	return 1;
cparata	2:39ad2a393143	1678	}
cparata	2:39ad2a393143	1679
cparata	2:39ad2a393143	1680	/* Disable Y direction in tap recognition. */
cparata	2:39ad2a393143	1681	if ( LSM6DSL_ACC_GYRO_W_TAP_Y_EN( (void *)this, LSM6DSL_ACC_GYRO_TAP_Y_EN_DISABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1682	{
cparata	2:39ad2a393143	1683	return 1;
cparata	2:39ad2a393143	1684	}
cparata	2:39ad2a393143	1685
cparata	2:39ad2a393143	1686	/* Disable X direction in tap recognition. */
cparata	2:39ad2a393143	1687	if ( LSM6DSL_ACC_GYRO_W_TAP_X_EN( (void *)this, LSM6DSL_ACC_GYRO_TAP_X_EN_DISABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1688	{
cparata	2:39ad2a393143	1689	return 1;
cparata	2:39ad2a393143	1690	}
cparata	2:39ad2a393143	1691
cparata	2:39ad2a393143	1692	return 0;
cparata	2:39ad2a393143	1693	}
cparata	2:39ad2a393143	1694
cparata	2:39ad2a393143	1695	/**
cparata	2:39ad2a393143	1696	* @brief Get the double tap detection status for LSM6DSL accelerometer sensor
cparata	2:39ad2a393143	1697	* @param status the pointer to the double tap detection status: 0 means no double tap detected, 1 means double tap detected
cparata	2:39ad2a393143	1698	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	1699	*/
cparata	2:39ad2a393143	1700	int LSM6DSLSensor::Get_Status_Double_Tap_Detection(uint8_t *status)
cparata	2:39ad2a393143	1701	{
cparata	2:39ad2a393143	1702	LSM6DSL_ACC_GYRO_DOUBLE_TAP_EV_STATUS_t tap_status;
cparata	2:39ad2a393143	1703
cparata	2:39ad2a393143	1704	if ( LSM6DSL_ACC_GYRO_R_DOUBLE_TAP_EV_STATUS( (void *)this, &tap_status ) == MEMS_ERROR )
cparata	2:39ad2a393143	1705	{
cparata	2:39ad2a393143	1706	return 1;
cparata	2:39ad2a393143	1707	}
cparata	2:39ad2a393143	1708
cparata	2:39ad2a393143	1709	switch( tap_status )
cparata	2:39ad2a393143	1710	{
cparata	2:39ad2a393143	1711	case LSM6DSL_ACC_GYRO_DOUBLE_TAP_EV_STATUS_DETECTED:
cparata	2:39ad2a393143	1712	*status = 1;
cparata	2:39ad2a393143	1713	break;
cparata	2:39ad2a393143	1714
cparata	2:39ad2a393143	1715	case LSM6DSL_ACC_GYRO_DOUBLE_TAP_EV_STATUS_NOT_DETECTED:
cparata	2:39ad2a393143	1716	*status = 0;
cparata	2:39ad2a393143	1717	break;
cparata	2:39ad2a393143	1718
cparata	2:39ad2a393143	1719	default:
cparata	2:39ad2a393143	1720	return 1;
cparata	2:39ad2a393143	1721	}
cparata	2:39ad2a393143	1722
cparata	2:39ad2a393143	1723	return 0;
cparata	2:39ad2a393143	1724	}
cparata	2:39ad2a393143	1725
cparata	2:39ad2a393143	1726	/**
cparata	2:39ad2a393143	1727	* @brief Set the tap threshold for LSM6DSL accelerometer sensor
cparata	2:39ad2a393143	1728	* @param thr the threshold to be set
cparata	2:39ad2a393143	1729	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	1730	*/
cparata	2:39ad2a393143	1731	int LSM6DSLSensor::Set_Tap_Threshold(uint8_t thr)
cparata	2:39ad2a393143	1732	{
cparata	2:39ad2a393143	1733	if ( LSM6DSL_ACC_GYRO_W_TAP_THS( (void *)this, thr ) == MEMS_ERROR )
cparata	2:39ad2a393143	1734	{
cparata	2:39ad2a393143	1735	return 1;
cparata	2:39ad2a393143	1736	}
cparata	2:39ad2a393143	1737
cparata	2:39ad2a393143	1738	return 0;
cparata	2:39ad2a393143	1739	}
cparata	2:39ad2a393143	1740
cparata	2:39ad2a393143	1741	/**
cparata	2:39ad2a393143	1742	* @brief Set the tap shock time window for LSM6DSL accelerometer sensor
cparata	2:39ad2a393143	1743	* @param time the shock time window to be set
cparata	2:39ad2a393143	1744	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	1745	*/
cparata	2:39ad2a393143	1746	int LSM6DSLSensor::Set_Tap_Shock_Time(uint8_t time)
cparata	2:39ad2a393143	1747	{
cparata	2:39ad2a393143	1748	if ( LSM6DSL_ACC_GYRO_W_SHOCK_Duration( (void *)this, time ) == MEMS_ERROR )
cparata	2:39ad2a393143	1749	{
cparata	2:39ad2a393143	1750	return 1;
cparata	2:39ad2a393143	1751	}
cparata	2:39ad2a393143	1752
cparata	2:39ad2a393143	1753	return 0;
cparata	2:39ad2a393143	1754	}
cparata	2:39ad2a393143	1755
cparata	2:39ad2a393143	1756	/**
cparata	2:39ad2a393143	1757	* @brief Set the tap quiet time window for LSM6DSL accelerometer sensor
cparata	2:39ad2a393143	1758	* @param time the quiet time window to be set
cparata	2:39ad2a393143	1759	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	1760	*/
cparata	2:39ad2a393143	1761	int LSM6DSLSensor::Set_Tap_Quiet_Time(uint8_t time)
cparata	2:39ad2a393143	1762	{
cparata	2:39ad2a393143	1763	if ( LSM6DSL_ACC_GYRO_W_QUIET_Duration( (void *)this, time ) == MEMS_ERROR )
cparata	2:39ad2a393143	1764	{
cparata	2:39ad2a393143	1765	return 1;
cparata	2:39ad2a393143	1766	}
cparata	2:39ad2a393143	1767
cparata	2:39ad2a393143	1768	return 0;
cparata	2:39ad2a393143	1769	}
cparata	2:39ad2a393143	1770
cparata	2:39ad2a393143	1771	/**
cparata	2:39ad2a393143	1772	* @brief Set the tap duration of the time window for LSM6DSL accelerometer sensor
cparata	2:39ad2a393143	1773	* @param time the duration of the time window to be set
cparata	2:39ad2a393143	1774	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	1775	*/
cparata	2:39ad2a393143	1776	int LSM6DSLSensor::Set_Tap_Duration_Time(uint8_t time)
cparata	2:39ad2a393143	1777	{
cparata	2:39ad2a393143	1778	if ( LSM6DSL_ACC_GYRO_W_DUR( (void *)this, time ) == MEMS_ERROR )
cparata	2:39ad2a393143	1779	{
cparata	2:39ad2a393143	1780	return 1;
cparata	2:39ad2a393143	1781	}
cparata	2:39ad2a393143	1782
cparata	2:39ad2a393143	1783	return 0;
cparata	2:39ad2a393143	1784	}
cparata	2:39ad2a393143	1785
cparata	2:39ad2a393143	1786	/**
cparata	2:39ad2a393143	1787	* @brief Enable the 6D orientation detection for LSM6DSL accelerometer sensor
cparata	2:39ad2a393143	1788	* @note This function sets the LSM6DSL accelerometer ODR to 416Hz and the LSM6DSL accelerometer full scale to 2g
cparata	2:39ad2a393143	1789	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	1790	*/
cparata	2:39ad2a393143	1791	int LSM6DSLSensor::Enable_6D_Orientation(void)
cparata	2:39ad2a393143	1792	{
cparata	2:39ad2a393143	1793	/* Output Data Rate selection */
cparata	2:39ad2a393143	1794	if( Set_X_ODR(416.0f) == 1 )
cparata	2:39ad2a393143	1795	{
cparata	2:39ad2a393143	1796	return 1;
cparata	2:39ad2a393143	1797	}
cparata	2:39ad2a393143	1798
cparata	2:39ad2a393143	1799	/* Full scale selection. */
cparata	2:39ad2a393143	1800	if( Set_X_FS(2.0f) == 1 )
cparata	2:39ad2a393143	1801	{
cparata	2:39ad2a393143	1802	return 1;
cparata	2:39ad2a393143	1803	}
cparata	2:39ad2a393143	1804
cparata	2:39ad2a393143	1805	/* Set 6D threshold. */
cparata	2:39ad2a393143	1806	if ( LSM6DSL_ACC_GYRO_W_SIXD_THS( (void *)this, LSM6DSL_ACC_GYRO_SIXD_THS_60_degree ) == MEMS_ERROR )
cparata	2:39ad2a393143	1807	{
cparata	2:39ad2a393143	1808	return 1;
cparata	2:39ad2a393143	1809	}
cparata	2:39ad2a393143	1810
cparata	2:39ad2a393143	1811	/* Enable basic Interrupts */
cparata	2:39ad2a393143	1812	if ( LSM6DSL_ACC_GYRO_W_BASIC_INT( (void *)this, LSM6DSL_ACC_GYRO_BASIC_INT_ENABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1813	{
cparata	2:39ad2a393143	1814	return 1;
cparata	2:39ad2a393143	1815	}
cparata	2:39ad2a393143	1816
cparata	2:39ad2a393143	1817	/* INT1_6D setting. */
cparata	2:39ad2a393143	1818	if ( LSM6DSL_ACC_GYRO_W_6DEvOnInt1( (void *)this, LSM6DSL_ACC_GYRO_INT1_6D_ENABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1819	{
cparata	2:39ad2a393143	1820	return 1;
cparata	2:39ad2a393143	1821	}
cparata	2:39ad2a393143	1822
cparata	2:39ad2a393143	1823	return 0;
cparata	2:39ad2a393143	1824	}
cparata	2:39ad2a393143	1825
cparata	2:39ad2a393143	1826	/**
cparata	2:39ad2a393143	1827	* @brief Disable the 6D orientation detection for LSM6DSL accelerometer sensor
cparata	2:39ad2a393143	1828	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	1829	*/
cparata	2:39ad2a393143	1830	int LSM6DSLSensor::Disable_6D_Orientation(void)
cparata	2:39ad2a393143	1831	{
cparata	2:39ad2a393143	1832	/* INT1_6D setting. */
cparata	2:39ad2a393143	1833	if ( LSM6DSL_ACC_GYRO_W_6DEvOnInt1( (void *)this, LSM6DSL_ACC_GYRO_INT1_6D_DISABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1834	{
cparata	2:39ad2a393143	1835	return 1;
cparata	2:39ad2a393143	1836	}
cparata	2:39ad2a393143	1837
cparata	2:39ad2a393143	1838	/* Disable basic Interrupts */
cparata	2:39ad2a393143	1839	if ( LSM6DSL_ACC_GYRO_W_BASIC_INT( (void *)this, LSM6DSL_ACC_GYRO_BASIC_INT_DISABLED ) == MEMS_ERROR )
cparata	2:39ad2a393143	1840	{
cparata	2:39ad2a393143	1841	return 1;
cparata	2:39ad2a393143	1842	}
cparata	2:39ad2a393143	1843
cparata	2:39ad2a393143	1844	/* Reset 6D threshold. */
cparata	2:39ad2a393143	1845	if ( LSM6DSL_ACC_GYRO_W_SIXD_THS( (void *)this, LSM6DSL_ACC_GYRO_SIXD_THS_80_degree ) == MEMS_ERROR )
cparata	2:39ad2a393143	1846	{
cparata	2:39ad2a393143	1847	return 1;
cparata	2:39ad2a393143	1848	}
cparata	2:39ad2a393143	1849
cparata	2:39ad2a393143	1850	return 0;
cparata	2:39ad2a393143	1851	}
cparata	2:39ad2a393143	1852
cparata	2:39ad2a393143	1853	/**
cparata	2:39ad2a393143	1854	* @brief Get the status of the 6D orientation detection for LSM6DSL accelerometer sensor
cparata	2:39ad2a393143	1855	* @param status the pointer to the status of the 6D orientation detection: 0 means no detection, 1 means detection happened
cparata	2:39ad2a393143	1856	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	1857	*/
cparata	2:39ad2a393143	1858	int LSM6DSLSensor::Get_Status_6D_Orientation(uint8_t *status)
cparata	2:39ad2a393143	1859	{
cparata	2:39ad2a393143	1860	LSM6DSL_ACC_GYRO_D6D_EV_STATUS_t status_raw;
cparata	2:39ad2a393143	1861
cparata	2:39ad2a393143	1862	if ( LSM6DSL_ACC_GYRO_R_D6D_EV_STATUS( (void *)this, &status_raw ) == MEMS_ERROR )
cparata	2:39ad2a393143	1863	{
cparata	2:39ad2a393143	1864	return 1;
cparata	2:39ad2a393143	1865	}
cparata	2:39ad2a393143	1866
cparata	2:39ad2a393143	1867	switch( status_raw )
cparata	2:39ad2a393143	1868	{
cparata	2:39ad2a393143	1869	case LSM6DSL_ACC_GYRO_D6D_EV_STATUS_DETECTED:
cparata	2:39ad2a393143	1870	*status = 1;
cparata	2:39ad2a393143	1871	break;
cparata	2:39ad2a393143	1872	case LSM6DSL_ACC_GYRO_D6D_EV_STATUS_NOT_DETECTED:
cparata	2:39ad2a393143	1873	*status = 0;
cparata	2:39ad2a393143	1874	break;
cparata	2:39ad2a393143	1875	default:
cparata	2:39ad2a393143	1876	return 1;
cparata	2:39ad2a393143	1877	}
cparata	2:39ad2a393143	1878
cparata	2:39ad2a393143	1879	return 0;
cparata	2:39ad2a393143	1880	}
cparata	2:39ad2a393143	1881
cparata	2:39ad2a393143	1882	/**
cparata	2:39ad2a393143	1883	* @brief Get the 6D orientation XL axis for LSM6DSL accelerometer sensor
cparata	2:39ad2a393143	1884	* @param xl the pointer to the 6D orientation XL axis
cparata	2:39ad2a393143	1885	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	1886	*/
cparata	2:39ad2a393143	1887	int LSM6DSLSensor::Get_6D_Orientation_XL(uint8_t *xl)
cparata	2:39ad2a393143	1888	{
cparata	2:39ad2a393143	1889	LSM6DSL_ACC_GYRO_DSD_XL_t xl_raw;
cparata	2:39ad2a393143	1890
cparata	2:39ad2a393143	1891	if ( LSM6DSL_ACC_GYRO_R_DSD_XL( (void *)this, &xl_raw ) == MEMS_ERROR )
cparata	2:39ad2a393143	1892	{
cparata	2:39ad2a393143	1893	return 1;
cparata	2:39ad2a393143	1894	}
cparata	2:39ad2a393143	1895
cparata	2:39ad2a393143	1896	switch( xl_raw )
cparata	2:39ad2a393143	1897	{
cparata	2:39ad2a393143	1898	case LSM6DSL_ACC_GYRO_DSD_XL_DETECTED:
cparata	2:39ad2a393143	1899	*xl = 1;
cparata	2:39ad2a393143	1900	break;
cparata	2:39ad2a393143	1901	case LSM6DSL_ACC_GYRO_DSD_XL_NOT_DETECTED:
cparata	2:39ad2a393143	1902	*xl = 0;
cparata	2:39ad2a393143	1903	break;
cparata	2:39ad2a393143	1904	default:
cparata	2:39ad2a393143	1905	return 1;
cparata	2:39ad2a393143	1906	}
cparata	2:39ad2a393143	1907
cparata	2:39ad2a393143	1908	return 0;
cparata	2:39ad2a393143	1909	}
cparata	2:39ad2a393143	1910
cparata	2:39ad2a393143	1911	/**
cparata	2:39ad2a393143	1912	* @brief Get the 6D orientation XH axis for LSM6DSL accelerometer sensor
cparata	2:39ad2a393143	1913	* @param xh the pointer to the 6D orientation XH axis
cparata	2:39ad2a393143	1914	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	1915	*/
cparata	2:39ad2a393143	1916	int LSM6DSLSensor::Get_6D_Orientation_XH(uint8_t *xh)
cparata	2:39ad2a393143	1917	{
cparata	2:39ad2a393143	1918	LSM6DSL_ACC_GYRO_DSD_XH_t xh_raw;
cparata	2:39ad2a393143	1919
cparata	2:39ad2a393143	1920	if ( LSM6DSL_ACC_GYRO_R_DSD_XH( (void *)this, &xh_raw ) == MEMS_ERROR )
cparata	2:39ad2a393143	1921	{
cparata	2:39ad2a393143	1922	return 1;
cparata	2:39ad2a393143	1923	}
cparata	2:39ad2a393143	1924
cparata	2:39ad2a393143	1925	switch( xh_raw )
cparata	2:39ad2a393143	1926	{
cparata	2:39ad2a393143	1927	case LSM6DSL_ACC_GYRO_DSD_XH_DETECTED:
cparata	2:39ad2a393143	1928	*xh = 1;
cparata	2:39ad2a393143	1929	break;
cparata	2:39ad2a393143	1930	case LSM6DSL_ACC_GYRO_DSD_XH_NOT_DETECTED:
cparata	2:39ad2a393143	1931	*xh = 0;
cparata	2:39ad2a393143	1932	break;
cparata	2:39ad2a393143	1933	default:
cparata	2:39ad2a393143	1934	return 1;
cparata	2:39ad2a393143	1935	}
cparata	2:39ad2a393143	1936
cparata	2:39ad2a393143	1937	return 0;
cparata	2:39ad2a393143	1938	}
cparata	2:39ad2a393143	1939
cparata	2:39ad2a393143	1940	/**
cparata	2:39ad2a393143	1941	* @brief Get the 6D orientation YL axis for LSM6DSL accelerometer sensor
cparata	2:39ad2a393143	1942	* @param yl the pointer to the 6D orientation YL axis
cparata	2:39ad2a393143	1943	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	1944	*/
cparata	2:39ad2a393143	1945	int LSM6DSLSensor::Get_6D_Orientation_YL(uint8_t *yl)
cparata	2:39ad2a393143	1946	{
cparata	2:39ad2a393143	1947	LSM6DSL_ACC_GYRO_DSD_YL_t yl_raw;
cparata	2:39ad2a393143	1948
cparata	2:39ad2a393143	1949	if ( LSM6DSL_ACC_GYRO_R_DSD_YL( (void *)this, &yl_raw ) == MEMS_ERROR )
cparata	2:39ad2a393143	1950	{
cparata	2:39ad2a393143	1951	return 1;
cparata	2:39ad2a393143	1952	}
cparata	2:39ad2a393143	1953
cparata	2:39ad2a393143	1954	switch( yl_raw )
cparata	2:39ad2a393143	1955	{
cparata	2:39ad2a393143	1956	case LSM6DSL_ACC_GYRO_DSD_YL_DETECTED:
cparata	2:39ad2a393143	1957	*yl = 1;
cparata	2:39ad2a393143	1958	break;
cparata	2:39ad2a393143	1959	case LSM6DSL_ACC_GYRO_DSD_YL_NOT_DETECTED:
cparata	2:39ad2a393143	1960	*yl = 0;
cparata	2:39ad2a393143	1961	break;
cparata	2:39ad2a393143	1962	default:
cparata	2:39ad2a393143	1963	return 1;
cparata	2:39ad2a393143	1964	}
cparata	2:39ad2a393143	1965
cparata	2:39ad2a393143	1966	return 0;
cparata	2:39ad2a393143	1967	}
cparata	2:39ad2a393143	1968
cparata	2:39ad2a393143	1969	/**
cparata	2:39ad2a393143	1970	* @brief Get the 6D orientation YH axis for LSM6DSL accelerometer sensor
cparata	2:39ad2a393143	1971	* @param yh the pointer to the 6D orientation YH axis
cparata	2:39ad2a393143	1972	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	1973	*/
cparata	2:39ad2a393143	1974	int LSM6DSLSensor::Get_6D_Orientation_YH(uint8_t *yh)
cparata	2:39ad2a393143	1975	{
cparata	2:39ad2a393143	1976	LSM6DSL_ACC_GYRO_DSD_YH_t yh_raw;
cparata	2:39ad2a393143	1977
cparata	2:39ad2a393143	1978	if ( LSM6DSL_ACC_GYRO_R_DSD_YH( (void *)this, &yh_raw ) == MEMS_ERROR )
cparata	2:39ad2a393143	1979	{
cparata	2:39ad2a393143	1980	return 1;
cparata	2:39ad2a393143	1981	}
cparata	2:39ad2a393143	1982
cparata	2:39ad2a393143	1983	switch( yh_raw )
cparata	2:39ad2a393143	1984	{
cparata	2:39ad2a393143	1985	case LSM6DSL_ACC_GYRO_DSD_YH_DETECTED:
cparata	2:39ad2a393143	1986	*yh = 1;
cparata	2:39ad2a393143	1987	break;
cparata	2:39ad2a393143	1988	case LSM6DSL_ACC_GYRO_DSD_YH_NOT_DETECTED:
cparata	2:39ad2a393143	1989	*yh = 0;
cparata	2:39ad2a393143	1990	break;
cparata	2:39ad2a393143	1991	default:
cparata	2:39ad2a393143	1992	return 1;
cparata	2:39ad2a393143	1993	}
cparata	2:39ad2a393143	1994
cparata	2:39ad2a393143	1995	return 0;
cparata	2:39ad2a393143	1996	}
cparata	2:39ad2a393143	1997
cparata	2:39ad2a393143	1998	/**
cparata	2:39ad2a393143	1999	* @brief Get the 6D orientation ZL axis for LSM6DSL accelerometer sensor
cparata	2:39ad2a393143	2000	* @param zl the pointer to the 6D orientation ZL axis
cparata	2:39ad2a393143	2001	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	2002	*/
cparata	2:39ad2a393143	2003	int LSM6DSLSensor::Get_6D_Orientation_ZL(uint8_t *zl)
cparata	2:39ad2a393143	2004	{
cparata	2:39ad2a393143	2005	LSM6DSL_ACC_GYRO_DSD_ZL_t zl_raw;
cparata	2:39ad2a393143	2006
cparata	2:39ad2a393143	2007	if ( LSM6DSL_ACC_GYRO_R_DSD_ZL( (void *)this, &zl_raw ) == MEMS_ERROR )
cparata	2:39ad2a393143	2008	{
cparata	2:39ad2a393143	2009	return 1;
cparata	2:39ad2a393143	2010	}
cparata	2:39ad2a393143	2011
cparata	2:39ad2a393143	2012	switch( zl_raw )
cparata	2:39ad2a393143	2013	{
cparata	2:39ad2a393143	2014	case LSM6DSL_ACC_GYRO_DSD_ZL_DETECTED:
cparata	2:39ad2a393143	2015	*zl = 1;
cparata	2:39ad2a393143	2016	break;
cparata	2:39ad2a393143	2017	case LSM6DSL_ACC_GYRO_DSD_ZL_NOT_DETECTED:
cparata	2:39ad2a393143	2018	*zl = 0;
cparata	2:39ad2a393143	2019	break;
cparata	2:39ad2a393143	2020	default:
cparata	2:39ad2a393143	2021	return 1;
cparata	2:39ad2a393143	2022	}
cparata	2:39ad2a393143	2023
cparata	2:39ad2a393143	2024	return 0;
cparata	2:39ad2a393143	2025	}
cparata	2:39ad2a393143	2026
cparata	2:39ad2a393143	2027	/**
cparata	2:39ad2a393143	2028	* @brief Get the 6D orientation ZH axis for LSM6DSL accelerometer sensor
cparata	2:39ad2a393143	2029	* @param zh the pointer to the 6D orientation ZH axis
cparata	2:39ad2a393143	2030	* @retval 0 in case of success, an error code otherwise
cparata	2:39ad2a393143	2031	*/
cparata	2:39ad2a393143	2032	int LSM6DSLSensor::Get_6D_Orientation_ZH(uint8_t *zh)
cparata	2:39ad2a393143	2033	{
cparata	2:39ad2a393143	2034	LSM6DSL_ACC_GYRO_DSD_ZH_t zh_raw;
cparata	2:39ad2a393143	2035
cparata	2:39ad2a393143	2036	if ( LSM6DSL_ACC_GYRO_R_DSD_ZH( (void *)this, &zh_raw ) == MEMS_ERROR )
cparata	2:39ad2a393143	2037	{
cparata	2:39ad2a393143	2038	return 1;
cparata	2:39ad2a393143	2039	}
cparata	2:39ad2a393143	2040
cparata	2:39ad2a393143	2041	switch( zh_raw )
cparata	2:39ad2a393143	2042	{
cparata	2:39ad2a393143	2043	case LSM6DSL_ACC_GYRO_DSD_ZH_DETECTED:
cparata	2:39ad2a393143	2044	*zh = 1;
cparata	2:39ad2a393143	2045	break;
cparata	2:39ad2a393143	2046	case LSM6DSL_ACC_GYRO_DSD_ZH_NOT_DETECTED:
cparata	2:39ad2a393143	2047	*zh = 0;
cparata	2:39ad2a393143	2048	break;
cparata	2:39ad2a393143	2049	default:
cparata	2:39ad2a393143	2050	return 1;
cparata	2:39ad2a393143	2051	}
cparata	2:39ad2a393143	2052
cparata	2:39ad2a393143	2053	return 0;
cparata	2:39ad2a393143	2054	}
cparata	2:39ad2a393143	2055
cparata	2:39ad2a393143	2056	/**
cparata	2:39ad2a393143	2057	* @brief Read the data from register
cparata	2:39ad2a393143	2058	* @param reg register address
cparata	2:39ad2a393143	2059	* @param data register data
cparata	2:39ad2a393143	2060	* @retval 0 in case of success
cparata	2:39ad2a393143	2061	* @retval 1 in case of failure
cparata	2:39ad2a393143	2062	*/
cparata	2:39ad2a393143	2063	int LSM6DSLSensor::ReadReg( uint8_t reg, uint8_t *data )
cparata	2:39ad2a393143	2064	{
cparata	2:39ad2a393143	2065
cparata	2:39ad2a393143	2066	if ( LSM6DSL_ACC_GYRO_ReadReg( (void *)this, reg, data, 1 ) == MEMS_ERROR )
cparata	2:39ad2a393143	2067	{
cparata	2:39ad2a393143	2068	return 1;
cparata	2:39ad2a393143	2069	}
cparata	2:39ad2a393143	2070
cparata	2:39ad2a393143	2071	return 0;
cparata	2:39ad2a393143	2072	}
cparata	2:39ad2a393143	2073
cparata	2:39ad2a393143	2074	/**
cparata	2:39ad2a393143	2075	* @brief Write the data to register
cparata	2:39ad2a393143	2076	* @param reg register address
cparata	2:39ad2a393143	2077	* @param data register data
cparata	2:39ad2a393143	2078	* @retval 0 in case of success
cparata	2:39ad2a393143	2079	* @retval 1 in case of failure
cparata	2:39ad2a393143	2080	*/
cparata	2:39ad2a393143	2081	int LSM6DSLSensor::WriteReg( uint8_t reg, uint8_t data )
cparata	2:39ad2a393143	2082	{
cparata	2:39ad2a393143	2083
cparata	2:39ad2a393143	2084	if ( LSM6DSL_ACC_GYRO_WriteReg( (void *)this, reg, &data, 1 ) == MEMS_ERROR )
cparata	2:39ad2a393143	2085	{
cparata	2:39ad2a393143	2086	return 1;
cparata	2:39ad2a393143	2087	}
cparata	2:39ad2a393143	2088
cparata	2:39ad2a393143	2089	return 0;
cparata	2:39ad2a393143	2090	}
cparata	2:39ad2a393143	2091
cparata	2:39ad2a393143	2092
cparata	2:39ad2a393143	2093	uint8_t LSM6DSL_IO_Write( void handle, uint8_t WriteAddr, uint8_t pBuffer, uint16_t nBytesToWrite )
cparata	2:39ad2a393143	2094	{
cparata	2:39ad2a393143	2095	return ((LSM6DSLSensor *)handle)->IO_Write(pBuffer, WriteAddr, nBytesToWrite);
cparata	2:39ad2a393143	2096	}
cparata	2:39ad2a393143	2097
cparata	2:39ad2a393143	2098	uint8_t LSM6DSL_IO_Read( void handle, uint8_t ReadAddr, uint8_t pBuffer, uint16_t nBytesToRead )
cparata	2:39ad2a393143	2099	{
cparata	2:39ad2a393143	2100	return ((LSM6DSLSensor *)handle)->IO_Read(pBuffer, ReadAddr, nBytesToRead);
cparata	2:39ad2a393143	2101	}

Repository toolbox

Export to desktop IDE

Build repository

Repository details

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

The code in this repository is Apache licensed.

Tilt Detection Demo Application based on sensor expansion board X-NUCLEO-IKS01A2

X_NUCLEO_IKS01A2/Components/LSM6DSLSensor/LSM6DSLSensor.cpp@2:39ad2a393143, 2016-08-19 (annotated)

Who changed what in which revision?

Repository toolbox

Repository details

Important Information for this Arm website

Access Warning