LSM6DSM设置WAKE_UP_SRC寄存器不成功

xieyj · 发表于2017-12-21 17:11

LSM6DSM设置WAKE_UP_SRC寄存器不成功 [复制链接]

大家好再次来求助论坛了
这次想要用WAKE_UP功能输出中断，设置WAKE_UP_SRC寄存器，发现不成功读出的值一直是0
设置其他寄存器都OK，想请教下设置这个寄存器有特殊的流程吗？比如设置这个寄存器必须先设置另一个寄存器之类的
设置MD2_CFG和WAKE_UP_DUR这两个寄存器都是成功的。感谢啊！
lsm6dsl_write_reg(&lsm6dsl_ctx, LSM6DSL_MD2_CFG, &num4, 1);
lsm6dsl_read_reg(&lsm6dsl_ctx, LSM6DSL_MD2_CFG, &buffer, 1);
LOG_I(LSM6,"Read LSM6DSL_MD2_CFG:%d\r\n",buffer); /* set wakeup interrupt  */

lsm6dsl_write_reg(&lsm6dsl_ctx, LSM6DSL_WAKE_UP_DUR, &num5, 1);
lsm6dsl_read_reg(&lsm6dsl_ctx, LSM6DSL_WAKE_UP_DUR, &buffer, 1);
LOG_I(LSM6,"Read LSM6DSL_WAKE_UP_DUR:%d\r\n",buffer); /* set wakeup interrupt DUR  */

lsm6dsl_write_reg(&lsm6dsl_ctx, LSM6DSL_WAKE_UP_SRC, &num6, 1);
lsm6dsl_read_reg(&lsm6dsl_ctx, LSM6DSL_WAKE_UP_SRC, &buffer, 1);
LOG_I(LSM6,"Read LSM6DSL_WAKE_UP_SRC:%d\r\n",buffer); /* set wakeup event interrupt  */

littleshrimp · 发表于2017-12-21 17:24

num6的数值是多少，我帮你试一下

xieyj · 发表于2017-12-21 17:26

littleshrimp 发表于 2017-12-21 17:24
num6的数值是多少，我帮你试一下

num6的值是15

littleshrimp · 发表于2017-12-21 17:27

WAKE_UP_SRC是只读寄存器，不能写入

xieyj · 发表于2017-12-21 17:34

littleshrimp 发表于 2017-12-21 17:27
WAKE_UP_SRC是只读寄存器，不能写入

明白，那我要用到WAKE_UP这个功能，将传感器网上抬希望INT2有中断输出，是不是设置MD2_CFG为00100000就是INT2_WU这个位吗

xieyj · 发表于2017-12-21 17:48

我设置了MD2_CFG这个寄存器，开启wakeup中断使能，但是示波器就输出不了中断，而且读这个WAKE_UP_SRC也一直是0。

littleshrimp · 发表于2017-12-21 18:14

xieyj 发表于 2017-12-21 17:48
我设置了MD2_CFG这个寄存器，开启wakeup中断使能，但是示波器就输出不了中断，而且读这个WAKE_UP_SRC也一直 ...

试试官方的驱动库

lsm6dsm.rar (33.58 KB, 下载次数: 9)

* File Name : LSM6DSM_ACC_GYRO_driver.c
* Author : MSH Application Team
* Version : v1.3
* Date : 17 Nov 2015
* Description : LSM6DSM ACC_GYRO driver source file
*
* Reviewed by: MSH Application Team
*-------------------------------------------------------------------------------
*
*
********************************************************************************
* THE PRESENT FIRMWARE WHICH IS FOR GUIDANCE ONLY AIMS AT PROVIDING CUSTOMERS
* WITH CODING INFORMATION REGARDING THEIR PRODUCTS IN ORDER FOR THEM TO SAVE TIME.
* AS A RESULT, STMICROELECTRONICS SHALL NOT BE HELD LIABLE FOR ANY DIRECT,
* INDIRECT OR CONSEQUENTIAL DAMAGES WITH RESPECT TO ANY CLAIMS ARISING FROM THE
* CONTENT OF SUCH FIRMWARE AND/OR THE USE MADE BY CUSTOMERS OF THE CODING
* INFORMATION CONTAINED HEREIN IN CONNECTION WITH THEIR PRODUCTS.
*
* THIS SOFTWARE IS SPECIFICALLY DESIGNED FOR EXCLUSIVE USE WITH ST PARTS.
*
*******************************************************************************/
/* Includes ------------------------------------------------------------------*/
#include "LSM6DSM_ACC_GYRO_driver.h"
/* Imported function prototypes ----------------------------------------------*/
extern uint8_t Sensor_IO_Write(void *handle, uint8_t WriteAddr, uint8_t *pBuffer, uint16_t nBytesToWrite);
extern uint8_t Sensor_IO_Read(void *handle, uint8_t ReadAddr, uint8_t *pBuffer, uint16_t nBytesToRead);
/* Private typedef -----------------------------------------------------------*/
/* Private define ------------------------------------------------------------*/
/* Private macro -------------------------------------------------------------*/
/* Private variables ---------------------------------------------------------*/
/* Private functions ---------------------------------------------------------*/
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_ReadReg
* Description : Generic Reading function. It must be fullfilled with either
* : I2C or SPI reading functions
* Input : Register Address
* Output : Data REad
* Return : None
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_ReadReg(void *handle, u8_t Reg, u8_t* Data)
{
if (Sensor_IO_Read(handle, Reg, Data, 1))
{
return MEMS_ERROR;
}
else
{
return MEMS_SUCCESS;
}
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_WriteReg
* Description : Generic Writing function. It must be fullfilled with either
* : I2C or SPI writing function
* Input : Register Address, Data to be written
* Output : None
* Return : None
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_WriteReg(void *handle, u8_t Reg, u8_t Data)
{
if (Sensor_IO_Write(handle, Reg, &Data, 1))
{
return MEMS_ERROR;
}
else
{
return MEMS_SUCCESS;
}
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_WriteMem
* Description : Generic Writing function. It must be fullfilled with either
* : I2C or SPI writing function
* Input : Register Address, ptr to buffer to be written,
* length of buffer
* Output : None
* Return : None
*******************************************************************************/
u8_t LSM6DSM_ACC_GYRO_WriteMem(void *handle, u8_t Reg, u8_t *Bufp, u16_t len)
{
if (Sensor_IO_Write(handle, Reg, Bufp, len))
{
return MEMS_ERROR;
}
else
{
return MEMS_SUCCESS;
}
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_ReadMem
* Description : Generic Reading function. It must be fullfilled with either
* : I2C or SPI writing function
* Input : Register Address, ptr to buffer to be read,
* length of buffer
* Output : None
* Return : None
*******************************************************************************/
u8_t LSM6DSM_ACC_GYRO_ReadMem(void *handle, u8_t Reg, u8_t *Bufp, u16_t len)
{
if (Sensor_IO_Read(handle, Reg, Bufp, len))
{
return MEMS_ERROR;
}
else
{
return MEMS_SUCCESS;
}
}
/*******************************************************************************
* Function Name : SwapHighLowByte
* Description : Swap High/low byte in multiple byte values
* It works with minimum 2 byte for every dimension.
* Example x,y,z with 2 byte for every dimension
*
* Input : bufferToSwap -> buffer to swap
* numberOfByte -> the buffer length in byte
* dimension -> number of dimension
*
* Output : bufferToSwap -> buffer swapped
* Return : None
*******************************************************************************/
void LSM6DSM_ACC_GYRO_SwapHighLowByte(u8_t *bufferToSwap, u8_t numberOfByte, u8_t dimension)
{
u8_t numberOfByteForDimension, i, j;
u8_t tempValue[10];
numberOfByteForDimension=numberOfByte/dimension;
for (i=0; i<dimension;i++ )
{
for (j=0; j<numberOfByteForDimension;j++ )
tempValue[j]=bufferToSwap[j+i*numberOfByteForDimension];
for (j=0; j<numberOfByteForDimension;j++ )
*(bufferToSwap+i*(numberOfByteForDimension)+j)=*(tempValue+(numberOfByteForDimension-1)-j);
}
}
/* Exported functions ---------------------------------------------------------*/
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_EmbeddedAccess
* Description : Write RAM_PAGE
* Input : LSM6DSM_ACC_GYRO_EMB_ACC_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_EmbeddedAccess(void *handle, LSM6DSM_ACC_GYRO_EMB_ACC_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FUNC_CFG_ACCESS, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_EMB_ACC_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_FUNC_CFG_ACCESS, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_EmbeddedAccess
* Description : Read RAM_PAGE
* Input : Pointer to LSM6DSM_ACC_GYRO_EMB_ACC_t
* Output : Status of RAM_PAGE see LSM6DSM_ACC_GYRO_EMB_ACC_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_EmbeddedAccess(void *handle, LSM6DSM_ACC_GYRO_EMB_ACC_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FUNC_CFG_ACCESS, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_EMB_ACC_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_SYNC_RES_RATIO
* Description : Write RR
* Input : LSM6DSM_ACC_GYRO_SYNC_RES_RATIO_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_SYNC_RES_RATIO(void *handle, LSM6DSM_ACC_GYRO_SYNC_RES_RATIO_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_SENSOR_RES_RATIO, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_SYNC_RES_RATIO_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_SENSOR_RES_RATIO, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_SYNC_RES_RATIO
* Description : Read RR
* Input : Pointer to LSM6DSM_ACC_GYRO_SYNC_RES_RATIO_t
* Output : Status of RR see LSM6DSM_ACC_GYRO_SYNC_RES_RATIO_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_SYNC_RES_RATIO(void *handle, LSM6DSM_ACC_GYRO_SYNC_RES_RATIO_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_SENSOR_RES_RATIO, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_SYNC_RES_RATIO_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_Stamping_Time_Frame
* Description : Write TPH
* Input : u8_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_Stamping_Time_Frame(void *handle, u8_t newValue)
{
u8_t value;
newValue = newValue << LSM6DSM_ACC_GYRO_TPH_POSITION; //mask
newValue &= LSM6DSM_ACC_GYRO_TPH_MASK; //coerce
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_SENSOR_SYNC_TIME, &value) )
return MEMS_ERROR;
value &= (u8_t)(~LSM6DSM_ACC_GYRO_TPH_MASK);
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_SENSOR_SYNC_TIME, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_Stamping_Time_Frame
* Description : Read TPH
* Input : Pointer to u8_t
* Output : Status of TPH
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_Stamping_Time_Frame(void *handle, u8_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_SENSOR_SYNC_TIME, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_TPH_MASK; //coerce
*value = *value >> LSM6DSM_ACC_GYRO_TPH_POSITION; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_FIFO_Watermark
* Description : Write WTM_FIFO
* Input : u16_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_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 << LSM6DSM_ACC_GYRO_WTM_FIFO_CTRL1_POSITION; //mask
valueL &= LSM6DSM_ACC_GYRO_WTM_FIFO_CTRL1_MASK; //coerce
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL1, &value) )
return MEMS_ERROR;
value &= (u8_t)(~LSM6DSM_ACC_GYRO_WTM_FIFO_CTRL1_MASK);
value |= valueL;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL1, value) )
return MEMS_ERROR;
/* High part goes in FIFO_CTRL2 */
valueH = valueH << LSM6DSM_ACC_GYRO_WTM_FIFO_CTRL2_POSITION; //mask
valueH &= LSM6DSM_ACC_GYRO_WTM_FIFO_CTRL2_MASK; //coerce
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL2, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_WTM_FIFO_CTRL2_MASK;
value |= valueH;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL2, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_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]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_FIFO_Watermark(void *handle, u16_t *value)
{
u8_t valueH, valueL;
/* Low part from FIFO_CTRL1 */
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL1, (u8_t *)&valueL) )
return MEMS_ERROR;
valueL &= LSM6DSM_ACC_GYRO_WTM_FIFO_CTRL1_MASK; //coerce
valueL = valueL >> LSM6DSM_ACC_GYRO_WTM_FIFO_CTRL1_POSITION; //mask
/* High part from FIFO_CTRL2 */
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL2, (u8_t *)&valueH) )
return MEMS_ERROR;
valueH &= LSM6DSM_ACC_GYRO_WTM_FIFO_CTRL2_MASK; //coerce
valueH = valueH >> LSM6DSM_ACC_GYRO_WTM_FIFO_CTRL2_POSITION; //mask
*value = ((valueH << 8) & 0xFF00) | valueL;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_FIFO_TEMP
* Description : Write FIFO_TEMP_EN
* Input : LSM6DSM_ACC_GYRO_FIFO_TEMP_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_FIFO_TEMP(void *handle, LSM6DSM_ACC_GYRO_FIFO_TEMP_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL2, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_FIFO_TEMP_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL2, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_FIFO_TEMP
* Description : Read FIFO_TEMP_EN
* Input : Pointer to LSM6DSM_ACC_GYRO_FIFO_TEMP_t
* Output : Status of FIFO_TEMP_EN see LSM6DSM_ACC_GYRO_FIFO_TEMP_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_FIFO_TEMP(void *handle, LSM6DSM_ACC_GYRO_FIFO_TEMP_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL2, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_FIFO_TEMP_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_TIM_PEDO_FIFO_Write_En
* Description : Write TIM_PEDO_FIFO_DRDY
* Input : LSM6DSM_ACC_GYRO_TIM_PEDO_FIFO_DRDY_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_TIM_PEDO_FIFO_Write_En(void *handle, LSM6DSM_ACC_GYRO_TIM_PEDO_FIFO_DRDY_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL2, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_TIM_PEDO_FIFO_DRDY_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL2, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_TIM_PEDO_FIFO_Write_En
* Description : Read TIM_PEDO_FIFO_DRDY
* Input : Pointer to LSM6DSM_ACC_GYRO_TIM_PEDO_FIFO_DRDY_t
* Output : Status of TIM_PEDO_FIFO_DRDY see LSM6DSM_ACC_GYRO_TIM_PEDO_FIFO_DRDY_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_TIM_PEDO_FIFO_Write_En(void *handle, LSM6DSM_ACC_GYRO_TIM_PEDO_FIFO_DRDY_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL2, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_TIM_PEDO_FIFO_DRDY_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_TIM_PEDO_FIFO_En
* Description : Write TIM_PEDO_FIFO_EN
* Input : LSM6DSM_ACC_GYRO_TIM_PEDO_FIFO_EN_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_TIM_PEDO_FIFO_En(void *handle, LSM6DSM_ACC_GYRO_TIM_PEDO_FIFO_EN_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL2, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_TIM_PEDO_FIFO_EN_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL2, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_TIM_PEDO_FIFO_En
* Description : Read TIM_PEDO_FIFO_EN
* Input : Pointer to LSM6DSM_ACC_GYRO_TIM_PEDO_FIFO_EN_t
* Output : Status of TIM_PEDO_FIFO_EN see LSM6DSM_ACC_GYRO_TIM_PEDO_FIFO_EN_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_TIM_PEDO_FIFO_En(void *handle, LSM6DSM_ACC_GYRO_TIM_PEDO_FIFO_EN_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL2, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_TIM_PEDO_FIFO_EN_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_DEC_FIFO_XL
* Description : Write DEC_FIFO_XL
* Input : LSM6DSM_ACC_GYRO_DEC_FIFO_XL_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_DEC_FIFO_XL(void *handle, LSM6DSM_ACC_GYRO_DEC_FIFO_XL_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL3, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_DEC_FIFO_XL_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL3, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/* Program XL decimation value from unsigned short */
status_t LSM6DSM_ACC_GYRO_W_DEC_FIFO_XL_val(void *handle, u16_t newValue)
{
switch(newValue) {
case 0:
LSM6DSM_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSM_ACC_GYRO_DEC_FIFO_XL_DATA_NOT_IN_FIFO);
break;
case 1:
LSM6DSM_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSM_ACC_GYRO_DEC_FIFO_XL_NO_DECIMATION);
break;
case 2:
LSM6DSM_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSM_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_2);
break;
case 3:
LSM6DSM_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSM_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_3);
break;
case 4:
LSM6DSM_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSM_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_4);
break;
case 8:
LSM6DSM_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSM_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_8);
break;
case 16:
LSM6DSM_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSM_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_16);
break;
case 32:
LSM6DSM_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSM_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_32);
break;
default:
return MEMS_ERROR;
}
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_DEC_FIFO_XL
* Description : Read DEC_FIFO_XL
* Input : Pointer to LSM6DSM_ACC_GYRO_DEC_FIFO_XL_t
* Output : Status of DEC_FIFO_XL see LSM6DSM_ACC_GYRO_DEC_FIFO_XL_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_DEC_FIFO_XL(void *handle, LSM6DSM_ACC_GYRO_DEC_FIFO_XL_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL3, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_DEC_FIFO_XL_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_DEC_FIFO_G
* Description : Write DEC_FIFO_G
* Input : LSM6DSM_ACC_GYRO_DEC_FIFO_G_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_DEC_FIFO_G(void *handle, LSM6DSM_ACC_GYRO_DEC_FIFO_G_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL3, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_DEC_FIFO_G_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL3, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/* Program G decimation value from unsigned short */
status_t LSM6DSM_ACC_GYRO_W_DEC_FIFO_G_val(void *handle, u16_t newValue)
{
switch(newValue) {
case 0:
LSM6DSM_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSM_ACC_GYRO_DEC_FIFO_G_DATA_NOT_IN_FIFO);
break;
case 1:
LSM6DSM_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSM_ACC_GYRO_DEC_FIFO_G_NO_DECIMATION);
break;
case 2:
LSM6DSM_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSM_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_2);
break;
case 3:
LSM6DSM_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSM_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_3);
break;
case 4:
LSM6DSM_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSM_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_4);
break;
case 8:
LSM6DSM_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSM_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_8);
break;
case 16:
LSM6DSM_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSM_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_16);
break;
case 32:
LSM6DSM_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSM_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_32);
break;
default:
return MEMS_ERROR;
}
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_DEC_FIFO_G
* Description : Read DEC_FIFO_G
* Input : Pointer to LSM6DSM_ACC_GYRO_DEC_FIFO_G_t
* Output : Status of DEC_FIFO_G see LSM6DSM_ACC_GYRO_DEC_FIFO_G_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_DEC_FIFO_G(void *handle, LSM6DSM_ACC_GYRO_DEC_FIFO_G_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL3, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_DEC_FIFO_G_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_DEC_FIFO_DS3
* Description : Write DEC_DS3_FIFO
* Input : LSM6DSM_ACC_GYRO_DEC_FIFO_DS3_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_DEC_FIFO_DS3(void *handle, LSM6DSM_ACC_GYRO_DEC_FIFO_DS3_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL4, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_DEC_FIFO_DS3_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL4, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_DEC_FIFO_DS3
* Description : Read DEC_DS3_FIFO
* Input : Pointer to LSM6DSM_ACC_GYRO_DEC_FIFO_DS3_t
* Output : Status of DEC_DS3_FIFO see LSM6DSM_ACC_GYRO_DEC_FIFO_DS3_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_DEC_FIFO_DS3(void *handle, LSM6DSM_ACC_GYRO_DEC_FIFO_DS3_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL4, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_DEC_FIFO_DS3_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_DEC_FIFO_DS4
* Description : Write DEC_DS4_FIFO
* Input : LSM6DSM_ACC_GYRO_DEC_FIFO_DS4_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_DEC_FIFO_DS4(void *handle, LSM6DSM_ACC_GYRO_DEC_FIFO_DS4_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL4, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_DEC_FIFO_DS4_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL4, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_DEC_FIFO_DS4
* Description : Read DEC_DS4_FIFO
* Input : Pointer to LSM6DSM_ACC_GYRO_DEC_FIFO_DS4_t
* Output : Status of DEC_DS4_FIFO see LSM6DSM_ACC_GYRO_DEC_FIFO_DS4_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_DEC_FIFO_DS4(void *handle, LSM6DSM_ACC_GYRO_DEC_FIFO_DS4_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL4, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_DEC_FIFO_DS4_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_HI_DATA_ONLY
* Description : Write HI_DATA_ONLY
* Input : LSM6DSM_ACC_GYRO_HI_DATA_ONLY_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_HI_DATA_ONLY(void *handle, LSM6DSM_ACC_GYRO_HI_DATA_ONLY_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL4, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_HI_DATA_ONLY_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL4, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_HI_DATA_ONLY
* Description : Read HI_DATA_ONLY
* Input : Pointer to LSM6DSM_ACC_GYRO_HI_DATA_ONLY_t
* Output : Status of HI_DATA_ONLY see LSM6DSM_ACC_GYRO_HI_DATA_ONLY_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_HI_DATA_ONLY(void *handle, LSM6DSM_ACC_GYRO_HI_DATA_ONLY_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL4, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_HI_DATA_ONLY_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_STOP_ON_FTH
* Description : Write STOP_ON_FTH
* Input : LSM6DSM_ACC_GYRO_STOP_ON_FTH_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_STOP_ON_FTH(void *handle, LSM6DSM_ACC_GYRO_STOP_ON_FTH_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL4, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_STOP_ON_FTH_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL4, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_STOP_ON_FTH
* Description : Read STOP_ON_FTH
* Input : Pointer to LSM6DSM_ACC_GYRO_STOP_ON_FTH_t
* Output : Status of STOP_ON_FTH see LSM6DSM_ACC_GYRO_STOP_ON_FTH_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_STOP_ON_FTH(void *handle, LSM6DSM_ACC_GYRO_STOP_ON_FTH_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL4, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_STOP_ON_FTH_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_FIFO_MODE
* Description : Write FIFO_MODE
* Input : LSM6DSM_ACC_GYRO_FIFO_MODE_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_FIFO_MODE(void *handle, LSM6DSM_ACC_GYRO_FIFO_MODE_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL5, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_FIFO_MODE_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL5, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_FIFO_MODE
* Description : Read FIFO_MODE
* Input : Pointer to LSM6DSM_ACC_GYRO_FIFO_MODE_t
* Output : Status of FIFO_MODE see LSM6DSM_ACC_GYRO_FIFO_MODE_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_FIFO_MODE(void *handle, LSM6DSM_ACC_GYRO_FIFO_MODE_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL5, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_FIFO_MODE_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_ODR_FIFO
* Description : Write ODR_FIFO
* Input : LSM6DSM_ACC_GYRO_ODR_FIFO_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_ODR_FIFO(void *handle, LSM6DSM_ACC_GYRO_ODR_FIFO_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL5, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_ODR_FIFO_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL5, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_ODR_FIFO
* Description : Read ODR_FIFO
* Input : Pointer to LSM6DSM_ACC_GYRO_ODR_FIFO_t
* Output : Status of ODR_FIFO see LSM6DSM_ACC_GYRO_ODR_FIFO_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_ODR_FIFO(void *handle, LSM6DSM_ACC_GYRO_ODR_FIFO_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FIFO_CTRL5, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_ODR_FIFO_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_DRDY_PULSE
* Description : Write DRDY_PULSE
* Input : LSM6DSM_ACC_GYRO_DRDY_PULSE_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_DRDY_PULSE(void *handle, LSM6DSM_ACC_GYRO_DRDY_PULSE_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_DRDY_PULSE_CFG_G, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_DRDY_PULSE_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_DRDY_PULSE_CFG_G, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_DRDY_PULSE
* Description : Read DRDY_PULSE
* Input : Pointer to LSM6DSM_ACC_GYRO_DRDY_PULSE_t
* Output : Status of DRDY_PULSE see LSM6DSM_ACC_GYRO_DRDY_PULSE_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_DRDY_PULSE(void *handle, LSM6DSM_ACC_GYRO_DRDY_PULSE_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_DRDY_PULSE_CFG_G, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_DRDY_PULSE_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_DRDY_XL_on_INT1
* Description : Write INT1_DRDY_XL
* Input : LSM6DSM_ACC_GYRO_INT1_DRDY_XL_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_DRDY_XL_on_INT1(void *handle, LSM6DSM_ACC_GYRO_INT1_DRDY_XL_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT1_CTRL, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_INT1_DRDY_XL_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_INT1_CTRL, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_DRDY_XL_on_INT1
* Description : Read INT1_DRDY_XL
* Input : Pointer to LSM6DSM_ACC_GYRO_INT1_DRDY_XL_t
* Output : Status of INT1_DRDY_XL see LSM6DSM_ACC_GYRO_INT1_DRDY_XL_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_DRDY_XL_on_INT1(void *handle, LSM6DSM_ACC_GYRO_INT1_DRDY_XL_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT1_CTRL, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_INT1_DRDY_XL_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_DRDY_G_on_INT1
* Description : Write INT1_DRDY_G
* Input : LSM6DSM_ACC_GYRO_INT1_DRDY_G_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_DRDY_G_on_INT1(void *handle, LSM6DSM_ACC_GYRO_INT1_DRDY_G_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT1_CTRL, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_INT1_DRDY_G_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_INT1_CTRL, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_DRDY_G_on_INT1
* Description : Read INT1_DRDY_G
* Input : Pointer to LSM6DSM_ACC_GYRO_INT1_DRDY_G_t
* Output : Status of INT1_DRDY_G see LSM6DSM_ACC_GYRO_INT1_DRDY_G_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_DRDY_G_on_INT1(void *handle, LSM6DSM_ACC_GYRO_INT1_DRDY_G_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT1_CTRL, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_INT1_DRDY_G_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_BOOT_on_INT1
* Description : Write INT1_BOOT
* Input : LSM6DSM_ACC_GYRO_INT1_BOOT_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_BOOT_on_INT1(void *handle, LSM6DSM_ACC_GYRO_INT1_BOOT_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT1_CTRL, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_INT1_BOOT_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_INT1_CTRL, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_BOOT_on_INT1
* Description : Read INT1_BOOT
* Input : Pointer to LSM6DSM_ACC_GYRO_INT1_BOOT_t
* Output : Status of INT1_BOOT see LSM6DSM_ACC_GYRO_INT1_BOOT_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_BOOT_on_INT1(void *handle, LSM6DSM_ACC_GYRO_INT1_BOOT_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT1_CTRL, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_INT1_BOOT_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_FIFO_TSHLD_on_INT1
* Description : Write INT1_FTH
* Input : LSM6DSM_ACC_GYRO_INT1_FTH_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_FIFO_TSHLD_on_INT1(void *handle, LSM6DSM_ACC_GYRO_INT1_FTH_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT1_CTRL, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_INT1_FTH_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_INT1_CTRL, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_FIFO_TSHLD_on_INT1
* Description : Read INT1_FTH
* Input : Pointer to LSM6DSM_ACC_GYRO_INT1_FTH_t
* Output : Status of INT1_FTH see LSM6DSM_ACC_GYRO_INT1_FTH_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_FIFO_TSHLD_on_INT1(void *handle, LSM6DSM_ACC_GYRO_INT1_FTH_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT1_CTRL, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_INT1_FTH_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_OVERRUN_on_INT1
* Description : Write INT1_OVR
* Input : LSM6DSM_ACC_GYRO_INT1_OVR_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_OVERRUN_on_INT1(void *handle, LSM6DSM_ACC_GYRO_INT1_OVR_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT1_CTRL, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_INT1_OVR_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_INT1_CTRL, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_OVERRUN_on_INT1
* Description : Read INT1_OVR
* Input : Pointer to LSM6DSM_ACC_GYRO_INT1_OVR_t
* Output : Status of INT1_OVR see LSM6DSM_ACC_GYRO_INT1_OVR_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_OVERRUN_on_INT1(void *handle, LSM6DSM_ACC_GYRO_INT1_OVR_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT1_CTRL, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_INT1_OVR_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_FULL_FLAG_on_INT1
* Description : Write INT1_FULL_FLAG
* Input : LSM6DSM_ACC_GYRO_INT1_FULL_FLAG_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_FULL_FLAG_on_INT1(void *handle, LSM6DSM_ACC_GYRO_INT1_FULL_FLAG_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT1_CTRL, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_INT1_FULL_FLAG_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_INT1_CTRL, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_FULL_FLAG_on_INT1
* Description : Read INT1_FULL_FLAG
* Input : Pointer to LSM6DSM_ACC_GYRO_INT1_FULL_FLAG_t
* Output : Status of INT1_FULL_FLAG see LSM6DSM_ACC_GYRO_INT1_FULL_FLAG_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_FULL_FLAG_on_INT1(void *handle, LSM6DSM_ACC_GYRO_INT1_FULL_FLAG_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT1_CTRL, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_INT1_FULL_FLAG_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_SIGN_MOT_on_INT1
* Description : Write INT1_SIGN_MOT
* Input : LSM6DSM_ACC_GYRO_INT1_SIGN_MOT_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_SIGN_MOT_on_INT1(void *handle, LSM6DSM_ACC_GYRO_INT1_SIGN_MOT_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT1_CTRL, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_INT1_SIGN_MOT_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_INT1_CTRL, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_SIGN_MOT_on_INT1
* Description : Read INT1_SIGN_MOT
* Input : Pointer to LSM6DSM_ACC_GYRO_INT1_SIGN_MOT_t
* Output : Status of INT1_SIGN_MOT see LSM6DSM_ACC_GYRO_INT1_SIGN_MOT_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_SIGN_MOT_on_INT1(void *handle, LSM6DSM_ACC_GYRO_INT1_SIGN_MOT_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT1_CTRL, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_INT1_SIGN_MOT_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_STEP_DET_on_INT1
* Description : Write INT1_PEDO
* Input : LSM6DSM_ACC_GYRO_INT1_PEDO_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_STEP_DET_on_INT1(void *handle, LSM6DSM_ACC_GYRO_INT1_PEDO_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT1_CTRL, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_INT1_PEDO_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_INT1_CTRL, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_STEP_DET_on_INT1
* Description : Read INT1_PEDO
* Input : Pointer to LSM6DSM_ACC_GYRO_INT1_PEDO_t
* Output : Status of INT1_PEDO see LSM6DSM_ACC_GYRO_INT1_PEDO_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_STEP_DET_on_INT1(void *handle, LSM6DSM_ACC_GYRO_INT1_PEDO_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT1_CTRL, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_INT1_PEDO_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_DRDY_XL_on_INT2
* Description : Write INT2_DRDY_XL
* Input : LSM6DSM_ACC_GYRO_INT2_DRDY_XL_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_DRDY_XL_on_INT2(void *handle, LSM6DSM_ACC_GYRO_INT2_DRDY_XL_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT2_CTRL, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_INT2_DRDY_XL_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_INT2_CTRL, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_DRDY_XL_on_INT2
* Description : Read INT2_DRDY_XL
* Input : Pointer to LSM6DSM_ACC_GYRO_INT2_DRDY_XL_t
* Output : Status of INT2_DRDY_XL see LSM6DSM_ACC_GYRO_INT2_DRDY_XL_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_DRDY_XL_on_INT2(void *handle, LSM6DSM_ACC_GYRO_INT2_DRDY_XL_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT2_CTRL, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_INT2_DRDY_XL_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_DRDY_G_on_INT2
* Description : Write INT2_DRDY_G
* Input : LSM6DSM_ACC_GYRO_INT2_DRDY_G_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_DRDY_G_on_INT2(void *handle, LSM6DSM_ACC_GYRO_INT2_DRDY_G_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT2_CTRL, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_INT2_DRDY_G_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_INT2_CTRL, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_DRDY_G_on_INT2
* Description : Read INT2_DRDY_G
* Input : Pointer to LSM6DSM_ACC_GYRO_INT2_DRDY_G_t
* Output : Status of INT2_DRDY_G see LSM6DSM_ACC_GYRO_INT2_DRDY_G_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_DRDY_G_on_INT2(void *handle, LSM6DSM_ACC_GYRO_INT2_DRDY_G_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT2_CTRL, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_INT2_DRDY_G_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_DRDY_TEMP_on_INT2
* Description : Write INT2_DRDY_TEMP
* Input : LSM6DSM_ACC_GYRO_INT2_DRDY_TEMP_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_DRDY_TEMP_on_INT2(void *handle, LSM6DSM_ACC_GYRO_INT2_DRDY_TEMP_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT2_CTRL, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_INT2_DRDY_TEMP_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_INT2_CTRL, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_DRDY_TEMP_on_INT2
* Description : Read INT2_DRDY_TEMP
* Input : Pointer to LSM6DSM_ACC_GYRO_INT2_DRDY_TEMP_t
* Output : Status of INT2_DRDY_TEMP see LSM6DSM_ACC_GYRO_INT2_DRDY_TEMP_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_DRDY_TEMP_on_INT2(void *handle, LSM6DSM_ACC_GYRO_INT2_DRDY_TEMP_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT2_CTRL, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_INT2_DRDY_TEMP_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_FIFO_TSHLD_on_INT2
* Description : Write INT2_FTH
* Input : LSM6DSM_ACC_GYRO_INT2_FTH_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_FIFO_TSHLD_on_INT2(void *handle, LSM6DSM_ACC_GYRO_INT2_FTH_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT2_CTRL, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_INT2_FTH_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_INT2_CTRL, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_FIFO_TSHLD_on_INT2
* Description : Read INT2_FTH
* Input : Pointer to LSM6DSM_ACC_GYRO_INT2_FTH_t
* Output : Status of INT2_FTH see LSM6DSM_ACC_GYRO_INT2_FTH_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_FIFO_TSHLD_on_INT2(void *handle, LSM6DSM_ACC_GYRO_INT2_FTH_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT2_CTRL, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_INT2_FTH_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_OVERRUN_on_INT2
* Description : Write INT2_OVR
* Input : LSM6DSM_ACC_GYRO_INT2_OVR_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_OVERRUN_on_INT2(void *handle, LSM6DSM_ACC_GYRO_INT2_OVR_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT2_CTRL, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_INT2_OVR_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_INT2_CTRL, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_OVERRUN_on_INT2
* Description : Read INT2_OVR
* Input : Pointer to LSM6DSM_ACC_GYRO_INT2_OVR_t
* Output : Status of INT2_OVR see LSM6DSM_ACC_GYRO_INT2_OVR_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_OVERRUN_on_INT2(void *handle, LSM6DSM_ACC_GYRO_INT2_OVR_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT2_CTRL, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_INT2_OVR_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_FULL_FLAG_on_INT2
* Description : Write INT2_FULL_FLAG
* Input : LSM6DSM_ACC_GYRO_INT2_FULL_FLAG_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_FULL_FLAG_on_INT2(void *handle, LSM6DSM_ACC_GYRO_INT2_FULL_FLAG_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT2_CTRL, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_INT2_FULL_FLAG_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_INT2_CTRL, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_FULL_FLAG_on_INT2
* Description : Read INT2_FULL_FLAG
* Input : Pointer to LSM6DSM_ACC_GYRO_INT2_FULL_FLAG_t
* Output : Status of INT2_FULL_FLAG see LSM6DSM_ACC_GYRO_INT2_FULL_FLAG_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_FULL_FLAG_on_INT2(void *handle, LSM6DSM_ACC_GYRO_INT2_FULL_FLAG_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT2_CTRL, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_INT2_FULL_FLAG_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_STEP_COUNT_OV_on_INT2
* Description : Write INT2_STEP_COUNT_OV
* Input : LSM6DSM_ACC_GYRO_INT2_STEP_COUNT_OV_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_STEP_COUNT_OV_on_INT2(void *handle, LSM6DSM_ACC_GYRO_INT2_STEP_COUNT_OV_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT2_CTRL, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_INT2_STEP_COUNT_OV_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_INT2_CTRL, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_STEP_COUNT_OV_on_INT2
* Description : Read INT2_STEP_COUNT_OV
* Input : Pointer to LSM6DSM_ACC_GYRO_INT2_STEP_COUNT_OV_t
* Output : Status of INT2_STEP_COUNT_OV see LSM6DSM_ACC_GYRO_INT2_STEP_COUNT_OV_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_STEP_COUNT_OV_on_INT2(void *handle, LSM6DSM_ACC_GYRO_INT2_STEP_COUNT_OV_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT2_CTRL, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_INT2_STEP_COUNT_OV_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_STEP_DELTA_on_INT2
* Description : Write INT2_STEP_DELTA
* Input : LSM6DSM_ACC_GYRO_INT2_STEP_DELTA_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_STEP_DELTA_on_INT2(void *handle, LSM6DSM_ACC_GYRO_INT2_STEP_DELTA_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT2_CTRL, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_INT2_STEP_DELTA_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_INT2_CTRL, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_STEP_DELTA_on_INT2
* Description : Read INT2_STEP_DELTA
* Input : Pointer to LSM6DSM_ACC_GYRO_INT2_STEP_DELTA_t
* Output : Status of INT2_STEP_DELTA see LSM6DSM_ACC_GYRO_INT2_STEP_DELTA_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_STEP_DELTA_on_INT2(void *handle, LSM6DSM_ACC_GYRO_INT2_STEP_DELTA_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT2_CTRL, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_INT2_STEP_DELTA_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_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]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_WHO_AM_I(void *handle, u8_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_WHO_AM_I_REG, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_WHO_AM_I_BIT_MASK; //coerce
*value = *value >> LSM6DSM_ACC_GYRO_WHO_AM_I_BIT_POSITION; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_BW_SEL
* Description : Write BW_SEL
* Input : LSM6DSM_ACC_GYRO_BW_SEL_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_BW_SEL(void *handle, LSM6DSM_ACC_GYRO_BW_SEL_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL1_XL, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_BW_SEL_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL1_XL, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_BW_SEL
* Description : Read BW_SEL
* Input : Pointer to LSM6DSM_ACC_GYRO_BW_SEL_t
* Output : Status of BW_SEL see LSM6DSM_ACC_GYRO_BW_SEL_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_BW_SEL(void *handle, LSM6DSM_ACC_GYRO_BW_SEL_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL1_XL, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_BW_SEL_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_FS_XL
* Description : Write FS_XL
* Input : LSM6DSM_ACC_GYRO_FS_XL_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_FS_XL(void *handle, LSM6DSM_ACC_GYRO_FS_XL_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL1_XL, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_FS_XL_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL1_XL, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_FS_XL
* Description : Read FS_XL
* Input : Pointer to LSM6DSM_ACC_GYRO_FS_XL_t
* Output : Status of FS_XL see LSM6DSM_ACC_GYRO_FS_XL_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_FS_XL(void *handle, LSM6DSM_ACC_GYRO_FS_XL_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL1_XL, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_FS_XL_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_ODR_XL
* Description : Write ODR_XL
* Input : LSM6DSM_ACC_GYRO_ODR_XL_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_ODR_XL(void *handle, LSM6DSM_ACC_GYRO_ODR_XL_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL1_XL, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_ODR_XL_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL1_XL, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_ODR_XL
* Description : Read ODR_XL
* Input : Pointer to LSM6DSM_ACC_GYRO_ODR_XL_t
* Output : Status of ODR_XL see LSM6DSM_ACC_GYRO_ODR_XL_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_ODR_XL(void *handle, LSM6DSM_ACC_GYRO_ODR_XL_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL1_XL, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_ODR_XL_MASK; //mask
return MEMS_SUCCESS;
}
status_t LSM6DSM_ACC_GYRO_translate_ODR_XL(LSM6DSM_ACC_GYRO_ODR_XL_t value, u16_t *odr_hz_val)
{
switch(value) {
case LSM6DSM_ACC_GYRO_ODR_XL_POWER_DOWN:
*odr_hz_val = 0;
break;
case LSM6DSM_ACC_GYRO_ODR_XL_13Hz:
*odr_hz_val = 13;
break;
case LSM6DSM_ACC_GYRO_ODR_XL_26Hz:
*odr_hz_val = 26;
break;
case LSM6DSM_ACC_GYRO_ODR_XL_52Hz:
*odr_hz_val = 52;
break;
case LSM6DSM_ACC_GYRO_ODR_XL_104Hz:
*odr_hz_val = 104;
break;
case LSM6DSM_ACC_GYRO_ODR_XL_208Hz:
*odr_hz_val = 208;
break;
case LSM6DSM_ACC_GYRO_ODR_XL_416Hz:
*odr_hz_val = 416;
break;
case LSM6DSM_ACC_GYRO_ODR_XL_833Hz:
*odr_hz_val = 833;
break;
case LSM6DSM_ACC_GYRO_ODR_XL_1660Hz:
*odr_hz_val = 1660;
break;
default:
return MEMS_ERROR;
}
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_FS_125
* Description : Write FS_125
* Input : LSM6DSM_ACC_GYRO_FS_125_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_FS_125(void *handle, LSM6DSM_ACC_GYRO_FS_125_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL2_G, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_FS_125_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL2_G, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_FS_125
* Description : Read FS_125
* Input : Pointer to LSM6DSM_ACC_GYRO_FS_125_t
* Output : Status of FS_125 see LSM6DSM_ACC_GYRO_FS_125_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_FS_125(void *handle, LSM6DSM_ACC_GYRO_FS_125_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL2_G, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_FS_125_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_FS_G
* Description : Write FS_G
* Input : LSM6DSM_ACC_GYRO_FS_G_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_FS_G(void *handle, LSM6DSM_ACC_GYRO_FS_G_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL2_G, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_FS_G_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL2_G, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_FS_G
* Description : Read FS_G
* Input : Pointer to LSM6DSM_ACC_GYRO_FS_G_t
* Output : Status of FS_G see LSM6DSM_ACC_GYRO_FS_G_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_FS_G(void *handle, LSM6DSM_ACC_GYRO_FS_G_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL2_G, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_FS_G_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_ODR_G
* Description : Write ODR_G
* Input : LSM6DSM_ACC_GYRO_ODR_G_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_ODR_G(void *handle, LSM6DSM_ACC_GYRO_ODR_G_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL2_G, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_ODR_G_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL2_G, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_ODR_G
* Description : Read ODR_G
* Input : Pointer to LSM6DSM_ACC_GYRO_ODR_G_t
* Output : Status of ODR_G see LSM6DSM_ACC_GYRO_ODR_G_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_ODR_G(void *handle, LSM6DSM_ACC_GYRO_ODR_G_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL2_G, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_ODR_G_MASK; //mask
return MEMS_SUCCESS;
}
status_t LSM6DSM_ACC_GYRO_translate_ODR_G(LSM6DSM_ACC_GYRO_ODR_G_t value, u16_t *odr_hz_val)
{
switch(value) {
case LSM6DSM_ACC_GYRO_ODR_G_POWER_DOWN:
*odr_hz_val = 0;
break;
case LSM6DSM_ACC_GYRO_ODR_G_13Hz:
*odr_hz_val = 13;
break;
case LSM6DSM_ACC_GYRO_ODR_G_26Hz:
*odr_hz_val = 26;
break;
case LSM6DSM_ACC_GYRO_ODR_G_52Hz:
*odr_hz_val = 52;
break;
case LSM6DSM_ACC_GYRO_ODR_G_104Hz:
*odr_hz_val = 104;
break;
case LSM6DSM_ACC_GYRO_ODR_G_208Hz:
*odr_hz_val = 208;
break;
case LSM6DSM_ACC_GYRO_ODR_G_416Hz:
*odr_hz_val = 416;
break;
case LSM6DSM_ACC_GYRO_ODR_G_833Hz:
*odr_hz_val = 833;
break;
case LSM6DSM_ACC_GYRO_ODR_G_1660Hz:
*odr_hz_val = 1660;
break;
default:
return MEMS_ERROR;
}
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_SW_RESET
* Description : Write SW_RESET
* Input : LSM6DSM_ACC_GYRO_SW_RESET_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_SW_RESET(void *handle, LSM6DSM_ACC_GYRO_SW_RESET_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL3_C, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_SW_RESET_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL3_C, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_SW_RESET
* Description : Read SW_RESET
* Input : Pointer to LSM6DSM_ACC_GYRO_SW_RESET_t
* Output : Status of SW_RESET see LSM6DSM_ACC_GYRO_SW_RESET_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_SW_RESET(void *handle, LSM6DSM_ACC_GYRO_SW_RESET_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL3_C, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_SW_RESET_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_BLE
* Description : Write BLE
* Input : LSM6DSM_ACC_GYRO_BLE_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_BLE(void *handle, LSM6DSM_ACC_GYRO_BLE_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL3_C, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_BLE_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL3_C, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_BLE
* Description : Read BLE
* Input : Pointer to LSM6DSM_ACC_GYRO_BLE_t
* Output : Status of BLE see LSM6DSM_ACC_GYRO_BLE_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_BLE(void *handle, LSM6DSM_ACC_GYRO_BLE_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL3_C, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_BLE_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_IF_Addr_Incr
* Description : Write IF_INC
* Input : LSM6DSM_ACC_GYRO_IF_INC_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_IF_Addr_Incr(void *handle, LSM6DSM_ACC_GYRO_IF_INC_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL3_C, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_IF_INC_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL3_C, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_IF_Addr_Incr
* Description : Read IF_INC
* Input : Pointer to LSM6DSM_ACC_GYRO_IF_INC_t
* Output : Status of IF_INC see LSM6DSM_ACC_GYRO_IF_INC_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_IF_Addr_Incr(void *handle, LSM6DSM_ACC_GYRO_IF_INC_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL3_C, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_IF_INC_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_SPI_Mode
* Description : Write SIM
* Input : LSM6DSM_ACC_GYRO_SIM_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_SPI_Mode(void *handle, LSM6DSM_ACC_GYRO_SIM_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL3_C, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_SIM_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL3_C, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_SPI_Mode
* Description : Read SIM
* Input : Pointer to LSM6DSM_ACC_GYRO_SIM_t
* Output : Status of SIM see LSM6DSM_ACC_GYRO_SIM_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_SPI_Mode(void *handle, LSM6DSM_ACC_GYRO_SIM_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL3_C, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_SIM_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_PadSel
* Description : Write PP_OD
* Input : LSM6DSM_ACC_GYRO_PP_OD_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_PadSel(void *handle, LSM6DSM_ACC_GYRO_PP_OD_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL3_C, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_PP_OD_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL3_C, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_PadSel
* Description : Read PP_OD
* Input : Pointer to LSM6DSM_ACC_GYRO_PP_OD_t
* Output : Status of PP_OD see LSM6DSM_ACC_GYRO_PP_OD_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_PadSel(void *handle, LSM6DSM_ACC_GYRO_PP_OD_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL3_C, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_PP_OD_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_INT_ACT_LEVEL
* Description : Write INT_ACT_LEVEL
* Input : LSM6DSM_ACC_GYRO_INT_ACT_LEVEL_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_INT_ACT_LEVEL(void *handle, LSM6DSM_ACC_GYRO_INT_ACT_LEVEL_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL3_C, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_INT_ACT_LEVEL_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL3_C, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_INT_ACT_LEVEL
* Description : Read INT_ACT_LEVEL
* Input : Pointer to LSM6DSM_ACC_GYRO_INT_ACT_LEVEL_t
* Output : Status of INT_ACT_LEVEL see LSM6DSM_ACC_GYRO_INT_ACT_LEVEL_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_INT_ACT_LEVEL(void *handle, LSM6DSM_ACC_GYRO_INT_ACT_LEVEL_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL3_C, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_INT_ACT_LEVEL_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_BDU
* Description : Write BDU
* Input : LSM6DSM_ACC_GYRO_BDU_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_BDU(void *handle, LSM6DSM_ACC_GYRO_BDU_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL3_C, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_BDU_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL3_C, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_BDU
* Description : Read BDU
* Input : Pointer to LSM6DSM_ACC_GYRO_BDU_t
* Output : Status of BDU see LSM6DSM_ACC_GYRO_BDU_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_BDU(void *handle, LSM6DSM_ACC_GYRO_BDU_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL3_C, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_BDU_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_BOOT
* Description : Write BOOT
* Input : LSM6DSM_ACC_GYRO_BOOT_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_BOOT(void *handle, LSM6DSM_ACC_GYRO_BOOT_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL3_C, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_BOOT_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL3_C, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_BOOT
* Description : Read BOOT
* Input : Pointer to LSM6DSM_ACC_GYRO_BOOT_t
* Output : Status of BOOT see LSM6DSM_ACC_GYRO_BOOT_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_BOOT(void *handle, LSM6DSM_ACC_GYRO_BOOT_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL3_C, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_BOOT_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_LPF1_SEL_G
* Description : Write LPF1_SEL_G
* Input : LSM6DSM_ACC_GYRO_LPF1_SEL_G_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_LPF1_SEL_G(void *handle, LSM6DSM_ACC_GYRO_LPF1_SEL_G_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL4_C, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_LPF1_SEL_G_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL4_C, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_LPF1_SEL_G
* Description : Read LPF1_SEL_G
* Input : Pointer to LSM6DSM_ACC_GYRO_LPF1_SEL_G_t
* Output : Status of LPF1_SEL_G see LSM6DSM_ACC_GYRO_LPF1_SEL_G_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_LPF1_SEL_G(void *handle, LSM6DSM_ACC_GYRO_LPF1_SEL_G_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL4_C, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_LPF1_SEL_G_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_I2C_DISABLE
* Description : Write I2C_DISABLE
* Input : LSM6DSM_ACC_GYRO_I2C_DISABLE_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_I2C_DISABLE(void *handle, LSM6DSM_ACC_GYRO_I2C_DISABLE_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL4_C, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_I2C_DISABLE_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL4_C, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_I2C_DISABLE
* Description : Read I2C_DISABLE
* Input : Pointer to LSM6DSM_ACC_GYRO_I2C_DISABLE_t
* Output : Status of I2C_DISABLE see LSM6DSM_ACC_GYRO_I2C_DISABLE_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_I2C_DISABLE(void *handle, LSM6DSM_ACC_GYRO_I2C_DISABLE_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL4_C, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_I2C_DISABLE_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_DRDY_MSK
* Description : Write DRDY_MSK
* Input : LSM6DSM_ACC_GYRO_DRDY_MSK_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_DRDY_MSK(void *handle, LSM6DSM_ACC_GYRO_DRDY_MSK_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL4_C, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_DRDY_MSK_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL4_C, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_DRDY_MSK
* Description : Read DRDY_MSK
* Input : Pointer to LSM6DSM_ACC_GYRO_DRDY_MSK_t
* Output : Status of DRDY_MSK see LSM6DSM_ACC_GYRO_DRDY_MSK_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_DRDY_MSK(void *handle, LSM6DSM_ACC_GYRO_DRDY_MSK_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL4_C, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_DRDY_MSK_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_INT2_ON_INT1
* Description : Write INT2_ON_INT1
* Input : LSM6DSM_ACC_GYRO_INT2_ON_INT1_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_INT2_ON_INT1(void *handle, LSM6DSM_ACC_GYRO_INT2_ON_INT1_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL4_C, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_INT2_ON_INT1_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL4_C, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_INT2_ON_INT1
* Description : Read INT2_ON_INT1
* Input : Pointer to LSM6DSM_ACC_GYRO_INT2_ON_INT1_t
* Output : Status of INT2_ON_INT1 see LSM6DSM_ACC_GYRO_INT2_ON_INT1_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_INT2_ON_INT1(void *handle, LSM6DSM_ACC_GYRO_INT2_ON_INT1_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL4_C, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_INT2_ON_INT1_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_SleepMode_G
* Description : Write SLEEP_G
* Input : LSM6DSM_ACC_GYRO_SLEEP_G_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_SleepMode_G(void *handle, LSM6DSM_ACC_GYRO_SLEEP_G_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL4_C, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_SLEEP_G_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL4_C, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_SleepMode_G
* Description : Read SLEEP_G
* Input : Pointer to LSM6DSM_ACC_GYRO_SLEEP_G_t
* Output : Status of SLEEP_G see LSM6DSM_ACC_GYRO_SLEEP_G_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_SleepMode_G(void *handle, LSM6DSM_ACC_GYRO_SLEEP_G_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL4_C, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_SLEEP_G_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_SelfTest_XL
* Description : Write ST_XL
* Input : LSM6DSM_ACC_GYRO_ST_XL_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_SelfTest_XL(void *handle, LSM6DSM_ACC_GYRO_ST_XL_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL5_C, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_ST_XL_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL5_C, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_SelfTest_XL
* Description : Read ST_XL
* Input : Pointer to LSM6DSM_ACC_GYRO_ST_XL_t
* Output : Status of ST_XL see LSM6DSM_ACC_GYRO_ST_XL_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_SelfTest_XL(void *handle, LSM6DSM_ACC_GYRO_ST_XL_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL5_C, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_ST_XL_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_SelfTest_G
* Description : Write ST_G
* Input : LSM6DSM_ACC_GYRO_ST_G_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_SelfTest_G(void *handle, LSM6DSM_ACC_GYRO_ST_G_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL5_C, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_ST_G_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL5_C, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_SelfTest_G
* Description : Read ST_G
* Input : Pointer to LSM6DSM_ACC_GYRO_ST_G_t
* Output : Status of ST_G see LSM6DSM_ACC_GYRO_ST_G_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_SelfTest_G(void *handle, LSM6DSM_ACC_GYRO_ST_G_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL5_C, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_ST_G_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_DEN_Polarity
* Description : Write DEN_LH
* Input : LSM6DSM_ACC_GYRO_DEN_LH_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_DEN_Polarity(void *handle, LSM6DSM_ACC_GYRO_DEN_LH_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL5_C, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_DEN_LH_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL5_C, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_DEN_Polarity
* Description : Read DEN_LH
* Input : Pointer to LSM6DSM_ACC_GYRO_DEN_LH_t
* Output : Status of DEN_LH see LSM6DSM_ACC_GYRO_DEN_LH_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_DEN_Polarity(void *handle, LSM6DSM_ACC_GYRO_DEN_LH_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL5_C, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_DEN_LH_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_CircularBurstMode
* Description : Write ST_ROUNDING
* Input : LSM6DSM_ACC_GYRO_ROUNDING_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_CircularBurstMode(void *handle, LSM6DSM_ACC_GYRO_ROUNDING_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL5_C, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_LSM6DSM_ACC_GYRO_ROUNDING_t_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL5_C, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_CircularBurstMode
* Description : Read ST_ROUNDING
* Input : Pointer to LSM6DSM_ACC_GYRO_ROUNDING_t
* Output : Status of ST_ROUNDING see LSM6DSM_ACC_GYRO_ROUNDING_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_CircularBurstMode(void *handle, LSM6DSM_ACC_GYRO_ROUNDING_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL5_C, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_LSM6DSM_ACC_GYRO_ROUNDING_t_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_LP_BW_G
* Description : Write FTYPE
* Input : LSM6DSM_ACC_GYRO_FTYPE_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_LP_BW_G(void *handle, LSM6DSM_ACC_GYRO_FTYPE_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL6_G, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_FTYPE_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL6_G, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_LP_BW_G
* Description : Read FTYPE
* Input : Pointer to LSM6DSM_ACC_GYRO_FTYPE_t
* Output : Status of FTYPE see LSM6DSM_ACC_GYRO_FTYPE_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_LP_BW_G(void *handle, LSM6DSM_ACC_GYRO_FTYPE_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL6_G, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_FTYPE_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_UserOffsetWeight
* Description : Write USR_OFF_W
* Input : LSM6DSM_ACC_GYRO_USR_OFF_W_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_UserOffsetWeight(void *handle, LSM6DSM_ACC_GYRO_USR_OFF_W_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL6_G, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_USR_OFF_W_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL6_G, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_UserOffsetWeight
* Description : Read USR_OFF_W
* Input : Pointer to LSM6DSM_ACC_GYRO_USR_OFF_W_t
* Output : Status of USR_OFF_W see LSM6DSM_ACC_GYRO_USR_OFF_W_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_UserOffsetWeight(void *handle, LSM6DSM_ACC_GYRO_USR_OFF_W_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL6_G, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_USR_OFF_W_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_LowPower_XL
* Description : Write LP_XL
* Input : LSM6DSM_ACC_GYRO_LP_XL_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_LowPower_XL(void *handle, LSM6DSM_ACC_GYRO_LP_XL_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL6_G, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_LP_XL_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL6_G, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_LowPower_XL
* Description : Read LP_XL
* Input : Pointer to LSM6DSM_ACC_GYRO_LP_XL_t
* Output : Status of LP_XL see LSM6DSM_ACC_GYRO_LP_XL_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_LowPower_XL(void *handle, LSM6DSM_ACC_GYRO_LP_XL_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL6_G, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_LP_XL_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_DEN_LVL2_EN
* Description : Write DEN_LVL2_EN
* Input : LSM6DSM_ACC_GYRO_DEN_LVL2_EN_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_DEN_LVL2_EN(void *handle, LSM6DSM_ACC_GYRO_DEN_LVL2_EN_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL6_G, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_DEN_LVL2_EN_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL6_G, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_DEN_LVL2_EN
* Description : Read DEN_LVL2_EN
* Input : Pointer to LSM6DSM_ACC_GYRO_DEN_LVL2_EN_t
* Output : Status of DEN_LVL2_EN see LSM6DSM_ACC_GYRO_DEN_LVL2_EN_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_DEN_LVL2_EN(void *handle, LSM6DSM_ACC_GYRO_DEN_LVL2_EN_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL6_G, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_DEN_LVL2_EN_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_DEN_LVL_EN
* Description : Write DEN_LVL_EN
* Input : LSM6DSM_ACC_GYRO_DEN_LVL_EN_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_DEN_LVL_EN(void *handle, LSM6DSM_ACC_GYRO_DEN_LVL_EN_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL6_G, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_DEN_LVL_EN_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL6_G, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_DEN_LVL_EN
* Description : Read DEN_LVL_EN
* Input : Pointer to LSM6DSM_ACC_GYRO_DEN_LVL_EN_t
* Output : Status of DEN_LVL_EN see LSM6DSM_ACC_GYRO_DEN_LVL_EN_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_DEN_LVL_EN(void *handle, LSM6DSM_ACC_GYRO_DEN_LVL_EN_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL6_G, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_DEN_LVL_EN_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_ExternalTrigger
* Description : Write DEN_EDGE_EN
* Input : LSM6DSM_ACC_GYRO_DEN_EDGE_EN_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_ExternalTrigger(void *handle, LSM6DSM_ACC_GYRO_DEN_EDGE_EN_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL6_G, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_DEN_EDGE_EN_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL6_G, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_ExternalTrigger
* Description : Read DEN_EDGE_EN
* Input : Pointer to LSM6DSM_ACC_GYRO_DEN_EDGE_EN_t
* Output : Status of DEN_EDGE_EN see LSM6DSM_ACC_GYRO_DEN_EDGE_EN_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_ExternalTrigger(void *handle, LSM6DSM_ACC_GYRO_DEN_EDGE_EN_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL6_G, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_DEN_EDGE_EN_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_HPM_G
* Description : Write HPM_G
* Input : LSM6DSM_ACC_GYRO_HPM_G_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_HPM_G(void *handle, LSM6DSM_ACC_GYRO_HPM_G_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL7_G, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_HPM_G_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL7_G, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_HPM_G
* Description : Read HPM_G
* Input : Pointer to LSM6DSM_ACC_GYRO_HPM_G_t
* Output : Status of HPM_G see LSM6DSM_ACC_GYRO_HPM_G_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_HPM_G(void *handle, LSM6DSM_ACC_GYRO_HPM_G_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL7_G, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_HPM_G_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_RoundingOnStatusRegisters
* Description : Write HPM_G
* Input : LSM6DSM_ACC_GYRO_RND_status_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_RoundingOnStatusRegisters(void *handle, LSM6DSM_ACC_GYRO_RND_STATUS_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL7_G, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_RND_STATUS_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL7_G, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_RoundingOnStatusRegisters
* Description : Read HPM_G
* Input : Pointer to LSM6DSM_ACC_GYRO_RND_status_t
* Output : Status of HPM_G see LSM6DSM_ACC_GYRO_RND_status_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_RoundingOnStatusRegisters(void *handle, LSM6DSM_ACC_GYRO_RND_STATUS_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL7_G, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_RND_STATUS_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_HPFilter_En
* Description : Write HP_EN
* Input : LSM6DSM_ACC_GYRO_HP_EN_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_HPFilter_En(void *handle, LSM6DSM_ACC_GYRO_HP_EN_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL7_G, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_HP_EN_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL7_G, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_HPFilter_En
* Description : Read HP_EN
* Input : Pointer to LSM6DSM_ACC_GYRO_HP_EN_t
* Output : Status of HP_EN see LSM6DSM_ACC_GYRO_HP_EN_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_HPFilter_En(void *handle, LSM6DSM_ACC_GYRO_HP_EN_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL7_G, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_HP_EN_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_LP_Mode
* Description : Write LP_EN
* Input : LSM6DSM_ACC_GYRO_LP_EN_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_LP_Mode(void *handle, LSM6DSM_ACC_GYRO_LP_EN_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL7_G, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_LP_EN_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL7_G, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_LP_Mode
* Description : Read LP_EN
* Input : Pointer to LSM6DSM_ACC_GYRO_LP_EN_t
* Output : Status of LP_EN see LSM6DSM_ACC_GYRO_LP_EN_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_LP_Mode(void *handle, LSM6DSM_ACC_GYRO_LP_EN_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL7_G, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_LP_EN_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_ROUNDING_STATUS
* Description : Write ROUNDING_STATUS
* Input : LSM6DSM_ACC_GYRO_ROUNDING_status_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_ROUNDING_STATUS(void *handle, LSM6DSM_ACC_GYRO_ROUNDING_STATUS_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL7_G, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_ROUNDING_STATUS_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL7_G, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_ROUNDING_STATUS
* Description : Read ROUNDING_STATUS
* Input : Pointer to LSM6DSM_ACC_GYRO_ROUNDING_status_t
* Output : Status of ROUNDING_STATUS see LSM6DSM_ACC_GYRO_ROUNDING_status_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_ROUNDING_STATUS(void *handle, LSM6DSM_ACC_GYRO_ROUNDING_STATUS_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL7_G, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_ROUNDING_STATUS_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_HP_G_RST
* Description : Write HP_G_RST
* Input : LSM6DSM_ACC_GYRO_HP_G_RST_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_HP_G_RST(void *handle, LSM6DSM_ACC_GYRO_HP_G_RST_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL7_G, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_HP_G_RST_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL7_G, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_HP_G_RST
* Description : Read HP_G_RST
* Input : Pointer to LSM6DSM_ACC_GYRO_HP_G_RST_t
* Output : Status of HP_G_RST see LSM6DSM_ACC_GYRO_HP_G_RST_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_HP_G_RST(void *handle, LSM6DSM_ACC_GYRO_HP_G_RST_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL7_G, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_HP_G_RST_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_InComposit
* Description : Write INPUT_COMPOSITE
* Input : LSM6DSM_ACC_GYRO_IN_COMP_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_InComposit(void *handle, LSM6DSM_ACC_GYRO_IN_COMP_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL8_XL, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_IN_COMP_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL8_XL, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_InComposit
* Description : Read INPUT_COMPOSITE
* Input : Pointer to LSM6DSM_ACC_GYRO_IN_COMP_t
* Output : Status of INPUT_COMPOSITE see LSM6DSM_ACC_GYRO_IN_COMP_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_InComposit(void *handle, LSM6DSM_ACC_GYRO_IN_COMP_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL8_XL, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_IN_COMP_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_HPfilterReference
* Description : Write HP_REF_MODE
* Input : LSM6DSM_ACC_GYRO_HP_REF_MODE_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_HPfilterReference(void *handle, LSM6DSM_ACC_GYRO_HP_REF_MODE_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL8_XL, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_HP_REF_MODE_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL8_XL, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_HPfilterReference
* Description : Read HP_REF_MODE
* Input : Pointer to LSM6DSM_ACC_GYRO_HP_REF_MODE_t
* Output : Status of HP_REF_MODE see LSM6DSM_ACC_GYRO_HP_REF_MODE_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_HPfilterReference(void *handle, LSM6DSM_ACC_GYRO_HP_REF_MODE_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL8_XL, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_HP_REF_MODE_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_HPCF_XL
* Description : Write HPCF_XL
* Input : LSM6DSM_ACC_GYRO_HPCF_XL_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_HPCF_XL(void *handle, LSM6DSM_ACC_GYRO_HPCF_XL_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL8_XL, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_HPCF_XL_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL8_XL, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_HPCF_XL
* Description : Read HPCF_XL
* Input : Pointer to LSM6DSM_ACC_GYRO_HPCF_XL_t
* Output : Status of HPCF_XL see LSM6DSM_ACC_GYRO_HPCF_XL_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_HPCF_XL(void *handle, LSM6DSM_ACC_GYRO_HPCF_XL_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL8_XL, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_HPCF_XL_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_LowPassFiltSel_XL
* Description : Write LPF2_XL_EN
* Input : LSM6DSM_ACC_GYRO_LPF2_XL_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_LowPassFiltSel_XL(void *handle, LSM6DSM_ACC_GYRO_LPF2_XL_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL8_XL, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_LPF2_XL_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL8_XL, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_LowPassFiltSel_XL
* Description : Read LPF2_XL_EN
* Input : Pointer to LSM6DSM_ACC_GYRO_LPF2_XL_t
* Output : Status of LPF2_XL_EN see LSM6DSM_ACC_GYRO_LPF2_XL_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_LowPassFiltSel_XL(void *handle, LSM6DSM_ACC_GYRO_LPF2_XL_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL8_XL, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_LPF2_XL_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_LOW_PASS_ON_6D
* Description : Write LOW_PASS_ON_6D
* Input : LSM6DSM_ACC_GYRO_LOW_PASS_ON_6D_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_LOW_PASS_ON_6D(void *handle, LSM6DSM_ACC_GYRO_LOW_PASS_ON_6D_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL8_XL, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_LOW_PASS_ON_6D_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL8_XL, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_LOW_PASS_ON_6D
* Description : Read LOW_PASS_ON_6D
* Input : Pointer to LSM6DSM_ACC_GYRO_LOW_PASS_ON_6D_t
* Output : Status of LOW_PASS_ON_6D see LSM6DSM_ACC_GYRO_LOW_PASS_ON_6D_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_LOW_PASS_ON_6D(void *handle, LSM6DSM_ACC_GYRO_LOW_PASS_ON_6D_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL8_XL, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_LOW_PASS_ON_6D_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_HP_SLOPE_XL
* Description : Write HP_SLOPE_XL_EN
* Input : LSM6DSM_ACC_GYRO_HP_SLOPE_XL_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_HP_SLOPE_XL(void *handle, LSM6DSM_ACC_GYRO_HP_SLOPE_XL_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL8_XL, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_HP_SLOPE_XL_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL8_XL, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_HP_SLOPE_XL
* Description : Read HP_SLOPE_XL_EN
* Input : Pointer to LSM6DSM_ACC_GYRO_HP_SLOPE_XL_t
* Output : Status of HP_SLOPE_XL_EN see LSM6DSM_ACC_GYRO_HP_SLOPE_XL_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_HP_SLOPE_XL(void *handle, LSM6DSM_ACC_GYRO_HP_SLOPE_XL_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL8_XL, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_HP_SLOPE_XL_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_SOFT
* Description : Write SOFT_EN
* Input : LSM6DSM_ACC_GYRO_SOFT_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_SOFT(void *handle, LSM6DSM_ACC_GYRO_SOFT_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL9_XL, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_SOFT_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL9_XL, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_SOFT
* Description : Read SOFT_EN
* Input : Pointer to LSM6DSM_ACC_GYRO_SOFT_t
* Output : Status of SOFT_EN see LSM6DSM_ACC_GYRO_SOFT_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_SOFT(void *handle, LSM6DSM_ACC_GYRO_SOFT_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL9_XL, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_SOFT_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_SignifcantMotion
* Description : Write SIGN_MOTION_EN
* Input : LSM6DSM_ACC_GYRO_SIGN_MOTION_EN_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_SignifcantMotion(void *handle, LSM6DSM_ACC_GYRO_SIGN_MOTION_EN_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL10_C, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_SIGN_MOTION_EN_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL10_C, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_SignifcantMotion
* Description : Read SIGN_MOTION_EN
* Input : Pointer to LSM6DSM_ACC_GYRO_SIGN_MOTION_EN_t
* Output : Status of SIGN_MOTION_EN see LSM6DSM_ACC_GYRO_SIGN_MOTION_EN_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_SignifcantMotion(void *handle, LSM6DSM_ACC_GYRO_SIGN_MOTION_EN_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL10_C, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_SIGN_MOTION_EN_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_PedoStepReset
* Description : Write PEDO_RST_STEP
* Input : LSM6DSM_ACC_GYRO_PEDO_RST_STEP_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_PedoStepReset(void *handle, LSM6DSM_ACC_GYRO_PEDO_RST_STEP_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL10_C, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_PEDO_RST_STEP_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL10_C, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_PedoStepReset
* Description : Read PEDO_RST_STEP
* Input : Pointer to LSM6DSM_ACC_GYRO_PEDO_RST_STEP_t
* Output : Status of PEDO_RST_STEP see LSM6DSM_ACC_GYRO_PEDO_RST_STEP_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_PedoStepReset(void *handle, LSM6DSM_ACC_GYRO_PEDO_RST_STEP_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL10_C, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_PEDO_RST_STEP_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_TILT
* Description : Write XEN_G
* Input : LSM6DSM_ACC_GYRO_TILT_G_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_TILT(void *handle, LSM6DSM_ACC_GYRO_TILT_G_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL10_C, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_TILT_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL10_C, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_TILT
* Description : Read XEN_G
* Input : Pointer to LSM6DSM_ACC_GYRO_TILT_G_t
* Output : Status of XEN_G see LSM6DSM_ACC_GYRO_TILT_G_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_TILT(void *handle, LSM6DSM_ACC_GYRO_TILT_G_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL10_C, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_TILT_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_PEDO
* Description : Write PEDO_EN
* Input : LSM6DSM_ACC_GYRO_PEDO_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_PEDO(void *handle, LSM6DSM_ACC_GYRO_PEDO_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL10_C, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_PEDO_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL10_C, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_PEDO
* Description : Read PEDO_EN
* Input : Pointer to LSM6DSM_ACC_GYRO_PEDO_t
* Output : Status of PEDO_EN see LSM6DSM_ACC_GYRO_PEDO_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_PEDO(void *handle, LSM6DSM_ACC_GYRO_PEDO_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL10_C, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_PEDO_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_TIMER
* Description : Write TIMER_EN
* Input : LSM6DSM_ACC_GYRO_TIMER_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_TIMER(void *handle, LSM6DSM_ACC_GYRO_TIMER_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL10_C, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_TIMER_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL10_C, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_TIMER
* Description : Read TIMER_EN
* Input : Pointer to LSM6DSM_ACC_GYRO_TIMER_t
* Output : Status of TIMER_EN see LSM6DSM_ACC_GYRO_TIMER_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_TIMER(void *handle, LSM6DSM_ACC_GYRO_TIMER_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL10_C, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_TIMER_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_FUNC_EN
* Description : Write FUNC_EN
* Input : LSM6DSM_ACC_GYRO_FUNC_EN_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_FUNC_EN(void *handle, LSM6DSM_ACC_GYRO_FUNC_EN_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL10_C, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_FUNC_EN_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CTRL10_C, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_FUNC_EN
* Description : Read FUNC_EN
* Input : Pointer to LSM6DSM_ACC_GYRO_FUNC_EN_t
* Output : Status of FUNC_EN see LSM6DSM_ACC_GYRO_FUNC_EN_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_FUNC_EN(void *handle, LSM6DSM_ACC_GYRO_FUNC_EN_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CTRL10_C, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_FUNC_EN_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_I2C_MASTER_Enable
* Description : Write MASTER_ON
* Input : LSM6DSM_ACC_GYRO_MASTER_ON_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_I2C_MASTER_Enable(void *handle, LSM6DSM_ACC_GYRO_MASTER_ON_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MASTER_CONFIG, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_MASTER_ON_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_MASTER_CONFIG, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_I2C_MASTER_Enable
* Description : Read MASTER_ON
* Input : Pointer to LSM6DSM_ACC_GYRO_MASTER_ON_t
* Output : Status of MASTER_ON see LSM6DSM_ACC_GYRO_MASTER_ON_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_I2C_MASTER_Enable(void *handle, LSM6DSM_ACC_GYRO_MASTER_ON_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MASTER_CONFIG, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_MASTER_ON_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_IronCorrection_EN
* Description : Write IRON_EN
* Input : LSM6DSM_ACC_GYRO_IRON_EN_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_IronCorrection_EN(void *handle, LSM6DSM_ACC_GYRO_IRON_EN_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MASTER_CONFIG, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_IRON_EN_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_MASTER_CONFIG, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_IronCorrection_EN
* Description : Read IRON_EN
* Input : Pointer to LSM6DSM_ACC_GYRO_IRON_EN_t
* Output : Status of IRON_EN see LSM6DSM_ACC_GYRO_IRON_EN_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_IronCorrection_EN(void *handle, LSM6DSM_ACC_GYRO_IRON_EN_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MASTER_CONFIG, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_IRON_EN_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_PASS_THRU_MODE
* Description : Write PASS_THRU_MODE
* Input : LSM6DSM_ACC_GYRO_PASS_THRU_MODE_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_PASS_THRU_MODE(void *handle, LSM6DSM_ACC_GYRO_PASS_THRU_MODE_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MASTER_CONFIG, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_PASS_THRU_MODE_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_MASTER_CONFIG, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_PASS_THRU_MODE
* Description : Read PASS_THRU_MODE
* Input : Pointer to LSM6DSM_ACC_GYRO_PASS_THRU_MODE_t
* Output : Status of PASS_THRU_MODE see LSM6DSM_ACC_GYRO_PASS_THRU_MODE_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_PASS_THRU_MODE(void *handle, LSM6DSM_ACC_GYRO_PASS_THRU_MODE_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MASTER_CONFIG, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_PASS_THRU_MODE_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_PULL_UP_EN
* Description : Write PULL_UP_EN
* Input : LSM6DSM_ACC_GYRO_PULL_UP_EN_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_PULL_UP_EN(void *handle, LSM6DSM_ACC_GYRO_PULL_UP_EN_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MASTER_CONFIG, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_PULL_UP_EN_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_MASTER_CONFIG, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_PULL_UP_EN
* Description : Read PULL_UP_EN
* Input : Pointer to LSM6DSM_ACC_GYRO_PULL_UP_EN_t
* Output : Status of PULL_UP_EN see LSM6DSM_ACC_GYRO_PULL_UP_EN_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_PULL_UP_EN(void *handle, LSM6DSM_ACC_GYRO_PULL_UP_EN_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MASTER_CONFIG, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_PULL_UP_EN_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_SensorHUB_Trigger_Sel
* Description : Write START_CONFIG
* Input : LSM6DSM_ACC_GYRO_START_CONFIG_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_SensorHUB_Trigger_Sel(void *handle, LSM6DSM_ACC_GYRO_START_CONFIG_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MASTER_CONFIG, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_START_CONFIG_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_MASTER_CONFIG, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_SensorHUB_Trigger_Sel
* Description : Read START_CONFIG
* Input : Pointer to LSM6DSM_ACC_GYRO_START_CONFIG_t
* Output : Status of START_CONFIG see LSM6DSM_ACC_GYRO_START_CONFIG_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_SensorHUB_Trigger_Sel(void *handle, LSM6DSM_ACC_GYRO_START_CONFIG_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MASTER_CONFIG, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_START_CONFIG_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_DATA_VAL_SEL_FIFO
* Description : Write DATA_VAL_SEL_FIFO
* Input : LSM6DSM_ACC_GYRO_DATA_VAL_SEL_FIFO_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_DATA_VAL_SEL_FIFO(void *handle, LSM6DSM_ACC_GYRO_DATA_VAL_SEL_FIFO_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MASTER_CONFIG, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_DATA_VAL_SEL_FIFO_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_MASTER_CONFIG, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_DATA_VAL_SEL_FIFO
* Description : Read DATA_VAL_SEL_FIFO
* Input : Pointer to LSM6DSM_ACC_GYRO_DATA_VAL_SEL_FIFO_t
* Output : Status of DATA_VAL_SEL_FIFO see LSM6DSM_ACC_GYRO_DATA_VAL_SEL_FIFO_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_DATA_VAL_SEL_FIFO(void *handle, LSM6DSM_ACC_GYRO_DATA_VAL_SEL_FIFO_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MASTER_CONFIG, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_DATA_VAL_SEL_FIFO_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_DRDY_ON_INT1
* Description : Write DRDY_ON_INT1
* Input : LSM6DSM_ACC_GYRO_DRDY_ON_INT1_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_DRDY_ON_INT1(void *handle, LSM6DSM_ACC_GYRO_DRDY_ON_INT1_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MASTER_CONFIG, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_DRDY_ON_INT1_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_MASTER_CONFIG, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_DRDY_ON_INT1
* Description : Read DRDY_ON_INT1
* Input : Pointer to LSM6DSM_ACC_GYRO_DRDY_ON_INT1_t
* Output : Status of DRDY_ON_INT1 see LSM6DSM_ACC_GYRO_DRDY_ON_INT1_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_DRDY_ON_INT1(void *handle, LSM6DSM_ACC_GYRO_DRDY_ON_INT1_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MASTER_CONFIG, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_DRDY_ON_INT1_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_Z_WU
* Description : Read Z_WU
* Input : Pointer to LSM6DSM_ACC_GYRO_Z_WU_t
* Output : Status of Z_WU see LSM6DSM_ACC_GYRO_Z_WU_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_Z_WU(void *handle, LSM6DSM_ACC_GYRO_Z_WU_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_Z_WU_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_Y_WU
* Description : Read Y_WU
* Input : Pointer to LSM6DSM_ACC_GYRO_Y_WU_t
* Output : Status of Y_WU see LSM6DSM_ACC_GYRO_Y_WU_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_Y_WU(void *handle, LSM6DSM_ACC_GYRO_Y_WU_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_Y_WU_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_X_WU
* Description : Read X_WU
* Input : Pointer to LSM6DSM_ACC_GYRO_X_WU_t
* Output : Status of X_WU see LSM6DSM_ACC_GYRO_X_WU_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_X_WU(void *handle, LSM6DSM_ACC_GYRO_X_WU_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_X_WU_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_WU_EV_STATUS
* Description : Read WU_EV_STATUS
* Input : Pointer to LSM6DSM_ACC_GYRO_WU_EV_status_t
* Output : Status of WU_EV_STATUS see LSM6DSM_ACC_GYRO_WU_EV_status_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_WU_EV_STATUS(void *handle, LSM6DSM_ACC_GYRO_WU_EV_STATUS_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_WU_EV_STATUS_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_SLEEP_EV_STATUS
* Description : Read SLEEP_EV_STATUS
* Input : Pointer to LSM6DSM_ACC_GYRO_SLEEP_EV_status_t
* Output : Status of SLEEP_EV_STATUS see LSM6DSM_ACC_GYRO_SLEEP_EV_status_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_SLEEP_EV_STATUS(void *handle, LSM6DSM_ACC_GYRO_SLEEP_EV_STATUS_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_SLEEP_EV_STATUS_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_FF_EV_STATUS
* Description : Read FF_EV_STATUS
* Input : Pointer to LSM6DSM_ACC_GYRO_FF_EV_status_t
* Output : Status of FF_EV_STATUS see LSM6DSM_ACC_GYRO_FF_EV_status_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_FF_EV_STATUS(void *handle, LSM6DSM_ACC_GYRO_FF_EV_STATUS_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_FF_EV_STATUS_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_Z_TAP
* Description : Read Z_TAP
* Input : Pointer to LSM6DSM_ACC_GYRO_Z_TAP_t
* Output : Status of Z_TAP see LSM6DSM_ACC_GYRO_Z_TAP_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_Z_TAP(void *handle, LSM6DSM_ACC_GYRO_Z_TAP_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_TAP_SRC, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_Z_TAP_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_Y_TAP
* Description : Read Y_TAP
* Input : Pointer to LSM6DSM_ACC_GYRO_Y_TAP_t
* Output : Status of Y_TAP see LSM6DSM_ACC_GYRO_Y_TAP_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_Y_TAP(void *handle, LSM6DSM_ACC_GYRO_Y_TAP_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_TAP_SRC, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_Y_TAP_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_X_TAP
* Description : Read X_TAP
* Input : Pointer to LSM6DSM_ACC_GYRO_X_TAP_t
* Output : Status of X_TAP see LSM6DSM_ACC_GYRO_X_TAP_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_X_TAP(void *handle, LSM6DSM_ACC_GYRO_X_TAP_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_TAP_SRC, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_X_TAP_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_TAP_SIGN
* Description : Read TAP_SIGN
* Input : Pointer to LSM6DSM_ACC_GYRO_TAP_SIGN_t
* Output : Status of TAP_SIGN see LSM6DSM_ACC_GYRO_TAP_SIGN_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_TAP_SIGN(void *handle, LSM6DSM_ACC_GYRO_TAP_SIGN_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_TAP_SRC, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_TAP_SIGN_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_DOUBLE_TAP_EV_STATUS
* Description : Read DOUBLE_TAP_EV_STATUS
* Input : Pointer to LSM6DSM_ACC_GYRO_DOUBLE_TAP_EV_status_t
* Output : Status of DOUBLE_TAP_EV_STATUS see LSM6DSM_ACC_GYRO_DOUBLE_TAP_EV_status_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_DOUBLE_TAP_EV_STATUS(void *handle, LSM6DSM_ACC_GYRO_DOUBLE_TAP_EV_STATUS_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_TAP_SRC, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_DOUBLE_TAP_EV_STATUS_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_SINGLE_TAP_EV_STATUS
* Description : Read SINGLE_TAP_EV_STATUS
* Input : Pointer to LSM6DSM_ACC_GYRO_SINGLE_TAP_EV_status_t
* Output : Status of SINGLE_TAP_EV_STATUS see LSM6DSM_ACC_GYRO_SINGLE_TAP_EV_status_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_SINGLE_TAP_EV_STATUS(void *handle, LSM6DSM_ACC_GYRO_SINGLE_TAP_EV_STATUS_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_TAP_SRC, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_SINGLE_TAP_EV_STATUS_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_TAP_EV_STATUS
* Description : Read TAP_EV_STATUS
* Input : Pointer to LSM6DSM_ACC_GYRO_TAP_EV_status_t
* Output : Status of TAP_EV_STATUS see LSM6DSM_ACC_GYRO_TAP_EV_status_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_TAP_EV_STATUS(void *handle, LSM6DSM_ACC_GYRO_TAP_EV_STATUS_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_TAP_SRC, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_TAP_EV_STATUS_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_DSD_XL
* Description : Read DSD_XL
* Input : Pointer to LSM6DSM_ACC_GYRO_DSD_XL_t
* Output : Status of DSD_XL see LSM6DSM_ACC_GYRO_DSD_XL_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_DSD_XL(void *handle, LSM6DSM_ACC_GYRO_DSD_XL_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_D6D_SRC, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_DSD_XL_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_DSD_XH
* Description : Read DSD_XH
* Input : Pointer to LSM6DSM_ACC_GYRO_DSD_XH_t
* Output : Status of DSD_XH see LSM6DSM_ACC_GYRO_DSD_XH_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_DSD_XH(void *handle, LSM6DSM_ACC_GYRO_DSD_XH_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_D6D_SRC, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_DSD_XH_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_DSD_YL
* Description : Read DSD_YL
* Input : Pointer to LSM6DSM_ACC_GYRO_DSD_YL_t
* Output : Status of DSD_YL see LSM6DSM_ACC_GYRO_DSD_YL_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_DSD_YL(void *handle, LSM6DSM_ACC_GYRO_DSD_YL_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_D6D_SRC, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_DSD_YL_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_DSD_YH
* Description : Read DSD_YH
* Input : Pointer to LSM6DSM_ACC_GYRO_DSD_YH_t
* Output : Status of DSD_YH see LSM6DSM_ACC_GYRO_DSD_YH_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_DSD_YH(void *handle, LSM6DSM_ACC_GYRO_DSD_YH_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_D6D_SRC, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_DSD_YH_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_DSD_ZL
* Description : Read DSD_ZL
* Input : Pointer to LSM6DSM_ACC_GYRO_DSD_ZL_t
* Output : Status of DSD_ZL see LSM6DSM_ACC_GYRO_DSD_ZL_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_DSD_ZL(void *handle, LSM6DSM_ACC_GYRO_DSD_ZL_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_D6D_SRC, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_DSD_ZL_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_DSD_ZH
* Description : Read DSD_ZH
* Input : Pointer to LSM6DSM_ACC_GYRO_DSD_ZH_t
* Output : Status of DSD_ZH see LSM6DSM_ACC_GYRO_DSD_ZH_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_DSD_ZH(void *handle, LSM6DSM_ACC_GYRO_DSD_ZH_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_D6D_SRC, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_DSD_ZH_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_D6D_EV_STATUS
* Description : Read D6D_EV_STATUS
* Input : Pointer to LSM6DSM_ACC_GYRO_D6D_EV_status_t
* Output : Status of D6D_EV_STATUS see LSM6DSM_ACC_GYRO_D6D_EV_status_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_D6D_EV_STATUS(void *handle, LSM6DSM_ACC_GYRO_D6D_EV_STATUS_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_D6D_SRC, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_D6D_EV_STATUS_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_XLDA
* Description : Read XLDA
* Input : Pointer to LSM6DSM_ACC_GYRO_XLDA_t
* Output : Status of XLDA see LSM6DSM_ACC_GYRO_XLDA_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_XLDA(void *handle, LSM6DSM_ACC_GYRO_XLDA_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_STATUS_REG, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_XLDA_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_GDA
* Description : Read GDA
* Input : Pointer to LSM6DSM_ACC_GYRO_GDA_t
* Output : Status of GDA see LSM6DSM_ACC_GYRO_GDA_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_GDA(void *handle, LSM6DSM_ACC_GYRO_GDA_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_STATUS_REG, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_GDA_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_TDA
* Description : Read GDA
* Input : Pointer to LSM6DSM_ACC_GYRO_TDA_t
* Output : Status of GDA see LSM6DSM_ACC_GYRO_TDA_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_TDA(void *handle, LSM6DSM_ACC_GYRO_TDA_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_STATUS_REG, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_TDA_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_FIFONumOfEntries
* Description : Read DIFF_FIFO
* Input : Pointer to u16_t
* Output : Status of DIFF_FIFO
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_FIFONumOfEntries(void *handle, u16_t *value)
{
u8_t valueH, valueL;
/* Low part from FIFO_STATUS1 */
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FIFO_STATUS1, (u8_t *)&valueL) )
return MEMS_ERROR;
valueL &= LSM6DSM_ACC_GYRO_DIFF_FIFO_STATUS1_MASK; //coerce
valueL = valueL >> LSM6DSM_ACC_GYRO_DIFF_FIFO_STATUS1_POSITION; //mask
/* High part from FIFO_STATUS2 */
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FIFO_STATUS2, (u8_t *)&valueH) )
return MEMS_ERROR;
valueH &= LSM6DSM_ACC_GYRO_DIFF_FIFO_STATUS2_MASK; //coerce
valueH = valueH >> LSM6DSM_ACC_GYRO_DIFF_FIFO_STATUS2_POSITION; //mask
*value = ((valueH << 8) & 0xFF00) | valueL;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_FIFOEmpty
* Description : Read FIFO_EMPTY
* Input : Pointer to LSM6DSM_ACC_GYRO_FIFO_EMPTY_t
* Output : Status of FIFO_EMPTY see LSM6DSM_ACC_GYRO_FIFO_EMPTY_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_FIFOEmpty(void *handle, LSM6DSM_ACC_GYRO_FIFO_EMPTY_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FIFO_STATUS2, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_FIFO_EMPTY_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_FIFOFull
* Description : Read FIFO_FULL
* Input : Pointer to LSM6DSM_ACC_GYRO_FIFO_FULL_t
* Output : Status of FIFO_FULL see LSM6DSM_ACC_GYRO_FIFO_FULL_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_FIFOFull(void *handle, LSM6DSM_ACC_GYRO_FIFO_FULL_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FIFO_STATUS2, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_FIFO_FULL_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_OVERRUN
* Description : Read OVERRUN
* Input : Pointer to LSM6DSM_ACC_GYRO_OVERRUN_t
* Output : Status of OVERRUN see LSM6DSM_ACC_GYRO_OVERRUN_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_OVERRUN(void *handle, LSM6DSM_ACC_GYRO_OVERRUN_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FIFO_STATUS2, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_OVERRUN_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_WaterMark
* Description : Read WTM
* Input : Pointer to LSM6DSM_ACC_GYRO_WTM_t
* Output : Status of WTM see LSM6DSM_ACC_GYRO_WTM_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_WaterMark(void *handle, LSM6DSM_ACC_GYRO_WTM_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FIFO_STATUS2, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_WTM_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_FIFOPattern
* Description : Read FIFO_PATTERN
* Input : Pointer to u16_t
* Output : Status of FIFO_PATTERN
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_FIFOPattern(void *handle, u16_t *value)
{
u8_t valueH, valueL;
/* Low part from FIFO_STATUS3 */
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FIFO_STATUS3, (u8_t *)&valueL) )
return MEMS_ERROR;
valueL &= LSM6DSM_ACC_GYRO_FIFO_STATUS3_PATTERN_MASK; //coerce
valueL = valueL >> LSM6DSM_ACC_GYRO_FIFO_STATUS3_PATTERN_POSITION; //mask
/* High part from FIFO_STATUS4 */
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FIFO_STATUS4, (u8_t *)&valueH) )
return MEMS_ERROR;
valueH &= LSM6DSM_ACC_GYRO_FIFO_STATUS4_PATTERN_MASK; //coerce
valueH = valueH >> LSM6DSM_ACC_GYRO_FIFO_STATUS4_PATTERN_POSITION; //mask
*value = ((valueH << 8) & 0xFF00) | valueL;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_SENS_HUB_END
* Description : Read SENS_HUB_END
* Input : Pointer to LSM6DSM_ACC_GYRO_SENS_HUB_END_t
* Output : Status of SENS_HUB_END see LSM6DSM_ACC_GYRO_SENS_HUB_END_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_SENS_HUB_END(void *handle, LSM6DSM_ACC_GYRO_SENS_HUB_END_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FUNC_SRC, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_SENS_HUB_END_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_SOFT_IRON_END
* Description : Read SOFT_IRON_END
* Input : Pointer to LSM6DSM_ACC_GYRO_SOFT_IRON_END_t
* Output : Status of SOFT_IRON_END see LSM6DSM_ACC_GYRO_SOFT_IRON_END_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_SOFT_IRON_END(void *handle, LSM6DSM_ACC_GYRO_SOFT_IRON_END_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FUNC_SRC, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_SOFT_IRON_END_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_HardIron
* Description : Read HI_FAIL
* Input : Pointer to LSM6DSM_ACC_GYRO_SOFT_HARD_IRON_STAT_t
* Output : Status of HI_FAIL see LSM6DSM_ACC_GYRO_SOFT_HARD_IRON_STAT_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_HardIron(void *handle, LSM6DSM_ACC_GYRO_SOFT_HARD_IRON_STAT_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FUNC_SRC, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_HARD_IRON_STAT_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_STEP_OVERFLOW
* Description : Read STEP_OVERFLOW
* Input : Pointer to LSM6DSM_ACC_GYRO_STEP_OVERFLOW_t
* Output : Status of STEP_OVERFLOW see LSM6DSM_ACC_GYRO_STEP_OVERFLOW_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_STEP_OVERFLOW(void *handle, LSM6DSM_ACC_GYRO_STEP_OVERFLOW_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FUNC_SRC, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_STEP_OVERFLOW_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_STEP_COUNT_DELTA
* Description : Read STEP_COUNT_DELTA_IA
* Input : Pointer to LSM6DSM_ACC_GYRO_STEP_COUNT_DELTA_t
* Output : Status of STEP_COUNT_DELTA_IA see LSM6DSM_ACC_GYRO_STEP_COUNT_DELTA_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_STEP_COUNT_DELTA(void *handle, LSM6DSM_ACC_GYRO_STEP_COUNT_DELTA_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FUNC_SRC, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_STEP_COUNT_DELTA_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_PEDO_EV_STATUS
* Description : Read PEDO_EV_STATUS
* Input : Pointer to LSM6DSM_ACC_GYRO_PEDO_EV_status_t
* Output : Status of PEDO_EV_STATUS see LSM6DSM_ACC_GYRO_PEDO_EV_status_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_PEDO_EV_STATUS(void *handle, LSM6DSM_ACC_GYRO_PEDO_EV_STATUS_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FUNC_SRC, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_PEDO_EV_STATUS_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_TILT_EV_STATUS
* Description : Read TILT_EV_STATUS
* Input : Pointer to LSM6DSM_ACC_GYRO_TILT_EV_status_t
* Output : Status of TILT_EV_STATUS see LSM6DSM_ACC_GYRO_TILT_EV_status_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_TILT_EV_STATUS(void *handle, LSM6DSM_ACC_GYRO_TILT_EV_STATUS_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FUNC_SRC, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_TILT_EV_STATUS_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_SIGN_MOT_EV_STATUS
* Description : Read SIGN_MOT_EV_STATUS
* Input : Pointer to LSM6DSM_ACC_GYRO_SIGN_MOT_EV_status_t
* Output : Status of SIGN_MOT_EV_STATUS see LSM6DSM_ACC_GYRO_SIGN_MOT_EV_status_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_SIGN_MOT_EV_STATUS(void *handle, LSM6DSM_ACC_GYRO_SIGN_MOT_EV_STATUS_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FUNC_SRC, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_SIGN_MOT_EV_STATUS_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_LIR
* Description : Write LIR
* Input : LSM6DSM_ACC_GYRO_LIR_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_LIR(void *handle, LSM6DSM_ACC_GYRO_LIR_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_TAP_CFG1, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_LIR_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_TAP_CFG1, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_LIR
* Description : Read LIR
* Input : Pointer to LSM6DSM_ACC_GYRO_LIR_t
* Output : Status of LIR see LSM6DSM_ACC_GYRO_LIR_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_LIR(void *handle, LSM6DSM_ACC_GYRO_LIR_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_TAP_CFG1, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_LIR_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_TAP_Z_EN
* Description : Write TAP_Z_EN
* Input : LSM6DSM_ACC_GYRO_TAP_Z_EN_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_TAP_Z_EN(void *handle, LSM6DSM_ACC_GYRO_TAP_Z_EN_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_TAP_CFG1, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_TAP_Z_EN_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_TAP_CFG1, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_TAP_Z_EN
* Description : Read TAP_Z_EN
* Input : Pointer to LSM6DSM_ACC_GYRO_TAP_Z_EN_t
* Output : Status of TAP_Z_EN see LSM6DSM_ACC_GYRO_TAP_Z_EN_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_TAP_Z_EN(void *handle, LSM6DSM_ACC_GYRO_TAP_Z_EN_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_TAP_CFG1, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_TAP_Z_EN_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_TAP_Y_EN
* Description : Write TAP_Y_EN
* Input : LSM6DSM_ACC_GYRO_TAP_Y_EN_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_TAP_Y_EN(void *handle, LSM6DSM_ACC_GYRO_TAP_Y_EN_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_TAP_CFG1, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_TAP_Y_EN_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_TAP_CFG1, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_TAP_Y_EN
* Description : Read TAP_Y_EN
* Input : Pointer to LSM6DSM_ACC_GYRO_TAP_Y_EN_t
* Output : Status of TAP_Y_EN see LSM6DSM_ACC_GYRO_TAP_Y_EN_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_TAP_Y_EN(void *handle, LSM6DSM_ACC_GYRO_TAP_Y_EN_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_TAP_CFG1, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_TAP_Y_EN_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_TAP_X_EN
* Description : Write TAP_X_EN
* Input : LSM6DSM_ACC_GYRO_TAP_X_EN_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_TAP_X_EN(void *handle, LSM6DSM_ACC_GYRO_TAP_X_EN_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_TAP_CFG1, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_TAP_X_EN_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_TAP_CFG1, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_TAP_X_EN
* Description : Read TAP_X_EN
* Input : Pointer to LSM6DSM_ACC_GYRO_TAP_X_EN_t
* Output : Status of TAP_X_EN see LSM6DSM_ACC_GYRO_TAP_X_EN_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_TAP_X_EN(void *handle, LSM6DSM_ACC_GYRO_TAP_X_EN_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_TAP_CFG1, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_TAP_X_EN_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_SLOPE_FDS
* Description : Write SLOPE_FDS
* Input : LSM6DSM_ACC_GYRO_SLOPE_FDS_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_SLOPE_FDS(void *handle, LSM6DSM_ACC_GYRO_SLOPE_FDS_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_TAP_CFG1, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_SLOPE_FDS_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_TAP_CFG1, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_SLOPE_FDS
* Description : Read SLOPE_FDS
* Input : Pointer to LSM6DSM_ACC_GYRO_SLOPE_FDS_t
* Output : Status of SLOPE_FDS see LSM6DSM_ACC_GYRO_SLOPE_FDS_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_SLOPE_FDS(void *handle, LSM6DSM_ACC_GYRO_SLOPE_FDS_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_TAP_CFG1, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_SLOPE_FDS_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_BASIC_INT
* Description : Write INTERRUPTS_ENABLE
* Input : LSM6DSM_ACC_GYRO_INT_EN_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_BASIC_INT(void *handle, LSM6DSM_ACC_GYRO_INT_EN_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_TAP_CFG1, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_INT_EN_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_TAP_CFG1, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_BASIC_INT
* Description : Read INTERRUPTS_ENABLE
* Input : Pointer to LSM6DSM_ACC_GYRO_INT_EN_t
* Output : Status of INTERRUPTS_ENABLE see LSM6DSM_ACC_GYRO_INT_EN_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_BASIC_INT(void *handle, LSM6DSM_ACC_GYRO_INT_EN_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_TAP_CFG1, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_INT_EN_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_TAP_THS
* Description : Write TAP_THS
* Input : u8_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_TAP_THS(void *handle, u8_t newValue)
{
u8_t value;
newValue = newValue << LSM6DSM_ACC_GYRO_TAP_THS_POSITION; //mask
newValue &= LSM6DSM_ACC_GYRO_TAP_THS_MASK; //coerce
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_TAP_THS_6D, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_TAP_THS_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_TAP_THS_6D, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_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]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_TAP_THS(void *handle, u8_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_TAP_THS_6D, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_TAP_THS_MASK; //coerce
*value = *value >> LSM6DSM_ACC_GYRO_TAP_THS_POSITION; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_SIXD_THS
* Description : Write SIXD_THS
* Input : LSM6DSM_ACC_GYRO_SIXD_THS_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_SIXD_THS(void *handle, LSM6DSM_ACC_GYRO_SIXD_THS_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_TAP_THS_6D, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_SIXD_THS_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_TAP_THS_6D, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_SIXD_THS
* Description : Read SIXD_THS
* Input : Pointer to LSM6DSM_ACC_GYRO_SIXD_THS_t
* Output : Status of SIXD_THS see LSM6DSM_ACC_GYRO_SIXD_THS_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_SIXD_THS(void *handle, LSM6DSM_ACC_GYRO_SIXD_THS_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_TAP_THS_6D, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_SIXD_THS_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_D4D
* Description : Write D4D_EN
* Input : LSM6DSM_ACC_GYRO_D4D_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_D4D(void *handle, LSM6DSM_ACC_GYRO_D4D_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_TAP_THS_6D, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_D4D_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_TAP_THS_6D, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_D4D
* Description : Read D4D_EN
* Input : Pointer to LSM6DSM_ACC_GYRO_D4D_t
* Output : Status of D4D_EN see LSM6DSM_ACC_GYRO_D4D_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_D4D(void *handle, LSM6DSM_ACC_GYRO_D4D_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_TAP_THS_6D, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_D4D_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_SHOCK_Duration
* Description : Write SHOCK
* Input : u8_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_SHOCK_Duration(void *handle, u8_t newValue)
{
u8_t value;
newValue = newValue << LSM6DSM_ACC_GYRO_SHOCK_POSITION; //mask
newValue &= LSM6DSM_ACC_GYRO_SHOCK_MASK; //coerce
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT_DUR2, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_SHOCK_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_INT_DUR2, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_SHOCK_Duration
* Description : Read SHOCK
* Input : Pointer to u8_t
* Output : Status of SHOCK
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_SHOCK_Duration(void *handle, u8_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT_DUR2, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_SHOCK_MASK; //coerce
*value = *value >> LSM6DSM_ACC_GYRO_SHOCK_POSITION; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_QUIET_Duration
* Description : Write QUIET
* Input : u8_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_QUIET_Duration(void *handle, u8_t newValue)
{
u8_t value;
newValue = newValue << LSM6DSM_ACC_GYRO_QUIET_POSITION; //mask
newValue &= LSM6DSM_ACC_GYRO_QUIET_MASK; //coerce
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT_DUR2, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_QUIET_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_INT_DUR2, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_QUIET_Duration
* Description : Read QUIET
* Input : Pointer to u8_t
* Output : Status of QUIET
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_QUIET_Duration(void *handle, u8_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT_DUR2, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_QUIET_MASK; //coerce
*value = *value >> LSM6DSM_ACC_GYRO_QUIET_POSITION; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_DUR
* Description : Write DUR
* Input : u8_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_DUR(void *handle, u8_t newValue)
{
u8_t value;
newValue = newValue << LSM6DSM_ACC_GYRO_DUR_POSITION; //mask
newValue &= LSM6DSM_ACC_GYRO_DUR_MASK; //coerce
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT_DUR2, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_DUR_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_INT_DUR2, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_DUR
* Description : Read DUR
* Input : Pointer to u8_t
* Output : Status of DUR
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_DUR(void *handle, u8_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_INT_DUR2, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_DUR_MASK; //coerce
*value = *value >> LSM6DSM_ACC_GYRO_DUR_POSITION; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_WK_THS
* Description : Write WK_THS
* Input : u8_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_WK_THS(void *handle, u8_t newValue)
{
u8_t value;
newValue = newValue << LSM6DSM_ACC_GYRO_WK_THS_POSITION; //mask
newValue &= LSM6DSM_ACC_GYRO_WK_THS_MASK; //coerce
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_WAKE_UP_THS, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_WK_THS_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_WAKE_UP_THS, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_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]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_WK_THS(void *handle, u8_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_WAKE_UP_THS, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_WK_THS_MASK; //coerce
*value = *value >> LSM6DSM_ACC_GYRO_WK_THS_POSITION; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_SINGLE_DOUBLE_TAP_EV
* Description : Write SINGLE_DOUBLE_TAP
* Input : LSM6DSM_ACC_GYRO_SINGLE_DOUBLE_TAP_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_SINGLE_DOUBLE_TAP_EV(void *handle, LSM6DSM_ACC_GYRO_SINGLE_DOUBLE_TAP_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_WAKE_UP_THS, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_SINGLE_DOUBLE_TAP_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_WAKE_UP_THS, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_SINGLE_DOUBLE_TAP_EV
* Description : Read SINGLE_DOUBLE_TAP
* Input : Pointer to LSM6DSM_ACC_GYRO_SINGLE_DOUBLE_TAP_t
* Output : Status of SINGLE_DOUBLE_TAP see LSM6DSM_ACC_GYRO_SINGLE_DOUBLE_TAP_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_SINGLE_DOUBLE_TAP_EV(void *handle, LSM6DSM_ACC_GYRO_SINGLE_DOUBLE_TAP_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_WAKE_UP_THS, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_SINGLE_DOUBLE_TAP_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_SLEEP_DUR
* Description : Write SLEEP_DUR
* Input : u8_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_SLEEP_DUR(void *handle, u8_t newValue)
{
u8_t value;
newValue = newValue << LSM6DSM_ACC_GYRO_SLEEP_DUR_POSITION; //mask
newValue &= LSM6DSM_ACC_GYRO_SLEEP_DUR_MASK; //coerce
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_WAKE_UP_DUR, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_SLEEP_DUR_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_WAKE_UP_DUR, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_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]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_SLEEP_DUR(void *handle, u8_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_WAKE_UP_DUR, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_SLEEP_DUR_MASK; //coerce
*value = *value >> LSM6DSM_ACC_GYRO_SLEEP_DUR_POSITION; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_TIMER_HR
* Description : Write TIMER_HR
* Input : LSM6DSM_ACC_GYRO_TIMER_HR_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_TIMER_HR(void *handle, LSM6DSM_ACC_GYRO_TIMER_HR_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_WAKE_UP_DUR, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_TIMER_HR_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_WAKE_UP_DUR, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_TIMER_HR
* Description : Read TIMER_HR
* Input : Pointer to LSM6DSM_ACC_GYRO_TIMER_HR_t
* Output : Status of TIMER_HR see LSM6DSM_ACC_GYRO_TIMER_HR_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_TIMER_HR(void *handle, LSM6DSM_ACC_GYRO_TIMER_HR_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_WAKE_UP_DUR, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_TIMER_HR_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_WAKE_DUR
* Description : Write WAKE_DUR
* Input : u8_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_WAKE_DUR(void *handle, u8_t newValue)
{
u8_t value;
newValue = newValue << LSM6DSM_ACC_GYRO_WAKE_DUR_POSITION; //mask
newValue &= LSM6DSM_ACC_GYRO_WAKE_DUR_MASK; //coerce
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_WAKE_UP_DUR, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_WAKE_DUR_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_WAKE_UP_DUR, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_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]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_WAKE_DUR(void *handle, u8_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_WAKE_UP_DUR, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_WAKE_DUR_MASK; //coerce
*value = *value >> LSM6DSM_ACC_GYRO_WAKE_DUR_POSITION; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_FF_THS
* Description : Write FF_THS
* Input : LSM6DSM_ACC_GYRO_FF_THS_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_FF_THS(void *handle, LSM6DSM_ACC_GYRO_FF_THS_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FREE_FALL, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_FF_THS_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_FREE_FALL, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_FF_THS
* Description : Read FF_THS
* Input : Pointer to LSM6DSM_ACC_GYRO_FF_THS_t
* Output : Status of FF_THS see LSM6DSM_ACC_GYRO_FF_THS_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_FF_THS(void *handle, LSM6DSM_ACC_GYRO_FF_THS_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FREE_FALL, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_FF_THS_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_FF_Duration
* Description : Write FF_DUR
* Input : u8_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_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 << LSM6DSM_ACC_GYRO_FF_FREE_FALL_DUR_POSITION; //mask
valueL &= LSM6DSM_ACC_GYRO_FF_FREE_FALL_DUR_MASK; //coerce
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FREE_FALL, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_FF_FREE_FALL_DUR_MASK;
value |= valueL;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_FREE_FALL, value) )
return MEMS_ERROR;
/* High part in WAKE_UP_DUR reg */
valueH = valueH << LSM6DSM_ACC_GYRO_FF_WAKE_UP_DUR_POSITION; //mask
valueH &= LSM6DSM_ACC_GYRO_FF_WAKE_UP_DUR_MASK; //coerce
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_WAKE_UP_DUR, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_FF_WAKE_UP_DUR_MASK;
value |= valueH;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_WAKE_UP_DUR, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_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]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_FF_Duration(void *handle, u8_t *value)
{
u8_t valueH, valueL;
/* Low part from FREE_FALL reg */
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FREE_FALL, (u8_t *)&valueL) )
return MEMS_ERROR;
valueL &= LSM6DSM_ACC_GYRO_FF_FREE_FALL_DUR_MASK; //coerce
valueL = valueL >> LSM6DSM_ACC_GYRO_FF_FREE_FALL_DUR_POSITION; //mask
/* High part from WAKE_UP_DUR reg */
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_WAKE_UP_DUR, (u8_t *)&valueH) )
return MEMS_ERROR;
valueH &= LSM6DSM_ACC_GYRO_FF_WAKE_UP_DUR_MASK; //coerce
valueH = valueH >> LSM6DSM_ACC_GYRO_FF_WAKE_UP_DUR_POSITION; //mask
*value = ((valueH << 5) & 0x20) | valueL;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_TimerEvRouteInt1
* Description : Write INT1_TIMER
* Input : LSM6DSM_ACC_GYRO_INT1_TIMER_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_TimerEvRouteInt1(void *handle, LSM6DSM_ACC_GYRO_INT1_TIMER_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MD1_CFG, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_INT1_TIMER_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_MD1_CFG, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_TimerEvRouteInt1
* Description : Read INT1_TIMER
* Input : Pointer to LSM6DSM_ACC_GYRO_INT1_TIMER_t
* Output : Status of INT1_TIMER see LSM6DSM_ACC_GYRO_INT1_TIMER_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_TimerEvRouteInt1(void *handle, LSM6DSM_ACC_GYRO_INT1_TIMER_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MD1_CFG, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_INT1_TIMER_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_TiltEvOnInt1
* Description : Write INT1_TILT
* Input : LSM6DSM_ACC_GYRO_INT1_TILT_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_TiltEvOnInt1(void *handle, LSM6DSM_ACC_GYRO_INT1_TILT_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MD1_CFG, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_INT1_TILT_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_MD1_CFG, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_TiltEvOnInt1
* Description : Read INT1_TILT
* Input : Pointer to LSM6DSM_ACC_GYRO_INT1_TILT_t
* Output : Status of INT1_TILT see LSM6DSM_ACC_GYRO_INT1_TILT_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_TiltEvOnInt1(void *handle, LSM6DSM_ACC_GYRO_INT1_TILT_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MD1_CFG, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_INT1_TILT_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_6DEvOnInt1
* Description : Write INT1_6D
* Input : LSM6DSM_ACC_GYRO_INT1_6D_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_6DEvOnInt1(void *handle, LSM6DSM_ACC_GYRO_INT1_6D_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MD1_CFG, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_INT1_6D_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_MD1_CFG, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_6DEvOnInt1
* Description : Read INT1_6D
* Input : Pointer to LSM6DSM_ACC_GYRO_INT1_6D_t
* Output : Status of INT1_6D see LSM6DSM_ACC_GYRO_INT1_6D_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_6DEvOnInt1(void *handle, LSM6DSM_ACC_GYRO_INT1_6D_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MD1_CFG, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_INT1_6D_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_TapEvOnInt1
* Description : Write INT1_TAP
* Input : LSM6DSM_ACC_GYRO_INT1_TAP_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_TapEvOnInt1(void *handle, LSM6DSM_ACC_GYRO_INT1_TAP_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MD1_CFG, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_INT1_TAP_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_MD1_CFG, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_TapEvOnInt1
* Description : Read INT1_TAP
* Input : Pointer to LSM6DSM_ACC_GYRO_INT1_TAP_t
* Output : Status of INT1_TAP see LSM6DSM_ACC_GYRO_INT1_TAP_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_TapEvOnInt1(void *handle, LSM6DSM_ACC_GYRO_INT1_TAP_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MD1_CFG, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_INT1_TAP_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_FFEvOnInt1
* Description : Write INT1_FF
* Input : LSM6DSM_ACC_GYRO_INT1_FF_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_FFEvOnInt1(void *handle, LSM6DSM_ACC_GYRO_INT1_FF_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MD1_CFG, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_INT1_FF_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_MD1_CFG, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_FFEvOnInt1
* Description : Read INT1_FF
* Input : Pointer to LSM6DSM_ACC_GYRO_INT1_FF_t
* Output : Status of INT1_FF see LSM6DSM_ACC_GYRO_INT1_FF_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_FFEvOnInt1(void *handle, LSM6DSM_ACC_GYRO_INT1_FF_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MD1_CFG, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_INT1_FF_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_WUEvOnInt1
* Description : Write INT1_WU
* Input : LSM6DSM_ACC_GYRO_INT1_WU_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_WUEvOnInt1(void *handle, LSM6DSM_ACC_GYRO_INT1_WU_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MD1_CFG, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_INT1_WU_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_MD1_CFG, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_WUEvOnInt1
* Description : Read INT1_WU
* Input : Pointer to LSM6DSM_ACC_GYRO_INT1_WU_t
* Output : Status of INT1_WU see LSM6DSM_ACC_GYRO_INT1_WU_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_WUEvOnInt1(void *handle, LSM6DSM_ACC_GYRO_INT1_WU_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MD1_CFG, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_INT1_WU_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_SingleTapOnInt1
* Description : Write INT1_SINGLE_TAP
* Input : LSM6DSM_ACC_GYRO_INT1_SINGLE_TAP_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_SingleTapOnInt1(void *handle, LSM6DSM_ACC_GYRO_INT1_SINGLE_TAP_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MD1_CFG, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_INT1_SINGLE_TAP_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_MD1_CFG, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_SingleTapOnInt1
* Description : Read INT1_SINGLE_TAP
* Input : Pointer to LSM6DSM_ACC_GYRO_INT1_SINGLE_TAP_t
* Output : Status of INT1_SINGLE_TAP see LSM6DSM_ACC_GYRO_INT1_SINGLE_TAP_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_SingleTapOnInt1(void *handle, LSM6DSM_ACC_GYRO_INT1_SINGLE_TAP_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MD1_CFG, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_INT1_SINGLE_TAP_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_SleepEvOnInt1
* Description : Write INT1_SLEEP
* Input : LSM6DSM_ACC_GYRO_INT1_SLEEP_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_SleepEvOnInt1(void *handle, LSM6DSM_ACC_GYRO_INT1_SLEEP_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MD1_CFG, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_INT1_SLEEP_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_MD1_CFG, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_SleepEvOnInt1
* Description : Read INT1_SLEEP
* Input : Pointer to LSM6DSM_ACC_GYRO_INT1_SLEEP_t
* Output : Status of INT1_SLEEP see LSM6DSM_ACC_GYRO_INT1_SLEEP_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_SleepEvOnInt1(void *handle, LSM6DSM_ACC_GYRO_INT1_SLEEP_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MD1_CFG, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_INT1_SLEEP_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_MagCorrection_Int2
* Description : Write INT2_IRON
* Input : LSM6DSM_ACC_GYRO_INT2_IRON_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_MagCorrection_Int2(void *handle, LSM6DSM_ACC_GYRO_INT2_IRON_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MD2_CFG, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_INT2_IRON_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_MD2_CFG, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_MagCorrection_Int2
* Description : Read INT2_IRON
* Input : Pointer to LSM6DSM_ACC_GYRO_INT2_IRON_t
* Output : Status of INT2_IRON see LSM6DSM_ACC_GYRO_INT2_IRON_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_MagCorrection_Int2(void *handle, LSM6DSM_ACC_GYRO_INT2_IRON_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MD2_CFG, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_INT2_IRON_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_TiltEvOnInt2
* Description : Write INT2_TILT
* Input : LSM6DSM_ACC_GYRO_INT2_TILT_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_TiltEvOnInt2(void *handle, LSM6DSM_ACC_GYRO_INT2_TILT_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MD2_CFG, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_INT2_TILT_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_MD2_CFG, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_TiltEvOnInt2
* Description : Read INT2_TILT
* Input : Pointer to LSM6DSM_ACC_GYRO_INT2_TILT_t
* Output : Status of INT2_TILT see LSM6DSM_ACC_GYRO_INT2_TILT_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_TiltEvOnInt2(void *handle, LSM6DSM_ACC_GYRO_INT2_TILT_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MD2_CFG, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_INT2_TILT_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_6DEvOnInt2
* Description : Write INT2_6D
* Input : LSM6DSM_ACC_GYRO_INT2_6D_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_6DEvOnInt2(void *handle, LSM6DSM_ACC_GYRO_INT2_6D_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MD2_CFG, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_INT2_6D_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_MD2_CFG, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_6DEvOnInt2
* Description : Read INT2_6D
* Input : Pointer to LSM6DSM_ACC_GYRO_INT2_6D_t
* Output : Status of INT2_6D see LSM6DSM_ACC_GYRO_INT2_6D_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_6DEvOnInt2(void *handle, LSM6DSM_ACC_GYRO_INT2_6D_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MD2_CFG, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_INT2_6D_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_TapEvOnInt2
* Description : Write INT2_TAP
* Input : LSM6DSM_ACC_GYRO_INT2_TAP_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_TapEvOnInt2(void *handle, LSM6DSM_ACC_GYRO_INT2_TAP_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MD2_CFG, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_INT2_TAP_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_MD2_CFG, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_TapEvOnInt2
* Description : Read INT2_TAP
* Input : Pointer to LSM6DSM_ACC_GYRO_INT2_TAP_t
* Output : Status of INT2_TAP see LSM6DSM_ACC_GYRO_INT2_TAP_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_TapEvOnInt2(void *handle, LSM6DSM_ACC_GYRO_INT2_TAP_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MD2_CFG, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_INT2_TAP_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_FFEvOnInt2
* Description : Write INT2_FF
* Input : LSM6DSM_ACC_GYRO_INT2_FF_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_FFEvOnInt2(void *handle, LSM6DSM_ACC_GYRO_INT2_FF_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MD2_CFG, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_INT2_FF_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_MD2_CFG, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_FFEvOnInt2
* Description : Read INT2_FF
* Input : Pointer to LSM6DSM_ACC_GYRO_INT2_FF_t
* Output : Status of INT2_FF see LSM6DSM_ACC_GYRO_INT2_FF_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_FFEvOnInt2(void *handle, LSM6DSM_ACC_GYRO_INT2_FF_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MD2_CFG, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_INT2_FF_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_WUEvOnInt2
* Description : Write INT2_WU
* Input : LSM6DSM_ACC_GYRO_INT2_WU_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_WUEvOnInt2(void *handle, LSM6DSM_ACC_GYRO_INT2_WU_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MD2_CFG, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_INT2_WU_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_MD2_CFG, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_WUEvOnInt2
* Description : Read INT2_WU
* Input : Pointer to LSM6DSM_ACC_GYRO_INT2_WU_t
* Output : Status of INT2_WU see LSM6DSM_ACC_GYRO_INT2_WU_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_WUEvOnInt2(void *handle, LSM6DSM_ACC_GYRO_INT2_WU_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MD2_CFG, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_INT2_WU_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_SingleTapOnInt2
* Description : Write INT2_SINGLE_TAP
* Input : LSM6DSM_ACC_GYRO_INT2_SINGLE_TAP_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_SingleTapOnInt2(void *handle, LSM6DSM_ACC_GYRO_INT2_SINGLE_TAP_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MD2_CFG, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_INT2_SINGLE_TAP_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_MD2_CFG, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_SingleTapOnInt2
* Description : Read INT2_SINGLE_TAP
* Input : Pointer to LSM6DSM_ACC_GYRO_INT2_SINGLE_TAP_t
* Output : Status of INT2_SINGLE_TAP see LSM6DSM_ACC_GYRO_INT2_SINGLE_TAP_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_SingleTapOnInt2(void *handle, LSM6DSM_ACC_GYRO_INT2_SINGLE_TAP_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MD2_CFG, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_INT2_SINGLE_TAP_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_W_SleepEvOnInt2
* Description : Write INT2_SLEEP
* Input : LSM6DSM_ACC_GYRO_INT2_SLEEP_t
* Output : None
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_W_SleepEvOnInt2(void *handle, LSM6DSM_ACC_GYRO_INT2_SLEEP_t newValue)
{
u8_t value;
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MD2_CFG, &value) )
return MEMS_ERROR;
value &= ~LSM6DSM_ACC_GYRO_INT2_SLEEP_MASK;
value |= newValue;
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_MD2_CFG, value) )
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : LSM6DSM_ACC_GYRO_R_SleepEvOnInt2
* Description : Read INT2_SLEEP
* Input : Pointer to LSM6DSM_ACC_GYRO_INT2_SLEEP_t
* Output : Status of INT2_SLEEP see LSM6DSM_ACC_GYRO_INT2_SLEEP_t
* Return : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t LSM6DSM_ACC_GYRO_R_SleepEvOnInt2(void *handle, LSM6DSM_ACC_GYRO_INT2_SLEEP_t *value)
{
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_MD2_CFG, (u8_t *)value) )
return MEMS_ERROR;
*value &= LSM6DSM_ACC_GYRO_INT2_SLEEP_MASK; //mask
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : status_t LSM6DSM_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]
*******************************************************************************/
status_t LSM6DSM_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( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_OUTX_L_G+k, &buff[k]))
return MEMS_ERROR;
k++;
}
}
return MEMS_SUCCESS;
}
/*
* Following is the table of sensitivity values for each case.
* Values are espressed in udps/digit.
*/
static const long long LSM6DSM_GYRO_Sensitivity_List[5] = {
4375, /* FS [url=home.php?mod=space&uid=42867]@125[/url] */
8750, /* FS [url=home.php?mod=space&uid=454190]@245[/url] */
17500, /* FS @500 */
35000, /* FS [url=home.php?mod=space&uid=27776]@1000[/url] */
70000, /* FS [url=home.php?mod=space&uid=3290]@2000[/url] */
};
/*
* Returned values are espressed in mdps.
*/
status_t LSM6DSM_ACC_Get_AngularRate(void *handle, int *buff, u8_t from_fifo)
{
LSM6DSM_ACC_GYRO_FS_125_t fs_125;
LSM6DSM_ACC_GYRO_FS_G_t fs;
long long sensitivity=0;
Type3Axis16bit_U raw_data_tmp;
/* Read out current odr, fs, hf setting */
if(!LSM6DSM_ACC_GYRO_R_FS_125(handle, &fs_125)) {
return MEMS_ERROR;
}
if (fs_125 == LSM6DSM_ACC_GYRO_FS_125_ENABLED) {
sensitivity = LSM6DSM_GYRO_Sensitivity_List[0];
} else {
if(!LSM6DSM_ACC_GYRO_R_FS_G(handle, &fs)) {
return MEMS_ERROR;
}
/* Determine the sensitivity according to fs */
switch(fs) {
case LSM6DSM_ACC_GYRO_FS_G_245dps:
sensitivity = LSM6DSM_GYRO_Sensitivity_List[1];
break;
case LSM6DSM_ACC_GYRO_FS_G_500dps:
sensitivity = LSM6DSM_GYRO_Sensitivity_List[2];
break;
case LSM6DSM_ACC_GYRO_FS_G_1000dps:
sensitivity = LSM6DSM_GYRO_Sensitivity_List[3];
break;
case LSM6DSM_ACC_GYRO_FS_G_2000dps:
sensitivity = LSM6DSM_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++) {
if(!LSM6DSM_ACC_GYRO_Get_GetFIFOData(handle, raw_data_tmp.u8bit + 2*i)) {
return MEMS_ERROR;
}
}
} else {
if(!LSM6DSM_ACC_GYRO_GetRawGyroData(handle, raw_data_tmp.u8bit)) {
return MEMS_ERROR;
}
}
/* 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 : status_t LSM6DSM_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]
*******************************************************************************/
status_t LSM6DSM_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( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_OUTX_L_XL+k, &buff[k]))
return MEMS_ERROR;
k++;
}
}
return MEMS_SUCCESS;
}
/*
* Following is the table of sensitivity values for each case.
* Values are espressed in ug/digit.
*/
static const long long LSM6DSM_ACC_Sensitivity_List[4] = {
61, /* FS @2g */
122, /* FS @4g */
244, /* FS @8g */
488, /* FS @16g */
};
/*
* Returned values are espressed in mg.
*/
status_t LSM6DSM_ACC_Get_Acceleration(void *handle, int *buff, u8_t from_fifo)
{
LSM6DSM_ACC_GYRO_FS_XL_t fs;
long long sensitivity=0;
Type3Axis16bit_U raw_data_tmp;
/* Read out current odr, fs, hf setting */
if(!LSM6DSM_ACC_GYRO_R_FS_XL(handle, &fs)) {
return MEMS_ERROR;
}
/* Determine the sensitivity according to fs */
switch(fs) {
case LSM6DSM_ACC_GYRO_FS_XL_2g:
sensitivity = LSM6DSM_ACC_Sensitivity_List[0];
break;
case LSM6DSM_ACC_GYRO_FS_XL_4g:
sensitivity = LSM6DSM_ACC_Sensitivity_List[1];
break;
case LSM6DSM_ACC_GYRO_FS_XL_8g:
sensitivity = LSM6DSM_ACC_Sensitivity_List[2];
break;
case LSM6DSM_ACC_GYRO_FS_XL_16g:
sensitivity = LSM6DSM_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++) {
if(!LSM6DSM_ACC_GYRO_Get_GetFIFOData(handle, raw_data_tmp.u8bit + 2*i)) {
return MEMS_ERROR;
}
}
} else {
if(!LSM6DSM_ACC_GYRO_GetRawAccData(handle, raw_data_tmp.u8bit)) {
return MEMS_ERROR;
}
}
/* 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 : status_t LSM6DSM_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]
*******************************************************************************/
status_t LSM6DSM_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( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_FIFO_DATA_OUT_L+k, &buff[k]))
return MEMS_ERROR;
k++;
}
}
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : status_t LSM6DSM_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]
*******************************************************************************/
status_t LSM6DSM_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( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_TIMESTAMP0_REG+k, &buff[k]))
return MEMS_ERROR;
k++;
}
}
return MEMS_SUCCESS;
}
/*******************************************************************************
* Function Name : status_t LSM6DSM_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]
*******************************************************************************/
status_t LSM6DSM_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( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_STEP_COUNTER_L+k, &buff[k]))
return MEMS_ERROR;
k++;
}
}
return MEMS_SUCCESS;
}
/************** Program Pedometer Threshold *******************/
status_t LSM6DSM_ACC_GYRO_W_PedoThreshold(void *handle, u8_t newValue)
{
u8_t value;
/* Open Embedded Function Register page*/
if( !LSM6DSM_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSM_ACC_GYRO_EMBEDDED_ACCESS_ENABLED))
return MEMS_ERROR;
/* read current value */
if( !LSM6DSM_ACC_GYRO_ReadReg(handle, LSM6DSM_ACC_GYRO_CONFIG_PEDO_THS_MIN, &value))
return MEMS_ERROR;
value &= ~0x1F;
value |= (newValue & 0x1F);
/* write new value */
if( !LSM6DSM_ACC_GYRO_WriteReg(handle, LSM6DSM_ACC_GYRO_CONFIG_PEDO_THS_MIN, value))
return MEMS_ERROR;
/* Close Embedded Function Register page*/
if( !LSM6DSM_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSM_ACC_GYRO_EMBEDDED_ACCESS_DISABLED))
return MEMS_ERROR;
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.
*/
status_t LSM6DSM_ACC_GYRO_SH_init_SI_Matrix(void *handle, u8_t *SI_matrix)
{
/* Open Embedded Function Register page*/
if( !LSM6DSM_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSM_ACC_GYRO_EMBEDDED_ACCESS_ENABLED))
return MEMS_ERROR;
/* Write the Soft Iron Matrix coefficients */
if( !LSM6DSM_ACC_GYRO_WriteMem(handle, LSM6DSM_ACC_GYRO_MAG_SI_XX, SI_matrix, 9))
return MEMS_ERROR;
/* Close Embedded Function Register page*/
if( !LSM6DSM_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSM_ACC_GYRO_EMBEDDED_ACCESS_DISABLED))
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/* Read a remote device through I2C Sensor Hub Slave 0 */
status_t LSM6DSM_ACC_GYRO_SH0_Program(void *handle, u8_t SlvAddr, u8_t Reg, u8_t len)
{
/* Open Embedded Function Register page*/
if( !LSM6DSM_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSM_ACC_GYRO_EMBEDDED_ACCESS_ENABLED))
return MEMS_ERROR;
/* Write remote device I2C slave address */
SlvAddr |= 0x1; /* Raise the read op bit */
if( !LSM6DSM_ACC_GYRO_WriteMem(handle, LSM6DSM_ACC_GYRO_SLV0_ADD, &SlvAddr, 1))
return MEMS_ERROR;
/* Write remote device I2C subaddress */
if( !LSM6DSM_ACC_GYRO_WriteMem(handle, LSM6DSM_ACC_GYRO_SLV0_SUBADD, &Reg, 1))
return MEMS_ERROR;
/* Write number of bytes to read */
if( !LSM6DSM_ACC_GYRO_WriteMem(handle, LSM6DSM_ACC_GYRO_SLAVE0_CONFIG, &len, 1))
return MEMS_ERROR;
/* Close Embedded Function Register page*/
if( !LSM6DSM_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSM_ACC_GYRO_EMBEDDED_ACCESS_DISABLED))
return MEMS_ERROR;
/* Enable FUNC */
if( !LSM6DSM_ACC_GYRO_W_FUNC_EN(handle, LSM6DSM_ACC_GYRO_FUNC_EN_ENABLED))
return MEMS_ERROR;
/* Enable PULL_UP_EN and MASTER_EN */
if( !LSM6DSM_ACC_GYRO_W_PULL_UP_EN(handle, LSM6DSM_ACC_GYRO_PULL_UP_EN_ENABLED))
return MEMS_ERROR;
if( !LSM6DSM_ACC_GYRO_W_I2C_MASTER_Enable(handle, LSM6DSM_ACC_GYRO_MASTER_ON_ENABLED))
return MEMS_ERROR;
return MEMS_SUCCESS;
}
/* Read a remote device through I2C Sensor Hub Slave 0 */
status_t LSM6DSM_ACC_GYRO_SH0_ReadMem(void *handle, u8_t SlvAddr, u8_t Reg, u8_t *Bufp, u8_t len, u8_t stop)
{
LSM6DSM_ACC_GYRO_SENS_HUB_END_t op_cmpl = LSM6DSM_ACC_GYRO_SENS_HUB_END_STILL_ONGOING;
if( !LSM6DSM_ACC_GYRO_SH0_Program(handle, SlvAddr, Reg, len))
return MEMS_ERROR;
/* Wait until operation is not completed */
do {
if( !LSM6DSM_ACC_GYRO_R_SENS_HUB_END(handle, &op_cmpl))
return MEMS_ERROR;
} while(op_cmpl != LSM6DSM_ACC_GYRO_SENS_HUB_END_OP_COMPLETED);
/* Read the result */
if( !LSM6DSM_ACC_GYRO_ReadMem(handle, LSM6DSM_ACC_GYRO_SENSORHUB1_REG, Bufp, len))
return MEMS_ERROR;
if (stop) {
/* Stop everything */
if( !LSM6DSM_ACC_GYRO_W_FUNC_EN(handle, LSM6DSM_ACC_GYRO_FUNC_EN_DISABLED))
return MEMS_ERROR;
if( !LSM6DSM_ACC_GYRO_W_I2C_MASTER_Enable(handle, LSM6DSM_ACC_GYRO_MASTER_ON_DISABLED))
return MEMS_ERROR;
}
return MEMS_SUCCESS;
}
/* Write a remote device through I2C Sensor Hub Slave 0 */
status_t LSM6DSM_ACC_GYRO_SH0_WriteByte(void *handle, u8_t SlvAddr, u8_t Reg, u8_t Bufp)
{
/* Open Embedded Function Register page*/
if( !LSM6DSM_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSM_ACC_GYRO_EMBEDDED_ACCESS_ENABLED))
return MEMS_ERROR;
/* Write remote device I2C slave address */
if( !LSM6DSM_ACC_GYRO_WriteMem(handle, LSM6DSM_ACC_GYRO_SLV0_ADD, &SlvAddr, 1))
return MEMS_ERROR;
/* Write remote device I2C subaddress */
if( !LSM6DSM_ACC_GYRO_WriteMem(handle, LSM6DSM_ACC_GYRO_SLV0_SUBADD, &Reg, 1))
return MEMS_ERROR;
/* Write the data */
if( !LSM6DSM_ACC_GYRO_WriteMem(handle, LSM6DSM_ACC_GYRO_DATAWRITE_SRC_MODE_SUB_SLV0, &Bufp, 1))
return MEMS_ERROR;
/* Close Embedded Function Register page*/
if( !LSM6DSM_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSM_ACC_GYRO_EMBEDDED_ACCESS_DISABLED))
return MEMS_ERROR;
/* Enable FUNC */
if( !LSM6DSM_ACC_GYRO_W_FUNC_EN(handle, LSM6DSM_ACC_GYRO_FUNC_EN_ENABLED))
return MEMS_ERROR;
/* Enable PULL_UP_EN and MASTER_EN */
if( !LSM6DSM_ACC_GYRO_W_PULL_UP_EN(handle, LSM6DSM_ACC_GYRO_PULL_UP_EN_ENABLED))
return MEMS_ERROR;
if( !LSM6DSM_ACC_GYRO_W_I2C_MASTER_Enable(handle, LSM6DSM_ACC_GYRO_MASTER_ON_ENABLED))
return MEMS_ERROR;
/* Add 20ms of delay, because for now there's no write complete indication */
//Delay(20);
/* Stop everything */
if( !LSM6DSM_ACC_GYRO_W_FUNC_EN(handle, LSM6DSM_ACC_GYRO_FUNC_EN_DISABLED))
return MEMS_ERROR;
if( !LSM6DSM_ACC_GYRO_W_I2C_MASTER_Enable(handle, LSM6DSM_ACC_GYRO_MASTER_ON_DISABLED))
return MEMS_ERROR;
return MEMS_SUCCESS;
}

复制代码

xieyj · 发表于2017-12-21 18:17

littleshrimp 发表于 2017-12-21 18:14
试试官方的驱动库

[code]
/******************** (C) COPYRIGHT 2015 STMicroelectr ...

好的多谢版主

xieyj · 2017-12-22 14:17 上传

问题解决了，参考如图这两种配置就可以解决问题。解答留给遇到同样问题的童鞋们，不要感谢我，感谢版主！

LSM6DSM设置WAKE_UP_SRC寄存器不成功 [复制链接]

最新回复

点评

点评

点评

点评