ST
iNEMO inertial module: 3D accelerometer and 3D gyroscope.
Dependencies: X_NUCLEO_COMMON ST_INTERFACES
Dependents: HelloWorld_ST_Sensors MOTENV_Mbed mbed-os-mqtt-client LSM6DSL_JS ... more
Diff: LSM6DSL_acc_gyro_driver.c
- Revision:
- 0:704c89673b57
- Child:
- 3:20ccff7dd652
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/LSM6DSL_acc_gyro_driver.c Mon Sep 04 16:08:00 2017 +0000
@@ -0,0 +1,6393 @@
+/**
+ ******************************************************************************
+ * @file LSM6DSL_acc_gyro_driver.c
+ * @author MEMS Application Team
+ * @version V1.5
+ * @date 17-May-2016
+ * @brief LSM6DSL driver file
+ ******************************************************************************
+ * @attention
+ *
+ * <h2><center>© COPYRIGHT(c) 2016 STMicroelectronics</center></h2>
+ *
+ * Redistribution and use in source and binary forms, with or without modification,
+ * are permitted provided that the following conditions are met:
+ * 1. Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright notice,
+ * this list of conditions and the following disclaimer in the documentation
+ * and/or other materials provided with the distribution.
+ * 3. Neither the name of STMicroelectronics nor the names of its contributors
+ * may be used to endorse or promote products derived from this software
+ * without specific prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ *
+ ******************************************************************************
+ */
+
+/* Includes ------------------------------------------------------------------*/
+#include "LSM6DSL_acc_gyro_driver.h"
+
+/* Imported function prototypes ----------------------------------------------*/
+extern uint8_t LSM6DSL_io_write(void *handle, uint8_t WriteAddr, uint8_t *pBuffer, uint16_t nBytesToWrite);
+extern uint8_t LSM6DSL_io_read(void *handle, uint8_t ReadAddr, uint8_t *pBuffer, uint16_t nBytesToRead);
+
+/* Private typedef -----------------------------------------------------------*/
+
+/* Private define ------------------------------------------------------------*/
+
+/* Private macro -------------------------------------------------------------*/
+
+/* Private variables ---------------------------------------------------------*/
+
+/* Private functions ---------------------------------------------------------*/
+
+/* Exported functions ---------------------------------------------------------*/
+
+/************** Generic Function *******************/
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_read_reg
+* Description : Generic Reading function. It must be fullfilled with either
+* : I2C or SPI reading functions
+* Input : Register Address, length of buffer
+* Output : Data REad
+* Return : None
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_read_reg(void *handle, u8_t Reg, u8_t* Data, u16_t len)
+{
+ if (LSM6DSL_io_read(handle, Reg, Data, len))
+ {
+ return MEMS_ERROR;
+ }
+ else
+ {
+ return MEMS_SUCCESS;
+ }
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_write_reg
+* Description : Generic Writing function. It must be fullfilled with either
+* : I2C or SPI writing function
+* Input : Register Address, Data to be written, length of buffer
+* Output : None
+* Return : None
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_write_reg(void *handle, u8_t Reg, u8_t *Data, u16_t len)
+{
+ if (LSM6DSL_io_write(handle, Reg, Data, len))
+ {
+ return MEMS_ERROR;
+ }
+ else
+ {
+ return MEMS_SUCCESS;
+ }
+}
+
+/**************** Base Function *******************/
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_WHO_AM_I
+* Description : Read WHO_AM_I_BIT
+* Input : Pointer to u8_t
+* Output : Status of WHO_AM_I_BIT
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_WHO_AM_I(void *handle, u8_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_WHO_AM_I_REG, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_WHO_AM_I_BIT_MASK; //coerce
+ *value = *value >> LSM6DSL_ACC_GYRO_WHO_AM_I_BIT_POSITION; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_BDU
+* Description : Write BDU
+* Input : LSM6DSL_ACC_GYRO_BDU_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_BDU(void *handle, LSM6DSL_ACC_GYRO_BDU_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_BDU_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_BDU
+* Description : Read BDU
+* Input : Pointer to LSM6DSL_ACC_GYRO_BDU_t
+* Output : Status of BDU see LSM6DSL_ACC_GYRO_BDU_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_BDU(void *handle, LSM6DSL_ACC_GYRO_BDU_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_BDU_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_FS_XL
+* Description : Write FS_XL
+* Input : LSM6DSL_ACC_GYRO_FS_XL_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_FS_XL(void *handle, LSM6DSL_ACC_GYRO_FS_XL_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_FS_XL_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_FS_XL
+* Description : Read FS_XL
+* Input : Pointer to LSM6DSL_ACC_GYRO_FS_XL_t
+* Output : Status of FS_XL see LSM6DSL_ACC_GYRO_FS_XL_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_FS_XL(void *handle, LSM6DSL_ACC_GYRO_FS_XL_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_FS_XL_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : mems_status_t LSM6DSL_ACC_GYRO_GetRawAccData(u8_t *buff)
+* Description : Read GetAccData output register
+* Input : pointer to [u8_t]
+* Output : GetAccData buffer u8_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_GetRawAccData(void *handle, u8_t *buff)
+{
+ u8_t i, j, k;
+ u8_t numberOfByteForDimension;
+
+ numberOfByteForDimension=6/3;
+
+ k=0;
+ for (i=0; i<3;i++ )
+ {
+ for (j=0; j<numberOfByteForDimension;j++ )
+ {
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_OUTX_L_XL+k, &buff[k], 1))
+ return MEMS_ERROR;
+ k++;
+ }
+ }
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : mems_status_t LSM6DSL_ACC_Get_Acceleration(void *handle, int *buff, u8_t from_fifo)
+* Description : Read GetAccData output register
+* Input : pointer to [u8_t]
+* Output : values are expressed in mg
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+/*
+ * Following is the table of sensitivity values for each case.
+ * Values are expressed in ug/digit.
+ */
+static const long long LSM6DSL_ACC_Sensitivity_List[4] = {
+ 61, /* FS @2g */
+ 122, /* FS @4g */
+ 244, /* FS @8g */
+ 488, /* FS @16g */
+};
+mems_status_t LSM6DSL_ACC_Get_Acceleration(void *handle, int *buff, u8_t from_fifo)
+{
+ LSM6DSL_ACC_GYRO_FS_XL_t fs;
+ long long sensitivity = 0;
+ Type3Axis16bit_U raw_data_tmp;
+
+ /* Read out current odr, fs, hf setting */
+ LSM6DSL_ACC_GYRO_R_FS_XL(handle, &fs);
+
+ /* Determine the sensitivity according to fs */
+ switch(fs) {
+ case LSM6DSL_ACC_GYRO_FS_XL_2g:
+ sensitivity = LSM6DSL_ACC_Sensitivity_List[0];
+ break;
+
+ case LSM6DSL_ACC_GYRO_FS_XL_4g:
+ sensitivity = LSM6DSL_ACC_Sensitivity_List[1];
+ break;
+
+ case LSM6DSL_ACC_GYRO_FS_XL_8g:
+ sensitivity = LSM6DSL_ACC_Sensitivity_List[2];
+ break;
+
+ case LSM6DSL_ACC_GYRO_FS_XL_16g:
+ sensitivity = LSM6DSL_ACC_Sensitivity_List[3];
+ break;
+ }
+
+ /* Read out raw accelerometer samples */
+ if (from_fifo) {
+ u8_t i;
+
+ /* read all 3 axis from FIFO */
+ for(i = 0; i < 3; i++)
+ LSM6DSL_ACC_GYRO_Get_GetFIFOData(handle, raw_data_tmp.u8bit + 2*i);
+ } else
+ LSM6DSL_ACC_GYRO_GetRawAccData(handle, raw_data_tmp.u8bit);
+
+ /* Apply proper shift and sensitivity */
+ buff[0] = (raw_data_tmp.i16bit[0] * sensitivity + 500)/1000;
+ buff[1] = (raw_data_tmp.i16bit[1] * sensitivity + 500)/1000;
+ buff[2] = (raw_data_tmp.i16bit[2] * sensitivity + 500)/1000;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_ODR_XL
+* Description : Write ODR_XL
+* Input : LSM6DSL_ACC_GYRO_ODR_XL_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_ODR_XL(void *handle, LSM6DSL_ACC_GYRO_ODR_XL_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_ODR_XL_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_ODR_XL
+* Description : Read ODR_XL
+* Input : Pointer to LSM6DSL_ACC_GYRO_ODR_XL_t
+* Output : Status of ODR_XL see LSM6DSL_ACC_GYRO_ODR_XL_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_ODR_XL(void *handle, LSM6DSL_ACC_GYRO_ODR_XL_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_ODR_XL_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_translate_ODR_XL
+* Description : Read ODR_XL
+* Input : LSM6DSL_ACC_GYRO_ODR_XL_t
+* Output : The ODR value in Hz
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_translate_ODR_XL(LSM6DSL_ACC_GYRO_ODR_XL_t value, u16_t *odr_hz_val)
+{
+ switch(value) {
+ case LSM6DSL_ACC_GYRO_ODR_XL_POWER_DOWN:
+ *odr_hz_val = 0;
+ break;
+
+ case LSM6DSL_ACC_GYRO_ODR_XL_13Hz:
+ *odr_hz_val = 13;
+ break;
+
+ case LSM6DSL_ACC_GYRO_ODR_XL_26Hz:
+ *odr_hz_val = 26;
+ break;
+
+ case LSM6DSL_ACC_GYRO_ODR_XL_52Hz:
+ *odr_hz_val = 52;
+ break;
+
+ case LSM6DSL_ACC_GYRO_ODR_XL_104Hz:
+ *odr_hz_val = 104;
+ break;
+
+ case LSM6DSL_ACC_GYRO_ODR_XL_208Hz:
+ *odr_hz_val = 208;
+ break;
+
+ case LSM6DSL_ACC_GYRO_ODR_XL_416Hz:
+ *odr_hz_val = 416;
+ break;
+
+ case LSM6DSL_ACC_GYRO_ODR_XL_833Hz:
+ *odr_hz_val = 833;
+ break;
+
+ case LSM6DSL_ACC_GYRO_ODR_XL_1660Hz:
+ *odr_hz_val = 1660;
+ break;
+
+ default:
+ return MEMS_ERROR;
+ }
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_FS_G
+* Description : Write FS_G
+* Input : LSM6DSL_ACC_GYRO_FS_G_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_FS_G(void *handle, LSM6DSL_ACC_GYRO_FS_G_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_FS_G_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_FS_G
+* Description : Read FS_G
+* Input : Pointer to LSM6DSL_ACC_GYRO_FS_G_t
+* Output : Status of FS_G see LSM6DSL_ACC_GYRO_FS_G_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_FS_G(void *handle, LSM6DSL_ACC_GYRO_FS_G_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_FS_G_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : mems_status_t LSM6DSL_ACC_GYRO_GetRawGyroData(u8_t *buff)
+* Description : Read GetGyroData output register
+* Input : pointer to [u8_t]
+* Output : GetGyroData buffer u8_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_GetRawGyroData(void *handle, u8_t *buff)
+{
+ u8_t i, j, k;
+ u8_t numberOfByteForDimension;
+
+ numberOfByteForDimension=6/3;
+
+ k=0;
+ for (i=0; i<3;i++ )
+ {
+ for (j=0; j<numberOfByteForDimension;j++ )
+ {
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_OUTX_L_G+k, &buff[k], 1))
+ return MEMS_ERROR;
+ k++;
+ }
+ }
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : mems_status_t LSM6DSL_ACC_Get_AngularRate(u8_t *buff)
+* Description : Read GetGyroData output register
+* Input : pointer to [u8_t]
+* Output : Returned values are espressed in mdps
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+/*
+ * Following is the table of sensitivity values for each case.
+ * Values are espressed in udps/digit.
+ */
+static const long long LSM6DSL_GYRO_Sensitivity_List[5] = {
+ 4375, /* FS @125 */
+ 8750, /* FS @245 */
+ 17500, /* FS @500 */
+ 35000, /* FS @1000 */
+ 70000, /* FS @2000 */
+};
+mems_status_t LSM6DSL_ACC_Get_AngularRate(void *handle, int *buff, u8_t from_fifo)
+{
+ LSM6DSL_ACC_GYRO_FS_125_t fs_125;
+ LSM6DSL_ACC_GYRO_FS_G_t fs;
+ long long sensitivity = 0;
+ Type3Axis16bit_U raw_data_tmp;
+
+ /* Read out current odr, fs, hf setting */
+ LSM6DSL_ACC_GYRO_R_FS_125(handle, &fs_125);
+ if (fs_125 == LSM6DSL_ACC_GYRO_FS_125_ENABLED) {
+ sensitivity = LSM6DSL_GYRO_Sensitivity_List[0];
+ } else {
+ LSM6DSL_ACC_GYRO_R_FS_G(handle, &fs);
+
+ /* Determine the sensitivity according to fs */
+ switch(fs) {
+ case LSM6DSL_ACC_GYRO_FS_G_245dps:
+ sensitivity = LSM6DSL_GYRO_Sensitivity_List[1];
+ break;
+
+ case LSM6DSL_ACC_GYRO_FS_G_500dps:
+ sensitivity = LSM6DSL_GYRO_Sensitivity_List[2];
+ break;
+
+ case LSM6DSL_ACC_GYRO_FS_G_1000dps:
+ sensitivity = LSM6DSL_GYRO_Sensitivity_List[3];
+ break;
+
+ case LSM6DSL_ACC_GYRO_FS_G_2000dps:
+ sensitivity = LSM6DSL_GYRO_Sensitivity_List[4];
+ break;
+ }
+ }
+
+ /* Read out raw accelerometer samples */
+ if (from_fifo) {
+ u8_t i;
+
+ /* read all 3 axis from FIFO */
+ for(i = 0; i < 3; i++)
+ LSM6DSL_ACC_GYRO_Get_GetFIFOData(handle, raw_data_tmp.u8bit + 2*i);
+ } else
+ LSM6DSL_ACC_GYRO_GetRawGyroData(handle, raw_data_tmp.u8bit);
+
+ /* Apply proper shift and sensitivity */
+ buff[0] = (raw_data_tmp.i16bit[0] * sensitivity + 500)/1000;
+ buff[1] = (raw_data_tmp.i16bit[1] * sensitivity + 500)/1000;
+ buff[2] = (raw_data_tmp.i16bit[2] * sensitivity + 500)/1000;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_ODR_G
+* Description : Write ODR_G
+* Input : LSM6DSL_ACC_GYRO_ODR_G_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_ODR_G(void *handle, LSM6DSL_ACC_GYRO_ODR_G_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_ODR_G_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_ODR_G
+* Description : Read ODR_G
+* Input : Pointer to LSM6DSL_ACC_GYRO_ODR_G_t
+* Output : Status of ODR_G see LSM6DSL_ACC_GYRO_ODR_G_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_ODR_G(void *handle, LSM6DSL_ACC_GYRO_ODR_G_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_ODR_G_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_translate_ODR_G
+* Description : Read ODR_G
+* Input : LSM6DSL_ACC_GYRO_ODR_G_t
+* Output : The ODR value in Hz
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_translate_ODR_G(LSM6DSL_ACC_GYRO_ODR_G_t value, u16_t *odr_hz_val)
+{
+ switch(value) {
+ case LSM6DSL_ACC_GYRO_ODR_G_POWER_DOWN:
+ *odr_hz_val = 0;
+ break;
+
+ case LSM6DSL_ACC_GYRO_ODR_G_13Hz:
+ *odr_hz_val = 13;
+ break;
+
+ case LSM6DSL_ACC_GYRO_ODR_G_26Hz:
+ *odr_hz_val = 26;
+ break;
+
+ case LSM6DSL_ACC_GYRO_ODR_G_52Hz:
+ *odr_hz_val = 52;
+ break;
+
+ case LSM6DSL_ACC_GYRO_ODR_G_104Hz:
+ *odr_hz_val = 104;
+ break;
+
+ case LSM6DSL_ACC_GYRO_ODR_G_208Hz:
+ *odr_hz_val = 208;
+ break;
+
+ case LSM6DSL_ACC_GYRO_ODR_G_416Hz:
+ *odr_hz_val = 416;
+ break;
+
+ case LSM6DSL_ACC_GYRO_ODR_G_833Hz:
+ *odr_hz_val = 833;
+ break;
+
+ case LSM6DSL_ACC_GYRO_ODR_G_1660Hz:
+ *odr_hz_val = 1660;
+ break;
+
+ default:
+ return MEMS_ERROR;
+ }
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_FS_125
+* Description : Write FS_125
+* Input : LSM6DSL_ACC_GYRO_FS_125_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_FS_125(void *handle, LSM6DSL_ACC_GYRO_FS_125_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_FS_125_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_FS_125
+* Description : Read FS_125
+* Input : Pointer to LSM6DSL_ACC_GYRO_FS_125_t
+* Output : Status of FS_125 see LSM6DSL_ACC_GYRO_FS_125_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_FS_125(void *handle, LSM6DSL_ACC_GYRO_FS_125_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_FS_125_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/**************** Advanced Function *******************/
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_BW_SEL
+* Description : Write BW_SEL
+* Input : LSM6DSL_ACC_GYRO_BW_SEL_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_BW_SEL(void *handle, LSM6DSL_ACC_GYRO_BW_SEL_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_BW_SEL_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_BW_SEL
+* Description : Read BW_SEL
+* Input : Pointer to LSM6DSL_ACC_GYRO_BW_SEL_t
+* Output : Status of BW_SEL see LSM6DSL_ACC_GYRO_BW_SEL_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_BW_SEL(void *handle, LSM6DSL_ACC_GYRO_BW_SEL_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_BW_SEL_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_BLE
+* Description : Write BLE
+* Input : LSM6DSL_ACC_GYRO_BLE_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_BLE(void *handle, LSM6DSL_ACC_GYRO_BLE_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_BLE_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_BLE
+* Description : Read BLE
+* Input : Pointer to LSM6DSL_ACC_GYRO_BLE_t
+* Output : Status of BLE see LSM6DSL_ACC_GYRO_BLE_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_BLE(void *handle, LSM6DSL_ACC_GYRO_BLE_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_BLE_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_EmbeddedAccess
+* Description : Write EMB_ACC
+* Input : LSM6DSL_ACC_GYRO_EMB_ACC_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_EmbeddedAccess(void *handle, LSM6DSL_ACC_GYRO_EMB_ACC_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FUNC_CFG_ACCESS, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_EMB_ACC_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_FUNC_CFG_ACCESS, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_EmbeddedAccess
+* Description : Read EMB_ACC
+* Input : Pointer to LSM6DSL_ACC_GYRO_EMB_ACC_t
+* Output : Status of EMB_ACC see LSM6DSL_ACC_GYRO_EMB_ACC_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_EmbeddedAccess(void *handle, LSM6DSL_ACC_GYRO_EMB_ACC_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FUNC_CFG_ACCESS, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_EMB_ACC_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_SYNC_RES_RATIO
+* Description : Write RR
+* Input : LSM6DSL_ACC_GYRO_SYNC_RES_RATIO_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_SYNC_RES_RATIO(void *handle, LSM6DSL_ACC_GYRO_SYNC_RES_RATIO_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_SENSOR_RES_RATIO, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_SYNC_RES_RATIO_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_SENSOR_RES_RATIO, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_SYNC_RES_RATIO
+* Description : Read RR
+* Input : Pointer to LSM6DSL_ACC_GYRO_SYNC_RES_RATIO_t
+* Output : Status of RR see LSM6DSL_ACC_GYRO_SYNC_RES_RATIO_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_SYNC_RES_RATIO(void *handle, LSM6DSL_ACC_GYRO_SYNC_RES_RATIO_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_SENSOR_RES_RATIO, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_SYNC_RES_RATIO_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_Stamping_Time_Frame
+* Description : Write TPH
+* Input : u8_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_Stamping_Time_Frame(void *handle, u8_t newValue)
+{
+ u8_t value;
+
+ newValue = newValue << LSM6DSL_ACC_GYRO_TPH_POSITION; //mask
+ newValue &= LSM6DSL_ACC_GYRO_TPH_MASK; //coerce
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_SENSOR_SYNC_TIME, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= (u8_t)~LSM6DSL_ACC_GYRO_TPH_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_SENSOR_SYNC_TIME, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_Stamping_Time_Frame
+* Description : Read TPH
+* Input : Pointer to u8_t
+* Output : Status of TPH
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_Stamping_Time_Frame(void *handle, u8_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_SENSOR_SYNC_TIME, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_TPH_MASK; //coerce
+ *value = *value >> LSM6DSL_ACC_GYRO_TPH_POSITION; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_FIFO_Watermark
+* Description : Write WTM_FIFO
+* Input : u16_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_FIFO_Watermark(void *handle, u16_t newValue)
+{
+ u8_t valueH, valueL;
+ u8_t value;
+
+ valueL = newValue & 0xFF;
+ valueH = (newValue >> 8) & 0xFF;
+
+ /* Low part goes in FIFO_CTRL1 */
+ valueL = valueL << LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL1_POSITION; //mask
+ valueL &= LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL1_MASK; //coerce
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL1, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= (u8_t)~LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL1_MASK;
+ value |= valueL;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL1, &value, 1) )
+ return MEMS_ERROR;
+
+ /* High part goes in FIFO_CTRL2 */
+ valueH = valueH << LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL2_POSITION; //mask
+ valueH &= LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL2_MASK; //coerce
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL2_MASK;
+ value |= valueH;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_FIFO_Watermark
+* Description : Read WTM_FIFO
+* Input : Pointer to u16_t
+* Output : Status of WTM_FIFO
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_FIFO_Watermark(void *handle, u16_t *value)
+{
+ u8_t valueH, valueL;
+
+ /* Low part from FIFO_CTRL1 */
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL1, (u8_t *)&valueL, 1) )
+ return MEMS_ERROR;
+
+ valueL &= LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL1_MASK; //coerce
+ valueL = valueL >> LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL1_POSITION; //mask
+
+ /* High part from FIFO_CTRL2 */
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, (u8_t *)&valueH, 1) )
+ return MEMS_ERROR;
+
+ valueH &= LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL2_MASK; //coerce
+ valueH = valueH >> LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL2_POSITION; //mask
+
+ *value = ((valueH << 8) & 0xFF00) | valueL;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_FIFO_TEMP
+* Description : Write FIFO_TEMP_EN
+* Input : LSM6DSL_ACC_GYRO_FIFO_TEMP_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_FIFO_TEMP(void *handle, LSM6DSL_ACC_GYRO_FIFO_TEMP_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_FIFO_TEMP_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_FIFO_TEMP
+* Description : Read FIFO_TEMP_EN
+* Input : Pointer to LSM6DSL_ACC_GYRO_FIFO_TEMP_t
+* Output : Status of FIFO_TEMP_EN see LSM6DSL_ACC_GYRO_FIFO_TEMP_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_FIFO_TEMP(void *handle, LSM6DSL_ACC_GYRO_FIFO_TEMP_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_FIFO_TEMP_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_TIM_PEDO_FIFO_Write_En
+* Description : Write TIM_PEDO_FIFO_DRDY
+* Input : LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_DRDY_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_TIM_PEDO_FIFO_Write_En(void *handle, LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_DRDY_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_DRDY_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_TIM_PEDO_FIFO_Write_En
+* Description : Read TIM_PEDO_FIFO_DRDY
+* Input : Pointer to LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_DRDY_t
+* Output : Status of TIM_PEDO_FIFO_DRDY see LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_DRDY_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_TIM_PEDO_FIFO_Write_En(void *handle, LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_DRDY_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_DRDY_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_TIM_PEDO_FIFO_En
+* Description : Write TIM_PEDO_FIFO_EN
+* Input : LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_EN_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_TIM_PEDO_FIFO_En(void *handle, LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_EN_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_EN_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_TIM_PEDO_FIFO_En
+* Description : Read TIM_PEDO_FIFO_EN
+* Input : Pointer to LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_EN_t
+* Output : Status of TIM_PEDO_FIFO_EN see LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_EN_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_TIM_PEDO_FIFO_En(void *handle, LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_EN_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_EN_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL
+* Description : Write DEC_FIFO_XL
+* Input : LSM6DSL_ACC_GYRO_DEC_FIFO_XL_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL3, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_DEC_FIFO_XL_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL3, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL_val
+* Description : Write DEC_FIFO_XL
+* Input : u16_t
+* Output : Program XL decimation value from unsigned short
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL_val(void *handle, u16_t newValue)
+{
+ switch(newValue) {
+ case 0:
+ LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_DATA_NOT_IN_FIFO);
+ break;
+
+ case 1:
+ LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_NO_DECIMATION);
+ break;
+
+ case 2:
+ LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_2);
+ break;
+
+ case 3:
+ LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_3);
+ break;
+
+ case 4:
+ LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_4);
+ break;
+
+ case 8:
+ LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_8);
+ break;
+
+ case 16:
+ LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_16);
+ break;
+
+ case 32:
+ LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_32);
+ break;
+
+ default:
+ return MEMS_ERROR;
+ }
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_DEC_FIFO_XL
+* Description : Read DEC_FIFO_XL
+* Input : Pointer to LSM6DSL_ACC_GYRO_DEC_FIFO_XL_t
+* Output : Status of DEC_FIFO_XL see LSM6DSL_ACC_GYRO_DEC_FIFO_XL_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_DEC_FIFO_XL(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL3, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_DEC_FIFO_XL_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_DEC_FIFO_G
+* Description : Write DEC_FIFO_G
+* Input : LSM6DSL_ACC_GYRO_DEC_FIFO_G_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL3, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_DEC_FIFO_G_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL3, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_DEC_FIFO_G_val
+* Description : Write DEC_FIFO_G
+* Input : u16_t
+* Output : Program G decimation value from unsigned short
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_DEC_FIFO_G_val(void *handle, u16_t newValue)
+{
+ switch(newValue) {
+ case 0:
+ LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_DATA_NOT_IN_FIFO);
+ break;
+
+ case 1:
+ LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_NO_DECIMATION);
+ break;
+
+ case 2:
+ LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_2);
+ break;
+
+ case 3:
+ LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_3);
+ break;
+
+ case 4:
+ LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_4);
+ break;
+
+ case 8:
+ LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_8);
+ break;
+
+ case 16:
+ LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_16);
+ break;
+
+ case 32:
+ LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_32);
+ break;
+
+ default:
+ return MEMS_ERROR;
+ }
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_DEC_FIFO_G
+* Description : Read DEC_FIFO_G
+* Input : Pointer to LSM6DSL_ACC_GYRO_DEC_FIFO_G_t
+* Output : Status of DEC_FIFO_G see LSM6DSL_ACC_GYRO_DEC_FIFO_G_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_DEC_FIFO_G(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL3, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_DEC_FIFO_G_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_DEC_FIFO_DS3
+* Description : Write DEC_DS3_FIFO
+* Input : LSM6DSL_ACC_GYRO_DEC_FIFO_DS3_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_DEC_FIFO_DS3(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_DS3_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_DEC_FIFO_DS3_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_DEC_FIFO_DS3
+* Description : Read DEC_DS3_FIFO
+* Input : Pointer to LSM6DSL_ACC_GYRO_DEC_FIFO_DS3_t
+* Output : Status of DEC_DS3_FIFO see LSM6DSL_ACC_GYRO_DEC_FIFO_DS3_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_DEC_FIFO_DS3(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_DS3_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_DEC_FIFO_DS3_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_DEC_FIFO_DS4
+* Description : Write DEC_DS4_FIFO
+* Input : LSM6DSL_ACC_GYRO_DEC_FIFO_DS4_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_DEC_FIFO_DS4(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_DS4_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_DEC_FIFO_DS4_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_DEC_FIFO_DS4
+* Description : Read DEC_DS4_FIFO
+* Input : Pointer to LSM6DSL_ACC_GYRO_DEC_FIFO_DS4_t
+* Output : Status of DEC_DS4_FIFO see LSM6DSL_ACC_GYRO_DEC_FIFO_DS4_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_DEC_FIFO_DS4(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_DS4_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_DEC_FIFO_DS4_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_HI_DATA_ONLY
+* Description : Write HI_DATA_ONLY
+* Input : LSM6DSL_ACC_GYRO_HI_DATA_ONLY_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_HI_DATA_ONLY(void *handle, LSM6DSL_ACC_GYRO_HI_DATA_ONLY_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_HI_DATA_ONLY_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_HI_DATA_ONLY
+* Description : Read HI_DATA_ONLY
+* Input : Pointer to LSM6DSL_ACC_GYRO_HI_DATA_ONLY_t
+* Output : Status of HI_DATA_ONLY see LSM6DSL_ACC_GYRO_HI_DATA_ONLY_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_HI_DATA_ONLY(void *handle, LSM6DSL_ACC_GYRO_HI_DATA_ONLY_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_HI_DATA_ONLY_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_STOP_ON_FTH
+* Description : Write STOP_ON_FTH
+* Input : LSM6DSL_ACC_GYRO_STOP_ON_FTH_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_STOP_ON_FTH(void *handle, LSM6DSL_ACC_GYRO_STOP_ON_FTH_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_STOP_ON_FTH_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_STOP_ON_FTH
+* Description : Read STOP_ON_FTH
+* Input : Pointer to LSM6DSL_ACC_GYRO_STOP_ON_FTH_t
+* Output : Status of STOP_ON_FTH see LSM6DSL_ACC_GYRO_STOP_ON_FTH_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_STOP_ON_FTH(void *handle, LSM6DSL_ACC_GYRO_STOP_ON_FTH_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_STOP_ON_FTH_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_FIFO_MODE
+* Description : Write FIFO_MODE
+* Input : LSM6DSL_ACC_GYRO_FIFO_MODE_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_FIFO_MODE(void *handle, LSM6DSL_ACC_GYRO_FIFO_MODE_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL5, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_FIFO_MODE_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL5, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_FIFO_MODE
+* Description : Read FIFO_MODE
+* Input : Pointer to LSM6DSL_ACC_GYRO_FIFO_MODE_t
+* Output : Status of FIFO_MODE see LSM6DSL_ACC_GYRO_FIFO_MODE_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_FIFO_MODE(void *handle, LSM6DSL_ACC_GYRO_FIFO_MODE_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL5, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_FIFO_MODE_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_ODR_FIFO
+* Description : Write ODR_FIFO
+* Input : LSM6DSL_ACC_GYRO_ODR_FIFO_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_ODR_FIFO(void *handle, LSM6DSL_ACC_GYRO_ODR_FIFO_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL5, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_ODR_FIFO_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL5, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_ODR_FIFO
+* Description : Read ODR_FIFO
+* Input : Pointer to LSM6DSL_ACC_GYRO_ODR_FIFO_t
+* Output : Status of ODR_FIFO see LSM6DSL_ACC_GYRO_ODR_FIFO_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_ODR_FIFO(void *handle, LSM6DSL_ACC_GYRO_ODR_FIFO_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL5, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_ODR_FIFO_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_DRDY_PULSE
+* Description : Write DRDY_PULSE
+* Input : LSM6DSL_ACC_GYRO_DRDY_PULSE_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_DRDY_PULSE(void *handle, LSM6DSL_ACC_GYRO_DRDY_PULSE_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_DRDY_PULSE_CFG_G, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_DRDY_PULSE_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_DRDY_PULSE_CFG_G, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_DRDY_PULSE
+* Description : Read DRDY_PULSE
+* Input : Pointer to LSM6DSL_ACC_GYRO_DRDY_PULSE_t
+* Output : Status of DRDY_PULSE see LSM6DSL_ACC_GYRO_DRDY_PULSE_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_DRDY_PULSE(void *handle, LSM6DSL_ACC_GYRO_DRDY_PULSE_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_DRDY_PULSE_CFG_G, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_DRDY_PULSE_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_DRDY_XL_on_INT1
+* Description : Write INT1_DRDY_XL
+* Input : LSM6DSL_ACC_GYRO_INT1_DRDY_XL_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_DRDY_XL_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_DRDY_XL_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_INT1_DRDY_XL_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_DRDY_XL_on_INT1
+* Description : Read INT1_DRDY_XL
+* Input : Pointer to LSM6DSL_ACC_GYRO_INT1_DRDY_XL_t
+* Output : Status of INT1_DRDY_XL see LSM6DSL_ACC_GYRO_INT1_DRDY_XL_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_DRDY_XL_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_DRDY_XL_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_INT1_DRDY_XL_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_DRDY_G_on_INT1
+* Description : Write INT1_DRDY_G
+* Input : LSM6DSL_ACC_GYRO_INT1_DRDY_G_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_DRDY_G_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_DRDY_G_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_INT1_DRDY_G_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_DRDY_G_on_INT1
+* Description : Read INT1_DRDY_G
+* Input : Pointer to LSM6DSL_ACC_GYRO_INT1_DRDY_G_t
+* Output : Status of INT1_DRDY_G see LSM6DSL_ACC_GYRO_INT1_DRDY_G_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_DRDY_G_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_DRDY_G_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_INT1_DRDY_G_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_BOOT_on_INT1
+* Description : Write INT1_BOOT
+* Input : LSM6DSL_ACC_GYRO_INT1_BOOT_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_BOOT_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_BOOT_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_INT1_BOOT_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_BOOT_on_INT1
+* Description : Read INT1_BOOT
+* Input : Pointer to LSM6DSL_ACC_GYRO_INT1_BOOT_t
+* Output : Status of INT1_BOOT see LSM6DSL_ACC_GYRO_INT1_BOOT_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_BOOT_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_BOOT_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_INT1_BOOT_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_FIFO_TSHLD_on_INT1
+* Description : Write INT1_FTH
+* Input : LSM6DSL_ACC_GYRO_INT1_FTH_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_FIFO_TSHLD_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_FTH_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_INT1_FTH_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_FIFO_TSHLD_on_INT1
+* Description : Read INT1_FTH
+* Input : Pointer to LSM6DSL_ACC_GYRO_INT1_FTH_t
+* Output : Status of INT1_FTH see LSM6DSL_ACC_GYRO_INT1_FTH_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_FIFO_TSHLD_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_FTH_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_INT1_FTH_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_OVERRUN_on_INT1
+* Description : Write INT1_OVR
+* Input : LSM6DSL_ACC_GYRO_INT1_OVR_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_OVERRUN_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_OVR_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_INT1_OVR_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_OVERRUN_on_INT1
+* Description : Read INT1_OVR
+* Input : Pointer to LSM6DSL_ACC_GYRO_INT1_OVR_t
+* Output : Status of INT1_OVR see LSM6DSL_ACC_GYRO_INT1_OVR_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_OVERRUN_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_OVR_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_INT1_OVR_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_FULL_FLAG_on_INT1
+* Description : Write INT1_FULL_FLAG
+* Input : LSM6DSL_ACC_GYRO_INT1_FULL_FLAG_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_FULL_FLAG_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_FULL_FLAG_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_INT1_FULL_FLAG_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_FULL_FLAG_on_INT1
+* Description : Read INT1_FULL_FLAG
+* Input : Pointer to LSM6DSL_ACC_GYRO_INT1_FULL_FLAG_t
+* Output : Status of INT1_FULL_FLAG see LSM6DSL_ACC_GYRO_INT1_FULL_FLAG_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_FULL_FLAG_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_FULL_FLAG_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_INT1_FULL_FLAG_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_SIGN_MOT_on_INT1
+* Description : Write INT1_SIGN_MOT
+* Input : LSM6DSL_ACC_GYRO_INT1_SIGN_MOT_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_SIGN_MOT_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_SIGN_MOT_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_INT1_SIGN_MOT_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_SIGN_MOT_on_INT1
+* Description : Read INT1_SIGN_MOT
+* Input : Pointer to LSM6DSL_ACC_GYRO_INT1_SIGN_MOT_t
+* Output : Status of INT1_SIGN_MOT see LSM6DSL_ACC_GYRO_INT1_SIGN_MOT_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_SIGN_MOT_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_SIGN_MOT_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_INT1_SIGN_MOT_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_STEP_DET_on_INT1
+* Description : Write INT1_PEDO
+* Input : LSM6DSL_ACC_GYRO_INT1_PEDO_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_STEP_DET_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_PEDO_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_INT1_PEDO_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_STEP_DET_on_INT1
+* Description : Read INT1_PEDO
+* Input : Pointer to LSM6DSL_ACC_GYRO_INT1_PEDO_t
+* Output : Status of INT1_PEDO see LSM6DSL_ACC_GYRO_INT1_PEDO_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_STEP_DET_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_PEDO_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_INT1_PEDO_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_DRDY_XL_on_INT2
+* Description : Write INT2_DRDY_XL
+* Input : LSM6DSL_ACC_GYRO_INT2_DRDY_XL_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_DRDY_XL_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_DRDY_XL_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_INT2_DRDY_XL_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_DRDY_XL_on_INT2
+* Description : Read INT2_DRDY_XL
+* Input : Pointer to LSM6DSL_ACC_GYRO_INT2_DRDY_XL_t
+* Output : Status of INT2_DRDY_XL see LSM6DSL_ACC_GYRO_INT2_DRDY_XL_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_DRDY_XL_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_DRDY_XL_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_INT2_DRDY_XL_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_DRDY_G_on_INT2
+* Description : Write INT2_DRDY_G
+* Input : LSM6DSL_ACC_GYRO_INT2_DRDY_G_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_DRDY_G_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_DRDY_G_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_INT2_DRDY_G_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_DRDY_G_on_INT2
+* Description : Read INT2_DRDY_G
+* Input : Pointer to LSM6DSL_ACC_GYRO_INT2_DRDY_G_t
+* Output : Status of INT2_DRDY_G see LSM6DSL_ACC_GYRO_INT2_DRDY_G_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_DRDY_G_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_DRDY_G_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_INT2_DRDY_G_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_DRDY_TEMP_on_INT2
+* Description : Write INT2_DRDY_TEMP
+* Input : LSM6DSL_ACC_GYRO_INT2_DRDY_TEMP_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_DRDY_TEMP_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_DRDY_TEMP_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_INT2_DRDY_TEMP_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_DRDY_TEMP_on_INT2
+* Description : Read INT2_DRDY_TEMP
+* Input : Pointer to LSM6DSL_ACC_GYRO_INT2_DRDY_TEMP_t
+* Output : Status of INT2_DRDY_TEMP see LSM6DSL_ACC_GYRO_INT2_DRDY_TEMP_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_DRDY_TEMP_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_DRDY_TEMP_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_INT2_DRDY_TEMP_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_FIFO_TSHLD_on_INT2
+* Description : Write INT2_FTH
+* Input : LSM6DSL_ACC_GYRO_INT2_FTH_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_FIFO_TSHLD_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_FTH_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_INT2_FTH_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_FIFO_TSHLD_on_INT2
+* Description : Read INT2_FTH
+* Input : Pointer to LSM6DSL_ACC_GYRO_INT2_FTH_t
+* Output : Status of INT2_FTH see LSM6DSL_ACC_GYRO_INT2_FTH_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_FIFO_TSHLD_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_FTH_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_INT2_FTH_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_OVERRUN_on_INT2
+* Description : Write INT2_OVR
+* Input : LSM6DSL_ACC_GYRO_INT2_OVR_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_OVERRUN_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_OVR_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_INT2_OVR_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_OVERRUN_on_INT2
+* Description : Read INT2_OVR
+* Input : Pointer to LSM6DSL_ACC_GYRO_INT2_OVR_t
+* Output : Status of INT2_OVR see LSM6DSL_ACC_GYRO_INT2_OVR_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_OVERRUN_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_OVR_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_INT2_OVR_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_FULL_FLAG_on_INT2
+* Description : Write INT2_FULL_FLAG
+* Input : LSM6DSL_ACC_GYRO_INT2_FULL_FLAG_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_FULL_FLAG_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_FULL_FLAG_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_INT2_FULL_FLAG_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_FULL_FLAG_on_INT2
+* Description : Read INT2_FULL_FLAG
+* Input : Pointer to LSM6DSL_ACC_GYRO_INT2_FULL_FLAG_t
+* Output : Status of INT2_FULL_FLAG see LSM6DSL_ACC_GYRO_INT2_FULL_FLAG_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_FULL_FLAG_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_FULL_FLAG_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_INT2_FULL_FLAG_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_STEP_COUNT_OV_on_INT2
+* Description : Write INT2_STEP_COUNT_OV
+* Input : LSM6DSL_ACC_GYRO_INT2_STEP_COUNT_OV_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_STEP_COUNT_OV_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_STEP_COUNT_OV_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_INT2_STEP_COUNT_OV_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_STEP_COUNT_OV_on_INT2
+* Description : Read INT2_STEP_COUNT_OV
+* Input : Pointer to LSM6DSL_ACC_GYRO_INT2_STEP_COUNT_OV_t
+* Output : Status of INT2_STEP_COUNT_OV see LSM6DSL_ACC_GYRO_INT2_STEP_COUNT_OV_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_STEP_COUNT_OV_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_STEP_COUNT_OV_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_INT2_STEP_COUNT_OV_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_STEP_DELTA_on_INT2
+* Description : Write INT2_STEP_DELTA
+* Input : LSM6DSL_ACC_GYRO_INT2_STEP_DELTA_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_STEP_DELTA_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_STEP_DELTA_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_INT2_STEP_DELTA_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_STEP_DELTA_on_INT2
+* Description : Read INT2_STEP_DELTA
+* Input : Pointer to LSM6DSL_ACC_GYRO_INT2_STEP_DELTA_t
+* Output : Status of INT2_STEP_DELTA see LSM6DSL_ACC_GYRO_INT2_STEP_DELTA_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_STEP_DELTA_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_STEP_DELTA_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_INT2_STEP_DELTA_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_SW_RESET
+* Description : Write SW_RESET
+* Input : LSM6DSL_ACC_GYRO_SW_RESET_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_SW_RESET(void *handle, LSM6DSL_ACC_GYRO_SW_RESET_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_SW_RESET_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_SW_RESET
+* Description : Read SW_RESET
+* Input : Pointer to LSM6DSL_ACC_GYRO_SW_RESET_t
+* Output : Status of SW_RESET see LSM6DSL_ACC_GYRO_SW_RESET_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_SW_RESET(void *handle, LSM6DSL_ACC_GYRO_SW_RESET_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_SW_RESET_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_IF_Addr_Incr
+* Description : Write IF_INC
+* Input : LSM6DSL_ACC_GYRO_IF_INC_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_IF_Addr_Incr(void *handle, LSM6DSL_ACC_GYRO_IF_INC_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_IF_INC_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_IF_Addr_Incr
+* Description : Read IF_INC
+* Input : Pointer to LSM6DSL_ACC_GYRO_IF_INC_t
+* Output : Status of IF_INC see LSM6DSL_ACC_GYRO_IF_INC_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_IF_Addr_Incr(void *handle, LSM6DSL_ACC_GYRO_IF_INC_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_IF_INC_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_SPI_Mode
+* Description : Write SIM
+* Input : LSM6DSL_ACC_GYRO_SIM_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_SPI_Mode(void *handle, LSM6DSL_ACC_GYRO_SIM_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_SIM_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_SPI_Mode
+* Description : Read SIM
+* Input : Pointer to LSM6DSL_ACC_GYRO_SIM_t
+* Output : Status of SIM see LSM6DSL_ACC_GYRO_SIM_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_SPI_Mode(void *handle, LSM6DSL_ACC_GYRO_SIM_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_SIM_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_PadSel
+* Description : Write PP_OD
+* Input : LSM6DSL_ACC_GYRO_PP_OD_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_PadSel(void *handle, LSM6DSL_ACC_GYRO_PP_OD_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_PP_OD_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_PadSel
+* Description : Read PP_OD
+* Input : Pointer to LSM6DSL_ACC_GYRO_PP_OD_t
+* Output : Status of PP_OD see LSM6DSL_ACC_GYRO_PP_OD_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_PadSel(void *handle, LSM6DSL_ACC_GYRO_PP_OD_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_PP_OD_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_INT_ACT_LEVEL
+* Description : Write INT_ACT_LEVEL
+* Input : LSM6DSL_ACC_GYRO_INT_ACT_LEVEL_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_INT_ACT_LEVEL(void *handle, LSM6DSL_ACC_GYRO_INT_ACT_LEVEL_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_INT_ACT_LEVEL_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_INT_ACT_LEVEL
+* Description : Read INT_ACT_LEVEL
+* Input : Pointer to LSM6DSL_ACC_GYRO_INT_ACT_LEVEL_t
+* Output : Status of INT_ACT_LEVEL see LSM6DSL_ACC_GYRO_INT_ACT_LEVEL_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_INT_ACT_LEVEL(void *handle, LSM6DSL_ACC_GYRO_INT_ACT_LEVEL_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_INT_ACT_LEVEL_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_BOOT
+* Description : Write BOOT
+* Input : LSM6DSL_ACC_GYRO_BOOT_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_BOOT(void *handle, LSM6DSL_ACC_GYRO_BOOT_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_BOOT_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_BOOT
+* Description : Read BOOT
+* Input : Pointer to LSM6DSL_ACC_GYRO_BOOT_t
+* Output : Status of BOOT see LSM6DSL_ACC_GYRO_BOOT_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_BOOT(void *handle, LSM6DSL_ACC_GYRO_BOOT_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_BOOT_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_LPF1_SEL_G
+* Description : Write LPF1_SEL_G
+* Input : LSM6DSL_ACC_GYRO_LPF1_SEL_G_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_LPF1_SEL_G(void *handle, LSM6DSL_ACC_GYRO_LPF1_SEL_G_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_LPF1_SEL_G_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_LPF1_SEL_G
+* Description : Read LPF1_SEL_G
+* Input : Pointer to LSM6DSL_ACC_GYRO_LPF1_SEL_G_t
+* Output : Status of LPF1_SEL_G see LSM6DSL_ACC_GYRO_LPF1_SEL_G_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_LPF1_SEL_G(void *handle, LSM6DSL_ACC_GYRO_LPF1_SEL_G_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_LPF1_SEL_G_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_I2C_DISABLE
+* Description : Write I2C_DISABLE
+* Input : LSM6DSL_ACC_GYRO_I2C_DISABLE_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_I2C_DISABLE(void *handle, LSM6DSL_ACC_GYRO_I2C_DISABLE_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_I2C_DISABLE_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_I2C_DISABLE
+* Description : Read I2C_DISABLE
+* Input : Pointer to LSM6DSL_ACC_GYRO_I2C_DISABLE_t
+* Output : Status of I2C_DISABLE see LSM6DSL_ACC_GYRO_I2C_DISABLE_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_I2C_DISABLE(void *handle, LSM6DSL_ACC_GYRO_I2C_DISABLE_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_I2C_DISABLE_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_DRDY_MSK
+* Description : Write DRDY_MSK
+* Input : LSM6DSL_ACC_GYRO_DRDY_MSK_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_DRDY_MSK(void *handle, LSM6DSL_ACC_GYRO_DRDY_MSK_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_DRDY_MSK_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_DRDY_MSK
+* Description : Read DRDY_MSK
+* Input : Pointer to LSM6DSL_ACC_GYRO_DRDY_MSK_t
+* Output : Status of DRDY_MSK see LSM6DSL_ACC_GYRO_DRDY_MSK_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_DRDY_MSK(void *handle, LSM6DSL_ACC_GYRO_DRDY_MSK_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_DRDY_MSK_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_INT2_ON_INT1
+* Description : Write INT2_ON_INT1
+* Input : LSM6DSL_ACC_GYRO_INT2_ON_INT1_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_INT2_ON_INT1(void *handle, LSM6DSL_ACC_GYRO_INT2_ON_INT1_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_INT2_ON_INT1_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_INT2_ON_INT1
+* Description : Read INT2_ON_INT1
+* Input : Pointer to LSM6DSL_ACC_GYRO_INT2_ON_INT1_t
+* Output : Status of INT2_ON_INT1 see LSM6DSL_ACC_GYRO_INT2_ON_INT1_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_INT2_ON_INT1(void *handle, LSM6DSL_ACC_GYRO_INT2_ON_INT1_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_INT2_ON_INT1_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_SleepMode_G
+* Description : Write SLEEP_G
+* Input : LSM6DSL_ACC_GYRO_SLEEP_G_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_SleepMode_G(void *handle, LSM6DSL_ACC_GYRO_SLEEP_G_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_SLEEP_G_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_SleepMode_G
+* Description : Read SLEEP_G
+* Input : Pointer to LSM6DSL_ACC_GYRO_SLEEP_G_t
+* Output : Status of SLEEP_G see LSM6DSL_ACC_GYRO_SLEEP_G_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_SleepMode_G(void *handle, LSM6DSL_ACC_GYRO_SLEEP_G_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_SLEEP_G_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_SelfTest_XL
+* Description : Write ST_XL
+* Input : LSM6DSL_ACC_GYRO_ST_XL_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_SelfTest_XL(void *handle, LSM6DSL_ACC_GYRO_ST_XL_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_ST_XL_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_SelfTest_XL
+* Description : Read ST_XL
+* Input : Pointer to LSM6DSL_ACC_GYRO_ST_XL_t
+* Output : Status of ST_XL see LSM6DSL_ACC_GYRO_ST_XL_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_SelfTest_XL(void *handle, LSM6DSL_ACC_GYRO_ST_XL_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_ST_XL_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_SelfTest_G
+* Description : Write ST_G
+* Input : LSM6DSL_ACC_GYRO_ST_G_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_SelfTest_G(void *handle, LSM6DSL_ACC_GYRO_ST_G_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_ST_G_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_SelfTest_G
+* Description : Read ST_G
+* Input : Pointer to LSM6DSL_ACC_GYRO_ST_G_t
+* Output : Status of ST_G see LSM6DSL_ACC_GYRO_ST_G_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_SelfTest_G(void *handle, LSM6DSL_ACC_GYRO_ST_G_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_ST_G_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_DEN_Polarity
+* Description : Write DEN_LH
+* Input : LSM6DSL_ACC_GYRO_DEN_LH_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_DEN_Polarity(void *handle, LSM6DSL_ACC_GYRO_DEN_LH_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_DEN_LH_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_DEN_Polarity
+* Description : Read DEN_LH
+* Input : Pointer to LSM6DSL_ACC_GYRO_DEN_LH_t
+* Output : Status of DEN_LH see LSM6DSL_ACC_GYRO_DEN_LH_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_DEN_Polarity(void *handle, LSM6DSL_ACC_GYRO_DEN_LH_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_DEN_LH_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_CircularBurstMode
+* Description : Write ST_ROUNDING
+* Input : LSM6DSL_ACC_GYRO_ROUNDING_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_CircularBurstMode(void *handle, LSM6DSL_ACC_GYRO_ROUNDING_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_LSM6DSL_ACC_GYRO_ROUNDING_t_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_CircularBurstMode
+* Description : Read ST_ROUNDING
+* Input : Pointer to LSM6DSL_ACC_GYRO_ROUNDING_t
+* Output : Status of ST_ROUNDING see LSM6DSL_ACC_GYRO_ROUNDING_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_CircularBurstMode(void *handle, LSM6DSL_ACC_GYRO_ROUNDING_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_LSM6DSL_ACC_GYRO_ROUNDING_t_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_LP_BW_G
+* Description : Write FTYPE
+* Input : LSM6DSL_ACC_GYRO_FTYPE_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_LP_BW_G(void *handle, LSM6DSL_ACC_GYRO_FTYPE_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_FTYPE_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_LP_BW_G
+* Description : Read FTYPE
+* Input : Pointer to LSM6DSL_ACC_GYRO_FTYPE_t
+* Output : Status of FTYPE see LSM6DSL_ACC_GYRO_FTYPE_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_LP_BW_G(void *handle, LSM6DSL_ACC_GYRO_FTYPE_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_FTYPE_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_UserOffsetWeight
+* Description : Write USR_OFF_W
+* Input : LSM6DSL_ACC_GYRO_USR_OFF_W_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_UserOffsetWeight(void *handle, LSM6DSL_ACC_GYRO_USR_OFF_W_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_USR_OFF_W_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_UserOffsetWeight
+* Description : Read USR_OFF_W
+* Input : Pointer to LSM6DSL_ACC_GYRO_USR_OFF_W_t
+* Output : Status of USR_OFF_W see LSM6DSL_ACC_GYRO_USR_OFF_W_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_UserOffsetWeight(void *handle, LSM6DSL_ACC_GYRO_USR_OFF_W_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_USR_OFF_W_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_LowPower_XL
+* Description : Write LP_XL
+* Input : LSM6DSL_ACC_GYRO_LP_XL_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_LowPower_XL(void *handle, LSM6DSL_ACC_GYRO_LP_XL_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_LP_XL_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_LowPower_XL
+* Description : Read LP_XL
+* Input : Pointer to LSM6DSL_ACC_GYRO_LP_XL_t
+* Output : Status of LP_XL see LSM6DSL_ACC_GYRO_LP_XL_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_LowPower_XL(void *handle, LSM6DSL_ACC_GYRO_LP_XL_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_LP_XL_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_DEN_LVL2_EN
+* Description : Write DEN_LVL2_EN
+* Input : LSM6DSL_ACC_GYRO_DEN_LVL2_EN_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_DEN_LVL2_EN(void *handle, LSM6DSL_ACC_GYRO_DEN_LVL2_EN_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_DEN_LVL2_EN_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_DEN_LVL2_EN
+* Description : Read DEN_LVL2_EN
+* Input : Pointer to LSM6DSL_ACC_GYRO_DEN_LVL2_EN_t
+* Output : Status of DEN_LVL2_EN see LSM6DSL_ACC_GYRO_DEN_LVL2_EN_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_DEN_LVL2_EN(void *handle, LSM6DSL_ACC_GYRO_DEN_LVL2_EN_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_DEN_LVL2_EN_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_DEN_LVL_EN
+* Description : Write DEN_LVL_EN
+* Input : LSM6DSL_ACC_GYRO_DEN_LVL_EN_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_DEN_LVL_EN(void *handle, LSM6DSL_ACC_GYRO_DEN_LVL_EN_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1))
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_DEN_LVL_EN_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_DEN_LVL_EN
+* Description : Read DEN_LVL_EN
+* Input : Pointer to LSM6DSL_ACC_GYRO_DEN_LVL_EN_t
+* Output : Status of DEN_LVL_EN see LSM6DSL_ACC_GYRO_DEN_LVL_EN_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_DEN_LVL_EN(void *handle, LSM6DSL_ACC_GYRO_DEN_LVL_EN_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_DEN_LVL_EN_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_ExternalTrigger
+* Description : Write DEN_EDGE_EN
+* Input : LSM6DSL_ACC_GYRO_DEN_EDGE_EN_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_ExternalTrigger(void *handle, LSM6DSL_ACC_GYRO_DEN_EDGE_EN_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_DEN_EDGE_EN_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_ExternalTrigger
+* Description : Read DEN_EDGE_EN
+* Input : Pointer to LSM6DSL_ACC_GYRO_DEN_EDGE_EN_t
+* Output : Status of DEN_EDGE_EN see LSM6DSL_ACC_GYRO_DEN_EDGE_EN_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_ExternalTrigger(void *handle, LSM6DSL_ACC_GYRO_DEN_EDGE_EN_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_DEN_EDGE_EN_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_HPM_G
+* Description : Write HPM_G
+* Input : LSM6DSL_ACC_GYRO_HPM_G_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_HPM_G(void *handle, LSM6DSL_ACC_GYRO_HPM_G_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_HPM_G_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_HPM_G
+* Description : Read HPM_G
+* Input : Pointer to LSM6DSL_ACC_GYRO_HPM_G_t
+* Output : Status of HPM_G see LSM6DSL_ACC_GYRO_HPM_G_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_HPM_G(void *handle, LSM6DSL_ACC_GYRO_HPM_G_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_HPM_G_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_RoundingOnStatusRegisters
+* Description : Write HPM_G
+* Input : LSM6DSL_ACC_GYRO_RND_STATUS_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_RoundingOnStatusRegisters(void *handle, LSM6DSL_ACC_GYRO_RND_STATUS_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_RND_STATUS_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_RoundingOnStatusRegisters
+* Description : Read HPM_G
+* Input : Pointer to LSM6DSL_ACC_GYRO_RND_STATUS_t
+* Output : Status of HPM_G see LSM6DSL_ACC_GYRO_RND_STATUS_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_RoundingOnStatusRegisters(void *handle, LSM6DSL_ACC_GYRO_RND_STATUS_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, (u8_t *)value, 1))
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_RND_STATUS_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_HPFilter_En
+* Description : Write HP_EN
+* Input : LSM6DSL_ACC_GYRO_HP_EN_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_HPFilter_En(void *handle, LSM6DSL_ACC_GYRO_HP_EN_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_HP_EN_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_HPFilter_En
+* Description : Read HP_EN
+* Input : Pointer to LSM6DSL_ACC_GYRO_HP_EN_t
+* Output : Status of HP_EN see LSM6DSL_ACC_GYRO_HP_EN_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_HPFilter_En(void *handle, LSM6DSL_ACC_GYRO_HP_EN_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_HP_EN_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_LP_Mode
+* Description : Write LP_EN
+* Input : LSM6DSL_ACC_GYRO_LP_EN_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_LP_Mode(void *handle, LSM6DSL_ACC_GYRO_LP_EN_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_LP_EN_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_LP_Mode
+* Description : Read LP_EN
+* Input : Pointer to LSM6DSL_ACC_GYRO_LP_EN_t
+* Output : Status of LP_EN see LSM6DSL_ACC_GYRO_LP_EN_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_LP_Mode(void *handle, LSM6DSL_ACC_GYRO_LP_EN_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_LP_EN_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_ROUNDING_STATUS
+* Description : Write ROUNDING_STATUS
+* Input : LSM6DSL_ACC_GYRO_ROUNDING_STATUS_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_ROUNDING_STATUS(void *handle, LSM6DSL_ACC_GYRO_ROUNDING_STATUS_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_ROUNDING_STATUS_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_ROUNDING_STATUS
+* Description : Read ROUNDING_STATUS
+* Input : Pointer to LSM6DSL_ACC_GYRO_ROUNDING_STATUS_t
+* Output : Status of ROUNDING_STATUS see LSM6DSL_ACC_GYRO_ROUNDING_STATUS_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_ROUNDING_STATUS(void *handle, LSM6DSL_ACC_GYRO_ROUNDING_STATUS_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_ROUNDING_STATUS_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_HP_G_RST
+* Description : Write HP_G_RST
+* Input : LSM6DSL_ACC_GYRO_HP_G_RST_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_HP_G_RST(void *handle, LSM6DSL_ACC_GYRO_HP_G_RST_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_HP_G_RST_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_HP_G_RST
+* Description : Read HP_G_RST
+* Input : Pointer to LSM6DSL_ACC_GYRO_HP_G_RST_t
+* Output : Status of HP_G_RST see LSM6DSL_ACC_GYRO_HP_G_RST_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_HP_G_RST(void *handle, LSM6DSL_ACC_GYRO_HP_G_RST_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_HP_G_RST_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_InComposit
+* Description : Write INPUT_COMPOSITE
+* Input : LSM6DSL_ACC_GYRO_IN_COMP_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_InComposit(void *handle, LSM6DSL_ACC_GYRO_IN_COMP_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_IN_COMP_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_InComposit
+* Description : Read INPUT_COMPOSITE
+* Input : Pointer to LSM6DSL_ACC_GYRO_IN_COMP_t
+* Output : Status of INPUT_COMPOSITE see LSM6DSL_ACC_GYRO_IN_COMP_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_InComposit(void *handle, LSM6DSL_ACC_GYRO_IN_COMP_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_IN_COMP_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_HPfilterReference
+* Description : Write HP_REF_MODE
+* Input : LSM6DSL_ACC_GYRO_HP_REF_MODE_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_HPfilterReference(void *handle, LSM6DSL_ACC_GYRO_HP_REF_MODE_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_HP_REF_MODE_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_HPfilterReference
+* Description : Read HP_REF_MODE
+* Input : Pointer to LSM6DSL_ACC_GYRO_HP_REF_MODE_t
+* Output : Status of HP_REF_MODE see LSM6DSL_ACC_GYRO_HP_REF_MODE_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_HPfilterReference(void *handle, LSM6DSL_ACC_GYRO_HP_REF_MODE_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_HP_REF_MODE_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_HPCF_XL
+* Description : Write HPCF_XL
+* Input : LSM6DSL_ACC_GYRO_HPCF_XL_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_HPCF_XL(void *handle, LSM6DSL_ACC_GYRO_HPCF_XL_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_HPCF_XL_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_HPCF_XL
+* Description : Read HPCF_XL
+* Input : Pointer to LSM6DSL_ACC_GYRO_HPCF_XL_t
+* Output : Status of HPCF_XL see LSM6DSL_ACC_GYRO_HPCF_XL_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_HPCF_XL(void *handle, LSM6DSL_ACC_GYRO_HPCF_XL_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_HPCF_XL_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_LowPassFiltSel_XL
+* Description : Write LPF2_XL_EN
+* Input : LSM6DSL_ACC_GYRO_LPF2_XL_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_LowPassFiltSel_XL(void *handle, LSM6DSL_ACC_GYRO_LPF2_XL_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_LPF2_XL_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_LowPassFiltSel_XL
+* Description : Read LPF2_XL_EN
+* Input : Pointer to LSM6DSL_ACC_GYRO_LPF2_XL_t
+* Output : Status of LPF2_XL_EN see LSM6DSL_ACC_GYRO_LPF2_XL_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_LowPassFiltSel_XL(void *handle, LSM6DSL_ACC_GYRO_LPF2_XL_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_LPF2_XL_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_LOW_PASS_ON_6D
+* Description : Write LOW_PASS_ON_6D
+* Input : LSM6DSL_ACC_GYRO_LOW_PASS_ON_6D_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_LOW_PASS_ON_6D(void *handle, LSM6DSL_ACC_GYRO_LOW_PASS_ON_6D_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_LOW_PASS_ON_6D_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_LOW_PASS_ON_6D
+* Description : Read LOW_PASS_ON_6D
+* Input : Pointer to LSM6DSL_ACC_GYRO_LOW_PASS_ON_6D_t
+* Output : Status of LOW_PASS_ON_6D see LSM6DSL_ACC_GYRO_LOW_PASS_ON_6D_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_LOW_PASS_ON_6D(void *handle, LSM6DSL_ACC_GYRO_LOW_PASS_ON_6D_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_LOW_PASS_ON_6D_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_HP_SLOPE_XL
+* Description : Write HP_SLOPE_XL_EN
+* Input : LSM6DSL_ACC_GYRO_HP_SLOPE_XL_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_HP_SLOPE_XL(void *handle, LSM6DSL_ACC_GYRO_HP_SLOPE_XL_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_HP_SLOPE_XL_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_HP_SLOPE_XL
+* Description : Read HP_SLOPE_XL_EN
+* Input : Pointer to LSM6DSL_ACC_GYRO_HP_SLOPE_XL_t
+* Output : Status of HP_SLOPE_XL_EN see LSM6DSL_ACC_GYRO_HP_SLOPE_XL_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_HP_SLOPE_XL(void *handle, LSM6DSL_ACC_GYRO_HP_SLOPE_XL_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_HP_SLOPE_XL_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_SOFT
+* Description : Write SOFT_EN
+* Input : LSM6DSL_ACC_GYRO_SOFT_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_SOFT(void *handle, LSM6DSL_ACC_GYRO_SOFT_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL9_XL, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_SOFT_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL9_XL, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_SOFT
+* Description : Read SOFT_EN
+* Input : Pointer to LSM6DSL_ACC_GYRO_SOFT_t
+* Output : Status of SOFT_EN see LSM6DSL_ACC_GYRO_SOFT_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_SOFT(void *handle, LSM6DSL_ACC_GYRO_SOFT_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL9_XL, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_SOFT_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_SignifcantMotion
+* Description : Write SIGN_MOTION_EN
+* Input : LSM6DSL_ACC_GYRO_SIGN_MOTION_EN_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_SignifcantMotion(void *handle, LSM6DSL_ACC_GYRO_SIGN_MOTION_EN_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_SIGN_MOTION_EN_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_SignifcantMotion
+* Description : Read SIGN_MOTION_EN
+* Input : Pointer to LSM6DSL_ACC_GYRO_SIGN_MOTION_EN_t
+* Output : Status of SIGN_MOTION_EN see LSM6DSL_ACC_GYRO_SIGN_MOTION_EN_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_SignifcantMotion(void *handle, LSM6DSL_ACC_GYRO_SIGN_MOTION_EN_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_SIGN_MOTION_EN_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_PedoStepReset
+* Description : Write PEDO_RST_STEP
+* Input : LSM6DSL_ACC_GYRO_PEDO_RST_STEP_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_PedoStepReset(void *handle, LSM6DSL_ACC_GYRO_PEDO_RST_STEP_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_PEDO_RST_STEP_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_PedoStepReset
+* Description : Read PEDO_RST_STEP
+* Input : Pointer to LSM6DSL_ACC_GYRO_PEDO_RST_STEP_t
+* Output : Status of PEDO_RST_STEP see LSM6DSL_ACC_GYRO_PEDO_RST_STEP_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_PedoStepReset(void *handle, LSM6DSL_ACC_GYRO_PEDO_RST_STEP_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_PEDO_RST_STEP_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_TILT
+* Description : Write XEN_G
+* Input : LSM6DSL_ACC_GYRO_TILT_G_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_TILT(void *handle, LSM6DSL_ACC_GYRO_TILT_G_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_TILT_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_TILT
+* Description : Read XEN_G
+* Input : Pointer to LSM6DSL_ACC_GYRO_TILT_G_t
+* Output : Status of XEN_G see LSM6DSL_ACC_GYRO_TILT_G_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_TILT(void *handle, LSM6DSL_ACC_GYRO_TILT_G_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_TILT_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_PEDO
+* Description : Write PEDO_EN
+* Input : LSM6DSL_ACC_GYRO_PEDO_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_PEDO(void *handle, LSM6DSL_ACC_GYRO_PEDO_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_PEDO_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_PEDO
+* Description : Read PEDO_EN
+* Input : Pointer to LSM6DSL_ACC_GYRO_PEDO_t
+* Output : Status of PEDO_EN see LSM6DSL_ACC_GYRO_PEDO_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_PEDO(void *handle, LSM6DSL_ACC_GYRO_PEDO_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_PEDO_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_TIMER
+* Description : Write TIMER_EN
+* Input : LSM6DSL_ACC_GYRO_TIMER_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_TIMER(void *handle, LSM6DSL_ACC_GYRO_TIMER_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_TIMER_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_TIMER
+* Description : Read TIMER_EN
+* Input : Pointer to LSM6DSL_ACC_GYRO_TIMER_t
+* Output : Status of TIMER_EN see LSM6DSL_ACC_GYRO_TIMER_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_TIMER(void *handle, LSM6DSL_ACC_GYRO_TIMER_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_TIMER_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_FUNC_EN
+* Description : Write FUNC_EN
+* Input : LSM6DSL_ACC_GYRO_FUNC_EN_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_FUNC_EN(void *handle, LSM6DSL_ACC_GYRO_FUNC_EN_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_FUNC_EN_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_FUNC_EN
+* Description : Read FUNC_EN
+* Input : Pointer to LSM6DSL_ACC_GYRO_FUNC_EN_t
+* Output : Status of FUNC_EN see LSM6DSL_ACC_GYRO_FUNC_EN_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_FUNC_EN(void *handle, LSM6DSL_ACC_GYRO_FUNC_EN_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_FUNC_EN_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_I2C_MASTER_Enable
+* Description : Write MASTER_ON
+* Input : LSM6DSL_ACC_GYRO_MASTER_ON_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_I2C_MASTER_Enable(void *handle, LSM6DSL_ACC_GYRO_MASTER_ON_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_MASTER_ON_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_I2C_MASTER_Enable
+* Description : Read MASTER_ON
+* Input : Pointer to LSM6DSL_ACC_GYRO_MASTER_ON_t
+* Output : Status of MASTER_ON see LSM6DSL_ACC_GYRO_MASTER_ON_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_I2C_MASTER_Enable(void *handle, LSM6DSL_ACC_GYRO_MASTER_ON_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_MASTER_ON_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_IronCorrection_EN
+* Description : Write IRON_EN
+* Input : LSM6DSL_ACC_GYRO_IRON_EN_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_IronCorrection_EN(void *handle, LSM6DSL_ACC_GYRO_IRON_EN_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_IRON_EN_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_IronCorrection_EN
+* Description : Read IRON_EN
+* Input : Pointer to LSM6DSL_ACC_GYRO_IRON_EN_t
+* Output : Status of IRON_EN see LSM6DSL_ACC_GYRO_IRON_EN_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_IronCorrection_EN(void *handle, LSM6DSL_ACC_GYRO_IRON_EN_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_IRON_EN_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_PASS_THRU_MODE
+* Description : Write PASS_THRU_MODE
+* Input : LSM6DSL_ACC_GYRO_PASS_THRU_MODE_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_PASS_THRU_MODE(void *handle, LSM6DSL_ACC_GYRO_PASS_THRU_MODE_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_PASS_THRU_MODE_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_PASS_THRU_MODE
+* Description : Read PASS_THRU_MODE
+* Input : Pointer to LSM6DSL_ACC_GYRO_PASS_THRU_MODE_t
+* Output : Status of PASS_THRU_MODE see LSM6DSL_ACC_GYRO_PASS_THRU_MODE_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_PASS_THRU_MODE(void *handle, LSM6DSL_ACC_GYRO_PASS_THRU_MODE_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_PASS_THRU_MODE_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_PULL_UP_EN
+* Description : Write PULL_UP_EN
+* Input : LSM6DSL_ACC_GYRO_PULL_UP_EN_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_PULL_UP_EN(void *handle, LSM6DSL_ACC_GYRO_PULL_UP_EN_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_PULL_UP_EN_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_PULL_UP_EN
+* Description : Read PULL_UP_EN
+* Input : Pointer to LSM6DSL_ACC_GYRO_PULL_UP_EN_t
+* Output : Status of PULL_UP_EN see LSM6DSL_ACC_GYRO_PULL_UP_EN_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_PULL_UP_EN(void *handle, LSM6DSL_ACC_GYRO_PULL_UP_EN_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_PULL_UP_EN_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_SensorHUB_Trigger_Sel
+* Description : Write START_CONFIG
+* Input : LSM6DSL_ACC_GYRO_START_CONFIG_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_SensorHUB_Trigger_Sel(void *handle, LSM6DSL_ACC_GYRO_START_CONFIG_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_START_CONFIG_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_SensorHUB_Trigger_Sel
+* Description : Read START_CONFIG
+* Input : Pointer to LSM6DSL_ACC_GYRO_START_CONFIG_t
+* Output : Status of START_CONFIG see LSM6DSL_ACC_GYRO_START_CONFIG_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_SensorHUB_Trigger_Sel(void *handle, LSM6DSL_ACC_GYRO_START_CONFIG_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_START_CONFIG_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_DATA_VAL_SEL_FIFO
+* Description : Write DATA_VAL_SEL_FIFO
+* Input : LSM6DSL_ACC_GYRO_DATA_VAL_SEL_FIFO_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_DATA_VAL_SEL_FIFO(void *handle, LSM6DSL_ACC_GYRO_DATA_VAL_SEL_FIFO_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_DATA_VAL_SEL_FIFO_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_DATA_VAL_SEL_FIFO
+* Description : Read DATA_VAL_SEL_FIFO
+* Input : Pointer to LSM6DSL_ACC_GYRO_DATA_VAL_SEL_FIFO_t
+* Output : Status of DATA_VAL_SEL_FIFO see LSM6DSL_ACC_GYRO_DATA_VAL_SEL_FIFO_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_DATA_VAL_SEL_FIFO(void *handle, LSM6DSL_ACC_GYRO_DATA_VAL_SEL_FIFO_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_DATA_VAL_SEL_FIFO_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_DRDY_ON_INT1
+* Description : Write DRDY_ON_INT1
+* Input : LSM6DSL_ACC_GYRO_DRDY_ON_INT1_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_DRDY_ON_INT1(void *handle, LSM6DSL_ACC_GYRO_DRDY_ON_INT1_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_DRDY_ON_INT1_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_DRDY_ON_INT1
+* Description : Read DRDY_ON_INT1
+* Input : Pointer to LSM6DSL_ACC_GYRO_DRDY_ON_INT1_t
+* Output : Status of DRDY_ON_INT1 see LSM6DSL_ACC_GYRO_DRDY_ON_INT1_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_DRDY_ON_INT1(void *handle, LSM6DSL_ACC_GYRO_DRDY_ON_INT1_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_DRDY_ON_INT1_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_Z_WU
+* Description : Read Z_WU
+* Input : Pointer to LSM6DSL_ACC_GYRO_Z_WU_t
+* Output : Status of Z_WU see LSM6DSL_ACC_GYRO_Z_WU_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_Z_WU(void *handle, LSM6DSL_ACC_GYRO_Z_WU_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_Z_WU_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_Y_WU
+* Description : Read Y_WU
+* Input : Pointer to LSM6DSL_ACC_GYRO_Y_WU_t
+* Output : Status of Y_WU see LSM6DSL_ACC_GYRO_Y_WU_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_Y_WU(void *handle, LSM6DSL_ACC_GYRO_Y_WU_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_Y_WU_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_X_WU
+* Description : Read X_WU
+* Input : Pointer to LSM6DSL_ACC_GYRO_X_WU_t
+* Output : Status of X_WU see LSM6DSL_ACC_GYRO_X_WU_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_X_WU(void *handle, LSM6DSL_ACC_GYRO_X_WU_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_X_WU_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_WU_EV_STATUS
+* Description : Read WU_EV_STATUS
+* Input : Pointer to LSM6DSL_ACC_GYRO_WU_EV_STATUS_t
+* Output : Status of WU_EV_STATUS see LSM6DSL_ACC_GYRO_WU_EV_STATUS_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_WU_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_WU_EV_STATUS_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_WU_EV_STATUS_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_SLEEP_EV_STATUS
+* Description : Read SLEEP_EV_STATUS
+* Input : Pointer to LSM6DSL_ACC_GYRO_SLEEP_EV_STATUS_t
+* Output : Status of SLEEP_EV_STATUS see LSM6DSL_ACC_GYRO_SLEEP_EV_STATUS_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_SLEEP_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_SLEEP_EV_STATUS_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_SLEEP_EV_STATUS_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_FF_EV_STATUS
+* Description : Read FF_EV_STATUS
+* Input : Pointer to LSM6DSL_ACC_GYRO_FF_EV_STATUS_t
+* Output : Status of FF_EV_STATUS see LSM6DSL_ACC_GYRO_FF_EV_STATUS_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_FF_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_FF_EV_STATUS_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_FF_EV_STATUS_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_Z_TAP
+* Description : Read Z_TAP
+* Input : Pointer to LSM6DSL_ACC_GYRO_Z_TAP_t
+* Output : Status of Z_TAP see LSM6DSL_ACC_GYRO_Z_TAP_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_Z_TAP(void *handle, LSM6DSL_ACC_GYRO_Z_TAP_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_TAP_SRC, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_Z_TAP_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_Y_TAP
+* Description : Read Y_TAP
+* Input : Pointer to LSM6DSL_ACC_GYRO_Y_TAP_t
+* Output : Status of Y_TAP see LSM6DSL_ACC_GYRO_Y_TAP_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_Y_TAP(void *handle, LSM6DSL_ACC_GYRO_Y_TAP_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_TAP_SRC, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_Y_TAP_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_X_TAP
+* Description : Read X_TAP
+* Input : Pointer to LSM6DSL_ACC_GYRO_X_TAP_t
+* Output : Status of X_TAP see LSM6DSL_ACC_GYRO_X_TAP_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_X_TAP(void *handle, LSM6DSL_ACC_GYRO_X_TAP_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_TAP_SRC, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_X_TAP_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_TAP_SIGN
+* Description : Read TAP_SIGN
+* Input : Pointer to LSM6DSL_ACC_GYRO_TAP_SIGN_t
+* Output : Status of TAP_SIGN see LSM6DSL_ACC_GYRO_TAP_SIGN_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_TAP_SIGN(void *handle, LSM6DSL_ACC_GYRO_TAP_SIGN_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_TAP_SRC, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_TAP_SIGN_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_DOUBLE_TAP_EV_STATUS
+* Description : Read DOUBLE_TAP_EV_STATUS
+* Input : Pointer to LSM6DSL_ACC_GYRO_DOUBLE_TAP_EV_STATUS_t
+* Output : Status of DOUBLE_TAP_EV_STATUS see LSM6DSL_ACC_GYRO_DOUBLE_TAP_EV_STATUS_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_DOUBLE_TAP_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_DOUBLE_TAP_EV_STATUS_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_TAP_SRC, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_DOUBLE_TAP_EV_STATUS_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_SINGLE_TAP_EV_STATUS
+* Description : Read SINGLE_TAP_EV_STATUS
+* Input : Pointer to LSM6DSL_ACC_GYRO_SINGLE_TAP_EV_STATUS_t
+* Output : Status of SINGLE_TAP_EV_STATUS see LSM6DSL_ACC_GYRO_SINGLE_TAP_EV_STATUS_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_SINGLE_TAP_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_SINGLE_TAP_EV_STATUS_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_TAP_SRC, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_SINGLE_TAP_EV_STATUS_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_TAP_EV_STATUS
+* Description : Read TAP_EV_STATUS
+* Input : Pointer to LSM6DSL_ACC_GYRO_TAP_EV_STATUS_t
+* Output : Status of TAP_EV_STATUS see LSM6DSL_ACC_GYRO_TAP_EV_STATUS_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_TAP_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_TAP_EV_STATUS_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_TAP_SRC, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_TAP_EV_STATUS_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_DSD_XL
+* Description : Read DSD_XL
+* Input : Pointer to LSM6DSL_ACC_GYRO_DSD_XL_t
+* Output : Status of DSD_XL see LSM6DSL_ACC_GYRO_DSD_XL_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_DSD_XL(void *handle, LSM6DSL_ACC_GYRO_DSD_XL_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_D6D_SRC, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_DSD_XL_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_DSD_XH
+* Description : Read DSD_XH
+* Input : Pointer to LSM6DSL_ACC_GYRO_DSD_XH_t
+* Output : Status of DSD_XH see LSM6DSL_ACC_GYRO_DSD_XH_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_DSD_XH(void *handle, LSM6DSL_ACC_GYRO_DSD_XH_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_D6D_SRC, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_DSD_XH_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_DSD_YL
+* Description : Read DSD_YL
+* Input : Pointer to LSM6DSL_ACC_GYRO_DSD_YL_t
+* Output : Status of DSD_YL see LSM6DSL_ACC_GYRO_DSD_YL_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_DSD_YL(void *handle, LSM6DSL_ACC_GYRO_DSD_YL_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_D6D_SRC, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_DSD_YL_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_DSD_YH
+* Description : Read DSD_YH
+* Input : Pointer to LSM6DSL_ACC_GYRO_DSD_YH_t
+* Output : Status of DSD_YH see LSM6DSL_ACC_GYRO_DSD_YH_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_DSD_YH(void *handle, LSM6DSL_ACC_GYRO_DSD_YH_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_D6D_SRC, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_DSD_YH_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_DSD_ZL
+* Description : Read DSD_ZL
+* Input : Pointer to LSM6DSL_ACC_GYRO_DSD_ZL_t
+* Output : Status of DSD_ZL see LSM6DSL_ACC_GYRO_DSD_ZL_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_DSD_ZL(void *handle, LSM6DSL_ACC_GYRO_DSD_ZL_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_D6D_SRC, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_DSD_ZL_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_DSD_ZH
+* Description : Read DSD_ZH
+* Input : Pointer to LSM6DSL_ACC_GYRO_DSD_ZH_t
+* Output : Status of DSD_ZH see LSM6DSL_ACC_GYRO_DSD_ZH_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_DSD_ZH(void *handle, LSM6DSL_ACC_GYRO_DSD_ZH_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_D6D_SRC, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_DSD_ZH_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_D6D_EV_STATUS
+* Description : Read D6D_EV_STATUS
+* Input : Pointer to LSM6DSL_ACC_GYRO_D6D_EV_STATUS_t
+* Output : Status of D6D_EV_STATUS see LSM6DSL_ACC_GYRO_D6D_EV_STATUS_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_D6D_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_D6D_EV_STATUS_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_D6D_SRC, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_D6D_EV_STATUS_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_XLDA
+* Description : Read XLDA
+* Input : Pointer to LSM6DSL_ACC_GYRO_XLDA_t
+* Output : Status of XLDA see LSM6DSL_ACC_GYRO_XLDA_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_XLDA(void *handle, LSM6DSL_ACC_GYRO_XLDA_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_STATUS_REG, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_XLDA_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_GDA
+* Description : Read GDA
+* Input : Pointer to LSM6DSL_ACC_GYRO_GDA_t
+* Output : Status of GDA see LSM6DSL_ACC_GYRO_GDA_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_GDA(void *handle, LSM6DSL_ACC_GYRO_GDA_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_STATUS_REG, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_GDA_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_TDA
+* Description : Read GDA
+* Input : Pointer to LSM6DSL_ACC_GYRO_TDA_t
+* Output : Status of GDA see LSM6DSL_ACC_GYRO_TDA_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_TDA(void *handle, LSM6DSL_ACC_GYRO_TDA_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_STATUS_REG, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_TDA_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_FIFONumOfEntries
+* Description : Read DIFF_FIFO
+* Input : Pointer to u16_t
+* Output : Status of DIFF_FIFO
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_FIFONumOfEntries(void *handle, u16_t *value)
+{
+ u8_t valueH, valueL;
+
+ /* Low part from FIFO_STATUS1 */
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS1, (u8_t *)&valueL, 1) )
+ return MEMS_ERROR;
+
+ valueL &= LSM6DSL_ACC_GYRO_DIFF_FIFO_STATUS1_MASK; //coerce
+ valueL = valueL >> LSM6DSL_ACC_GYRO_DIFF_FIFO_STATUS1_POSITION; //mask
+
+ /* High part from FIFO_STATUS2 */
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS2, (u8_t *)&valueH, 1) )
+ return MEMS_ERROR;
+
+ valueH &= LSM6DSL_ACC_GYRO_DIFF_FIFO_STATUS2_MASK; //coerce
+ valueH = valueH >> LSM6DSL_ACC_GYRO_DIFF_FIFO_STATUS2_POSITION; //mask
+
+ *value = ((valueH << 8) & 0xFF00) | valueL;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_FIFOEmpty
+* Description : Read FIFO_EMPTY
+* Input : Pointer to LSM6DSL_ACC_GYRO_FIFO_EMPTY_t
+* Output : Status of FIFO_EMPTY see LSM6DSL_ACC_GYRO_FIFO_EMPTY_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_FIFOEmpty(void *handle, LSM6DSL_ACC_GYRO_FIFO_EMPTY_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS2, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_FIFO_EMPTY_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_FIFOFull
+* Description : Read FIFO_FULL
+* Input : Pointer to LSM6DSL_ACC_GYRO_FIFO_FULL_t
+* Output : Status of FIFO_FULL see LSM6DSL_ACC_GYRO_FIFO_FULL_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_FIFOFull(void *handle, LSM6DSL_ACC_GYRO_FIFO_FULL_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS2, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_FIFO_FULL_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_OVERRUN
+* Description : Read OVERRUN
+* Input : Pointer to LSM6DSL_ACC_GYRO_OVERRUN_t
+* Output : Status of OVERRUN see LSM6DSL_ACC_GYRO_OVERRUN_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_OVERRUN(void *handle, LSM6DSL_ACC_GYRO_OVERRUN_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS2, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_OVERRUN_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_WaterMark
+* Description : Read WTM
+* Input : Pointer to LSM6DSL_ACC_GYRO_WTM_t
+* Output : Status of WTM see LSM6DSL_ACC_GYRO_WTM_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_WaterMark(void *handle, LSM6DSL_ACC_GYRO_WTM_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS2, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_WTM_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_FIFOPattern
+* Description : Read FIFO_PATTERN
+* Input : Pointer to u16_t
+* Output : Status of FIFO_PATTERN
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_FIFOPattern(void *handle, u16_t *value)
+{
+ u8_t valueH, valueL;
+
+ /* Low part from FIFO_STATUS3 */
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS3, (u8_t *)&valueL, 1) )
+ return MEMS_ERROR;
+
+ valueL &= LSM6DSL_ACC_GYRO_FIFO_STATUS3_PATTERN_MASK; //coerce
+ valueL = valueL >> LSM6DSL_ACC_GYRO_FIFO_STATUS3_PATTERN_POSITION; //mask
+
+ /* High part from FIFO_STATUS4 */
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS4, (u8_t *)&valueH, 1) )
+ return MEMS_ERROR;
+
+ valueH &= LSM6DSL_ACC_GYRO_FIFO_STATUS4_PATTERN_MASK; //coerce
+ valueH = valueH >> LSM6DSL_ACC_GYRO_FIFO_STATUS4_PATTERN_POSITION; //mask
+
+ *value = ((valueH << 8) & 0xFF00) | valueL;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_SENS_HUB_END
+* Description : Read SENS_HUB_END
+* Input : Pointer to LSM6DSL_ACC_GYRO_SENS_HUB_END_t
+* Output : Status of SENS_HUB_END see LSM6DSL_ACC_GYRO_SENS_HUB_END_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_SENS_HUB_END(void *handle, LSM6DSL_ACC_GYRO_SENS_HUB_END_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_SENS_HUB_END_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_SOFT_IRON_END
+* Description : Read SOFT_IRON_END
+* Input : Pointer to LSM6DSL_ACC_GYRO_SOFT_IRON_END_t
+* Output : Status of SOFT_IRON_END see LSM6DSL_ACC_GYRO_SOFT_IRON_END_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_SOFT_IRON_END(void *handle, LSM6DSL_ACC_GYRO_SOFT_IRON_END_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_SOFT_IRON_END_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_HardIron
+* Description : Read HI_FAIL
+* Input : Pointer to LSM6DSL_ACC_GYRO_SOFT_HARD_IRON_STAT_t
+* Output : Status of HI_FAIL see LSM6DSL_ACC_GYRO_SOFT_HARD_IRON_STAT_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_HardIron(void *handle, LSM6DSL_ACC_GYRO_SOFT_HARD_IRON_STAT_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_HARD_IRON_STAT_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_STEP_OVERFLOW
+* Description : Read STEP_OVERFLOW
+* Input : Pointer to LSM6DSL_ACC_GYRO_STEP_OVERFLOW_t
+* Output : Status of STEP_OVERFLOW see LSM6DSL_ACC_GYRO_STEP_OVERFLOW_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_STEP_OVERFLOW(void *handle, LSM6DSL_ACC_GYRO_STEP_OVERFLOW_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_STEP_OVERFLOW_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_STEP_COUNT_DELTA
+* Description : Read STEP_COUNT_DELTA_IA
+* Input : Pointer to LSM6DSL_ACC_GYRO_STEP_COUNT_DELTA_t
+* Output : Status of STEP_COUNT_DELTA_IA see LSM6DSL_ACC_GYRO_STEP_COUNT_DELTA_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_STEP_COUNT_DELTA(void *handle, LSM6DSL_ACC_GYRO_STEP_COUNT_DELTA_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_STEP_COUNT_DELTA_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_PEDO_EV_STATUS
+* Description : Read PEDO_EV_STATUS
+* Input : Pointer to LSM6DSL_ACC_GYRO_PEDO_EV_STATUS_t
+* Output : Status of PEDO_EV_STATUS see LSM6DSL_ACC_GYRO_PEDO_EV_STATUS_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_PEDO_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_PEDO_EV_STATUS_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_PEDO_EV_STATUS_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_TILT_EV_STATUS
+* Description : Read TILT_EV_STATUS
+* Input : Pointer to LSM6DSL_ACC_GYRO_TILT_EV_STATUS_t
+* Output : Status of TILT_EV_STATUS see LSM6DSL_ACC_GYRO_TILT_EV_STATUS_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_TILT_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_TILT_EV_STATUS_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_TILT_EV_STATUS_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_SIGN_MOT_EV_STATUS
+* Description : Read SIGN_MOT_EV_STATUS
+* Input : Pointer to LSM6DSL_ACC_GYRO_SIGN_MOT_EV_STATUS_t
+* Output : Status of SIGN_MOT_EV_STATUS see LSM6DSL_ACC_GYRO_SIGN_MOT_EV_STATUS_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_SIGN_MOT_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_SIGN_MOT_EV_STATUS_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_SIGN_MOT_EV_STATUS_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_LIR
+* Description : Write LIR
+* Input : LSM6DSL_ACC_GYRO_LIR_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_LIR(void *handle, LSM6DSL_ACC_GYRO_LIR_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_LIR_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_LIR
+* Description : Read LIR
+* Input : Pointer to LSM6DSL_ACC_GYRO_LIR_t
+* Output : Status of LIR see LSM6DSL_ACC_GYRO_LIR_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_LIR(void *handle, LSM6DSL_ACC_GYRO_LIR_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_LIR_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_TAP_Z_EN
+* Description : Write TAP_Z_EN
+* Input : LSM6DSL_ACC_GYRO_TAP_Z_EN_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_TAP_Z_EN(void *handle, LSM6DSL_ACC_GYRO_TAP_Z_EN_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_TAP_Z_EN_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_TAP_Z_EN
+* Description : Read TAP_Z_EN
+* Input : Pointer to LSM6DSL_ACC_GYRO_TAP_Z_EN_t
+* Output : Status of TAP_Z_EN see LSM6DSL_ACC_GYRO_TAP_Z_EN_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_TAP_Z_EN(void *handle, LSM6DSL_ACC_GYRO_TAP_Z_EN_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_TAP_Z_EN_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_TAP_Y_EN
+* Description : Write TAP_Y_EN
+* Input : LSM6DSL_ACC_GYRO_TAP_Y_EN_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_TAP_Y_EN(void *handle, LSM6DSL_ACC_GYRO_TAP_Y_EN_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_TAP_Y_EN_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_TAP_Y_EN
+* Description : Read TAP_Y_EN
+* Input : Pointer to LSM6DSL_ACC_GYRO_TAP_Y_EN_t
+* Output : Status of TAP_Y_EN see LSM6DSL_ACC_GYRO_TAP_Y_EN_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_TAP_Y_EN(void *handle, LSM6DSL_ACC_GYRO_TAP_Y_EN_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_TAP_Y_EN_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_TAP_X_EN
+* Description : Write TAP_X_EN
+* Input : LSM6DSL_ACC_GYRO_TAP_X_EN_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_TAP_X_EN(void *handle, LSM6DSL_ACC_GYRO_TAP_X_EN_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_TAP_X_EN_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_TAP_X_EN
+* Description : Read TAP_X_EN
+* Input : Pointer to LSM6DSL_ACC_GYRO_TAP_X_EN_t
+* Output : Status of TAP_X_EN see LSM6DSL_ACC_GYRO_TAP_X_EN_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_TAP_X_EN(void *handle, LSM6DSL_ACC_GYRO_TAP_X_EN_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_TAP_X_EN_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_SLOPE_FDS
+* Description : Write SLOPE_FDS
+* Input : LSM6DSL_ACC_GYRO_SLOPE_FDS_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_SLOPE_FDS(void *handle, LSM6DSL_ACC_GYRO_SLOPE_FDS_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_SLOPE_FDS_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_SLOPE_FDS
+* Description : Read SLOPE_FDS
+* Input : Pointer to LSM6DSL_ACC_GYRO_SLOPE_FDS_t
+* Output : Status of SLOPE_FDS see LSM6DSL_ACC_GYRO_SLOPE_FDS_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_SLOPE_FDS(void *handle, LSM6DSL_ACC_GYRO_SLOPE_FDS_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_SLOPE_FDS_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_BASIC_INT
+* Description : Write INTERRUPTS_ENABLE
+* Input : LSM6DSL_ACC_GYRO_INT_EN_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_BASIC_INT(void *handle, LSM6DSL_ACC_GYRO_INT_EN_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_INT_EN_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_BASIC_INT
+* Description : Read INTERRUPTS_ENABLE
+* Input : Pointer to LSM6DSL_ACC_GYRO_INT_EN_t
+* Output : Status of INTERRUPTS_ENABLE see LSM6DSL_ACC_GYRO_INT_EN_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_BASIC_INT(void *handle, LSM6DSL_ACC_GYRO_INT_EN_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_INT_EN_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_TAP_THS
+* Description : Write TAP_THS
+* Input : u8_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_TAP_THS(void *handle, u8_t newValue)
+{
+ u8_t value;
+
+ newValue = newValue << LSM6DSL_ACC_GYRO_TAP_THS_POSITION; //mask
+ newValue &= LSM6DSL_ACC_GYRO_TAP_THS_MASK; //coerce
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_TAP_THS_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_TAP_THS
+* Description : Read TAP_THS
+* Input : Pointer to u8_t
+* Output : Status of TAP_THS
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_TAP_THS(void *handle, u8_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_TAP_THS_MASK; //coerce
+ *value = *value >> LSM6DSL_ACC_GYRO_TAP_THS_POSITION; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_SIXD_THS
+* Description : Write SIXD_THS
+* Input : LSM6DSL_ACC_GYRO_SIXD_THS_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_SIXD_THS(void *handle, LSM6DSL_ACC_GYRO_SIXD_THS_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_SIXD_THS_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_SIXD_THS
+* Description : Read SIXD_THS
+* Input : Pointer to LSM6DSL_ACC_GYRO_SIXD_THS_t
+* Output : Status of SIXD_THS see LSM6DSL_ACC_GYRO_SIXD_THS_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_SIXD_THS(void *handle, LSM6DSL_ACC_GYRO_SIXD_THS_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_SIXD_THS_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_D4D
+* Description : Write D4D_EN
+* Input : LSM6DSL_ACC_GYRO_D4D_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_D4D(void *handle, LSM6DSL_ACC_GYRO_D4D_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_D4D_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_D4D
+* Description : Read D4D_EN
+* Input : Pointer to LSM6DSL_ACC_GYRO_D4D_t
+* Output : Status of D4D_EN see LSM6DSL_ACC_GYRO_D4D_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_D4D(void *handle, LSM6DSL_ACC_GYRO_D4D_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_D4D_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_SHOCK_Duration
+* Description : Write SHOCK
+* Input : u8_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_SHOCK_Duration(void *handle, u8_t newValue)
+{
+ u8_t value;
+
+ newValue = newValue << LSM6DSL_ACC_GYRO_SHOCK_POSITION; //mask
+ newValue &= LSM6DSL_ACC_GYRO_SHOCK_MASK; //coerce
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_SHOCK_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_SHOCK_Duration
+* Description : Read SHOCK
+* Input : Pointer to u8_t
+* Output : Status of SHOCK
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_SHOCK_Duration(void *handle, u8_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_SHOCK_MASK; //coerce
+ *value = *value >> LSM6DSL_ACC_GYRO_SHOCK_POSITION; //mask
+
+ return MEMS_SUCCESS;
+}
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_QUIET_Duration
+* Description : Write QUIET
+* Input : u8_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_QUIET_Duration(void *handle, u8_t newValue)
+{
+ u8_t value;
+
+ newValue = newValue << LSM6DSL_ACC_GYRO_QUIET_POSITION; //mask
+ newValue &= LSM6DSL_ACC_GYRO_QUIET_MASK; //coerce
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_QUIET_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_QUIET_Duration
+* Description : Read QUIET
+* Input : Pointer to u8_t
+* Output : Status of QUIET
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_QUIET_Duration(void *handle, u8_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_QUIET_MASK; //coerce
+ *value = *value >> LSM6DSL_ACC_GYRO_QUIET_POSITION; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_DUR
+* Description : Write DUR
+* Input : u8_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_DUR(void *handle, u8_t newValue)
+{
+ u8_t value;
+
+ newValue = newValue << LSM6DSL_ACC_GYRO_DUR_POSITION; //mask
+ newValue &= LSM6DSL_ACC_GYRO_DUR_MASK; //coerce
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_DUR_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_DUR
+* Description : Read DUR
+* Input : Pointer to u8_t
+* Output : Status of DUR
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_DUR(void *handle, u8_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_DUR_MASK; //coerce
+ *value = *value >> LSM6DSL_ACC_GYRO_DUR_POSITION; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_WK_THS
+* Description : Write WK_THS
+* Input : u8_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_WK_THS(void *handle, u8_t newValue)
+{
+ u8_t value;
+
+ newValue = newValue << LSM6DSL_ACC_GYRO_WK_THS_POSITION; //mask
+ newValue &= LSM6DSL_ACC_GYRO_WK_THS_MASK; //coerce
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_THS, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_WK_THS_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_THS, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_WK_THS
+* Description : Read WK_THS
+* Input : Pointer to u8_t
+* Output : Status of WK_THS
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_WK_THS(void *handle, u8_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_THS, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_WK_THS_MASK; //coerce
+ *value = *value >> LSM6DSL_ACC_GYRO_WK_THS_POSITION; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_SINGLE_DOUBLE_TAP_EV
+* Description : Write SINGLE_DOUBLE_TAP
+* Input : LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_SINGLE_DOUBLE_TAP_EV(void *handle, LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_THS, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_THS, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_SINGLE_DOUBLE_TAP_EV
+* Description : Read SINGLE_DOUBLE_TAP
+* Input : Pointer to LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_t
+* Output : Status of SINGLE_DOUBLE_TAP see LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_SINGLE_DOUBLE_TAP_EV(void *handle, LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_THS, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_SLEEP_DUR
+* Description : Write SLEEP_DUR
+* Input : u8_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_SLEEP_DUR(void *handle, u8_t newValue)
+{
+ u8_t value;
+
+ newValue = newValue << LSM6DSL_ACC_GYRO_SLEEP_DUR_POSITION; //mask
+ newValue &= LSM6DSL_ACC_GYRO_SLEEP_DUR_MASK; //coerce
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_SLEEP_DUR_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_SLEEP_DUR
+* Description : Read SLEEP_DUR
+* Input : Pointer to u8_t
+* Output : Status of SLEEP_DUR
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_SLEEP_DUR(void *handle, u8_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_SLEEP_DUR_MASK; //coerce
+ *value = *value >> LSM6DSL_ACC_GYRO_SLEEP_DUR_POSITION; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_TIMER_HR
+* Description : Write TIMER_HR
+* Input : LSM6DSL_ACC_GYRO_TIMER_HR_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_TIMER_HR(void *handle, LSM6DSL_ACC_GYRO_TIMER_HR_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_TIMER_HR_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_TIMER_HR
+* Description : Read TIMER_HR
+* Input : Pointer to LSM6DSL_ACC_GYRO_TIMER_HR_t
+* Output : Status of TIMER_HR see LSM6DSL_ACC_GYRO_TIMER_HR_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_TIMER_HR(void *handle, LSM6DSL_ACC_GYRO_TIMER_HR_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_TIMER_HR_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_WAKE_DUR
+* Description : Write WAKE_DUR
+* Input : u8_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_WAKE_DUR(void *handle, u8_t newValue)
+{
+ u8_t value;
+
+ newValue = newValue << LSM6DSL_ACC_GYRO_WAKE_DUR_POSITION; //mask
+ newValue &= LSM6DSL_ACC_GYRO_WAKE_DUR_MASK; //coerce
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_WAKE_DUR_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_WAKE_DUR
+* Description : Read WAKE_DUR
+* Input : Pointer to u8_t
+* Output : Status of WAKE_DUR
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_WAKE_DUR(void *handle, u8_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_WAKE_DUR_MASK; //coerce
+ *value = *value >> LSM6DSL_ACC_GYRO_WAKE_DUR_POSITION; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_FF_THS
+* Description : Write FF_THS
+* Input : LSM6DSL_ACC_GYRO_FF_THS_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_FF_THS(void *handle, LSM6DSL_ACC_GYRO_FF_THS_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FREE_FALL, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_FF_THS_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_FREE_FALL, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_FF_THS
+* Description : Read FF_THS
+* Input : Pointer to LSM6DSL_ACC_GYRO_FF_THS_t
+* Output : Status of FF_THS see LSM6DSL_ACC_GYRO_FF_THS_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_FF_THS(void *handle, LSM6DSL_ACC_GYRO_FF_THS_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FREE_FALL, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_FF_THS_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_FF_Duration
+* Description : Write FF_DUR
+* Input : u8_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_FF_Duration(void *handle, u8_t newValue)
+{
+ u8_t valueH, valueL;
+ u8_t value;
+
+ valueL = newValue & 0x1F;
+ valueH = (newValue >> 5) & 0x1;
+
+ /* Low part in FREE_FALL reg */
+ valueL = valueL << LSM6DSL_ACC_GYRO_FF_FREE_FALL_DUR_POSITION; //mask
+ valueL &= LSM6DSL_ACC_GYRO_FF_FREE_FALL_DUR_MASK; //coerce
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FREE_FALL, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_FF_FREE_FALL_DUR_MASK;
+ value |= valueL;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_FREE_FALL, &value, 1) )
+ return MEMS_ERROR;
+
+ /* High part in WAKE_UP_DUR reg */
+ valueH = valueH << LSM6DSL_ACC_GYRO_FF_WAKE_UP_DUR_POSITION; //mask
+ valueH &= LSM6DSL_ACC_GYRO_FF_WAKE_UP_DUR_MASK; //coerce
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_FF_WAKE_UP_DUR_MASK;
+ value |= valueH;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_FF_Duration
+* Description : Read FF_DUR
+* Input : Pointer to u8_t
+* Output : Status of FF_DUR
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_FF_Duration(void *handle, u8_t *value)
+{
+ u8_t valueH, valueL;
+
+ /* Low part from FREE_FALL reg */
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FREE_FALL, (u8_t *)&valueL, 1) )
+ return MEMS_ERROR;
+
+ valueL &= LSM6DSL_ACC_GYRO_FF_FREE_FALL_DUR_MASK; //coerce
+ valueL = valueL >> LSM6DSL_ACC_GYRO_FF_FREE_FALL_DUR_POSITION; //mask
+
+ /* High part from WAKE_UP_DUR reg */
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, (u8_t *)&valueH, 1) )
+ return MEMS_ERROR;
+
+ valueH &= LSM6DSL_ACC_GYRO_FF_WAKE_UP_DUR_MASK; //coerce
+ valueH = valueH >> LSM6DSL_ACC_GYRO_FF_WAKE_UP_DUR_POSITION; //mask
+
+ *value = ((valueH << 5) & 0x20) | valueL;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_TimerEvRouteInt1
+* Description : Write INT1_TIMER
+* Input : LSM6DSL_ACC_GYRO_INT1_TIMER_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_TimerEvRouteInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_TIMER_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_INT1_TIMER_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_TimerEvRouteInt1
+* Description : Read INT1_TIMER
+* Input : Pointer to LSM6DSL_ACC_GYRO_INT1_TIMER_t
+* Output : Status of INT1_TIMER see LSM6DSL_ACC_GYRO_INT1_TIMER_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_TimerEvRouteInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_TIMER_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_INT1_TIMER_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_TiltEvOnInt1
+* Description : Write INT1_TILT
+* Input : LSM6DSL_ACC_GYRO_INT1_TILT_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_TiltEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_TILT_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_INT1_TILT_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_TiltEvOnInt1
+* Description : Read INT1_TILT
+* Input : Pointer to LSM6DSL_ACC_GYRO_INT1_TILT_t
+* Output : Status of INT1_TILT see LSM6DSL_ACC_GYRO_INT1_TILT_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_TiltEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_TILT_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_INT1_TILT_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_6DEvOnInt1
+* Description : Write INT1_6D
+* Input : LSM6DSL_ACC_GYRO_INT1_6D_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_6DEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_6D_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_INT1_6D_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_6DEvOnInt1
+* Description : Read INT1_6D
+* Input : Pointer to LSM6DSL_ACC_GYRO_INT1_6D_t
+* Output : Status of INT1_6D see LSM6DSL_ACC_GYRO_INT1_6D_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_6DEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_6D_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_INT1_6D_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_TapEvOnInt1
+* Description : Write INT1_TAP
+* Input : LSM6DSL_ACC_GYRO_INT1_TAP_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_TapEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_TAP_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_INT1_TAP_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_TapEvOnInt1
+* Description : Read INT1_TAP
+* Input : Pointer to LSM6DSL_ACC_GYRO_INT1_TAP_t
+* Output : Status of INT1_TAP see LSM6DSL_ACC_GYRO_INT1_TAP_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_TapEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_TAP_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_INT1_TAP_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_FFEvOnInt1
+* Description : Write INT1_FF
+* Input : LSM6DSL_ACC_GYRO_INT1_FF_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_FFEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_FF_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_INT1_FF_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_FFEvOnInt1
+* Description : Read INT1_FF
+* Input : Pointer to LSM6DSL_ACC_GYRO_INT1_FF_t
+* Output : Status of INT1_FF see LSM6DSL_ACC_GYRO_INT1_FF_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_FFEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_FF_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_INT1_FF_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_WUEvOnInt1
+* Description : Write INT1_WU
+* Input : LSM6DSL_ACC_GYRO_INT1_WU_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_WUEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_WU_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_INT1_WU_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_WUEvOnInt1
+* Description : Read INT1_WU
+* Input : Pointer to LSM6DSL_ACC_GYRO_INT1_WU_t
+* Output : Status of INT1_WU see LSM6DSL_ACC_GYRO_INT1_WU_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_WUEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_WU_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_INT1_WU_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_SingleTapOnInt1
+* Description : Write INT1_SINGLE_TAP
+* Input : LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_SingleTapOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_SingleTapOnInt1
+* Description : Read INT1_SINGLE_TAP
+* Input : Pointer to LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_t
+* Output : Status of INT1_SINGLE_TAP see LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_SingleTapOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_SleepEvOnInt1
+* Description : Write INT1_SLEEP
+* Input : LSM6DSL_ACC_GYRO_INT1_SLEEP_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_SleepEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_SLEEP_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_INT1_SLEEP_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_SleepEvOnInt1
+* Description : Read INT1_SLEEP
+* Input : Pointer to LSM6DSL_ACC_GYRO_INT1_SLEEP_t
+* Output : Status of INT1_SLEEP see LSM6DSL_ACC_GYRO_INT1_SLEEP_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_SleepEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_SLEEP_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_INT1_SLEEP_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_MagCorrection_Int2
+* Description : Write INT2_IRON
+* Input : LSM6DSL_ACC_GYRO_INT2_IRON_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_MagCorrection_Int2(void *handle, LSM6DSL_ACC_GYRO_INT2_IRON_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_INT2_IRON_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_MagCorrection_Int2
+* Description : Read INT2_IRON
+* Input : Pointer to LSM6DSL_ACC_GYRO_INT2_IRON_t
+* Output : Status of INT2_IRON see LSM6DSL_ACC_GYRO_INT2_IRON_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_MagCorrection_Int2(void *handle, LSM6DSL_ACC_GYRO_INT2_IRON_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_INT2_IRON_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_TiltEvOnInt2
+* Description : Write INT2_TILT
+* Input : LSM6DSL_ACC_GYRO_INT2_TILT_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_TiltEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_TILT_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_INT2_TILT_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_TiltEvOnInt2
+* Description : Read INT2_TILT
+* Input : Pointer to LSM6DSL_ACC_GYRO_INT2_TILT_t
+* Output : Status of INT2_TILT see LSM6DSL_ACC_GYRO_INT2_TILT_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_TiltEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_TILT_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_INT2_TILT_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_6DEvOnInt2
+* Description : Write INT2_6D
+* Input : LSM6DSL_ACC_GYRO_INT2_6D_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_6DEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_6D_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_INT2_6D_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_6DEvOnInt2
+* Description : Read INT2_6D
+* Input : Pointer to LSM6DSL_ACC_GYRO_INT2_6D_t
+* Output : Status of INT2_6D see LSM6DSL_ACC_GYRO_INT2_6D_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_6DEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_6D_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_INT2_6D_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_TapEvOnInt2
+* Description : Write INT2_TAP
+* Input : LSM6DSL_ACC_GYRO_INT2_TAP_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_TapEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_TAP_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_INT2_TAP_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_TapEvOnInt2
+* Description : Read INT2_TAP
+* Input : Pointer to LSM6DSL_ACC_GYRO_INT2_TAP_t
+* Output : Status of INT2_TAP see LSM6DSL_ACC_GYRO_INT2_TAP_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_TapEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_TAP_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_INT2_TAP_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_FFEvOnInt2
+* Description : Write INT2_FF
+* Input : LSM6DSL_ACC_GYRO_INT2_FF_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_FFEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_FF_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_INT2_FF_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_FFEvOnInt2
+* Description : Read INT2_FF
+* Input : Pointer to LSM6DSL_ACC_GYRO_INT2_FF_t
+* Output : Status of INT2_FF see LSM6DSL_ACC_GYRO_INT2_FF_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_FFEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_FF_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_INT2_FF_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_WUEvOnInt2
+* Description : Write INT2_WU
+* Input : LSM6DSL_ACC_GYRO_INT2_WU_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_WUEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_WU_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_INT2_WU_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_WUEvOnInt2
+* Description : Read INT2_WU
+* Input : Pointer to LSM6DSL_ACC_GYRO_INT2_WU_t
+* Output : Status of INT2_WU see LSM6DSL_ACC_GYRO_INT2_WU_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_WUEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_WU_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_INT2_WU_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_SingleTapOnInt2
+* Description : Write INT2_SINGLE_TAP
+* Input : LSM6DSL_ACC_GYRO_INT2_SINGLE_TAP_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_SingleTapOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_SINGLE_TAP_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_INT2_SINGLE_TAP_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_SingleTapOnInt2
+* Description : Read INT2_SINGLE_TAP
+* Input : Pointer to LSM6DSL_ACC_GYRO_INT2_SINGLE_TAP_t
+* Output : Status of INT2_SINGLE_TAP see LSM6DSL_ACC_GYRO_INT2_SINGLE_TAP_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_SingleTapOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_SINGLE_TAP_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_INT2_SINGLE_TAP_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_SleepEvOnInt2
+* Description : Write INT2_SLEEP
+* Input : LSM6DSL_ACC_GYRO_INT2_SLEEP_t
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_SleepEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_SLEEP_t newValue)
+{
+ u8_t value;
+
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
+ return MEMS_ERROR;
+
+ value &= ~LSM6DSL_ACC_GYRO_INT2_SLEEP_MASK;
+ value |= newValue;
+
+ if( !LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
+ return MEMS_ERROR;
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_R_SleepEvOnInt2
+* Description : Read INT2_SLEEP
+* Input : Pointer to LSM6DSL_ACC_GYRO_INT2_SLEEP_t
+* Output : Status of INT2_SLEEP see LSM6DSL_ACC_GYRO_INT2_SLEEP_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_R_SleepEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_SLEEP_t *value)
+{
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
+ return MEMS_ERROR;
+
+ *value &= LSM6DSL_ACC_GYRO_INT2_SLEEP_MASK; //mask
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : mems_status_t LSM6DSL_ACC_GYRO_Get_GetFIFOData(u8_t *buff)
+* Description : Read GetFIFOData output register
+* Input : pointer to [u8_t]
+* Output : GetFIFOData buffer u8_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_Get_GetFIFOData(void *handle, u8_t *buff)
+{
+ u8_t i, j, k;
+ u8_t numberOfByteForDimension;
+
+ numberOfByteForDimension=2/1;
+
+ k=0;
+ for (i=0; i<1;i++ )
+ {
+ for (j=0; j<numberOfByteForDimension;j++ )
+ {
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_FIFO_DATA_OUT_L+k, &buff[k], 1))
+ return MEMS_ERROR;
+ k++;
+ }
+ }
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : mems_status_t LSM6DSL_ACC_GYRO_Get_GetTimestamp(u8_t *buff)
+* Description : Read GetTimestamp output register
+* Input : pointer to [u8_t]
+* Output : GetTimestamp buffer u8_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_Get_GetTimestamp(void *handle, u8_t *buff)
+{
+ u8_t i, j, k;
+ u8_t numberOfByteForDimension;
+
+ numberOfByteForDimension=3/1;
+
+ k=0;
+ for (i=0; i<1;i++ )
+ {
+ for (j=0; j<numberOfByteForDimension;j++ )
+ {
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_TIMESTAMP0_REG+k, &buff[k], 1))
+ return MEMS_ERROR;
+ k++;
+ }
+ }
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : mems_status_t LSM6DSL_ACC_GYRO_Get_GetStepCounter(u8_t *buff)
+* Description : Read GetStepCounter output register
+* Input : pointer to [u8_t]
+* Output : GetStepCounter buffer u8_t
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_Get_GetStepCounter(void *handle, u8_t *buff)
+{
+ u8_t i, j, k;
+ u8_t numberOfByteForDimension;
+
+ numberOfByteForDimension=2/1;
+
+ k=0;
+ for (i=0; i<1;i++ )
+ {
+ for (j=0; j<numberOfByteForDimension;j++ )
+ {
+ if( !LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_STEP_COUNTER_L+k, &buff[k], 1))
+ return MEMS_ERROR;
+ k++;
+ }
+ }
+
+ return MEMS_SUCCESS;
+}
+
+/*******************************************************************************
+* Function Name : LSM6DSL_ACC_GYRO_W_PedoThreshold(void *handle, u8_t newValue)
+* Description : Set accelerometer threshold for pedometer
+* Input : pointer to [u8_t]
+* Output : None
+* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
+*******************************************************************************/
+mems_status_t LSM6DSL_ACC_GYRO_W_PedoThreshold(void *handle, u8_t newValue)
+{
+ u8_t value;
+
+ /* Open Embedded Function Register page*/
+ LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_ENABLED);
+
+ /* read current value */
+ LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_CONFIG_PEDO_THS_MIN, &value, 1);
+
+ value &= ~0x1F;
+ value |= (newValue & 0x1F);
+
+ /* write new value */
+ LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_CONFIG_PEDO_THS_MIN, &value, 1);
+
+ /* Close Embedded Function Register page*/
+ LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_DISABLED);
+
+ return MEMS_SUCCESS;
+}
+
+/************** Use Sensor Hub *******************/
+/*
+ * Program the nine Soft Iron Matrix coefficients.
+ * The SI_Matrix buffer must provide coefficients
+ * in xx, xy, xz, yx, yy, yz, zx, zy, zz order.
+ */
+mems_status_t LSM6DSL_ACC_GYRO_SH_init_SI_Matrix(void *handle, u8_t *SI_matrix)
+{
+ /* Open Embedded Function Register page*/
+ LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_ENABLED);
+
+ /* Write the Soft Iron Matrix coefficients */
+ LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_MAG_SI_XX, SI_matrix, 9);
+
+ /* Close Embedded Function Register page*/
+ LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_DISABLED);
+
+ return MEMS_SUCCESS;
+}
+
+/* Read a remote device through I2C Sensor Hub Slave 0 */
+mems_status_t LSM6DSL_ACC_GYRO_SH0_Program(void *handle, u8_t SlvAddr, u8_t Reg, u8_t len)
+{
+ /* Open Embedded Function Register page*/
+ LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_ENABLED);
+
+ /* Write remote device I2C slave address */
+ SlvAddr |= 0x1; /* Raise the read op bit */
+ LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_SLV0_ADD, &SlvAddr, 1);
+
+ /* Write remote device I2C subaddress */
+ LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_SLV0_SUBADD, &Reg, 1);
+
+ /* Write number of bytes to read [SLAVE0_CONFIG - 04h ]*/
+ u8_t sl0_cfg = 0;
+ sl0_cfg |= 0x00; //00 bit [7-6] : no decimation
+ sl0_cfg |= 0x00; //00 bit [5-4] : one sensor
+ sl0_cfg |= 0x00; // 0 bit [3] : source mode read disabled
+ sl0_cfg |= len & 0x07; // bit [2-0] : number of bytes
+
+ LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_SLAVE0_CONFIG, &sl0_cfg, 1);
+
+ /* Close Embedded Function Register page*/
+ LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_DISABLED);
+
+ /* Enable FUNC */
+ LSM6DSL_ACC_GYRO_W_FUNC_EN(handle, LSM6DSL_ACC_GYRO_FUNC_EN_ENABLED);
+
+ /* MASTER_EN */
+ LSM6DSL_ACC_GYRO_W_I2C_MASTER_Enable(handle, LSM6DSL_ACC_GYRO_MASTER_ON_ENABLED);
+
+ return MEMS_SUCCESS;
+}
+
+/* Read a remote device through I2C Sensor Hub Slave 0 */
+mems_status_t LSM6DSL_ACC_GYRO_SH0_ReadMem(void *handle, u8_t SlvAddr, u8_t Reg, u8_t *Bufp, u8_t len, u8_t stop)
+{
+ LSM6DSL_ACC_GYRO_SENS_HUB_END_t op_cmpl = LSM6DSL_ACC_GYRO_SENS_HUB_END_STILL_ONGOING;
+ LSM6DSL_ACC_GYRO_XLDA_t op_update = LSM6DSL_ACC_GYRO_XLDA_NO_DATA_AVAIL;
+ u8_t dummy[6];
+
+ LSM6DSL_ACC_GYRO_W_ODR_XL(handle, LSM6DSL_ACC_GYRO_ODR_XL_POWER_DOWN);
+
+ LSM6DSL_ACC_GYRO_SH0_Program(handle, SlvAddr, Reg, len);
+
+ /* Syncronize the SH with internal trigger (xl) */
+ LSM6DSL_ACC_GYRO_W_ODR_XL(handle, LSM6DSL_ACC_GYRO_ODR_XL_104Hz);
+
+ /* Wait until operation is not completed */
+ LSM6DSL_ACC_GYRO_GetRawAccData(handle, dummy);
+ do {
+ LSM6DSL_ACC_GYRO_R_XLDA(handle, &op_update);
+ } while(op_update != LSM6DSL_ACC_GYRO_XLDA_DATA_AVAIL);
+ do {
+ LSM6DSL_ACC_GYRO_R_SENS_HUB_END(handle, &op_cmpl);
+ } while(op_cmpl != LSM6DSL_ACC_GYRO_SENS_HUB_END_OP_COMPLETED);
+
+
+ /* Read the result */
+ LSM6DSL_ACC_GYRO_read_reg(handle, LSM6DSL_ACC_GYRO_SENSORHUB1_REG, Bufp, len);
+
+ LSM6DSL_ACC_GYRO_W_ODR_XL(handle, LSM6DSL_ACC_GYRO_ODR_XL_POWER_DOWN);
+
+ if (stop) {
+ /* Stop everything */
+ LSM6DSL_ACC_GYRO_W_FUNC_EN(handle, LSM6DSL_ACC_GYRO_FUNC_EN_DISABLED);
+ LSM6DSL_ACC_GYRO_W_I2C_MASTER_Enable(handle, LSM6DSL_ACC_GYRO_MASTER_ON_DISABLED);
+ }
+
+ return MEMS_SUCCESS;
+}
+
+/* Write a remote device through I2C Sensor Hub Slave 0 */
+mems_status_t LSM6DSL_ACC_GYRO_SH0_WriteByte(void *handle, u8_t SlvAddr, u8_t Reg, u8_t Bufp)
+{
+ LSM6DSL_ACC_GYRO_SENS_HUB_END_t op_cmpl = LSM6DSL_ACC_GYRO_SENS_HUB_END_STILL_ONGOING;
+ LSM6DSL_ACC_GYRO_XLDA_t op_update = LSM6DSL_ACC_GYRO_XLDA_NO_DATA_AVAIL;
+ u8_t dummy[6];
+
+ /* Open Embedded Function Register page*/
+ LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_ENABLED);
+
+ /* Write remote device I2C slave address */
+ LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_SLV0_ADD, &SlvAddr, 1);
+
+ /* Write remote device I2C subaddress */
+ LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_SLV0_SUBADD, &Reg, 1);
+
+ /* Write the data */
+ LSM6DSL_ACC_GYRO_write_reg(handle, LSM6DSL_ACC_GYRO_DATAWRITE_SRC_MODE_SUB_SLV0, &Bufp, 1);
+
+ /* Close Embedded Function Register page*/
+ LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_DISABLED);
+
+ /* Enable FUNC */
+ LSM6DSL_ACC_GYRO_W_FUNC_EN(handle, LSM6DSL_ACC_GYRO_FUNC_EN_ENABLED);
+
+ /* Enable PULL_UP_EN and MASTER_EN */
+ //LSM6DSL_ACC_GYRO_W_PULL_UP_EN(handle, LSM6DSL_ACC_GYRO_PULL_UP_EN_ENABLED);
+ LSM6DSL_ACC_GYRO_W_I2C_MASTER_Enable(handle, LSM6DSL_ACC_GYRO_MASTER_ON_ENABLED);
+
+ /* Syncronize the SH with internal trigger (xl) */
+ LSM6DSL_ACC_GYRO_W_ODR_XL(handle, LSM6DSL_ACC_GYRO_ODR_XL_104Hz);
+
+ /* Wait until operation is not completed */
+ LSM6DSL_ACC_GYRO_GetRawAccData(handle, dummy);
+ do {
+ LSM6DSL_ACC_GYRO_R_XLDA(handle, &op_update);
+ } while(op_update != LSM6DSL_ACC_GYRO_XLDA_DATA_AVAIL);
+ do {
+ LSM6DSL_ACC_GYRO_R_SENS_HUB_END(handle, &op_cmpl);
+ } while(op_cmpl != LSM6DSL_ACC_GYRO_SENS_HUB_END_OP_COMPLETED);
+
+ LSM6DSL_ACC_GYRO_W_ODR_XL(handle, LSM6DSL_ACC_GYRO_ODR_XL_POWER_DOWN);
+
+ /* Stop everything */
+ LSM6DSL_ACC_GYRO_W_FUNC_EN(handle, LSM6DSL_ACC_GYRO_FUNC_EN_DISABLED);
+ LSM6DSL_ACC_GYRO_W_I2C_MASTER_Enable(handle, LSM6DSL_ACC_GYRO_MASTER_ON_DISABLED);
+
+
+ return MEMS_SUCCESS;
+}