Example of hello world for X-NUCLEO-IKS01A2

Dependencies:   X_NUCLEO_IKS01A2 mbed

Fork of HelloWorld_IKS01A2 by ST Expansion SW Team

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

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

Committer:
cparata
Date:
Fri Aug 12 13:40:12 2016 +0000
Revision:
0:69566eea0fba
First release of Hello World for IKS01A2

Who changed what in which revision?

UserRevisionLine numberNew contents of line
cparata 0:69566eea0fba 1 /**
cparata 0:69566eea0fba 2 ******************************************************************************
cparata 0:69566eea0fba 3 * @file LSM6DSL_ACC_GYRO_driver.c
cparata 0:69566eea0fba 4 * @author MEMS Application Team
cparata 0:69566eea0fba 5 * @version V1.5
cparata 0:69566eea0fba 6 * @date 17-May-2016
cparata 0:69566eea0fba 7 * @brief LSM6DSL driver file
cparata 0:69566eea0fba 8 ******************************************************************************
cparata 0:69566eea0fba 9 * @attention
cparata 0:69566eea0fba 10 *
cparata 0:69566eea0fba 11 * <h2><center>&copy; COPYRIGHT(c) 2016 STMicroelectronics</center></h2>
cparata 0:69566eea0fba 12 *
cparata 0:69566eea0fba 13 * Redistribution and use in source and binary forms, with or without modification,
cparata 0:69566eea0fba 14 * are permitted provided that the following conditions are met:
cparata 0:69566eea0fba 15 * 1. Redistributions of source code must retain the above copyright notice,
cparata 0:69566eea0fba 16 * this list of conditions and the following disclaimer.
cparata 0:69566eea0fba 17 * 2. Redistributions in binary form must reproduce the above copyright notice,
cparata 0:69566eea0fba 18 * this list of conditions and the following disclaimer in the documentation
cparata 0:69566eea0fba 19 * and/or other materials provided with the distribution.
cparata 0:69566eea0fba 20 * 3. Neither the name of STMicroelectronics nor the names of its contributors
cparata 0:69566eea0fba 21 * may be used to endorse or promote products derived from this software
cparata 0:69566eea0fba 22 * without specific prior written permission.
cparata 0:69566eea0fba 23 *
cparata 0:69566eea0fba 24 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
cparata 0:69566eea0fba 25 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
cparata 0:69566eea0fba 26 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
cparata 0:69566eea0fba 27 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
cparata 0:69566eea0fba 28 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
cparata 0:69566eea0fba 29 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
cparata 0:69566eea0fba 30 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
cparata 0:69566eea0fba 31 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
cparata 0:69566eea0fba 32 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
cparata 0:69566eea0fba 33 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
cparata 0:69566eea0fba 34 *
cparata 0:69566eea0fba 35 ******************************************************************************
cparata 0:69566eea0fba 36 */
cparata 0:69566eea0fba 37
cparata 0:69566eea0fba 38 /* Includes ------------------------------------------------------------------*/
cparata 0:69566eea0fba 39 #include "LSM6DSL_ACC_GYRO_driver.h"
cparata 0:69566eea0fba 40
cparata 0:69566eea0fba 41 /* Imported function prototypes ----------------------------------------------*/
cparata 0:69566eea0fba 42 extern uint8_t LSM6DSL_IO_Write(void *handle, uint8_t WriteAddr, uint8_t *pBuffer, uint16_t nBytesToWrite);
cparata 0:69566eea0fba 43 extern uint8_t LSM6DSL_IO_Read(void *handle, uint8_t ReadAddr, uint8_t *pBuffer, uint16_t nBytesToRead);
cparata 0:69566eea0fba 44
cparata 0:69566eea0fba 45 /* Private typedef -----------------------------------------------------------*/
cparata 0:69566eea0fba 46
cparata 0:69566eea0fba 47 /* Private define ------------------------------------------------------------*/
cparata 0:69566eea0fba 48
cparata 0:69566eea0fba 49 /* Private macro -------------------------------------------------------------*/
cparata 0:69566eea0fba 50
cparata 0:69566eea0fba 51 /* Private variables ---------------------------------------------------------*/
cparata 0:69566eea0fba 52
cparata 0:69566eea0fba 53 /* Private functions ---------------------------------------------------------*/
cparata 0:69566eea0fba 54
cparata 0:69566eea0fba 55 /* Exported functions ---------------------------------------------------------*/
cparata 0:69566eea0fba 56
cparata 0:69566eea0fba 57 /************** Generic Function *******************/
cparata 0:69566eea0fba 58
cparata 0:69566eea0fba 59 /*******************************************************************************
cparata 0:69566eea0fba 60 * Function Name : LSM6DSL_ACC_GYRO_ReadReg
cparata 0:69566eea0fba 61 * Description : Generic Reading function. It must be fullfilled with either
cparata 0:69566eea0fba 62 * : I2C or SPI reading functions
cparata 0:69566eea0fba 63 * Input : Register Address, length of buffer
cparata 0:69566eea0fba 64 * Output : Data REad
cparata 0:69566eea0fba 65 * Return : None
cparata 0:69566eea0fba 66 *******************************************************************************/
cparata 0:69566eea0fba 67 status_t LSM6DSL_ACC_GYRO_ReadReg(void *handle, u8_t Reg, u8_t* Data, u16_t len)
cparata 0:69566eea0fba 68 {
cparata 0:69566eea0fba 69 if (LSM6DSL_IO_Read(handle, Reg, Data, len))
cparata 0:69566eea0fba 70 {
cparata 0:69566eea0fba 71 return MEMS_ERROR;
cparata 0:69566eea0fba 72 }
cparata 0:69566eea0fba 73 else
cparata 0:69566eea0fba 74 {
cparata 0:69566eea0fba 75 return MEMS_SUCCESS;
cparata 0:69566eea0fba 76 }
cparata 0:69566eea0fba 77 }
cparata 0:69566eea0fba 78
cparata 0:69566eea0fba 79 /*******************************************************************************
cparata 0:69566eea0fba 80 * Function Name : LSM6DSL_ACC_GYRO_WriteReg
cparata 0:69566eea0fba 81 * Description : Generic Writing function. It must be fullfilled with either
cparata 0:69566eea0fba 82 * : I2C or SPI writing function
cparata 0:69566eea0fba 83 * Input : Register Address, Data to be written, length of buffer
cparata 0:69566eea0fba 84 * Output : None
cparata 0:69566eea0fba 85 * Return : None
cparata 0:69566eea0fba 86 *******************************************************************************/
cparata 0:69566eea0fba 87 status_t LSM6DSL_ACC_GYRO_WriteReg(void *handle, u8_t Reg, u8_t *Data, u16_t len)
cparata 0:69566eea0fba 88 {
cparata 0:69566eea0fba 89 if (LSM6DSL_IO_Write(handle, Reg, Data, len))
cparata 0:69566eea0fba 90 {
cparata 0:69566eea0fba 91 return MEMS_ERROR;
cparata 0:69566eea0fba 92 }
cparata 0:69566eea0fba 93 else
cparata 0:69566eea0fba 94 {
cparata 0:69566eea0fba 95 return MEMS_SUCCESS;
cparata 0:69566eea0fba 96 }
cparata 0:69566eea0fba 97 }
cparata 0:69566eea0fba 98
cparata 0:69566eea0fba 99 /**************** Base Function *******************/
cparata 0:69566eea0fba 100
cparata 0:69566eea0fba 101 /*******************************************************************************
cparata 0:69566eea0fba 102 * Function Name : LSM6DSL_ACC_GYRO_R_WHO_AM_I
cparata 0:69566eea0fba 103 * Description : Read WHO_AM_I_BIT
cparata 0:69566eea0fba 104 * Input : Pointer to u8_t
cparata 0:69566eea0fba 105 * Output : Status of WHO_AM_I_BIT
cparata 0:69566eea0fba 106 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 107 *******************************************************************************/
cparata 0:69566eea0fba 108 status_t LSM6DSL_ACC_GYRO_R_WHO_AM_I(void *handle, u8_t *value)
cparata 0:69566eea0fba 109 {
cparata 0:69566eea0fba 110 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WHO_AM_I_REG, (u8_t *)value, 1))
cparata 0:69566eea0fba 111 return MEMS_ERROR;
cparata 0:69566eea0fba 112
cparata 0:69566eea0fba 113 *value &= LSM6DSL_ACC_GYRO_WHO_AM_I_BIT_MASK; //coerce
cparata 0:69566eea0fba 114 *value = *value >> LSM6DSL_ACC_GYRO_WHO_AM_I_BIT_POSITION; //mask
cparata 0:69566eea0fba 115
cparata 0:69566eea0fba 116 return MEMS_SUCCESS;
cparata 0:69566eea0fba 117 }
cparata 0:69566eea0fba 118
cparata 0:69566eea0fba 119 /*******************************************************************************
cparata 0:69566eea0fba 120 * Function Name : LSM6DSL_ACC_GYRO_W_BDU
cparata 0:69566eea0fba 121 * Description : Write BDU
cparata 0:69566eea0fba 122 * Input : LSM6DSL_ACC_GYRO_BDU_t
cparata 0:69566eea0fba 123 * Output : None
cparata 0:69566eea0fba 124 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 125 *******************************************************************************/
cparata 0:69566eea0fba 126 status_t LSM6DSL_ACC_GYRO_W_BDU(void *handle, LSM6DSL_ACC_GYRO_BDU_t newValue)
cparata 0:69566eea0fba 127 {
cparata 0:69566eea0fba 128 u8_t value;
cparata 0:69566eea0fba 129
cparata 0:69566eea0fba 130 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
cparata 0:69566eea0fba 131 return MEMS_ERROR;
cparata 0:69566eea0fba 132
cparata 0:69566eea0fba 133 value &= ~LSM6DSL_ACC_GYRO_BDU_MASK;
cparata 0:69566eea0fba 134 value |= newValue;
cparata 0:69566eea0fba 135
cparata 0:69566eea0fba 136 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
cparata 0:69566eea0fba 137 return MEMS_ERROR;
cparata 0:69566eea0fba 138
cparata 0:69566eea0fba 139 return MEMS_SUCCESS;
cparata 0:69566eea0fba 140 }
cparata 0:69566eea0fba 141
cparata 0:69566eea0fba 142 /*******************************************************************************
cparata 0:69566eea0fba 143 * Function Name : LSM6DSL_ACC_GYRO_R_BDU
cparata 0:69566eea0fba 144 * Description : Read BDU
cparata 0:69566eea0fba 145 * Input : Pointer to LSM6DSL_ACC_GYRO_BDU_t
cparata 0:69566eea0fba 146 * Output : Status of BDU see LSM6DSL_ACC_GYRO_BDU_t
cparata 0:69566eea0fba 147 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 148 *******************************************************************************/
cparata 0:69566eea0fba 149 status_t LSM6DSL_ACC_GYRO_R_BDU(void *handle, LSM6DSL_ACC_GYRO_BDU_t *value)
cparata 0:69566eea0fba 150 {
cparata 0:69566eea0fba 151 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1))
cparata 0:69566eea0fba 152 return MEMS_ERROR;
cparata 0:69566eea0fba 153
cparata 0:69566eea0fba 154 *value &= LSM6DSL_ACC_GYRO_BDU_MASK; //mask
cparata 0:69566eea0fba 155
cparata 0:69566eea0fba 156 return MEMS_SUCCESS;
cparata 0:69566eea0fba 157 }
cparata 0:69566eea0fba 158
cparata 0:69566eea0fba 159 /*******************************************************************************
cparata 0:69566eea0fba 160 * Function Name : LSM6DSL_ACC_GYRO_W_FS_XL
cparata 0:69566eea0fba 161 * Description : Write FS_XL
cparata 0:69566eea0fba 162 * Input : LSM6DSL_ACC_GYRO_FS_XL_t
cparata 0:69566eea0fba 163 * Output : None
cparata 0:69566eea0fba 164 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 165 *******************************************************************************/
cparata 0:69566eea0fba 166 status_t LSM6DSL_ACC_GYRO_W_FS_XL(void *handle, LSM6DSL_ACC_GYRO_FS_XL_t newValue)
cparata 0:69566eea0fba 167 {
cparata 0:69566eea0fba 168 u8_t value;
cparata 0:69566eea0fba 169
cparata 0:69566eea0fba 170 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, &value, 1))
cparata 0:69566eea0fba 171 return MEMS_ERROR;
cparata 0:69566eea0fba 172
cparata 0:69566eea0fba 173 value &= ~LSM6DSL_ACC_GYRO_FS_XL_MASK;
cparata 0:69566eea0fba 174 value |= newValue;
cparata 0:69566eea0fba 175
cparata 0:69566eea0fba 176 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, &value, 1) )
cparata 0:69566eea0fba 177 return MEMS_ERROR;
cparata 0:69566eea0fba 178
cparata 0:69566eea0fba 179 return MEMS_SUCCESS;
cparata 0:69566eea0fba 180 }
cparata 0:69566eea0fba 181
cparata 0:69566eea0fba 182 /*******************************************************************************
cparata 0:69566eea0fba 183 * Function Name : LSM6DSL_ACC_GYRO_R_FS_XL
cparata 0:69566eea0fba 184 * Description : Read FS_XL
cparata 0:69566eea0fba 185 * Input : Pointer to LSM6DSL_ACC_GYRO_FS_XL_t
cparata 0:69566eea0fba 186 * Output : Status of FS_XL see LSM6DSL_ACC_GYRO_FS_XL_t
cparata 0:69566eea0fba 187 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 188 *******************************************************************************/
cparata 0:69566eea0fba 189 status_t LSM6DSL_ACC_GYRO_R_FS_XL(void *handle, LSM6DSL_ACC_GYRO_FS_XL_t *value)
cparata 0:69566eea0fba 190 {
cparata 0:69566eea0fba 191 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, (u8_t *)value, 1))
cparata 0:69566eea0fba 192 return MEMS_ERROR;
cparata 0:69566eea0fba 193
cparata 0:69566eea0fba 194 *value &= LSM6DSL_ACC_GYRO_FS_XL_MASK; //mask
cparata 0:69566eea0fba 195
cparata 0:69566eea0fba 196 return MEMS_SUCCESS;
cparata 0:69566eea0fba 197 }
cparata 0:69566eea0fba 198
cparata 0:69566eea0fba 199 /*******************************************************************************
cparata 0:69566eea0fba 200 * Function Name : status_t LSM6DSL_ACC_GYRO_GetRawAccData(u8_t *buff)
cparata 0:69566eea0fba 201 * Description : Read GetAccData output register
cparata 0:69566eea0fba 202 * Input : pointer to [u8_t]
cparata 0:69566eea0fba 203 * Output : GetAccData buffer u8_t
cparata 0:69566eea0fba 204 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 205 *******************************************************************************/
cparata 0:69566eea0fba 206 status_t LSM6DSL_ACC_GYRO_GetRawAccData(void *handle, u8_t *buff)
cparata 0:69566eea0fba 207 {
cparata 0:69566eea0fba 208 u8_t i, j, k;
cparata 0:69566eea0fba 209 u8_t numberOfByteForDimension;
cparata 0:69566eea0fba 210
cparata 0:69566eea0fba 211 numberOfByteForDimension=6/3;
cparata 0:69566eea0fba 212
cparata 0:69566eea0fba 213 k=0;
cparata 0:69566eea0fba 214 for (i=0; i<3;i++ )
cparata 0:69566eea0fba 215 {
cparata 0:69566eea0fba 216 for (j=0; j<numberOfByteForDimension;j++ )
cparata 0:69566eea0fba 217 {
cparata 0:69566eea0fba 218 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_OUTX_L_XL+k, &buff[k], 1))
cparata 0:69566eea0fba 219 return MEMS_ERROR;
cparata 0:69566eea0fba 220 k++;
cparata 0:69566eea0fba 221 }
cparata 0:69566eea0fba 222 }
cparata 0:69566eea0fba 223
cparata 0:69566eea0fba 224 return MEMS_SUCCESS;
cparata 0:69566eea0fba 225 }
cparata 0:69566eea0fba 226
cparata 0:69566eea0fba 227 /*******************************************************************************
cparata 0:69566eea0fba 228 * Function Name : status_t LSM6DSL_ACC_Get_Acceleration(void *handle, int *buff, u8_t from_fifo)
cparata 0:69566eea0fba 229 * Description : Read GetAccData output register
cparata 0:69566eea0fba 230 * Input : pointer to [u8_t]
cparata 0:69566eea0fba 231 * Output : values are expressed in mg
cparata 0:69566eea0fba 232 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 233 *******************************************************************************/
cparata 0:69566eea0fba 234 /*
cparata 0:69566eea0fba 235 * Following is the table of sensitivity values for each case.
cparata 0:69566eea0fba 236 * Values are expressed in ug/digit.
cparata 0:69566eea0fba 237 */
cparata 0:69566eea0fba 238 static const long long LSM6DSL_ACC_Sensitivity_List[4] = {
cparata 0:69566eea0fba 239 61, /* FS @2g */
cparata 0:69566eea0fba 240 122, /* FS @4g */
cparata 0:69566eea0fba 241 244, /* FS @8g */
cparata 0:69566eea0fba 242 488, /* FS @16g */
cparata 0:69566eea0fba 243 };
cparata 0:69566eea0fba 244 status_t LSM6DSL_ACC_Get_Acceleration(void *handle, int *buff, u8_t from_fifo)
cparata 0:69566eea0fba 245 {
cparata 0:69566eea0fba 246 LSM6DSL_ACC_GYRO_FS_XL_t fs;
cparata 0:69566eea0fba 247 long long sensitivity = 0;
cparata 0:69566eea0fba 248 Type3Axis16bit_U raw_data_tmp;
cparata 0:69566eea0fba 249
cparata 0:69566eea0fba 250 /* Read out current odr, fs, hf setting */
cparata 0:69566eea0fba 251 LSM6DSL_ACC_GYRO_R_FS_XL(handle, &fs);
cparata 0:69566eea0fba 252
cparata 0:69566eea0fba 253 /* Determine the sensitivity according to fs */
cparata 0:69566eea0fba 254 switch(fs) {
cparata 0:69566eea0fba 255 case LSM6DSL_ACC_GYRO_FS_XL_2g:
cparata 0:69566eea0fba 256 sensitivity = LSM6DSL_ACC_Sensitivity_List[0];
cparata 0:69566eea0fba 257 break;
cparata 0:69566eea0fba 258
cparata 0:69566eea0fba 259 case LSM6DSL_ACC_GYRO_FS_XL_4g:
cparata 0:69566eea0fba 260 sensitivity = LSM6DSL_ACC_Sensitivity_List[1];
cparata 0:69566eea0fba 261 break;
cparata 0:69566eea0fba 262
cparata 0:69566eea0fba 263 case LSM6DSL_ACC_GYRO_FS_XL_8g:
cparata 0:69566eea0fba 264 sensitivity = LSM6DSL_ACC_Sensitivity_List[2];
cparata 0:69566eea0fba 265 break;
cparata 0:69566eea0fba 266
cparata 0:69566eea0fba 267 case LSM6DSL_ACC_GYRO_FS_XL_16g:
cparata 0:69566eea0fba 268 sensitivity = LSM6DSL_ACC_Sensitivity_List[3];
cparata 0:69566eea0fba 269 break;
cparata 0:69566eea0fba 270 }
cparata 0:69566eea0fba 271
cparata 0:69566eea0fba 272 /* Read out raw accelerometer samples */
cparata 0:69566eea0fba 273 if (from_fifo) {
cparata 0:69566eea0fba 274 u8_t i;
cparata 0:69566eea0fba 275
cparata 0:69566eea0fba 276 /* read all 3 axis from FIFO */
cparata 0:69566eea0fba 277 for(i = 0; i < 3; i++)
cparata 0:69566eea0fba 278 LSM6DSL_ACC_GYRO_Get_GetFIFOData(handle, raw_data_tmp.u8bit + 2*i);
cparata 0:69566eea0fba 279 } else
cparata 0:69566eea0fba 280 LSM6DSL_ACC_GYRO_GetRawAccData(handle, raw_data_tmp.u8bit);
cparata 0:69566eea0fba 281
cparata 0:69566eea0fba 282 /* Apply proper shift and sensitivity */
cparata 0:69566eea0fba 283 buff[0] = (raw_data_tmp.i16bit[0] * sensitivity + 500)/1000;
cparata 0:69566eea0fba 284 buff[1] = (raw_data_tmp.i16bit[1] * sensitivity + 500)/1000;
cparata 0:69566eea0fba 285 buff[2] = (raw_data_tmp.i16bit[2] * sensitivity + 500)/1000;
cparata 0:69566eea0fba 286
cparata 0:69566eea0fba 287 return MEMS_SUCCESS;
cparata 0:69566eea0fba 288 }
cparata 0:69566eea0fba 289
cparata 0:69566eea0fba 290 /*******************************************************************************
cparata 0:69566eea0fba 291 * Function Name : LSM6DSL_ACC_GYRO_W_ODR_XL
cparata 0:69566eea0fba 292 * Description : Write ODR_XL
cparata 0:69566eea0fba 293 * Input : LSM6DSL_ACC_GYRO_ODR_XL_t
cparata 0:69566eea0fba 294 * Output : None
cparata 0:69566eea0fba 295 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 296 *******************************************************************************/
cparata 0:69566eea0fba 297 status_t LSM6DSL_ACC_GYRO_W_ODR_XL(void *handle, LSM6DSL_ACC_GYRO_ODR_XL_t newValue)
cparata 0:69566eea0fba 298 {
cparata 0:69566eea0fba 299 u8_t value;
cparata 0:69566eea0fba 300
cparata 0:69566eea0fba 301 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, &value, 1))
cparata 0:69566eea0fba 302 return MEMS_ERROR;
cparata 0:69566eea0fba 303
cparata 0:69566eea0fba 304 value &= ~LSM6DSL_ACC_GYRO_ODR_XL_MASK;
cparata 0:69566eea0fba 305 value |= newValue;
cparata 0:69566eea0fba 306
cparata 0:69566eea0fba 307 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, &value, 1) )
cparata 0:69566eea0fba 308 return MEMS_ERROR;
cparata 0:69566eea0fba 309
cparata 0:69566eea0fba 310 return MEMS_SUCCESS;
cparata 0:69566eea0fba 311 }
cparata 0:69566eea0fba 312
cparata 0:69566eea0fba 313 /*******************************************************************************
cparata 0:69566eea0fba 314 * Function Name : LSM6DSL_ACC_GYRO_R_ODR_XL
cparata 0:69566eea0fba 315 * Description : Read ODR_XL
cparata 0:69566eea0fba 316 * Input : Pointer to LSM6DSL_ACC_GYRO_ODR_XL_t
cparata 0:69566eea0fba 317 * Output : Status of ODR_XL see LSM6DSL_ACC_GYRO_ODR_XL_t
cparata 0:69566eea0fba 318 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 319 *******************************************************************************/
cparata 0:69566eea0fba 320 status_t LSM6DSL_ACC_GYRO_R_ODR_XL(void *handle, LSM6DSL_ACC_GYRO_ODR_XL_t *value)
cparata 0:69566eea0fba 321 {
cparata 0:69566eea0fba 322 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, (u8_t *)value, 1))
cparata 0:69566eea0fba 323 return MEMS_ERROR;
cparata 0:69566eea0fba 324
cparata 0:69566eea0fba 325 *value &= LSM6DSL_ACC_GYRO_ODR_XL_MASK; //mask
cparata 0:69566eea0fba 326
cparata 0:69566eea0fba 327 return MEMS_SUCCESS;
cparata 0:69566eea0fba 328 }
cparata 0:69566eea0fba 329
cparata 0:69566eea0fba 330 /*******************************************************************************
cparata 0:69566eea0fba 331 * Function Name : LSM6DSL_ACC_GYRO_translate_ODR_XL
cparata 0:69566eea0fba 332 * Description : Read ODR_XL
cparata 0:69566eea0fba 333 * Input : LSM6DSL_ACC_GYRO_ODR_XL_t
cparata 0:69566eea0fba 334 * Output : The ODR value in Hz
cparata 0:69566eea0fba 335 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 336 *******************************************************************************/
cparata 0:69566eea0fba 337 status_t LSM6DSL_ACC_GYRO_translate_ODR_XL(LSM6DSL_ACC_GYRO_ODR_XL_t value, u16_t *odr_hz_val)
cparata 0:69566eea0fba 338 {
cparata 0:69566eea0fba 339 switch(value) {
cparata 0:69566eea0fba 340 case LSM6DSL_ACC_GYRO_ODR_XL_POWER_DOWN:
cparata 0:69566eea0fba 341 *odr_hz_val = 0;
cparata 0:69566eea0fba 342 break;
cparata 0:69566eea0fba 343
cparata 0:69566eea0fba 344 case LSM6DSL_ACC_GYRO_ODR_XL_13Hz:
cparata 0:69566eea0fba 345 *odr_hz_val = 13;
cparata 0:69566eea0fba 346 break;
cparata 0:69566eea0fba 347
cparata 0:69566eea0fba 348 case LSM6DSL_ACC_GYRO_ODR_XL_26Hz:
cparata 0:69566eea0fba 349 *odr_hz_val = 26;
cparata 0:69566eea0fba 350 break;
cparata 0:69566eea0fba 351
cparata 0:69566eea0fba 352 case LSM6DSL_ACC_GYRO_ODR_XL_52Hz:
cparata 0:69566eea0fba 353 *odr_hz_val = 52;
cparata 0:69566eea0fba 354 break;
cparata 0:69566eea0fba 355
cparata 0:69566eea0fba 356 case LSM6DSL_ACC_GYRO_ODR_XL_104Hz:
cparata 0:69566eea0fba 357 *odr_hz_val = 104;
cparata 0:69566eea0fba 358 break;
cparata 0:69566eea0fba 359
cparata 0:69566eea0fba 360 case LSM6DSL_ACC_GYRO_ODR_XL_208Hz:
cparata 0:69566eea0fba 361 *odr_hz_val = 208;
cparata 0:69566eea0fba 362 break;
cparata 0:69566eea0fba 363
cparata 0:69566eea0fba 364 case LSM6DSL_ACC_GYRO_ODR_XL_416Hz:
cparata 0:69566eea0fba 365 *odr_hz_val = 416;
cparata 0:69566eea0fba 366 break;
cparata 0:69566eea0fba 367
cparata 0:69566eea0fba 368 case LSM6DSL_ACC_GYRO_ODR_XL_833Hz:
cparata 0:69566eea0fba 369 *odr_hz_val = 833;
cparata 0:69566eea0fba 370 break;
cparata 0:69566eea0fba 371
cparata 0:69566eea0fba 372 case LSM6DSL_ACC_GYRO_ODR_XL_1660Hz:
cparata 0:69566eea0fba 373 *odr_hz_val = 1660;
cparata 0:69566eea0fba 374 break;
cparata 0:69566eea0fba 375
cparata 0:69566eea0fba 376 default:
cparata 0:69566eea0fba 377 return MEMS_ERROR;
cparata 0:69566eea0fba 378 }
cparata 0:69566eea0fba 379
cparata 0:69566eea0fba 380 return MEMS_SUCCESS;
cparata 0:69566eea0fba 381 }
cparata 0:69566eea0fba 382
cparata 0:69566eea0fba 383 /*******************************************************************************
cparata 0:69566eea0fba 384 * Function Name : LSM6DSL_ACC_GYRO_W_FS_G
cparata 0:69566eea0fba 385 * Description : Write FS_G
cparata 0:69566eea0fba 386 * Input : LSM6DSL_ACC_GYRO_FS_G_t
cparata 0:69566eea0fba 387 * Output : None
cparata 0:69566eea0fba 388 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 389 *******************************************************************************/
cparata 0:69566eea0fba 390 status_t LSM6DSL_ACC_GYRO_W_FS_G(void *handle, LSM6DSL_ACC_GYRO_FS_G_t newValue)
cparata 0:69566eea0fba 391 {
cparata 0:69566eea0fba 392 u8_t value;
cparata 0:69566eea0fba 393
cparata 0:69566eea0fba 394 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, &value, 1))
cparata 0:69566eea0fba 395 return MEMS_ERROR;
cparata 0:69566eea0fba 396
cparata 0:69566eea0fba 397 value &= ~LSM6DSL_ACC_GYRO_FS_G_MASK;
cparata 0:69566eea0fba 398 value |= newValue;
cparata 0:69566eea0fba 399
cparata 0:69566eea0fba 400 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, &value, 1) )
cparata 0:69566eea0fba 401 return MEMS_ERROR;
cparata 0:69566eea0fba 402
cparata 0:69566eea0fba 403 return MEMS_SUCCESS;
cparata 0:69566eea0fba 404 }
cparata 0:69566eea0fba 405
cparata 0:69566eea0fba 406 /*******************************************************************************
cparata 0:69566eea0fba 407 * Function Name : LSM6DSL_ACC_GYRO_R_FS_G
cparata 0:69566eea0fba 408 * Description : Read FS_G
cparata 0:69566eea0fba 409 * Input : Pointer to LSM6DSL_ACC_GYRO_FS_G_t
cparata 0:69566eea0fba 410 * Output : Status of FS_G see LSM6DSL_ACC_GYRO_FS_G_t
cparata 0:69566eea0fba 411 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 412 *******************************************************************************/
cparata 0:69566eea0fba 413 status_t LSM6DSL_ACC_GYRO_R_FS_G(void *handle, LSM6DSL_ACC_GYRO_FS_G_t *value)
cparata 0:69566eea0fba 414 {
cparata 0:69566eea0fba 415 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, (u8_t *)value, 1))
cparata 0:69566eea0fba 416 return MEMS_ERROR;
cparata 0:69566eea0fba 417
cparata 0:69566eea0fba 418 *value &= LSM6DSL_ACC_GYRO_FS_G_MASK; //mask
cparata 0:69566eea0fba 419
cparata 0:69566eea0fba 420 return MEMS_SUCCESS;
cparata 0:69566eea0fba 421 }
cparata 0:69566eea0fba 422
cparata 0:69566eea0fba 423 /*******************************************************************************
cparata 0:69566eea0fba 424 * Function Name : status_t LSM6DSL_ACC_GYRO_GetRawGyroData(u8_t *buff)
cparata 0:69566eea0fba 425 * Description : Read GetGyroData output register
cparata 0:69566eea0fba 426 * Input : pointer to [u8_t]
cparata 0:69566eea0fba 427 * Output : GetGyroData buffer u8_t
cparata 0:69566eea0fba 428 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 429 *******************************************************************************/
cparata 0:69566eea0fba 430 status_t LSM6DSL_ACC_GYRO_GetRawGyroData(void *handle, u8_t *buff)
cparata 0:69566eea0fba 431 {
cparata 0:69566eea0fba 432 u8_t i, j, k;
cparata 0:69566eea0fba 433 u8_t numberOfByteForDimension;
cparata 0:69566eea0fba 434
cparata 0:69566eea0fba 435 numberOfByteForDimension=6/3;
cparata 0:69566eea0fba 436
cparata 0:69566eea0fba 437 k=0;
cparata 0:69566eea0fba 438 for (i=0; i<3;i++ )
cparata 0:69566eea0fba 439 {
cparata 0:69566eea0fba 440 for (j=0; j<numberOfByteForDimension;j++ )
cparata 0:69566eea0fba 441 {
cparata 0:69566eea0fba 442 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_OUTX_L_G+k, &buff[k], 1))
cparata 0:69566eea0fba 443 return MEMS_ERROR;
cparata 0:69566eea0fba 444 k++;
cparata 0:69566eea0fba 445 }
cparata 0:69566eea0fba 446 }
cparata 0:69566eea0fba 447
cparata 0:69566eea0fba 448 return MEMS_SUCCESS;
cparata 0:69566eea0fba 449 }
cparata 0:69566eea0fba 450
cparata 0:69566eea0fba 451 /*******************************************************************************
cparata 0:69566eea0fba 452 * Function Name : status_t LSM6DSL_ACC_Get_AngularRate(u8_t *buff)
cparata 0:69566eea0fba 453 * Description : Read GetGyroData output register
cparata 0:69566eea0fba 454 * Input : pointer to [u8_t]
cparata 0:69566eea0fba 455 * Output : Returned values are espressed in mdps
cparata 0:69566eea0fba 456 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 457 *******************************************************************************/
cparata 0:69566eea0fba 458 /*
cparata 0:69566eea0fba 459 * Following is the table of sensitivity values for each case.
cparata 0:69566eea0fba 460 * Values are espressed in udps/digit.
cparata 0:69566eea0fba 461 */
cparata 0:69566eea0fba 462 static const long long LSM6DSL_GYRO_Sensitivity_List[5] = {
cparata 0:69566eea0fba 463 4375, /* FS @125 */
cparata 0:69566eea0fba 464 8750, /* FS @245 */
cparata 0:69566eea0fba 465 17500, /* FS @500 */
cparata 0:69566eea0fba 466 35000, /* FS @1000 */
cparata 0:69566eea0fba 467 70000, /* FS @2000 */
cparata 0:69566eea0fba 468 };
cparata 0:69566eea0fba 469 status_t LSM6DSL_ACC_Get_AngularRate(void *handle, int *buff, u8_t from_fifo)
cparata 0:69566eea0fba 470 {
cparata 0:69566eea0fba 471 LSM6DSL_ACC_GYRO_FS_125_t fs_125;
cparata 0:69566eea0fba 472 LSM6DSL_ACC_GYRO_FS_G_t fs;
cparata 0:69566eea0fba 473 long long sensitivity = 0;
cparata 0:69566eea0fba 474 Type3Axis16bit_U raw_data_tmp;
cparata 0:69566eea0fba 475
cparata 0:69566eea0fba 476 /* Read out current odr, fs, hf setting */
cparata 0:69566eea0fba 477 LSM6DSL_ACC_GYRO_R_FS_125(handle, &fs_125);
cparata 0:69566eea0fba 478 if (fs_125 == LSM6DSL_ACC_GYRO_FS_125_ENABLED) {
cparata 0:69566eea0fba 479 sensitivity = LSM6DSL_GYRO_Sensitivity_List[0];
cparata 0:69566eea0fba 480 } else {
cparata 0:69566eea0fba 481 LSM6DSL_ACC_GYRO_R_FS_G(handle, &fs);
cparata 0:69566eea0fba 482
cparata 0:69566eea0fba 483 /* Determine the sensitivity according to fs */
cparata 0:69566eea0fba 484 switch(fs) {
cparata 0:69566eea0fba 485 case LSM6DSL_ACC_GYRO_FS_G_245dps:
cparata 0:69566eea0fba 486 sensitivity = LSM6DSL_GYRO_Sensitivity_List[1];
cparata 0:69566eea0fba 487 break;
cparata 0:69566eea0fba 488
cparata 0:69566eea0fba 489 case LSM6DSL_ACC_GYRO_FS_G_500dps:
cparata 0:69566eea0fba 490 sensitivity = LSM6DSL_GYRO_Sensitivity_List[2];
cparata 0:69566eea0fba 491 break;
cparata 0:69566eea0fba 492
cparata 0:69566eea0fba 493 case LSM6DSL_ACC_GYRO_FS_G_1000dps:
cparata 0:69566eea0fba 494 sensitivity = LSM6DSL_GYRO_Sensitivity_List[3];
cparata 0:69566eea0fba 495 break;
cparata 0:69566eea0fba 496
cparata 0:69566eea0fba 497 case LSM6DSL_ACC_GYRO_FS_G_2000dps:
cparata 0:69566eea0fba 498 sensitivity = LSM6DSL_GYRO_Sensitivity_List[4];
cparata 0:69566eea0fba 499 break;
cparata 0:69566eea0fba 500 }
cparata 0:69566eea0fba 501 }
cparata 0:69566eea0fba 502
cparata 0:69566eea0fba 503 /* Read out raw accelerometer samples */
cparata 0:69566eea0fba 504 if (from_fifo) {
cparata 0:69566eea0fba 505 u8_t i;
cparata 0:69566eea0fba 506
cparata 0:69566eea0fba 507 /* read all 3 axis from FIFO */
cparata 0:69566eea0fba 508 for(i = 0; i < 3; i++)
cparata 0:69566eea0fba 509 LSM6DSL_ACC_GYRO_Get_GetFIFOData(handle, raw_data_tmp.u8bit + 2*i);
cparata 0:69566eea0fba 510 } else
cparata 0:69566eea0fba 511 LSM6DSL_ACC_GYRO_GetRawGyroData(handle, raw_data_tmp.u8bit);
cparata 0:69566eea0fba 512
cparata 0:69566eea0fba 513 /* Apply proper shift and sensitivity */
cparata 0:69566eea0fba 514 buff[0] = (raw_data_tmp.i16bit[0] * sensitivity + 500)/1000;
cparata 0:69566eea0fba 515 buff[1] = (raw_data_tmp.i16bit[1] * sensitivity + 500)/1000;
cparata 0:69566eea0fba 516 buff[2] = (raw_data_tmp.i16bit[2] * sensitivity + 500)/1000;
cparata 0:69566eea0fba 517
cparata 0:69566eea0fba 518 return MEMS_SUCCESS;
cparata 0:69566eea0fba 519 }
cparata 0:69566eea0fba 520
cparata 0:69566eea0fba 521 /*******************************************************************************
cparata 0:69566eea0fba 522 * Function Name : LSM6DSL_ACC_GYRO_W_ODR_G
cparata 0:69566eea0fba 523 * Description : Write ODR_G
cparata 0:69566eea0fba 524 * Input : LSM6DSL_ACC_GYRO_ODR_G_t
cparata 0:69566eea0fba 525 * Output : None
cparata 0:69566eea0fba 526 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 527 *******************************************************************************/
cparata 0:69566eea0fba 528 status_t LSM6DSL_ACC_GYRO_W_ODR_G(void *handle, LSM6DSL_ACC_GYRO_ODR_G_t newValue)
cparata 0:69566eea0fba 529 {
cparata 0:69566eea0fba 530 u8_t value;
cparata 0:69566eea0fba 531
cparata 0:69566eea0fba 532 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, &value, 1))
cparata 0:69566eea0fba 533 return MEMS_ERROR;
cparata 0:69566eea0fba 534
cparata 0:69566eea0fba 535 value &= ~LSM6DSL_ACC_GYRO_ODR_G_MASK;
cparata 0:69566eea0fba 536 value |= newValue;
cparata 0:69566eea0fba 537
cparata 0:69566eea0fba 538 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, &value, 1) )
cparata 0:69566eea0fba 539 return MEMS_ERROR;
cparata 0:69566eea0fba 540
cparata 0:69566eea0fba 541 return MEMS_SUCCESS;
cparata 0:69566eea0fba 542 }
cparata 0:69566eea0fba 543
cparata 0:69566eea0fba 544 /*******************************************************************************
cparata 0:69566eea0fba 545 * Function Name : LSM6DSL_ACC_GYRO_R_ODR_G
cparata 0:69566eea0fba 546 * Description : Read ODR_G
cparata 0:69566eea0fba 547 * Input : Pointer to LSM6DSL_ACC_GYRO_ODR_G_t
cparata 0:69566eea0fba 548 * Output : Status of ODR_G see LSM6DSL_ACC_GYRO_ODR_G_t
cparata 0:69566eea0fba 549 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 550 *******************************************************************************/
cparata 0:69566eea0fba 551 status_t LSM6DSL_ACC_GYRO_R_ODR_G(void *handle, LSM6DSL_ACC_GYRO_ODR_G_t *value)
cparata 0:69566eea0fba 552 {
cparata 0:69566eea0fba 553 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, (u8_t *)value, 1))
cparata 0:69566eea0fba 554 return MEMS_ERROR;
cparata 0:69566eea0fba 555
cparata 0:69566eea0fba 556 *value &= LSM6DSL_ACC_GYRO_ODR_G_MASK; //mask
cparata 0:69566eea0fba 557
cparata 0:69566eea0fba 558 return MEMS_SUCCESS;
cparata 0:69566eea0fba 559 }
cparata 0:69566eea0fba 560
cparata 0:69566eea0fba 561 /*******************************************************************************
cparata 0:69566eea0fba 562 * Function Name : LSM6DSL_ACC_GYRO_translate_ODR_G
cparata 0:69566eea0fba 563 * Description : Read ODR_G
cparata 0:69566eea0fba 564 * Input : LSM6DSL_ACC_GYRO_ODR_G_t
cparata 0:69566eea0fba 565 * Output : The ODR value in Hz
cparata 0:69566eea0fba 566 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 567 *******************************************************************************/
cparata 0:69566eea0fba 568 status_t LSM6DSL_ACC_GYRO_translate_ODR_G(LSM6DSL_ACC_GYRO_ODR_G_t value, u16_t *odr_hz_val)
cparata 0:69566eea0fba 569 {
cparata 0:69566eea0fba 570 switch(value) {
cparata 0:69566eea0fba 571 case LSM6DSL_ACC_GYRO_ODR_G_POWER_DOWN:
cparata 0:69566eea0fba 572 *odr_hz_val = 0;
cparata 0:69566eea0fba 573 break;
cparata 0:69566eea0fba 574
cparata 0:69566eea0fba 575 case LSM6DSL_ACC_GYRO_ODR_G_13Hz:
cparata 0:69566eea0fba 576 *odr_hz_val = 13;
cparata 0:69566eea0fba 577 break;
cparata 0:69566eea0fba 578
cparata 0:69566eea0fba 579 case LSM6DSL_ACC_GYRO_ODR_G_26Hz:
cparata 0:69566eea0fba 580 *odr_hz_val = 26;
cparata 0:69566eea0fba 581 break;
cparata 0:69566eea0fba 582
cparata 0:69566eea0fba 583 case LSM6DSL_ACC_GYRO_ODR_G_52Hz:
cparata 0:69566eea0fba 584 *odr_hz_val = 52;
cparata 0:69566eea0fba 585 break;
cparata 0:69566eea0fba 586
cparata 0:69566eea0fba 587 case LSM6DSL_ACC_GYRO_ODR_G_104Hz:
cparata 0:69566eea0fba 588 *odr_hz_val = 104;
cparata 0:69566eea0fba 589 break;
cparata 0:69566eea0fba 590
cparata 0:69566eea0fba 591 case LSM6DSL_ACC_GYRO_ODR_G_208Hz:
cparata 0:69566eea0fba 592 *odr_hz_val = 208;
cparata 0:69566eea0fba 593 break;
cparata 0:69566eea0fba 594
cparata 0:69566eea0fba 595 case LSM6DSL_ACC_GYRO_ODR_G_416Hz:
cparata 0:69566eea0fba 596 *odr_hz_val = 416;
cparata 0:69566eea0fba 597 break;
cparata 0:69566eea0fba 598
cparata 0:69566eea0fba 599 case LSM6DSL_ACC_GYRO_ODR_G_833Hz:
cparata 0:69566eea0fba 600 *odr_hz_val = 833;
cparata 0:69566eea0fba 601 break;
cparata 0:69566eea0fba 602
cparata 0:69566eea0fba 603 case LSM6DSL_ACC_GYRO_ODR_G_1660Hz:
cparata 0:69566eea0fba 604 *odr_hz_val = 1660;
cparata 0:69566eea0fba 605 break;
cparata 0:69566eea0fba 606
cparata 0:69566eea0fba 607 default:
cparata 0:69566eea0fba 608 return MEMS_ERROR;
cparata 0:69566eea0fba 609 }
cparata 0:69566eea0fba 610
cparata 0:69566eea0fba 611 return MEMS_SUCCESS;
cparata 0:69566eea0fba 612 }
cparata 0:69566eea0fba 613
cparata 0:69566eea0fba 614 /*******************************************************************************
cparata 0:69566eea0fba 615 * Function Name : LSM6DSL_ACC_GYRO_W_FS_125
cparata 0:69566eea0fba 616 * Description : Write FS_125
cparata 0:69566eea0fba 617 * Input : LSM6DSL_ACC_GYRO_FS_125_t
cparata 0:69566eea0fba 618 * Output : None
cparata 0:69566eea0fba 619 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 620 *******************************************************************************/
cparata 0:69566eea0fba 621 status_t LSM6DSL_ACC_GYRO_W_FS_125(void *handle, LSM6DSL_ACC_GYRO_FS_125_t newValue)
cparata 0:69566eea0fba 622 {
cparata 0:69566eea0fba 623 u8_t value;
cparata 0:69566eea0fba 624
cparata 0:69566eea0fba 625 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, &value, 1))
cparata 0:69566eea0fba 626 return MEMS_ERROR;
cparata 0:69566eea0fba 627
cparata 0:69566eea0fba 628 value &= ~LSM6DSL_ACC_GYRO_FS_125_MASK;
cparata 0:69566eea0fba 629 value |= newValue;
cparata 0:69566eea0fba 630
cparata 0:69566eea0fba 631 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, &value, 1) )
cparata 0:69566eea0fba 632 return MEMS_ERROR;
cparata 0:69566eea0fba 633
cparata 0:69566eea0fba 634 return MEMS_SUCCESS;
cparata 0:69566eea0fba 635 }
cparata 0:69566eea0fba 636
cparata 0:69566eea0fba 637 /*******************************************************************************
cparata 0:69566eea0fba 638 * Function Name : LSM6DSL_ACC_GYRO_R_FS_125
cparata 0:69566eea0fba 639 * Description : Read FS_125
cparata 0:69566eea0fba 640 * Input : Pointer to LSM6DSL_ACC_GYRO_FS_125_t
cparata 0:69566eea0fba 641 * Output : Status of FS_125 see LSM6DSL_ACC_GYRO_FS_125_t
cparata 0:69566eea0fba 642 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 643 *******************************************************************************/
cparata 0:69566eea0fba 644 status_t LSM6DSL_ACC_GYRO_R_FS_125(void *handle, LSM6DSL_ACC_GYRO_FS_125_t *value)
cparata 0:69566eea0fba 645 {
cparata 0:69566eea0fba 646 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, (u8_t *)value, 1))
cparata 0:69566eea0fba 647 return MEMS_ERROR;
cparata 0:69566eea0fba 648
cparata 0:69566eea0fba 649 *value &= LSM6DSL_ACC_GYRO_FS_125_MASK; //mask
cparata 0:69566eea0fba 650
cparata 0:69566eea0fba 651 return MEMS_SUCCESS;
cparata 0:69566eea0fba 652 }
cparata 0:69566eea0fba 653
cparata 0:69566eea0fba 654 /**************** Advanced Function *******************/
cparata 0:69566eea0fba 655
cparata 0:69566eea0fba 656 /*******************************************************************************
cparata 0:69566eea0fba 657 * Function Name : LSM6DSL_ACC_GYRO_W_BW_SEL
cparata 0:69566eea0fba 658 * Description : Write BW_SEL
cparata 0:69566eea0fba 659 * Input : LSM6DSL_ACC_GYRO_BW_SEL_t
cparata 0:69566eea0fba 660 * Output : None
cparata 0:69566eea0fba 661 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 662 *******************************************************************************/
cparata 0:69566eea0fba 663 status_t LSM6DSL_ACC_GYRO_W_BW_SEL(void *handle, LSM6DSL_ACC_GYRO_BW_SEL_t newValue)
cparata 0:69566eea0fba 664 {
cparata 0:69566eea0fba 665 u8_t value;
cparata 0:69566eea0fba 666
cparata 0:69566eea0fba 667 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, &value, 1))
cparata 0:69566eea0fba 668 return MEMS_ERROR;
cparata 0:69566eea0fba 669
cparata 0:69566eea0fba 670 value &= ~LSM6DSL_ACC_GYRO_BW_SEL_MASK;
cparata 0:69566eea0fba 671 value |= newValue;
cparata 0:69566eea0fba 672
cparata 0:69566eea0fba 673 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, &value, 1) )
cparata 0:69566eea0fba 674 return MEMS_ERROR;
cparata 0:69566eea0fba 675
cparata 0:69566eea0fba 676 return MEMS_SUCCESS;
cparata 0:69566eea0fba 677 }
cparata 0:69566eea0fba 678
cparata 0:69566eea0fba 679 /*******************************************************************************
cparata 0:69566eea0fba 680 * Function Name : LSM6DSL_ACC_GYRO_R_BW_SEL
cparata 0:69566eea0fba 681 * Description : Read BW_SEL
cparata 0:69566eea0fba 682 * Input : Pointer to LSM6DSL_ACC_GYRO_BW_SEL_t
cparata 0:69566eea0fba 683 * Output : Status of BW_SEL see LSM6DSL_ACC_GYRO_BW_SEL_t
cparata 0:69566eea0fba 684 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 685 *******************************************************************************/
cparata 0:69566eea0fba 686 status_t LSM6DSL_ACC_GYRO_R_BW_SEL(void *handle, LSM6DSL_ACC_GYRO_BW_SEL_t *value)
cparata 0:69566eea0fba 687 {
cparata 0:69566eea0fba 688 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, (u8_t *)value, 1))
cparata 0:69566eea0fba 689 return MEMS_ERROR;
cparata 0:69566eea0fba 690
cparata 0:69566eea0fba 691 *value &= LSM6DSL_ACC_GYRO_BW_SEL_MASK; //mask
cparata 0:69566eea0fba 692
cparata 0:69566eea0fba 693 return MEMS_SUCCESS;
cparata 0:69566eea0fba 694 }
cparata 0:69566eea0fba 695
cparata 0:69566eea0fba 696 /*******************************************************************************
cparata 0:69566eea0fba 697 * Function Name : LSM6DSL_ACC_GYRO_W_BLE
cparata 0:69566eea0fba 698 * Description : Write BLE
cparata 0:69566eea0fba 699 * Input : LSM6DSL_ACC_GYRO_BLE_t
cparata 0:69566eea0fba 700 * Output : None
cparata 0:69566eea0fba 701 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 702 *******************************************************************************/
cparata 0:69566eea0fba 703 status_t LSM6DSL_ACC_GYRO_W_BLE(void *handle, LSM6DSL_ACC_GYRO_BLE_t newValue)
cparata 0:69566eea0fba 704 {
cparata 0:69566eea0fba 705 u8_t value;
cparata 0:69566eea0fba 706
cparata 0:69566eea0fba 707 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
cparata 0:69566eea0fba 708 return MEMS_ERROR;
cparata 0:69566eea0fba 709
cparata 0:69566eea0fba 710 value &= ~LSM6DSL_ACC_GYRO_BLE_MASK;
cparata 0:69566eea0fba 711 value |= newValue;
cparata 0:69566eea0fba 712
cparata 0:69566eea0fba 713 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
cparata 0:69566eea0fba 714 return MEMS_ERROR;
cparata 0:69566eea0fba 715
cparata 0:69566eea0fba 716 return MEMS_SUCCESS;
cparata 0:69566eea0fba 717 }
cparata 0:69566eea0fba 718
cparata 0:69566eea0fba 719 /*******************************************************************************
cparata 0:69566eea0fba 720 * Function Name : LSM6DSL_ACC_GYRO_R_BLE
cparata 0:69566eea0fba 721 * Description : Read BLE
cparata 0:69566eea0fba 722 * Input : Pointer to LSM6DSL_ACC_GYRO_BLE_t
cparata 0:69566eea0fba 723 * Output : Status of BLE see LSM6DSL_ACC_GYRO_BLE_t
cparata 0:69566eea0fba 724 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 725 *******************************************************************************/
cparata 0:69566eea0fba 726 status_t LSM6DSL_ACC_GYRO_R_BLE(void *handle, LSM6DSL_ACC_GYRO_BLE_t *value)
cparata 0:69566eea0fba 727 {
cparata 0:69566eea0fba 728 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1))
cparata 0:69566eea0fba 729 return MEMS_ERROR;
cparata 0:69566eea0fba 730
cparata 0:69566eea0fba 731 *value &= LSM6DSL_ACC_GYRO_BLE_MASK; //mask
cparata 0:69566eea0fba 732
cparata 0:69566eea0fba 733 return MEMS_SUCCESS;
cparata 0:69566eea0fba 734 }
cparata 0:69566eea0fba 735
cparata 0:69566eea0fba 736 /*******************************************************************************
cparata 0:69566eea0fba 737 * Function Name : LSM6DSL_ACC_GYRO_W_EmbeddedAccess
cparata 0:69566eea0fba 738 * Description : Write EMB_ACC
cparata 0:69566eea0fba 739 * Input : LSM6DSL_ACC_GYRO_EMB_ACC_t
cparata 0:69566eea0fba 740 * Output : None
cparata 0:69566eea0fba 741 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 742 *******************************************************************************/
cparata 0:69566eea0fba 743 status_t LSM6DSL_ACC_GYRO_W_EmbeddedAccess(void *handle, LSM6DSL_ACC_GYRO_EMB_ACC_t newValue)
cparata 0:69566eea0fba 744 {
cparata 0:69566eea0fba 745 u8_t value;
cparata 0:69566eea0fba 746
cparata 0:69566eea0fba 747 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_CFG_ACCESS, &value, 1) )
cparata 0:69566eea0fba 748 return MEMS_ERROR;
cparata 0:69566eea0fba 749
cparata 0:69566eea0fba 750 value &= ~LSM6DSL_ACC_GYRO_EMB_ACC_MASK;
cparata 0:69566eea0fba 751 value |= newValue;
cparata 0:69566eea0fba 752
cparata 0:69566eea0fba 753 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FUNC_CFG_ACCESS, &value, 1) )
cparata 0:69566eea0fba 754 return MEMS_ERROR;
cparata 0:69566eea0fba 755
cparata 0:69566eea0fba 756 return MEMS_SUCCESS;
cparata 0:69566eea0fba 757 }
cparata 0:69566eea0fba 758
cparata 0:69566eea0fba 759 /*******************************************************************************
cparata 0:69566eea0fba 760 * Function Name : LSM6DSL_ACC_GYRO_R_EmbeddedAccess
cparata 0:69566eea0fba 761 * Description : Read EMB_ACC
cparata 0:69566eea0fba 762 * Input : Pointer to LSM6DSL_ACC_GYRO_EMB_ACC_t
cparata 0:69566eea0fba 763 * Output : Status of EMB_ACC see LSM6DSL_ACC_GYRO_EMB_ACC_t
cparata 0:69566eea0fba 764 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 765 *******************************************************************************/
cparata 0:69566eea0fba 766 status_t LSM6DSL_ACC_GYRO_R_EmbeddedAccess(void *handle, LSM6DSL_ACC_GYRO_EMB_ACC_t *value)
cparata 0:69566eea0fba 767 {
cparata 0:69566eea0fba 768 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_CFG_ACCESS, (u8_t *)value, 1) )
cparata 0:69566eea0fba 769 return MEMS_ERROR;
cparata 0:69566eea0fba 770
cparata 0:69566eea0fba 771 *value &= LSM6DSL_ACC_GYRO_EMB_ACC_MASK; //mask
cparata 0:69566eea0fba 772
cparata 0:69566eea0fba 773 return MEMS_SUCCESS;
cparata 0:69566eea0fba 774 }
cparata 0:69566eea0fba 775
cparata 0:69566eea0fba 776 /*******************************************************************************
cparata 0:69566eea0fba 777 * Function Name : LSM6DSL_ACC_GYRO_W_SYNC_RES_RATIO
cparata 0:69566eea0fba 778 * Description : Write RR
cparata 0:69566eea0fba 779 * Input : LSM6DSL_ACC_GYRO_SYNC_RES_RATIO_t
cparata 0:69566eea0fba 780 * Output : None
cparata 0:69566eea0fba 781 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 782 *******************************************************************************/
cparata 0:69566eea0fba 783 status_t LSM6DSL_ACC_GYRO_W_SYNC_RES_RATIO(void *handle, LSM6DSL_ACC_GYRO_SYNC_RES_RATIO_t newValue)
cparata 0:69566eea0fba 784 {
cparata 0:69566eea0fba 785 u8_t value;
cparata 0:69566eea0fba 786
cparata 0:69566eea0fba 787 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_SENSOR_RES_RATIO, &value, 1) )
cparata 0:69566eea0fba 788 return MEMS_ERROR;
cparata 0:69566eea0fba 789
cparata 0:69566eea0fba 790 value &= ~LSM6DSL_ACC_GYRO_SYNC_RES_RATIO_MASK;
cparata 0:69566eea0fba 791 value |= newValue;
cparata 0:69566eea0fba 792
cparata 0:69566eea0fba 793 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_SENSOR_RES_RATIO, &value, 1) )
cparata 0:69566eea0fba 794 return MEMS_ERROR;
cparata 0:69566eea0fba 795
cparata 0:69566eea0fba 796 return MEMS_SUCCESS;
cparata 0:69566eea0fba 797 }
cparata 0:69566eea0fba 798
cparata 0:69566eea0fba 799 /*******************************************************************************
cparata 0:69566eea0fba 800 * Function Name : LSM6DSL_ACC_GYRO_R_SYNC_RES_RATIO
cparata 0:69566eea0fba 801 * Description : Read RR
cparata 0:69566eea0fba 802 * Input : Pointer to LSM6DSL_ACC_GYRO_SYNC_RES_RATIO_t
cparata 0:69566eea0fba 803 * Output : Status of RR see LSM6DSL_ACC_GYRO_SYNC_RES_RATIO_t
cparata 0:69566eea0fba 804 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 805 *******************************************************************************/
cparata 0:69566eea0fba 806 status_t LSM6DSL_ACC_GYRO_R_SYNC_RES_RATIO(void *handle, LSM6DSL_ACC_GYRO_SYNC_RES_RATIO_t *value)
cparata 0:69566eea0fba 807 {
cparata 0:69566eea0fba 808 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_SENSOR_RES_RATIO, (u8_t *)value, 1) )
cparata 0:69566eea0fba 809 return MEMS_ERROR;
cparata 0:69566eea0fba 810
cparata 0:69566eea0fba 811 *value &= LSM6DSL_ACC_GYRO_SYNC_RES_RATIO_MASK; //mask
cparata 0:69566eea0fba 812
cparata 0:69566eea0fba 813 return MEMS_SUCCESS;
cparata 0:69566eea0fba 814 }
cparata 0:69566eea0fba 815
cparata 0:69566eea0fba 816 /*******************************************************************************
cparata 0:69566eea0fba 817 * Function Name : LSM6DSL_ACC_GYRO_W_Stamping_Time_Frame
cparata 0:69566eea0fba 818 * Description : Write TPH
cparata 0:69566eea0fba 819 * Input : u8_t
cparata 0:69566eea0fba 820 * Output : None
cparata 0:69566eea0fba 821 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 822 *******************************************************************************/
cparata 0:69566eea0fba 823 status_t LSM6DSL_ACC_GYRO_W_Stamping_Time_Frame(void *handle, u8_t newValue)
cparata 0:69566eea0fba 824 {
cparata 0:69566eea0fba 825 u8_t value;
cparata 0:69566eea0fba 826
cparata 0:69566eea0fba 827 newValue = newValue << LSM6DSL_ACC_GYRO_TPH_POSITION; //mask
cparata 0:69566eea0fba 828 newValue &= LSM6DSL_ACC_GYRO_TPH_MASK; //coerce
cparata 0:69566eea0fba 829
cparata 0:69566eea0fba 830 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_SENSOR_SYNC_TIME, &value, 1) )
cparata 0:69566eea0fba 831 return MEMS_ERROR;
cparata 0:69566eea0fba 832
cparata 0:69566eea0fba 833 value &= (u8_t)~LSM6DSL_ACC_GYRO_TPH_MASK;
cparata 0:69566eea0fba 834 value |= newValue;
cparata 0:69566eea0fba 835
cparata 0:69566eea0fba 836 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_SENSOR_SYNC_TIME, &value, 1) )
cparata 0:69566eea0fba 837 return MEMS_ERROR;
cparata 0:69566eea0fba 838
cparata 0:69566eea0fba 839 return MEMS_SUCCESS;
cparata 0:69566eea0fba 840 }
cparata 0:69566eea0fba 841
cparata 0:69566eea0fba 842 /*******************************************************************************
cparata 0:69566eea0fba 843 * Function Name : LSM6DSL_ACC_GYRO_R_Stamping_Time_Frame
cparata 0:69566eea0fba 844 * Description : Read TPH
cparata 0:69566eea0fba 845 * Input : Pointer to u8_t
cparata 0:69566eea0fba 846 * Output : Status of TPH
cparata 0:69566eea0fba 847 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 848 *******************************************************************************/
cparata 0:69566eea0fba 849 status_t LSM6DSL_ACC_GYRO_R_Stamping_Time_Frame(void *handle, u8_t *value)
cparata 0:69566eea0fba 850 {
cparata 0:69566eea0fba 851 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_SENSOR_SYNC_TIME, (u8_t *)value, 1) )
cparata 0:69566eea0fba 852 return MEMS_ERROR;
cparata 0:69566eea0fba 853
cparata 0:69566eea0fba 854 *value &= LSM6DSL_ACC_GYRO_TPH_MASK; //coerce
cparata 0:69566eea0fba 855 *value = *value >> LSM6DSL_ACC_GYRO_TPH_POSITION; //mask
cparata 0:69566eea0fba 856
cparata 0:69566eea0fba 857 return MEMS_SUCCESS;
cparata 0:69566eea0fba 858 }
cparata 0:69566eea0fba 859
cparata 0:69566eea0fba 860 /*******************************************************************************
cparata 0:69566eea0fba 861 * Function Name : LSM6DSL_ACC_GYRO_W_FIFO_Watermark
cparata 0:69566eea0fba 862 * Description : Write WTM_FIFO
cparata 0:69566eea0fba 863 * Input : u16_t
cparata 0:69566eea0fba 864 * Output : None
cparata 0:69566eea0fba 865 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 866 *******************************************************************************/
cparata 0:69566eea0fba 867 status_t LSM6DSL_ACC_GYRO_W_FIFO_Watermark(void *handle, u16_t newValue)
cparata 0:69566eea0fba 868 {
cparata 0:69566eea0fba 869 u8_t valueH, valueL;
cparata 0:69566eea0fba 870 u8_t value;
cparata 0:69566eea0fba 871
cparata 0:69566eea0fba 872 valueL = newValue & 0xFF;
cparata 0:69566eea0fba 873 valueH = (newValue >> 8) & 0xFF;
cparata 0:69566eea0fba 874
cparata 0:69566eea0fba 875 /* Low part goes in FIFO_CTRL1 */
cparata 0:69566eea0fba 876 valueL = valueL << LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL1_POSITION; //mask
cparata 0:69566eea0fba 877 valueL &= LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL1_MASK; //coerce
cparata 0:69566eea0fba 878
cparata 0:69566eea0fba 879 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL1, &value, 1) )
cparata 0:69566eea0fba 880 return MEMS_ERROR;
cparata 0:69566eea0fba 881
cparata 0:69566eea0fba 882 value &= (u8_t)~LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL1_MASK;
cparata 0:69566eea0fba 883 value |= valueL;
cparata 0:69566eea0fba 884
cparata 0:69566eea0fba 885 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL1, &value, 1) )
cparata 0:69566eea0fba 886 return MEMS_ERROR;
cparata 0:69566eea0fba 887
cparata 0:69566eea0fba 888 /* High part goes in FIFO_CTRL2 */
cparata 0:69566eea0fba 889 valueH = valueH << LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL2_POSITION; //mask
cparata 0:69566eea0fba 890 valueH &= LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL2_MASK; //coerce
cparata 0:69566eea0fba 891
cparata 0:69566eea0fba 892 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
cparata 0:69566eea0fba 893 return MEMS_ERROR;
cparata 0:69566eea0fba 894
cparata 0:69566eea0fba 895 value &= ~LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL2_MASK;
cparata 0:69566eea0fba 896 value |= valueH;
cparata 0:69566eea0fba 897
cparata 0:69566eea0fba 898 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
cparata 0:69566eea0fba 899 return MEMS_ERROR;
cparata 0:69566eea0fba 900
cparata 0:69566eea0fba 901 return MEMS_SUCCESS;
cparata 0:69566eea0fba 902 }
cparata 0:69566eea0fba 903
cparata 0:69566eea0fba 904 /*******************************************************************************
cparata 0:69566eea0fba 905 * Function Name : LSM6DSL_ACC_GYRO_R_FIFO_Watermark
cparata 0:69566eea0fba 906 * Description : Read WTM_FIFO
cparata 0:69566eea0fba 907 * Input : Pointer to u16_t
cparata 0:69566eea0fba 908 * Output : Status of WTM_FIFO
cparata 0:69566eea0fba 909 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 910 *******************************************************************************/
cparata 0:69566eea0fba 911 status_t LSM6DSL_ACC_GYRO_R_FIFO_Watermark(void *handle, u16_t *value)
cparata 0:69566eea0fba 912 {
cparata 0:69566eea0fba 913 u8_t valueH, valueL;
cparata 0:69566eea0fba 914
cparata 0:69566eea0fba 915 /* Low part from FIFO_CTRL1 */
cparata 0:69566eea0fba 916 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL1, (u8_t *)&valueL, 1) )
cparata 0:69566eea0fba 917 return MEMS_ERROR;
cparata 0:69566eea0fba 918
cparata 0:69566eea0fba 919 valueL &= LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL1_MASK; //coerce
cparata 0:69566eea0fba 920 valueL = valueL >> LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL1_POSITION; //mask
cparata 0:69566eea0fba 921
cparata 0:69566eea0fba 922 /* High part from FIFO_CTRL2 */
cparata 0:69566eea0fba 923 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, (u8_t *)&valueH, 1) )
cparata 0:69566eea0fba 924 return MEMS_ERROR;
cparata 0:69566eea0fba 925
cparata 0:69566eea0fba 926 valueH &= LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL2_MASK; //coerce
cparata 0:69566eea0fba 927 valueH = valueH >> LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL2_POSITION; //mask
cparata 0:69566eea0fba 928
cparata 0:69566eea0fba 929 *value = ((valueH << 8) & 0xFF00) | valueL;
cparata 0:69566eea0fba 930
cparata 0:69566eea0fba 931 return MEMS_SUCCESS;
cparata 0:69566eea0fba 932 }
cparata 0:69566eea0fba 933
cparata 0:69566eea0fba 934 /*******************************************************************************
cparata 0:69566eea0fba 935 * Function Name : LSM6DSL_ACC_GYRO_W_FIFO_TEMP
cparata 0:69566eea0fba 936 * Description : Write FIFO_TEMP_EN
cparata 0:69566eea0fba 937 * Input : LSM6DSL_ACC_GYRO_FIFO_TEMP_t
cparata 0:69566eea0fba 938 * Output : None
cparata 0:69566eea0fba 939 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 940 *******************************************************************************/
cparata 0:69566eea0fba 941 status_t LSM6DSL_ACC_GYRO_W_FIFO_TEMP(void *handle, LSM6DSL_ACC_GYRO_FIFO_TEMP_t newValue)
cparata 0:69566eea0fba 942 {
cparata 0:69566eea0fba 943 u8_t value;
cparata 0:69566eea0fba 944
cparata 0:69566eea0fba 945 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
cparata 0:69566eea0fba 946 return MEMS_ERROR;
cparata 0:69566eea0fba 947
cparata 0:69566eea0fba 948 value &= ~LSM6DSL_ACC_GYRO_FIFO_TEMP_MASK;
cparata 0:69566eea0fba 949 value |= newValue;
cparata 0:69566eea0fba 950
cparata 0:69566eea0fba 951 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
cparata 0:69566eea0fba 952 return MEMS_ERROR;
cparata 0:69566eea0fba 953
cparata 0:69566eea0fba 954 return MEMS_SUCCESS;
cparata 0:69566eea0fba 955 }
cparata 0:69566eea0fba 956
cparata 0:69566eea0fba 957 /*******************************************************************************
cparata 0:69566eea0fba 958 * Function Name : LSM6DSL_ACC_GYRO_R_FIFO_TEMP
cparata 0:69566eea0fba 959 * Description : Read FIFO_TEMP_EN
cparata 0:69566eea0fba 960 * Input : Pointer to LSM6DSL_ACC_GYRO_FIFO_TEMP_t
cparata 0:69566eea0fba 961 * Output : Status of FIFO_TEMP_EN see LSM6DSL_ACC_GYRO_FIFO_TEMP_t
cparata 0:69566eea0fba 962 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 963 *******************************************************************************/
cparata 0:69566eea0fba 964 status_t LSM6DSL_ACC_GYRO_R_FIFO_TEMP(void *handle, LSM6DSL_ACC_GYRO_FIFO_TEMP_t *value)
cparata 0:69566eea0fba 965 {
cparata 0:69566eea0fba 966 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, (u8_t *)value, 1) )
cparata 0:69566eea0fba 967 return MEMS_ERROR;
cparata 0:69566eea0fba 968
cparata 0:69566eea0fba 969 *value &= LSM6DSL_ACC_GYRO_FIFO_TEMP_MASK; //mask
cparata 0:69566eea0fba 970
cparata 0:69566eea0fba 971 return MEMS_SUCCESS;
cparata 0:69566eea0fba 972 }
cparata 0:69566eea0fba 973
cparata 0:69566eea0fba 974 /*******************************************************************************
cparata 0:69566eea0fba 975 * Function Name : LSM6DSL_ACC_GYRO_W_TIM_PEDO_FIFO_Write_En
cparata 0:69566eea0fba 976 * Description : Write TIM_PEDO_FIFO_DRDY
cparata 0:69566eea0fba 977 * Input : LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_DRDY_t
cparata 0:69566eea0fba 978 * Output : None
cparata 0:69566eea0fba 979 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 980 *******************************************************************************/
cparata 0:69566eea0fba 981 status_t LSM6DSL_ACC_GYRO_W_TIM_PEDO_FIFO_Write_En(void *handle, LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_DRDY_t newValue)
cparata 0:69566eea0fba 982 {
cparata 0:69566eea0fba 983 u8_t value;
cparata 0:69566eea0fba 984
cparata 0:69566eea0fba 985 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
cparata 0:69566eea0fba 986 return MEMS_ERROR;
cparata 0:69566eea0fba 987
cparata 0:69566eea0fba 988 value &= ~LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_DRDY_MASK;
cparata 0:69566eea0fba 989 value |= newValue;
cparata 0:69566eea0fba 990
cparata 0:69566eea0fba 991 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
cparata 0:69566eea0fba 992 return MEMS_ERROR;
cparata 0:69566eea0fba 993
cparata 0:69566eea0fba 994 return MEMS_SUCCESS;
cparata 0:69566eea0fba 995 }
cparata 0:69566eea0fba 996
cparata 0:69566eea0fba 997 /*******************************************************************************
cparata 0:69566eea0fba 998 * Function Name : LSM6DSL_ACC_GYRO_R_TIM_PEDO_FIFO_Write_En
cparata 0:69566eea0fba 999 * Description : Read TIM_PEDO_FIFO_DRDY
cparata 0:69566eea0fba 1000 * Input : Pointer to LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_DRDY_t
cparata 0:69566eea0fba 1001 * Output : Status of TIM_PEDO_FIFO_DRDY see LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_DRDY_t
cparata 0:69566eea0fba 1002 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1003 *******************************************************************************/
cparata 0:69566eea0fba 1004 status_t LSM6DSL_ACC_GYRO_R_TIM_PEDO_FIFO_Write_En(void *handle, LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_DRDY_t *value)
cparata 0:69566eea0fba 1005 {
cparata 0:69566eea0fba 1006 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, (u8_t *)value, 1) )
cparata 0:69566eea0fba 1007 return MEMS_ERROR;
cparata 0:69566eea0fba 1008
cparata 0:69566eea0fba 1009 *value &= LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_DRDY_MASK; //mask
cparata 0:69566eea0fba 1010
cparata 0:69566eea0fba 1011 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1012 }
cparata 0:69566eea0fba 1013
cparata 0:69566eea0fba 1014 /*******************************************************************************
cparata 0:69566eea0fba 1015 * Function Name : LSM6DSL_ACC_GYRO_W_TIM_PEDO_FIFO_En
cparata 0:69566eea0fba 1016 * Description : Write TIM_PEDO_FIFO_EN
cparata 0:69566eea0fba 1017 * Input : LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_EN_t
cparata 0:69566eea0fba 1018 * Output : None
cparata 0:69566eea0fba 1019 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1020 *******************************************************************************/
cparata 0:69566eea0fba 1021 status_t LSM6DSL_ACC_GYRO_W_TIM_PEDO_FIFO_En(void *handle, LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_EN_t newValue)
cparata 0:69566eea0fba 1022 {
cparata 0:69566eea0fba 1023 u8_t value;
cparata 0:69566eea0fba 1024
cparata 0:69566eea0fba 1025 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
cparata 0:69566eea0fba 1026 return MEMS_ERROR;
cparata 0:69566eea0fba 1027
cparata 0:69566eea0fba 1028 value &= ~LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_EN_MASK;
cparata 0:69566eea0fba 1029 value |= newValue;
cparata 0:69566eea0fba 1030
cparata 0:69566eea0fba 1031 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
cparata 0:69566eea0fba 1032 return MEMS_ERROR;
cparata 0:69566eea0fba 1033
cparata 0:69566eea0fba 1034 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1035 }
cparata 0:69566eea0fba 1036
cparata 0:69566eea0fba 1037 /*******************************************************************************
cparata 0:69566eea0fba 1038 * Function Name : LSM6DSL_ACC_GYRO_R_TIM_PEDO_FIFO_En
cparata 0:69566eea0fba 1039 * Description : Read TIM_PEDO_FIFO_EN
cparata 0:69566eea0fba 1040 * Input : Pointer to LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_EN_t
cparata 0:69566eea0fba 1041 * Output : Status of TIM_PEDO_FIFO_EN see LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_EN_t
cparata 0:69566eea0fba 1042 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1043 *******************************************************************************/
cparata 0:69566eea0fba 1044 status_t LSM6DSL_ACC_GYRO_R_TIM_PEDO_FIFO_En(void *handle, LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_EN_t *value)
cparata 0:69566eea0fba 1045 {
cparata 0:69566eea0fba 1046 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, (u8_t *)value, 1) )
cparata 0:69566eea0fba 1047 return MEMS_ERROR;
cparata 0:69566eea0fba 1048
cparata 0:69566eea0fba 1049 *value &= LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_EN_MASK; //mask
cparata 0:69566eea0fba 1050
cparata 0:69566eea0fba 1051 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1052 }
cparata 0:69566eea0fba 1053 /*******************************************************************************
cparata 0:69566eea0fba 1054 * Function Name : LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL
cparata 0:69566eea0fba 1055 * Description : Write DEC_FIFO_XL
cparata 0:69566eea0fba 1056 * Input : LSM6DSL_ACC_GYRO_DEC_FIFO_XL_t
cparata 0:69566eea0fba 1057 * Output : None
cparata 0:69566eea0fba 1058 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1059 *******************************************************************************/
cparata 0:69566eea0fba 1060 status_t LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_t newValue)
cparata 0:69566eea0fba 1061 {
cparata 0:69566eea0fba 1062 u8_t value;
cparata 0:69566eea0fba 1063
cparata 0:69566eea0fba 1064 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL3, &value, 1) )
cparata 0:69566eea0fba 1065 return MEMS_ERROR;
cparata 0:69566eea0fba 1066
cparata 0:69566eea0fba 1067 value &= ~LSM6DSL_ACC_GYRO_DEC_FIFO_XL_MASK;
cparata 0:69566eea0fba 1068 value |= newValue;
cparata 0:69566eea0fba 1069
cparata 0:69566eea0fba 1070 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL3, &value, 1) )
cparata 0:69566eea0fba 1071 return MEMS_ERROR;
cparata 0:69566eea0fba 1072
cparata 0:69566eea0fba 1073 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1074 }
cparata 0:69566eea0fba 1075
cparata 0:69566eea0fba 1076 /*******************************************************************************
cparata 0:69566eea0fba 1077 * Function Name : LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL_val
cparata 0:69566eea0fba 1078 * Description : Write DEC_FIFO_XL
cparata 0:69566eea0fba 1079 * Input : u16_t
cparata 0:69566eea0fba 1080 * Output : Program XL decimation value from unsigned short
cparata 0:69566eea0fba 1081 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1082 *******************************************************************************/
cparata 0:69566eea0fba 1083 status_t LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL_val(void *handle, u16_t newValue)
cparata 0:69566eea0fba 1084 {
cparata 0:69566eea0fba 1085 switch(newValue) {
cparata 0:69566eea0fba 1086 case 0:
cparata 0:69566eea0fba 1087 LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_DATA_NOT_IN_FIFO);
cparata 0:69566eea0fba 1088 break;
cparata 0:69566eea0fba 1089
cparata 0:69566eea0fba 1090 case 1:
cparata 0:69566eea0fba 1091 LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_NO_DECIMATION);
cparata 0:69566eea0fba 1092 break;
cparata 0:69566eea0fba 1093
cparata 0:69566eea0fba 1094 case 2:
cparata 0:69566eea0fba 1095 LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_2);
cparata 0:69566eea0fba 1096 break;
cparata 0:69566eea0fba 1097
cparata 0:69566eea0fba 1098 case 3:
cparata 0:69566eea0fba 1099 LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_3);
cparata 0:69566eea0fba 1100 break;
cparata 0:69566eea0fba 1101
cparata 0:69566eea0fba 1102 case 4:
cparata 0:69566eea0fba 1103 LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_4);
cparata 0:69566eea0fba 1104 break;
cparata 0:69566eea0fba 1105
cparata 0:69566eea0fba 1106 case 8:
cparata 0:69566eea0fba 1107 LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_8);
cparata 0:69566eea0fba 1108 break;
cparata 0:69566eea0fba 1109
cparata 0:69566eea0fba 1110 case 16:
cparata 0:69566eea0fba 1111 LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_16);
cparata 0:69566eea0fba 1112 break;
cparata 0:69566eea0fba 1113
cparata 0:69566eea0fba 1114 case 32:
cparata 0:69566eea0fba 1115 LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_32);
cparata 0:69566eea0fba 1116 break;
cparata 0:69566eea0fba 1117
cparata 0:69566eea0fba 1118 default:
cparata 0:69566eea0fba 1119 return MEMS_ERROR;
cparata 0:69566eea0fba 1120 }
cparata 0:69566eea0fba 1121
cparata 0:69566eea0fba 1122 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1123 }
cparata 0:69566eea0fba 1124
cparata 0:69566eea0fba 1125 /*******************************************************************************
cparata 0:69566eea0fba 1126 * Function Name : LSM6DSL_ACC_GYRO_R_DEC_FIFO_XL
cparata 0:69566eea0fba 1127 * Description : Read DEC_FIFO_XL
cparata 0:69566eea0fba 1128 * Input : Pointer to LSM6DSL_ACC_GYRO_DEC_FIFO_XL_t
cparata 0:69566eea0fba 1129 * Output : Status of DEC_FIFO_XL see LSM6DSL_ACC_GYRO_DEC_FIFO_XL_t
cparata 0:69566eea0fba 1130 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1131 *******************************************************************************/
cparata 0:69566eea0fba 1132 status_t LSM6DSL_ACC_GYRO_R_DEC_FIFO_XL(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_t *value)
cparata 0:69566eea0fba 1133 {
cparata 0:69566eea0fba 1134 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL3, (u8_t *)value, 1) )
cparata 0:69566eea0fba 1135 return MEMS_ERROR;
cparata 0:69566eea0fba 1136
cparata 0:69566eea0fba 1137 *value &= LSM6DSL_ACC_GYRO_DEC_FIFO_XL_MASK; //mask
cparata 0:69566eea0fba 1138
cparata 0:69566eea0fba 1139 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1140 }
cparata 0:69566eea0fba 1141
cparata 0:69566eea0fba 1142 /*******************************************************************************
cparata 0:69566eea0fba 1143 * Function Name : LSM6DSL_ACC_GYRO_W_DEC_FIFO_G
cparata 0:69566eea0fba 1144 * Description : Write DEC_FIFO_G
cparata 0:69566eea0fba 1145 * Input : LSM6DSL_ACC_GYRO_DEC_FIFO_G_t
cparata 0:69566eea0fba 1146 * Output : None
cparata 0:69566eea0fba 1147 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1148 *******************************************************************************/
cparata 0:69566eea0fba 1149 status_t LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_t newValue)
cparata 0:69566eea0fba 1150 {
cparata 0:69566eea0fba 1151 u8_t value;
cparata 0:69566eea0fba 1152
cparata 0:69566eea0fba 1153 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL3, &value, 1))
cparata 0:69566eea0fba 1154 return MEMS_ERROR;
cparata 0:69566eea0fba 1155
cparata 0:69566eea0fba 1156 value &= ~LSM6DSL_ACC_GYRO_DEC_FIFO_G_MASK;
cparata 0:69566eea0fba 1157 value |= newValue;
cparata 0:69566eea0fba 1158
cparata 0:69566eea0fba 1159 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL3, &value, 1) )
cparata 0:69566eea0fba 1160 return MEMS_ERROR;
cparata 0:69566eea0fba 1161
cparata 0:69566eea0fba 1162 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1163 }
cparata 0:69566eea0fba 1164
cparata 0:69566eea0fba 1165 /*******************************************************************************
cparata 0:69566eea0fba 1166 * Function Name : LSM6DSL_ACC_GYRO_W_DEC_FIFO_G_val
cparata 0:69566eea0fba 1167 * Description : Write DEC_FIFO_G
cparata 0:69566eea0fba 1168 * Input : u16_t
cparata 0:69566eea0fba 1169 * Output : Program G decimation value from unsigned short
cparata 0:69566eea0fba 1170 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1171 *******************************************************************************/
cparata 0:69566eea0fba 1172 status_t LSM6DSL_ACC_GYRO_W_DEC_FIFO_G_val(void *handle, u16_t newValue)
cparata 0:69566eea0fba 1173 {
cparata 0:69566eea0fba 1174 switch(newValue) {
cparata 0:69566eea0fba 1175 case 0:
cparata 0:69566eea0fba 1176 LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_DATA_NOT_IN_FIFO);
cparata 0:69566eea0fba 1177 break;
cparata 0:69566eea0fba 1178
cparata 0:69566eea0fba 1179 case 1:
cparata 0:69566eea0fba 1180 LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_NO_DECIMATION);
cparata 0:69566eea0fba 1181 break;
cparata 0:69566eea0fba 1182
cparata 0:69566eea0fba 1183 case 2:
cparata 0:69566eea0fba 1184 LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_2);
cparata 0:69566eea0fba 1185 break;
cparata 0:69566eea0fba 1186
cparata 0:69566eea0fba 1187 case 3:
cparata 0:69566eea0fba 1188 LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_3);
cparata 0:69566eea0fba 1189 break;
cparata 0:69566eea0fba 1190
cparata 0:69566eea0fba 1191 case 4:
cparata 0:69566eea0fba 1192 LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_4);
cparata 0:69566eea0fba 1193 break;
cparata 0:69566eea0fba 1194
cparata 0:69566eea0fba 1195 case 8:
cparata 0:69566eea0fba 1196 LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_8);
cparata 0:69566eea0fba 1197 break;
cparata 0:69566eea0fba 1198
cparata 0:69566eea0fba 1199 case 16:
cparata 0:69566eea0fba 1200 LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_16);
cparata 0:69566eea0fba 1201 break;
cparata 0:69566eea0fba 1202
cparata 0:69566eea0fba 1203 case 32:
cparata 0:69566eea0fba 1204 LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_32);
cparata 0:69566eea0fba 1205 break;
cparata 0:69566eea0fba 1206
cparata 0:69566eea0fba 1207 default:
cparata 0:69566eea0fba 1208 return MEMS_ERROR;
cparata 0:69566eea0fba 1209 }
cparata 0:69566eea0fba 1210
cparata 0:69566eea0fba 1211 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1212 }
cparata 0:69566eea0fba 1213
cparata 0:69566eea0fba 1214 /*******************************************************************************
cparata 0:69566eea0fba 1215 * Function Name : LSM6DSL_ACC_GYRO_R_DEC_FIFO_G
cparata 0:69566eea0fba 1216 * Description : Read DEC_FIFO_G
cparata 0:69566eea0fba 1217 * Input : Pointer to LSM6DSL_ACC_GYRO_DEC_FIFO_G_t
cparata 0:69566eea0fba 1218 * Output : Status of DEC_FIFO_G see LSM6DSL_ACC_GYRO_DEC_FIFO_G_t
cparata 0:69566eea0fba 1219 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1220 *******************************************************************************/
cparata 0:69566eea0fba 1221 status_t LSM6DSL_ACC_GYRO_R_DEC_FIFO_G(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_t *value)
cparata 0:69566eea0fba 1222 {
cparata 0:69566eea0fba 1223 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL3, (u8_t *)value, 1))
cparata 0:69566eea0fba 1224 return MEMS_ERROR;
cparata 0:69566eea0fba 1225
cparata 0:69566eea0fba 1226 *value &= LSM6DSL_ACC_GYRO_DEC_FIFO_G_MASK; //mask
cparata 0:69566eea0fba 1227
cparata 0:69566eea0fba 1228 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1229 }
cparata 0:69566eea0fba 1230
cparata 0:69566eea0fba 1231 /*******************************************************************************
cparata 0:69566eea0fba 1232 * Function Name : LSM6DSL_ACC_GYRO_W_DEC_FIFO_DS3
cparata 0:69566eea0fba 1233 * Description : Write DEC_DS3_FIFO
cparata 0:69566eea0fba 1234 * Input : LSM6DSL_ACC_GYRO_DEC_FIFO_DS3_t
cparata 0:69566eea0fba 1235 * Output : None
cparata 0:69566eea0fba 1236 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1237 *******************************************************************************/
cparata 0:69566eea0fba 1238 status_t LSM6DSL_ACC_GYRO_W_DEC_FIFO_DS3(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_DS3_t newValue)
cparata 0:69566eea0fba 1239 {
cparata 0:69566eea0fba 1240 u8_t value;
cparata 0:69566eea0fba 1241
cparata 0:69566eea0fba 1242 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1))
cparata 0:69566eea0fba 1243 return MEMS_ERROR;
cparata 0:69566eea0fba 1244
cparata 0:69566eea0fba 1245 value &= ~LSM6DSL_ACC_GYRO_DEC_FIFO_DS3_MASK;
cparata 0:69566eea0fba 1246 value |= newValue;
cparata 0:69566eea0fba 1247
cparata 0:69566eea0fba 1248 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1) )
cparata 0:69566eea0fba 1249 return MEMS_ERROR;
cparata 0:69566eea0fba 1250
cparata 0:69566eea0fba 1251 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1252 }
cparata 0:69566eea0fba 1253
cparata 0:69566eea0fba 1254 /*******************************************************************************
cparata 0:69566eea0fba 1255 * Function Name : LSM6DSL_ACC_GYRO_R_DEC_FIFO_DS3
cparata 0:69566eea0fba 1256 * Description : Read DEC_DS3_FIFO
cparata 0:69566eea0fba 1257 * Input : Pointer to LSM6DSL_ACC_GYRO_DEC_FIFO_DS3_t
cparata 0:69566eea0fba 1258 * Output : Status of DEC_DS3_FIFO see LSM6DSL_ACC_GYRO_DEC_FIFO_DS3_t
cparata 0:69566eea0fba 1259 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1260 *******************************************************************************/
cparata 0:69566eea0fba 1261 status_t LSM6DSL_ACC_GYRO_R_DEC_FIFO_DS3(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_DS3_t *value)
cparata 0:69566eea0fba 1262 {
cparata 0:69566eea0fba 1263 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, (u8_t *)value, 1))
cparata 0:69566eea0fba 1264 return MEMS_ERROR;
cparata 0:69566eea0fba 1265
cparata 0:69566eea0fba 1266 *value &= LSM6DSL_ACC_GYRO_DEC_FIFO_DS3_MASK; //mask
cparata 0:69566eea0fba 1267
cparata 0:69566eea0fba 1268 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1269 }
cparata 0:69566eea0fba 1270
cparata 0:69566eea0fba 1271 /*******************************************************************************
cparata 0:69566eea0fba 1272 * Function Name : LSM6DSL_ACC_GYRO_W_DEC_FIFO_DS4
cparata 0:69566eea0fba 1273 * Description : Write DEC_DS4_FIFO
cparata 0:69566eea0fba 1274 * Input : LSM6DSL_ACC_GYRO_DEC_FIFO_DS4_t
cparata 0:69566eea0fba 1275 * Output : None
cparata 0:69566eea0fba 1276 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1277 *******************************************************************************/
cparata 0:69566eea0fba 1278 status_t LSM6DSL_ACC_GYRO_W_DEC_FIFO_DS4(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_DS4_t newValue)
cparata 0:69566eea0fba 1279 {
cparata 0:69566eea0fba 1280 u8_t value;
cparata 0:69566eea0fba 1281
cparata 0:69566eea0fba 1282 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1))
cparata 0:69566eea0fba 1283 return MEMS_ERROR;
cparata 0:69566eea0fba 1284
cparata 0:69566eea0fba 1285 value &= ~LSM6DSL_ACC_GYRO_DEC_FIFO_DS4_MASK;
cparata 0:69566eea0fba 1286 value |= newValue;
cparata 0:69566eea0fba 1287
cparata 0:69566eea0fba 1288 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1) )
cparata 0:69566eea0fba 1289 return MEMS_ERROR;
cparata 0:69566eea0fba 1290
cparata 0:69566eea0fba 1291 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1292 }
cparata 0:69566eea0fba 1293
cparata 0:69566eea0fba 1294 /*******************************************************************************
cparata 0:69566eea0fba 1295 * Function Name : LSM6DSL_ACC_GYRO_R_DEC_FIFO_DS4
cparata 0:69566eea0fba 1296 * Description : Read DEC_DS4_FIFO
cparata 0:69566eea0fba 1297 * Input : Pointer to LSM6DSL_ACC_GYRO_DEC_FIFO_DS4_t
cparata 0:69566eea0fba 1298 * Output : Status of DEC_DS4_FIFO see LSM6DSL_ACC_GYRO_DEC_FIFO_DS4_t
cparata 0:69566eea0fba 1299 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1300 *******************************************************************************/
cparata 0:69566eea0fba 1301 status_t LSM6DSL_ACC_GYRO_R_DEC_FIFO_DS4(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_DS4_t *value)
cparata 0:69566eea0fba 1302 {
cparata 0:69566eea0fba 1303 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, (u8_t *)value, 1))
cparata 0:69566eea0fba 1304 return MEMS_ERROR;
cparata 0:69566eea0fba 1305
cparata 0:69566eea0fba 1306 *value &= LSM6DSL_ACC_GYRO_DEC_FIFO_DS4_MASK; //mask
cparata 0:69566eea0fba 1307
cparata 0:69566eea0fba 1308 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1309 }
cparata 0:69566eea0fba 1310
cparata 0:69566eea0fba 1311 /*******************************************************************************
cparata 0:69566eea0fba 1312 * Function Name : LSM6DSL_ACC_GYRO_W_HI_DATA_ONLY
cparata 0:69566eea0fba 1313 * Description : Write HI_DATA_ONLY
cparata 0:69566eea0fba 1314 * Input : LSM6DSL_ACC_GYRO_HI_DATA_ONLY_t
cparata 0:69566eea0fba 1315 * Output : None
cparata 0:69566eea0fba 1316 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1317 *******************************************************************************/
cparata 0:69566eea0fba 1318 status_t LSM6DSL_ACC_GYRO_W_HI_DATA_ONLY(void *handle, LSM6DSL_ACC_GYRO_HI_DATA_ONLY_t newValue)
cparata 0:69566eea0fba 1319 {
cparata 0:69566eea0fba 1320 u8_t value;
cparata 0:69566eea0fba 1321
cparata 0:69566eea0fba 1322 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1))
cparata 0:69566eea0fba 1323 return MEMS_ERROR;
cparata 0:69566eea0fba 1324
cparata 0:69566eea0fba 1325 value &= ~LSM6DSL_ACC_GYRO_HI_DATA_ONLY_MASK;
cparata 0:69566eea0fba 1326 value |= newValue;
cparata 0:69566eea0fba 1327
cparata 0:69566eea0fba 1328 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1) )
cparata 0:69566eea0fba 1329 return MEMS_ERROR;
cparata 0:69566eea0fba 1330
cparata 0:69566eea0fba 1331 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1332 }
cparata 0:69566eea0fba 1333
cparata 0:69566eea0fba 1334 /*******************************************************************************
cparata 0:69566eea0fba 1335 * Function Name : LSM6DSL_ACC_GYRO_R_HI_DATA_ONLY
cparata 0:69566eea0fba 1336 * Description : Read HI_DATA_ONLY
cparata 0:69566eea0fba 1337 * Input : Pointer to LSM6DSL_ACC_GYRO_HI_DATA_ONLY_t
cparata 0:69566eea0fba 1338 * Output : Status of HI_DATA_ONLY see LSM6DSL_ACC_GYRO_HI_DATA_ONLY_t
cparata 0:69566eea0fba 1339 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1340 *******************************************************************************/
cparata 0:69566eea0fba 1341 status_t LSM6DSL_ACC_GYRO_R_HI_DATA_ONLY(void *handle, LSM6DSL_ACC_GYRO_HI_DATA_ONLY_t *value)
cparata 0:69566eea0fba 1342 {
cparata 0:69566eea0fba 1343 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, (u8_t *)value, 1))
cparata 0:69566eea0fba 1344 return MEMS_ERROR;
cparata 0:69566eea0fba 1345
cparata 0:69566eea0fba 1346 *value &= LSM6DSL_ACC_GYRO_HI_DATA_ONLY_MASK; //mask
cparata 0:69566eea0fba 1347
cparata 0:69566eea0fba 1348 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1349 }
cparata 0:69566eea0fba 1350
cparata 0:69566eea0fba 1351 /*******************************************************************************
cparata 0:69566eea0fba 1352 * Function Name : LSM6DSL_ACC_GYRO_W_STOP_ON_FTH
cparata 0:69566eea0fba 1353 * Description : Write STOP_ON_FTH
cparata 0:69566eea0fba 1354 * Input : LSM6DSL_ACC_GYRO_STOP_ON_FTH_t
cparata 0:69566eea0fba 1355 * Output : None
cparata 0:69566eea0fba 1356 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1357 *******************************************************************************/
cparata 0:69566eea0fba 1358 status_t LSM6DSL_ACC_GYRO_W_STOP_ON_FTH(void *handle, LSM6DSL_ACC_GYRO_STOP_ON_FTH_t newValue)
cparata 0:69566eea0fba 1359 {
cparata 0:69566eea0fba 1360 u8_t value;
cparata 0:69566eea0fba 1361
cparata 0:69566eea0fba 1362 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1))
cparata 0:69566eea0fba 1363 return MEMS_ERROR;
cparata 0:69566eea0fba 1364
cparata 0:69566eea0fba 1365 value &= ~LSM6DSL_ACC_GYRO_STOP_ON_FTH_MASK;
cparata 0:69566eea0fba 1366 value |= newValue;
cparata 0:69566eea0fba 1367
cparata 0:69566eea0fba 1368 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1) )
cparata 0:69566eea0fba 1369 return MEMS_ERROR;
cparata 0:69566eea0fba 1370
cparata 0:69566eea0fba 1371 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1372 }
cparata 0:69566eea0fba 1373
cparata 0:69566eea0fba 1374 /*******************************************************************************
cparata 0:69566eea0fba 1375 * Function Name : LSM6DSL_ACC_GYRO_R_STOP_ON_FTH
cparata 0:69566eea0fba 1376 * Description : Read STOP_ON_FTH
cparata 0:69566eea0fba 1377 * Input : Pointer to LSM6DSL_ACC_GYRO_STOP_ON_FTH_t
cparata 0:69566eea0fba 1378 * Output : Status of STOP_ON_FTH see LSM6DSL_ACC_GYRO_STOP_ON_FTH_t
cparata 0:69566eea0fba 1379 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1380 *******************************************************************************/
cparata 0:69566eea0fba 1381 status_t LSM6DSL_ACC_GYRO_R_STOP_ON_FTH(void *handle, LSM6DSL_ACC_GYRO_STOP_ON_FTH_t *value)
cparata 0:69566eea0fba 1382 {
cparata 0:69566eea0fba 1383 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, (u8_t *)value, 1))
cparata 0:69566eea0fba 1384 return MEMS_ERROR;
cparata 0:69566eea0fba 1385
cparata 0:69566eea0fba 1386 *value &= LSM6DSL_ACC_GYRO_STOP_ON_FTH_MASK; //mask
cparata 0:69566eea0fba 1387
cparata 0:69566eea0fba 1388 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1389 }
cparata 0:69566eea0fba 1390
cparata 0:69566eea0fba 1391 /*******************************************************************************
cparata 0:69566eea0fba 1392 * Function Name : LSM6DSL_ACC_GYRO_W_FIFO_MODE
cparata 0:69566eea0fba 1393 * Description : Write FIFO_MODE
cparata 0:69566eea0fba 1394 * Input : LSM6DSL_ACC_GYRO_FIFO_MODE_t
cparata 0:69566eea0fba 1395 * Output : None
cparata 0:69566eea0fba 1396 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1397 *******************************************************************************/
cparata 0:69566eea0fba 1398 status_t LSM6DSL_ACC_GYRO_W_FIFO_MODE(void *handle, LSM6DSL_ACC_GYRO_FIFO_MODE_t newValue)
cparata 0:69566eea0fba 1399 {
cparata 0:69566eea0fba 1400 u8_t value;
cparata 0:69566eea0fba 1401
cparata 0:69566eea0fba 1402 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL5, &value, 1))
cparata 0:69566eea0fba 1403 return MEMS_ERROR;
cparata 0:69566eea0fba 1404
cparata 0:69566eea0fba 1405 value &= ~LSM6DSL_ACC_GYRO_FIFO_MODE_MASK;
cparata 0:69566eea0fba 1406 value |= newValue;
cparata 0:69566eea0fba 1407
cparata 0:69566eea0fba 1408 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL5, &value, 1) )
cparata 0:69566eea0fba 1409 return MEMS_ERROR;
cparata 0:69566eea0fba 1410
cparata 0:69566eea0fba 1411 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1412 }
cparata 0:69566eea0fba 1413
cparata 0:69566eea0fba 1414 /*******************************************************************************
cparata 0:69566eea0fba 1415 * Function Name : LSM6DSL_ACC_GYRO_R_FIFO_MODE
cparata 0:69566eea0fba 1416 * Description : Read FIFO_MODE
cparata 0:69566eea0fba 1417 * Input : Pointer to LSM6DSL_ACC_GYRO_FIFO_MODE_t
cparata 0:69566eea0fba 1418 * Output : Status of FIFO_MODE see LSM6DSL_ACC_GYRO_FIFO_MODE_t
cparata 0:69566eea0fba 1419 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1420 *******************************************************************************/
cparata 0:69566eea0fba 1421 status_t LSM6DSL_ACC_GYRO_R_FIFO_MODE(void *handle, LSM6DSL_ACC_GYRO_FIFO_MODE_t *value)
cparata 0:69566eea0fba 1422 {
cparata 0:69566eea0fba 1423 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL5, (u8_t *)value, 1))
cparata 0:69566eea0fba 1424 return MEMS_ERROR;
cparata 0:69566eea0fba 1425
cparata 0:69566eea0fba 1426 *value &= LSM6DSL_ACC_GYRO_FIFO_MODE_MASK; //mask
cparata 0:69566eea0fba 1427
cparata 0:69566eea0fba 1428 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1429 }
cparata 0:69566eea0fba 1430
cparata 0:69566eea0fba 1431 /*******************************************************************************
cparata 0:69566eea0fba 1432 * Function Name : LSM6DSL_ACC_GYRO_W_ODR_FIFO
cparata 0:69566eea0fba 1433 * Description : Write ODR_FIFO
cparata 0:69566eea0fba 1434 * Input : LSM6DSL_ACC_GYRO_ODR_FIFO_t
cparata 0:69566eea0fba 1435 * Output : None
cparata 0:69566eea0fba 1436 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1437 *******************************************************************************/
cparata 0:69566eea0fba 1438 status_t LSM6DSL_ACC_GYRO_W_ODR_FIFO(void *handle, LSM6DSL_ACC_GYRO_ODR_FIFO_t newValue)
cparata 0:69566eea0fba 1439 {
cparata 0:69566eea0fba 1440 u8_t value;
cparata 0:69566eea0fba 1441
cparata 0:69566eea0fba 1442 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL5, &value, 1))
cparata 0:69566eea0fba 1443 return MEMS_ERROR;
cparata 0:69566eea0fba 1444
cparata 0:69566eea0fba 1445 value &= ~LSM6DSL_ACC_GYRO_ODR_FIFO_MASK;
cparata 0:69566eea0fba 1446 value |= newValue;
cparata 0:69566eea0fba 1447
cparata 0:69566eea0fba 1448 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL5, &value, 1) )
cparata 0:69566eea0fba 1449 return MEMS_ERROR;
cparata 0:69566eea0fba 1450
cparata 0:69566eea0fba 1451 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1452 }
cparata 0:69566eea0fba 1453
cparata 0:69566eea0fba 1454 /*******************************************************************************
cparata 0:69566eea0fba 1455 * Function Name : LSM6DSL_ACC_GYRO_R_ODR_FIFO
cparata 0:69566eea0fba 1456 * Description : Read ODR_FIFO
cparata 0:69566eea0fba 1457 * Input : Pointer to LSM6DSL_ACC_GYRO_ODR_FIFO_t
cparata 0:69566eea0fba 1458 * Output : Status of ODR_FIFO see LSM6DSL_ACC_GYRO_ODR_FIFO_t
cparata 0:69566eea0fba 1459 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1460 *******************************************************************************/
cparata 0:69566eea0fba 1461 status_t LSM6DSL_ACC_GYRO_R_ODR_FIFO(void *handle, LSM6DSL_ACC_GYRO_ODR_FIFO_t *value)
cparata 0:69566eea0fba 1462 {
cparata 0:69566eea0fba 1463 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL5, (u8_t *)value, 1))
cparata 0:69566eea0fba 1464 return MEMS_ERROR;
cparata 0:69566eea0fba 1465
cparata 0:69566eea0fba 1466 *value &= LSM6DSL_ACC_GYRO_ODR_FIFO_MASK; //mask
cparata 0:69566eea0fba 1467
cparata 0:69566eea0fba 1468 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1469 }
cparata 0:69566eea0fba 1470
cparata 0:69566eea0fba 1471 /*******************************************************************************
cparata 0:69566eea0fba 1472 * Function Name : LSM6DSL_ACC_GYRO_W_DRDY_PULSE
cparata 0:69566eea0fba 1473 * Description : Write DRDY_PULSE
cparata 0:69566eea0fba 1474 * Input : LSM6DSL_ACC_GYRO_DRDY_PULSE_t
cparata 0:69566eea0fba 1475 * Output : None
cparata 0:69566eea0fba 1476 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1477 *******************************************************************************/
cparata 0:69566eea0fba 1478 status_t LSM6DSL_ACC_GYRO_W_DRDY_PULSE(void *handle, LSM6DSL_ACC_GYRO_DRDY_PULSE_t newValue)
cparata 0:69566eea0fba 1479 {
cparata 0:69566eea0fba 1480 u8_t value;
cparata 0:69566eea0fba 1481
cparata 0:69566eea0fba 1482 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_DRDY_PULSE_CFG_G, &value, 1))
cparata 0:69566eea0fba 1483 return MEMS_ERROR;
cparata 0:69566eea0fba 1484
cparata 0:69566eea0fba 1485 value &= ~LSM6DSL_ACC_GYRO_DRDY_PULSE_MASK;
cparata 0:69566eea0fba 1486 value |= newValue;
cparata 0:69566eea0fba 1487
cparata 0:69566eea0fba 1488 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_DRDY_PULSE_CFG_G, &value, 1) )
cparata 0:69566eea0fba 1489 return MEMS_ERROR;
cparata 0:69566eea0fba 1490
cparata 0:69566eea0fba 1491 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1492 }
cparata 0:69566eea0fba 1493
cparata 0:69566eea0fba 1494 /*******************************************************************************
cparata 0:69566eea0fba 1495 * Function Name : LSM6DSL_ACC_GYRO_R_DRDY_PULSE
cparata 0:69566eea0fba 1496 * Description : Read DRDY_PULSE
cparata 0:69566eea0fba 1497 * Input : Pointer to LSM6DSL_ACC_GYRO_DRDY_PULSE_t
cparata 0:69566eea0fba 1498 * Output : Status of DRDY_PULSE see LSM6DSL_ACC_GYRO_DRDY_PULSE_t
cparata 0:69566eea0fba 1499 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1500 *******************************************************************************/
cparata 0:69566eea0fba 1501 status_t LSM6DSL_ACC_GYRO_R_DRDY_PULSE(void *handle, LSM6DSL_ACC_GYRO_DRDY_PULSE_t *value)
cparata 0:69566eea0fba 1502 {
cparata 0:69566eea0fba 1503 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_DRDY_PULSE_CFG_G, (u8_t *)value, 1))
cparata 0:69566eea0fba 1504 return MEMS_ERROR;
cparata 0:69566eea0fba 1505
cparata 0:69566eea0fba 1506 *value &= LSM6DSL_ACC_GYRO_DRDY_PULSE_MASK; //mask
cparata 0:69566eea0fba 1507
cparata 0:69566eea0fba 1508 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1509 }
cparata 0:69566eea0fba 1510
cparata 0:69566eea0fba 1511 /*******************************************************************************
cparata 0:69566eea0fba 1512 * Function Name : LSM6DSL_ACC_GYRO_W_DRDY_XL_on_INT1
cparata 0:69566eea0fba 1513 * Description : Write INT1_DRDY_XL
cparata 0:69566eea0fba 1514 * Input : LSM6DSL_ACC_GYRO_INT1_DRDY_XL_t
cparata 0:69566eea0fba 1515 * Output : None
cparata 0:69566eea0fba 1516 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1517 *******************************************************************************/
cparata 0:69566eea0fba 1518 status_t LSM6DSL_ACC_GYRO_W_DRDY_XL_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_DRDY_XL_t newValue)
cparata 0:69566eea0fba 1519 {
cparata 0:69566eea0fba 1520 u8_t value;
cparata 0:69566eea0fba 1521
cparata 0:69566eea0fba 1522 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
cparata 0:69566eea0fba 1523 return MEMS_ERROR;
cparata 0:69566eea0fba 1524
cparata 0:69566eea0fba 1525 value &= ~LSM6DSL_ACC_GYRO_INT1_DRDY_XL_MASK;
cparata 0:69566eea0fba 1526 value |= newValue;
cparata 0:69566eea0fba 1527
cparata 0:69566eea0fba 1528 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
cparata 0:69566eea0fba 1529 return MEMS_ERROR;
cparata 0:69566eea0fba 1530
cparata 0:69566eea0fba 1531 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1532 }
cparata 0:69566eea0fba 1533
cparata 0:69566eea0fba 1534 /*******************************************************************************
cparata 0:69566eea0fba 1535 * Function Name : LSM6DSL_ACC_GYRO_R_DRDY_XL_on_INT1
cparata 0:69566eea0fba 1536 * Description : Read INT1_DRDY_XL
cparata 0:69566eea0fba 1537 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_DRDY_XL_t
cparata 0:69566eea0fba 1538 * Output : Status of INT1_DRDY_XL see LSM6DSL_ACC_GYRO_INT1_DRDY_XL_t
cparata 0:69566eea0fba 1539 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1540 *******************************************************************************/
cparata 0:69566eea0fba 1541 status_t LSM6DSL_ACC_GYRO_R_DRDY_XL_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_DRDY_XL_t *value)
cparata 0:69566eea0fba 1542 {
cparata 0:69566eea0fba 1543 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
cparata 0:69566eea0fba 1544 return MEMS_ERROR;
cparata 0:69566eea0fba 1545
cparata 0:69566eea0fba 1546 *value &= LSM6DSL_ACC_GYRO_INT1_DRDY_XL_MASK; //mask
cparata 0:69566eea0fba 1547
cparata 0:69566eea0fba 1548 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1549 }
cparata 0:69566eea0fba 1550
cparata 0:69566eea0fba 1551 /*******************************************************************************
cparata 0:69566eea0fba 1552 * Function Name : LSM6DSL_ACC_GYRO_W_DRDY_G_on_INT1
cparata 0:69566eea0fba 1553 * Description : Write INT1_DRDY_G
cparata 0:69566eea0fba 1554 * Input : LSM6DSL_ACC_GYRO_INT1_DRDY_G_t
cparata 0:69566eea0fba 1555 * Output : None
cparata 0:69566eea0fba 1556 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1557 *******************************************************************************/
cparata 0:69566eea0fba 1558 status_t LSM6DSL_ACC_GYRO_W_DRDY_G_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_DRDY_G_t newValue)
cparata 0:69566eea0fba 1559 {
cparata 0:69566eea0fba 1560 u8_t value;
cparata 0:69566eea0fba 1561
cparata 0:69566eea0fba 1562 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
cparata 0:69566eea0fba 1563 return MEMS_ERROR;
cparata 0:69566eea0fba 1564
cparata 0:69566eea0fba 1565 value &= ~LSM6DSL_ACC_GYRO_INT1_DRDY_G_MASK;
cparata 0:69566eea0fba 1566 value |= newValue;
cparata 0:69566eea0fba 1567
cparata 0:69566eea0fba 1568 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
cparata 0:69566eea0fba 1569 return MEMS_ERROR;
cparata 0:69566eea0fba 1570
cparata 0:69566eea0fba 1571 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1572 }
cparata 0:69566eea0fba 1573
cparata 0:69566eea0fba 1574 /*******************************************************************************
cparata 0:69566eea0fba 1575 * Function Name : LSM6DSL_ACC_GYRO_R_DRDY_G_on_INT1
cparata 0:69566eea0fba 1576 * Description : Read INT1_DRDY_G
cparata 0:69566eea0fba 1577 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_DRDY_G_t
cparata 0:69566eea0fba 1578 * Output : Status of INT1_DRDY_G see LSM6DSL_ACC_GYRO_INT1_DRDY_G_t
cparata 0:69566eea0fba 1579 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1580 *******************************************************************************/
cparata 0:69566eea0fba 1581 status_t LSM6DSL_ACC_GYRO_R_DRDY_G_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_DRDY_G_t *value)
cparata 0:69566eea0fba 1582 {
cparata 0:69566eea0fba 1583 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
cparata 0:69566eea0fba 1584 return MEMS_ERROR;
cparata 0:69566eea0fba 1585
cparata 0:69566eea0fba 1586 *value &= LSM6DSL_ACC_GYRO_INT1_DRDY_G_MASK; //mask
cparata 0:69566eea0fba 1587
cparata 0:69566eea0fba 1588 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1589 }
cparata 0:69566eea0fba 1590
cparata 0:69566eea0fba 1591 /*******************************************************************************
cparata 0:69566eea0fba 1592 * Function Name : LSM6DSL_ACC_GYRO_W_BOOT_on_INT1
cparata 0:69566eea0fba 1593 * Description : Write INT1_BOOT
cparata 0:69566eea0fba 1594 * Input : LSM6DSL_ACC_GYRO_INT1_BOOT_t
cparata 0:69566eea0fba 1595 * Output : None
cparata 0:69566eea0fba 1596 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1597 *******************************************************************************/
cparata 0:69566eea0fba 1598 status_t LSM6DSL_ACC_GYRO_W_BOOT_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_BOOT_t newValue)
cparata 0:69566eea0fba 1599 {
cparata 0:69566eea0fba 1600 u8_t value;
cparata 0:69566eea0fba 1601
cparata 0:69566eea0fba 1602 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
cparata 0:69566eea0fba 1603 return MEMS_ERROR;
cparata 0:69566eea0fba 1604
cparata 0:69566eea0fba 1605 value &= ~LSM6DSL_ACC_GYRO_INT1_BOOT_MASK;
cparata 0:69566eea0fba 1606 value |= newValue;
cparata 0:69566eea0fba 1607
cparata 0:69566eea0fba 1608 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
cparata 0:69566eea0fba 1609 return MEMS_ERROR;
cparata 0:69566eea0fba 1610
cparata 0:69566eea0fba 1611 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1612 }
cparata 0:69566eea0fba 1613
cparata 0:69566eea0fba 1614 /*******************************************************************************
cparata 0:69566eea0fba 1615 * Function Name : LSM6DSL_ACC_GYRO_R_BOOT_on_INT1
cparata 0:69566eea0fba 1616 * Description : Read INT1_BOOT
cparata 0:69566eea0fba 1617 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_BOOT_t
cparata 0:69566eea0fba 1618 * Output : Status of INT1_BOOT see LSM6DSL_ACC_GYRO_INT1_BOOT_t
cparata 0:69566eea0fba 1619 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1620 *******************************************************************************/
cparata 0:69566eea0fba 1621 status_t LSM6DSL_ACC_GYRO_R_BOOT_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_BOOT_t *value)
cparata 0:69566eea0fba 1622 {
cparata 0:69566eea0fba 1623 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
cparata 0:69566eea0fba 1624 return MEMS_ERROR;
cparata 0:69566eea0fba 1625
cparata 0:69566eea0fba 1626 *value &= LSM6DSL_ACC_GYRO_INT1_BOOT_MASK; //mask
cparata 0:69566eea0fba 1627
cparata 0:69566eea0fba 1628 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1629 }
cparata 0:69566eea0fba 1630
cparata 0:69566eea0fba 1631 /*******************************************************************************
cparata 0:69566eea0fba 1632 * Function Name : LSM6DSL_ACC_GYRO_W_FIFO_TSHLD_on_INT1
cparata 0:69566eea0fba 1633 * Description : Write INT1_FTH
cparata 0:69566eea0fba 1634 * Input : LSM6DSL_ACC_GYRO_INT1_FTH_t
cparata 0:69566eea0fba 1635 * Output : None
cparata 0:69566eea0fba 1636 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1637 *******************************************************************************/
cparata 0:69566eea0fba 1638 status_t LSM6DSL_ACC_GYRO_W_FIFO_TSHLD_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_FTH_t newValue)
cparata 0:69566eea0fba 1639 {
cparata 0:69566eea0fba 1640 u8_t value;
cparata 0:69566eea0fba 1641
cparata 0:69566eea0fba 1642 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
cparata 0:69566eea0fba 1643 return MEMS_ERROR;
cparata 0:69566eea0fba 1644
cparata 0:69566eea0fba 1645 value &= ~LSM6DSL_ACC_GYRO_INT1_FTH_MASK;
cparata 0:69566eea0fba 1646 value |= newValue;
cparata 0:69566eea0fba 1647
cparata 0:69566eea0fba 1648 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
cparata 0:69566eea0fba 1649 return MEMS_ERROR;
cparata 0:69566eea0fba 1650
cparata 0:69566eea0fba 1651 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1652 }
cparata 0:69566eea0fba 1653
cparata 0:69566eea0fba 1654 /*******************************************************************************
cparata 0:69566eea0fba 1655 * Function Name : LSM6DSL_ACC_GYRO_R_FIFO_TSHLD_on_INT1
cparata 0:69566eea0fba 1656 * Description : Read INT1_FTH
cparata 0:69566eea0fba 1657 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_FTH_t
cparata 0:69566eea0fba 1658 * Output : Status of INT1_FTH see LSM6DSL_ACC_GYRO_INT1_FTH_t
cparata 0:69566eea0fba 1659 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1660 *******************************************************************************/
cparata 0:69566eea0fba 1661 status_t LSM6DSL_ACC_GYRO_R_FIFO_TSHLD_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_FTH_t *value)
cparata 0:69566eea0fba 1662 {
cparata 0:69566eea0fba 1663 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
cparata 0:69566eea0fba 1664 return MEMS_ERROR;
cparata 0:69566eea0fba 1665
cparata 0:69566eea0fba 1666 *value &= LSM6DSL_ACC_GYRO_INT1_FTH_MASK; //mask
cparata 0:69566eea0fba 1667
cparata 0:69566eea0fba 1668 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1669 }
cparata 0:69566eea0fba 1670
cparata 0:69566eea0fba 1671 /*******************************************************************************
cparata 0:69566eea0fba 1672 * Function Name : LSM6DSL_ACC_GYRO_W_OVERRUN_on_INT1
cparata 0:69566eea0fba 1673 * Description : Write INT1_OVR
cparata 0:69566eea0fba 1674 * Input : LSM6DSL_ACC_GYRO_INT1_OVR_t
cparata 0:69566eea0fba 1675 * Output : None
cparata 0:69566eea0fba 1676 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1677 *******************************************************************************/
cparata 0:69566eea0fba 1678 status_t LSM6DSL_ACC_GYRO_W_OVERRUN_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_OVR_t newValue)
cparata 0:69566eea0fba 1679 {
cparata 0:69566eea0fba 1680 u8_t value;
cparata 0:69566eea0fba 1681
cparata 0:69566eea0fba 1682 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
cparata 0:69566eea0fba 1683 return MEMS_ERROR;
cparata 0:69566eea0fba 1684
cparata 0:69566eea0fba 1685 value &= ~LSM6DSL_ACC_GYRO_INT1_OVR_MASK;
cparata 0:69566eea0fba 1686 value |= newValue;
cparata 0:69566eea0fba 1687
cparata 0:69566eea0fba 1688 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
cparata 0:69566eea0fba 1689 return MEMS_ERROR;
cparata 0:69566eea0fba 1690
cparata 0:69566eea0fba 1691 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1692 }
cparata 0:69566eea0fba 1693
cparata 0:69566eea0fba 1694 /*******************************************************************************
cparata 0:69566eea0fba 1695 * Function Name : LSM6DSL_ACC_GYRO_R_OVERRUN_on_INT1
cparata 0:69566eea0fba 1696 * Description : Read INT1_OVR
cparata 0:69566eea0fba 1697 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_OVR_t
cparata 0:69566eea0fba 1698 * Output : Status of INT1_OVR see LSM6DSL_ACC_GYRO_INT1_OVR_t
cparata 0:69566eea0fba 1699 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1700 *******************************************************************************/
cparata 0:69566eea0fba 1701 status_t LSM6DSL_ACC_GYRO_R_OVERRUN_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_OVR_t *value)
cparata 0:69566eea0fba 1702 {
cparata 0:69566eea0fba 1703 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
cparata 0:69566eea0fba 1704 return MEMS_ERROR;
cparata 0:69566eea0fba 1705
cparata 0:69566eea0fba 1706 *value &= LSM6DSL_ACC_GYRO_INT1_OVR_MASK; //mask
cparata 0:69566eea0fba 1707
cparata 0:69566eea0fba 1708 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1709 }
cparata 0:69566eea0fba 1710
cparata 0:69566eea0fba 1711 /*******************************************************************************
cparata 0:69566eea0fba 1712 * Function Name : LSM6DSL_ACC_GYRO_W_FULL_FLAG_on_INT1
cparata 0:69566eea0fba 1713 * Description : Write INT1_FULL_FLAG
cparata 0:69566eea0fba 1714 * Input : LSM6DSL_ACC_GYRO_INT1_FULL_FLAG_t
cparata 0:69566eea0fba 1715 * Output : None
cparata 0:69566eea0fba 1716 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1717 *******************************************************************************/
cparata 0:69566eea0fba 1718 status_t LSM6DSL_ACC_GYRO_W_FULL_FLAG_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_FULL_FLAG_t newValue)
cparata 0:69566eea0fba 1719 {
cparata 0:69566eea0fba 1720 u8_t value;
cparata 0:69566eea0fba 1721
cparata 0:69566eea0fba 1722 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
cparata 0:69566eea0fba 1723 return MEMS_ERROR;
cparata 0:69566eea0fba 1724
cparata 0:69566eea0fba 1725 value &= ~LSM6DSL_ACC_GYRO_INT1_FULL_FLAG_MASK;
cparata 0:69566eea0fba 1726 value |= newValue;
cparata 0:69566eea0fba 1727
cparata 0:69566eea0fba 1728 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
cparata 0:69566eea0fba 1729 return MEMS_ERROR;
cparata 0:69566eea0fba 1730
cparata 0:69566eea0fba 1731 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1732 }
cparata 0:69566eea0fba 1733
cparata 0:69566eea0fba 1734 /*******************************************************************************
cparata 0:69566eea0fba 1735 * Function Name : LSM6DSL_ACC_GYRO_R_FULL_FLAG_on_INT1
cparata 0:69566eea0fba 1736 * Description : Read INT1_FULL_FLAG
cparata 0:69566eea0fba 1737 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_FULL_FLAG_t
cparata 0:69566eea0fba 1738 * Output : Status of INT1_FULL_FLAG see LSM6DSL_ACC_GYRO_INT1_FULL_FLAG_t
cparata 0:69566eea0fba 1739 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1740 *******************************************************************************/
cparata 0:69566eea0fba 1741 status_t LSM6DSL_ACC_GYRO_R_FULL_FLAG_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_FULL_FLAG_t *value)
cparata 0:69566eea0fba 1742 {
cparata 0:69566eea0fba 1743 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
cparata 0:69566eea0fba 1744 return MEMS_ERROR;
cparata 0:69566eea0fba 1745
cparata 0:69566eea0fba 1746 *value &= LSM6DSL_ACC_GYRO_INT1_FULL_FLAG_MASK; //mask
cparata 0:69566eea0fba 1747
cparata 0:69566eea0fba 1748 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1749 }
cparata 0:69566eea0fba 1750
cparata 0:69566eea0fba 1751 /*******************************************************************************
cparata 0:69566eea0fba 1752 * Function Name : LSM6DSL_ACC_GYRO_W_SIGN_MOT_on_INT1
cparata 0:69566eea0fba 1753 * Description : Write INT1_SIGN_MOT
cparata 0:69566eea0fba 1754 * Input : LSM6DSL_ACC_GYRO_INT1_SIGN_MOT_t
cparata 0:69566eea0fba 1755 * Output : None
cparata 0:69566eea0fba 1756 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1757 *******************************************************************************/
cparata 0:69566eea0fba 1758 status_t LSM6DSL_ACC_GYRO_W_SIGN_MOT_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_SIGN_MOT_t newValue)
cparata 0:69566eea0fba 1759 {
cparata 0:69566eea0fba 1760 u8_t value;
cparata 0:69566eea0fba 1761
cparata 0:69566eea0fba 1762 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
cparata 0:69566eea0fba 1763 return MEMS_ERROR;
cparata 0:69566eea0fba 1764
cparata 0:69566eea0fba 1765 value &= ~LSM6DSL_ACC_GYRO_INT1_SIGN_MOT_MASK;
cparata 0:69566eea0fba 1766 value |= newValue;
cparata 0:69566eea0fba 1767
cparata 0:69566eea0fba 1768 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
cparata 0:69566eea0fba 1769 return MEMS_ERROR;
cparata 0:69566eea0fba 1770
cparata 0:69566eea0fba 1771 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1772 }
cparata 0:69566eea0fba 1773
cparata 0:69566eea0fba 1774 /*******************************************************************************
cparata 0:69566eea0fba 1775 * Function Name : LSM6DSL_ACC_GYRO_R_SIGN_MOT_on_INT1
cparata 0:69566eea0fba 1776 * Description : Read INT1_SIGN_MOT
cparata 0:69566eea0fba 1777 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_SIGN_MOT_t
cparata 0:69566eea0fba 1778 * Output : Status of INT1_SIGN_MOT see LSM6DSL_ACC_GYRO_INT1_SIGN_MOT_t
cparata 0:69566eea0fba 1779 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1780 *******************************************************************************/
cparata 0:69566eea0fba 1781 status_t LSM6DSL_ACC_GYRO_R_SIGN_MOT_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_SIGN_MOT_t *value)
cparata 0:69566eea0fba 1782 {
cparata 0:69566eea0fba 1783 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
cparata 0:69566eea0fba 1784 return MEMS_ERROR;
cparata 0:69566eea0fba 1785
cparata 0:69566eea0fba 1786 *value &= LSM6DSL_ACC_GYRO_INT1_SIGN_MOT_MASK; //mask
cparata 0:69566eea0fba 1787
cparata 0:69566eea0fba 1788 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1789 }
cparata 0:69566eea0fba 1790
cparata 0:69566eea0fba 1791 /*******************************************************************************
cparata 0:69566eea0fba 1792 * Function Name : LSM6DSL_ACC_GYRO_W_STEP_DET_on_INT1
cparata 0:69566eea0fba 1793 * Description : Write INT1_PEDO
cparata 0:69566eea0fba 1794 * Input : LSM6DSL_ACC_GYRO_INT1_PEDO_t
cparata 0:69566eea0fba 1795 * Output : None
cparata 0:69566eea0fba 1796 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1797 *******************************************************************************/
cparata 0:69566eea0fba 1798 status_t LSM6DSL_ACC_GYRO_W_STEP_DET_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_PEDO_t newValue)
cparata 0:69566eea0fba 1799 {
cparata 0:69566eea0fba 1800 u8_t value;
cparata 0:69566eea0fba 1801
cparata 0:69566eea0fba 1802 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
cparata 0:69566eea0fba 1803 return MEMS_ERROR;
cparata 0:69566eea0fba 1804
cparata 0:69566eea0fba 1805 value &= ~LSM6DSL_ACC_GYRO_INT1_PEDO_MASK;
cparata 0:69566eea0fba 1806 value |= newValue;
cparata 0:69566eea0fba 1807
cparata 0:69566eea0fba 1808 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
cparata 0:69566eea0fba 1809 return MEMS_ERROR;
cparata 0:69566eea0fba 1810
cparata 0:69566eea0fba 1811 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1812 }
cparata 0:69566eea0fba 1813
cparata 0:69566eea0fba 1814 /*******************************************************************************
cparata 0:69566eea0fba 1815 * Function Name : LSM6DSL_ACC_GYRO_R_STEP_DET_on_INT1
cparata 0:69566eea0fba 1816 * Description : Read INT1_PEDO
cparata 0:69566eea0fba 1817 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_PEDO_t
cparata 0:69566eea0fba 1818 * Output : Status of INT1_PEDO see LSM6DSL_ACC_GYRO_INT1_PEDO_t
cparata 0:69566eea0fba 1819 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1820 *******************************************************************************/
cparata 0:69566eea0fba 1821 status_t LSM6DSL_ACC_GYRO_R_STEP_DET_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_PEDO_t *value)
cparata 0:69566eea0fba 1822 {
cparata 0:69566eea0fba 1823 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
cparata 0:69566eea0fba 1824 return MEMS_ERROR;
cparata 0:69566eea0fba 1825
cparata 0:69566eea0fba 1826 *value &= LSM6DSL_ACC_GYRO_INT1_PEDO_MASK; //mask
cparata 0:69566eea0fba 1827
cparata 0:69566eea0fba 1828 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1829 }
cparata 0:69566eea0fba 1830
cparata 0:69566eea0fba 1831 /*******************************************************************************
cparata 0:69566eea0fba 1832 * Function Name : LSM6DSL_ACC_GYRO_W_DRDY_XL_on_INT2
cparata 0:69566eea0fba 1833 * Description : Write INT2_DRDY_XL
cparata 0:69566eea0fba 1834 * Input : LSM6DSL_ACC_GYRO_INT2_DRDY_XL_t
cparata 0:69566eea0fba 1835 * Output : None
cparata 0:69566eea0fba 1836 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1837 *******************************************************************************/
cparata 0:69566eea0fba 1838 status_t LSM6DSL_ACC_GYRO_W_DRDY_XL_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_DRDY_XL_t newValue)
cparata 0:69566eea0fba 1839 {
cparata 0:69566eea0fba 1840 u8_t value;
cparata 0:69566eea0fba 1841
cparata 0:69566eea0fba 1842 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
cparata 0:69566eea0fba 1843 return MEMS_ERROR;
cparata 0:69566eea0fba 1844
cparata 0:69566eea0fba 1845 value &= ~LSM6DSL_ACC_GYRO_INT2_DRDY_XL_MASK;
cparata 0:69566eea0fba 1846 value |= newValue;
cparata 0:69566eea0fba 1847
cparata 0:69566eea0fba 1848 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
cparata 0:69566eea0fba 1849 return MEMS_ERROR;
cparata 0:69566eea0fba 1850
cparata 0:69566eea0fba 1851 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1852 }
cparata 0:69566eea0fba 1853
cparata 0:69566eea0fba 1854 /*******************************************************************************
cparata 0:69566eea0fba 1855 * Function Name : LSM6DSL_ACC_GYRO_R_DRDY_XL_on_INT2
cparata 0:69566eea0fba 1856 * Description : Read INT2_DRDY_XL
cparata 0:69566eea0fba 1857 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_DRDY_XL_t
cparata 0:69566eea0fba 1858 * Output : Status of INT2_DRDY_XL see LSM6DSL_ACC_GYRO_INT2_DRDY_XL_t
cparata 0:69566eea0fba 1859 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1860 *******************************************************************************/
cparata 0:69566eea0fba 1861 status_t LSM6DSL_ACC_GYRO_R_DRDY_XL_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_DRDY_XL_t *value)
cparata 0:69566eea0fba 1862 {
cparata 0:69566eea0fba 1863 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
cparata 0:69566eea0fba 1864 return MEMS_ERROR;
cparata 0:69566eea0fba 1865
cparata 0:69566eea0fba 1866 *value &= LSM6DSL_ACC_GYRO_INT2_DRDY_XL_MASK; //mask
cparata 0:69566eea0fba 1867
cparata 0:69566eea0fba 1868 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1869 }
cparata 0:69566eea0fba 1870
cparata 0:69566eea0fba 1871 /*******************************************************************************
cparata 0:69566eea0fba 1872 * Function Name : LSM6DSL_ACC_GYRO_W_DRDY_G_on_INT2
cparata 0:69566eea0fba 1873 * Description : Write INT2_DRDY_G
cparata 0:69566eea0fba 1874 * Input : LSM6DSL_ACC_GYRO_INT2_DRDY_G_t
cparata 0:69566eea0fba 1875 * Output : None
cparata 0:69566eea0fba 1876 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1877 *******************************************************************************/
cparata 0:69566eea0fba 1878 status_t LSM6DSL_ACC_GYRO_W_DRDY_G_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_DRDY_G_t newValue)
cparata 0:69566eea0fba 1879 {
cparata 0:69566eea0fba 1880 u8_t value;
cparata 0:69566eea0fba 1881
cparata 0:69566eea0fba 1882 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
cparata 0:69566eea0fba 1883 return MEMS_ERROR;
cparata 0:69566eea0fba 1884
cparata 0:69566eea0fba 1885 value &= ~LSM6DSL_ACC_GYRO_INT2_DRDY_G_MASK;
cparata 0:69566eea0fba 1886 value |= newValue;
cparata 0:69566eea0fba 1887
cparata 0:69566eea0fba 1888 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
cparata 0:69566eea0fba 1889 return MEMS_ERROR;
cparata 0:69566eea0fba 1890
cparata 0:69566eea0fba 1891 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1892 }
cparata 0:69566eea0fba 1893
cparata 0:69566eea0fba 1894 /*******************************************************************************
cparata 0:69566eea0fba 1895 * Function Name : LSM6DSL_ACC_GYRO_R_DRDY_G_on_INT2
cparata 0:69566eea0fba 1896 * Description : Read INT2_DRDY_G
cparata 0:69566eea0fba 1897 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_DRDY_G_t
cparata 0:69566eea0fba 1898 * Output : Status of INT2_DRDY_G see LSM6DSL_ACC_GYRO_INT2_DRDY_G_t
cparata 0:69566eea0fba 1899 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1900 *******************************************************************************/
cparata 0:69566eea0fba 1901 status_t LSM6DSL_ACC_GYRO_R_DRDY_G_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_DRDY_G_t *value)
cparata 0:69566eea0fba 1902 {
cparata 0:69566eea0fba 1903 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
cparata 0:69566eea0fba 1904 return MEMS_ERROR;
cparata 0:69566eea0fba 1905
cparata 0:69566eea0fba 1906 *value &= LSM6DSL_ACC_GYRO_INT2_DRDY_G_MASK; //mask
cparata 0:69566eea0fba 1907
cparata 0:69566eea0fba 1908 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1909 }
cparata 0:69566eea0fba 1910
cparata 0:69566eea0fba 1911 /*******************************************************************************
cparata 0:69566eea0fba 1912 * Function Name : LSM6DSL_ACC_GYRO_W_DRDY_TEMP_on_INT2
cparata 0:69566eea0fba 1913 * Description : Write INT2_DRDY_TEMP
cparata 0:69566eea0fba 1914 * Input : LSM6DSL_ACC_GYRO_INT2_DRDY_TEMP_t
cparata 0:69566eea0fba 1915 * Output : None
cparata 0:69566eea0fba 1916 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1917 *******************************************************************************/
cparata 0:69566eea0fba 1918 status_t LSM6DSL_ACC_GYRO_W_DRDY_TEMP_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_DRDY_TEMP_t newValue)
cparata 0:69566eea0fba 1919 {
cparata 0:69566eea0fba 1920 u8_t value;
cparata 0:69566eea0fba 1921
cparata 0:69566eea0fba 1922 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
cparata 0:69566eea0fba 1923 return MEMS_ERROR;
cparata 0:69566eea0fba 1924
cparata 0:69566eea0fba 1925 value &= ~LSM6DSL_ACC_GYRO_INT2_DRDY_TEMP_MASK;
cparata 0:69566eea0fba 1926 value |= newValue;
cparata 0:69566eea0fba 1927
cparata 0:69566eea0fba 1928 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
cparata 0:69566eea0fba 1929 return MEMS_ERROR;
cparata 0:69566eea0fba 1930
cparata 0:69566eea0fba 1931 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1932 }
cparata 0:69566eea0fba 1933
cparata 0:69566eea0fba 1934 /*******************************************************************************
cparata 0:69566eea0fba 1935 * Function Name : LSM6DSL_ACC_GYRO_R_DRDY_TEMP_on_INT2
cparata 0:69566eea0fba 1936 * Description : Read INT2_DRDY_TEMP
cparata 0:69566eea0fba 1937 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_DRDY_TEMP_t
cparata 0:69566eea0fba 1938 * Output : Status of INT2_DRDY_TEMP see LSM6DSL_ACC_GYRO_INT2_DRDY_TEMP_t
cparata 0:69566eea0fba 1939 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1940 *******************************************************************************/
cparata 0:69566eea0fba 1941 status_t LSM6DSL_ACC_GYRO_R_DRDY_TEMP_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_DRDY_TEMP_t *value)
cparata 0:69566eea0fba 1942 {
cparata 0:69566eea0fba 1943 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
cparata 0:69566eea0fba 1944 return MEMS_ERROR;
cparata 0:69566eea0fba 1945
cparata 0:69566eea0fba 1946 *value &= LSM6DSL_ACC_GYRO_INT2_DRDY_TEMP_MASK; //mask
cparata 0:69566eea0fba 1947
cparata 0:69566eea0fba 1948 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1949 }
cparata 0:69566eea0fba 1950
cparata 0:69566eea0fba 1951 /*******************************************************************************
cparata 0:69566eea0fba 1952 * Function Name : LSM6DSL_ACC_GYRO_W_FIFO_TSHLD_on_INT2
cparata 0:69566eea0fba 1953 * Description : Write INT2_FTH
cparata 0:69566eea0fba 1954 * Input : LSM6DSL_ACC_GYRO_INT2_FTH_t
cparata 0:69566eea0fba 1955 * Output : None
cparata 0:69566eea0fba 1956 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1957 *******************************************************************************/
cparata 0:69566eea0fba 1958 status_t LSM6DSL_ACC_GYRO_W_FIFO_TSHLD_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_FTH_t newValue)
cparata 0:69566eea0fba 1959 {
cparata 0:69566eea0fba 1960 u8_t value;
cparata 0:69566eea0fba 1961
cparata 0:69566eea0fba 1962 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
cparata 0:69566eea0fba 1963 return MEMS_ERROR;
cparata 0:69566eea0fba 1964
cparata 0:69566eea0fba 1965 value &= ~LSM6DSL_ACC_GYRO_INT2_FTH_MASK;
cparata 0:69566eea0fba 1966 value |= newValue;
cparata 0:69566eea0fba 1967
cparata 0:69566eea0fba 1968 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
cparata 0:69566eea0fba 1969 return MEMS_ERROR;
cparata 0:69566eea0fba 1970
cparata 0:69566eea0fba 1971 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1972 }
cparata 0:69566eea0fba 1973
cparata 0:69566eea0fba 1974 /*******************************************************************************
cparata 0:69566eea0fba 1975 * Function Name : LSM6DSL_ACC_GYRO_R_FIFO_TSHLD_on_INT2
cparata 0:69566eea0fba 1976 * Description : Read INT2_FTH
cparata 0:69566eea0fba 1977 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_FTH_t
cparata 0:69566eea0fba 1978 * Output : Status of INT2_FTH see LSM6DSL_ACC_GYRO_INT2_FTH_t
cparata 0:69566eea0fba 1979 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1980 *******************************************************************************/
cparata 0:69566eea0fba 1981 status_t LSM6DSL_ACC_GYRO_R_FIFO_TSHLD_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_FTH_t *value)
cparata 0:69566eea0fba 1982 {
cparata 0:69566eea0fba 1983 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
cparata 0:69566eea0fba 1984 return MEMS_ERROR;
cparata 0:69566eea0fba 1985
cparata 0:69566eea0fba 1986 *value &= LSM6DSL_ACC_GYRO_INT2_FTH_MASK; //mask
cparata 0:69566eea0fba 1987
cparata 0:69566eea0fba 1988 return MEMS_SUCCESS;
cparata 0:69566eea0fba 1989 }
cparata 0:69566eea0fba 1990
cparata 0:69566eea0fba 1991 /*******************************************************************************
cparata 0:69566eea0fba 1992 * Function Name : LSM6DSL_ACC_GYRO_W_OVERRUN_on_INT2
cparata 0:69566eea0fba 1993 * Description : Write INT2_OVR
cparata 0:69566eea0fba 1994 * Input : LSM6DSL_ACC_GYRO_INT2_OVR_t
cparata 0:69566eea0fba 1995 * Output : None
cparata 0:69566eea0fba 1996 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 1997 *******************************************************************************/
cparata 0:69566eea0fba 1998 status_t LSM6DSL_ACC_GYRO_W_OVERRUN_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_OVR_t newValue)
cparata 0:69566eea0fba 1999 {
cparata 0:69566eea0fba 2000 u8_t value;
cparata 0:69566eea0fba 2001
cparata 0:69566eea0fba 2002 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
cparata 0:69566eea0fba 2003 return MEMS_ERROR;
cparata 0:69566eea0fba 2004
cparata 0:69566eea0fba 2005 value &= ~LSM6DSL_ACC_GYRO_INT2_OVR_MASK;
cparata 0:69566eea0fba 2006 value |= newValue;
cparata 0:69566eea0fba 2007
cparata 0:69566eea0fba 2008 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
cparata 0:69566eea0fba 2009 return MEMS_ERROR;
cparata 0:69566eea0fba 2010
cparata 0:69566eea0fba 2011 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2012 }
cparata 0:69566eea0fba 2013
cparata 0:69566eea0fba 2014 /*******************************************************************************
cparata 0:69566eea0fba 2015 * Function Name : LSM6DSL_ACC_GYRO_R_OVERRUN_on_INT2
cparata 0:69566eea0fba 2016 * Description : Read INT2_OVR
cparata 0:69566eea0fba 2017 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_OVR_t
cparata 0:69566eea0fba 2018 * Output : Status of INT2_OVR see LSM6DSL_ACC_GYRO_INT2_OVR_t
cparata 0:69566eea0fba 2019 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2020 *******************************************************************************/
cparata 0:69566eea0fba 2021 status_t LSM6DSL_ACC_GYRO_R_OVERRUN_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_OVR_t *value)
cparata 0:69566eea0fba 2022 {
cparata 0:69566eea0fba 2023 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
cparata 0:69566eea0fba 2024 return MEMS_ERROR;
cparata 0:69566eea0fba 2025
cparata 0:69566eea0fba 2026 *value &= LSM6DSL_ACC_GYRO_INT2_OVR_MASK; //mask
cparata 0:69566eea0fba 2027
cparata 0:69566eea0fba 2028 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2029 }
cparata 0:69566eea0fba 2030
cparata 0:69566eea0fba 2031 /*******************************************************************************
cparata 0:69566eea0fba 2032 * Function Name : LSM6DSL_ACC_GYRO_W_FULL_FLAG_on_INT2
cparata 0:69566eea0fba 2033 * Description : Write INT2_FULL_FLAG
cparata 0:69566eea0fba 2034 * Input : LSM6DSL_ACC_GYRO_INT2_FULL_FLAG_t
cparata 0:69566eea0fba 2035 * Output : None
cparata 0:69566eea0fba 2036 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2037 *******************************************************************************/
cparata 0:69566eea0fba 2038 status_t LSM6DSL_ACC_GYRO_W_FULL_FLAG_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_FULL_FLAG_t newValue)
cparata 0:69566eea0fba 2039 {
cparata 0:69566eea0fba 2040 u8_t value;
cparata 0:69566eea0fba 2041
cparata 0:69566eea0fba 2042 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
cparata 0:69566eea0fba 2043 return MEMS_ERROR;
cparata 0:69566eea0fba 2044
cparata 0:69566eea0fba 2045 value &= ~LSM6DSL_ACC_GYRO_INT2_FULL_FLAG_MASK;
cparata 0:69566eea0fba 2046 value |= newValue;
cparata 0:69566eea0fba 2047
cparata 0:69566eea0fba 2048 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
cparata 0:69566eea0fba 2049 return MEMS_ERROR;
cparata 0:69566eea0fba 2050
cparata 0:69566eea0fba 2051 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2052 }
cparata 0:69566eea0fba 2053
cparata 0:69566eea0fba 2054 /*******************************************************************************
cparata 0:69566eea0fba 2055 * Function Name : LSM6DSL_ACC_GYRO_R_FULL_FLAG_on_INT2
cparata 0:69566eea0fba 2056 * Description : Read INT2_FULL_FLAG
cparata 0:69566eea0fba 2057 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_FULL_FLAG_t
cparata 0:69566eea0fba 2058 * Output : Status of INT2_FULL_FLAG see LSM6DSL_ACC_GYRO_INT2_FULL_FLAG_t
cparata 0:69566eea0fba 2059 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2060 *******************************************************************************/
cparata 0:69566eea0fba 2061 status_t LSM6DSL_ACC_GYRO_R_FULL_FLAG_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_FULL_FLAG_t *value)
cparata 0:69566eea0fba 2062 {
cparata 0:69566eea0fba 2063 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
cparata 0:69566eea0fba 2064 return MEMS_ERROR;
cparata 0:69566eea0fba 2065
cparata 0:69566eea0fba 2066 *value &= LSM6DSL_ACC_GYRO_INT2_FULL_FLAG_MASK; //mask
cparata 0:69566eea0fba 2067
cparata 0:69566eea0fba 2068 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2069 }
cparata 0:69566eea0fba 2070
cparata 0:69566eea0fba 2071 /*******************************************************************************
cparata 0:69566eea0fba 2072 * Function Name : LSM6DSL_ACC_GYRO_W_STEP_COUNT_OV_on_INT2
cparata 0:69566eea0fba 2073 * Description : Write INT2_STEP_COUNT_OV
cparata 0:69566eea0fba 2074 * Input : LSM6DSL_ACC_GYRO_INT2_STEP_COUNT_OV_t
cparata 0:69566eea0fba 2075 * Output : None
cparata 0:69566eea0fba 2076 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2077 *******************************************************************************/
cparata 0:69566eea0fba 2078 status_t LSM6DSL_ACC_GYRO_W_STEP_COUNT_OV_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_STEP_COUNT_OV_t newValue)
cparata 0:69566eea0fba 2079 {
cparata 0:69566eea0fba 2080 u8_t value;
cparata 0:69566eea0fba 2081
cparata 0:69566eea0fba 2082 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
cparata 0:69566eea0fba 2083 return MEMS_ERROR;
cparata 0:69566eea0fba 2084
cparata 0:69566eea0fba 2085 value &= ~LSM6DSL_ACC_GYRO_INT2_STEP_COUNT_OV_MASK;
cparata 0:69566eea0fba 2086 value |= newValue;
cparata 0:69566eea0fba 2087
cparata 0:69566eea0fba 2088 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
cparata 0:69566eea0fba 2089 return MEMS_ERROR;
cparata 0:69566eea0fba 2090
cparata 0:69566eea0fba 2091 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2092 }
cparata 0:69566eea0fba 2093
cparata 0:69566eea0fba 2094 /*******************************************************************************
cparata 0:69566eea0fba 2095 * Function Name : LSM6DSL_ACC_GYRO_R_STEP_COUNT_OV_on_INT2
cparata 0:69566eea0fba 2096 * Description : Read INT2_STEP_COUNT_OV
cparata 0:69566eea0fba 2097 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_STEP_COUNT_OV_t
cparata 0:69566eea0fba 2098 * Output : Status of INT2_STEP_COUNT_OV see LSM6DSL_ACC_GYRO_INT2_STEP_COUNT_OV_t
cparata 0:69566eea0fba 2099 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2100 *******************************************************************************/
cparata 0:69566eea0fba 2101 status_t LSM6DSL_ACC_GYRO_R_STEP_COUNT_OV_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_STEP_COUNT_OV_t *value)
cparata 0:69566eea0fba 2102 {
cparata 0:69566eea0fba 2103 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
cparata 0:69566eea0fba 2104 return MEMS_ERROR;
cparata 0:69566eea0fba 2105
cparata 0:69566eea0fba 2106 *value &= LSM6DSL_ACC_GYRO_INT2_STEP_COUNT_OV_MASK; //mask
cparata 0:69566eea0fba 2107
cparata 0:69566eea0fba 2108 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2109 }
cparata 0:69566eea0fba 2110
cparata 0:69566eea0fba 2111 /*******************************************************************************
cparata 0:69566eea0fba 2112 * Function Name : LSM6DSL_ACC_GYRO_W_STEP_DELTA_on_INT2
cparata 0:69566eea0fba 2113 * Description : Write INT2_STEP_DELTA
cparata 0:69566eea0fba 2114 * Input : LSM6DSL_ACC_GYRO_INT2_STEP_DELTA_t
cparata 0:69566eea0fba 2115 * Output : None
cparata 0:69566eea0fba 2116 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2117 *******************************************************************************/
cparata 0:69566eea0fba 2118 status_t LSM6DSL_ACC_GYRO_W_STEP_DELTA_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_STEP_DELTA_t newValue)
cparata 0:69566eea0fba 2119 {
cparata 0:69566eea0fba 2120 u8_t value;
cparata 0:69566eea0fba 2121
cparata 0:69566eea0fba 2122 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
cparata 0:69566eea0fba 2123 return MEMS_ERROR;
cparata 0:69566eea0fba 2124
cparata 0:69566eea0fba 2125 value &= ~LSM6DSL_ACC_GYRO_INT2_STEP_DELTA_MASK;
cparata 0:69566eea0fba 2126 value |= newValue;
cparata 0:69566eea0fba 2127
cparata 0:69566eea0fba 2128 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
cparata 0:69566eea0fba 2129 return MEMS_ERROR;
cparata 0:69566eea0fba 2130
cparata 0:69566eea0fba 2131 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2132 }
cparata 0:69566eea0fba 2133
cparata 0:69566eea0fba 2134 /*******************************************************************************
cparata 0:69566eea0fba 2135 * Function Name : LSM6DSL_ACC_GYRO_R_STEP_DELTA_on_INT2
cparata 0:69566eea0fba 2136 * Description : Read INT2_STEP_DELTA
cparata 0:69566eea0fba 2137 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_STEP_DELTA_t
cparata 0:69566eea0fba 2138 * Output : Status of INT2_STEP_DELTA see LSM6DSL_ACC_GYRO_INT2_STEP_DELTA_t
cparata 0:69566eea0fba 2139 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2140 *******************************************************************************/
cparata 0:69566eea0fba 2141 status_t LSM6DSL_ACC_GYRO_R_STEP_DELTA_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_STEP_DELTA_t *value)
cparata 0:69566eea0fba 2142 {
cparata 0:69566eea0fba 2143 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
cparata 0:69566eea0fba 2144 return MEMS_ERROR;
cparata 0:69566eea0fba 2145
cparata 0:69566eea0fba 2146 *value &= LSM6DSL_ACC_GYRO_INT2_STEP_DELTA_MASK; //mask
cparata 0:69566eea0fba 2147
cparata 0:69566eea0fba 2148 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2149 }
cparata 0:69566eea0fba 2150
cparata 0:69566eea0fba 2151 /*******************************************************************************
cparata 0:69566eea0fba 2152 * Function Name : LSM6DSL_ACC_GYRO_W_SW_RESET
cparata 0:69566eea0fba 2153 * Description : Write SW_RESET
cparata 0:69566eea0fba 2154 * Input : LSM6DSL_ACC_GYRO_SW_RESET_t
cparata 0:69566eea0fba 2155 * Output : None
cparata 0:69566eea0fba 2156 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2157 *******************************************************************************/
cparata 0:69566eea0fba 2158 status_t LSM6DSL_ACC_GYRO_W_SW_RESET(void *handle, LSM6DSL_ACC_GYRO_SW_RESET_t newValue)
cparata 0:69566eea0fba 2159 {
cparata 0:69566eea0fba 2160 u8_t value;
cparata 0:69566eea0fba 2161
cparata 0:69566eea0fba 2162 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
cparata 0:69566eea0fba 2163 return MEMS_ERROR;
cparata 0:69566eea0fba 2164
cparata 0:69566eea0fba 2165 value &= ~LSM6DSL_ACC_GYRO_SW_RESET_MASK;
cparata 0:69566eea0fba 2166 value |= newValue;
cparata 0:69566eea0fba 2167
cparata 0:69566eea0fba 2168 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
cparata 0:69566eea0fba 2169 return MEMS_ERROR;
cparata 0:69566eea0fba 2170
cparata 0:69566eea0fba 2171 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2172 }
cparata 0:69566eea0fba 2173
cparata 0:69566eea0fba 2174 /*******************************************************************************
cparata 0:69566eea0fba 2175 * Function Name : LSM6DSL_ACC_GYRO_R_SW_RESET
cparata 0:69566eea0fba 2176 * Description : Read SW_RESET
cparata 0:69566eea0fba 2177 * Input : Pointer to LSM6DSL_ACC_GYRO_SW_RESET_t
cparata 0:69566eea0fba 2178 * Output : Status of SW_RESET see LSM6DSL_ACC_GYRO_SW_RESET_t
cparata 0:69566eea0fba 2179 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2180 *******************************************************************************/
cparata 0:69566eea0fba 2181 status_t LSM6DSL_ACC_GYRO_R_SW_RESET(void *handle, LSM6DSL_ACC_GYRO_SW_RESET_t *value)
cparata 0:69566eea0fba 2182 {
cparata 0:69566eea0fba 2183 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1))
cparata 0:69566eea0fba 2184 return MEMS_ERROR;
cparata 0:69566eea0fba 2185
cparata 0:69566eea0fba 2186 *value &= LSM6DSL_ACC_GYRO_SW_RESET_MASK; //mask
cparata 0:69566eea0fba 2187
cparata 0:69566eea0fba 2188 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2189 }
cparata 0:69566eea0fba 2190
cparata 0:69566eea0fba 2191 /*******************************************************************************
cparata 0:69566eea0fba 2192 * Function Name : LSM6DSL_ACC_GYRO_W_IF_Addr_Incr
cparata 0:69566eea0fba 2193 * Description : Write IF_INC
cparata 0:69566eea0fba 2194 * Input : LSM6DSL_ACC_GYRO_IF_INC_t
cparata 0:69566eea0fba 2195 * Output : None
cparata 0:69566eea0fba 2196 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2197 *******************************************************************************/
cparata 0:69566eea0fba 2198 status_t LSM6DSL_ACC_GYRO_W_IF_Addr_Incr(void *handle, LSM6DSL_ACC_GYRO_IF_INC_t newValue)
cparata 0:69566eea0fba 2199 {
cparata 0:69566eea0fba 2200 u8_t value;
cparata 0:69566eea0fba 2201
cparata 0:69566eea0fba 2202 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
cparata 0:69566eea0fba 2203 return MEMS_ERROR;
cparata 0:69566eea0fba 2204
cparata 0:69566eea0fba 2205 value &= ~LSM6DSL_ACC_GYRO_IF_INC_MASK;
cparata 0:69566eea0fba 2206 value |= newValue;
cparata 0:69566eea0fba 2207
cparata 0:69566eea0fba 2208 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
cparata 0:69566eea0fba 2209 return MEMS_ERROR;
cparata 0:69566eea0fba 2210
cparata 0:69566eea0fba 2211 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2212 }
cparata 0:69566eea0fba 2213
cparata 0:69566eea0fba 2214 /*******************************************************************************
cparata 0:69566eea0fba 2215 * Function Name : LSM6DSL_ACC_GYRO_R_IF_Addr_Incr
cparata 0:69566eea0fba 2216 * Description : Read IF_INC
cparata 0:69566eea0fba 2217 * Input : Pointer to LSM6DSL_ACC_GYRO_IF_INC_t
cparata 0:69566eea0fba 2218 * Output : Status of IF_INC see LSM6DSL_ACC_GYRO_IF_INC_t
cparata 0:69566eea0fba 2219 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2220 *******************************************************************************/
cparata 0:69566eea0fba 2221 status_t LSM6DSL_ACC_GYRO_R_IF_Addr_Incr(void *handle, LSM6DSL_ACC_GYRO_IF_INC_t *value)
cparata 0:69566eea0fba 2222 {
cparata 0:69566eea0fba 2223 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1) )
cparata 0:69566eea0fba 2224 return MEMS_ERROR;
cparata 0:69566eea0fba 2225
cparata 0:69566eea0fba 2226 *value &= LSM6DSL_ACC_GYRO_IF_INC_MASK; //mask
cparata 0:69566eea0fba 2227
cparata 0:69566eea0fba 2228 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2229 }
cparata 0:69566eea0fba 2230
cparata 0:69566eea0fba 2231 /*******************************************************************************
cparata 0:69566eea0fba 2232 * Function Name : LSM6DSL_ACC_GYRO_W_SPI_Mode
cparata 0:69566eea0fba 2233 * Description : Write SIM
cparata 0:69566eea0fba 2234 * Input : LSM6DSL_ACC_GYRO_SIM_t
cparata 0:69566eea0fba 2235 * Output : None
cparata 0:69566eea0fba 2236 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2237 *******************************************************************************/
cparata 0:69566eea0fba 2238 status_t LSM6DSL_ACC_GYRO_W_SPI_Mode(void *handle, LSM6DSL_ACC_GYRO_SIM_t newValue)
cparata 0:69566eea0fba 2239 {
cparata 0:69566eea0fba 2240 u8_t value;
cparata 0:69566eea0fba 2241
cparata 0:69566eea0fba 2242 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
cparata 0:69566eea0fba 2243 return MEMS_ERROR;
cparata 0:69566eea0fba 2244
cparata 0:69566eea0fba 2245 value &= ~LSM6DSL_ACC_GYRO_SIM_MASK;
cparata 0:69566eea0fba 2246 value |= newValue;
cparata 0:69566eea0fba 2247
cparata 0:69566eea0fba 2248 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
cparata 0:69566eea0fba 2249 return MEMS_ERROR;
cparata 0:69566eea0fba 2250
cparata 0:69566eea0fba 2251 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2252 }
cparata 0:69566eea0fba 2253
cparata 0:69566eea0fba 2254 /*******************************************************************************
cparata 0:69566eea0fba 2255 * Function Name : LSM6DSL_ACC_GYRO_R_SPI_Mode
cparata 0:69566eea0fba 2256 * Description : Read SIM
cparata 0:69566eea0fba 2257 * Input : Pointer to LSM6DSL_ACC_GYRO_SIM_t
cparata 0:69566eea0fba 2258 * Output : Status of SIM see LSM6DSL_ACC_GYRO_SIM_t
cparata 0:69566eea0fba 2259 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2260 *******************************************************************************/
cparata 0:69566eea0fba 2261 status_t LSM6DSL_ACC_GYRO_R_SPI_Mode(void *handle, LSM6DSL_ACC_GYRO_SIM_t *value)
cparata 0:69566eea0fba 2262 {
cparata 0:69566eea0fba 2263 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1))
cparata 0:69566eea0fba 2264 return MEMS_ERROR;
cparata 0:69566eea0fba 2265
cparata 0:69566eea0fba 2266 *value &= LSM6DSL_ACC_GYRO_SIM_MASK; //mask
cparata 0:69566eea0fba 2267
cparata 0:69566eea0fba 2268 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2269 }
cparata 0:69566eea0fba 2270
cparata 0:69566eea0fba 2271 /*******************************************************************************
cparata 0:69566eea0fba 2272 * Function Name : LSM6DSL_ACC_GYRO_W_PadSel
cparata 0:69566eea0fba 2273 * Description : Write PP_OD
cparata 0:69566eea0fba 2274 * Input : LSM6DSL_ACC_GYRO_PP_OD_t
cparata 0:69566eea0fba 2275 * Output : None
cparata 0:69566eea0fba 2276 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2277 *******************************************************************************/
cparata 0:69566eea0fba 2278 status_t LSM6DSL_ACC_GYRO_W_PadSel(void *handle, LSM6DSL_ACC_GYRO_PP_OD_t newValue)
cparata 0:69566eea0fba 2279 {
cparata 0:69566eea0fba 2280 u8_t value;
cparata 0:69566eea0fba 2281
cparata 0:69566eea0fba 2282 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
cparata 0:69566eea0fba 2283 return MEMS_ERROR;
cparata 0:69566eea0fba 2284
cparata 0:69566eea0fba 2285 value &= ~LSM6DSL_ACC_GYRO_PP_OD_MASK;
cparata 0:69566eea0fba 2286 value |= newValue;
cparata 0:69566eea0fba 2287
cparata 0:69566eea0fba 2288 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
cparata 0:69566eea0fba 2289 return MEMS_ERROR;
cparata 0:69566eea0fba 2290
cparata 0:69566eea0fba 2291 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2292 }
cparata 0:69566eea0fba 2293
cparata 0:69566eea0fba 2294 /*******************************************************************************
cparata 0:69566eea0fba 2295 * Function Name : LSM6DSL_ACC_GYRO_R_PadSel
cparata 0:69566eea0fba 2296 * Description : Read PP_OD
cparata 0:69566eea0fba 2297 * Input : Pointer to LSM6DSL_ACC_GYRO_PP_OD_t
cparata 0:69566eea0fba 2298 * Output : Status of PP_OD see LSM6DSL_ACC_GYRO_PP_OD_t
cparata 0:69566eea0fba 2299 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2300 *******************************************************************************/
cparata 0:69566eea0fba 2301 status_t LSM6DSL_ACC_GYRO_R_PadSel(void *handle, LSM6DSL_ACC_GYRO_PP_OD_t *value)
cparata 0:69566eea0fba 2302 {
cparata 0:69566eea0fba 2303 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1) )
cparata 0:69566eea0fba 2304 return MEMS_ERROR;
cparata 0:69566eea0fba 2305
cparata 0:69566eea0fba 2306 *value &= LSM6DSL_ACC_GYRO_PP_OD_MASK; //mask
cparata 0:69566eea0fba 2307
cparata 0:69566eea0fba 2308 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2309 }
cparata 0:69566eea0fba 2310
cparata 0:69566eea0fba 2311 /*******************************************************************************
cparata 0:69566eea0fba 2312 * Function Name : LSM6DSL_ACC_GYRO_W_INT_ACT_LEVEL
cparata 0:69566eea0fba 2313 * Description : Write INT_ACT_LEVEL
cparata 0:69566eea0fba 2314 * Input : LSM6DSL_ACC_GYRO_INT_ACT_LEVEL_t
cparata 0:69566eea0fba 2315 * Output : None
cparata 0:69566eea0fba 2316 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2317 *******************************************************************************/
cparata 0:69566eea0fba 2318 status_t LSM6DSL_ACC_GYRO_W_INT_ACT_LEVEL(void *handle, LSM6DSL_ACC_GYRO_INT_ACT_LEVEL_t newValue)
cparata 0:69566eea0fba 2319 {
cparata 0:69566eea0fba 2320 u8_t value;
cparata 0:69566eea0fba 2321
cparata 0:69566eea0fba 2322 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
cparata 0:69566eea0fba 2323 return MEMS_ERROR;
cparata 0:69566eea0fba 2324
cparata 0:69566eea0fba 2325 value &= ~LSM6DSL_ACC_GYRO_INT_ACT_LEVEL_MASK;
cparata 0:69566eea0fba 2326 value |= newValue;
cparata 0:69566eea0fba 2327
cparata 0:69566eea0fba 2328 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
cparata 0:69566eea0fba 2329 return MEMS_ERROR;
cparata 0:69566eea0fba 2330
cparata 0:69566eea0fba 2331 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2332 }
cparata 0:69566eea0fba 2333
cparata 0:69566eea0fba 2334 /*******************************************************************************
cparata 0:69566eea0fba 2335 * Function Name : LSM6DSL_ACC_GYRO_R_INT_ACT_LEVEL
cparata 0:69566eea0fba 2336 * Description : Read INT_ACT_LEVEL
cparata 0:69566eea0fba 2337 * Input : Pointer to LSM6DSL_ACC_GYRO_INT_ACT_LEVEL_t
cparata 0:69566eea0fba 2338 * Output : Status of INT_ACT_LEVEL see LSM6DSL_ACC_GYRO_INT_ACT_LEVEL_t
cparata 0:69566eea0fba 2339 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2340 *******************************************************************************/
cparata 0:69566eea0fba 2341 status_t LSM6DSL_ACC_GYRO_R_INT_ACT_LEVEL(void *handle, LSM6DSL_ACC_GYRO_INT_ACT_LEVEL_t *value)
cparata 0:69566eea0fba 2342 {
cparata 0:69566eea0fba 2343 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1))
cparata 0:69566eea0fba 2344 return MEMS_ERROR;
cparata 0:69566eea0fba 2345
cparata 0:69566eea0fba 2346 *value &= LSM6DSL_ACC_GYRO_INT_ACT_LEVEL_MASK; //mask
cparata 0:69566eea0fba 2347
cparata 0:69566eea0fba 2348 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2349 }
cparata 0:69566eea0fba 2350
cparata 0:69566eea0fba 2351 /*******************************************************************************
cparata 0:69566eea0fba 2352 * Function Name : LSM6DSL_ACC_GYRO_W_BOOT
cparata 0:69566eea0fba 2353 * Description : Write BOOT
cparata 0:69566eea0fba 2354 * Input : LSM6DSL_ACC_GYRO_BOOT_t
cparata 0:69566eea0fba 2355 * Output : None
cparata 0:69566eea0fba 2356 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2357 *******************************************************************************/
cparata 0:69566eea0fba 2358 status_t LSM6DSL_ACC_GYRO_W_BOOT(void *handle, LSM6DSL_ACC_GYRO_BOOT_t newValue)
cparata 0:69566eea0fba 2359 {
cparata 0:69566eea0fba 2360 u8_t value;
cparata 0:69566eea0fba 2361
cparata 0:69566eea0fba 2362 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
cparata 0:69566eea0fba 2363 return MEMS_ERROR;
cparata 0:69566eea0fba 2364
cparata 0:69566eea0fba 2365 value &= ~LSM6DSL_ACC_GYRO_BOOT_MASK;
cparata 0:69566eea0fba 2366 value |= newValue;
cparata 0:69566eea0fba 2367
cparata 0:69566eea0fba 2368 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
cparata 0:69566eea0fba 2369 return MEMS_ERROR;
cparata 0:69566eea0fba 2370
cparata 0:69566eea0fba 2371 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2372 }
cparata 0:69566eea0fba 2373
cparata 0:69566eea0fba 2374 /*******************************************************************************
cparata 0:69566eea0fba 2375 * Function Name : LSM6DSL_ACC_GYRO_R_BOOT
cparata 0:69566eea0fba 2376 * Description : Read BOOT
cparata 0:69566eea0fba 2377 * Input : Pointer to LSM6DSL_ACC_GYRO_BOOT_t
cparata 0:69566eea0fba 2378 * Output : Status of BOOT see LSM6DSL_ACC_GYRO_BOOT_t
cparata 0:69566eea0fba 2379 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2380 *******************************************************************************/
cparata 0:69566eea0fba 2381 status_t LSM6DSL_ACC_GYRO_R_BOOT(void *handle, LSM6DSL_ACC_GYRO_BOOT_t *value)
cparata 0:69566eea0fba 2382 {
cparata 0:69566eea0fba 2383 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1) )
cparata 0:69566eea0fba 2384 return MEMS_ERROR;
cparata 0:69566eea0fba 2385
cparata 0:69566eea0fba 2386 *value &= LSM6DSL_ACC_GYRO_BOOT_MASK; //mask
cparata 0:69566eea0fba 2387
cparata 0:69566eea0fba 2388 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2389 }
cparata 0:69566eea0fba 2390
cparata 0:69566eea0fba 2391 /*******************************************************************************
cparata 0:69566eea0fba 2392 * Function Name : LSM6DSL_ACC_GYRO_LPF1_SEL_G
cparata 0:69566eea0fba 2393 * Description : Write LPF1_SEL_G
cparata 0:69566eea0fba 2394 * Input : LSM6DSL_ACC_GYRO_LPF1_SEL_G_t
cparata 0:69566eea0fba 2395 * Output : None
cparata 0:69566eea0fba 2396 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2397 *******************************************************************************/
cparata 0:69566eea0fba 2398 status_t LSM6DSL_ACC_GYRO_W_LPF1_SEL_G(void *handle, LSM6DSL_ACC_GYRO_LPF1_SEL_G_t newValue)
cparata 0:69566eea0fba 2399 {
cparata 0:69566eea0fba 2400 u8_t value;
cparata 0:69566eea0fba 2401
cparata 0:69566eea0fba 2402 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1))
cparata 0:69566eea0fba 2403 return MEMS_ERROR;
cparata 0:69566eea0fba 2404
cparata 0:69566eea0fba 2405 value &= ~LSM6DSL_ACC_GYRO_LPF1_SEL_G_MASK;
cparata 0:69566eea0fba 2406 value |= newValue;
cparata 0:69566eea0fba 2407
cparata 0:69566eea0fba 2408 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1) )
cparata 0:69566eea0fba 2409 return MEMS_ERROR;
cparata 0:69566eea0fba 2410
cparata 0:69566eea0fba 2411 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2412 }
cparata 0:69566eea0fba 2413
cparata 0:69566eea0fba 2414 /*******************************************************************************
cparata 0:69566eea0fba 2415 * Function Name : LSM6DSL_ACC_GYRO_LPF1_SEL_G
cparata 0:69566eea0fba 2416 * Description : Read LPF1_SEL_G
cparata 0:69566eea0fba 2417 * Input : Pointer to LSM6DSL_ACC_GYRO_LPF1_SEL_G_t
cparata 0:69566eea0fba 2418 * Output : Status of LPF1_SEL_G see LSM6DSL_ACC_GYRO_LPF1_SEL_G_t
cparata 0:69566eea0fba 2419 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2420 *******************************************************************************/
cparata 0:69566eea0fba 2421 status_t LSM6DSL_ACC_GYRO_R_LPF1_SEL_G(void *handle, LSM6DSL_ACC_GYRO_LPF1_SEL_G_t *value)
cparata 0:69566eea0fba 2422 {
cparata 0:69566eea0fba 2423 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, (u8_t *)value, 1) )
cparata 0:69566eea0fba 2424 return MEMS_ERROR;
cparata 0:69566eea0fba 2425
cparata 0:69566eea0fba 2426 *value &= LSM6DSL_ACC_GYRO_LPF1_SEL_G_MASK; //mask
cparata 0:69566eea0fba 2427
cparata 0:69566eea0fba 2428 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2429 }
cparata 0:69566eea0fba 2430
cparata 0:69566eea0fba 2431 /*******************************************************************************
cparata 0:69566eea0fba 2432 * Function Name : LSM6DSL_ACC_GYRO_W_I2C_DISABLE
cparata 0:69566eea0fba 2433 * Description : Write I2C_DISABLE
cparata 0:69566eea0fba 2434 * Input : LSM6DSL_ACC_GYRO_I2C_DISABLE_t
cparata 0:69566eea0fba 2435 * Output : None
cparata 0:69566eea0fba 2436 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2437 *******************************************************************************/
cparata 0:69566eea0fba 2438 status_t LSM6DSL_ACC_GYRO_W_I2C_DISABLE(void *handle, LSM6DSL_ACC_GYRO_I2C_DISABLE_t newValue)
cparata 0:69566eea0fba 2439 {
cparata 0:69566eea0fba 2440 u8_t value;
cparata 0:69566eea0fba 2441
cparata 0:69566eea0fba 2442 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1))
cparata 0:69566eea0fba 2443 return MEMS_ERROR;
cparata 0:69566eea0fba 2444
cparata 0:69566eea0fba 2445 value &= ~LSM6DSL_ACC_GYRO_I2C_DISABLE_MASK;
cparata 0:69566eea0fba 2446 value |= newValue;
cparata 0:69566eea0fba 2447
cparata 0:69566eea0fba 2448 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1) )
cparata 0:69566eea0fba 2449 return MEMS_ERROR;
cparata 0:69566eea0fba 2450
cparata 0:69566eea0fba 2451 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2452 }
cparata 0:69566eea0fba 2453
cparata 0:69566eea0fba 2454 /*******************************************************************************
cparata 0:69566eea0fba 2455 * Function Name : LSM6DSL_ACC_GYRO_R_I2C_DISABLE
cparata 0:69566eea0fba 2456 * Description : Read I2C_DISABLE
cparata 0:69566eea0fba 2457 * Input : Pointer to LSM6DSL_ACC_GYRO_I2C_DISABLE_t
cparata 0:69566eea0fba 2458 * Output : Status of I2C_DISABLE see LSM6DSL_ACC_GYRO_I2C_DISABLE_t
cparata 0:69566eea0fba 2459 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2460 *******************************************************************************/
cparata 0:69566eea0fba 2461 status_t LSM6DSL_ACC_GYRO_R_I2C_DISABLE(void *handle, LSM6DSL_ACC_GYRO_I2C_DISABLE_t *value)
cparata 0:69566eea0fba 2462 {
cparata 0:69566eea0fba 2463 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, (u8_t *)value, 1) )
cparata 0:69566eea0fba 2464 return MEMS_ERROR;
cparata 0:69566eea0fba 2465
cparata 0:69566eea0fba 2466 *value &= LSM6DSL_ACC_GYRO_I2C_DISABLE_MASK; //mask
cparata 0:69566eea0fba 2467
cparata 0:69566eea0fba 2468 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2469 }
cparata 0:69566eea0fba 2470
cparata 0:69566eea0fba 2471 /*******************************************************************************
cparata 0:69566eea0fba 2472 * Function Name : LSM6DSL_ACC_GYRO_W_DRDY_MSK
cparata 0:69566eea0fba 2473 * Description : Write DRDY_MSK
cparata 0:69566eea0fba 2474 * Input : LSM6DSL_ACC_GYRO_DRDY_MSK_t
cparata 0:69566eea0fba 2475 * Output : None
cparata 0:69566eea0fba 2476 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2477 *******************************************************************************/
cparata 0:69566eea0fba 2478 status_t LSM6DSL_ACC_GYRO_W_DRDY_MSK(void *handle, LSM6DSL_ACC_GYRO_DRDY_MSK_t newValue)
cparata 0:69566eea0fba 2479 {
cparata 0:69566eea0fba 2480 u8_t value;
cparata 0:69566eea0fba 2481
cparata 0:69566eea0fba 2482 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1))
cparata 0:69566eea0fba 2483 return MEMS_ERROR;
cparata 0:69566eea0fba 2484
cparata 0:69566eea0fba 2485 value &= ~LSM6DSL_ACC_GYRO_DRDY_MSK_MASK;
cparata 0:69566eea0fba 2486 value |= newValue;
cparata 0:69566eea0fba 2487
cparata 0:69566eea0fba 2488 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1) )
cparata 0:69566eea0fba 2489 return MEMS_ERROR;
cparata 0:69566eea0fba 2490
cparata 0:69566eea0fba 2491 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2492 }
cparata 0:69566eea0fba 2493
cparata 0:69566eea0fba 2494 /*******************************************************************************
cparata 0:69566eea0fba 2495 * Function Name : LSM6DSL_ACC_GYRO_R_DRDY_MSK
cparata 0:69566eea0fba 2496 * Description : Read DRDY_MSK
cparata 0:69566eea0fba 2497 * Input : Pointer to LSM6DSL_ACC_GYRO_DRDY_MSK_t
cparata 0:69566eea0fba 2498 * Output : Status of DRDY_MSK see LSM6DSL_ACC_GYRO_DRDY_MSK_t
cparata 0:69566eea0fba 2499 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2500 *******************************************************************************/
cparata 0:69566eea0fba 2501 status_t LSM6DSL_ACC_GYRO_R_DRDY_MSK(void *handle, LSM6DSL_ACC_GYRO_DRDY_MSK_t *value)
cparata 0:69566eea0fba 2502 {
cparata 0:69566eea0fba 2503 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, (u8_t *)value, 1))
cparata 0:69566eea0fba 2504 return MEMS_ERROR;
cparata 0:69566eea0fba 2505
cparata 0:69566eea0fba 2506 *value &= LSM6DSL_ACC_GYRO_DRDY_MSK_MASK; //mask
cparata 0:69566eea0fba 2507
cparata 0:69566eea0fba 2508 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2509 }
cparata 0:69566eea0fba 2510
cparata 0:69566eea0fba 2511 /*******************************************************************************
cparata 0:69566eea0fba 2512 * Function Name : LSM6DSL_ACC_GYRO_W_INT2_ON_INT1
cparata 0:69566eea0fba 2513 * Description : Write INT2_ON_INT1
cparata 0:69566eea0fba 2514 * Input : LSM6DSL_ACC_GYRO_INT2_ON_INT1_t
cparata 0:69566eea0fba 2515 * Output : None
cparata 0:69566eea0fba 2516 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2517 *******************************************************************************/
cparata 0:69566eea0fba 2518 status_t LSM6DSL_ACC_GYRO_W_INT2_ON_INT1(void *handle, LSM6DSL_ACC_GYRO_INT2_ON_INT1_t newValue)
cparata 0:69566eea0fba 2519 {
cparata 0:69566eea0fba 2520 u8_t value;
cparata 0:69566eea0fba 2521
cparata 0:69566eea0fba 2522 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1))
cparata 0:69566eea0fba 2523 return MEMS_ERROR;
cparata 0:69566eea0fba 2524
cparata 0:69566eea0fba 2525 value &= ~LSM6DSL_ACC_GYRO_INT2_ON_INT1_MASK;
cparata 0:69566eea0fba 2526 value |= newValue;
cparata 0:69566eea0fba 2527
cparata 0:69566eea0fba 2528 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1) )
cparata 0:69566eea0fba 2529 return MEMS_ERROR;
cparata 0:69566eea0fba 2530
cparata 0:69566eea0fba 2531 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2532 }
cparata 0:69566eea0fba 2533
cparata 0:69566eea0fba 2534 /*******************************************************************************
cparata 0:69566eea0fba 2535 * Function Name : LSM6DSL_ACC_GYRO_R_INT2_ON_INT1
cparata 0:69566eea0fba 2536 * Description : Read INT2_ON_INT1
cparata 0:69566eea0fba 2537 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_ON_INT1_t
cparata 0:69566eea0fba 2538 * Output : Status of INT2_ON_INT1 see LSM6DSL_ACC_GYRO_INT2_ON_INT1_t
cparata 0:69566eea0fba 2539 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2540 *******************************************************************************/
cparata 0:69566eea0fba 2541 status_t LSM6DSL_ACC_GYRO_R_INT2_ON_INT1(void *handle, LSM6DSL_ACC_GYRO_INT2_ON_INT1_t *value)
cparata 0:69566eea0fba 2542 {
cparata 0:69566eea0fba 2543 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, (u8_t *)value, 1))
cparata 0:69566eea0fba 2544 return MEMS_ERROR;
cparata 0:69566eea0fba 2545
cparata 0:69566eea0fba 2546 *value &= LSM6DSL_ACC_GYRO_INT2_ON_INT1_MASK; //mask
cparata 0:69566eea0fba 2547
cparata 0:69566eea0fba 2548 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2549 }
cparata 0:69566eea0fba 2550
cparata 0:69566eea0fba 2551 /*******************************************************************************
cparata 0:69566eea0fba 2552 * Function Name : LSM6DSL_ACC_GYRO_W_SleepMode_G
cparata 0:69566eea0fba 2553 * Description : Write SLEEP_G
cparata 0:69566eea0fba 2554 * Input : LSM6DSL_ACC_GYRO_SLEEP_G_t
cparata 0:69566eea0fba 2555 * Output : None
cparata 0:69566eea0fba 2556 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2557 *******************************************************************************/
cparata 0:69566eea0fba 2558 status_t LSM6DSL_ACC_GYRO_W_SleepMode_G(void *handle, LSM6DSL_ACC_GYRO_SLEEP_G_t newValue)
cparata 0:69566eea0fba 2559 {
cparata 0:69566eea0fba 2560 u8_t value;
cparata 0:69566eea0fba 2561
cparata 0:69566eea0fba 2562 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1))
cparata 0:69566eea0fba 2563 return MEMS_ERROR;
cparata 0:69566eea0fba 2564
cparata 0:69566eea0fba 2565 value &= ~LSM6DSL_ACC_GYRO_SLEEP_G_MASK;
cparata 0:69566eea0fba 2566 value |= newValue;
cparata 0:69566eea0fba 2567
cparata 0:69566eea0fba 2568 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1) )
cparata 0:69566eea0fba 2569 return MEMS_ERROR;
cparata 0:69566eea0fba 2570
cparata 0:69566eea0fba 2571 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2572 }
cparata 0:69566eea0fba 2573
cparata 0:69566eea0fba 2574 /*******************************************************************************
cparata 0:69566eea0fba 2575 * Function Name : LSM6DSL_ACC_GYRO_R_SleepMode_G
cparata 0:69566eea0fba 2576 * Description : Read SLEEP_G
cparata 0:69566eea0fba 2577 * Input : Pointer to LSM6DSL_ACC_GYRO_SLEEP_G_t
cparata 0:69566eea0fba 2578 * Output : Status of SLEEP_G see LSM6DSL_ACC_GYRO_SLEEP_G_t
cparata 0:69566eea0fba 2579 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2580 *******************************************************************************/
cparata 0:69566eea0fba 2581 status_t LSM6DSL_ACC_GYRO_R_SleepMode_G(void *handle, LSM6DSL_ACC_GYRO_SLEEP_G_t *value)
cparata 0:69566eea0fba 2582 {
cparata 0:69566eea0fba 2583 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, (u8_t *)value, 1))
cparata 0:69566eea0fba 2584 return MEMS_ERROR;
cparata 0:69566eea0fba 2585
cparata 0:69566eea0fba 2586 *value &= LSM6DSL_ACC_GYRO_SLEEP_G_MASK; //mask
cparata 0:69566eea0fba 2587
cparata 0:69566eea0fba 2588 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2589 }
cparata 0:69566eea0fba 2590
cparata 0:69566eea0fba 2591 /*******************************************************************************
cparata 0:69566eea0fba 2592 * Function Name : LSM6DSL_ACC_GYRO_W_SelfTest_XL
cparata 0:69566eea0fba 2593 * Description : Write ST_XL
cparata 0:69566eea0fba 2594 * Input : LSM6DSL_ACC_GYRO_ST_XL_t
cparata 0:69566eea0fba 2595 * Output : None
cparata 0:69566eea0fba 2596 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2597 *******************************************************************************/
cparata 0:69566eea0fba 2598 status_t LSM6DSL_ACC_GYRO_W_SelfTest_XL(void *handle, LSM6DSL_ACC_GYRO_ST_XL_t newValue)
cparata 0:69566eea0fba 2599 {
cparata 0:69566eea0fba 2600 u8_t value;
cparata 0:69566eea0fba 2601
cparata 0:69566eea0fba 2602 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1))
cparata 0:69566eea0fba 2603 return MEMS_ERROR;
cparata 0:69566eea0fba 2604
cparata 0:69566eea0fba 2605 value &= ~LSM6DSL_ACC_GYRO_ST_XL_MASK;
cparata 0:69566eea0fba 2606 value |= newValue;
cparata 0:69566eea0fba 2607
cparata 0:69566eea0fba 2608 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1) )
cparata 0:69566eea0fba 2609 return MEMS_ERROR;
cparata 0:69566eea0fba 2610
cparata 0:69566eea0fba 2611 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2612 }
cparata 0:69566eea0fba 2613
cparata 0:69566eea0fba 2614 /*******************************************************************************
cparata 0:69566eea0fba 2615 * Function Name : LSM6DSL_ACC_GYRO_R_SelfTest_XL
cparata 0:69566eea0fba 2616 * Description : Read ST_XL
cparata 0:69566eea0fba 2617 * Input : Pointer to LSM6DSL_ACC_GYRO_ST_XL_t
cparata 0:69566eea0fba 2618 * Output : Status of ST_XL see LSM6DSL_ACC_GYRO_ST_XL_t
cparata 0:69566eea0fba 2619 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2620 *******************************************************************************/
cparata 0:69566eea0fba 2621 status_t LSM6DSL_ACC_GYRO_R_SelfTest_XL(void *handle, LSM6DSL_ACC_GYRO_ST_XL_t *value)
cparata 0:69566eea0fba 2622 {
cparata 0:69566eea0fba 2623 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, (u8_t *)value, 1))
cparata 0:69566eea0fba 2624 return MEMS_ERROR;
cparata 0:69566eea0fba 2625
cparata 0:69566eea0fba 2626 *value &= LSM6DSL_ACC_GYRO_ST_XL_MASK; //mask
cparata 0:69566eea0fba 2627
cparata 0:69566eea0fba 2628 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2629 }
cparata 0:69566eea0fba 2630
cparata 0:69566eea0fba 2631 /*******************************************************************************
cparata 0:69566eea0fba 2632 * Function Name : LSM6DSL_ACC_GYRO_W_SelfTest_G
cparata 0:69566eea0fba 2633 * Description : Write ST_G
cparata 0:69566eea0fba 2634 * Input : LSM6DSL_ACC_GYRO_ST_G_t
cparata 0:69566eea0fba 2635 * Output : None
cparata 0:69566eea0fba 2636 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2637 *******************************************************************************/
cparata 0:69566eea0fba 2638 status_t LSM6DSL_ACC_GYRO_W_SelfTest_G(void *handle, LSM6DSL_ACC_GYRO_ST_G_t newValue)
cparata 0:69566eea0fba 2639 {
cparata 0:69566eea0fba 2640 u8_t value;
cparata 0:69566eea0fba 2641
cparata 0:69566eea0fba 2642 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1))
cparata 0:69566eea0fba 2643 return MEMS_ERROR;
cparata 0:69566eea0fba 2644
cparata 0:69566eea0fba 2645 value &= ~LSM6DSL_ACC_GYRO_ST_G_MASK;
cparata 0:69566eea0fba 2646 value |= newValue;
cparata 0:69566eea0fba 2647
cparata 0:69566eea0fba 2648 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1) )
cparata 0:69566eea0fba 2649 return MEMS_ERROR;
cparata 0:69566eea0fba 2650
cparata 0:69566eea0fba 2651 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2652 }
cparata 0:69566eea0fba 2653
cparata 0:69566eea0fba 2654 /*******************************************************************************
cparata 0:69566eea0fba 2655 * Function Name : LSM6DSL_ACC_GYRO_R_SelfTest_G
cparata 0:69566eea0fba 2656 * Description : Read ST_G
cparata 0:69566eea0fba 2657 * Input : Pointer to LSM6DSL_ACC_GYRO_ST_G_t
cparata 0:69566eea0fba 2658 * Output : Status of ST_G see LSM6DSL_ACC_GYRO_ST_G_t
cparata 0:69566eea0fba 2659 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2660 *******************************************************************************/
cparata 0:69566eea0fba 2661 status_t LSM6DSL_ACC_GYRO_R_SelfTest_G(void *handle, LSM6DSL_ACC_GYRO_ST_G_t *value)
cparata 0:69566eea0fba 2662 {
cparata 0:69566eea0fba 2663 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, (u8_t *)value, 1))
cparata 0:69566eea0fba 2664 return MEMS_ERROR;
cparata 0:69566eea0fba 2665
cparata 0:69566eea0fba 2666 *value &= LSM6DSL_ACC_GYRO_ST_G_MASK; //mask
cparata 0:69566eea0fba 2667
cparata 0:69566eea0fba 2668 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2669 }
cparata 0:69566eea0fba 2670
cparata 0:69566eea0fba 2671 /*******************************************************************************
cparata 0:69566eea0fba 2672 * Function Name : LSM6DSL_ACC_GYRO_W_DEN_Polarity
cparata 0:69566eea0fba 2673 * Description : Write DEN_LH
cparata 0:69566eea0fba 2674 * Input : LSM6DSL_ACC_GYRO_DEN_LH_t
cparata 0:69566eea0fba 2675 * Output : None
cparata 0:69566eea0fba 2676 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2677 *******************************************************************************/
cparata 0:69566eea0fba 2678 status_t LSM6DSL_ACC_GYRO_W_DEN_Polarity(void *handle, LSM6DSL_ACC_GYRO_DEN_LH_t newValue)
cparata 0:69566eea0fba 2679 {
cparata 0:69566eea0fba 2680 u8_t value;
cparata 0:69566eea0fba 2681
cparata 0:69566eea0fba 2682 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1))
cparata 0:69566eea0fba 2683 return MEMS_ERROR;
cparata 0:69566eea0fba 2684
cparata 0:69566eea0fba 2685 value &= ~LSM6DSL_ACC_GYRO_DEN_LH_MASK;
cparata 0:69566eea0fba 2686 value |= newValue;
cparata 0:69566eea0fba 2687
cparata 0:69566eea0fba 2688 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1) )
cparata 0:69566eea0fba 2689 return MEMS_ERROR;
cparata 0:69566eea0fba 2690
cparata 0:69566eea0fba 2691 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2692 }
cparata 0:69566eea0fba 2693
cparata 0:69566eea0fba 2694 /*******************************************************************************
cparata 0:69566eea0fba 2695 * Function Name : LSM6DSL_ACC_GYRO_R_DEN_Polarity
cparata 0:69566eea0fba 2696 * Description : Read DEN_LH
cparata 0:69566eea0fba 2697 * Input : Pointer to LSM6DSL_ACC_GYRO_DEN_LH_t
cparata 0:69566eea0fba 2698 * Output : Status of DEN_LH see LSM6DSL_ACC_GYRO_DEN_LH_t
cparata 0:69566eea0fba 2699 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2700 *******************************************************************************/
cparata 0:69566eea0fba 2701 status_t LSM6DSL_ACC_GYRO_R_DEN_Polarity(void *handle, LSM6DSL_ACC_GYRO_DEN_LH_t *value)
cparata 0:69566eea0fba 2702 {
cparata 0:69566eea0fba 2703 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, (u8_t *)value, 1))
cparata 0:69566eea0fba 2704 return MEMS_ERROR;
cparata 0:69566eea0fba 2705
cparata 0:69566eea0fba 2706 *value &= LSM6DSL_ACC_GYRO_DEN_LH_MASK; //mask
cparata 0:69566eea0fba 2707
cparata 0:69566eea0fba 2708 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2709 }
cparata 0:69566eea0fba 2710
cparata 0:69566eea0fba 2711 /*******************************************************************************
cparata 0:69566eea0fba 2712 * Function Name : LSM6DSL_ACC_GYRO_W_CircularBurstMode
cparata 0:69566eea0fba 2713 * Description : Write ST_ROUNDING
cparata 0:69566eea0fba 2714 * Input : LSM6DSL_ACC_GYRO_ROUNDING_t
cparata 0:69566eea0fba 2715 * Output : None
cparata 0:69566eea0fba 2716 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2717 *******************************************************************************/
cparata 0:69566eea0fba 2718 status_t LSM6DSL_ACC_GYRO_W_CircularBurstMode(void *handle, LSM6DSL_ACC_GYRO_ROUNDING_t newValue)
cparata 0:69566eea0fba 2719 {
cparata 0:69566eea0fba 2720 u8_t value;
cparata 0:69566eea0fba 2721
cparata 0:69566eea0fba 2722 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1))
cparata 0:69566eea0fba 2723 return MEMS_ERROR;
cparata 0:69566eea0fba 2724
cparata 0:69566eea0fba 2725 value &= ~LSM6DSL_ACC_GYRO_LSM6DSL_ACC_GYRO_ROUNDING_t_MASK;
cparata 0:69566eea0fba 2726 value |= newValue;
cparata 0:69566eea0fba 2727
cparata 0:69566eea0fba 2728 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1) )
cparata 0:69566eea0fba 2729 return MEMS_ERROR;
cparata 0:69566eea0fba 2730
cparata 0:69566eea0fba 2731 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2732 }
cparata 0:69566eea0fba 2733
cparata 0:69566eea0fba 2734 /*******************************************************************************
cparata 0:69566eea0fba 2735 * Function Name : LSM6DSL_ACC_GYRO_R_CircularBurstMode
cparata 0:69566eea0fba 2736 * Description : Read ST_ROUNDING
cparata 0:69566eea0fba 2737 * Input : Pointer to LSM6DSL_ACC_GYRO_ROUNDING_t
cparata 0:69566eea0fba 2738 * Output : Status of ST_ROUNDING see LSM6DSL_ACC_GYRO_ROUNDING_t
cparata 0:69566eea0fba 2739 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2740 *******************************************************************************/
cparata 0:69566eea0fba 2741 status_t LSM6DSL_ACC_GYRO_R_CircularBurstMode(void *handle, LSM6DSL_ACC_GYRO_ROUNDING_t *value)
cparata 0:69566eea0fba 2742 {
cparata 0:69566eea0fba 2743 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, (u8_t *)value, 1))
cparata 0:69566eea0fba 2744 return MEMS_ERROR;
cparata 0:69566eea0fba 2745
cparata 0:69566eea0fba 2746 *value &= LSM6DSL_ACC_GYRO_LSM6DSL_ACC_GYRO_ROUNDING_t_MASK; //mask
cparata 0:69566eea0fba 2747
cparata 0:69566eea0fba 2748 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2749 }
cparata 0:69566eea0fba 2750
cparata 0:69566eea0fba 2751 /*******************************************************************************
cparata 0:69566eea0fba 2752 * Function Name : LSM6DSL_ACC_GYRO_W_LP_BW_G
cparata 0:69566eea0fba 2753 * Description : Write FTYPE
cparata 0:69566eea0fba 2754 * Input : LSM6DSL_ACC_GYRO_FTYPE_t
cparata 0:69566eea0fba 2755 * Output : None
cparata 0:69566eea0fba 2756 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2757 *******************************************************************************/
cparata 0:69566eea0fba 2758 status_t LSM6DSL_ACC_GYRO_W_LP_BW_G(void *handle, LSM6DSL_ACC_GYRO_FTYPE_t newValue)
cparata 0:69566eea0fba 2759 {
cparata 0:69566eea0fba 2760 u8_t value;
cparata 0:69566eea0fba 2761
cparata 0:69566eea0fba 2762 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1))
cparata 0:69566eea0fba 2763 return MEMS_ERROR;
cparata 0:69566eea0fba 2764
cparata 0:69566eea0fba 2765 value &= ~LSM6DSL_ACC_GYRO_FTYPE_MASK;
cparata 0:69566eea0fba 2766 value |= newValue;
cparata 0:69566eea0fba 2767
cparata 0:69566eea0fba 2768 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1) )
cparata 0:69566eea0fba 2769 return MEMS_ERROR;
cparata 0:69566eea0fba 2770
cparata 0:69566eea0fba 2771 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2772 }
cparata 0:69566eea0fba 2773
cparata 0:69566eea0fba 2774 /*******************************************************************************
cparata 0:69566eea0fba 2775 * Function Name : LSM6DSL_ACC_GYRO_R_LP_BW_G
cparata 0:69566eea0fba 2776 * Description : Read FTYPE
cparata 0:69566eea0fba 2777 * Input : Pointer to LSM6DSL_ACC_GYRO_FTYPE_t
cparata 0:69566eea0fba 2778 * Output : Status of FTYPE see LSM6DSL_ACC_GYRO_FTYPE_t
cparata 0:69566eea0fba 2779 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2780 *******************************************************************************/
cparata 0:69566eea0fba 2781 status_t LSM6DSL_ACC_GYRO_R_LP_BW_G(void *handle, LSM6DSL_ACC_GYRO_FTYPE_t *value)
cparata 0:69566eea0fba 2782 {
cparata 0:69566eea0fba 2783 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, (u8_t *)value, 1))
cparata 0:69566eea0fba 2784 return MEMS_ERROR;
cparata 0:69566eea0fba 2785
cparata 0:69566eea0fba 2786 *value &= LSM6DSL_ACC_GYRO_FTYPE_MASK; //mask
cparata 0:69566eea0fba 2787
cparata 0:69566eea0fba 2788 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2789 }
cparata 0:69566eea0fba 2790
cparata 0:69566eea0fba 2791 /*******************************************************************************
cparata 0:69566eea0fba 2792 * Function Name : LSM6DSL_ACC_GYRO_W_UserOffsetWeight
cparata 0:69566eea0fba 2793 * Description : Write USR_OFF_W
cparata 0:69566eea0fba 2794 * Input : LSM6DSL_ACC_GYRO_USR_OFF_W_t
cparata 0:69566eea0fba 2795 * Output : None
cparata 0:69566eea0fba 2796 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2797 *******************************************************************************/
cparata 0:69566eea0fba 2798 status_t LSM6DSL_ACC_GYRO_W_UserOffsetWeight(void *handle, LSM6DSL_ACC_GYRO_USR_OFF_W_t newValue)
cparata 0:69566eea0fba 2799 {
cparata 0:69566eea0fba 2800 u8_t value;
cparata 0:69566eea0fba 2801
cparata 0:69566eea0fba 2802 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1))
cparata 0:69566eea0fba 2803 return MEMS_ERROR;
cparata 0:69566eea0fba 2804
cparata 0:69566eea0fba 2805 value &= ~LSM6DSL_ACC_GYRO_USR_OFF_W_MASK;
cparata 0:69566eea0fba 2806 value |= newValue;
cparata 0:69566eea0fba 2807
cparata 0:69566eea0fba 2808 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1) )
cparata 0:69566eea0fba 2809 return MEMS_ERROR;
cparata 0:69566eea0fba 2810
cparata 0:69566eea0fba 2811 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2812 }
cparata 0:69566eea0fba 2813
cparata 0:69566eea0fba 2814 /*******************************************************************************
cparata 0:69566eea0fba 2815 * Function Name : LSM6DSL_ACC_GYRO_R_UserOffsetWeight
cparata 0:69566eea0fba 2816 * Description : Read USR_OFF_W
cparata 0:69566eea0fba 2817 * Input : Pointer to LSM6DSL_ACC_GYRO_USR_OFF_W_t
cparata 0:69566eea0fba 2818 * Output : Status of USR_OFF_W see LSM6DSL_ACC_GYRO_USR_OFF_W_t
cparata 0:69566eea0fba 2819 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2820 *******************************************************************************/
cparata 0:69566eea0fba 2821 status_t LSM6DSL_ACC_GYRO_R_UserOffsetWeight(void *handle, LSM6DSL_ACC_GYRO_USR_OFF_W_t *value)
cparata 0:69566eea0fba 2822 {
cparata 0:69566eea0fba 2823 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, (u8_t *)value, 1))
cparata 0:69566eea0fba 2824 return MEMS_ERROR;
cparata 0:69566eea0fba 2825
cparata 0:69566eea0fba 2826 *value &= LSM6DSL_ACC_GYRO_USR_OFF_W_MASK; //mask
cparata 0:69566eea0fba 2827
cparata 0:69566eea0fba 2828 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2829 }
cparata 0:69566eea0fba 2830
cparata 0:69566eea0fba 2831 /*******************************************************************************
cparata 0:69566eea0fba 2832 * Function Name : LSM6DSL_ACC_GYRO_W_LowPower_XL
cparata 0:69566eea0fba 2833 * Description : Write LP_XL
cparata 0:69566eea0fba 2834 * Input : LSM6DSL_ACC_GYRO_LP_XL_t
cparata 0:69566eea0fba 2835 * Output : None
cparata 0:69566eea0fba 2836 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2837 *******************************************************************************/
cparata 0:69566eea0fba 2838 status_t LSM6DSL_ACC_GYRO_W_LowPower_XL(void *handle, LSM6DSL_ACC_GYRO_LP_XL_t newValue)
cparata 0:69566eea0fba 2839 {
cparata 0:69566eea0fba 2840 u8_t value;
cparata 0:69566eea0fba 2841
cparata 0:69566eea0fba 2842 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1))
cparata 0:69566eea0fba 2843 return MEMS_ERROR;
cparata 0:69566eea0fba 2844
cparata 0:69566eea0fba 2845 value &= ~LSM6DSL_ACC_GYRO_LP_XL_MASK;
cparata 0:69566eea0fba 2846 value |= newValue;
cparata 0:69566eea0fba 2847
cparata 0:69566eea0fba 2848 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1) )
cparata 0:69566eea0fba 2849 return MEMS_ERROR;
cparata 0:69566eea0fba 2850
cparata 0:69566eea0fba 2851 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2852 }
cparata 0:69566eea0fba 2853
cparata 0:69566eea0fba 2854 /*******************************************************************************
cparata 0:69566eea0fba 2855 * Function Name : LSM6DSL_ACC_GYRO_R_LowPower_XL
cparata 0:69566eea0fba 2856 * Description : Read LP_XL
cparata 0:69566eea0fba 2857 * Input : Pointer to LSM6DSL_ACC_GYRO_LP_XL_t
cparata 0:69566eea0fba 2858 * Output : Status of LP_XL see LSM6DSL_ACC_GYRO_LP_XL_t
cparata 0:69566eea0fba 2859 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2860 *******************************************************************************/
cparata 0:69566eea0fba 2861 status_t LSM6DSL_ACC_GYRO_R_LowPower_XL(void *handle, LSM6DSL_ACC_GYRO_LP_XL_t *value)
cparata 0:69566eea0fba 2862 {
cparata 0:69566eea0fba 2863 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, (u8_t *)value, 1))
cparata 0:69566eea0fba 2864 return MEMS_ERROR;
cparata 0:69566eea0fba 2865
cparata 0:69566eea0fba 2866 *value &= LSM6DSL_ACC_GYRO_LP_XL_MASK; //mask
cparata 0:69566eea0fba 2867
cparata 0:69566eea0fba 2868 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2869 }
cparata 0:69566eea0fba 2870 /*******************************************************************************
cparata 0:69566eea0fba 2871 * Function Name : LSM6DSL_ACC_GYRO_W_DEN_LVL2_EN
cparata 0:69566eea0fba 2872 * Description : Write DEN_LVL2_EN
cparata 0:69566eea0fba 2873 * Input : LSM6DSL_ACC_GYRO_DEN_LVL2_EN_t
cparata 0:69566eea0fba 2874 * Output : None
cparata 0:69566eea0fba 2875 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2876 *******************************************************************************/
cparata 0:69566eea0fba 2877 status_t LSM6DSL_ACC_GYRO_W_DEN_LVL2_EN(void *handle, LSM6DSL_ACC_GYRO_DEN_LVL2_EN_t newValue)
cparata 0:69566eea0fba 2878 {
cparata 0:69566eea0fba 2879 u8_t value;
cparata 0:69566eea0fba 2880
cparata 0:69566eea0fba 2881 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1))
cparata 0:69566eea0fba 2882 return MEMS_ERROR;
cparata 0:69566eea0fba 2883
cparata 0:69566eea0fba 2884 value &= ~LSM6DSL_ACC_GYRO_DEN_LVL2_EN_MASK;
cparata 0:69566eea0fba 2885 value |= newValue;
cparata 0:69566eea0fba 2886
cparata 0:69566eea0fba 2887 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1) )
cparata 0:69566eea0fba 2888 return MEMS_ERROR;
cparata 0:69566eea0fba 2889
cparata 0:69566eea0fba 2890 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2891 }
cparata 0:69566eea0fba 2892
cparata 0:69566eea0fba 2893 /*******************************************************************************
cparata 0:69566eea0fba 2894 * Function Name : LSM6DSL_ACC_GYRO_R_DEN_LVL2_EN
cparata 0:69566eea0fba 2895 * Description : Read DEN_LVL2_EN
cparata 0:69566eea0fba 2896 * Input : Pointer to LSM6DSL_ACC_GYRO_DEN_LVL2_EN_t
cparata 0:69566eea0fba 2897 * Output : Status of DEN_LVL2_EN see LSM6DSL_ACC_GYRO_DEN_LVL2_EN_t
cparata 0:69566eea0fba 2898 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2899 *******************************************************************************/
cparata 0:69566eea0fba 2900 status_t LSM6DSL_ACC_GYRO_R_DEN_LVL2_EN(void *handle, LSM6DSL_ACC_GYRO_DEN_LVL2_EN_t *value)
cparata 0:69566eea0fba 2901 {
cparata 0:69566eea0fba 2902 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, (u8_t *)value, 1))
cparata 0:69566eea0fba 2903 return MEMS_ERROR;
cparata 0:69566eea0fba 2904
cparata 0:69566eea0fba 2905 *value &= LSM6DSL_ACC_GYRO_DEN_LVL2_EN_MASK; //mask
cparata 0:69566eea0fba 2906
cparata 0:69566eea0fba 2907 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2908 }
cparata 0:69566eea0fba 2909 /*******************************************************************************
cparata 0:69566eea0fba 2910 * Function Name : LSM6DSL_ACC_GYRO_W_DEN_LVL_EN
cparata 0:69566eea0fba 2911 * Description : Write DEN_LVL_EN
cparata 0:69566eea0fba 2912 * Input : LSM6DSL_ACC_GYRO_DEN_LVL_EN_t
cparata 0:69566eea0fba 2913 * Output : None
cparata 0:69566eea0fba 2914 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2915 *******************************************************************************/
cparata 0:69566eea0fba 2916 status_t LSM6DSL_ACC_GYRO_W_DEN_LVL_EN(void *handle, LSM6DSL_ACC_GYRO_DEN_LVL_EN_t newValue)
cparata 0:69566eea0fba 2917 {
cparata 0:69566eea0fba 2918 u8_t value;
cparata 0:69566eea0fba 2919
cparata 0:69566eea0fba 2920 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1))
cparata 0:69566eea0fba 2921 return MEMS_ERROR;
cparata 0:69566eea0fba 2922
cparata 0:69566eea0fba 2923 value &= ~LSM6DSL_ACC_GYRO_DEN_LVL_EN_MASK;
cparata 0:69566eea0fba 2924 value |= newValue;
cparata 0:69566eea0fba 2925
cparata 0:69566eea0fba 2926 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1) )
cparata 0:69566eea0fba 2927 return MEMS_ERROR;
cparata 0:69566eea0fba 2928
cparata 0:69566eea0fba 2929 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2930 }
cparata 0:69566eea0fba 2931
cparata 0:69566eea0fba 2932 /*******************************************************************************
cparata 0:69566eea0fba 2933 * Function Name : LSM6DSL_ACC_GYRO_R_DEN_LVL_EN
cparata 0:69566eea0fba 2934 * Description : Read DEN_LVL_EN
cparata 0:69566eea0fba 2935 * Input : Pointer to LSM6DSL_ACC_GYRO_DEN_LVL_EN_t
cparata 0:69566eea0fba 2936 * Output : Status of DEN_LVL_EN see LSM6DSL_ACC_GYRO_DEN_LVL_EN_t
cparata 0:69566eea0fba 2937 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2938 *******************************************************************************/
cparata 0:69566eea0fba 2939 status_t LSM6DSL_ACC_GYRO_R_DEN_LVL_EN(void *handle, LSM6DSL_ACC_GYRO_DEN_LVL_EN_t *value)
cparata 0:69566eea0fba 2940 {
cparata 0:69566eea0fba 2941 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, (u8_t *)value, 1) )
cparata 0:69566eea0fba 2942 return MEMS_ERROR;
cparata 0:69566eea0fba 2943
cparata 0:69566eea0fba 2944 *value &= LSM6DSL_ACC_GYRO_DEN_LVL_EN_MASK; //mask
cparata 0:69566eea0fba 2945
cparata 0:69566eea0fba 2946 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2947 }
cparata 0:69566eea0fba 2948 /*******************************************************************************
cparata 0:69566eea0fba 2949 * Function Name : LSM6DSL_ACC_GYRO_W_ExternalTrigger
cparata 0:69566eea0fba 2950 * Description : Write DEN_EDGE_EN
cparata 0:69566eea0fba 2951 * Input : LSM6DSL_ACC_GYRO_DEN_EDGE_EN_t
cparata 0:69566eea0fba 2952 * Output : None
cparata 0:69566eea0fba 2953 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2954 *******************************************************************************/
cparata 0:69566eea0fba 2955 status_t LSM6DSL_ACC_GYRO_W_ExternalTrigger(void *handle, LSM6DSL_ACC_GYRO_DEN_EDGE_EN_t newValue)
cparata 0:69566eea0fba 2956 {
cparata 0:69566eea0fba 2957 u8_t value;
cparata 0:69566eea0fba 2958
cparata 0:69566eea0fba 2959 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1) )
cparata 0:69566eea0fba 2960 return MEMS_ERROR;
cparata 0:69566eea0fba 2961
cparata 0:69566eea0fba 2962 value &= ~LSM6DSL_ACC_GYRO_DEN_EDGE_EN_MASK;
cparata 0:69566eea0fba 2963 value |= newValue;
cparata 0:69566eea0fba 2964
cparata 0:69566eea0fba 2965 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1) )
cparata 0:69566eea0fba 2966 return MEMS_ERROR;
cparata 0:69566eea0fba 2967
cparata 0:69566eea0fba 2968 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2969 }
cparata 0:69566eea0fba 2970
cparata 0:69566eea0fba 2971 /*******************************************************************************
cparata 0:69566eea0fba 2972 * Function Name : LSM6DSL_ACC_GYRO_R_ExternalTrigger
cparata 0:69566eea0fba 2973 * Description : Read DEN_EDGE_EN
cparata 0:69566eea0fba 2974 * Input : Pointer to LSM6DSL_ACC_GYRO_DEN_EDGE_EN_t
cparata 0:69566eea0fba 2975 * Output : Status of DEN_EDGE_EN see LSM6DSL_ACC_GYRO_DEN_EDGE_EN_t
cparata 0:69566eea0fba 2976 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2977 *******************************************************************************/
cparata 0:69566eea0fba 2978 status_t LSM6DSL_ACC_GYRO_R_ExternalTrigger(void *handle, LSM6DSL_ACC_GYRO_DEN_EDGE_EN_t *value)
cparata 0:69566eea0fba 2979 {
cparata 0:69566eea0fba 2980 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, (u8_t *)value, 1) )
cparata 0:69566eea0fba 2981 return MEMS_ERROR;
cparata 0:69566eea0fba 2982
cparata 0:69566eea0fba 2983 *value &= LSM6DSL_ACC_GYRO_DEN_EDGE_EN_MASK; //mask
cparata 0:69566eea0fba 2984
cparata 0:69566eea0fba 2985 return MEMS_SUCCESS;
cparata 0:69566eea0fba 2986 }
cparata 0:69566eea0fba 2987
cparata 0:69566eea0fba 2988 /*******************************************************************************
cparata 0:69566eea0fba 2989 * Function Name : LSM6DSL_ACC_GYRO_W_HPM_G
cparata 0:69566eea0fba 2990 * Description : Write HPM_G
cparata 0:69566eea0fba 2991 * Input : LSM6DSL_ACC_GYRO_HPM_G_t
cparata 0:69566eea0fba 2992 * Output : None
cparata 0:69566eea0fba 2993 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 2994 *******************************************************************************/
cparata 0:69566eea0fba 2995 status_t LSM6DSL_ACC_GYRO_W_HPM_G(void *handle, LSM6DSL_ACC_GYRO_HPM_G_t newValue)
cparata 0:69566eea0fba 2996 {
cparata 0:69566eea0fba 2997 u8_t value;
cparata 0:69566eea0fba 2998
cparata 0:69566eea0fba 2999 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:69566eea0fba 3000 return MEMS_ERROR;
cparata 0:69566eea0fba 3001
cparata 0:69566eea0fba 3002 value &= ~LSM6DSL_ACC_GYRO_HPM_G_MASK;
cparata 0:69566eea0fba 3003 value |= newValue;
cparata 0:69566eea0fba 3004
cparata 0:69566eea0fba 3005 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:69566eea0fba 3006 return MEMS_ERROR;
cparata 0:69566eea0fba 3007
cparata 0:69566eea0fba 3008 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3009 }
cparata 0:69566eea0fba 3010
cparata 0:69566eea0fba 3011 /*******************************************************************************
cparata 0:69566eea0fba 3012 * Function Name : LSM6DSL_ACC_GYRO_R_HPM_G
cparata 0:69566eea0fba 3013 * Description : Read HPM_G
cparata 0:69566eea0fba 3014 * Input : Pointer to LSM6DSL_ACC_GYRO_HPM_G_t
cparata 0:69566eea0fba 3015 * Output : Status of HPM_G see LSM6DSL_ACC_GYRO_HPM_G_t
cparata 0:69566eea0fba 3016 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3017 *******************************************************************************/
cparata 0:69566eea0fba 3018 status_t LSM6DSL_ACC_GYRO_R_HPM_G(void *handle, LSM6DSL_ACC_GYRO_HPM_G_t *value)
cparata 0:69566eea0fba 3019 {
cparata 0:69566eea0fba 3020 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, (u8_t *)value, 1) )
cparata 0:69566eea0fba 3021 return MEMS_ERROR;
cparata 0:69566eea0fba 3022
cparata 0:69566eea0fba 3023 *value &= LSM6DSL_ACC_GYRO_HPM_G_MASK; //mask
cparata 0:69566eea0fba 3024
cparata 0:69566eea0fba 3025 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3026 }
cparata 0:69566eea0fba 3027
cparata 0:69566eea0fba 3028 /*******************************************************************************
cparata 0:69566eea0fba 3029 * Function Name : LSM6DSL_ACC_GYRO_W_RoundingOnStatusRegisters
cparata 0:69566eea0fba 3030 * Description : Write HPM_G
cparata 0:69566eea0fba 3031 * Input : LSM6DSL_ACC_GYRO_RND_STATUS_t
cparata 0:69566eea0fba 3032 * Output : None
cparata 0:69566eea0fba 3033 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3034 *******************************************************************************/
cparata 0:69566eea0fba 3035 status_t LSM6DSL_ACC_GYRO_W_RoundingOnStatusRegisters(void *handle, LSM6DSL_ACC_GYRO_RND_STATUS_t newValue)
cparata 0:69566eea0fba 3036 {
cparata 0:69566eea0fba 3037 u8_t value;
cparata 0:69566eea0fba 3038
cparata 0:69566eea0fba 3039 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:69566eea0fba 3040 return MEMS_ERROR;
cparata 0:69566eea0fba 3041
cparata 0:69566eea0fba 3042 value &= ~LSM6DSL_ACC_GYRO_RND_STATUS_MASK;
cparata 0:69566eea0fba 3043 value |= newValue;
cparata 0:69566eea0fba 3044
cparata 0:69566eea0fba 3045 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:69566eea0fba 3046 return MEMS_ERROR;
cparata 0:69566eea0fba 3047
cparata 0:69566eea0fba 3048 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3049 }
cparata 0:69566eea0fba 3050
cparata 0:69566eea0fba 3051 /*******************************************************************************
cparata 0:69566eea0fba 3052 * Function Name : LSM6DSL_ACC_GYRO_R_RoundingOnStatusRegisters
cparata 0:69566eea0fba 3053 * Description : Read HPM_G
cparata 0:69566eea0fba 3054 * Input : Pointer to LSM6DSL_ACC_GYRO_RND_STATUS_t
cparata 0:69566eea0fba 3055 * Output : Status of HPM_G see LSM6DSL_ACC_GYRO_RND_STATUS_t
cparata 0:69566eea0fba 3056 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3057 *******************************************************************************/
cparata 0:69566eea0fba 3058 status_t LSM6DSL_ACC_GYRO_R_RoundingOnStatusRegisters(void *handle, LSM6DSL_ACC_GYRO_RND_STATUS_t *value)
cparata 0:69566eea0fba 3059 {
cparata 0:69566eea0fba 3060 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, (u8_t *)value, 1))
cparata 0:69566eea0fba 3061 return MEMS_ERROR;
cparata 0:69566eea0fba 3062
cparata 0:69566eea0fba 3063 *value &= LSM6DSL_ACC_GYRO_RND_STATUS_MASK; //mask
cparata 0:69566eea0fba 3064
cparata 0:69566eea0fba 3065 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3066 }
cparata 0:69566eea0fba 3067
cparata 0:69566eea0fba 3068 /*******************************************************************************
cparata 0:69566eea0fba 3069 * Function Name : LSM6DSL_ACC_GYRO_W_HPFilter_En
cparata 0:69566eea0fba 3070 * Description : Write HP_EN
cparata 0:69566eea0fba 3071 * Input : LSM6DSL_ACC_GYRO_HP_EN_t
cparata 0:69566eea0fba 3072 * Output : None
cparata 0:69566eea0fba 3073 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3074 *******************************************************************************/
cparata 0:69566eea0fba 3075 status_t LSM6DSL_ACC_GYRO_W_HPFilter_En(void *handle, LSM6DSL_ACC_GYRO_HP_EN_t newValue)
cparata 0:69566eea0fba 3076 {
cparata 0:69566eea0fba 3077 u8_t value;
cparata 0:69566eea0fba 3078
cparata 0:69566eea0fba 3079 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:69566eea0fba 3080 return MEMS_ERROR;
cparata 0:69566eea0fba 3081
cparata 0:69566eea0fba 3082 value &= ~LSM6DSL_ACC_GYRO_HP_EN_MASK;
cparata 0:69566eea0fba 3083 value |= newValue;
cparata 0:69566eea0fba 3084
cparata 0:69566eea0fba 3085 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:69566eea0fba 3086 return MEMS_ERROR;
cparata 0:69566eea0fba 3087
cparata 0:69566eea0fba 3088 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3089 }
cparata 0:69566eea0fba 3090
cparata 0:69566eea0fba 3091 /*******************************************************************************
cparata 0:69566eea0fba 3092 * Function Name : LSM6DSL_ACC_GYRO_R_HPFilter_En
cparata 0:69566eea0fba 3093 * Description : Read HP_EN
cparata 0:69566eea0fba 3094 * Input : Pointer to LSM6DSL_ACC_GYRO_HP_EN_t
cparata 0:69566eea0fba 3095 * Output : Status of HP_EN see LSM6DSL_ACC_GYRO_HP_EN_t
cparata 0:69566eea0fba 3096 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3097 *******************************************************************************/
cparata 0:69566eea0fba 3098 status_t LSM6DSL_ACC_GYRO_R_HPFilter_En(void *handle, LSM6DSL_ACC_GYRO_HP_EN_t *value)
cparata 0:69566eea0fba 3099 {
cparata 0:69566eea0fba 3100 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, (u8_t *)value, 1) )
cparata 0:69566eea0fba 3101 return MEMS_ERROR;
cparata 0:69566eea0fba 3102
cparata 0:69566eea0fba 3103 *value &= LSM6DSL_ACC_GYRO_HP_EN_MASK; //mask
cparata 0:69566eea0fba 3104
cparata 0:69566eea0fba 3105 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3106 }
cparata 0:69566eea0fba 3107 /*******************************************************************************
cparata 0:69566eea0fba 3108 * Function Name : LSM6DSL_ACC_GYRO_W_LP_Mode
cparata 0:69566eea0fba 3109 * Description : Write LP_EN
cparata 0:69566eea0fba 3110 * Input : LSM6DSL_ACC_GYRO_LP_EN_t
cparata 0:69566eea0fba 3111 * Output : None
cparata 0:69566eea0fba 3112 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3113 *******************************************************************************/
cparata 0:69566eea0fba 3114 status_t LSM6DSL_ACC_GYRO_W_LP_Mode(void *handle, LSM6DSL_ACC_GYRO_LP_EN_t newValue)
cparata 0:69566eea0fba 3115 {
cparata 0:69566eea0fba 3116 u8_t value;
cparata 0:69566eea0fba 3117
cparata 0:69566eea0fba 3118 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:69566eea0fba 3119 return MEMS_ERROR;
cparata 0:69566eea0fba 3120
cparata 0:69566eea0fba 3121 value &= ~LSM6DSL_ACC_GYRO_LP_EN_MASK;
cparata 0:69566eea0fba 3122 value |= newValue;
cparata 0:69566eea0fba 3123
cparata 0:69566eea0fba 3124 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:69566eea0fba 3125 return MEMS_ERROR;
cparata 0:69566eea0fba 3126
cparata 0:69566eea0fba 3127 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3128 }
cparata 0:69566eea0fba 3129
cparata 0:69566eea0fba 3130 /*******************************************************************************
cparata 0:69566eea0fba 3131 * Function Name : LSM6DSL_ACC_GYRO_R_LP_Mode
cparata 0:69566eea0fba 3132 * Description : Read LP_EN
cparata 0:69566eea0fba 3133 * Input : Pointer to LSM6DSL_ACC_GYRO_LP_EN_t
cparata 0:69566eea0fba 3134 * Output : Status of LP_EN see LSM6DSL_ACC_GYRO_LP_EN_t
cparata 0:69566eea0fba 3135 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3136 *******************************************************************************/
cparata 0:69566eea0fba 3137 status_t LSM6DSL_ACC_GYRO_R_LP_Mode(void *handle, LSM6DSL_ACC_GYRO_LP_EN_t *value)
cparata 0:69566eea0fba 3138 {
cparata 0:69566eea0fba 3139 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, (u8_t *)value, 1) )
cparata 0:69566eea0fba 3140 return MEMS_ERROR;
cparata 0:69566eea0fba 3141
cparata 0:69566eea0fba 3142 *value &= LSM6DSL_ACC_GYRO_LP_EN_MASK; //mask
cparata 0:69566eea0fba 3143
cparata 0:69566eea0fba 3144 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3145 }
cparata 0:69566eea0fba 3146
cparata 0:69566eea0fba 3147 /*******************************************************************************
cparata 0:69566eea0fba 3148 * Function Name : LSM6DSL_ACC_GYRO_W_ROUNDING_STATUS
cparata 0:69566eea0fba 3149 * Description : Write ROUNDING_STATUS
cparata 0:69566eea0fba 3150 * Input : LSM6DSL_ACC_GYRO_ROUNDING_STATUS_t
cparata 0:69566eea0fba 3151 * Output : None
cparata 0:69566eea0fba 3152 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3153 *******************************************************************************/
cparata 0:69566eea0fba 3154 status_t LSM6DSL_ACC_GYRO_W_ROUNDING_STATUS(void *handle, LSM6DSL_ACC_GYRO_ROUNDING_STATUS_t newValue)
cparata 0:69566eea0fba 3155 {
cparata 0:69566eea0fba 3156 u8_t value;
cparata 0:69566eea0fba 3157
cparata 0:69566eea0fba 3158 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:69566eea0fba 3159 return MEMS_ERROR;
cparata 0:69566eea0fba 3160
cparata 0:69566eea0fba 3161 value &= ~LSM6DSL_ACC_GYRO_ROUNDING_STATUS_MASK;
cparata 0:69566eea0fba 3162 value |= newValue;
cparata 0:69566eea0fba 3163
cparata 0:69566eea0fba 3164 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:69566eea0fba 3165 return MEMS_ERROR;
cparata 0:69566eea0fba 3166
cparata 0:69566eea0fba 3167 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3168 }
cparata 0:69566eea0fba 3169
cparata 0:69566eea0fba 3170 /*******************************************************************************
cparata 0:69566eea0fba 3171 * Function Name : LSM6DSL_ACC_GYRO_R_ROUNDING_STATUS
cparata 0:69566eea0fba 3172 * Description : Read ROUNDING_STATUS
cparata 0:69566eea0fba 3173 * Input : Pointer to LSM6DSL_ACC_GYRO_ROUNDING_STATUS_t
cparata 0:69566eea0fba 3174 * Output : Status of ROUNDING_STATUS see LSM6DSL_ACC_GYRO_ROUNDING_STATUS_t
cparata 0:69566eea0fba 3175 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3176 *******************************************************************************/
cparata 0:69566eea0fba 3177 status_t LSM6DSL_ACC_GYRO_R_ROUNDING_STATUS(void *handle, LSM6DSL_ACC_GYRO_ROUNDING_STATUS_t *value)
cparata 0:69566eea0fba 3178 {
cparata 0:69566eea0fba 3179 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, (u8_t *)value, 1) )
cparata 0:69566eea0fba 3180 return MEMS_ERROR;
cparata 0:69566eea0fba 3181
cparata 0:69566eea0fba 3182 *value &= LSM6DSL_ACC_GYRO_ROUNDING_STATUS_MASK; //mask
cparata 0:69566eea0fba 3183
cparata 0:69566eea0fba 3184 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3185 }
cparata 0:69566eea0fba 3186
cparata 0:69566eea0fba 3187 /*******************************************************************************
cparata 0:69566eea0fba 3188 * Function Name : LSM6DSL_ACC_GYRO_W_HP_G_RST
cparata 0:69566eea0fba 3189 * Description : Write HP_G_RST
cparata 0:69566eea0fba 3190 * Input : LSM6DSL_ACC_GYRO_HP_G_RST_t
cparata 0:69566eea0fba 3191 * Output : None
cparata 0:69566eea0fba 3192 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3193 *******************************************************************************/
cparata 0:69566eea0fba 3194 status_t LSM6DSL_ACC_GYRO_W_HP_G_RST(void *handle, LSM6DSL_ACC_GYRO_HP_G_RST_t newValue)
cparata 0:69566eea0fba 3195 {
cparata 0:69566eea0fba 3196 u8_t value;
cparata 0:69566eea0fba 3197
cparata 0:69566eea0fba 3198 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:69566eea0fba 3199 return MEMS_ERROR;
cparata 0:69566eea0fba 3200
cparata 0:69566eea0fba 3201 value &= ~LSM6DSL_ACC_GYRO_HP_G_RST_MASK;
cparata 0:69566eea0fba 3202 value |= newValue;
cparata 0:69566eea0fba 3203
cparata 0:69566eea0fba 3204 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:69566eea0fba 3205 return MEMS_ERROR;
cparata 0:69566eea0fba 3206
cparata 0:69566eea0fba 3207 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3208 }
cparata 0:69566eea0fba 3209
cparata 0:69566eea0fba 3210 /*******************************************************************************
cparata 0:69566eea0fba 3211 * Function Name : LSM6DSL_ACC_GYRO_R_HP_G_RST
cparata 0:69566eea0fba 3212 * Description : Read HP_G_RST
cparata 0:69566eea0fba 3213 * Input : Pointer to LSM6DSL_ACC_GYRO_HP_G_RST_t
cparata 0:69566eea0fba 3214 * Output : Status of HP_G_RST see LSM6DSL_ACC_GYRO_HP_G_RST_t
cparata 0:69566eea0fba 3215 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3216 *******************************************************************************/
cparata 0:69566eea0fba 3217 status_t LSM6DSL_ACC_GYRO_R_HP_G_RST(void *handle, LSM6DSL_ACC_GYRO_HP_G_RST_t *value)
cparata 0:69566eea0fba 3218 {
cparata 0:69566eea0fba 3219 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, (u8_t *)value, 1) )
cparata 0:69566eea0fba 3220 return MEMS_ERROR;
cparata 0:69566eea0fba 3221
cparata 0:69566eea0fba 3222 *value &= LSM6DSL_ACC_GYRO_HP_G_RST_MASK; //mask
cparata 0:69566eea0fba 3223
cparata 0:69566eea0fba 3224 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3225 }
cparata 0:69566eea0fba 3226
cparata 0:69566eea0fba 3227 /*******************************************************************************
cparata 0:69566eea0fba 3228 * Function Name : LSM6DSL_ACC_GYRO_W_InComposit
cparata 0:69566eea0fba 3229 * Description : Write INPUT_COMPOSITE
cparata 0:69566eea0fba 3230 * Input : LSM6DSL_ACC_GYRO_IN_COMP_t
cparata 0:69566eea0fba 3231 * Output : None
cparata 0:69566eea0fba 3232 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3233 *******************************************************************************/
cparata 0:69566eea0fba 3234 status_t LSM6DSL_ACC_GYRO_W_InComposit(void *handle, LSM6DSL_ACC_GYRO_IN_COMP_t newValue)
cparata 0:69566eea0fba 3235 {
cparata 0:69566eea0fba 3236 u8_t value;
cparata 0:69566eea0fba 3237
cparata 0:69566eea0fba 3238 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:69566eea0fba 3239 return MEMS_ERROR;
cparata 0:69566eea0fba 3240
cparata 0:69566eea0fba 3241 value &= ~LSM6DSL_ACC_GYRO_IN_COMP_MASK;
cparata 0:69566eea0fba 3242 value |= newValue;
cparata 0:69566eea0fba 3243
cparata 0:69566eea0fba 3244 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:69566eea0fba 3245 return MEMS_ERROR;
cparata 0:69566eea0fba 3246
cparata 0:69566eea0fba 3247 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3248 }
cparata 0:69566eea0fba 3249
cparata 0:69566eea0fba 3250 /*******************************************************************************
cparata 0:69566eea0fba 3251 * Function Name : LSM6DSL_ACC_GYRO_R_InComposit
cparata 0:69566eea0fba 3252 * Description : Read INPUT_COMPOSITE
cparata 0:69566eea0fba 3253 * Input : Pointer to LSM6DSL_ACC_GYRO_IN_COMP_t
cparata 0:69566eea0fba 3254 * Output : Status of INPUT_COMPOSITE see LSM6DSL_ACC_GYRO_IN_COMP_t
cparata 0:69566eea0fba 3255 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3256 *******************************************************************************/
cparata 0:69566eea0fba 3257 status_t LSM6DSL_ACC_GYRO_R_InComposit(void *handle, LSM6DSL_ACC_GYRO_IN_COMP_t *value)
cparata 0:69566eea0fba 3258 {
cparata 0:69566eea0fba 3259 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, (u8_t *)value, 1) )
cparata 0:69566eea0fba 3260 return MEMS_ERROR;
cparata 0:69566eea0fba 3261
cparata 0:69566eea0fba 3262 *value &= LSM6DSL_ACC_GYRO_IN_COMP_MASK; //mask
cparata 0:69566eea0fba 3263
cparata 0:69566eea0fba 3264 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3265 }
cparata 0:69566eea0fba 3266
cparata 0:69566eea0fba 3267 /*******************************************************************************
cparata 0:69566eea0fba 3268 * Function Name : LSM6DSL_ACC_GYRO_W_HPfilterReference
cparata 0:69566eea0fba 3269 * Description : Write HP_REF_MODE
cparata 0:69566eea0fba 3270 * Input : LSM6DSL_ACC_GYRO_HP_REF_MODE_t
cparata 0:69566eea0fba 3271 * Output : None
cparata 0:69566eea0fba 3272 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3273 *******************************************************************************/
cparata 0:69566eea0fba 3274 status_t LSM6DSL_ACC_GYRO_W_HPfilterReference(void *handle, LSM6DSL_ACC_GYRO_HP_REF_MODE_t newValue)
cparata 0:69566eea0fba 3275 {
cparata 0:69566eea0fba 3276 u8_t value;
cparata 0:69566eea0fba 3277
cparata 0:69566eea0fba 3278 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:69566eea0fba 3279 return MEMS_ERROR;
cparata 0:69566eea0fba 3280
cparata 0:69566eea0fba 3281 value &= ~LSM6DSL_ACC_GYRO_HP_REF_MODE_MASK;
cparata 0:69566eea0fba 3282 value |= newValue;
cparata 0:69566eea0fba 3283
cparata 0:69566eea0fba 3284 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:69566eea0fba 3285 return MEMS_ERROR;
cparata 0:69566eea0fba 3286
cparata 0:69566eea0fba 3287 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3288 }
cparata 0:69566eea0fba 3289
cparata 0:69566eea0fba 3290 /*******************************************************************************
cparata 0:69566eea0fba 3291 * Function Name : LSM6DSL_ACC_GYRO_R_HPfilterReference
cparata 0:69566eea0fba 3292 * Description : Read HP_REF_MODE
cparata 0:69566eea0fba 3293 * Input : Pointer to LSM6DSL_ACC_GYRO_HP_REF_MODE_t
cparata 0:69566eea0fba 3294 * Output : Status of HP_REF_MODE see LSM6DSL_ACC_GYRO_HP_REF_MODE_t
cparata 0:69566eea0fba 3295 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3296 *******************************************************************************/
cparata 0:69566eea0fba 3297 status_t LSM6DSL_ACC_GYRO_R_HPfilterReference(void *handle, LSM6DSL_ACC_GYRO_HP_REF_MODE_t *value)
cparata 0:69566eea0fba 3298 {
cparata 0:69566eea0fba 3299 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, (u8_t *)value, 1) )
cparata 0:69566eea0fba 3300 return MEMS_ERROR;
cparata 0:69566eea0fba 3301
cparata 0:69566eea0fba 3302 *value &= LSM6DSL_ACC_GYRO_HP_REF_MODE_MASK; //mask
cparata 0:69566eea0fba 3303
cparata 0:69566eea0fba 3304 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3305 }
cparata 0:69566eea0fba 3306
cparata 0:69566eea0fba 3307 /*******************************************************************************
cparata 0:69566eea0fba 3308 * Function Name : LSM6DSL_ACC_GYRO_W_HPCF_XL
cparata 0:69566eea0fba 3309 * Description : Write HPCF_XL
cparata 0:69566eea0fba 3310 * Input : LSM6DSL_ACC_GYRO_HPCF_XL_t
cparata 0:69566eea0fba 3311 * Output : None
cparata 0:69566eea0fba 3312 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3313 *******************************************************************************/
cparata 0:69566eea0fba 3314 status_t LSM6DSL_ACC_GYRO_W_HPCF_XL(void *handle, LSM6DSL_ACC_GYRO_HPCF_XL_t newValue)
cparata 0:69566eea0fba 3315 {
cparata 0:69566eea0fba 3316 u8_t value;
cparata 0:69566eea0fba 3317
cparata 0:69566eea0fba 3318 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:69566eea0fba 3319 return MEMS_ERROR;
cparata 0:69566eea0fba 3320
cparata 0:69566eea0fba 3321 value &= ~LSM6DSL_ACC_GYRO_HPCF_XL_MASK;
cparata 0:69566eea0fba 3322 value |= newValue;
cparata 0:69566eea0fba 3323
cparata 0:69566eea0fba 3324 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:69566eea0fba 3325 return MEMS_ERROR;
cparata 0:69566eea0fba 3326
cparata 0:69566eea0fba 3327 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3328 }
cparata 0:69566eea0fba 3329
cparata 0:69566eea0fba 3330 /*******************************************************************************
cparata 0:69566eea0fba 3331 * Function Name : LSM6DSL_ACC_GYRO_R_HPCF_XL
cparata 0:69566eea0fba 3332 * Description : Read HPCF_XL
cparata 0:69566eea0fba 3333 * Input : Pointer to LSM6DSL_ACC_GYRO_HPCF_XL_t
cparata 0:69566eea0fba 3334 * Output : Status of HPCF_XL see LSM6DSL_ACC_GYRO_HPCF_XL_t
cparata 0:69566eea0fba 3335 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3336 *******************************************************************************/
cparata 0:69566eea0fba 3337 status_t LSM6DSL_ACC_GYRO_R_HPCF_XL(void *handle, LSM6DSL_ACC_GYRO_HPCF_XL_t *value)
cparata 0:69566eea0fba 3338 {
cparata 0:69566eea0fba 3339 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, (u8_t *)value, 1) )
cparata 0:69566eea0fba 3340 return MEMS_ERROR;
cparata 0:69566eea0fba 3341
cparata 0:69566eea0fba 3342 *value &= LSM6DSL_ACC_GYRO_HPCF_XL_MASK; //mask
cparata 0:69566eea0fba 3343
cparata 0:69566eea0fba 3344 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3345 }
cparata 0:69566eea0fba 3346
cparata 0:69566eea0fba 3347 /*******************************************************************************
cparata 0:69566eea0fba 3348 * Function Name : LSM6DSL_ACC_GYRO_W_LowPassFiltSel_XL
cparata 0:69566eea0fba 3349 * Description : Write LPF2_XL_EN
cparata 0:69566eea0fba 3350 * Input : LSM6DSL_ACC_GYRO_LPF2_XL_t
cparata 0:69566eea0fba 3351 * Output : None
cparata 0:69566eea0fba 3352 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3353 *******************************************************************************/
cparata 0:69566eea0fba 3354 status_t LSM6DSL_ACC_GYRO_W_LowPassFiltSel_XL(void *handle, LSM6DSL_ACC_GYRO_LPF2_XL_t newValue)
cparata 0:69566eea0fba 3355 {
cparata 0:69566eea0fba 3356 u8_t value;
cparata 0:69566eea0fba 3357
cparata 0:69566eea0fba 3358 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:69566eea0fba 3359 return MEMS_ERROR;
cparata 0:69566eea0fba 3360
cparata 0:69566eea0fba 3361 value &= ~LSM6DSL_ACC_GYRO_LPF2_XL_MASK;
cparata 0:69566eea0fba 3362 value |= newValue;
cparata 0:69566eea0fba 3363
cparata 0:69566eea0fba 3364 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:69566eea0fba 3365 return MEMS_ERROR;
cparata 0:69566eea0fba 3366
cparata 0:69566eea0fba 3367 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3368 }
cparata 0:69566eea0fba 3369
cparata 0:69566eea0fba 3370 /*******************************************************************************
cparata 0:69566eea0fba 3371 * Function Name : LSM6DSL_ACC_GYRO_R_LowPassFiltSel_XL
cparata 0:69566eea0fba 3372 * Description : Read LPF2_XL_EN
cparata 0:69566eea0fba 3373 * Input : Pointer to LSM6DSL_ACC_GYRO_LPF2_XL_t
cparata 0:69566eea0fba 3374 * Output : Status of LPF2_XL_EN see LSM6DSL_ACC_GYRO_LPF2_XL_t
cparata 0:69566eea0fba 3375 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3376 *******************************************************************************/
cparata 0:69566eea0fba 3377 status_t LSM6DSL_ACC_GYRO_R_LowPassFiltSel_XL(void *handle, LSM6DSL_ACC_GYRO_LPF2_XL_t *value)
cparata 0:69566eea0fba 3378 {
cparata 0:69566eea0fba 3379 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, (u8_t *)value, 1) )
cparata 0:69566eea0fba 3380 return MEMS_ERROR;
cparata 0:69566eea0fba 3381
cparata 0:69566eea0fba 3382 *value &= LSM6DSL_ACC_GYRO_LPF2_XL_MASK; //mask
cparata 0:69566eea0fba 3383
cparata 0:69566eea0fba 3384 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3385 }
cparata 0:69566eea0fba 3386
cparata 0:69566eea0fba 3387 /*******************************************************************************
cparata 0:69566eea0fba 3388 * Function Name : LSM6DSL_ACC_GYRO_W_LOW_PASS_ON_6D
cparata 0:69566eea0fba 3389 * Description : Write LOW_PASS_ON_6D
cparata 0:69566eea0fba 3390 * Input : LSM6DSL_ACC_GYRO_LOW_PASS_ON_6D_t
cparata 0:69566eea0fba 3391 * Output : None
cparata 0:69566eea0fba 3392 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3393 *******************************************************************************/
cparata 0:69566eea0fba 3394 status_t LSM6DSL_ACC_GYRO_W_LOW_PASS_ON_6D(void *handle, LSM6DSL_ACC_GYRO_LOW_PASS_ON_6D_t newValue)
cparata 0:69566eea0fba 3395 {
cparata 0:69566eea0fba 3396 u8_t value;
cparata 0:69566eea0fba 3397
cparata 0:69566eea0fba 3398 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:69566eea0fba 3399 return MEMS_ERROR;
cparata 0:69566eea0fba 3400
cparata 0:69566eea0fba 3401 value &= ~LSM6DSL_ACC_GYRO_LOW_PASS_ON_6D_MASK;
cparata 0:69566eea0fba 3402 value |= newValue;
cparata 0:69566eea0fba 3403
cparata 0:69566eea0fba 3404 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:69566eea0fba 3405 return MEMS_ERROR;
cparata 0:69566eea0fba 3406
cparata 0:69566eea0fba 3407 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3408 }
cparata 0:69566eea0fba 3409
cparata 0:69566eea0fba 3410 /*******************************************************************************
cparata 0:69566eea0fba 3411 * Function Name : LSM6DSL_ACC_GYRO_R_LOW_PASS_ON_6D
cparata 0:69566eea0fba 3412 * Description : Read LOW_PASS_ON_6D
cparata 0:69566eea0fba 3413 * Input : Pointer to LSM6DSL_ACC_GYRO_LOW_PASS_ON_6D_t
cparata 0:69566eea0fba 3414 * Output : Status of LOW_PASS_ON_6D see LSM6DSL_ACC_GYRO_LOW_PASS_ON_6D_t
cparata 0:69566eea0fba 3415 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3416 *******************************************************************************/
cparata 0:69566eea0fba 3417 status_t LSM6DSL_ACC_GYRO_R_LOW_PASS_ON_6D(void *handle, LSM6DSL_ACC_GYRO_LOW_PASS_ON_6D_t *value)
cparata 0:69566eea0fba 3418 {
cparata 0:69566eea0fba 3419 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, (u8_t *)value, 1) )
cparata 0:69566eea0fba 3420 return MEMS_ERROR;
cparata 0:69566eea0fba 3421
cparata 0:69566eea0fba 3422 *value &= LSM6DSL_ACC_GYRO_LOW_PASS_ON_6D_MASK; //mask
cparata 0:69566eea0fba 3423
cparata 0:69566eea0fba 3424 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3425 }
cparata 0:69566eea0fba 3426
cparata 0:69566eea0fba 3427 /*******************************************************************************
cparata 0:69566eea0fba 3428 * Function Name : LSM6DSL_ACC_GYRO_W_HP_SLOPE_XL
cparata 0:69566eea0fba 3429 * Description : Write HP_SLOPE_XL_EN
cparata 0:69566eea0fba 3430 * Input : LSM6DSL_ACC_GYRO_HP_SLOPE_XL_t
cparata 0:69566eea0fba 3431 * Output : None
cparata 0:69566eea0fba 3432 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3433 *******************************************************************************/
cparata 0:69566eea0fba 3434 status_t LSM6DSL_ACC_GYRO_W_HP_SLOPE_XL(void *handle, LSM6DSL_ACC_GYRO_HP_SLOPE_XL_t newValue)
cparata 0:69566eea0fba 3435 {
cparata 0:69566eea0fba 3436 u8_t value;
cparata 0:69566eea0fba 3437
cparata 0:69566eea0fba 3438 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:69566eea0fba 3439 return MEMS_ERROR;
cparata 0:69566eea0fba 3440
cparata 0:69566eea0fba 3441 value &= ~LSM6DSL_ACC_GYRO_HP_SLOPE_XL_MASK;
cparata 0:69566eea0fba 3442 value |= newValue;
cparata 0:69566eea0fba 3443
cparata 0:69566eea0fba 3444 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:69566eea0fba 3445 return MEMS_ERROR;
cparata 0:69566eea0fba 3446
cparata 0:69566eea0fba 3447 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3448 }
cparata 0:69566eea0fba 3449
cparata 0:69566eea0fba 3450 /*******************************************************************************
cparata 0:69566eea0fba 3451 * Function Name : LSM6DSL_ACC_GYRO_R_HP_SLOPE_XL
cparata 0:69566eea0fba 3452 * Description : Read HP_SLOPE_XL_EN
cparata 0:69566eea0fba 3453 * Input : Pointer to LSM6DSL_ACC_GYRO_HP_SLOPE_XL_t
cparata 0:69566eea0fba 3454 * Output : Status of HP_SLOPE_XL_EN see LSM6DSL_ACC_GYRO_HP_SLOPE_XL_t
cparata 0:69566eea0fba 3455 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3456 *******************************************************************************/
cparata 0:69566eea0fba 3457 status_t LSM6DSL_ACC_GYRO_R_HP_SLOPE_XL(void *handle, LSM6DSL_ACC_GYRO_HP_SLOPE_XL_t *value)
cparata 0:69566eea0fba 3458 {
cparata 0:69566eea0fba 3459 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, (u8_t *)value, 1) )
cparata 0:69566eea0fba 3460 return MEMS_ERROR;
cparata 0:69566eea0fba 3461
cparata 0:69566eea0fba 3462 *value &= LSM6DSL_ACC_GYRO_HP_SLOPE_XL_MASK; //mask
cparata 0:69566eea0fba 3463
cparata 0:69566eea0fba 3464 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3465 }
cparata 0:69566eea0fba 3466
cparata 0:69566eea0fba 3467 /*******************************************************************************
cparata 0:69566eea0fba 3468 * Function Name : LSM6DSL_ACC_GYRO_W_SOFT
cparata 0:69566eea0fba 3469 * Description : Write SOFT_EN
cparata 0:69566eea0fba 3470 * Input : LSM6DSL_ACC_GYRO_SOFT_t
cparata 0:69566eea0fba 3471 * Output : None
cparata 0:69566eea0fba 3472 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3473 *******************************************************************************/
cparata 0:69566eea0fba 3474 status_t LSM6DSL_ACC_GYRO_W_SOFT(void *handle, LSM6DSL_ACC_GYRO_SOFT_t newValue)
cparata 0:69566eea0fba 3475 {
cparata 0:69566eea0fba 3476 u8_t value;
cparata 0:69566eea0fba 3477
cparata 0:69566eea0fba 3478 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL9_XL, &value, 1) )
cparata 0:69566eea0fba 3479 return MEMS_ERROR;
cparata 0:69566eea0fba 3480
cparata 0:69566eea0fba 3481 value &= ~LSM6DSL_ACC_GYRO_SOFT_MASK;
cparata 0:69566eea0fba 3482 value |= newValue;
cparata 0:69566eea0fba 3483
cparata 0:69566eea0fba 3484 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL9_XL, &value, 1) )
cparata 0:69566eea0fba 3485 return MEMS_ERROR;
cparata 0:69566eea0fba 3486
cparata 0:69566eea0fba 3487 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3488 }
cparata 0:69566eea0fba 3489
cparata 0:69566eea0fba 3490 /*******************************************************************************
cparata 0:69566eea0fba 3491 * Function Name : LSM6DSL_ACC_GYRO_R_SOFT
cparata 0:69566eea0fba 3492 * Description : Read SOFT_EN
cparata 0:69566eea0fba 3493 * Input : Pointer to LSM6DSL_ACC_GYRO_SOFT_t
cparata 0:69566eea0fba 3494 * Output : Status of SOFT_EN see LSM6DSL_ACC_GYRO_SOFT_t
cparata 0:69566eea0fba 3495 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3496 *******************************************************************************/
cparata 0:69566eea0fba 3497 status_t LSM6DSL_ACC_GYRO_R_SOFT(void *handle, LSM6DSL_ACC_GYRO_SOFT_t *value)
cparata 0:69566eea0fba 3498 {
cparata 0:69566eea0fba 3499 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL9_XL, (u8_t *)value, 1) )
cparata 0:69566eea0fba 3500 return MEMS_ERROR;
cparata 0:69566eea0fba 3501
cparata 0:69566eea0fba 3502 *value &= LSM6DSL_ACC_GYRO_SOFT_MASK; //mask
cparata 0:69566eea0fba 3503
cparata 0:69566eea0fba 3504 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3505 }
cparata 0:69566eea0fba 3506
cparata 0:69566eea0fba 3507 /*******************************************************************************
cparata 0:69566eea0fba 3508 * Function Name : LSM6DSL_ACC_GYRO_W_SignifcantMotion
cparata 0:69566eea0fba 3509 * Description : Write SIGN_MOTION_EN
cparata 0:69566eea0fba 3510 * Input : LSM6DSL_ACC_GYRO_SIGN_MOTION_EN_t
cparata 0:69566eea0fba 3511 * Output : None
cparata 0:69566eea0fba 3512 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3513 *******************************************************************************/
cparata 0:69566eea0fba 3514 status_t LSM6DSL_ACC_GYRO_W_SignifcantMotion(void *handle, LSM6DSL_ACC_GYRO_SIGN_MOTION_EN_t newValue)
cparata 0:69566eea0fba 3515 {
cparata 0:69566eea0fba 3516 u8_t value;
cparata 0:69566eea0fba 3517
cparata 0:69566eea0fba 3518 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:69566eea0fba 3519 return MEMS_ERROR;
cparata 0:69566eea0fba 3520
cparata 0:69566eea0fba 3521 value &= ~LSM6DSL_ACC_GYRO_SIGN_MOTION_EN_MASK;
cparata 0:69566eea0fba 3522 value |= newValue;
cparata 0:69566eea0fba 3523
cparata 0:69566eea0fba 3524 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:69566eea0fba 3525 return MEMS_ERROR;
cparata 0:69566eea0fba 3526
cparata 0:69566eea0fba 3527 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3528 }
cparata 0:69566eea0fba 3529
cparata 0:69566eea0fba 3530 /*******************************************************************************
cparata 0:69566eea0fba 3531 * Function Name : LSM6DSL_ACC_GYRO_R_SignifcantMotion
cparata 0:69566eea0fba 3532 * Description : Read SIGN_MOTION_EN
cparata 0:69566eea0fba 3533 * Input : Pointer to LSM6DSL_ACC_GYRO_SIGN_MOTION_EN_t
cparata 0:69566eea0fba 3534 * Output : Status of SIGN_MOTION_EN see LSM6DSL_ACC_GYRO_SIGN_MOTION_EN_t
cparata 0:69566eea0fba 3535 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3536 *******************************************************************************/
cparata 0:69566eea0fba 3537 status_t LSM6DSL_ACC_GYRO_R_SignifcantMotion(void *handle, LSM6DSL_ACC_GYRO_SIGN_MOTION_EN_t *value)
cparata 0:69566eea0fba 3538 {
cparata 0:69566eea0fba 3539 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, (u8_t *)value, 1) )
cparata 0:69566eea0fba 3540 return MEMS_ERROR;
cparata 0:69566eea0fba 3541
cparata 0:69566eea0fba 3542 *value &= LSM6DSL_ACC_GYRO_SIGN_MOTION_EN_MASK; //mask
cparata 0:69566eea0fba 3543
cparata 0:69566eea0fba 3544 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3545 }
cparata 0:69566eea0fba 3546 /*******************************************************************************
cparata 0:69566eea0fba 3547 * Function Name : LSM6DSL_ACC_GYRO_W_PedoStepReset
cparata 0:69566eea0fba 3548 * Description : Write PEDO_RST_STEP
cparata 0:69566eea0fba 3549 * Input : LSM6DSL_ACC_GYRO_PEDO_RST_STEP_t
cparata 0:69566eea0fba 3550 * Output : None
cparata 0:69566eea0fba 3551 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3552 *******************************************************************************/
cparata 0:69566eea0fba 3553 status_t LSM6DSL_ACC_GYRO_W_PedoStepReset(void *handle, LSM6DSL_ACC_GYRO_PEDO_RST_STEP_t newValue)
cparata 0:69566eea0fba 3554 {
cparata 0:69566eea0fba 3555 u8_t value;
cparata 0:69566eea0fba 3556
cparata 0:69566eea0fba 3557 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:69566eea0fba 3558 return MEMS_ERROR;
cparata 0:69566eea0fba 3559
cparata 0:69566eea0fba 3560 value &= ~LSM6DSL_ACC_GYRO_PEDO_RST_STEP_MASK;
cparata 0:69566eea0fba 3561 value |= newValue;
cparata 0:69566eea0fba 3562
cparata 0:69566eea0fba 3563 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:69566eea0fba 3564 return MEMS_ERROR;
cparata 0:69566eea0fba 3565
cparata 0:69566eea0fba 3566 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3567 }
cparata 0:69566eea0fba 3568
cparata 0:69566eea0fba 3569 /*******************************************************************************
cparata 0:69566eea0fba 3570 * Function Name : LSM6DSL_ACC_GYRO_R_PedoStepReset
cparata 0:69566eea0fba 3571 * Description : Read PEDO_RST_STEP
cparata 0:69566eea0fba 3572 * Input : Pointer to LSM6DSL_ACC_GYRO_PEDO_RST_STEP_t
cparata 0:69566eea0fba 3573 * Output : Status of PEDO_RST_STEP see LSM6DSL_ACC_GYRO_PEDO_RST_STEP_t
cparata 0:69566eea0fba 3574 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3575 *******************************************************************************/
cparata 0:69566eea0fba 3576 status_t LSM6DSL_ACC_GYRO_R_PedoStepReset(void *handle, LSM6DSL_ACC_GYRO_PEDO_RST_STEP_t *value)
cparata 0:69566eea0fba 3577 {
cparata 0:69566eea0fba 3578 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, (u8_t *)value, 1) )
cparata 0:69566eea0fba 3579 return MEMS_ERROR;
cparata 0:69566eea0fba 3580
cparata 0:69566eea0fba 3581 *value &= LSM6DSL_ACC_GYRO_PEDO_RST_STEP_MASK; //mask
cparata 0:69566eea0fba 3582
cparata 0:69566eea0fba 3583 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3584 }
cparata 0:69566eea0fba 3585 /*******************************************************************************
cparata 0:69566eea0fba 3586 * Function Name : LSM6DSL_ACC_GYRO_W_TILT
cparata 0:69566eea0fba 3587 * Description : Write XEN_G
cparata 0:69566eea0fba 3588 * Input : LSM6DSL_ACC_GYRO_TILT_G_t
cparata 0:69566eea0fba 3589 * Output : None
cparata 0:69566eea0fba 3590 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3591 *******************************************************************************/
cparata 0:69566eea0fba 3592 status_t LSM6DSL_ACC_GYRO_W_TILT(void *handle, LSM6DSL_ACC_GYRO_TILT_G_t newValue)
cparata 0:69566eea0fba 3593 {
cparata 0:69566eea0fba 3594 u8_t value;
cparata 0:69566eea0fba 3595
cparata 0:69566eea0fba 3596 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:69566eea0fba 3597 return MEMS_ERROR;
cparata 0:69566eea0fba 3598
cparata 0:69566eea0fba 3599 value &= ~LSM6DSL_ACC_GYRO_TILT_MASK;
cparata 0:69566eea0fba 3600 value |= newValue;
cparata 0:69566eea0fba 3601
cparata 0:69566eea0fba 3602 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:69566eea0fba 3603 return MEMS_ERROR;
cparata 0:69566eea0fba 3604
cparata 0:69566eea0fba 3605 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3606 }
cparata 0:69566eea0fba 3607
cparata 0:69566eea0fba 3608 /*******************************************************************************
cparata 0:69566eea0fba 3609 * Function Name : LSM6DSL_ACC_GYRO_R_TILT
cparata 0:69566eea0fba 3610 * Description : Read XEN_G
cparata 0:69566eea0fba 3611 * Input : Pointer to LSM6DSL_ACC_GYRO_TILT_G_t
cparata 0:69566eea0fba 3612 * Output : Status of XEN_G see LSM6DSL_ACC_GYRO_TILT_G_t
cparata 0:69566eea0fba 3613 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3614 *******************************************************************************/
cparata 0:69566eea0fba 3615 status_t LSM6DSL_ACC_GYRO_R_TILT(void *handle, LSM6DSL_ACC_GYRO_TILT_G_t *value)
cparata 0:69566eea0fba 3616 {
cparata 0:69566eea0fba 3617 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, (u8_t *)value, 1) )
cparata 0:69566eea0fba 3618 return MEMS_ERROR;
cparata 0:69566eea0fba 3619
cparata 0:69566eea0fba 3620 *value &= LSM6DSL_ACC_GYRO_TILT_MASK; //mask
cparata 0:69566eea0fba 3621
cparata 0:69566eea0fba 3622 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3623 }
cparata 0:69566eea0fba 3624 /*******************************************************************************
cparata 0:69566eea0fba 3625 * Function Name : LSM6DSL_ACC_GYRO_W_PEDO
cparata 0:69566eea0fba 3626 * Description : Write PEDO_EN
cparata 0:69566eea0fba 3627 * Input : LSM6DSL_ACC_GYRO_PEDO_t
cparata 0:69566eea0fba 3628 * Output : None
cparata 0:69566eea0fba 3629 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3630 *******************************************************************************/
cparata 0:69566eea0fba 3631 status_t LSM6DSL_ACC_GYRO_W_PEDO(void *handle, LSM6DSL_ACC_GYRO_PEDO_t newValue)
cparata 0:69566eea0fba 3632 {
cparata 0:69566eea0fba 3633 u8_t value;
cparata 0:69566eea0fba 3634
cparata 0:69566eea0fba 3635 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:69566eea0fba 3636 return MEMS_ERROR;
cparata 0:69566eea0fba 3637
cparata 0:69566eea0fba 3638 value &= ~LSM6DSL_ACC_GYRO_PEDO_MASK;
cparata 0:69566eea0fba 3639 value |= newValue;
cparata 0:69566eea0fba 3640
cparata 0:69566eea0fba 3641 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:69566eea0fba 3642 return MEMS_ERROR;
cparata 0:69566eea0fba 3643
cparata 0:69566eea0fba 3644 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3645 }
cparata 0:69566eea0fba 3646
cparata 0:69566eea0fba 3647 /*******************************************************************************
cparata 0:69566eea0fba 3648 * Function Name : LSM6DSL_ACC_GYRO_R_PEDO
cparata 0:69566eea0fba 3649 * Description : Read PEDO_EN
cparata 0:69566eea0fba 3650 * Input : Pointer to LSM6DSL_ACC_GYRO_PEDO_t
cparata 0:69566eea0fba 3651 * Output : Status of PEDO_EN see LSM6DSL_ACC_GYRO_PEDO_t
cparata 0:69566eea0fba 3652 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3653 *******************************************************************************/
cparata 0:69566eea0fba 3654 status_t LSM6DSL_ACC_GYRO_R_PEDO(void *handle, LSM6DSL_ACC_GYRO_PEDO_t *value)
cparata 0:69566eea0fba 3655 {
cparata 0:69566eea0fba 3656 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, (u8_t *)value, 1) )
cparata 0:69566eea0fba 3657 return MEMS_ERROR;
cparata 0:69566eea0fba 3658
cparata 0:69566eea0fba 3659 *value &= LSM6DSL_ACC_GYRO_PEDO_MASK; //mask
cparata 0:69566eea0fba 3660
cparata 0:69566eea0fba 3661 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3662 }
cparata 0:69566eea0fba 3663
cparata 0:69566eea0fba 3664 /*******************************************************************************
cparata 0:69566eea0fba 3665 * Function Name : LSM6DSL_ACC_GYRO_W_TIMER
cparata 0:69566eea0fba 3666 * Description : Write TIMER_EN
cparata 0:69566eea0fba 3667 * Input : LSM6DSL_ACC_GYRO_TIMER_t
cparata 0:69566eea0fba 3668 * Output : None
cparata 0:69566eea0fba 3669 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3670 *******************************************************************************/
cparata 0:69566eea0fba 3671 status_t LSM6DSL_ACC_GYRO_W_TIMER(void *handle, LSM6DSL_ACC_GYRO_TIMER_t newValue)
cparata 0:69566eea0fba 3672 {
cparata 0:69566eea0fba 3673 u8_t value;
cparata 0:69566eea0fba 3674
cparata 0:69566eea0fba 3675 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:69566eea0fba 3676 return MEMS_ERROR;
cparata 0:69566eea0fba 3677
cparata 0:69566eea0fba 3678 value &= ~LSM6DSL_ACC_GYRO_TIMER_MASK;
cparata 0:69566eea0fba 3679 value |= newValue;
cparata 0:69566eea0fba 3680
cparata 0:69566eea0fba 3681 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:69566eea0fba 3682 return MEMS_ERROR;
cparata 0:69566eea0fba 3683
cparata 0:69566eea0fba 3684 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3685 }
cparata 0:69566eea0fba 3686
cparata 0:69566eea0fba 3687 /*******************************************************************************
cparata 0:69566eea0fba 3688 * Function Name : LSM6DSL_ACC_GYRO_R_TIMER
cparata 0:69566eea0fba 3689 * Description : Read TIMER_EN
cparata 0:69566eea0fba 3690 * Input : Pointer to LSM6DSL_ACC_GYRO_TIMER_t
cparata 0:69566eea0fba 3691 * Output : Status of TIMER_EN see LSM6DSL_ACC_GYRO_TIMER_t
cparata 0:69566eea0fba 3692 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3693 *******************************************************************************/
cparata 0:69566eea0fba 3694 status_t LSM6DSL_ACC_GYRO_R_TIMER(void *handle, LSM6DSL_ACC_GYRO_TIMER_t *value)
cparata 0:69566eea0fba 3695 {
cparata 0:69566eea0fba 3696 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, (u8_t *)value, 1) )
cparata 0:69566eea0fba 3697 return MEMS_ERROR;
cparata 0:69566eea0fba 3698
cparata 0:69566eea0fba 3699 *value &= LSM6DSL_ACC_GYRO_TIMER_MASK; //mask
cparata 0:69566eea0fba 3700
cparata 0:69566eea0fba 3701 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3702 }
cparata 0:69566eea0fba 3703
cparata 0:69566eea0fba 3704 /*******************************************************************************
cparata 0:69566eea0fba 3705 * Function Name : LSM6DSL_ACC_GYRO_W_FUNC_EN
cparata 0:69566eea0fba 3706 * Description : Write FUNC_EN
cparata 0:69566eea0fba 3707 * Input : LSM6DSL_ACC_GYRO_FUNC_EN_t
cparata 0:69566eea0fba 3708 * Output : None
cparata 0:69566eea0fba 3709 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3710 *******************************************************************************/
cparata 0:69566eea0fba 3711 status_t LSM6DSL_ACC_GYRO_W_FUNC_EN(void *handle, LSM6DSL_ACC_GYRO_FUNC_EN_t newValue)
cparata 0:69566eea0fba 3712 {
cparata 0:69566eea0fba 3713 u8_t value;
cparata 0:69566eea0fba 3714
cparata 0:69566eea0fba 3715 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:69566eea0fba 3716 return MEMS_ERROR;
cparata 0:69566eea0fba 3717
cparata 0:69566eea0fba 3718 value &= ~LSM6DSL_ACC_GYRO_FUNC_EN_MASK;
cparata 0:69566eea0fba 3719 value |= newValue;
cparata 0:69566eea0fba 3720
cparata 0:69566eea0fba 3721 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:69566eea0fba 3722 return MEMS_ERROR;
cparata 0:69566eea0fba 3723
cparata 0:69566eea0fba 3724 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3725 }
cparata 0:69566eea0fba 3726
cparata 0:69566eea0fba 3727 /*******************************************************************************
cparata 0:69566eea0fba 3728 * Function Name : LSM6DSL_ACC_GYRO_R_FUNC_EN
cparata 0:69566eea0fba 3729 * Description : Read FUNC_EN
cparata 0:69566eea0fba 3730 * Input : Pointer to LSM6DSL_ACC_GYRO_FUNC_EN_t
cparata 0:69566eea0fba 3731 * Output : Status of FUNC_EN see LSM6DSL_ACC_GYRO_FUNC_EN_t
cparata 0:69566eea0fba 3732 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3733 *******************************************************************************/
cparata 0:69566eea0fba 3734 status_t LSM6DSL_ACC_GYRO_R_FUNC_EN(void *handle, LSM6DSL_ACC_GYRO_FUNC_EN_t *value)
cparata 0:69566eea0fba 3735 {
cparata 0:69566eea0fba 3736 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, (u8_t *)value, 1) )
cparata 0:69566eea0fba 3737 return MEMS_ERROR;
cparata 0:69566eea0fba 3738
cparata 0:69566eea0fba 3739 *value &= LSM6DSL_ACC_GYRO_FUNC_EN_MASK; //mask
cparata 0:69566eea0fba 3740
cparata 0:69566eea0fba 3741 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3742 }
cparata 0:69566eea0fba 3743
cparata 0:69566eea0fba 3744 /*******************************************************************************
cparata 0:69566eea0fba 3745 * Function Name : LSM6DSL_ACC_GYRO_W_I2C_MASTER_Enable
cparata 0:69566eea0fba 3746 * Description : Write MASTER_ON
cparata 0:69566eea0fba 3747 * Input : LSM6DSL_ACC_GYRO_MASTER_ON_t
cparata 0:69566eea0fba 3748 * Output : None
cparata 0:69566eea0fba 3749 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3750 *******************************************************************************/
cparata 0:69566eea0fba 3751 status_t LSM6DSL_ACC_GYRO_W_I2C_MASTER_Enable(void *handle, LSM6DSL_ACC_GYRO_MASTER_ON_t newValue)
cparata 0:69566eea0fba 3752 {
cparata 0:69566eea0fba 3753 u8_t value;
cparata 0:69566eea0fba 3754
cparata 0:69566eea0fba 3755 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:69566eea0fba 3756 return MEMS_ERROR;
cparata 0:69566eea0fba 3757
cparata 0:69566eea0fba 3758 value &= ~LSM6DSL_ACC_GYRO_MASTER_ON_MASK;
cparata 0:69566eea0fba 3759 value |= newValue;
cparata 0:69566eea0fba 3760
cparata 0:69566eea0fba 3761 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:69566eea0fba 3762 return MEMS_ERROR;
cparata 0:69566eea0fba 3763
cparata 0:69566eea0fba 3764 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3765 }
cparata 0:69566eea0fba 3766
cparata 0:69566eea0fba 3767 /*******************************************************************************
cparata 0:69566eea0fba 3768 * Function Name : LSM6DSL_ACC_GYRO_R_I2C_MASTER_Enable
cparata 0:69566eea0fba 3769 * Description : Read MASTER_ON
cparata 0:69566eea0fba 3770 * Input : Pointer to LSM6DSL_ACC_GYRO_MASTER_ON_t
cparata 0:69566eea0fba 3771 * Output : Status of MASTER_ON see LSM6DSL_ACC_GYRO_MASTER_ON_t
cparata 0:69566eea0fba 3772 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3773 *******************************************************************************/
cparata 0:69566eea0fba 3774 status_t LSM6DSL_ACC_GYRO_R_I2C_MASTER_Enable(void *handle, LSM6DSL_ACC_GYRO_MASTER_ON_t *value)
cparata 0:69566eea0fba 3775 {
cparata 0:69566eea0fba 3776 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, (u8_t *)value, 1) )
cparata 0:69566eea0fba 3777 return MEMS_ERROR;
cparata 0:69566eea0fba 3778
cparata 0:69566eea0fba 3779 *value &= LSM6DSL_ACC_GYRO_MASTER_ON_MASK; //mask
cparata 0:69566eea0fba 3780
cparata 0:69566eea0fba 3781 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3782 }
cparata 0:69566eea0fba 3783
cparata 0:69566eea0fba 3784 /*******************************************************************************
cparata 0:69566eea0fba 3785 * Function Name : LSM6DSL_ACC_GYRO_W_IronCorrection_EN
cparata 0:69566eea0fba 3786 * Description : Write IRON_EN
cparata 0:69566eea0fba 3787 * Input : LSM6DSL_ACC_GYRO_IRON_EN_t
cparata 0:69566eea0fba 3788 * Output : None
cparata 0:69566eea0fba 3789 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3790 *******************************************************************************/
cparata 0:69566eea0fba 3791 status_t LSM6DSL_ACC_GYRO_W_IronCorrection_EN(void *handle, LSM6DSL_ACC_GYRO_IRON_EN_t newValue)
cparata 0:69566eea0fba 3792 {
cparata 0:69566eea0fba 3793 u8_t value;
cparata 0:69566eea0fba 3794
cparata 0:69566eea0fba 3795 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:69566eea0fba 3796 return MEMS_ERROR;
cparata 0:69566eea0fba 3797
cparata 0:69566eea0fba 3798 value &= ~LSM6DSL_ACC_GYRO_IRON_EN_MASK;
cparata 0:69566eea0fba 3799 value |= newValue;
cparata 0:69566eea0fba 3800
cparata 0:69566eea0fba 3801 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:69566eea0fba 3802 return MEMS_ERROR;
cparata 0:69566eea0fba 3803
cparata 0:69566eea0fba 3804 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3805 }
cparata 0:69566eea0fba 3806
cparata 0:69566eea0fba 3807 /*******************************************************************************
cparata 0:69566eea0fba 3808 * Function Name : LSM6DSL_ACC_GYRO_R_IronCorrection_EN
cparata 0:69566eea0fba 3809 * Description : Read IRON_EN
cparata 0:69566eea0fba 3810 * Input : Pointer to LSM6DSL_ACC_GYRO_IRON_EN_t
cparata 0:69566eea0fba 3811 * Output : Status of IRON_EN see LSM6DSL_ACC_GYRO_IRON_EN_t
cparata 0:69566eea0fba 3812 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3813 *******************************************************************************/
cparata 0:69566eea0fba 3814 status_t LSM6DSL_ACC_GYRO_R_IronCorrection_EN(void *handle, LSM6DSL_ACC_GYRO_IRON_EN_t *value)
cparata 0:69566eea0fba 3815 {
cparata 0:69566eea0fba 3816 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, (u8_t *)value, 1) )
cparata 0:69566eea0fba 3817 return MEMS_ERROR;
cparata 0:69566eea0fba 3818
cparata 0:69566eea0fba 3819 *value &= LSM6DSL_ACC_GYRO_IRON_EN_MASK; //mask
cparata 0:69566eea0fba 3820
cparata 0:69566eea0fba 3821 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3822 }
cparata 0:69566eea0fba 3823
cparata 0:69566eea0fba 3824 /*******************************************************************************
cparata 0:69566eea0fba 3825 * Function Name : LSM6DSL_ACC_GYRO_W_PASS_THRU_MODE
cparata 0:69566eea0fba 3826 * Description : Write PASS_THRU_MODE
cparata 0:69566eea0fba 3827 * Input : LSM6DSL_ACC_GYRO_PASS_THRU_MODE_t
cparata 0:69566eea0fba 3828 * Output : None
cparata 0:69566eea0fba 3829 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3830 *******************************************************************************/
cparata 0:69566eea0fba 3831 status_t LSM6DSL_ACC_GYRO_W_PASS_THRU_MODE(void *handle, LSM6DSL_ACC_GYRO_PASS_THRU_MODE_t newValue)
cparata 0:69566eea0fba 3832 {
cparata 0:69566eea0fba 3833 u8_t value;
cparata 0:69566eea0fba 3834
cparata 0:69566eea0fba 3835 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:69566eea0fba 3836 return MEMS_ERROR;
cparata 0:69566eea0fba 3837
cparata 0:69566eea0fba 3838 value &= ~LSM6DSL_ACC_GYRO_PASS_THRU_MODE_MASK;
cparata 0:69566eea0fba 3839 value |= newValue;
cparata 0:69566eea0fba 3840
cparata 0:69566eea0fba 3841 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:69566eea0fba 3842 return MEMS_ERROR;
cparata 0:69566eea0fba 3843
cparata 0:69566eea0fba 3844 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3845 }
cparata 0:69566eea0fba 3846
cparata 0:69566eea0fba 3847 /*******************************************************************************
cparata 0:69566eea0fba 3848 * Function Name : LSM6DSL_ACC_GYRO_R_PASS_THRU_MODE
cparata 0:69566eea0fba 3849 * Description : Read PASS_THRU_MODE
cparata 0:69566eea0fba 3850 * Input : Pointer to LSM6DSL_ACC_GYRO_PASS_THRU_MODE_t
cparata 0:69566eea0fba 3851 * Output : Status of PASS_THRU_MODE see LSM6DSL_ACC_GYRO_PASS_THRU_MODE_t
cparata 0:69566eea0fba 3852 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3853 *******************************************************************************/
cparata 0:69566eea0fba 3854 status_t LSM6DSL_ACC_GYRO_R_PASS_THRU_MODE(void *handle, LSM6DSL_ACC_GYRO_PASS_THRU_MODE_t *value)
cparata 0:69566eea0fba 3855 {
cparata 0:69566eea0fba 3856 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, (u8_t *)value, 1) )
cparata 0:69566eea0fba 3857 return MEMS_ERROR;
cparata 0:69566eea0fba 3858
cparata 0:69566eea0fba 3859 *value &= LSM6DSL_ACC_GYRO_PASS_THRU_MODE_MASK; //mask
cparata 0:69566eea0fba 3860
cparata 0:69566eea0fba 3861 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3862 }
cparata 0:69566eea0fba 3863
cparata 0:69566eea0fba 3864 /*******************************************************************************
cparata 0:69566eea0fba 3865 * Function Name : LSM6DSL_ACC_GYRO_W_PULL_UP_EN
cparata 0:69566eea0fba 3866 * Description : Write PULL_UP_EN
cparata 0:69566eea0fba 3867 * Input : LSM6DSL_ACC_GYRO_PULL_UP_EN_t
cparata 0:69566eea0fba 3868 * Output : None
cparata 0:69566eea0fba 3869 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3870 *******************************************************************************/
cparata 0:69566eea0fba 3871 status_t LSM6DSL_ACC_GYRO_W_PULL_UP_EN(void *handle, LSM6DSL_ACC_GYRO_PULL_UP_EN_t newValue)
cparata 0:69566eea0fba 3872 {
cparata 0:69566eea0fba 3873 u8_t value;
cparata 0:69566eea0fba 3874
cparata 0:69566eea0fba 3875 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:69566eea0fba 3876 return MEMS_ERROR;
cparata 0:69566eea0fba 3877
cparata 0:69566eea0fba 3878 value &= ~LSM6DSL_ACC_GYRO_PULL_UP_EN_MASK;
cparata 0:69566eea0fba 3879 value |= newValue;
cparata 0:69566eea0fba 3880
cparata 0:69566eea0fba 3881 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:69566eea0fba 3882 return MEMS_ERROR;
cparata 0:69566eea0fba 3883
cparata 0:69566eea0fba 3884 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3885 }
cparata 0:69566eea0fba 3886
cparata 0:69566eea0fba 3887 /*******************************************************************************
cparata 0:69566eea0fba 3888 * Function Name : LSM6DSL_ACC_GYRO_R_PULL_UP_EN
cparata 0:69566eea0fba 3889 * Description : Read PULL_UP_EN
cparata 0:69566eea0fba 3890 * Input : Pointer to LSM6DSL_ACC_GYRO_PULL_UP_EN_t
cparata 0:69566eea0fba 3891 * Output : Status of PULL_UP_EN see LSM6DSL_ACC_GYRO_PULL_UP_EN_t
cparata 0:69566eea0fba 3892 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3893 *******************************************************************************/
cparata 0:69566eea0fba 3894 status_t LSM6DSL_ACC_GYRO_R_PULL_UP_EN(void *handle, LSM6DSL_ACC_GYRO_PULL_UP_EN_t *value)
cparata 0:69566eea0fba 3895 {
cparata 0:69566eea0fba 3896 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, (u8_t *)value, 1) )
cparata 0:69566eea0fba 3897 return MEMS_ERROR;
cparata 0:69566eea0fba 3898
cparata 0:69566eea0fba 3899 *value &= LSM6DSL_ACC_GYRO_PULL_UP_EN_MASK; //mask
cparata 0:69566eea0fba 3900
cparata 0:69566eea0fba 3901 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3902 }
cparata 0:69566eea0fba 3903
cparata 0:69566eea0fba 3904 /*******************************************************************************
cparata 0:69566eea0fba 3905 * Function Name : LSM6DSL_ACC_GYRO_W_SensorHUB_Trigger_Sel
cparata 0:69566eea0fba 3906 * Description : Write START_CONFIG
cparata 0:69566eea0fba 3907 * Input : LSM6DSL_ACC_GYRO_START_CONFIG_t
cparata 0:69566eea0fba 3908 * Output : None
cparata 0:69566eea0fba 3909 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3910 *******************************************************************************/
cparata 0:69566eea0fba 3911 status_t LSM6DSL_ACC_GYRO_W_SensorHUB_Trigger_Sel(void *handle, LSM6DSL_ACC_GYRO_START_CONFIG_t newValue)
cparata 0:69566eea0fba 3912 {
cparata 0:69566eea0fba 3913 u8_t value;
cparata 0:69566eea0fba 3914
cparata 0:69566eea0fba 3915 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:69566eea0fba 3916 return MEMS_ERROR;
cparata 0:69566eea0fba 3917
cparata 0:69566eea0fba 3918 value &= ~LSM6DSL_ACC_GYRO_START_CONFIG_MASK;
cparata 0:69566eea0fba 3919 value |= newValue;
cparata 0:69566eea0fba 3920
cparata 0:69566eea0fba 3921 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:69566eea0fba 3922 return MEMS_ERROR;
cparata 0:69566eea0fba 3923
cparata 0:69566eea0fba 3924 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3925 }
cparata 0:69566eea0fba 3926
cparata 0:69566eea0fba 3927 /*******************************************************************************
cparata 0:69566eea0fba 3928 * Function Name : LSM6DSL_ACC_GYRO_R_SensorHUB_Trigger_Sel
cparata 0:69566eea0fba 3929 * Description : Read START_CONFIG
cparata 0:69566eea0fba 3930 * Input : Pointer to LSM6DSL_ACC_GYRO_START_CONFIG_t
cparata 0:69566eea0fba 3931 * Output : Status of START_CONFIG see LSM6DSL_ACC_GYRO_START_CONFIG_t
cparata 0:69566eea0fba 3932 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3933 *******************************************************************************/
cparata 0:69566eea0fba 3934 status_t LSM6DSL_ACC_GYRO_R_SensorHUB_Trigger_Sel(void *handle, LSM6DSL_ACC_GYRO_START_CONFIG_t *value)
cparata 0:69566eea0fba 3935 {
cparata 0:69566eea0fba 3936 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, (u8_t *)value, 1) )
cparata 0:69566eea0fba 3937 return MEMS_ERROR;
cparata 0:69566eea0fba 3938
cparata 0:69566eea0fba 3939 *value &= LSM6DSL_ACC_GYRO_START_CONFIG_MASK; //mask
cparata 0:69566eea0fba 3940
cparata 0:69566eea0fba 3941 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3942 }
cparata 0:69566eea0fba 3943
cparata 0:69566eea0fba 3944 /*******************************************************************************
cparata 0:69566eea0fba 3945 * Function Name : LSM6DSL_ACC_GYRO_W_DATA_VAL_SEL_FIFO
cparata 0:69566eea0fba 3946 * Description : Write DATA_VAL_SEL_FIFO
cparata 0:69566eea0fba 3947 * Input : LSM6DSL_ACC_GYRO_DATA_VAL_SEL_FIFO_t
cparata 0:69566eea0fba 3948 * Output : None
cparata 0:69566eea0fba 3949 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3950 *******************************************************************************/
cparata 0:69566eea0fba 3951 status_t LSM6DSL_ACC_GYRO_W_DATA_VAL_SEL_FIFO(void *handle, LSM6DSL_ACC_GYRO_DATA_VAL_SEL_FIFO_t newValue)
cparata 0:69566eea0fba 3952 {
cparata 0:69566eea0fba 3953 u8_t value;
cparata 0:69566eea0fba 3954
cparata 0:69566eea0fba 3955 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:69566eea0fba 3956 return MEMS_ERROR;
cparata 0:69566eea0fba 3957
cparata 0:69566eea0fba 3958 value &= ~LSM6DSL_ACC_GYRO_DATA_VAL_SEL_FIFO_MASK;
cparata 0:69566eea0fba 3959 value |= newValue;
cparata 0:69566eea0fba 3960
cparata 0:69566eea0fba 3961 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:69566eea0fba 3962 return MEMS_ERROR;
cparata 0:69566eea0fba 3963
cparata 0:69566eea0fba 3964 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3965 }
cparata 0:69566eea0fba 3966
cparata 0:69566eea0fba 3967 /*******************************************************************************
cparata 0:69566eea0fba 3968 * Function Name : LSM6DSL_ACC_GYRO_R_DATA_VAL_SEL_FIFO
cparata 0:69566eea0fba 3969 * Description : Read DATA_VAL_SEL_FIFO
cparata 0:69566eea0fba 3970 * Input : Pointer to LSM6DSL_ACC_GYRO_DATA_VAL_SEL_FIFO_t
cparata 0:69566eea0fba 3971 * Output : Status of DATA_VAL_SEL_FIFO see LSM6DSL_ACC_GYRO_DATA_VAL_SEL_FIFO_t
cparata 0:69566eea0fba 3972 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3973 *******************************************************************************/
cparata 0:69566eea0fba 3974 status_t LSM6DSL_ACC_GYRO_R_DATA_VAL_SEL_FIFO(void *handle, LSM6DSL_ACC_GYRO_DATA_VAL_SEL_FIFO_t *value)
cparata 0:69566eea0fba 3975 {
cparata 0:69566eea0fba 3976 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, (u8_t *)value, 1) )
cparata 0:69566eea0fba 3977 return MEMS_ERROR;
cparata 0:69566eea0fba 3978
cparata 0:69566eea0fba 3979 *value &= LSM6DSL_ACC_GYRO_DATA_VAL_SEL_FIFO_MASK; //mask
cparata 0:69566eea0fba 3980
cparata 0:69566eea0fba 3981 return MEMS_SUCCESS;
cparata 0:69566eea0fba 3982 }
cparata 0:69566eea0fba 3983
cparata 0:69566eea0fba 3984 /*******************************************************************************
cparata 0:69566eea0fba 3985 * Function Name : LSM6DSL_ACC_GYRO_W_DRDY_ON_INT1
cparata 0:69566eea0fba 3986 * Description : Write DRDY_ON_INT1
cparata 0:69566eea0fba 3987 * Input : LSM6DSL_ACC_GYRO_DRDY_ON_INT1_t
cparata 0:69566eea0fba 3988 * Output : None
cparata 0:69566eea0fba 3989 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 3990 *******************************************************************************/
cparata 0:69566eea0fba 3991 status_t LSM6DSL_ACC_GYRO_W_DRDY_ON_INT1(void *handle, LSM6DSL_ACC_GYRO_DRDY_ON_INT1_t newValue)
cparata 0:69566eea0fba 3992 {
cparata 0:69566eea0fba 3993 u8_t value;
cparata 0:69566eea0fba 3994
cparata 0:69566eea0fba 3995 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:69566eea0fba 3996 return MEMS_ERROR;
cparata 0:69566eea0fba 3997
cparata 0:69566eea0fba 3998 value &= ~LSM6DSL_ACC_GYRO_DRDY_ON_INT1_MASK;
cparata 0:69566eea0fba 3999 value |= newValue;
cparata 0:69566eea0fba 4000
cparata 0:69566eea0fba 4001 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:69566eea0fba 4002 return MEMS_ERROR;
cparata 0:69566eea0fba 4003
cparata 0:69566eea0fba 4004 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4005 }
cparata 0:69566eea0fba 4006 /*******************************************************************************
cparata 0:69566eea0fba 4007 * Function Name : LSM6DSL_ACC_GYRO_R_DRDY_ON_INT1
cparata 0:69566eea0fba 4008 * Description : Read DRDY_ON_INT1
cparata 0:69566eea0fba 4009 * Input : Pointer to LSM6DSL_ACC_GYRO_DRDY_ON_INT1_t
cparata 0:69566eea0fba 4010 * Output : Status of DRDY_ON_INT1 see LSM6DSL_ACC_GYRO_DRDY_ON_INT1_t
cparata 0:69566eea0fba 4011 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4012 *******************************************************************************/
cparata 0:69566eea0fba 4013 status_t LSM6DSL_ACC_GYRO_R_DRDY_ON_INT1(void *handle, LSM6DSL_ACC_GYRO_DRDY_ON_INT1_t *value)
cparata 0:69566eea0fba 4014 {
cparata 0:69566eea0fba 4015 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4016 return MEMS_ERROR;
cparata 0:69566eea0fba 4017
cparata 0:69566eea0fba 4018 *value &= LSM6DSL_ACC_GYRO_DRDY_ON_INT1_MASK; //mask
cparata 0:69566eea0fba 4019
cparata 0:69566eea0fba 4020 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4021 }
cparata 0:69566eea0fba 4022
cparata 0:69566eea0fba 4023 /*******************************************************************************
cparata 0:69566eea0fba 4024 * Function Name : LSM6DSL_ACC_GYRO_R_Z_WU
cparata 0:69566eea0fba 4025 * Description : Read Z_WU
cparata 0:69566eea0fba 4026 * Input : Pointer to LSM6DSL_ACC_GYRO_Z_WU_t
cparata 0:69566eea0fba 4027 * Output : Status of Z_WU see LSM6DSL_ACC_GYRO_Z_WU_t
cparata 0:69566eea0fba 4028 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4029 *******************************************************************************/
cparata 0:69566eea0fba 4030 status_t LSM6DSL_ACC_GYRO_R_Z_WU(void *handle, LSM6DSL_ACC_GYRO_Z_WU_t *value)
cparata 0:69566eea0fba 4031 {
cparata 0:69566eea0fba 4032 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4033 return MEMS_ERROR;
cparata 0:69566eea0fba 4034
cparata 0:69566eea0fba 4035 *value &= LSM6DSL_ACC_GYRO_Z_WU_MASK; //mask
cparata 0:69566eea0fba 4036
cparata 0:69566eea0fba 4037 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4038 }
cparata 0:69566eea0fba 4039
cparata 0:69566eea0fba 4040 /*******************************************************************************
cparata 0:69566eea0fba 4041 * Function Name : LSM6DSL_ACC_GYRO_R_Y_WU
cparata 0:69566eea0fba 4042 * Description : Read Y_WU
cparata 0:69566eea0fba 4043 * Input : Pointer to LSM6DSL_ACC_GYRO_Y_WU_t
cparata 0:69566eea0fba 4044 * Output : Status of Y_WU see LSM6DSL_ACC_GYRO_Y_WU_t
cparata 0:69566eea0fba 4045 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4046 *******************************************************************************/
cparata 0:69566eea0fba 4047 status_t LSM6DSL_ACC_GYRO_R_Y_WU(void *handle, LSM6DSL_ACC_GYRO_Y_WU_t *value)
cparata 0:69566eea0fba 4048 {
cparata 0:69566eea0fba 4049 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4050 return MEMS_ERROR;
cparata 0:69566eea0fba 4051
cparata 0:69566eea0fba 4052 *value &= LSM6DSL_ACC_GYRO_Y_WU_MASK; //mask
cparata 0:69566eea0fba 4053
cparata 0:69566eea0fba 4054 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4055 }
cparata 0:69566eea0fba 4056
cparata 0:69566eea0fba 4057 /*******************************************************************************
cparata 0:69566eea0fba 4058 * Function Name : LSM6DSL_ACC_GYRO_R_X_WU
cparata 0:69566eea0fba 4059 * Description : Read X_WU
cparata 0:69566eea0fba 4060 * Input : Pointer to LSM6DSL_ACC_GYRO_X_WU_t
cparata 0:69566eea0fba 4061 * Output : Status of X_WU see LSM6DSL_ACC_GYRO_X_WU_t
cparata 0:69566eea0fba 4062 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4063 *******************************************************************************/
cparata 0:69566eea0fba 4064 status_t LSM6DSL_ACC_GYRO_R_X_WU(void *handle, LSM6DSL_ACC_GYRO_X_WU_t *value)
cparata 0:69566eea0fba 4065 {
cparata 0:69566eea0fba 4066 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4067 return MEMS_ERROR;
cparata 0:69566eea0fba 4068
cparata 0:69566eea0fba 4069 *value &= LSM6DSL_ACC_GYRO_X_WU_MASK; //mask
cparata 0:69566eea0fba 4070
cparata 0:69566eea0fba 4071 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4072 }
cparata 0:69566eea0fba 4073
cparata 0:69566eea0fba 4074 /*******************************************************************************
cparata 0:69566eea0fba 4075 * Function Name : LSM6DSL_ACC_GYRO_R_WU_EV_STATUS
cparata 0:69566eea0fba 4076 * Description : Read WU_EV_STATUS
cparata 0:69566eea0fba 4077 * Input : Pointer to LSM6DSL_ACC_GYRO_WU_EV_STATUS_t
cparata 0:69566eea0fba 4078 * Output : Status of WU_EV_STATUS see LSM6DSL_ACC_GYRO_WU_EV_STATUS_t
cparata 0:69566eea0fba 4079 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4080 *******************************************************************************/
cparata 0:69566eea0fba 4081 status_t LSM6DSL_ACC_GYRO_R_WU_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_WU_EV_STATUS_t *value)
cparata 0:69566eea0fba 4082 {
cparata 0:69566eea0fba 4083 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4084 return MEMS_ERROR;
cparata 0:69566eea0fba 4085
cparata 0:69566eea0fba 4086 *value &= LSM6DSL_ACC_GYRO_WU_EV_STATUS_MASK; //mask
cparata 0:69566eea0fba 4087
cparata 0:69566eea0fba 4088 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4089 }
cparata 0:69566eea0fba 4090
cparata 0:69566eea0fba 4091 /*******************************************************************************
cparata 0:69566eea0fba 4092 * Function Name : LSM6DSL_ACC_GYRO_R_SLEEP_EV_STATUS
cparata 0:69566eea0fba 4093 * Description : Read SLEEP_EV_STATUS
cparata 0:69566eea0fba 4094 * Input : Pointer to LSM6DSL_ACC_GYRO_SLEEP_EV_STATUS_t
cparata 0:69566eea0fba 4095 * Output : Status of SLEEP_EV_STATUS see LSM6DSL_ACC_GYRO_SLEEP_EV_STATUS_t
cparata 0:69566eea0fba 4096 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4097 *******************************************************************************/
cparata 0:69566eea0fba 4098 status_t LSM6DSL_ACC_GYRO_R_SLEEP_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_SLEEP_EV_STATUS_t *value)
cparata 0:69566eea0fba 4099 {
cparata 0:69566eea0fba 4100 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4101 return MEMS_ERROR;
cparata 0:69566eea0fba 4102
cparata 0:69566eea0fba 4103 *value &= LSM6DSL_ACC_GYRO_SLEEP_EV_STATUS_MASK; //mask
cparata 0:69566eea0fba 4104
cparata 0:69566eea0fba 4105 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4106 }
cparata 0:69566eea0fba 4107
cparata 0:69566eea0fba 4108 /*******************************************************************************
cparata 0:69566eea0fba 4109 * Function Name : LSM6DSL_ACC_GYRO_R_FF_EV_STATUS
cparata 0:69566eea0fba 4110 * Description : Read FF_EV_STATUS
cparata 0:69566eea0fba 4111 * Input : Pointer to LSM6DSL_ACC_GYRO_FF_EV_STATUS_t
cparata 0:69566eea0fba 4112 * Output : Status of FF_EV_STATUS see LSM6DSL_ACC_GYRO_FF_EV_STATUS_t
cparata 0:69566eea0fba 4113 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4114 *******************************************************************************/
cparata 0:69566eea0fba 4115 status_t LSM6DSL_ACC_GYRO_R_FF_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_FF_EV_STATUS_t *value)
cparata 0:69566eea0fba 4116 {
cparata 0:69566eea0fba 4117 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4118 return MEMS_ERROR;
cparata 0:69566eea0fba 4119
cparata 0:69566eea0fba 4120 *value &= LSM6DSL_ACC_GYRO_FF_EV_STATUS_MASK; //mask
cparata 0:69566eea0fba 4121
cparata 0:69566eea0fba 4122 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4123 }
cparata 0:69566eea0fba 4124
cparata 0:69566eea0fba 4125 /*******************************************************************************
cparata 0:69566eea0fba 4126 * Function Name : LSM6DSL_ACC_GYRO_R_Z_TAP
cparata 0:69566eea0fba 4127 * Description : Read Z_TAP
cparata 0:69566eea0fba 4128 * Input : Pointer to LSM6DSL_ACC_GYRO_Z_TAP_t
cparata 0:69566eea0fba 4129 * Output : Status of Z_TAP see LSM6DSL_ACC_GYRO_Z_TAP_t
cparata 0:69566eea0fba 4130 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4131 *******************************************************************************/
cparata 0:69566eea0fba 4132 status_t LSM6DSL_ACC_GYRO_R_Z_TAP(void *handle, LSM6DSL_ACC_GYRO_Z_TAP_t *value)
cparata 0:69566eea0fba 4133 {
cparata 0:69566eea0fba 4134 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_SRC, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4135 return MEMS_ERROR;
cparata 0:69566eea0fba 4136
cparata 0:69566eea0fba 4137 *value &= LSM6DSL_ACC_GYRO_Z_TAP_MASK; //mask
cparata 0:69566eea0fba 4138
cparata 0:69566eea0fba 4139 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4140 }
cparata 0:69566eea0fba 4141
cparata 0:69566eea0fba 4142 /*******************************************************************************
cparata 0:69566eea0fba 4143 * Function Name : LSM6DSL_ACC_GYRO_R_Y_TAP
cparata 0:69566eea0fba 4144 * Description : Read Y_TAP
cparata 0:69566eea0fba 4145 * Input : Pointer to LSM6DSL_ACC_GYRO_Y_TAP_t
cparata 0:69566eea0fba 4146 * Output : Status of Y_TAP see LSM6DSL_ACC_GYRO_Y_TAP_t
cparata 0:69566eea0fba 4147 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4148 *******************************************************************************/
cparata 0:69566eea0fba 4149 status_t LSM6DSL_ACC_GYRO_R_Y_TAP(void *handle, LSM6DSL_ACC_GYRO_Y_TAP_t *value)
cparata 0:69566eea0fba 4150 {
cparata 0:69566eea0fba 4151 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_SRC, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4152 return MEMS_ERROR;
cparata 0:69566eea0fba 4153
cparata 0:69566eea0fba 4154 *value &= LSM6DSL_ACC_GYRO_Y_TAP_MASK; //mask
cparata 0:69566eea0fba 4155
cparata 0:69566eea0fba 4156 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4157 }
cparata 0:69566eea0fba 4158
cparata 0:69566eea0fba 4159 /*******************************************************************************
cparata 0:69566eea0fba 4160 * Function Name : LSM6DSL_ACC_GYRO_R_X_TAP
cparata 0:69566eea0fba 4161 * Description : Read X_TAP
cparata 0:69566eea0fba 4162 * Input : Pointer to LSM6DSL_ACC_GYRO_X_TAP_t
cparata 0:69566eea0fba 4163 * Output : Status of X_TAP see LSM6DSL_ACC_GYRO_X_TAP_t
cparata 0:69566eea0fba 4164 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4165 *******************************************************************************/
cparata 0:69566eea0fba 4166 status_t LSM6DSL_ACC_GYRO_R_X_TAP(void *handle, LSM6DSL_ACC_GYRO_X_TAP_t *value)
cparata 0:69566eea0fba 4167 {
cparata 0:69566eea0fba 4168 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_SRC, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4169 return MEMS_ERROR;
cparata 0:69566eea0fba 4170
cparata 0:69566eea0fba 4171 *value &= LSM6DSL_ACC_GYRO_X_TAP_MASK; //mask
cparata 0:69566eea0fba 4172
cparata 0:69566eea0fba 4173 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4174 }
cparata 0:69566eea0fba 4175
cparata 0:69566eea0fba 4176 /*******************************************************************************
cparata 0:69566eea0fba 4177 * Function Name : LSM6DSL_ACC_GYRO_R_TAP_SIGN
cparata 0:69566eea0fba 4178 * Description : Read TAP_SIGN
cparata 0:69566eea0fba 4179 * Input : Pointer to LSM6DSL_ACC_GYRO_TAP_SIGN_t
cparata 0:69566eea0fba 4180 * Output : Status of TAP_SIGN see LSM6DSL_ACC_GYRO_TAP_SIGN_t
cparata 0:69566eea0fba 4181 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4182 *******************************************************************************/
cparata 0:69566eea0fba 4183 status_t LSM6DSL_ACC_GYRO_R_TAP_SIGN(void *handle, LSM6DSL_ACC_GYRO_TAP_SIGN_t *value)
cparata 0:69566eea0fba 4184 {
cparata 0:69566eea0fba 4185 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_SRC, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4186 return MEMS_ERROR;
cparata 0:69566eea0fba 4187
cparata 0:69566eea0fba 4188 *value &= LSM6DSL_ACC_GYRO_TAP_SIGN_MASK; //mask
cparata 0:69566eea0fba 4189
cparata 0:69566eea0fba 4190 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4191 }
cparata 0:69566eea0fba 4192
cparata 0:69566eea0fba 4193 /*******************************************************************************
cparata 0:69566eea0fba 4194 * Function Name : LSM6DSL_ACC_GYRO_R_DOUBLE_TAP_EV_STATUS
cparata 0:69566eea0fba 4195 * Description : Read DOUBLE_TAP_EV_STATUS
cparata 0:69566eea0fba 4196 * Input : Pointer to LSM6DSL_ACC_GYRO_DOUBLE_TAP_EV_STATUS_t
cparata 0:69566eea0fba 4197 * Output : Status of DOUBLE_TAP_EV_STATUS see LSM6DSL_ACC_GYRO_DOUBLE_TAP_EV_STATUS_t
cparata 0:69566eea0fba 4198 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4199 *******************************************************************************/
cparata 0:69566eea0fba 4200 status_t LSM6DSL_ACC_GYRO_R_DOUBLE_TAP_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_DOUBLE_TAP_EV_STATUS_t *value)
cparata 0:69566eea0fba 4201 {
cparata 0:69566eea0fba 4202 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_SRC, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4203 return MEMS_ERROR;
cparata 0:69566eea0fba 4204
cparata 0:69566eea0fba 4205 *value &= LSM6DSL_ACC_GYRO_DOUBLE_TAP_EV_STATUS_MASK; //mask
cparata 0:69566eea0fba 4206
cparata 0:69566eea0fba 4207 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4208 }
cparata 0:69566eea0fba 4209
cparata 0:69566eea0fba 4210 /*******************************************************************************
cparata 0:69566eea0fba 4211 * Function Name : LSM6DSL_ACC_GYRO_R_SINGLE_TAP_EV_STATUS
cparata 0:69566eea0fba 4212 * Description : Read SINGLE_TAP_EV_STATUS
cparata 0:69566eea0fba 4213 * Input : Pointer to LSM6DSL_ACC_GYRO_SINGLE_TAP_EV_STATUS_t
cparata 0:69566eea0fba 4214 * Output : Status of SINGLE_TAP_EV_STATUS see LSM6DSL_ACC_GYRO_SINGLE_TAP_EV_STATUS_t
cparata 0:69566eea0fba 4215 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4216 *******************************************************************************/
cparata 0:69566eea0fba 4217 status_t LSM6DSL_ACC_GYRO_R_SINGLE_TAP_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_SINGLE_TAP_EV_STATUS_t *value)
cparata 0:69566eea0fba 4218 {
cparata 0:69566eea0fba 4219 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_SRC, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4220 return MEMS_ERROR;
cparata 0:69566eea0fba 4221
cparata 0:69566eea0fba 4222 *value &= LSM6DSL_ACC_GYRO_SINGLE_TAP_EV_STATUS_MASK; //mask
cparata 0:69566eea0fba 4223
cparata 0:69566eea0fba 4224 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4225 }
cparata 0:69566eea0fba 4226
cparata 0:69566eea0fba 4227 /*******************************************************************************
cparata 0:69566eea0fba 4228 * Function Name : LSM6DSL_ACC_GYRO_R_TAP_EV_STATUS
cparata 0:69566eea0fba 4229 * Description : Read TAP_EV_STATUS
cparata 0:69566eea0fba 4230 * Input : Pointer to LSM6DSL_ACC_GYRO_TAP_EV_STATUS_t
cparata 0:69566eea0fba 4231 * Output : Status of TAP_EV_STATUS see LSM6DSL_ACC_GYRO_TAP_EV_STATUS_t
cparata 0:69566eea0fba 4232 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4233 *******************************************************************************/
cparata 0:69566eea0fba 4234 status_t LSM6DSL_ACC_GYRO_R_TAP_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_TAP_EV_STATUS_t *value)
cparata 0:69566eea0fba 4235 {
cparata 0:69566eea0fba 4236 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_SRC, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4237 return MEMS_ERROR;
cparata 0:69566eea0fba 4238
cparata 0:69566eea0fba 4239 *value &= LSM6DSL_ACC_GYRO_TAP_EV_STATUS_MASK; //mask
cparata 0:69566eea0fba 4240
cparata 0:69566eea0fba 4241 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4242 }
cparata 0:69566eea0fba 4243
cparata 0:69566eea0fba 4244 /*******************************************************************************
cparata 0:69566eea0fba 4245 * Function Name : LSM6DSL_ACC_GYRO_R_DSD_XL
cparata 0:69566eea0fba 4246 * Description : Read DSD_XL
cparata 0:69566eea0fba 4247 * Input : Pointer to LSM6DSL_ACC_GYRO_DSD_XL_t
cparata 0:69566eea0fba 4248 * Output : Status of DSD_XL see LSM6DSL_ACC_GYRO_DSD_XL_t
cparata 0:69566eea0fba 4249 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4250 *******************************************************************************/
cparata 0:69566eea0fba 4251 status_t LSM6DSL_ACC_GYRO_R_DSD_XL(void *handle, LSM6DSL_ACC_GYRO_DSD_XL_t *value)
cparata 0:69566eea0fba 4252 {
cparata 0:69566eea0fba 4253 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_D6D_SRC, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4254 return MEMS_ERROR;
cparata 0:69566eea0fba 4255
cparata 0:69566eea0fba 4256 *value &= LSM6DSL_ACC_GYRO_DSD_XL_MASK; //mask
cparata 0:69566eea0fba 4257
cparata 0:69566eea0fba 4258 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4259 }
cparata 0:69566eea0fba 4260
cparata 0:69566eea0fba 4261 /*******************************************************************************
cparata 0:69566eea0fba 4262 * Function Name : LSM6DSL_ACC_GYRO_R_DSD_XH
cparata 0:69566eea0fba 4263 * Description : Read DSD_XH
cparata 0:69566eea0fba 4264 * Input : Pointer to LSM6DSL_ACC_GYRO_DSD_XH_t
cparata 0:69566eea0fba 4265 * Output : Status of DSD_XH see LSM6DSL_ACC_GYRO_DSD_XH_t
cparata 0:69566eea0fba 4266 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4267 *******************************************************************************/
cparata 0:69566eea0fba 4268 status_t LSM6DSL_ACC_GYRO_R_DSD_XH(void *handle, LSM6DSL_ACC_GYRO_DSD_XH_t *value)
cparata 0:69566eea0fba 4269 {
cparata 0:69566eea0fba 4270 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_D6D_SRC, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4271 return MEMS_ERROR;
cparata 0:69566eea0fba 4272
cparata 0:69566eea0fba 4273 *value &= LSM6DSL_ACC_GYRO_DSD_XH_MASK; //mask
cparata 0:69566eea0fba 4274
cparata 0:69566eea0fba 4275 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4276 }
cparata 0:69566eea0fba 4277
cparata 0:69566eea0fba 4278 /*******************************************************************************
cparata 0:69566eea0fba 4279 * Function Name : LSM6DSL_ACC_GYRO_R_DSD_YL
cparata 0:69566eea0fba 4280 * Description : Read DSD_YL
cparata 0:69566eea0fba 4281 * Input : Pointer to LSM6DSL_ACC_GYRO_DSD_YL_t
cparata 0:69566eea0fba 4282 * Output : Status of DSD_YL see LSM6DSL_ACC_GYRO_DSD_YL_t
cparata 0:69566eea0fba 4283 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4284 *******************************************************************************/
cparata 0:69566eea0fba 4285 status_t LSM6DSL_ACC_GYRO_R_DSD_YL(void *handle, LSM6DSL_ACC_GYRO_DSD_YL_t *value)
cparata 0:69566eea0fba 4286 {
cparata 0:69566eea0fba 4287 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_D6D_SRC, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4288 return MEMS_ERROR;
cparata 0:69566eea0fba 4289
cparata 0:69566eea0fba 4290 *value &= LSM6DSL_ACC_GYRO_DSD_YL_MASK; //mask
cparata 0:69566eea0fba 4291
cparata 0:69566eea0fba 4292 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4293 }
cparata 0:69566eea0fba 4294
cparata 0:69566eea0fba 4295 /*******************************************************************************
cparata 0:69566eea0fba 4296 * Function Name : LSM6DSL_ACC_GYRO_R_DSD_YH
cparata 0:69566eea0fba 4297 * Description : Read DSD_YH
cparata 0:69566eea0fba 4298 * Input : Pointer to LSM6DSL_ACC_GYRO_DSD_YH_t
cparata 0:69566eea0fba 4299 * Output : Status of DSD_YH see LSM6DSL_ACC_GYRO_DSD_YH_t
cparata 0:69566eea0fba 4300 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4301 *******************************************************************************/
cparata 0:69566eea0fba 4302 status_t LSM6DSL_ACC_GYRO_R_DSD_YH(void *handle, LSM6DSL_ACC_GYRO_DSD_YH_t *value)
cparata 0:69566eea0fba 4303 {
cparata 0:69566eea0fba 4304 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_D6D_SRC, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4305 return MEMS_ERROR;
cparata 0:69566eea0fba 4306
cparata 0:69566eea0fba 4307 *value &= LSM6DSL_ACC_GYRO_DSD_YH_MASK; //mask
cparata 0:69566eea0fba 4308
cparata 0:69566eea0fba 4309 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4310 }
cparata 0:69566eea0fba 4311
cparata 0:69566eea0fba 4312 /*******************************************************************************
cparata 0:69566eea0fba 4313 * Function Name : LSM6DSL_ACC_GYRO_R_DSD_ZL
cparata 0:69566eea0fba 4314 * Description : Read DSD_ZL
cparata 0:69566eea0fba 4315 * Input : Pointer to LSM6DSL_ACC_GYRO_DSD_ZL_t
cparata 0:69566eea0fba 4316 * Output : Status of DSD_ZL see LSM6DSL_ACC_GYRO_DSD_ZL_t
cparata 0:69566eea0fba 4317 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4318 *******************************************************************************/
cparata 0:69566eea0fba 4319 status_t LSM6DSL_ACC_GYRO_R_DSD_ZL(void *handle, LSM6DSL_ACC_GYRO_DSD_ZL_t *value)
cparata 0:69566eea0fba 4320 {
cparata 0:69566eea0fba 4321 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_D6D_SRC, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4322 return MEMS_ERROR;
cparata 0:69566eea0fba 4323
cparata 0:69566eea0fba 4324 *value &= LSM6DSL_ACC_GYRO_DSD_ZL_MASK; //mask
cparata 0:69566eea0fba 4325
cparata 0:69566eea0fba 4326 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4327 }
cparata 0:69566eea0fba 4328
cparata 0:69566eea0fba 4329 /*******************************************************************************
cparata 0:69566eea0fba 4330 * Function Name : LSM6DSL_ACC_GYRO_R_DSD_ZH
cparata 0:69566eea0fba 4331 * Description : Read DSD_ZH
cparata 0:69566eea0fba 4332 * Input : Pointer to LSM6DSL_ACC_GYRO_DSD_ZH_t
cparata 0:69566eea0fba 4333 * Output : Status of DSD_ZH see LSM6DSL_ACC_GYRO_DSD_ZH_t
cparata 0:69566eea0fba 4334 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4335 *******************************************************************************/
cparata 0:69566eea0fba 4336 status_t LSM6DSL_ACC_GYRO_R_DSD_ZH(void *handle, LSM6DSL_ACC_GYRO_DSD_ZH_t *value)
cparata 0:69566eea0fba 4337 {
cparata 0:69566eea0fba 4338 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_D6D_SRC, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4339 return MEMS_ERROR;
cparata 0:69566eea0fba 4340
cparata 0:69566eea0fba 4341 *value &= LSM6DSL_ACC_GYRO_DSD_ZH_MASK; //mask
cparata 0:69566eea0fba 4342
cparata 0:69566eea0fba 4343 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4344 }
cparata 0:69566eea0fba 4345
cparata 0:69566eea0fba 4346 /*******************************************************************************
cparata 0:69566eea0fba 4347 * Function Name : LSM6DSL_ACC_GYRO_R_D6D_EV_STATUS
cparata 0:69566eea0fba 4348 * Description : Read D6D_EV_STATUS
cparata 0:69566eea0fba 4349 * Input : Pointer to LSM6DSL_ACC_GYRO_D6D_EV_STATUS_t
cparata 0:69566eea0fba 4350 * Output : Status of D6D_EV_STATUS see LSM6DSL_ACC_GYRO_D6D_EV_STATUS_t
cparata 0:69566eea0fba 4351 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4352 *******************************************************************************/
cparata 0:69566eea0fba 4353 status_t LSM6DSL_ACC_GYRO_R_D6D_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_D6D_EV_STATUS_t *value)
cparata 0:69566eea0fba 4354 {
cparata 0:69566eea0fba 4355 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_D6D_SRC, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4356 return MEMS_ERROR;
cparata 0:69566eea0fba 4357
cparata 0:69566eea0fba 4358 *value &= LSM6DSL_ACC_GYRO_D6D_EV_STATUS_MASK; //mask
cparata 0:69566eea0fba 4359
cparata 0:69566eea0fba 4360 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4361 }
cparata 0:69566eea0fba 4362
cparata 0:69566eea0fba 4363 /*******************************************************************************
cparata 0:69566eea0fba 4364 * Function Name : LSM6DSL_ACC_GYRO_R_XLDA
cparata 0:69566eea0fba 4365 * Description : Read XLDA
cparata 0:69566eea0fba 4366 * Input : Pointer to LSM6DSL_ACC_GYRO_XLDA_t
cparata 0:69566eea0fba 4367 * Output : Status of XLDA see LSM6DSL_ACC_GYRO_XLDA_t
cparata 0:69566eea0fba 4368 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4369 *******************************************************************************/
cparata 0:69566eea0fba 4370 status_t LSM6DSL_ACC_GYRO_R_XLDA(void *handle, LSM6DSL_ACC_GYRO_XLDA_t *value)
cparata 0:69566eea0fba 4371 {
cparata 0:69566eea0fba 4372 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_STATUS_REG, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4373 return MEMS_ERROR;
cparata 0:69566eea0fba 4374
cparata 0:69566eea0fba 4375 *value &= LSM6DSL_ACC_GYRO_XLDA_MASK; //mask
cparata 0:69566eea0fba 4376
cparata 0:69566eea0fba 4377 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4378 }
cparata 0:69566eea0fba 4379
cparata 0:69566eea0fba 4380 /*******************************************************************************
cparata 0:69566eea0fba 4381 * Function Name : LSM6DSL_ACC_GYRO_R_GDA
cparata 0:69566eea0fba 4382 * Description : Read GDA
cparata 0:69566eea0fba 4383 * Input : Pointer to LSM6DSL_ACC_GYRO_GDA_t
cparata 0:69566eea0fba 4384 * Output : Status of GDA see LSM6DSL_ACC_GYRO_GDA_t
cparata 0:69566eea0fba 4385 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4386 *******************************************************************************/
cparata 0:69566eea0fba 4387 status_t LSM6DSL_ACC_GYRO_R_GDA(void *handle, LSM6DSL_ACC_GYRO_GDA_t *value)
cparata 0:69566eea0fba 4388 {
cparata 0:69566eea0fba 4389 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_STATUS_REG, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4390 return MEMS_ERROR;
cparata 0:69566eea0fba 4391
cparata 0:69566eea0fba 4392 *value &= LSM6DSL_ACC_GYRO_GDA_MASK; //mask
cparata 0:69566eea0fba 4393
cparata 0:69566eea0fba 4394 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4395 }
cparata 0:69566eea0fba 4396
cparata 0:69566eea0fba 4397 /*******************************************************************************
cparata 0:69566eea0fba 4398 * Function Name : LSM6DSL_ACC_GYRO_R_TDA
cparata 0:69566eea0fba 4399 * Description : Read GDA
cparata 0:69566eea0fba 4400 * Input : Pointer to LSM6DSL_ACC_GYRO_TDA_t
cparata 0:69566eea0fba 4401 * Output : Status of GDA see LSM6DSL_ACC_GYRO_TDA_t
cparata 0:69566eea0fba 4402 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4403 *******************************************************************************/
cparata 0:69566eea0fba 4404 status_t LSM6DSL_ACC_GYRO_R_TDA(void *handle, LSM6DSL_ACC_GYRO_TDA_t *value)
cparata 0:69566eea0fba 4405 {
cparata 0:69566eea0fba 4406 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_STATUS_REG, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4407 return MEMS_ERROR;
cparata 0:69566eea0fba 4408
cparata 0:69566eea0fba 4409 *value &= LSM6DSL_ACC_GYRO_TDA_MASK; //mask
cparata 0:69566eea0fba 4410
cparata 0:69566eea0fba 4411 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4412 }
cparata 0:69566eea0fba 4413
cparata 0:69566eea0fba 4414 /*******************************************************************************
cparata 0:69566eea0fba 4415 * Function Name : LSM6DSL_ACC_GYRO_R_FIFONumOfEntries
cparata 0:69566eea0fba 4416 * Description : Read DIFF_FIFO
cparata 0:69566eea0fba 4417 * Input : Pointer to u16_t
cparata 0:69566eea0fba 4418 * Output : Status of DIFF_FIFO
cparata 0:69566eea0fba 4419 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4420 *******************************************************************************/
cparata 0:69566eea0fba 4421 status_t LSM6DSL_ACC_GYRO_R_FIFONumOfEntries(void *handle, u16_t *value)
cparata 0:69566eea0fba 4422 {
cparata 0:69566eea0fba 4423 u8_t valueH, valueL;
cparata 0:69566eea0fba 4424
cparata 0:69566eea0fba 4425 /* Low part from FIFO_STATUS1 */
cparata 0:69566eea0fba 4426 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS1, (u8_t *)&valueL, 1) )
cparata 0:69566eea0fba 4427 return MEMS_ERROR;
cparata 0:69566eea0fba 4428
cparata 0:69566eea0fba 4429 valueL &= LSM6DSL_ACC_GYRO_DIFF_FIFO_STATUS1_MASK; //coerce
cparata 0:69566eea0fba 4430 valueL = valueL >> LSM6DSL_ACC_GYRO_DIFF_FIFO_STATUS1_POSITION; //mask
cparata 0:69566eea0fba 4431
cparata 0:69566eea0fba 4432 /* High part from FIFO_STATUS2 */
cparata 0:69566eea0fba 4433 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS2, (u8_t *)&valueH, 1) )
cparata 0:69566eea0fba 4434 return MEMS_ERROR;
cparata 0:69566eea0fba 4435
cparata 0:69566eea0fba 4436 valueH &= LSM6DSL_ACC_GYRO_DIFF_FIFO_STATUS2_MASK; //coerce
cparata 0:69566eea0fba 4437 valueH = valueH >> LSM6DSL_ACC_GYRO_DIFF_FIFO_STATUS2_POSITION; //mask
cparata 0:69566eea0fba 4438
cparata 0:69566eea0fba 4439 *value = ((valueH << 8) & 0xFF00) | valueL;
cparata 0:69566eea0fba 4440
cparata 0:69566eea0fba 4441 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4442 }
cparata 0:69566eea0fba 4443
cparata 0:69566eea0fba 4444 /*******************************************************************************
cparata 0:69566eea0fba 4445 * Function Name : LSM6DSL_ACC_GYRO_R_FIFOEmpty
cparata 0:69566eea0fba 4446 * Description : Read FIFO_EMPTY
cparata 0:69566eea0fba 4447 * Input : Pointer to LSM6DSL_ACC_GYRO_FIFO_EMPTY_t
cparata 0:69566eea0fba 4448 * Output : Status of FIFO_EMPTY see LSM6DSL_ACC_GYRO_FIFO_EMPTY_t
cparata 0:69566eea0fba 4449 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4450 *******************************************************************************/
cparata 0:69566eea0fba 4451 status_t LSM6DSL_ACC_GYRO_R_FIFOEmpty(void *handle, LSM6DSL_ACC_GYRO_FIFO_EMPTY_t *value)
cparata 0:69566eea0fba 4452 {
cparata 0:69566eea0fba 4453 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS2, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4454 return MEMS_ERROR;
cparata 0:69566eea0fba 4455
cparata 0:69566eea0fba 4456 *value &= LSM6DSL_ACC_GYRO_FIFO_EMPTY_MASK; //mask
cparata 0:69566eea0fba 4457
cparata 0:69566eea0fba 4458 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4459 }
cparata 0:69566eea0fba 4460
cparata 0:69566eea0fba 4461 /*******************************************************************************
cparata 0:69566eea0fba 4462 * Function Name : LSM6DSL_ACC_GYRO_R_FIFOFull
cparata 0:69566eea0fba 4463 * Description : Read FIFO_FULL
cparata 0:69566eea0fba 4464 * Input : Pointer to LSM6DSL_ACC_GYRO_FIFO_FULL_t
cparata 0:69566eea0fba 4465 * Output : Status of FIFO_FULL see LSM6DSL_ACC_GYRO_FIFO_FULL_t
cparata 0:69566eea0fba 4466 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4467 *******************************************************************************/
cparata 0:69566eea0fba 4468 status_t LSM6DSL_ACC_GYRO_R_FIFOFull(void *handle, LSM6DSL_ACC_GYRO_FIFO_FULL_t *value)
cparata 0:69566eea0fba 4469 {
cparata 0:69566eea0fba 4470 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS2, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4471 return MEMS_ERROR;
cparata 0:69566eea0fba 4472
cparata 0:69566eea0fba 4473 *value &= LSM6DSL_ACC_GYRO_FIFO_FULL_MASK; //mask
cparata 0:69566eea0fba 4474
cparata 0:69566eea0fba 4475 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4476 }
cparata 0:69566eea0fba 4477
cparata 0:69566eea0fba 4478 /*******************************************************************************
cparata 0:69566eea0fba 4479 * Function Name : LSM6DSL_ACC_GYRO_R_OVERRUN
cparata 0:69566eea0fba 4480 * Description : Read OVERRUN
cparata 0:69566eea0fba 4481 * Input : Pointer to LSM6DSL_ACC_GYRO_OVERRUN_t
cparata 0:69566eea0fba 4482 * Output : Status of OVERRUN see LSM6DSL_ACC_GYRO_OVERRUN_t
cparata 0:69566eea0fba 4483 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4484 *******************************************************************************/
cparata 0:69566eea0fba 4485 status_t LSM6DSL_ACC_GYRO_R_OVERRUN(void *handle, LSM6DSL_ACC_GYRO_OVERRUN_t *value)
cparata 0:69566eea0fba 4486 {
cparata 0:69566eea0fba 4487 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS2, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4488 return MEMS_ERROR;
cparata 0:69566eea0fba 4489
cparata 0:69566eea0fba 4490 *value &= LSM6DSL_ACC_GYRO_OVERRUN_MASK; //mask
cparata 0:69566eea0fba 4491
cparata 0:69566eea0fba 4492 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4493 }
cparata 0:69566eea0fba 4494
cparata 0:69566eea0fba 4495 /*******************************************************************************
cparata 0:69566eea0fba 4496 * Function Name : LSM6DSL_ACC_GYRO_R_WaterMark
cparata 0:69566eea0fba 4497 * Description : Read WTM
cparata 0:69566eea0fba 4498 * Input : Pointer to LSM6DSL_ACC_GYRO_WTM_t
cparata 0:69566eea0fba 4499 * Output : Status of WTM see LSM6DSL_ACC_GYRO_WTM_t
cparata 0:69566eea0fba 4500 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4501 *******************************************************************************/
cparata 0:69566eea0fba 4502 status_t LSM6DSL_ACC_GYRO_R_WaterMark(void *handle, LSM6DSL_ACC_GYRO_WTM_t *value)
cparata 0:69566eea0fba 4503 {
cparata 0:69566eea0fba 4504 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS2, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4505 return MEMS_ERROR;
cparata 0:69566eea0fba 4506
cparata 0:69566eea0fba 4507 *value &= LSM6DSL_ACC_GYRO_WTM_MASK; //mask
cparata 0:69566eea0fba 4508
cparata 0:69566eea0fba 4509 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4510 }
cparata 0:69566eea0fba 4511
cparata 0:69566eea0fba 4512 /*******************************************************************************
cparata 0:69566eea0fba 4513 * Function Name : LSM6DSL_ACC_GYRO_R_FIFOPattern
cparata 0:69566eea0fba 4514 * Description : Read FIFO_PATTERN
cparata 0:69566eea0fba 4515 * Input : Pointer to u16_t
cparata 0:69566eea0fba 4516 * Output : Status of FIFO_PATTERN
cparata 0:69566eea0fba 4517 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4518 *******************************************************************************/
cparata 0:69566eea0fba 4519 status_t LSM6DSL_ACC_GYRO_R_FIFOPattern(void *handle, u16_t *value)
cparata 0:69566eea0fba 4520 {
cparata 0:69566eea0fba 4521 u8_t valueH, valueL;
cparata 0:69566eea0fba 4522
cparata 0:69566eea0fba 4523 /* Low part from FIFO_STATUS3 */
cparata 0:69566eea0fba 4524 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS3, (u8_t *)&valueL, 1) )
cparata 0:69566eea0fba 4525 return MEMS_ERROR;
cparata 0:69566eea0fba 4526
cparata 0:69566eea0fba 4527 valueL &= LSM6DSL_ACC_GYRO_FIFO_STATUS3_PATTERN_MASK; //coerce
cparata 0:69566eea0fba 4528 valueL = valueL >> LSM6DSL_ACC_GYRO_FIFO_STATUS3_PATTERN_POSITION; //mask
cparata 0:69566eea0fba 4529
cparata 0:69566eea0fba 4530 /* High part from FIFO_STATUS4 */
cparata 0:69566eea0fba 4531 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS4, (u8_t *)&valueH, 1) )
cparata 0:69566eea0fba 4532 return MEMS_ERROR;
cparata 0:69566eea0fba 4533
cparata 0:69566eea0fba 4534 valueH &= LSM6DSL_ACC_GYRO_FIFO_STATUS4_PATTERN_MASK; //coerce
cparata 0:69566eea0fba 4535 valueH = valueH >> LSM6DSL_ACC_GYRO_FIFO_STATUS4_PATTERN_POSITION; //mask
cparata 0:69566eea0fba 4536
cparata 0:69566eea0fba 4537 *value = ((valueH << 8) & 0xFF00) | valueL;
cparata 0:69566eea0fba 4538
cparata 0:69566eea0fba 4539 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4540 }
cparata 0:69566eea0fba 4541
cparata 0:69566eea0fba 4542 /*******************************************************************************
cparata 0:69566eea0fba 4543 * Function Name : LSM6DSL_ACC_GYRO_R_SENS_HUB_END
cparata 0:69566eea0fba 4544 * Description : Read SENS_HUB_END
cparata 0:69566eea0fba 4545 * Input : Pointer to LSM6DSL_ACC_GYRO_SENS_HUB_END_t
cparata 0:69566eea0fba 4546 * Output : Status of SENS_HUB_END see LSM6DSL_ACC_GYRO_SENS_HUB_END_t
cparata 0:69566eea0fba 4547 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4548 *******************************************************************************/
cparata 0:69566eea0fba 4549 status_t LSM6DSL_ACC_GYRO_R_SENS_HUB_END(void *handle, LSM6DSL_ACC_GYRO_SENS_HUB_END_t *value)
cparata 0:69566eea0fba 4550 {
cparata 0:69566eea0fba 4551 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4552 return MEMS_ERROR;
cparata 0:69566eea0fba 4553
cparata 0:69566eea0fba 4554 *value &= LSM6DSL_ACC_GYRO_SENS_HUB_END_MASK; //mask
cparata 0:69566eea0fba 4555
cparata 0:69566eea0fba 4556 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4557 }
cparata 0:69566eea0fba 4558
cparata 0:69566eea0fba 4559 /*******************************************************************************
cparata 0:69566eea0fba 4560 * Function Name : LSM6DSL_ACC_GYRO_R_SOFT_IRON_END
cparata 0:69566eea0fba 4561 * Description : Read SOFT_IRON_END
cparata 0:69566eea0fba 4562 * Input : Pointer to LSM6DSL_ACC_GYRO_SOFT_IRON_END_t
cparata 0:69566eea0fba 4563 * Output : Status of SOFT_IRON_END see LSM6DSL_ACC_GYRO_SOFT_IRON_END_t
cparata 0:69566eea0fba 4564 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4565 *******************************************************************************/
cparata 0:69566eea0fba 4566 status_t LSM6DSL_ACC_GYRO_R_SOFT_IRON_END(void *handle, LSM6DSL_ACC_GYRO_SOFT_IRON_END_t *value)
cparata 0:69566eea0fba 4567 {
cparata 0:69566eea0fba 4568 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4569 return MEMS_ERROR;
cparata 0:69566eea0fba 4570
cparata 0:69566eea0fba 4571 *value &= LSM6DSL_ACC_GYRO_SOFT_IRON_END_MASK; //mask
cparata 0:69566eea0fba 4572
cparata 0:69566eea0fba 4573 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4574 }
cparata 0:69566eea0fba 4575
cparata 0:69566eea0fba 4576 /*******************************************************************************
cparata 0:69566eea0fba 4577 * Function Name : LSM6DSL_ACC_GYRO_R_HardIron
cparata 0:69566eea0fba 4578 * Description : Read HI_FAIL
cparata 0:69566eea0fba 4579 * Input : Pointer to LSM6DSL_ACC_GYRO_SOFT_HARD_IRON_STAT_t
cparata 0:69566eea0fba 4580 * Output : Status of HI_FAIL see LSM6DSL_ACC_GYRO_SOFT_HARD_IRON_STAT_t
cparata 0:69566eea0fba 4581 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4582 *******************************************************************************/
cparata 0:69566eea0fba 4583 status_t LSM6DSL_ACC_GYRO_R_HardIron(void *handle, LSM6DSL_ACC_GYRO_SOFT_HARD_IRON_STAT_t *value)
cparata 0:69566eea0fba 4584 {
cparata 0:69566eea0fba 4585 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4586 return MEMS_ERROR;
cparata 0:69566eea0fba 4587
cparata 0:69566eea0fba 4588 *value &= LSM6DSL_ACC_GYRO_HARD_IRON_STAT_MASK; //mask
cparata 0:69566eea0fba 4589
cparata 0:69566eea0fba 4590 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4591 }
cparata 0:69566eea0fba 4592
cparata 0:69566eea0fba 4593 /*******************************************************************************
cparata 0:69566eea0fba 4594 * Function Name : LSM6DSL_ACC_GYRO_R_STEP_OVERFLOW
cparata 0:69566eea0fba 4595 * Description : Read STEP_OVERFLOW
cparata 0:69566eea0fba 4596 * Input : Pointer to LSM6DSL_ACC_GYRO_STEP_OVERFLOW_t
cparata 0:69566eea0fba 4597 * Output : Status of STEP_OVERFLOW see LSM6DSL_ACC_GYRO_STEP_OVERFLOW_t
cparata 0:69566eea0fba 4598 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4599 *******************************************************************************/
cparata 0:69566eea0fba 4600 status_t LSM6DSL_ACC_GYRO_R_STEP_OVERFLOW(void *handle, LSM6DSL_ACC_GYRO_STEP_OVERFLOW_t *value)
cparata 0:69566eea0fba 4601 {
cparata 0:69566eea0fba 4602 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4603 return MEMS_ERROR;
cparata 0:69566eea0fba 4604
cparata 0:69566eea0fba 4605 *value &= LSM6DSL_ACC_GYRO_STEP_OVERFLOW_MASK; //mask
cparata 0:69566eea0fba 4606
cparata 0:69566eea0fba 4607 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4608 }
cparata 0:69566eea0fba 4609
cparata 0:69566eea0fba 4610 /*******************************************************************************
cparata 0:69566eea0fba 4611 * Function Name : LSM6DSL_ACC_GYRO_R_STEP_COUNT_DELTA
cparata 0:69566eea0fba 4612 * Description : Read STEP_COUNT_DELTA_IA
cparata 0:69566eea0fba 4613 * Input : Pointer to LSM6DSL_ACC_GYRO_STEP_COUNT_DELTA_t
cparata 0:69566eea0fba 4614 * Output : Status of STEP_COUNT_DELTA_IA see LSM6DSL_ACC_GYRO_STEP_COUNT_DELTA_t
cparata 0:69566eea0fba 4615 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4616 *******************************************************************************/
cparata 0:69566eea0fba 4617 status_t LSM6DSL_ACC_GYRO_R_STEP_COUNT_DELTA(void *handle, LSM6DSL_ACC_GYRO_STEP_COUNT_DELTA_t *value)
cparata 0:69566eea0fba 4618 {
cparata 0:69566eea0fba 4619 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4620 return MEMS_ERROR;
cparata 0:69566eea0fba 4621
cparata 0:69566eea0fba 4622 *value &= LSM6DSL_ACC_GYRO_STEP_COUNT_DELTA_MASK; //mask
cparata 0:69566eea0fba 4623
cparata 0:69566eea0fba 4624 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4625 }
cparata 0:69566eea0fba 4626
cparata 0:69566eea0fba 4627 /*******************************************************************************
cparata 0:69566eea0fba 4628 * Function Name : LSM6DSL_ACC_GYRO_R_PEDO_EV_STATUS
cparata 0:69566eea0fba 4629 * Description : Read PEDO_EV_STATUS
cparata 0:69566eea0fba 4630 * Input : Pointer to LSM6DSL_ACC_GYRO_PEDO_EV_STATUS_t
cparata 0:69566eea0fba 4631 * Output : Status of PEDO_EV_STATUS see LSM6DSL_ACC_GYRO_PEDO_EV_STATUS_t
cparata 0:69566eea0fba 4632 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4633 *******************************************************************************/
cparata 0:69566eea0fba 4634 status_t LSM6DSL_ACC_GYRO_R_PEDO_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_PEDO_EV_STATUS_t *value)
cparata 0:69566eea0fba 4635 {
cparata 0:69566eea0fba 4636 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4637 return MEMS_ERROR;
cparata 0:69566eea0fba 4638
cparata 0:69566eea0fba 4639 *value &= LSM6DSL_ACC_GYRO_PEDO_EV_STATUS_MASK; //mask
cparata 0:69566eea0fba 4640
cparata 0:69566eea0fba 4641 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4642 }
cparata 0:69566eea0fba 4643
cparata 0:69566eea0fba 4644 /*******************************************************************************
cparata 0:69566eea0fba 4645 * Function Name : LSM6DSL_ACC_GYRO_R_TILT_EV_STATUS
cparata 0:69566eea0fba 4646 * Description : Read TILT_EV_STATUS
cparata 0:69566eea0fba 4647 * Input : Pointer to LSM6DSL_ACC_GYRO_TILT_EV_STATUS_t
cparata 0:69566eea0fba 4648 * Output : Status of TILT_EV_STATUS see LSM6DSL_ACC_GYRO_TILT_EV_STATUS_t
cparata 0:69566eea0fba 4649 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4650 *******************************************************************************/
cparata 0:69566eea0fba 4651 status_t LSM6DSL_ACC_GYRO_R_TILT_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_TILT_EV_STATUS_t *value)
cparata 0:69566eea0fba 4652 {
cparata 0:69566eea0fba 4653 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4654 return MEMS_ERROR;
cparata 0:69566eea0fba 4655
cparata 0:69566eea0fba 4656 *value &= LSM6DSL_ACC_GYRO_TILT_EV_STATUS_MASK; //mask
cparata 0:69566eea0fba 4657
cparata 0:69566eea0fba 4658 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4659 }
cparata 0:69566eea0fba 4660
cparata 0:69566eea0fba 4661 /*******************************************************************************
cparata 0:69566eea0fba 4662 * Function Name : LSM6DSL_ACC_GYRO_R_SIGN_MOT_EV_STATUS
cparata 0:69566eea0fba 4663 * Description : Read SIGN_MOT_EV_STATUS
cparata 0:69566eea0fba 4664 * Input : Pointer to LSM6DSL_ACC_GYRO_SIGN_MOT_EV_STATUS_t
cparata 0:69566eea0fba 4665 * Output : Status of SIGN_MOT_EV_STATUS see LSM6DSL_ACC_GYRO_SIGN_MOT_EV_STATUS_t
cparata 0:69566eea0fba 4666 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4667 *******************************************************************************/
cparata 0:69566eea0fba 4668 status_t LSM6DSL_ACC_GYRO_R_SIGN_MOT_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_SIGN_MOT_EV_STATUS_t *value)
cparata 0:69566eea0fba 4669 {
cparata 0:69566eea0fba 4670 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4671 return MEMS_ERROR;
cparata 0:69566eea0fba 4672
cparata 0:69566eea0fba 4673 *value &= LSM6DSL_ACC_GYRO_SIGN_MOT_EV_STATUS_MASK; //mask
cparata 0:69566eea0fba 4674
cparata 0:69566eea0fba 4675 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4676 }
cparata 0:69566eea0fba 4677
cparata 0:69566eea0fba 4678 /*******************************************************************************
cparata 0:69566eea0fba 4679 * Function Name : LSM6DSL_ACC_GYRO_W_LIR
cparata 0:69566eea0fba 4680 * Description : Write LIR
cparata 0:69566eea0fba 4681 * Input : LSM6DSL_ACC_GYRO_LIR_t
cparata 0:69566eea0fba 4682 * Output : None
cparata 0:69566eea0fba 4683 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4684 *******************************************************************************/
cparata 0:69566eea0fba 4685 status_t LSM6DSL_ACC_GYRO_W_LIR(void *handle, LSM6DSL_ACC_GYRO_LIR_t newValue)
cparata 0:69566eea0fba 4686 {
cparata 0:69566eea0fba 4687 u8_t value;
cparata 0:69566eea0fba 4688
cparata 0:69566eea0fba 4689 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:69566eea0fba 4690 return MEMS_ERROR;
cparata 0:69566eea0fba 4691
cparata 0:69566eea0fba 4692 value &= ~LSM6DSL_ACC_GYRO_LIR_MASK;
cparata 0:69566eea0fba 4693 value |= newValue;
cparata 0:69566eea0fba 4694
cparata 0:69566eea0fba 4695 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:69566eea0fba 4696 return MEMS_ERROR;
cparata 0:69566eea0fba 4697
cparata 0:69566eea0fba 4698 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4699 }
cparata 0:69566eea0fba 4700
cparata 0:69566eea0fba 4701 /*******************************************************************************
cparata 0:69566eea0fba 4702 * Function Name : LSM6DSL_ACC_GYRO_R_LIR
cparata 0:69566eea0fba 4703 * Description : Read LIR
cparata 0:69566eea0fba 4704 * Input : Pointer to LSM6DSL_ACC_GYRO_LIR_t
cparata 0:69566eea0fba 4705 * Output : Status of LIR see LSM6DSL_ACC_GYRO_LIR_t
cparata 0:69566eea0fba 4706 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4707 *******************************************************************************/
cparata 0:69566eea0fba 4708 status_t LSM6DSL_ACC_GYRO_R_LIR(void *handle, LSM6DSL_ACC_GYRO_LIR_t *value)
cparata 0:69566eea0fba 4709 {
cparata 0:69566eea0fba 4710 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4711 return MEMS_ERROR;
cparata 0:69566eea0fba 4712
cparata 0:69566eea0fba 4713 *value &= LSM6DSL_ACC_GYRO_LIR_MASK; //mask
cparata 0:69566eea0fba 4714
cparata 0:69566eea0fba 4715 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4716 }
cparata 0:69566eea0fba 4717
cparata 0:69566eea0fba 4718 /*******************************************************************************
cparata 0:69566eea0fba 4719 * Function Name : LSM6DSL_ACC_GYRO_W_TAP_Z_EN
cparata 0:69566eea0fba 4720 * Description : Write TAP_Z_EN
cparata 0:69566eea0fba 4721 * Input : LSM6DSL_ACC_GYRO_TAP_Z_EN_t
cparata 0:69566eea0fba 4722 * Output : None
cparata 0:69566eea0fba 4723 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4724 *******************************************************************************/
cparata 0:69566eea0fba 4725 status_t LSM6DSL_ACC_GYRO_W_TAP_Z_EN(void *handle, LSM6DSL_ACC_GYRO_TAP_Z_EN_t newValue)
cparata 0:69566eea0fba 4726 {
cparata 0:69566eea0fba 4727 u8_t value;
cparata 0:69566eea0fba 4728
cparata 0:69566eea0fba 4729 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:69566eea0fba 4730 return MEMS_ERROR;
cparata 0:69566eea0fba 4731
cparata 0:69566eea0fba 4732 value &= ~LSM6DSL_ACC_GYRO_TAP_Z_EN_MASK;
cparata 0:69566eea0fba 4733 value |= newValue;
cparata 0:69566eea0fba 4734
cparata 0:69566eea0fba 4735 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:69566eea0fba 4736 return MEMS_ERROR;
cparata 0:69566eea0fba 4737
cparata 0:69566eea0fba 4738 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4739 }
cparata 0:69566eea0fba 4740
cparata 0:69566eea0fba 4741 /*******************************************************************************
cparata 0:69566eea0fba 4742 * Function Name : LSM6DSL_ACC_GYRO_R_TAP_Z_EN
cparata 0:69566eea0fba 4743 * Description : Read TAP_Z_EN
cparata 0:69566eea0fba 4744 * Input : Pointer to LSM6DSL_ACC_GYRO_TAP_Z_EN_t
cparata 0:69566eea0fba 4745 * Output : Status of TAP_Z_EN see LSM6DSL_ACC_GYRO_TAP_Z_EN_t
cparata 0:69566eea0fba 4746 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4747 *******************************************************************************/
cparata 0:69566eea0fba 4748 status_t LSM6DSL_ACC_GYRO_R_TAP_Z_EN(void *handle, LSM6DSL_ACC_GYRO_TAP_Z_EN_t *value)
cparata 0:69566eea0fba 4749 {
cparata 0:69566eea0fba 4750 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4751 return MEMS_ERROR;
cparata 0:69566eea0fba 4752
cparata 0:69566eea0fba 4753 *value &= LSM6DSL_ACC_GYRO_TAP_Z_EN_MASK; //mask
cparata 0:69566eea0fba 4754
cparata 0:69566eea0fba 4755 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4756 }
cparata 0:69566eea0fba 4757
cparata 0:69566eea0fba 4758 /*******************************************************************************
cparata 0:69566eea0fba 4759 * Function Name : LSM6DSL_ACC_GYRO_W_TAP_Y_EN
cparata 0:69566eea0fba 4760 * Description : Write TAP_Y_EN
cparata 0:69566eea0fba 4761 * Input : LSM6DSL_ACC_GYRO_TAP_Y_EN_t
cparata 0:69566eea0fba 4762 * Output : None
cparata 0:69566eea0fba 4763 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4764 *******************************************************************************/
cparata 0:69566eea0fba 4765 status_t LSM6DSL_ACC_GYRO_W_TAP_Y_EN(void *handle, LSM6DSL_ACC_GYRO_TAP_Y_EN_t newValue)
cparata 0:69566eea0fba 4766 {
cparata 0:69566eea0fba 4767 u8_t value;
cparata 0:69566eea0fba 4768
cparata 0:69566eea0fba 4769 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:69566eea0fba 4770 return MEMS_ERROR;
cparata 0:69566eea0fba 4771
cparata 0:69566eea0fba 4772 value &= ~LSM6DSL_ACC_GYRO_TAP_Y_EN_MASK;
cparata 0:69566eea0fba 4773 value |= newValue;
cparata 0:69566eea0fba 4774
cparata 0:69566eea0fba 4775 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:69566eea0fba 4776 return MEMS_ERROR;
cparata 0:69566eea0fba 4777
cparata 0:69566eea0fba 4778 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4779 }
cparata 0:69566eea0fba 4780
cparata 0:69566eea0fba 4781 /*******************************************************************************
cparata 0:69566eea0fba 4782 * Function Name : LSM6DSL_ACC_GYRO_R_TAP_Y_EN
cparata 0:69566eea0fba 4783 * Description : Read TAP_Y_EN
cparata 0:69566eea0fba 4784 * Input : Pointer to LSM6DSL_ACC_GYRO_TAP_Y_EN_t
cparata 0:69566eea0fba 4785 * Output : Status of TAP_Y_EN see LSM6DSL_ACC_GYRO_TAP_Y_EN_t
cparata 0:69566eea0fba 4786 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4787 *******************************************************************************/
cparata 0:69566eea0fba 4788 status_t LSM6DSL_ACC_GYRO_R_TAP_Y_EN(void *handle, LSM6DSL_ACC_GYRO_TAP_Y_EN_t *value)
cparata 0:69566eea0fba 4789 {
cparata 0:69566eea0fba 4790 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4791 return MEMS_ERROR;
cparata 0:69566eea0fba 4792
cparata 0:69566eea0fba 4793 *value &= LSM6DSL_ACC_GYRO_TAP_Y_EN_MASK; //mask
cparata 0:69566eea0fba 4794
cparata 0:69566eea0fba 4795 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4796 }
cparata 0:69566eea0fba 4797
cparata 0:69566eea0fba 4798 /*******************************************************************************
cparata 0:69566eea0fba 4799 * Function Name : LSM6DSL_ACC_GYRO_W_TAP_X_EN
cparata 0:69566eea0fba 4800 * Description : Write TAP_X_EN
cparata 0:69566eea0fba 4801 * Input : LSM6DSL_ACC_GYRO_TAP_X_EN_t
cparata 0:69566eea0fba 4802 * Output : None
cparata 0:69566eea0fba 4803 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4804 *******************************************************************************/
cparata 0:69566eea0fba 4805 status_t LSM6DSL_ACC_GYRO_W_TAP_X_EN(void *handle, LSM6DSL_ACC_GYRO_TAP_X_EN_t newValue)
cparata 0:69566eea0fba 4806 {
cparata 0:69566eea0fba 4807 u8_t value;
cparata 0:69566eea0fba 4808
cparata 0:69566eea0fba 4809 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:69566eea0fba 4810 return MEMS_ERROR;
cparata 0:69566eea0fba 4811
cparata 0:69566eea0fba 4812 value &= ~LSM6DSL_ACC_GYRO_TAP_X_EN_MASK;
cparata 0:69566eea0fba 4813 value |= newValue;
cparata 0:69566eea0fba 4814
cparata 0:69566eea0fba 4815 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:69566eea0fba 4816 return MEMS_ERROR;
cparata 0:69566eea0fba 4817
cparata 0:69566eea0fba 4818 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4819 }
cparata 0:69566eea0fba 4820
cparata 0:69566eea0fba 4821 /*******************************************************************************
cparata 0:69566eea0fba 4822 * Function Name : LSM6DSL_ACC_GYRO_R_TAP_X_EN
cparata 0:69566eea0fba 4823 * Description : Read TAP_X_EN
cparata 0:69566eea0fba 4824 * Input : Pointer to LSM6DSL_ACC_GYRO_TAP_X_EN_t
cparata 0:69566eea0fba 4825 * Output : Status of TAP_X_EN see LSM6DSL_ACC_GYRO_TAP_X_EN_t
cparata 0:69566eea0fba 4826 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4827 *******************************************************************************/
cparata 0:69566eea0fba 4828 status_t LSM6DSL_ACC_GYRO_R_TAP_X_EN(void *handle, LSM6DSL_ACC_GYRO_TAP_X_EN_t *value)
cparata 0:69566eea0fba 4829 {
cparata 0:69566eea0fba 4830 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4831 return MEMS_ERROR;
cparata 0:69566eea0fba 4832
cparata 0:69566eea0fba 4833 *value &= LSM6DSL_ACC_GYRO_TAP_X_EN_MASK; //mask
cparata 0:69566eea0fba 4834
cparata 0:69566eea0fba 4835 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4836 }
cparata 0:69566eea0fba 4837
cparata 0:69566eea0fba 4838 /*******************************************************************************
cparata 0:69566eea0fba 4839 * Function Name : LSM6DSL_ACC_GYRO_W_SLOPE_FDS
cparata 0:69566eea0fba 4840 * Description : Write SLOPE_FDS
cparata 0:69566eea0fba 4841 * Input : LSM6DSL_ACC_GYRO_SLOPE_FDS_t
cparata 0:69566eea0fba 4842 * Output : None
cparata 0:69566eea0fba 4843 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4844 *******************************************************************************/
cparata 0:69566eea0fba 4845 status_t LSM6DSL_ACC_GYRO_W_SLOPE_FDS(void *handle, LSM6DSL_ACC_GYRO_SLOPE_FDS_t newValue)
cparata 0:69566eea0fba 4846 {
cparata 0:69566eea0fba 4847 u8_t value;
cparata 0:69566eea0fba 4848
cparata 0:69566eea0fba 4849 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:69566eea0fba 4850 return MEMS_ERROR;
cparata 0:69566eea0fba 4851
cparata 0:69566eea0fba 4852 value &= ~LSM6DSL_ACC_GYRO_SLOPE_FDS_MASK;
cparata 0:69566eea0fba 4853 value |= newValue;
cparata 0:69566eea0fba 4854
cparata 0:69566eea0fba 4855 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:69566eea0fba 4856 return MEMS_ERROR;
cparata 0:69566eea0fba 4857
cparata 0:69566eea0fba 4858 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4859 }
cparata 0:69566eea0fba 4860
cparata 0:69566eea0fba 4861 /*******************************************************************************
cparata 0:69566eea0fba 4862 * Function Name : LSM6DSL_ACC_GYRO_R_SLOPE_FDS
cparata 0:69566eea0fba 4863 * Description : Read SLOPE_FDS
cparata 0:69566eea0fba 4864 * Input : Pointer to LSM6DSL_ACC_GYRO_SLOPE_FDS_t
cparata 0:69566eea0fba 4865 * Output : Status of SLOPE_FDS see LSM6DSL_ACC_GYRO_SLOPE_FDS_t
cparata 0:69566eea0fba 4866 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4867 *******************************************************************************/
cparata 0:69566eea0fba 4868 status_t LSM6DSL_ACC_GYRO_R_SLOPE_FDS(void *handle, LSM6DSL_ACC_GYRO_SLOPE_FDS_t *value)
cparata 0:69566eea0fba 4869 {
cparata 0:69566eea0fba 4870 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4871 return MEMS_ERROR;
cparata 0:69566eea0fba 4872
cparata 0:69566eea0fba 4873 *value &= LSM6DSL_ACC_GYRO_SLOPE_FDS_MASK; //mask
cparata 0:69566eea0fba 4874
cparata 0:69566eea0fba 4875 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4876 }
cparata 0:69566eea0fba 4877
cparata 0:69566eea0fba 4878 /*******************************************************************************
cparata 0:69566eea0fba 4879 * Function Name : LSM6DSL_ACC_GYRO_W_BASIC_INT
cparata 0:69566eea0fba 4880 * Description : Write INTERRUPTS_ENABLE
cparata 0:69566eea0fba 4881 * Input : LSM6DSL_ACC_GYRO_INT_EN_t
cparata 0:69566eea0fba 4882 * Output : None
cparata 0:69566eea0fba 4883 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4884 *******************************************************************************/
cparata 0:69566eea0fba 4885 status_t LSM6DSL_ACC_GYRO_W_BASIC_INT(void *handle, LSM6DSL_ACC_GYRO_INT_EN_t newValue)
cparata 0:69566eea0fba 4886 {
cparata 0:69566eea0fba 4887 u8_t value;
cparata 0:69566eea0fba 4888
cparata 0:69566eea0fba 4889 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:69566eea0fba 4890 return MEMS_ERROR;
cparata 0:69566eea0fba 4891
cparata 0:69566eea0fba 4892 value &= ~LSM6DSL_ACC_GYRO_INT_EN_MASK;
cparata 0:69566eea0fba 4893 value |= newValue;
cparata 0:69566eea0fba 4894
cparata 0:69566eea0fba 4895 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:69566eea0fba 4896 return MEMS_ERROR;
cparata 0:69566eea0fba 4897
cparata 0:69566eea0fba 4898 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4899 }
cparata 0:69566eea0fba 4900
cparata 0:69566eea0fba 4901 /*******************************************************************************
cparata 0:69566eea0fba 4902 * Function Name : LSM6DSL_ACC_GYRO_R_BASIC_INT
cparata 0:69566eea0fba 4903 * Description : Read INTERRUPTS_ENABLE
cparata 0:69566eea0fba 4904 * Input : Pointer to LSM6DSL_ACC_GYRO_INT_EN_t
cparata 0:69566eea0fba 4905 * Output : Status of INTERRUPTS_ENABLE see LSM6DSL_ACC_GYRO_INT_EN_t
cparata 0:69566eea0fba 4906 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4907 *******************************************************************************/
cparata 0:69566eea0fba 4908 status_t LSM6DSL_ACC_GYRO_R_BASIC_INT(void *handle, LSM6DSL_ACC_GYRO_INT_EN_t *value)
cparata 0:69566eea0fba 4909 {
cparata 0:69566eea0fba 4910 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4911 return MEMS_ERROR;
cparata 0:69566eea0fba 4912
cparata 0:69566eea0fba 4913 *value &= LSM6DSL_ACC_GYRO_INT_EN_MASK; //mask
cparata 0:69566eea0fba 4914
cparata 0:69566eea0fba 4915 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4916 }
cparata 0:69566eea0fba 4917
cparata 0:69566eea0fba 4918 /*******************************************************************************
cparata 0:69566eea0fba 4919 * Function Name : LSM6DSL_ACC_GYRO_W_TAP_THS
cparata 0:69566eea0fba 4920 * Description : Write TAP_THS
cparata 0:69566eea0fba 4921 * Input : u8_t
cparata 0:69566eea0fba 4922 * Output : None
cparata 0:69566eea0fba 4923 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4924 *******************************************************************************/
cparata 0:69566eea0fba 4925 status_t LSM6DSL_ACC_GYRO_W_TAP_THS(void *handle, u8_t newValue)
cparata 0:69566eea0fba 4926 {
cparata 0:69566eea0fba 4927 u8_t value;
cparata 0:69566eea0fba 4928
cparata 0:69566eea0fba 4929 newValue = newValue << LSM6DSL_ACC_GYRO_TAP_THS_POSITION; //mask
cparata 0:69566eea0fba 4930 newValue &= LSM6DSL_ACC_GYRO_TAP_THS_MASK; //coerce
cparata 0:69566eea0fba 4931
cparata 0:69566eea0fba 4932 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, &value, 1) )
cparata 0:69566eea0fba 4933 return MEMS_ERROR;
cparata 0:69566eea0fba 4934
cparata 0:69566eea0fba 4935 value &= ~LSM6DSL_ACC_GYRO_TAP_THS_MASK;
cparata 0:69566eea0fba 4936 value |= newValue;
cparata 0:69566eea0fba 4937
cparata 0:69566eea0fba 4938 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, &value, 1) )
cparata 0:69566eea0fba 4939 return MEMS_ERROR;
cparata 0:69566eea0fba 4940
cparata 0:69566eea0fba 4941 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4942 }
cparata 0:69566eea0fba 4943
cparata 0:69566eea0fba 4944 /*******************************************************************************
cparata 0:69566eea0fba 4945 * Function Name : LSM6DSL_ACC_GYRO_R_TAP_THS
cparata 0:69566eea0fba 4946 * Description : Read TAP_THS
cparata 0:69566eea0fba 4947 * Input : Pointer to u8_t
cparata 0:69566eea0fba 4948 * Output : Status of TAP_THS
cparata 0:69566eea0fba 4949 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4950 *******************************************************************************/
cparata 0:69566eea0fba 4951 status_t LSM6DSL_ACC_GYRO_R_TAP_THS(void *handle, u8_t *value)
cparata 0:69566eea0fba 4952 {
cparata 0:69566eea0fba 4953 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4954 return MEMS_ERROR;
cparata 0:69566eea0fba 4955
cparata 0:69566eea0fba 4956 *value &= LSM6DSL_ACC_GYRO_TAP_THS_MASK; //coerce
cparata 0:69566eea0fba 4957 *value = *value >> LSM6DSL_ACC_GYRO_TAP_THS_POSITION; //mask
cparata 0:69566eea0fba 4958
cparata 0:69566eea0fba 4959 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4960 }
cparata 0:69566eea0fba 4961
cparata 0:69566eea0fba 4962 /*******************************************************************************
cparata 0:69566eea0fba 4963 * Function Name : LSM6DSL_ACC_GYRO_W_SIXD_THS
cparata 0:69566eea0fba 4964 * Description : Write SIXD_THS
cparata 0:69566eea0fba 4965 * Input : LSM6DSL_ACC_GYRO_SIXD_THS_t
cparata 0:69566eea0fba 4966 * Output : None
cparata 0:69566eea0fba 4967 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4968 *******************************************************************************/
cparata 0:69566eea0fba 4969 status_t LSM6DSL_ACC_GYRO_W_SIXD_THS(void *handle, LSM6DSL_ACC_GYRO_SIXD_THS_t newValue)
cparata 0:69566eea0fba 4970 {
cparata 0:69566eea0fba 4971 u8_t value;
cparata 0:69566eea0fba 4972
cparata 0:69566eea0fba 4973 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, &value, 1) )
cparata 0:69566eea0fba 4974 return MEMS_ERROR;
cparata 0:69566eea0fba 4975
cparata 0:69566eea0fba 4976 value &= ~LSM6DSL_ACC_GYRO_SIXD_THS_MASK;
cparata 0:69566eea0fba 4977 value |= newValue;
cparata 0:69566eea0fba 4978
cparata 0:69566eea0fba 4979 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, &value, 1) )
cparata 0:69566eea0fba 4980 return MEMS_ERROR;
cparata 0:69566eea0fba 4981
cparata 0:69566eea0fba 4982 return MEMS_SUCCESS;
cparata 0:69566eea0fba 4983 }
cparata 0:69566eea0fba 4984
cparata 0:69566eea0fba 4985 /*******************************************************************************
cparata 0:69566eea0fba 4986 * Function Name : LSM6DSL_ACC_GYRO_R_SIXD_THS
cparata 0:69566eea0fba 4987 * Description : Read SIXD_THS
cparata 0:69566eea0fba 4988 * Input : Pointer to LSM6DSL_ACC_GYRO_SIXD_THS_t
cparata 0:69566eea0fba 4989 * Output : Status of SIXD_THS see LSM6DSL_ACC_GYRO_SIXD_THS_t
cparata 0:69566eea0fba 4990 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 4991 *******************************************************************************/
cparata 0:69566eea0fba 4992 status_t LSM6DSL_ACC_GYRO_R_SIXD_THS(void *handle, LSM6DSL_ACC_GYRO_SIXD_THS_t *value)
cparata 0:69566eea0fba 4993 {
cparata 0:69566eea0fba 4994 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, (u8_t *)value, 1) )
cparata 0:69566eea0fba 4995 return MEMS_ERROR;
cparata 0:69566eea0fba 4996
cparata 0:69566eea0fba 4997 *value &= LSM6DSL_ACC_GYRO_SIXD_THS_MASK; //mask
cparata 0:69566eea0fba 4998
cparata 0:69566eea0fba 4999 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5000 }
cparata 0:69566eea0fba 5001
cparata 0:69566eea0fba 5002 /*******************************************************************************
cparata 0:69566eea0fba 5003 * Function Name : LSM6DSL_ACC_GYRO_W_D4D
cparata 0:69566eea0fba 5004 * Description : Write D4D_EN
cparata 0:69566eea0fba 5005 * Input : LSM6DSL_ACC_GYRO_D4D_t
cparata 0:69566eea0fba 5006 * Output : None
cparata 0:69566eea0fba 5007 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5008 *******************************************************************************/
cparata 0:69566eea0fba 5009 status_t LSM6DSL_ACC_GYRO_W_D4D(void *handle, LSM6DSL_ACC_GYRO_D4D_t newValue)
cparata 0:69566eea0fba 5010 {
cparata 0:69566eea0fba 5011 u8_t value;
cparata 0:69566eea0fba 5012
cparata 0:69566eea0fba 5013 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, &value, 1) )
cparata 0:69566eea0fba 5014 return MEMS_ERROR;
cparata 0:69566eea0fba 5015
cparata 0:69566eea0fba 5016 value &= ~LSM6DSL_ACC_GYRO_D4D_MASK;
cparata 0:69566eea0fba 5017 value |= newValue;
cparata 0:69566eea0fba 5018
cparata 0:69566eea0fba 5019 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, &value, 1) )
cparata 0:69566eea0fba 5020 return MEMS_ERROR;
cparata 0:69566eea0fba 5021
cparata 0:69566eea0fba 5022 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5023 }
cparata 0:69566eea0fba 5024
cparata 0:69566eea0fba 5025 /*******************************************************************************
cparata 0:69566eea0fba 5026 * Function Name : LSM6DSL_ACC_GYRO_R_D4D
cparata 0:69566eea0fba 5027 * Description : Read D4D_EN
cparata 0:69566eea0fba 5028 * Input : Pointer to LSM6DSL_ACC_GYRO_D4D_t
cparata 0:69566eea0fba 5029 * Output : Status of D4D_EN see LSM6DSL_ACC_GYRO_D4D_t
cparata 0:69566eea0fba 5030 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5031 *******************************************************************************/
cparata 0:69566eea0fba 5032 status_t LSM6DSL_ACC_GYRO_R_D4D(void *handle, LSM6DSL_ACC_GYRO_D4D_t *value)
cparata 0:69566eea0fba 5033 {
cparata 0:69566eea0fba 5034 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, (u8_t *)value, 1) )
cparata 0:69566eea0fba 5035 return MEMS_ERROR;
cparata 0:69566eea0fba 5036
cparata 0:69566eea0fba 5037 *value &= LSM6DSL_ACC_GYRO_D4D_MASK; //mask
cparata 0:69566eea0fba 5038
cparata 0:69566eea0fba 5039 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5040 }
cparata 0:69566eea0fba 5041
cparata 0:69566eea0fba 5042 /*******************************************************************************
cparata 0:69566eea0fba 5043 * Function Name : LSM6DSL_ACC_GYRO_W_SHOCK_Duration
cparata 0:69566eea0fba 5044 * Description : Write SHOCK
cparata 0:69566eea0fba 5045 * Input : u8_t
cparata 0:69566eea0fba 5046 * Output : None
cparata 0:69566eea0fba 5047 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5048 *******************************************************************************/
cparata 0:69566eea0fba 5049 status_t LSM6DSL_ACC_GYRO_W_SHOCK_Duration(void *handle, u8_t newValue)
cparata 0:69566eea0fba 5050 {
cparata 0:69566eea0fba 5051 u8_t value;
cparata 0:69566eea0fba 5052
cparata 0:69566eea0fba 5053 newValue = newValue << LSM6DSL_ACC_GYRO_SHOCK_POSITION; //mask
cparata 0:69566eea0fba 5054 newValue &= LSM6DSL_ACC_GYRO_SHOCK_MASK; //coerce
cparata 0:69566eea0fba 5055
cparata 0:69566eea0fba 5056 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, &value, 1) )
cparata 0:69566eea0fba 5057 return MEMS_ERROR;
cparata 0:69566eea0fba 5058
cparata 0:69566eea0fba 5059 value &= ~LSM6DSL_ACC_GYRO_SHOCK_MASK;
cparata 0:69566eea0fba 5060 value |= newValue;
cparata 0:69566eea0fba 5061
cparata 0:69566eea0fba 5062 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, &value, 1) )
cparata 0:69566eea0fba 5063 return MEMS_ERROR;
cparata 0:69566eea0fba 5064
cparata 0:69566eea0fba 5065 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5066 }
cparata 0:69566eea0fba 5067
cparata 0:69566eea0fba 5068 /*******************************************************************************
cparata 0:69566eea0fba 5069 * Function Name : LSM6DSL_ACC_GYRO_R_SHOCK_Duration
cparata 0:69566eea0fba 5070 * Description : Read SHOCK
cparata 0:69566eea0fba 5071 * Input : Pointer to u8_t
cparata 0:69566eea0fba 5072 * Output : Status of SHOCK
cparata 0:69566eea0fba 5073 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5074 *******************************************************************************/
cparata 0:69566eea0fba 5075 status_t LSM6DSL_ACC_GYRO_R_SHOCK_Duration(void *handle, u8_t *value)
cparata 0:69566eea0fba 5076 {
cparata 0:69566eea0fba 5077 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, (u8_t *)value, 1) )
cparata 0:69566eea0fba 5078 return MEMS_ERROR;
cparata 0:69566eea0fba 5079
cparata 0:69566eea0fba 5080 *value &= LSM6DSL_ACC_GYRO_SHOCK_MASK; //coerce
cparata 0:69566eea0fba 5081 *value = *value >> LSM6DSL_ACC_GYRO_SHOCK_POSITION; //mask
cparata 0:69566eea0fba 5082
cparata 0:69566eea0fba 5083 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5084 }
cparata 0:69566eea0fba 5085 /*******************************************************************************
cparata 0:69566eea0fba 5086 * Function Name : LSM6DSL_ACC_GYRO_W_QUIET_Duration
cparata 0:69566eea0fba 5087 * Description : Write QUIET
cparata 0:69566eea0fba 5088 * Input : u8_t
cparata 0:69566eea0fba 5089 * Output : None
cparata 0:69566eea0fba 5090 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5091 *******************************************************************************/
cparata 0:69566eea0fba 5092 status_t LSM6DSL_ACC_GYRO_W_QUIET_Duration(void *handle, u8_t newValue)
cparata 0:69566eea0fba 5093 {
cparata 0:69566eea0fba 5094 u8_t value;
cparata 0:69566eea0fba 5095
cparata 0:69566eea0fba 5096 newValue = newValue << LSM6DSL_ACC_GYRO_QUIET_POSITION; //mask
cparata 0:69566eea0fba 5097 newValue &= LSM6DSL_ACC_GYRO_QUIET_MASK; //coerce
cparata 0:69566eea0fba 5098
cparata 0:69566eea0fba 5099 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, &value, 1) )
cparata 0:69566eea0fba 5100 return MEMS_ERROR;
cparata 0:69566eea0fba 5101
cparata 0:69566eea0fba 5102 value &= ~LSM6DSL_ACC_GYRO_QUIET_MASK;
cparata 0:69566eea0fba 5103 value |= newValue;
cparata 0:69566eea0fba 5104
cparata 0:69566eea0fba 5105 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, &value, 1) )
cparata 0:69566eea0fba 5106 return MEMS_ERROR;
cparata 0:69566eea0fba 5107
cparata 0:69566eea0fba 5108 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5109 }
cparata 0:69566eea0fba 5110
cparata 0:69566eea0fba 5111 /*******************************************************************************
cparata 0:69566eea0fba 5112 * Function Name : LSM6DSL_ACC_GYRO_R_QUIET_Duration
cparata 0:69566eea0fba 5113 * Description : Read QUIET
cparata 0:69566eea0fba 5114 * Input : Pointer to u8_t
cparata 0:69566eea0fba 5115 * Output : Status of QUIET
cparata 0:69566eea0fba 5116 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5117 *******************************************************************************/
cparata 0:69566eea0fba 5118 status_t LSM6DSL_ACC_GYRO_R_QUIET_Duration(void *handle, u8_t *value)
cparata 0:69566eea0fba 5119 {
cparata 0:69566eea0fba 5120 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, (u8_t *)value, 1) )
cparata 0:69566eea0fba 5121 return MEMS_ERROR;
cparata 0:69566eea0fba 5122
cparata 0:69566eea0fba 5123 *value &= LSM6DSL_ACC_GYRO_QUIET_MASK; //coerce
cparata 0:69566eea0fba 5124 *value = *value >> LSM6DSL_ACC_GYRO_QUIET_POSITION; //mask
cparata 0:69566eea0fba 5125
cparata 0:69566eea0fba 5126 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5127 }
cparata 0:69566eea0fba 5128
cparata 0:69566eea0fba 5129 /*******************************************************************************
cparata 0:69566eea0fba 5130 * Function Name : LSM6DSL_ACC_GYRO_W_DUR
cparata 0:69566eea0fba 5131 * Description : Write DUR
cparata 0:69566eea0fba 5132 * Input : u8_t
cparata 0:69566eea0fba 5133 * Output : None
cparata 0:69566eea0fba 5134 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5135 *******************************************************************************/
cparata 0:69566eea0fba 5136 status_t LSM6DSL_ACC_GYRO_W_DUR(void *handle, u8_t newValue)
cparata 0:69566eea0fba 5137 {
cparata 0:69566eea0fba 5138 u8_t value;
cparata 0:69566eea0fba 5139
cparata 0:69566eea0fba 5140 newValue = newValue << LSM6DSL_ACC_GYRO_DUR_POSITION; //mask
cparata 0:69566eea0fba 5141 newValue &= LSM6DSL_ACC_GYRO_DUR_MASK; //coerce
cparata 0:69566eea0fba 5142
cparata 0:69566eea0fba 5143 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, &value, 1) )
cparata 0:69566eea0fba 5144 return MEMS_ERROR;
cparata 0:69566eea0fba 5145
cparata 0:69566eea0fba 5146 value &= ~LSM6DSL_ACC_GYRO_DUR_MASK;
cparata 0:69566eea0fba 5147 value |= newValue;
cparata 0:69566eea0fba 5148
cparata 0:69566eea0fba 5149 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, &value, 1) )
cparata 0:69566eea0fba 5150 return MEMS_ERROR;
cparata 0:69566eea0fba 5151
cparata 0:69566eea0fba 5152 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5153 }
cparata 0:69566eea0fba 5154
cparata 0:69566eea0fba 5155 /*******************************************************************************
cparata 0:69566eea0fba 5156 * Function Name : LSM6DSL_ACC_GYRO_R_DUR
cparata 0:69566eea0fba 5157 * Description : Read DUR
cparata 0:69566eea0fba 5158 * Input : Pointer to u8_t
cparata 0:69566eea0fba 5159 * Output : Status of DUR
cparata 0:69566eea0fba 5160 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5161 *******************************************************************************/
cparata 0:69566eea0fba 5162 status_t LSM6DSL_ACC_GYRO_R_DUR(void *handle, u8_t *value)
cparata 0:69566eea0fba 5163 {
cparata 0:69566eea0fba 5164 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, (u8_t *)value, 1) )
cparata 0:69566eea0fba 5165 return MEMS_ERROR;
cparata 0:69566eea0fba 5166
cparata 0:69566eea0fba 5167 *value &= LSM6DSL_ACC_GYRO_DUR_MASK; //coerce
cparata 0:69566eea0fba 5168 *value = *value >> LSM6DSL_ACC_GYRO_DUR_POSITION; //mask
cparata 0:69566eea0fba 5169
cparata 0:69566eea0fba 5170 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5171 }
cparata 0:69566eea0fba 5172
cparata 0:69566eea0fba 5173 /*******************************************************************************
cparata 0:69566eea0fba 5174 * Function Name : LSM6DSL_ACC_GYRO_W_WK_THS
cparata 0:69566eea0fba 5175 * Description : Write WK_THS
cparata 0:69566eea0fba 5176 * Input : u8_t
cparata 0:69566eea0fba 5177 * Output : None
cparata 0:69566eea0fba 5178 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5179 *******************************************************************************/
cparata 0:69566eea0fba 5180 status_t LSM6DSL_ACC_GYRO_W_WK_THS(void *handle, u8_t newValue)
cparata 0:69566eea0fba 5181 {
cparata 0:69566eea0fba 5182 u8_t value;
cparata 0:69566eea0fba 5183
cparata 0:69566eea0fba 5184 newValue = newValue << LSM6DSL_ACC_GYRO_WK_THS_POSITION; //mask
cparata 0:69566eea0fba 5185 newValue &= LSM6DSL_ACC_GYRO_WK_THS_MASK; //coerce
cparata 0:69566eea0fba 5186
cparata 0:69566eea0fba 5187 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_THS, &value, 1) )
cparata 0:69566eea0fba 5188 return MEMS_ERROR;
cparata 0:69566eea0fba 5189
cparata 0:69566eea0fba 5190 value &= ~LSM6DSL_ACC_GYRO_WK_THS_MASK;
cparata 0:69566eea0fba 5191 value |= newValue;
cparata 0:69566eea0fba 5192
cparata 0:69566eea0fba 5193 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_THS, &value, 1) )
cparata 0:69566eea0fba 5194 return MEMS_ERROR;
cparata 0:69566eea0fba 5195
cparata 0:69566eea0fba 5196 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5197 }
cparata 0:69566eea0fba 5198
cparata 0:69566eea0fba 5199 /*******************************************************************************
cparata 0:69566eea0fba 5200 * Function Name : LSM6DSL_ACC_GYRO_R_WK_THS
cparata 0:69566eea0fba 5201 * Description : Read WK_THS
cparata 0:69566eea0fba 5202 * Input : Pointer to u8_t
cparata 0:69566eea0fba 5203 * Output : Status of WK_THS
cparata 0:69566eea0fba 5204 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5205 *******************************************************************************/
cparata 0:69566eea0fba 5206 status_t LSM6DSL_ACC_GYRO_R_WK_THS(void *handle, u8_t *value)
cparata 0:69566eea0fba 5207 {
cparata 0:69566eea0fba 5208 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_THS, (u8_t *)value, 1) )
cparata 0:69566eea0fba 5209 return MEMS_ERROR;
cparata 0:69566eea0fba 5210
cparata 0:69566eea0fba 5211 *value &= LSM6DSL_ACC_GYRO_WK_THS_MASK; //coerce
cparata 0:69566eea0fba 5212 *value = *value >> LSM6DSL_ACC_GYRO_WK_THS_POSITION; //mask
cparata 0:69566eea0fba 5213
cparata 0:69566eea0fba 5214 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5215 }
cparata 0:69566eea0fba 5216
cparata 0:69566eea0fba 5217 /*******************************************************************************
cparata 0:69566eea0fba 5218 * Function Name : LSM6DSL_ACC_GYRO_W_SINGLE_DOUBLE_TAP_EV
cparata 0:69566eea0fba 5219 * Description : Write SINGLE_DOUBLE_TAP
cparata 0:69566eea0fba 5220 * Input : LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_t
cparata 0:69566eea0fba 5221 * Output : None
cparata 0:69566eea0fba 5222 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5223 *******************************************************************************/
cparata 0:69566eea0fba 5224 status_t LSM6DSL_ACC_GYRO_W_SINGLE_DOUBLE_TAP_EV(void *handle, LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_t newValue)
cparata 0:69566eea0fba 5225 {
cparata 0:69566eea0fba 5226 u8_t value;
cparata 0:69566eea0fba 5227
cparata 0:69566eea0fba 5228 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_THS, &value, 1) )
cparata 0:69566eea0fba 5229 return MEMS_ERROR;
cparata 0:69566eea0fba 5230
cparata 0:69566eea0fba 5231 value &= ~LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_MASK;
cparata 0:69566eea0fba 5232 value |= newValue;
cparata 0:69566eea0fba 5233
cparata 0:69566eea0fba 5234 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_THS, &value, 1) )
cparata 0:69566eea0fba 5235 return MEMS_ERROR;
cparata 0:69566eea0fba 5236
cparata 0:69566eea0fba 5237 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5238 }
cparata 0:69566eea0fba 5239
cparata 0:69566eea0fba 5240 /*******************************************************************************
cparata 0:69566eea0fba 5241 * Function Name : LSM6DSL_ACC_GYRO_R_SINGLE_DOUBLE_TAP_EV
cparata 0:69566eea0fba 5242 * Description : Read SINGLE_DOUBLE_TAP
cparata 0:69566eea0fba 5243 * Input : Pointer to LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_t
cparata 0:69566eea0fba 5244 * Output : Status of SINGLE_DOUBLE_TAP see LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_t
cparata 0:69566eea0fba 5245 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5246 *******************************************************************************/
cparata 0:69566eea0fba 5247 status_t LSM6DSL_ACC_GYRO_R_SINGLE_DOUBLE_TAP_EV(void *handle, LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_t *value)
cparata 0:69566eea0fba 5248 {
cparata 0:69566eea0fba 5249 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_THS, (u8_t *)value, 1) )
cparata 0:69566eea0fba 5250 return MEMS_ERROR;
cparata 0:69566eea0fba 5251
cparata 0:69566eea0fba 5252 *value &= LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_MASK; //mask
cparata 0:69566eea0fba 5253
cparata 0:69566eea0fba 5254 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5255 }
cparata 0:69566eea0fba 5256
cparata 0:69566eea0fba 5257 /*******************************************************************************
cparata 0:69566eea0fba 5258 * Function Name : LSM6DSL_ACC_GYRO_W_SLEEP_DUR
cparata 0:69566eea0fba 5259 * Description : Write SLEEP_DUR
cparata 0:69566eea0fba 5260 * Input : u8_t
cparata 0:69566eea0fba 5261 * Output : None
cparata 0:69566eea0fba 5262 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5263 *******************************************************************************/
cparata 0:69566eea0fba 5264 status_t LSM6DSL_ACC_GYRO_W_SLEEP_DUR(void *handle, u8_t newValue)
cparata 0:69566eea0fba 5265 {
cparata 0:69566eea0fba 5266 u8_t value;
cparata 0:69566eea0fba 5267
cparata 0:69566eea0fba 5268 newValue = newValue << LSM6DSL_ACC_GYRO_SLEEP_DUR_POSITION; //mask
cparata 0:69566eea0fba 5269 newValue &= LSM6DSL_ACC_GYRO_SLEEP_DUR_MASK; //coerce
cparata 0:69566eea0fba 5270
cparata 0:69566eea0fba 5271 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
cparata 0:69566eea0fba 5272 return MEMS_ERROR;
cparata 0:69566eea0fba 5273
cparata 0:69566eea0fba 5274 value &= ~LSM6DSL_ACC_GYRO_SLEEP_DUR_MASK;
cparata 0:69566eea0fba 5275 value |= newValue;
cparata 0:69566eea0fba 5276
cparata 0:69566eea0fba 5277 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
cparata 0:69566eea0fba 5278 return MEMS_ERROR;
cparata 0:69566eea0fba 5279
cparata 0:69566eea0fba 5280 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5281 }
cparata 0:69566eea0fba 5282
cparata 0:69566eea0fba 5283 /*******************************************************************************
cparata 0:69566eea0fba 5284 * Function Name : LSM6DSL_ACC_GYRO_R_SLEEP_DUR
cparata 0:69566eea0fba 5285 * Description : Read SLEEP_DUR
cparata 0:69566eea0fba 5286 * Input : Pointer to u8_t
cparata 0:69566eea0fba 5287 * Output : Status of SLEEP_DUR
cparata 0:69566eea0fba 5288 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5289 *******************************************************************************/
cparata 0:69566eea0fba 5290 status_t LSM6DSL_ACC_GYRO_R_SLEEP_DUR(void *handle, u8_t *value)
cparata 0:69566eea0fba 5291 {
cparata 0:69566eea0fba 5292 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, (u8_t *)value, 1) )
cparata 0:69566eea0fba 5293 return MEMS_ERROR;
cparata 0:69566eea0fba 5294
cparata 0:69566eea0fba 5295 *value &= LSM6DSL_ACC_GYRO_SLEEP_DUR_MASK; //coerce
cparata 0:69566eea0fba 5296 *value = *value >> LSM6DSL_ACC_GYRO_SLEEP_DUR_POSITION; //mask
cparata 0:69566eea0fba 5297
cparata 0:69566eea0fba 5298 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5299 }
cparata 0:69566eea0fba 5300
cparata 0:69566eea0fba 5301 /*******************************************************************************
cparata 0:69566eea0fba 5302 * Function Name : LSM6DSL_ACC_GYRO_W_TIMER_HR
cparata 0:69566eea0fba 5303 * Description : Write TIMER_HR
cparata 0:69566eea0fba 5304 * Input : LSM6DSL_ACC_GYRO_TIMER_HR_t
cparata 0:69566eea0fba 5305 * Output : None
cparata 0:69566eea0fba 5306 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5307 *******************************************************************************/
cparata 0:69566eea0fba 5308 status_t LSM6DSL_ACC_GYRO_W_TIMER_HR(void *handle, LSM6DSL_ACC_GYRO_TIMER_HR_t newValue)
cparata 0:69566eea0fba 5309 {
cparata 0:69566eea0fba 5310 u8_t value;
cparata 0:69566eea0fba 5311
cparata 0:69566eea0fba 5312 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
cparata 0:69566eea0fba 5313 return MEMS_ERROR;
cparata 0:69566eea0fba 5314
cparata 0:69566eea0fba 5315 value &= ~LSM6DSL_ACC_GYRO_TIMER_HR_MASK;
cparata 0:69566eea0fba 5316 value |= newValue;
cparata 0:69566eea0fba 5317
cparata 0:69566eea0fba 5318 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
cparata 0:69566eea0fba 5319 return MEMS_ERROR;
cparata 0:69566eea0fba 5320
cparata 0:69566eea0fba 5321 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5322 }
cparata 0:69566eea0fba 5323
cparata 0:69566eea0fba 5324 /*******************************************************************************
cparata 0:69566eea0fba 5325 * Function Name : LSM6DSL_ACC_GYRO_R_TIMER_HR
cparata 0:69566eea0fba 5326 * Description : Read TIMER_HR
cparata 0:69566eea0fba 5327 * Input : Pointer to LSM6DSL_ACC_GYRO_TIMER_HR_t
cparata 0:69566eea0fba 5328 * Output : Status of TIMER_HR see LSM6DSL_ACC_GYRO_TIMER_HR_t
cparata 0:69566eea0fba 5329 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5330 *******************************************************************************/
cparata 0:69566eea0fba 5331 status_t LSM6DSL_ACC_GYRO_R_TIMER_HR(void *handle, LSM6DSL_ACC_GYRO_TIMER_HR_t *value)
cparata 0:69566eea0fba 5332 {
cparata 0:69566eea0fba 5333 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, (u8_t *)value, 1) )
cparata 0:69566eea0fba 5334 return MEMS_ERROR;
cparata 0:69566eea0fba 5335
cparata 0:69566eea0fba 5336 *value &= LSM6DSL_ACC_GYRO_TIMER_HR_MASK; //mask
cparata 0:69566eea0fba 5337
cparata 0:69566eea0fba 5338 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5339 }
cparata 0:69566eea0fba 5340
cparata 0:69566eea0fba 5341 /*******************************************************************************
cparata 0:69566eea0fba 5342 * Function Name : LSM6DSL_ACC_GYRO_W_WAKE_DUR
cparata 0:69566eea0fba 5343 * Description : Write WAKE_DUR
cparata 0:69566eea0fba 5344 * Input : u8_t
cparata 0:69566eea0fba 5345 * Output : None
cparata 0:69566eea0fba 5346 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5347 *******************************************************************************/
cparata 0:69566eea0fba 5348 status_t LSM6DSL_ACC_GYRO_W_WAKE_DUR(void *handle, u8_t newValue)
cparata 0:69566eea0fba 5349 {
cparata 0:69566eea0fba 5350 u8_t value;
cparata 0:69566eea0fba 5351
cparata 0:69566eea0fba 5352 newValue = newValue << LSM6DSL_ACC_GYRO_WAKE_DUR_POSITION; //mask
cparata 0:69566eea0fba 5353 newValue &= LSM6DSL_ACC_GYRO_WAKE_DUR_MASK; //coerce
cparata 0:69566eea0fba 5354
cparata 0:69566eea0fba 5355 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
cparata 0:69566eea0fba 5356 return MEMS_ERROR;
cparata 0:69566eea0fba 5357
cparata 0:69566eea0fba 5358 value &= ~LSM6DSL_ACC_GYRO_WAKE_DUR_MASK;
cparata 0:69566eea0fba 5359 value |= newValue;
cparata 0:69566eea0fba 5360
cparata 0:69566eea0fba 5361 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
cparata 0:69566eea0fba 5362 return MEMS_ERROR;
cparata 0:69566eea0fba 5363
cparata 0:69566eea0fba 5364 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5365 }
cparata 0:69566eea0fba 5366
cparata 0:69566eea0fba 5367 /*******************************************************************************
cparata 0:69566eea0fba 5368 * Function Name : LSM6DSL_ACC_GYRO_R_WAKE_DUR
cparata 0:69566eea0fba 5369 * Description : Read WAKE_DUR
cparata 0:69566eea0fba 5370 * Input : Pointer to u8_t
cparata 0:69566eea0fba 5371 * Output : Status of WAKE_DUR
cparata 0:69566eea0fba 5372 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5373 *******************************************************************************/
cparata 0:69566eea0fba 5374 status_t LSM6DSL_ACC_GYRO_R_WAKE_DUR(void *handle, u8_t *value)
cparata 0:69566eea0fba 5375 {
cparata 0:69566eea0fba 5376 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, (u8_t *)value, 1) )
cparata 0:69566eea0fba 5377 return MEMS_ERROR;
cparata 0:69566eea0fba 5378
cparata 0:69566eea0fba 5379 *value &= LSM6DSL_ACC_GYRO_WAKE_DUR_MASK; //coerce
cparata 0:69566eea0fba 5380 *value = *value >> LSM6DSL_ACC_GYRO_WAKE_DUR_POSITION; //mask
cparata 0:69566eea0fba 5381
cparata 0:69566eea0fba 5382 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5383 }
cparata 0:69566eea0fba 5384
cparata 0:69566eea0fba 5385 /*******************************************************************************
cparata 0:69566eea0fba 5386 * Function Name : LSM6DSL_ACC_GYRO_W_FF_THS
cparata 0:69566eea0fba 5387 * Description : Write FF_THS
cparata 0:69566eea0fba 5388 * Input : LSM6DSL_ACC_GYRO_FF_THS_t
cparata 0:69566eea0fba 5389 * Output : None
cparata 0:69566eea0fba 5390 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5391 *******************************************************************************/
cparata 0:69566eea0fba 5392 status_t LSM6DSL_ACC_GYRO_W_FF_THS(void *handle, LSM6DSL_ACC_GYRO_FF_THS_t newValue)
cparata 0:69566eea0fba 5393 {
cparata 0:69566eea0fba 5394 u8_t value;
cparata 0:69566eea0fba 5395
cparata 0:69566eea0fba 5396 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FREE_FALL, &value, 1) )
cparata 0:69566eea0fba 5397 return MEMS_ERROR;
cparata 0:69566eea0fba 5398
cparata 0:69566eea0fba 5399 value &= ~LSM6DSL_ACC_GYRO_FF_THS_MASK;
cparata 0:69566eea0fba 5400 value |= newValue;
cparata 0:69566eea0fba 5401
cparata 0:69566eea0fba 5402 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FREE_FALL, &value, 1) )
cparata 0:69566eea0fba 5403 return MEMS_ERROR;
cparata 0:69566eea0fba 5404
cparata 0:69566eea0fba 5405 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5406 }
cparata 0:69566eea0fba 5407
cparata 0:69566eea0fba 5408 /*******************************************************************************
cparata 0:69566eea0fba 5409 * Function Name : LSM6DSL_ACC_GYRO_R_FF_THS
cparata 0:69566eea0fba 5410 * Description : Read FF_THS
cparata 0:69566eea0fba 5411 * Input : Pointer to LSM6DSL_ACC_GYRO_FF_THS_t
cparata 0:69566eea0fba 5412 * Output : Status of FF_THS see LSM6DSL_ACC_GYRO_FF_THS_t
cparata 0:69566eea0fba 5413 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5414 *******************************************************************************/
cparata 0:69566eea0fba 5415 status_t LSM6DSL_ACC_GYRO_R_FF_THS(void *handle, LSM6DSL_ACC_GYRO_FF_THS_t *value)
cparata 0:69566eea0fba 5416 {
cparata 0:69566eea0fba 5417 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FREE_FALL, (u8_t *)value, 1) )
cparata 0:69566eea0fba 5418 return MEMS_ERROR;
cparata 0:69566eea0fba 5419
cparata 0:69566eea0fba 5420 *value &= LSM6DSL_ACC_GYRO_FF_THS_MASK; //mask
cparata 0:69566eea0fba 5421
cparata 0:69566eea0fba 5422 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5423 }
cparata 0:69566eea0fba 5424
cparata 0:69566eea0fba 5425 /*******************************************************************************
cparata 0:69566eea0fba 5426 * Function Name : LSM6DSL_ACC_GYRO_W_FF_Duration
cparata 0:69566eea0fba 5427 * Description : Write FF_DUR
cparata 0:69566eea0fba 5428 * Input : u8_t
cparata 0:69566eea0fba 5429 * Output : None
cparata 0:69566eea0fba 5430 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5431 *******************************************************************************/
cparata 0:69566eea0fba 5432 status_t LSM6DSL_ACC_GYRO_W_FF_Duration(void *handle, u8_t newValue)
cparata 0:69566eea0fba 5433 {
cparata 0:69566eea0fba 5434 u8_t valueH, valueL;
cparata 0:69566eea0fba 5435 u8_t value;
cparata 0:69566eea0fba 5436
cparata 0:69566eea0fba 5437 valueL = newValue & 0x1F;
cparata 0:69566eea0fba 5438 valueH = (newValue >> 5) & 0x1;
cparata 0:69566eea0fba 5439
cparata 0:69566eea0fba 5440 /* Low part in FREE_FALL reg */
cparata 0:69566eea0fba 5441 valueL = valueL << LSM6DSL_ACC_GYRO_FF_FREE_FALL_DUR_POSITION; //mask
cparata 0:69566eea0fba 5442 valueL &= LSM6DSL_ACC_GYRO_FF_FREE_FALL_DUR_MASK; //coerce
cparata 0:69566eea0fba 5443
cparata 0:69566eea0fba 5444 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FREE_FALL, &value, 1) )
cparata 0:69566eea0fba 5445 return MEMS_ERROR;
cparata 0:69566eea0fba 5446
cparata 0:69566eea0fba 5447 value &= ~LSM6DSL_ACC_GYRO_FF_FREE_FALL_DUR_MASK;
cparata 0:69566eea0fba 5448 value |= valueL;
cparata 0:69566eea0fba 5449
cparata 0:69566eea0fba 5450 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FREE_FALL, &value, 1) )
cparata 0:69566eea0fba 5451 return MEMS_ERROR;
cparata 0:69566eea0fba 5452
cparata 0:69566eea0fba 5453 /* High part in WAKE_UP_DUR reg */
cparata 0:69566eea0fba 5454 valueH = valueH << LSM6DSL_ACC_GYRO_FF_WAKE_UP_DUR_POSITION; //mask
cparata 0:69566eea0fba 5455 valueH &= LSM6DSL_ACC_GYRO_FF_WAKE_UP_DUR_MASK; //coerce
cparata 0:69566eea0fba 5456
cparata 0:69566eea0fba 5457 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
cparata 0:69566eea0fba 5458 return MEMS_ERROR;
cparata 0:69566eea0fba 5459
cparata 0:69566eea0fba 5460 value &= ~LSM6DSL_ACC_GYRO_FF_WAKE_UP_DUR_MASK;
cparata 0:69566eea0fba 5461 value |= valueH;
cparata 0:69566eea0fba 5462
cparata 0:69566eea0fba 5463 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
cparata 0:69566eea0fba 5464 return MEMS_ERROR;
cparata 0:69566eea0fba 5465
cparata 0:69566eea0fba 5466 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5467 }
cparata 0:69566eea0fba 5468
cparata 0:69566eea0fba 5469 /*******************************************************************************
cparata 0:69566eea0fba 5470 * Function Name : LSM6DSL_ACC_GYRO_R_FF_Duration
cparata 0:69566eea0fba 5471 * Description : Read FF_DUR
cparata 0:69566eea0fba 5472 * Input : Pointer to u8_t
cparata 0:69566eea0fba 5473 * Output : Status of FF_DUR
cparata 0:69566eea0fba 5474 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5475 *******************************************************************************/
cparata 0:69566eea0fba 5476 status_t LSM6DSL_ACC_GYRO_R_FF_Duration(void *handle, u8_t *value)
cparata 0:69566eea0fba 5477 {
cparata 0:69566eea0fba 5478 u8_t valueH, valueL;
cparata 0:69566eea0fba 5479
cparata 0:69566eea0fba 5480 /* Low part from FREE_FALL reg */
cparata 0:69566eea0fba 5481 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FREE_FALL, (u8_t *)&valueL, 1) )
cparata 0:69566eea0fba 5482 return MEMS_ERROR;
cparata 0:69566eea0fba 5483
cparata 0:69566eea0fba 5484 valueL &= LSM6DSL_ACC_GYRO_FF_FREE_FALL_DUR_MASK; //coerce
cparata 0:69566eea0fba 5485 valueL = valueL >> LSM6DSL_ACC_GYRO_FF_FREE_FALL_DUR_POSITION; //mask
cparata 0:69566eea0fba 5486
cparata 0:69566eea0fba 5487 /* High part from WAKE_UP_DUR reg */
cparata 0:69566eea0fba 5488 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, (u8_t *)&valueH, 1) )
cparata 0:69566eea0fba 5489 return MEMS_ERROR;
cparata 0:69566eea0fba 5490
cparata 0:69566eea0fba 5491 valueH &= LSM6DSL_ACC_GYRO_FF_WAKE_UP_DUR_MASK; //coerce
cparata 0:69566eea0fba 5492 valueH = valueH >> LSM6DSL_ACC_GYRO_FF_WAKE_UP_DUR_POSITION; //mask
cparata 0:69566eea0fba 5493
cparata 0:69566eea0fba 5494 *value = ((valueH << 5) & 0x20) | valueL;
cparata 0:69566eea0fba 5495
cparata 0:69566eea0fba 5496 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5497 }
cparata 0:69566eea0fba 5498
cparata 0:69566eea0fba 5499 /*******************************************************************************
cparata 0:69566eea0fba 5500 * Function Name : LSM6DSL_ACC_GYRO_W_TimerEvRouteInt1
cparata 0:69566eea0fba 5501 * Description : Write INT1_TIMER
cparata 0:69566eea0fba 5502 * Input : LSM6DSL_ACC_GYRO_INT1_TIMER_t
cparata 0:69566eea0fba 5503 * Output : None
cparata 0:69566eea0fba 5504 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5505 *******************************************************************************/
cparata 0:69566eea0fba 5506 status_t LSM6DSL_ACC_GYRO_W_TimerEvRouteInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_TIMER_t newValue)
cparata 0:69566eea0fba 5507 {
cparata 0:69566eea0fba 5508 u8_t value;
cparata 0:69566eea0fba 5509
cparata 0:69566eea0fba 5510 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:69566eea0fba 5511 return MEMS_ERROR;
cparata 0:69566eea0fba 5512
cparata 0:69566eea0fba 5513 value &= ~LSM6DSL_ACC_GYRO_INT1_TIMER_MASK;
cparata 0:69566eea0fba 5514 value |= newValue;
cparata 0:69566eea0fba 5515
cparata 0:69566eea0fba 5516 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:69566eea0fba 5517 return MEMS_ERROR;
cparata 0:69566eea0fba 5518
cparata 0:69566eea0fba 5519 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5520 }
cparata 0:69566eea0fba 5521
cparata 0:69566eea0fba 5522 /*******************************************************************************
cparata 0:69566eea0fba 5523 * Function Name : LSM6DSL_ACC_GYRO_R_TimerEvRouteInt1
cparata 0:69566eea0fba 5524 * Description : Read INT1_TIMER
cparata 0:69566eea0fba 5525 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_TIMER_t
cparata 0:69566eea0fba 5526 * Output : Status of INT1_TIMER see LSM6DSL_ACC_GYRO_INT1_TIMER_t
cparata 0:69566eea0fba 5527 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5528 *******************************************************************************/
cparata 0:69566eea0fba 5529 status_t LSM6DSL_ACC_GYRO_R_TimerEvRouteInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_TIMER_t *value)
cparata 0:69566eea0fba 5530 {
cparata 0:69566eea0fba 5531 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
cparata 0:69566eea0fba 5532 return MEMS_ERROR;
cparata 0:69566eea0fba 5533
cparata 0:69566eea0fba 5534 *value &= LSM6DSL_ACC_GYRO_INT1_TIMER_MASK; //mask
cparata 0:69566eea0fba 5535
cparata 0:69566eea0fba 5536 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5537 }
cparata 0:69566eea0fba 5538
cparata 0:69566eea0fba 5539 /*******************************************************************************
cparata 0:69566eea0fba 5540 * Function Name : LSM6DSL_ACC_GYRO_W_TiltEvOnInt1
cparata 0:69566eea0fba 5541 * Description : Write INT1_TILT
cparata 0:69566eea0fba 5542 * Input : LSM6DSL_ACC_GYRO_INT1_TILT_t
cparata 0:69566eea0fba 5543 * Output : None
cparata 0:69566eea0fba 5544 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5545 *******************************************************************************/
cparata 0:69566eea0fba 5546 status_t LSM6DSL_ACC_GYRO_W_TiltEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_TILT_t newValue)
cparata 0:69566eea0fba 5547 {
cparata 0:69566eea0fba 5548 u8_t value;
cparata 0:69566eea0fba 5549
cparata 0:69566eea0fba 5550 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:69566eea0fba 5551 return MEMS_ERROR;
cparata 0:69566eea0fba 5552
cparata 0:69566eea0fba 5553 value &= ~LSM6DSL_ACC_GYRO_INT1_TILT_MASK;
cparata 0:69566eea0fba 5554 value |= newValue;
cparata 0:69566eea0fba 5555
cparata 0:69566eea0fba 5556 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:69566eea0fba 5557 return MEMS_ERROR;
cparata 0:69566eea0fba 5558
cparata 0:69566eea0fba 5559 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5560 }
cparata 0:69566eea0fba 5561
cparata 0:69566eea0fba 5562 /*******************************************************************************
cparata 0:69566eea0fba 5563 * Function Name : LSM6DSL_ACC_GYRO_R_TiltEvOnInt1
cparata 0:69566eea0fba 5564 * Description : Read INT1_TILT
cparata 0:69566eea0fba 5565 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_TILT_t
cparata 0:69566eea0fba 5566 * Output : Status of INT1_TILT see LSM6DSL_ACC_GYRO_INT1_TILT_t
cparata 0:69566eea0fba 5567 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5568 *******************************************************************************/
cparata 0:69566eea0fba 5569 status_t LSM6DSL_ACC_GYRO_R_TiltEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_TILT_t *value)
cparata 0:69566eea0fba 5570 {
cparata 0:69566eea0fba 5571 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
cparata 0:69566eea0fba 5572 return MEMS_ERROR;
cparata 0:69566eea0fba 5573
cparata 0:69566eea0fba 5574 *value &= LSM6DSL_ACC_GYRO_INT1_TILT_MASK; //mask
cparata 0:69566eea0fba 5575
cparata 0:69566eea0fba 5576 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5577 }
cparata 0:69566eea0fba 5578
cparata 0:69566eea0fba 5579 /*******************************************************************************
cparata 0:69566eea0fba 5580 * Function Name : LSM6DSL_ACC_GYRO_W_6DEvOnInt1
cparata 0:69566eea0fba 5581 * Description : Write INT1_6D
cparata 0:69566eea0fba 5582 * Input : LSM6DSL_ACC_GYRO_INT1_6D_t
cparata 0:69566eea0fba 5583 * Output : None
cparata 0:69566eea0fba 5584 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5585 *******************************************************************************/
cparata 0:69566eea0fba 5586 status_t LSM6DSL_ACC_GYRO_W_6DEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_6D_t newValue)
cparata 0:69566eea0fba 5587 {
cparata 0:69566eea0fba 5588 u8_t value;
cparata 0:69566eea0fba 5589
cparata 0:69566eea0fba 5590 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:69566eea0fba 5591 return MEMS_ERROR;
cparata 0:69566eea0fba 5592
cparata 0:69566eea0fba 5593 value &= ~LSM6DSL_ACC_GYRO_INT1_6D_MASK;
cparata 0:69566eea0fba 5594 value |= newValue;
cparata 0:69566eea0fba 5595
cparata 0:69566eea0fba 5596 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:69566eea0fba 5597 return MEMS_ERROR;
cparata 0:69566eea0fba 5598
cparata 0:69566eea0fba 5599 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5600 }
cparata 0:69566eea0fba 5601
cparata 0:69566eea0fba 5602 /*******************************************************************************
cparata 0:69566eea0fba 5603 * Function Name : LSM6DSL_ACC_GYRO_R_6DEvOnInt1
cparata 0:69566eea0fba 5604 * Description : Read INT1_6D
cparata 0:69566eea0fba 5605 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_6D_t
cparata 0:69566eea0fba 5606 * Output : Status of INT1_6D see LSM6DSL_ACC_GYRO_INT1_6D_t
cparata 0:69566eea0fba 5607 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5608 *******************************************************************************/
cparata 0:69566eea0fba 5609 status_t LSM6DSL_ACC_GYRO_R_6DEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_6D_t *value)
cparata 0:69566eea0fba 5610 {
cparata 0:69566eea0fba 5611 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
cparata 0:69566eea0fba 5612 return MEMS_ERROR;
cparata 0:69566eea0fba 5613
cparata 0:69566eea0fba 5614 *value &= LSM6DSL_ACC_GYRO_INT1_6D_MASK; //mask
cparata 0:69566eea0fba 5615
cparata 0:69566eea0fba 5616 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5617 }
cparata 0:69566eea0fba 5618
cparata 0:69566eea0fba 5619 /*******************************************************************************
cparata 0:69566eea0fba 5620 * Function Name : LSM6DSL_ACC_GYRO_W_TapEvOnInt1
cparata 0:69566eea0fba 5621 * Description : Write INT1_TAP
cparata 0:69566eea0fba 5622 * Input : LSM6DSL_ACC_GYRO_INT1_TAP_t
cparata 0:69566eea0fba 5623 * Output : None
cparata 0:69566eea0fba 5624 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5625 *******************************************************************************/
cparata 0:69566eea0fba 5626 status_t LSM6DSL_ACC_GYRO_W_TapEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_TAP_t newValue)
cparata 0:69566eea0fba 5627 {
cparata 0:69566eea0fba 5628 u8_t value;
cparata 0:69566eea0fba 5629
cparata 0:69566eea0fba 5630 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:69566eea0fba 5631 return MEMS_ERROR;
cparata 0:69566eea0fba 5632
cparata 0:69566eea0fba 5633 value &= ~LSM6DSL_ACC_GYRO_INT1_TAP_MASK;
cparata 0:69566eea0fba 5634 value |= newValue;
cparata 0:69566eea0fba 5635
cparata 0:69566eea0fba 5636 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:69566eea0fba 5637 return MEMS_ERROR;
cparata 0:69566eea0fba 5638
cparata 0:69566eea0fba 5639 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5640 }
cparata 0:69566eea0fba 5641
cparata 0:69566eea0fba 5642 /*******************************************************************************
cparata 0:69566eea0fba 5643 * Function Name : LSM6DSL_ACC_GYRO_R_TapEvOnInt1
cparata 0:69566eea0fba 5644 * Description : Read INT1_TAP
cparata 0:69566eea0fba 5645 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_TAP_t
cparata 0:69566eea0fba 5646 * Output : Status of INT1_TAP see LSM6DSL_ACC_GYRO_INT1_TAP_t
cparata 0:69566eea0fba 5647 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5648 *******************************************************************************/
cparata 0:69566eea0fba 5649 status_t LSM6DSL_ACC_GYRO_R_TapEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_TAP_t *value)
cparata 0:69566eea0fba 5650 {
cparata 0:69566eea0fba 5651 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
cparata 0:69566eea0fba 5652 return MEMS_ERROR;
cparata 0:69566eea0fba 5653
cparata 0:69566eea0fba 5654 *value &= LSM6DSL_ACC_GYRO_INT1_TAP_MASK; //mask
cparata 0:69566eea0fba 5655
cparata 0:69566eea0fba 5656 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5657 }
cparata 0:69566eea0fba 5658
cparata 0:69566eea0fba 5659 /*******************************************************************************
cparata 0:69566eea0fba 5660 * Function Name : LSM6DSL_ACC_GYRO_W_FFEvOnInt1
cparata 0:69566eea0fba 5661 * Description : Write INT1_FF
cparata 0:69566eea0fba 5662 * Input : LSM6DSL_ACC_GYRO_INT1_FF_t
cparata 0:69566eea0fba 5663 * Output : None
cparata 0:69566eea0fba 5664 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5665 *******************************************************************************/
cparata 0:69566eea0fba 5666 status_t LSM6DSL_ACC_GYRO_W_FFEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_FF_t newValue)
cparata 0:69566eea0fba 5667 {
cparata 0:69566eea0fba 5668 u8_t value;
cparata 0:69566eea0fba 5669
cparata 0:69566eea0fba 5670 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:69566eea0fba 5671 return MEMS_ERROR;
cparata 0:69566eea0fba 5672
cparata 0:69566eea0fba 5673 value &= ~LSM6DSL_ACC_GYRO_INT1_FF_MASK;
cparata 0:69566eea0fba 5674 value |= newValue;
cparata 0:69566eea0fba 5675
cparata 0:69566eea0fba 5676 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:69566eea0fba 5677 return MEMS_ERROR;
cparata 0:69566eea0fba 5678
cparata 0:69566eea0fba 5679 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5680 }
cparata 0:69566eea0fba 5681
cparata 0:69566eea0fba 5682 /*******************************************************************************
cparata 0:69566eea0fba 5683 * Function Name : LSM6DSL_ACC_GYRO_R_FFEvOnInt1
cparata 0:69566eea0fba 5684 * Description : Read INT1_FF
cparata 0:69566eea0fba 5685 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_FF_t
cparata 0:69566eea0fba 5686 * Output : Status of INT1_FF see LSM6DSL_ACC_GYRO_INT1_FF_t
cparata 0:69566eea0fba 5687 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5688 *******************************************************************************/
cparata 0:69566eea0fba 5689 status_t LSM6DSL_ACC_GYRO_R_FFEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_FF_t *value)
cparata 0:69566eea0fba 5690 {
cparata 0:69566eea0fba 5691 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
cparata 0:69566eea0fba 5692 return MEMS_ERROR;
cparata 0:69566eea0fba 5693
cparata 0:69566eea0fba 5694 *value &= LSM6DSL_ACC_GYRO_INT1_FF_MASK; //mask
cparata 0:69566eea0fba 5695
cparata 0:69566eea0fba 5696 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5697 }
cparata 0:69566eea0fba 5698
cparata 0:69566eea0fba 5699 /*******************************************************************************
cparata 0:69566eea0fba 5700 * Function Name : LSM6DSL_ACC_GYRO_W_WUEvOnInt1
cparata 0:69566eea0fba 5701 * Description : Write INT1_WU
cparata 0:69566eea0fba 5702 * Input : LSM6DSL_ACC_GYRO_INT1_WU_t
cparata 0:69566eea0fba 5703 * Output : None
cparata 0:69566eea0fba 5704 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5705 *******************************************************************************/
cparata 0:69566eea0fba 5706 status_t LSM6DSL_ACC_GYRO_W_WUEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_WU_t newValue)
cparata 0:69566eea0fba 5707 {
cparata 0:69566eea0fba 5708 u8_t value;
cparata 0:69566eea0fba 5709
cparata 0:69566eea0fba 5710 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:69566eea0fba 5711 return MEMS_ERROR;
cparata 0:69566eea0fba 5712
cparata 0:69566eea0fba 5713 value &= ~LSM6DSL_ACC_GYRO_INT1_WU_MASK;
cparata 0:69566eea0fba 5714 value |= newValue;
cparata 0:69566eea0fba 5715
cparata 0:69566eea0fba 5716 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:69566eea0fba 5717 return MEMS_ERROR;
cparata 0:69566eea0fba 5718
cparata 0:69566eea0fba 5719 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5720 }
cparata 0:69566eea0fba 5721
cparata 0:69566eea0fba 5722 /*******************************************************************************
cparata 0:69566eea0fba 5723 * Function Name : LSM6DSL_ACC_GYRO_R_WUEvOnInt1
cparata 0:69566eea0fba 5724 * Description : Read INT1_WU
cparata 0:69566eea0fba 5725 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_WU_t
cparata 0:69566eea0fba 5726 * Output : Status of INT1_WU see LSM6DSL_ACC_GYRO_INT1_WU_t
cparata 0:69566eea0fba 5727 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5728 *******************************************************************************/
cparata 0:69566eea0fba 5729 status_t LSM6DSL_ACC_GYRO_R_WUEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_WU_t *value)
cparata 0:69566eea0fba 5730 {
cparata 0:69566eea0fba 5731 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
cparata 0:69566eea0fba 5732 return MEMS_ERROR;
cparata 0:69566eea0fba 5733
cparata 0:69566eea0fba 5734 *value &= LSM6DSL_ACC_GYRO_INT1_WU_MASK; //mask
cparata 0:69566eea0fba 5735
cparata 0:69566eea0fba 5736 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5737 }
cparata 0:69566eea0fba 5738
cparata 0:69566eea0fba 5739 /*******************************************************************************
cparata 0:69566eea0fba 5740 * Function Name : LSM6DSL_ACC_GYRO_W_SingleTapOnInt1
cparata 0:69566eea0fba 5741 * Description : Write INT1_SINGLE_TAP
cparata 0:69566eea0fba 5742 * Input : LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_t
cparata 0:69566eea0fba 5743 * Output : None
cparata 0:69566eea0fba 5744 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5745 *******************************************************************************/
cparata 0:69566eea0fba 5746 status_t LSM6DSL_ACC_GYRO_W_SingleTapOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_t newValue)
cparata 0:69566eea0fba 5747 {
cparata 0:69566eea0fba 5748 u8_t value;
cparata 0:69566eea0fba 5749
cparata 0:69566eea0fba 5750 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:69566eea0fba 5751 return MEMS_ERROR;
cparata 0:69566eea0fba 5752
cparata 0:69566eea0fba 5753 value &= ~LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_MASK;
cparata 0:69566eea0fba 5754 value |= newValue;
cparata 0:69566eea0fba 5755
cparata 0:69566eea0fba 5756 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:69566eea0fba 5757 return MEMS_ERROR;
cparata 0:69566eea0fba 5758
cparata 0:69566eea0fba 5759 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5760 }
cparata 0:69566eea0fba 5761
cparata 0:69566eea0fba 5762 /*******************************************************************************
cparata 0:69566eea0fba 5763 * Function Name : LSM6DSL_ACC_GYRO_R_SingleTapOnInt1
cparata 0:69566eea0fba 5764 * Description : Read INT1_SINGLE_TAP
cparata 0:69566eea0fba 5765 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_t
cparata 0:69566eea0fba 5766 * Output : Status of INT1_SINGLE_TAP see LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_t
cparata 0:69566eea0fba 5767 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5768 *******************************************************************************/
cparata 0:69566eea0fba 5769 status_t LSM6DSL_ACC_GYRO_R_SingleTapOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_t *value)
cparata 0:69566eea0fba 5770 {
cparata 0:69566eea0fba 5771 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
cparata 0:69566eea0fba 5772 return MEMS_ERROR;
cparata 0:69566eea0fba 5773
cparata 0:69566eea0fba 5774 *value &= LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_MASK; //mask
cparata 0:69566eea0fba 5775
cparata 0:69566eea0fba 5776 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5777 }
cparata 0:69566eea0fba 5778
cparata 0:69566eea0fba 5779 /*******************************************************************************
cparata 0:69566eea0fba 5780 * Function Name : LSM6DSL_ACC_GYRO_W_SleepEvOnInt1
cparata 0:69566eea0fba 5781 * Description : Write INT1_SLEEP
cparata 0:69566eea0fba 5782 * Input : LSM6DSL_ACC_GYRO_INT1_SLEEP_t
cparata 0:69566eea0fba 5783 * Output : None
cparata 0:69566eea0fba 5784 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5785 *******************************************************************************/
cparata 0:69566eea0fba 5786 status_t LSM6DSL_ACC_GYRO_W_SleepEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_SLEEP_t newValue)
cparata 0:69566eea0fba 5787 {
cparata 0:69566eea0fba 5788 u8_t value;
cparata 0:69566eea0fba 5789
cparata 0:69566eea0fba 5790 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:69566eea0fba 5791 return MEMS_ERROR;
cparata 0:69566eea0fba 5792
cparata 0:69566eea0fba 5793 value &= ~LSM6DSL_ACC_GYRO_INT1_SLEEP_MASK;
cparata 0:69566eea0fba 5794 value |= newValue;
cparata 0:69566eea0fba 5795
cparata 0:69566eea0fba 5796 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:69566eea0fba 5797 return MEMS_ERROR;
cparata 0:69566eea0fba 5798
cparata 0:69566eea0fba 5799 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5800 }
cparata 0:69566eea0fba 5801
cparata 0:69566eea0fba 5802 /*******************************************************************************
cparata 0:69566eea0fba 5803 * Function Name : LSM6DSL_ACC_GYRO_R_SleepEvOnInt1
cparata 0:69566eea0fba 5804 * Description : Read INT1_SLEEP
cparata 0:69566eea0fba 5805 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_SLEEP_t
cparata 0:69566eea0fba 5806 * Output : Status of INT1_SLEEP see LSM6DSL_ACC_GYRO_INT1_SLEEP_t
cparata 0:69566eea0fba 5807 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5808 *******************************************************************************/
cparata 0:69566eea0fba 5809 status_t LSM6DSL_ACC_GYRO_R_SleepEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_SLEEP_t *value)
cparata 0:69566eea0fba 5810 {
cparata 0:69566eea0fba 5811 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
cparata 0:69566eea0fba 5812 return MEMS_ERROR;
cparata 0:69566eea0fba 5813
cparata 0:69566eea0fba 5814 *value &= LSM6DSL_ACC_GYRO_INT1_SLEEP_MASK; //mask
cparata 0:69566eea0fba 5815
cparata 0:69566eea0fba 5816 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5817 }
cparata 0:69566eea0fba 5818
cparata 0:69566eea0fba 5819 /*******************************************************************************
cparata 0:69566eea0fba 5820 * Function Name : LSM6DSL_ACC_GYRO_W_MagCorrection_Int2
cparata 0:69566eea0fba 5821 * Description : Write INT2_IRON
cparata 0:69566eea0fba 5822 * Input : LSM6DSL_ACC_GYRO_INT2_IRON_t
cparata 0:69566eea0fba 5823 * Output : None
cparata 0:69566eea0fba 5824 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5825 *******************************************************************************/
cparata 0:69566eea0fba 5826 status_t LSM6DSL_ACC_GYRO_W_MagCorrection_Int2(void *handle, LSM6DSL_ACC_GYRO_INT2_IRON_t newValue)
cparata 0:69566eea0fba 5827 {
cparata 0:69566eea0fba 5828 u8_t value;
cparata 0:69566eea0fba 5829
cparata 0:69566eea0fba 5830 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:69566eea0fba 5831 return MEMS_ERROR;
cparata 0:69566eea0fba 5832
cparata 0:69566eea0fba 5833 value &= ~LSM6DSL_ACC_GYRO_INT2_IRON_MASK;
cparata 0:69566eea0fba 5834 value |= newValue;
cparata 0:69566eea0fba 5835
cparata 0:69566eea0fba 5836 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:69566eea0fba 5837 return MEMS_ERROR;
cparata 0:69566eea0fba 5838
cparata 0:69566eea0fba 5839 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5840 }
cparata 0:69566eea0fba 5841
cparata 0:69566eea0fba 5842 /*******************************************************************************
cparata 0:69566eea0fba 5843 * Function Name : LSM6DSL_ACC_GYRO_R_MagCorrection_Int2
cparata 0:69566eea0fba 5844 * Description : Read INT2_IRON
cparata 0:69566eea0fba 5845 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_IRON_t
cparata 0:69566eea0fba 5846 * Output : Status of INT2_IRON see LSM6DSL_ACC_GYRO_INT2_IRON_t
cparata 0:69566eea0fba 5847 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5848 *******************************************************************************/
cparata 0:69566eea0fba 5849 status_t LSM6DSL_ACC_GYRO_R_MagCorrection_Int2(void *handle, LSM6DSL_ACC_GYRO_INT2_IRON_t *value)
cparata 0:69566eea0fba 5850 {
cparata 0:69566eea0fba 5851 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
cparata 0:69566eea0fba 5852 return MEMS_ERROR;
cparata 0:69566eea0fba 5853
cparata 0:69566eea0fba 5854 *value &= LSM6DSL_ACC_GYRO_INT2_IRON_MASK; //mask
cparata 0:69566eea0fba 5855
cparata 0:69566eea0fba 5856 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5857 }
cparata 0:69566eea0fba 5858
cparata 0:69566eea0fba 5859 /*******************************************************************************
cparata 0:69566eea0fba 5860 * Function Name : LSM6DSL_ACC_GYRO_W_TiltEvOnInt2
cparata 0:69566eea0fba 5861 * Description : Write INT2_TILT
cparata 0:69566eea0fba 5862 * Input : LSM6DSL_ACC_GYRO_INT2_TILT_t
cparata 0:69566eea0fba 5863 * Output : None
cparata 0:69566eea0fba 5864 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5865 *******************************************************************************/
cparata 0:69566eea0fba 5866 status_t LSM6DSL_ACC_GYRO_W_TiltEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_TILT_t newValue)
cparata 0:69566eea0fba 5867 {
cparata 0:69566eea0fba 5868 u8_t value;
cparata 0:69566eea0fba 5869
cparata 0:69566eea0fba 5870 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:69566eea0fba 5871 return MEMS_ERROR;
cparata 0:69566eea0fba 5872
cparata 0:69566eea0fba 5873 value &= ~LSM6DSL_ACC_GYRO_INT2_TILT_MASK;
cparata 0:69566eea0fba 5874 value |= newValue;
cparata 0:69566eea0fba 5875
cparata 0:69566eea0fba 5876 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:69566eea0fba 5877 return MEMS_ERROR;
cparata 0:69566eea0fba 5878
cparata 0:69566eea0fba 5879 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5880 }
cparata 0:69566eea0fba 5881
cparata 0:69566eea0fba 5882 /*******************************************************************************
cparata 0:69566eea0fba 5883 * Function Name : LSM6DSL_ACC_GYRO_R_TiltEvOnInt2
cparata 0:69566eea0fba 5884 * Description : Read INT2_TILT
cparata 0:69566eea0fba 5885 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_TILT_t
cparata 0:69566eea0fba 5886 * Output : Status of INT2_TILT see LSM6DSL_ACC_GYRO_INT2_TILT_t
cparata 0:69566eea0fba 5887 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5888 *******************************************************************************/
cparata 0:69566eea0fba 5889 status_t LSM6DSL_ACC_GYRO_R_TiltEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_TILT_t *value)
cparata 0:69566eea0fba 5890 {
cparata 0:69566eea0fba 5891 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
cparata 0:69566eea0fba 5892 return MEMS_ERROR;
cparata 0:69566eea0fba 5893
cparata 0:69566eea0fba 5894 *value &= LSM6DSL_ACC_GYRO_INT2_TILT_MASK; //mask
cparata 0:69566eea0fba 5895
cparata 0:69566eea0fba 5896 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5897 }
cparata 0:69566eea0fba 5898
cparata 0:69566eea0fba 5899 /*******************************************************************************
cparata 0:69566eea0fba 5900 * Function Name : LSM6DSL_ACC_GYRO_W_6DEvOnInt2
cparata 0:69566eea0fba 5901 * Description : Write INT2_6D
cparata 0:69566eea0fba 5902 * Input : LSM6DSL_ACC_GYRO_INT2_6D_t
cparata 0:69566eea0fba 5903 * Output : None
cparata 0:69566eea0fba 5904 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5905 *******************************************************************************/
cparata 0:69566eea0fba 5906 status_t LSM6DSL_ACC_GYRO_W_6DEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_6D_t newValue)
cparata 0:69566eea0fba 5907 {
cparata 0:69566eea0fba 5908 u8_t value;
cparata 0:69566eea0fba 5909
cparata 0:69566eea0fba 5910 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:69566eea0fba 5911 return MEMS_ERROR;
cparata 0:69566eea0fba 5912
cparata 0:69566eea0fba 5913 value &= ~LSM6DSL_ACC_GYRO_INT2_6D_MASK;
cparata 0:69566eea0fba 5914 value |= newValue;
cparata 0:69566eea0fba 5915
cparata 0:69566eea0fba 5916 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:69566eea0fba 5917 return MEMS_ERROR;
cparata 0:69566eea0fba 5918
cparata 0:69566eea0fba 5919 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5920 }
cparata 0:69566eea0fba 5921
cparata 0:69566eea0fba 5922 /*******************************************************************************
cparata 0:69566eea0fba 5923 * Function Name : LSM6DSL_ACC_GYRO_R_6DEvOnInt2
cparata 0:69566eea0fba 5924 * Description : Read INT2_6D
cparata 0:69566eea0fba 5925 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_6D_t
cparata 0:69566eea0fba 5926 * Output : Status of INT2_6D see LSM6DSL_ACC_GYRO_INT2_6D_t
cparata 0:69566eea0fba 5927 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5928 *******************************************************************************/
cparata 0:69566eea0fba 5929 status_t LSM6DSL_ACC_GYRO_R_6DEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_6D_t *value)
cparata 0:69566eea0fba 5930 {
cparata 0:69566eea0fba 5931 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
cparata 0:69566eea0fba 5932 return MEMS_ERROR;
cparata 0:69566eea0fba 5933
cparata 0:69566eea0fba 5934 *value &= LSM6DSL_ACC_GYRO_INT2_6D_MASK; //mask
cparata 0:69566eea0fba 5935
cparata 0:69566eea0fba 5936 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5937 }
cparata 0:69566eea0fba 5938
cparata 0:69566eea0fba 5939 /*******************************************************************************
cparata 0:69566eea0fba 5940 * Function Name : LSM6DSL_ACC_GYRO_W_TapEvOnInt2
cparata 0:69566eea0fba 5941 * Description : Write INT2_TAP
cparata 0:69566eea0fba 5942 * Input : LSM6DSL_ACC_GYRO_INT2_TAP_t
cparata 0:69566eea0fba 5943 * Output : None
cparata 0:69566eea0fba 5944 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5945 *******************************************************************************/
cparata 0:69566eea0fba 5946 status_t LSM6DSL_ACC_GYRO_W_TapEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_TAP_t newValue)
cparata 0:69566eea0fba 5947 {
cparata 0:69566eea0fba 5948 u8_t value;
cparata 0:69566eea0fba 5949
cparata 0:69566eea0fba 5950 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:69566eea0fba 5951 return MEMS_ERROR;
cparata 0:69566eea0fba 5952
cparata 0:69566eea0fba 5953 value &= ~LSM6DSL_ACC_GYRO_INT2_TAP_MASK;
cparata 0:69566eea0fba 5954 value |= newValue;
cparata 0:69566eea0fba 5955
cparata 0:69566eea0fba 5956 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:69566eea0fba 5957 return MEMS_ERROR;
cparata 0:69566eea0fba 5958
cparata 0:69566eea0fba 5959 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5960 }
cparata 0:69566eea0fba 5961
cparata 0:69566eea0fba 5962 /*******************************************************************************
cparata 0:69566eea0fba 5963 * Function Name : LSM6DSL_ACC_GYRO_R_TapEvOnInt2
cparata 0:69566eea0fba 5964 * Description : Read INT2_TAP
cparata 0:69566eea0fba 5965 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_TAP_t
cparata 0:69566eea0fba 5966 * Output : Status of INT2_TAP see LSM6DSL_ACC_GYRO_INT2_TAP_t
cparata 0:69566eea0fba 5967 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5968 *******************************************************************************/
cparata 0:69566eea0fba 5969 status_t LSM6DSL_ACC_GYRO_R_TapEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_TAP_t *value)
cparata 0:69566eea0fba 5970 {
cparata 0:69566eea0fba 5971 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
cparata 0:69566eea0fba 5972 return MEMS_ERROR;
cparata 0:69566eea0fba 5973
cparata 0:69566eea0fba 5974 *value &= LSM6DSL_ACC_GYRO_INT2_TAP_MASK; //mask
cparata 0:69566eea0fba 5975
cparata 0:69566eea0fba 5976 return MEMS_SUCCESS;
cparata 0:69566eea0fba 5977 }
cparata 0:69566eea0fba 5978
cparata 0:69566eea0fba 5979 /*******************************************************************************
cparata 0:69566eea0fba 5980 * Function Name : LSM6DSL_ACC_GYRO_W_FFEvOnInt2
cparata 0:69566eea0fba 5981 * Description : Write INT2_FF
cparata 0:69566eea0fba 5982 * Input : LSM6DSL_ACC_GYRO_INT2_FF_t
cparata 0:69566eea0fba 5983 * Output : None
cparata 0:69566eea0fba 5984 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 5985 *******************************************************************************/
cparata 0:69566eea0fba 5986 status_t LSM6DSL_ACC_GYRO_W_FFEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_FF_t newValue)
cparata 0:69566eea0fba 5987 {
cparata 0:69566eea0fba 5988 u8_t value;
cparata 0:69566eea0fba 5989
cparata 0:69566eea0fba 5990 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:69566eea0fba 5991 return MEMS_ERROR;
cparata 0:69566eea0fba 5992
cparata 0:69566eea0fba 5993 value &= ~LSM6DSL_ACC_GYRO_INT2_FF_MASK;
cparata 0:69566eea0fba 5994 value |= newValue;
cparata 0:69566eea0fba 5995
cparata 0:69566eea0fba 5996 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:69566eea0fba 5997 return MEMS_ERROR;
cparata 0:69566eea0fba 5998
cparata 0:69566eea0fba 5999 return MEMS_SUCCESS;
cparata 0:69566eea0fba 6000 }
cparata 0:69566eea0fba 6001
cparata 0:69566eea0fba 6002 /*******************************************************************************
cparata 0:69566eea0fba 6003 * Function Name : LSM6DSL_ACC_GYRO_R_FFEvOnInt2
cparata 0:69566eea0fba 6004 * Description : Read INT2_FF
cparata 0:69566eea0fba 6005 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_FF_t
cparata 0:69566eea0fba 6006 * Output : Status of INT2_FF see LSM6DSL_ACC_GYRO_INT2_FF_t
cparata 0:69566eea0fba 6007 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 6008 *******************************************************************************/
cparata 0:69566eea0fba 6009 status_t LSM6DSL_ACC_GYRO_R_FFEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_FF_t *value)
cparata 0:69566eea0fba 6010 {
cparata 0:69566eea0fba 6011 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
cparata 0:69566eea0fba 6012 return MEMS_ERROR;
cparata 0:69566eea0fba 6013
cparata 0:69566eea0fba 6014 *value &= LSM6DSL_ACC_GYRO_INT2_FF_MASK; //mask
cparata 0:69566eea0fba 6015
cparata 0:69566eea0fba 6016 return MEMS_SUCCESS;
cparata 0:69566eea0fba 6017 }
cparata 0:69566eea0fba 6018
cparata 0:69566eea0fba 6019 /*******************************************************************************
cparata 0:69566eea0fba 6020 * Function Name : LSM6DSL_ACC_GYRO_W_WUEvOnInt2
cparata 0:69566eea0fba 6021 * Description : Write INT2_WU
cparata 0:69566eea0fba 6022 * Input : LSM6DSL_ACC_GYRO_INT2_WU_t
cparata 0:69566eea0fba 6023 * Output : None
cparata 0:69566eea0fba 6024 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 6025 *******************************************************************************/
cparata 0:69566eea0fba 6026 status_t LSM6DSL_ACC_GYRO_W_WUEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_WU_t newValue)
cparata 0:69566eea0fba 6027 {
cparata 0:69566eea0fba 6028 u8_t value;
cparata 0:69566eea0fba 6029
cparata 0:69566eea0fba 6030 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:69566eea0fba 6031 return MEMS_ERROR;
cparata 0:69566eea0fba 6032
cparata 0:69566eea0fba 6033 value &= ~LSM6DSL_ACC_GYRO_INT2_WU_MASK;
cparata 0:69566eea0fba 6034 value |= newValue;
cparata 0:69566eea0fba 6035
cparata 0:69566eea0fba 6036 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:69566eea0fba 6037 return MEMS_ERROR;
cparata 0:69566eea0fba 6038
cparata 0:69566eea0fba 6039 return MEMS_SUCCESS;
cparata 0:69566eea0fba 6040 }
cparata 0:69566eea0fba 6041
cparata 0:69566eea0fba 6042 /*******************************************************************************
cparata 0:69566eea0fba 6043 * Function Name : LSM6DSL_ACC_GYRO_R_WUEvOnInt2
cparata 0:69566eea0fba 6044 * Description : Read INT2_WU
cparata 0:69566eea0fba 6045 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_WU_t
cparata 0:69566eea0fba 6046 * Output : Status of INT2_WU see LSM6DSL_ACC_GYRO_INT2_WU_t
cparata 0:69566eea0fba 6047 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 6048 *******************************************************************************/
cparata 0:69566eea0fba 6049 status_t LSM6DSL_ACC_GYRO_R_WUEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_WU_t *value)
cparata 0:69566eea0fba 6050 {
cparata 0:69566eea0fba 6051 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
cparata 0:69566eea0fba 6052 return MEMS_ERROR;
cparata 0:69566eea0fba 6053
cparata 0:69566eea0fba 6054 *value &= LSM6DSL_ACC_GYRO_INT2_WU_MASK; //mask
cparata 0:69566eea0fba 6055
cparata 0:69566eea0fba 6056 return MEMS_SUCCESS;
cparata 0:69566eea0fba 6057 }
cparata 0:69566eea0fba 6058
cparata 0:69566eea0fba 6059 /*******************************************************************************
cparata 0:69566eea0fba 6060 * Function Name : LSM6DSL_ACC_GYRO_W_SingleTapOnInt2
cparata 0:69566eea0fba 6061 * Description : Write INT2_SINGLE_TAP
cparata 0:69566eea0fba 6062 * Input : LSM6DSL_ACC_GYRO_INT2_SINGLE_TAP_t
cparata 0:69566eea0fba 6063 * Output : None
cparata 0:69566eea0fba 6064 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 6065 *******************************************************************************/
cparata 0:69566eea0fba 6066 status_t LSM6DSL_ACC_GYRO_W_SingleTapOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_SINGLE_TAP_t newValue)
cparata 0:69566eea0fba 6067 {
cparata 0:69566eea0fba 6068 u8_t value;
cparata 0:69566eea0fba 6069
cparata 0:69566eea0fba 6070 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:69566eea0fba 6071 return MEMS_ERROR;
cparata 0:69566eea0fba 6072
cparata 0:69566eea0fba 6073 value &= ~LSM6DSL_ACC_GYRO_INT2_SINGLE_TAP_MASK;
cparata 0:69566eea0fba 6074 value |= newValue;
cparata 0:69566eea0fba 6075
cparata 0:69566eea0fba 6076 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:69566eea0fba 6077 return MEMS_ERROR;
cparata 0:69566eea0fba 6078
cparata 0:69566eea0fba 6079 return MEMS_SUCCESS;
cparata 0:69566eea0fba 6080 }
cparata 0:69566eea0fba 6081
cparata 0:69566eea0fba 6082 /*******************************************************************************
cparata 0:69566eea0fba 6083 * Function Name : LSM6DSL_ACC_GYRO_R_SingleTapOnInt2
cparata 0:69566eea0fba 6084 * Description : Read INT2_SINGLE_TAP
cparata 0:69566eea0fba 6085 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_SINGLE_TAP_t
cparata 0:69566eea0fba 6086 * Output : Status of INT2_SINGLE_TAP see LSM6DSL_ACC_GYRO_INT2_SINGLE_TAP_t
cparata 0:69566eea0fba 6087 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 6088 *******************************************************************************/
cparata 0:69566eea0fba 6089 status_t LSM6DSL_ACC_GYRO_R_SingleTapOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_SINGLE_TAP_t *value)
cparata 0:69566eea0fba 6090 {
cparata 0:69566eea0fba 6091 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
cparata 0:69566eea0fba 6092 return MEMS_ERROR;
cparata 0:69566eea0fba 6093
cparata 0:69566eea0fba 6094 *value &= LSM6DSL_ACC_GYRO_INT2_SINGLE_TAP_MASK; //mask
cparata 0:69566eea0fba 6095
cparata 0:69566eea0fba 6096 return MEMS_SUCCESS;
cparata 0:69566eea0fba 6097 }
cparata 0:69566eea0fba 6098
cparata 0:69566eea0fba 6099 /*******************************************************************************
cparata 0:69566eea0fba 6100 * Function Name : LSM6DSL_ACC_GYRO_W_SleepEvOnInt2
cparata 0:69566eea0fba 6101 * Description : Write INT2_SLEEP
cparata 0:69566eea0fba 6102 * Input : LSM6DSL_ACC_GYRO_INT2_SLEEP_t
cparata 0:69566eea0fba 6103 * Output : None
cparata 0:69566eea0fba 6104 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 6105 *******************************************************************************/
cparata 0:69566eea0fba 6106 status_t LSM6DSL_ACC_GYRO_W_SleepEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_SLEEP_t newValue)
cparata 0:69566eea0fba 6107 {
cparata 0:69566eea0fba 6108 u8_t value;
cparata 0:69566eea0fba 6109
cparata 0:69566eea0fba 6110 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:69566eea0fba 6111 return MEMS_ERROR;
cparata 0:69566eea0fba 6112
cparata 0:69566eea0fba 6113 value &= ~LSM6DSL_ACC_GYRO_INT2_SLEEP_MASK;
cparata 0:69566eea0fba 6114 value |= newValue;
cparata 0:69566eea0fba 6115
cparata 0:69566eea0fba 6116 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:69566eea0fba 6117 return MEMS_ERROR;
cparata 0:69566eea0fba 6118
cparata 0:69566eea0fba 6119 return MEMS_SUCCESS;
cparata 0:69566eea0fba 6120 }
cparata 0:69566eea0fba 6121
cparata 0:69566eea0fba 6122 /*******************************************************************************
cparata 0:69566eea0fba 6123 * Function Name : LSM6DSL_ACC_GYRO_R_SleepEvOnInt2
cparata 0:69566eea0fba 6124 * Description : Read INT2_SLEEP
cparata 0:69566eea0fba 6125 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_SLEEP_t
cparata 0:69566eea0fba 6126 * Output : Status of INT2_SLEEP see LSM6DSL_ACC_GYRO_INT2_SLEEP_t
cparata 0:69566eea0fba 6127 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 6128 *******************************************************************************/
cparata 0:69566eea0fba 6129 status_t LSM6DSL_ACC_GYRO_R_SleepEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_SLEEP_t *value)
cparata 0:69566eea0fba 6130 {
cparata 0:69566eea0fba 6131 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
cparata 0:69566eea0fba 6132 return MEMS_ERROR;
cparata 0:69566eea0fba 6133
cparata 0:69566eea0fba 6134 *value &= LSM6DSL_ACC_GYRO_INT2_SLEEP_MASK; //mask
cparata 0:69566eea0fba 6135
cparata 0:69566eea0fba 6136 return MEMS_SUCCESS;
cparata 0:69566eea0fba 6137 }
cparata 0:69566eea0fba 6138
cparata 0:69566eea0fba 6139 /*******************************************************************************
cparata 0:69566eea0fba 6140 * Function Name : status_t LSM6DSL_ACC_GYRO_Get_GetFIFOData(u8_t *buff)
cparata 0:69566eea0fba 6141 * Description : Read GetFIFOData output register
cparata 0:69566eea0fba 6142 * Input : pointer to [u8_t]
cparata 0:69566eea0fba 6143 * Output : GetFIFOData buffer u8_t
cparata 0:69566eea0fba 6144 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 6145 *******************************************************************************/
cparata 0:69566eea0fba 6146 status_t LSM6DSL_ACC_GYRO_Get_GetFIFOData(void *handle, u8_t *buff)
cparata 0:69566eea0fba 6147 {
cparata 0:69566eea0fba 6148 u8_t i, j, k;
cparata 0:69566eea0fba 6149 u8_t numberOfByteForDimension;
cparata 0:69566eea0fba 6150
cparata 0:69566eea0fba 6151 numberOfByteForDimension=2/1;
cparata 0:69566eea0fba 6152
cparata 0:69566eea0fba 6153 k=0;
cparata 0:69566eea0fba 6154 for (i=0; i<1;i++ )
cparata 0:69566eea0fba 6155 {
cparata 0:69566eea0fba 6156 for (j=0; j<numberOfByteForDimension;j++ )
cparata 0:69566eea0fba 6157 {
cparata 0:69566eea0fba 6158 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_DATA_OUT_L+k, &buff[k], 1))
cparata 0:69566eea0fba 6159 return MEMS_ERROR;
cparata 0:69566eea0fba 6160 k++;
cparata 0:69566eea0fba 6161 }
cparata 0:69566eea0fba 6162 }
cparata 0:69566eea0fba 6163
cparata 0:69566eea0fba 6164 return MEMS_SUCCESS;
cparata 0:69566eea0fba 6165 }
cparata 0:69566eea0fba 6166
cparata 0:69566eea0fba 6167 /*******************************************************************************
cparata 0:69566eea0fba 6168 * Function Name : status_t LSM6DSL_ACC_GYRO_Get_GetTimestamp(u8_t *buff)
cparata 0:69566eea0fba 6169 * Description : Read GetTimestamp output register
cparata 0:69566eea0fba 6170 * Input : pointer to [u8_t]
cparata 0:69566eea0fba 6171 * Output : GetTimestamp buffer u8_t
cparata 0:69566eea0fba 6172 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 6173 *******************************************************************************/
cparata 0:69566eea0fba 6174 status_t LSM6DSL_ACC_GYRO_Get_GetTimestamp(void *handle, u8_t *buff)
cparata 0:69566eea0fba 6175 {
cparata 0:69566eea0fba 6176 u8_t i, j, k;
cparata 0:69566eea0fba 6177 u8_t numberOfByteForDimension;
cparata 0:69566eea0fba 6178
cparata 0:69566eea0fba 6179 numberOfByteForDimension=3/1;
cparata 0:69566eea0fba 6180
cparata 0:69566eea0fba 6181 k=0;
cparata 0:69566eea0fba 6182 for (i=0; i<1;i++ )
cparata 0:69566eea0fba 6183 {
cparata 0:69566eea0fba 6184 for (j=0; j<numberOfByteForDimension;j++ )
cparata 0:69566eea0fba 6185 {
cparata 0:69566eea0fba 6186 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TIMESTAMP0_REG+k, &buff[k], 1))
cparata 0:69566eea0fba 6187 return MEMS_ERROR;
cparata 0:69566eea0fba 6188 k++;
cparata 0:69566eea0fba 6189 }
cparata 0:69566eea0fba 6190 }
cparata 0:69566eea0fba 6191
cparata 0:69566eea0fba 6192 return MEMS_SUCCESS;
cparata 0:69566eea0fba 6193 }
cparata 0:69566eea0fba 6194
cparata 0:69566eea0fba 6195 /*******************************************************************************
cparata 0:69566eea0fba 6196 * Function Name : status_t LSM6DSL_ACC_GYRO_Get_GetStepCounter(u8_t *buff)
cparata 0:69566eea0fba 6197 * Description : Read GetStepCounter output register
cparata 0:69566eea0fba 6198 * Input : pointer to [u8_t]
cparata 0:69566eea0fba 6199 * Output : GetStepCounter buffer u8_t
cparata 0:69566eea0fba 6200 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 6201 *******************************************************************************/
cparata 0:69566eea0fba 6202 status_t LSM6DSL_ACC_GYRO_Get_GetStepCounter(void *handle, u8_t *buff)
cparata 0:69566eea0fba 6203 {
cparata 0:69566eea0fba 6204 u8_t i, j, k;
cparata 0:69566eea0fba 6205 u8_t numberOfByteForDimension;
cparata 0:69566eea0fba 6206
cparata 0:69566eea0fba 6207 numberOfByteForDimension=2/1;
cparata 0:69566eea0fba 6208
cparata 0:69566eea0fba 6209 k=0;
cparata 0:69566eea0fba 6210 for (i=0; i<1;i++ )
cparata 0:69566eea0fba 6211 {
cparata 0:69566eea0fba 6212 for (j=0; j<numberOfByteForDimension;j++ )
cparata 0:69566eea0fba 6213 {
cparata 0:69566eea0fba 6214 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_STEP_COUNTER_L+k, &buff[k], 1))
cparata 0:69566eea0fba 6215 return MEMS_ERROR;
cparata 0:69566eea0fba 6216 k++;
cparata 0:69566eea0fba 6217 }
cparata 0:69566eea0fba 6218 }
cparata 0:69566eea0fba 6219
cparata 0:69566eea0fba 6220 return MEMS_SUCCESS;
cparata 0:69566eea0fba 6221 }
cparata 0:69566eea0fba 6222
cparata 0:69566eea0fba 6223 /*******************************************************************************
cparata 0:69566eea0fba 6224 * Function Name : LSM6DSL_ACC_GYRO_W_PedoThreshold(void *handle, u8_t newValue)
cparata 0:69566eea0fba 6225 * Description : Set accelerometer threshold for pedometer
cparata 0:69566eea0fba 6226 * Input : pointer to [u8_t]
cparata 0:69566eea0fba 6227 * Output : None
cparata 0:69566eea0fba 6228 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:69566eea0fba 6229 *******************************************************************************/
cparata 0:69566eea0fba 6230 status_t LSM6DSL_ACC_GYRO_W_PedoThreshold(void *handle, u8_t newValue)
cparata 0:69566eea0fba 6231 {
cparata 0:69566eea0fba 6232 u8_t value;
cparata 0:69566eea0fba 6233
cparata 0:69566eea0fba 6234 /* Open Embedded Function Register page*/
cparata 0:69566eea0fba 6235 LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_ENABLED);
cparata 0:69566eea0fba 6236
cparata 0:69566eea0fba 6237 /* read current value */
cparata 0:69566eea0fba 6238 LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CONFIG_PEDO_THS_MIN, &value, 1);
cparata 0:69566eea0fba 6239
cparata 0:69566eea0fba 6240 value &= ~0x1F;
cparata 0:69566eea0fba 6241 value |= (newValue & 0x1F);
cparata 0:69566eea0fba 6242
cparata 0:69566eea0fba 6243 /* write new value */
cparata 0:69566eea0fba 6244 LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CONFIG_PEDO_THS_MIN, &value, 1);
cparata 0:69566eea0fba 6245
cparata 0:69566eea0fba 6246 /* Close Embedded Function Register page*/
cparata 0:69566eea0fba 6247 LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_DISABLED);
cparata 0:69566eea0fba 6248
cparata 0:69566eea0fba 6249 return MEMS_SUCCESS;
cparata 0:69566eea0fba 6250 }
cparata 0:69566eea0fba 6251
cparata 0:69566eea0fba 6252 /************** Use Sensor Hub *******************/
cparata 0:69566eea0fba 6253 /*
cparata 0:69566eea0fba 6254 * Program the nine Soft Iron Matrix coefficients.
cparata 0:69566eea0fba 6255 * The SI_Matrix buffer must provide coefficients
cparata 0:69566eea0fba 6256 * in xx, xy, xz, yx, yy, yz, zx, zy, zz order.
cparata 0:69566eea0fba 6257 */
cparata 0:69566eea0fba 6258 status_t LSM6DSL_ACC_GYRO_SH_init_SI_Matrix(void *handle, u8_t *SI_matrix)
cparata 0:69566eea0fba 6259 {
cparata 0:69566eea0fba 6260 /* Open Embedded Function Register page*/
cparata 0:69566eea0fba 6261 LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_ENABLED);
cparata 0:69566eea0fba 6262
cparata 0:69566eea0fba 6263 /* Write the Soft Iron Matrix coefficients */
cparata 0:69566eea0fba 6264 LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MAG_SI_XX, SI_matrix, 9);
cparata 0:69566eea0fba 6265
cparata 0:69566eea0fba 6266 /* Close Embedded Function Register page*/
cparata 0:69566eea0fba 6267 LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_DISABLED);
cparata 0:69566eea0fba 6268
cparata 0:69566eea0fba 6269 return MEMS_SUCCESS;
cparata 0:69566eea0fba 6270 }
cparata 0:69566eea0fba 6271
cparata 0:69566eea0fba 6272 /* Read a remote device through I2C Sensor Hub Slave 0 */
cparata 0:69566eea0fba 6273 status_t LSM6DSL_ACC_GYRO_SH0_Program(void *handle, u8_t SlvAddr, u8_t Reg, u8_t len)
cparata 0:69566eea0fba 6274 {
cparata 0:69566eea0fba 6275 /* Open Embedded Function Register page*/
cparata 0:69566eea0fba 6276 LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_ENABLED);
cparata 0:69566eea0fba 6277
cparata 0:69566eea0fba 6278 /* Write remote device I2C slave address */
cparata 0:69566eea0fba 6279 SlvAddr |= 0x1; /* Raise the read op bit */
cparata 0:69566eea0fba 6280 LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_SLV0_ADD, &SlvAddr, 1);
cparata 0:69566eea0fba 6281
cparata 0:69566eea0fba 6282 /* Write remote device I2C subaddress */
cparata 0:69566eea0fba 6283 LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_SLV0_SUBADD, &Reg, 1);
cparata 0:69566eea0fba 6284
cparata 0:69566eea0fba 6285 /* Write number of bytes to read [SLAVE0_CONFIG - 04h ]*/
cparata 0:69566eea0fba 6286 u8_t sl0_cfg = 0;
cparata 0:69566eea0fba 6287 sl0_cfg |= 0x00; //00 bit [7-6] : no decimation
cparata 0:69566eea0fba 6288 sl0_cfg |= 0x00; //00 bit [5-4] : one sensor
cparata 0:69566eea0fba 6289 sl0_cfg |= 0x00; // 0 bit [3] : source mode read disabled
cparata 0:69566eea0fba 6290 sl0_cfg |= len & 0x07; // bit [2-0] : number of bytes
cparata 0:69566eea0fba 6291
cparata 0:69566eea0fba 6292 LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_SLAVE0_CONFIG, &sl0_cfg, 1);
cparata 0:69566eea0fba 6293
cparata 0:69566eea0fba 6294 /* Close Embedded Function Register page*/
cparata 0:69566eea0fba 6295 LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_DISABLED);
cparata 0:69566eea0fba 6296
cparata 0:69566eea0fba 6297 /* Enable FUNC */
cparata 0:69566eea0fba 6298 LSM6DSL_ACC_GYRO_W_FUNC_EN(handle, LSM6DSL_ACC_GYRO_FUNC_EN_ENABLED);
cparata 0:69566eea0fba 6299
cparata 0:69566eea0fba 6300 /* MASTER_EN */
cparata 0:69566eea0fba 6301 LSM6DSL_ACC_GYRO_W_I2C_MASTER_Enable(handle, LSM6DSL_ACC_GYRO_MASTER_ON_ENABLED);
cparata 0:69566eea0fba 6302
cparata 0:69566eea0fba 6303 return MEMS_SUCCESS;
cparata 0:69566eea0fba 6304 }
cparata 0:69566eea0fba 6305
cparata 0:69566eea0fba 6306 /* Read a remote device through I2C Sensor Hub Slave 0 */
cparata 0:69566eea0fba 6307 status_t LSM6DSL_ACC_GYRO_SH0_ReadMem(void *handle, u8_t SlvAddr, u8_t Reg, u8_t *Bufp, u8_t len, u8_t stop)
cparata 0:69566eea0fba 6308 {
cparata 0:69566eea0fba 6309 LSM6DSL_ACC_GYRO_SENS_HUB_END_t op_cmpl = LSM6DSL_ACC_GYRO_SENS_HUB_END_STILL_ONGOING;
cparata 0:69566eea0fba 6310 LSM6DSL_ACC_GYRO_XLDA_t op_update = LSM6DSL_ACC_GYRO_XLDA_NO_DATA_AVAIL;
cparata 0:69566eea0fba 6311 u8_t dummy[6];
cparata 0:69566eea0fba 6312
cparata 0:69566eea0fba 6313 LSM6DSL_ACC_GYRO_W_ODR_XL(handle, LSM6DSL_ACC_GYRO_ODR_XL_POWER_DOWN);
cparata 0:69566eea0fba 6314
cparata 0:69566eea0fba 6315 LSM6DSL_ACC_GYRO_SH0_Program(handle, SlvAddr, Reg, len);
cparata 0:69566eea0fba 6316
cparata 0:69566eea0fba 6317 /* Syncronize the SH with internal trigger (xl) */
cparata 0:69566eea0fba 6318 LSM6DSL_ACC_GYRO_W_ODR_XL(handle, LSM6DSL_ACC_GYRO_ODR_XL_104Hz);
cparata 0:69566eea0fba 6319
cparata 0:69566eea0fba 6320 /* Wait until operation is not completed */
cparata 0:69566eea0fba 6321 LSM6DSL_ACC_GYRO_GetRawAccData(handle, dummy);
cparata 0:69566eea0fba 6322 do {
cparata 0:69566eea0fba 6323 LSM6DSL_ACC_GYRO_R_XLDA(handle, &op_update);
cparata 0:69566eea0fba 6324 } while(op_update != LSM6DSL_ACC_GYRO_XLDA_DATA_AVAIL);
cparata 0:69566eea0fba 6325 do {
cparata 0:69566eea0fba 6326 LSM6DSL_ACC_GYRO_R_SENS_HUB_END(handle, &op_cmpl);
cparata 0:69566eea0fba 6327 } while(op_cmpl != LSM6DSL_ACC_GYRO_SENS_HUB_END_OP_COMPLETED);
cparata 0:69566eea0fba 6328
cparata 0:69566eea0fba 6329
cparata 0:69566eea0fba 6330 /* Read the result */
cparata 0:69566eea0fba 6331 LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_SENSORHUB1_REG, Bufp, len);
cparata 0:69566eea0fba 6332
cparata 0:69566eea0fba 6333 LSM6DSL_ACC_GYRO_W_ODR_XL(handle, LSM6DSL_ACC_GYRO_ODR_XL_POWER_DOWN);
cparata 0:69566eea0fba 6334
cparata 0:69566eea0fba 6335 if (stop) {
cparata 0:69566eea0fba 6336 /* Stop everything */
cparata 0:69566eea0fba 6337 LSM6DSL_ACC_GYRO_W_FUNC_EN(handle, LSM6DSL_ACC_GYRO_FUNC_EN_DISABLED);
cparata 0:69566eea0fba 6338 LSM6DSL_ACC_GYRO_W_I2C_MASTER_Enable(handle, LSM6DSL_ACC_GYRO_MASTER_ON_DISABLED);
cparata 0:69566eea0fba 6339 }
cparata 0:69566eea0fba 6340
cparata 0:69566eea0fba 6341 return MEMS_SUCCESS;
cparata 0:69566eea0fba 6342 }
cparata 0:69566eea0fba 6343
cparata 0:69566eea0fba 6344 /* Write a remote device through I2C Sensor Hub Slave 0 */
cparata 0:69566eea0fba 6345 status_t LSM6DSL_ACC_GYRO_SH0_WriteByte(void *handle, u8_t SlvAddr, u8_t Reg, u8_t Bufp)
cparata 0:69566eea0fba 6346 {
cparata 0:69566eea0fba 6347 LSM6DSL_ACC_GYRO_SENS_HUB_END_t op_cmpl = LSM6DSL_ACC_GYRO_SENS_HUB_END_STILL_ONGOING;
cparata 0:69566eea0fba 6348 LSM6DSL_ACC_GYRO_XLDA_t op_update = LSM6DSL_ACC_GYRO_XLDA_NO_DATA_AVAIL;
cparata 0:69566eea0fba 6349 u8_t dummy[6];
cparata 0:69566eea0fba 6350
cparata 0:69566eea0fba 6351 /* Open Embedded Function Register page*/
cparata 0:69566eea0fba 6352 LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_ENABLED);
cparata 0:69566eea0fba 6353
cparata 0:69566eea0fba 6354 /* Write remote device I2C slave address */
cparata 0:69566eea0fba 6355 LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_SLV0_ADD, &SlvAddr, 1);
cparata 0:69566eea0fba 6356
cparata 0:69566eea0fba 6357 /* Write remote device I2C subaddress */
cparata 0:69566eea0fba 6358 LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_SLV0_SUBADD, &Reg, 1);
cparata 0:69566eea0fba 6359
cparata 0:69566eea0fba 6360 /* Write the data */
cparata 0:69566eea0fba 6361 LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_DATAWRITE_SRC_MODE_SUB_SLV0, &Bufp, 1);
cparata 0:69566eea0fba 6362
cparata 0:69566eea0fba 6363 /* Close Embedded Function Register page*/
cparata 0:69566eea0fba 6364 LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_DISABLED);
cparata 0:69566eea0fba 6365
cparata 0:69566eea0fba 6366 /* Enable FUNC */
cparata 0:69566eea0fba 6367 LSM6DSL_ACC_GYRO_W_FUNC_EN(handle, LSM6DSL_ACC_GYRO_FUNC_EN_ENABLED);
cparata 0:69566eea0fba 6368
cparata 0:69566eea0fba 6369 /* Enable PULL_UP_EN and MASTER_EN */
cparata 0:69566eea0fba 6370 //LSM6DSL_ACC_GYRO_W_PULL_UP_EN(handle, LSM6DSL_ACC_GYRO_PULL_UP_EN_ENABLED);
cparata 0:69566eea0fba 6371 LSM6DSL_ACC_GYRO_W_I2C_MASTER_Enable(handle, LSM6DSL_ACC_GYRO_MASTER_ON_ENABLED);
cparata 0:69566eea0fba 6372
cparata 0:69566eea0fba 6373 /* Syncronize the SH with internal trigger (xl) */
cparata 0:69566eea0fba 6374 LSM6DSL_ACC_GYRO_W_ODR_XL(handle, LSM6DSL_ACC_GYRO_ODR_XL_104Hz);
cparata 0:69566eea0fba 6375
cparata 0:69566eea0fba 6376 /* Wait until operation is not completed */
cparata 0:69566eea0fba 6377 LSM6DSL_ACC_GYRO_GetRawAccData(handle, dummy);
cparata 0:69566eea0fba 6378 do {
cparata 0:69566eea0fba 6379 LSM6DSL_ACC_GYRO_R_XLDA(handle, &op_update);
cparata 0:69566eea0fba 6380 } while(op_update != LSM6DSL_ACC_GYRO_XLDA_DATA_AVAIL);
cparata 0:69566eea0fba 6381 do {
cparata 0:69566eea0fba 6382 LSM6DSL_ACC_GYRO_R_SENS_HUB_END(handle, &op_cmpl);
cparata 0:69566eea0fba 6383 } while(op_cmpl != LSM6DSL_ACC_GYRO_SENS_HUB_END_OP_COMPLETED);
cparata 0:69566eea0fba 6384
cparata 0:69566eea0fba 6385 LSM6DSL_ACC_GYRO_W_ODR_XL(handle, LSM6DSL_ACC_GYRO_ODR_XL_POWER_DOWN);
cparata 0:69566eea0fba 6386
cparata 0:69566eea0fba 6387 /* Stop everything */
cparata 0:69566eea0fba 6388 LSM6DSL_ACC_GYRO_W_FUNC_EN(handle, LSM6DSL_ACC_GYRO_FUNC_EN_DISABLED);
cparata 0:69566eea0fba 6389 LSM6DSL_ACC_GYRO_W_I2C_MASTER_Enable(handle, LSM6DSL_ACC_GYRO_MASTER_ON_DISABLED);
cparata 0:69566eea0fba 6390
cparata 0:69566eea0fba 6391
cparata 0:69566eea0fba 6392 return MEMS_SUCCESS;
cparata 0:69566eea0fba 6393 }