Example of 6D orientation recognition for LSM6DSL in X-NUCLEO-IKS01A2

Dependencies:   X_NUCLEO_IKS01A2 mbed

Fork of 6DOrientation_IKS01A2 by ST Expansion SW Team

6D Orientation Demo Application based on sensor expansion board X-NUCLEO-IKS01A2

Main function is to show how to use sensor expansion board to find out the 6D orientation and send data using UART to a connected PC or Desktop and display it on terminal applications like TeraTerm.
After connection has been established:
- the user can rotate the board to change the 6D orientation and then view the data using an hyper terminal.
- the user button can be used to display the current 6D orientation.

Committer:
cparata
Date:
Fri Aug 19 12:23:23 2016 +0000
Revision:
2:ae74845fa96a
Parent:
0:485458fca2bd
Add interfaces to all components

Who changed what in which revision?

UserRevisionLine numberNew contents of line
cparata 0:485458fca2bd 1 /**
cparata 0:485458fca2bd 2 ******************************************************************************
cparata 0:485458fca2bd 3 * @file LSM6DSL_ACC_GYRO_driver.c
cparata 0:485458fca2bd 4 * @author MEMS Application Team
cparata 0:485458fca2bd 5 * @version V1.5
cparata 0:485458fca2bd 6 * @date 17-May-2016
cparata 0:485458fca2bd 7 * @brief LSM6DSL driver file
cparata 0:485458fca2bd 8 ******************************************************************************
cparata 0:485458fca2bd 9 * @attention
cparata 0:485458fca2bd 10 *
cparata 0:485458fca2bd 11 * <h2><center>&copy; COPYRIGHT(c) 2016 STMicroelectronics</center></h2>
cparata 0:485458fca2bd 12 *
cparata 0:485458fca2bd 13 * Redistribution and use in source and binary forms, with or without modification,
cparata 0:485458fca2bd 14 * are permitted provided that the following conditions are met:
cparata 0:485458fca2bd 15 * 1. Redistributions of source code must retain the above copyright notice,
cparata 0:485458fca2bd 16 * this list of conditions and the following disclaimer.
cparata 0:485458fca2bd 17 * 2. Redistributions in binary form must reproduce the above copyright notice,
cparata 0:485458fca2bd 18 * this list of conditions and the following disclaimer in the documentation
cparata 0:485458fca2bd 19 * and/or other materials provided with the distribution.
cparata 0:485458fca2bd 20 * 3. Neither the name of STMicroelectronics nor the names of its contributors
cparata 0:485458fca2bd 21 * may be used to endorse or promote products derived from this software
cparata 0:485458fca2bd 22 * without specific prior written permission.
cparata 0:485458fca2bd 23 *
cparata 0:485458fca2bd 24 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
cparata 0:485458fca2bd 25 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
cparata 0:485458fca2bd 26 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
cparata 0:485458fca2bd 27 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
cparata 0:485458fca2bd 28 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
cparata 0:485458fca2bd 29 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
cparata 0:485458fca2bd 30 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
cparata 0:485458fca2bd 31 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
cparata 0:485458fca2bd 32 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
cparata 0:485458fca2bd 33 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
cparata 0:485458fca2bd 34 *
cparata 0:485458fca2bd 35 ******************************************************************************
cparata 0:485458fca2bd 36 */
cparata 0:485458fca2bd 37
cparata 0:485458fca2bd 38 /* Includes ------------------------------------------------------------------*/
cparata 0:485458fca2bd 39 #include "LSM6DSL_ACC_GYRO_driver.h"
cparata 0:485458fca2bd 40
cparata 0:485458fca2bd 41 /* Imported function prototypes ----------------------------------------------*/
cparata 0:485458fca2bd 42 extern uint8_t LSM6DSL_IO_Write(void *handle, uint8_t WriteAddr, uint8_t *pBuffer, uint16_t nBytesToWrite);
cparata 0:485458fca2bd 43 extern uint8_t LSM6DSL_IO_Read(void *handle, uint8_t ReadAddr, uint8_t *pBuffer, uint16_t nBytesToRead);
cparata 0:485458fca2bd 44
cparata 0:485458fca2bd 45 /* Private typedef -----------------------------------------------------------*/
cparata 0:485458fca2bd 46
cparata 0:485458fca2bd 47 /* Private define ------------------------------------------------------------*/
cparata 0:485458fca2bd 48
cparata 0:485458fca2bd 49 /* Private macro -------------------------------------------------------------*/
cparata 0:485458fca2bd 50
cparata 0:485458fca2bd 51 /* Private variables ---------------------------------------------------------*/
cparata 0:485458fca2bd 52
cparata 0:485458fca2bd 53 /* Private functions ---------------------------------------------------------*/
cparata 0:485458fca2bd 54
cparata 0:485458fca2bd 55 /* Exported functions ---------------------------------------------------------*/
cparata 0:485458fca2bd 56
cparata 0:485458fca2bd 57 /************** Generic Function *******************/
cparata 0:485458fca2bd 58
cparata 0:485458fca2bd 59 /*******************************************************************************
cparata 0:485458fca2bd 60 * Function Name : LSM6DSL_ACC_GYRO_ReadReg
cparata 0:485458fca2bd 61 * Description : Generic Reading function. It must be fullfilled with either
cparata 0:485458fca2bd 62 * : I2C or SPI reading functions
cparata 0:485458fca2bd 63 * Input : Register Address, length of buffer
cparata 0:485458fca2bd 64 * Output : Data REad
cparata 0:485458fca2bd 65 * Return : None
cparata 0:485458fca2bd 66 *******************************************************************************/
cparata 0:485458fca2bd 67 status_t LSM6DSL_ACC_GYRO_ReadReg(void *handle, u8_t Reg, u8_t* Data, u16_t len)
cparata 0:485458fca2bd 68 {
cparata 0:485458fca2bd 69 if (LSM6DSL_IO_Read(handle, Reg, Data, len))
cparata 0:485458fca2bd 70 {
cparata 0:485458fca2bd 71 return MEMS_ERROR;
cparata 0:485458fca2bd 72 }
cparata 0:485458fca2bd 73 else
cparata 0:485458fca2bd 74 {
cparata 0:485458fca2bd 75 return MEMS_SUCCESS;
cparata 0:485458fca2bd 76 }
cparata 0:485458fca2bd 77 }
cparata 0:485458fca2bd 78
cparata 0:485458fca2bd 79 /*******************************************************************************
cparata 0:485458fca2bd 80 * Function Name : LSM6DSL_ACC_GYRO_WriteReg
cparata 0:485458fca2bd 81 * Description : Generic Writing function. It must be fullfilled with either
cparata 0:485458fca2bd 82 * : I2C or SPI writing function
cparata 0:485458fca2bd 83 * Input : Register Address, Data to be written, length of buffer
cparata 0:485458fca2bd 84 * Output : None
cparata 0:485458fca2bd 85 * Return : None
cparata 0:485458fca2bd 86 *******************************************************************************/
cparata 0:485458fca2bd 87 status_t LSM6DSL_ACC_GYRO_WriteReg(void *handle, u8_t Reg, u8_t *Data, u16_t len)
cparata 0:485458fca2bd 88 {
cparata 0:485458fca2bd 89 if (LSM6DSL_IO_Write(handle, Reg, Data, len))
cparata 0:485458fca2bd 90 {
cparata 0:485458fca2bd 91 return MEMS_ERROR;
cparata 0:485458fca2bd 92 }
cparata 0:485458fca2bd 93 else
cparata 0:485458fca2bd 94 {
cparata 0:485458fca2bd 95 return MEMS_SUCCESS;
cparata 0:485458fca2bd 96 }
cparata 0:485458fca2bd 97 }
cparata 0:485458fca2bd 98
cparata 0:485458fca2bd 99 /**************** Base Function *******************/
cparata 0:485458fca2bd 100
cparata 0:485458fca2bd 101 /*******************************************************************************
cparata 0:485458fca2bd 102 * Function Name : LSM6DSL_ACC_GYRO_R_WHO_AM_I
cparata 0:485458fca2bd 103 * Description : Read WHO_AM_I_BIT
cparata 0:485458fca2bd 104 * Input : Pointer to u8_t
cparata 0:485458fca2bd 105 * Output : Status of WHO_AM_I_BIT
cparata 0:485458fca2bd 106 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 107 *******************************************************************************/
cparata 0:485458fca2bd 108 status_t LSM6DSL_ACC_GYRO_R_WHO_AM_I(void *handle, u8_t *value)
cparata 0:485458fca2bd 109 {
cparata 0:485458fca2bd 110 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WHO_AM_I_REG, (u8_t *)value, 1))
cparata 0:485458fca2bd 111 return MEMS_ERROR;
cparata 0:485458fca2bd 112
cparata 0:485458fca2bd 113 *value &= LSM6DSL_ACC_GYRO_WHO_AM_I_BIT_MASK; //coerce
cparata 0:485458fca2bd 114 *value = *value >> LSM6DSL_ACC_GYRO_WHO_AM_I_BIT_POSITION; //mask
cparata 0:485458fca2bd 115
cparata 0:485458fca2bd 116 return MEMS_SUCCESS;
cparata 0:485458fca2bd 117 }
cparata 0:485458fca2bd 118
cparata 0:485458fca2bd 119 /*******************************************************************************
cparata 0:485458fca2bd 120 * Function Name : LSM6DSL_ACC_GYRO_W_BDU
cparata 0:485458fca2bd 121 * Description : Write BDU
cparata 0:485458fca2bd 122 * Input : LSM6DSL_ACC_GYRO_BDU_t
cparata 0:485458fca2bd 123 * Output : None
cparata 0:485458fca2bd 124 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 125 *******************************************************************************/
cparata 0:485458fca2bd 126 status_t LSM6DSL_ACC_GYRO_W_BDU(void *handle, LSM6DSL_ACC_GYRO_BDU_t newValue)
cparata 0:485458fca2bd 127 {
cparata 0:485458fca2bd 128 u8_t value;
cparata 0:485458fca2bd 129
cparata 0:485458fca2bd 130 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
cparata 0:485458fca2bd 131 return MEMS_ERROR;
cparata 0:485458fca2bd 132
cparata 0:485458fca2bd 133 value &= ~LSM6DSL_ACC_GYRO_BDU_MASK;
cparata 0:485458fca2bd 134 value |= newValue;
cparata 0:485458fca2bd 135
cparata 0:485458fca2bd 136 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
cparata 0:485458fca2bd 137 return MEMS_ERROR;
cparata 0:485458fca2bd 138
cparata 0:485458fca2bd 139 return MEMS_SUCCESS;
cparata 0:485458fca2bd 140 }
cparata 0:485458fca2bd 141
cparata 0:485458fca2bd 142 /*******************************************************************************
cparata 0:485458fca2bd 143 * Function Name : LSM6DSL_ACC_GYRO_R_BDU
cparata 0:485458fca2bd 144 * Description : Read BDU
cparata 0:485458fca2bd 145 * Input : Pointer to LSM6DSL_ACC_GYRO_BDU_t
cparata 0:485458fca2bd 146 * Output : Status of BDU see LSM6DSL_ACC_GYRO_BDU_t
cparata 0:485458fca2bd 147 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 148 *******************************************************************************/
cparata 0:485458fca2bd 149 status_t LSM6DSL_ACC_GYRO_R_BDU(void *handle, LSM6DSL_ACC_GYRO_BDU_t *value)
cparata 0:485458fca2bd 150 {
cparata 0:485458fca2bd 151 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1))
cparata 0:485458fca2bd 152 return MEMS_ERROR;
cparata 0:485458fca2bd 153
cparata 0:485458fca2bd 154 *value &= LSM6DSL_ACC_GYRO_BDU_MASK; //mask
cparata 0:485458fca2bd 155
cparata 0:485458fca2bd 156 return MEMS_SUCCESS;
cparata 0:485458fca2bd 157 }
cparata 0:485458fca2bd 158
cparata 0:485458fca2bd 159 /*******************************************************************************
cparata 0:485458fca2bd 160 * Function Name : LSM6DSL_ACC_GYRO_W_FS_XL
cparata 0:485458fca2bd 161 * Description : Write FS_XL
cparata 0:485458fca2bd 162 * Input : LSM6DSL_ACC_GYRO_FS_XL_t
cparata 0:485458fca2bd 163 * Output : None
cparata 0:485458fca2bd 164 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 165 *******************************************************************************/
cparata 0:485458fca2bd 166 status_t LSM6DSL_ACC_GYRO_W_FS_XL(void *handle, LSM6DSL_ACC_GYRO_FS_XL_t newValue)
cparata 0:485458fca2bd 167 {
cparata 0:485458fca2bd 168 u8_t value;
cparata 0:485458fca2bd 169
cparata 0:485458fca2bd 170 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, &value, 1))
cparata 0:485458fca2bd 171 return MEMS_ERROR;
cparata 0:485458fca2bd 172
cparata 0:485458fca2bd 173 value &= ~LSM6DSL_ACC_GYRO_FS_XL_MASK;
cparata 0:485458fca2bd 174 value |= newValue;
cparata 0:485458fca2bd 175
cparata 0:485458fca2bd 176 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, &value, 1) )
cparata 0:485458fca2bd 177 return MEMS_ERROR;
cparata 0:485458fca2bd 178
cparata 0:485458fca2bd 179 return MEMS_SUCCESS;
cparata 0:485458fca2bd 180 }
cparata 0:485458fca2bd 181
cparata 0:485458fca2bd 182 /*******************************************************************************
cparata 0:485458fca2bd 183 * Function Name : LSM6DSL_ACC_GYRO_R_FS_XL
cparata 0:485458fca2bd 184 * Description : Read FS_XL
cparata 0:485458fca2bd 185 * Input : Pointer to LSM6DSL_ACC_GYRO_FS_XL_t
cparata 0:485458fca2bd 186 * Output : Status of FS_XL see LSM6DSL_ACC_GYRO_FS_XL_t
cparata 0:485458fca2bd 187 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 188 *******************************************************************************/
cparata 0:485458fca2bd 189 status_t LSM6DSL_ACC_GYRO_R_FS_XL(void *handle, LSM6DSL_ACC_GYRO_FS_XL_t *value)
cparata 0:485458fca2bd 190 {
cparata 0:485458fca2bd 191 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, (u8_t *)value, 1))
cparata 0:485458fca2bd 192 return MEMS_ERROR;
cparata 0:485458fca2bd 193
cparata 0:485458fca2bd 194 *value &= LSM6DSL_ACC_GYRO_FS_XL_MASK; //mask
cparata 0:485458fca2bd 195
cparata 0:485458fca2bd 196 return MEMS_SUCCESS;
cparata 0:485458fca2bd 197 }
cparata 0:485458fca2bd 198
cparata 0:485458fca2bd 199 /*******************************************************************************
cparata 0:485458fca2bd 200 * Function Name : status_t LSM6DSL_ACC_GYRO_GetRawAccData(u8_t *buff)
cparata 0:485458fca2bd 201 * Description : Read GetAccData output register
cparata 0:485458fca2bd 202 * Input : pointer to [u8_t]
cparata 0:485458fca2bd 203 * Output : GetAccData buffer u8_t
cparata 0:485458fca2bd 204 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 205 *******************************************************************************/
cparata 0:485458fca2bd 206 status_t LSM6DSL_ACC_GYRO_GetRawAccData(void *handle, u8_t *buff)
cparata 0:485458fca2bd 207 {
cparata 0:485458fca2bd 208 u8_t i, j, k;
cparata 0:485458fca2bd 209 u8_t numberOfByteForDimension;
cparata 0:485458fca2bd 210
cparata 0:485458fca2bd 211 numberOfByteForDimension=6/3;
cparata 0:485458fca2bd 212
cparata 0:485458fca2bd 213 k=0;
cparata 0:485458fca2bd 214 for (i=0; i<3;i++ )
cparata 0:485458fca2bd 215 {
cparata 0:485458fca2bd 216 for (j=0; j<numberOfByteForDimension;j++ )
cparata 0:485458fca2bd 217 {
cparata 0:485458fca2bd 218 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_OUTX_L_XL+k, &buff[k], 1))
cparata 0:485458fca2bd 219 return MEMS_ERROR;
cparata 0:485458fca2bd 220 k++;
cparata 0:485458fca2bd 221 }
cparata 0:485458fca2bd 222 }
cparata 0:485458fca2bd 223
cparata 0:485458fca2bd 224 return MEMS_SUCCESS;
cparata 0:485458fca2bd 225 }
cparata 0:485458fca2bd 226
cparata 0:485458fca2bd 227 /*******************************************************************************
cparata 0:485458fca2bd 228 * Function Name : status_t LSM6DSL_ACC_Get_Acceleration(void *handle, int *buff, u8_t from_fifo)
cparata 0:485458fca2bd 229 * Description : Read GetAccData output register
cparata 0:485458fca2bd 230 * Input : pointer to [u8_t]
cparata 0:485458fca2bd 231 * Output : values are expressed in mg
cparata 0:485458fca2bd 232 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 233 *******************************************************************************/
cparata 0:485458fca2bd 234 /*
cparata 0:485458fca2bd 235 * Following is the table of sensitivity values for each case.
cparata 0:485458fca2bd 236 * Values are expressed in ug/digit.
cparata 0:485458fca2bd 237 */
cparata 0:485458fca2bd 238 static const long long LSM6DSL_ACC_Sensitivity_List[4] = {
cparata 0:485458fca2bd 239 61, /* FS @2g */
cparata 0:485458fca2bd 240 122, /* FS @4g */
cparata 0:485458fca2bd 241 244, /* FS @8g */
cparata 0:485458fca2bd 242 488, /* FS @16g */
cparata 0:485458fca2bd 243 };
cparata 0:485458fca2bd 244 status_t LSM6DSL_ACC_Get_Acceleration(void *handle, int *buff, u8_t from_fifo)
cparata 0:485458fca2bd 245 {
cparata 0:485458fca2bd 246 LSM6DSL_ACC_GYRO_FS_XL_t fs;
cparata 0:485458fca2bd 247 long long sensitivity = 0;
cparata 0:485458fca2bd 248 Type3Axis16bit_U raw_data_tmp;
cparata 0:485458fca2bd 249
cparata 0:485458fca2bd 250 /* Read out current odr, fs, hf setting */
cparata 0:485458fca2bd 251 LSM6DSL_ACC_GYRO_R_FS_XL(handle, &fs);
cparata 0:485458fca2bd 252
cparata 0:485458fca2bd 253 /* Determine the sensitivity according to fs */
cparata 0:485458fca2bd 254 switch(fs) {
cparata 0:485458fca2bd 255 case LSM6DSL_ACC_GYRO_FS_XL_2g:
cparata 0:485458fca2bd 256 sensitivity = LSM6DSL_ACC_Sensitivity_List[0];
cparata 0:485458fca2bd 257 break;
cparata 0:485458fca2bd 258
cparata 0:485458fca2bd 259 case LSM6DSL_ACC_GYRO_FS_XL_4g:
cparata 0:485458fca2bd 260 sensitivity = LSM6DSL_ACC_Sensitivity_List[1];
cparata 0:485458fca2bd 261 break;
cparata 0:485458fca2bd 262
cparata 0:485458fca2bd 263 case LSM6DSL_ACC_GYRO_FS_XL_8g:
cparata 0:485458fca2bd 264 sensitivity = LSM6DSL_ACC_Sensitivity_List[2];
cparata 0:485458fca2bd 265 break;
cparata 0:485458fca2bd 266
cparata 0:485458fca2bd 267 case LSM6DSL_ACC_GYRO_FS_XL_16g:
cparata 0:485458fca2bd 268 sensitivity = LSM6DSL_ACC_Sensitivity_List[3];
cparata 0:485458fca2bd 269 break;
cparata 0:485458fca2bd 270 }
cparata 0:485458fca2bd 271
cparata 0:485458fca2bd 272 /* Read out raw accelerometer samples */
cparata 0:485458fca2bd 273 if (from_fifo) {
cparata 0:485458fca2bd 274 u8_t i;
cparata 0:485458fca2bd 275
cparata 0:485458fca2bd 276 /* read all 3 axis from FIFO */
cparata 0:485458fca2bd 277 for(i = 0; i < 3; i++)
cparata 0:485458fca2bd 278 LSM6DSL_ACC_GYRO_Get_GetFIFOData(handle, raw_data_tmp.u8bit + 2*i);
cparata 0:485458fca2bd 279 } else
cparata 0:485458fca2bd 280 LSM6DSL_ACC_GYRO_GetRawAccData(handle, raw_data_tmp.u8bit);
cparata 0:485458fca2bd 281
cparata 0:485458fca2bd 282 /* Apply proper shift and sensitivity */
cparata 0:485458fca2bd 283 buff[0] = (raw_data_tmp.i16bit[0] * sensitivity + 500)/1000;
cparata 0:485458fca2bd 284 buff[1] = (raw_data_tmp.i16bit[1] * sensitivity + 500)/1000;
cparata 0:485458fca2bd 285 buff[2] = (raw_data_tmp.i16bit[2] * sensitivity + 500)/1000;
cparata 0:485458fca2bd 286
cparata 0:485458fca2bd 287 return MEMS_SUCCESS;
cparata 0:485458fca2bd 288 }
cparata 0:485458fca2bd 289
cparata 0:485458fca2bd 290 /*******************************************************************************
cparata 0:485458fca2bd 291 * Function Name : LSM6DSL_ACC_GYRO_W_ODR_XL
cparata 0:485458fca2bd 292 * Description : Write ODR_XL
cparata 0:485458fca2bd 293 * Input : LSM6DSL_ACC_GYRO_ODR_XL_t
cparata 0:485458fca2bd 294 * Output : None
cparata 0:485458fca2bd 295 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 296 *******************************************************************************/
cparata 0:485458fca2bd 297 status_t LSM6DSL_ACC_GYRO_W_ODR_XL(void *handle, LSM6DSL_ACC_GYRO_ODR_XL_t newValue)
cparata 0:485458fca2bd 298 {
cparata 0:485458fca2bd 299 u8_t value;
cparata 0:485458fca2bd 300
cparata 0:485458fca2bd 301 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, &value, 1))
cparata 0:485458fca2bd 302 return MEMS_ERROR;
cparata 0:485458fca2bd 303
cparata 0:485458fca2bd 304 value &= ~LSM6DSL_ACC_GYRO_ODR_XL_MASK;
cparata 0:485458fca2bd 305 value |= newValue;
cparata 0:485458fca2bd 306
cparata 0:485458fca2bd 307 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, &value, 1) )
cparata 0:485458fca2bd 308 return MEMS_ERROR;
cparata 0:485458fca2bd 309
cparata 0:485458fca2bd 310 return MEMS_SUCCESS;
cparata 0:485458fca2bd 311 }
cparata 0:485458fca2bd 312
cparata 0:485458fca2bd 313 /*******************************************************************************
cparata 0:485458fca2bd 314 * Function Name : LSM6DSL_ACC_GYRO_R_ODR_XL
cparata 0:485458fca2bd 315 * Description : Read ODR_XL
cparata 0:485458fca2bd 316 * Input : Pointer to LSM6DSL_ACC_GYRO_ODR_XL_t
cparata 0:485458fca2bd 317 * Output : Status of ODR_XL see LSM6DSL_ACC_GYRO_ODR_XL_t
cparata 0:485458fca2bd 318 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 319 *******************************************************************************/
cparata 0:485458fca2bd 320 status_t LSM6DSL_ACC_GYRO_R_ODR_XL(void *handle, LSM6DSL_ACC_GYRO_ODR_XL_t *value)
cparata 0:485458fca2bd 321 {
cparata 0:485458fca2bd 322 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, (u8_t *)value, 1))
cparata 0:485458fca2bd 323 return MEMS_ERROR;
cparata 0:485458fca2bd 324
cparata 0:485458fca2bd 325 *value &= LSM6DSL_ACC_GYRO_ODR_XL_MASK; //mask
cparata 0:485458fca2bd 326
cparata 0:485458fca2bd 327 return MEMS_SUCCESS;
cparata 0:485458fca2bd 328 }
cparata 0:485458fca2bd 329
cparata 0:485458fca2bd 330 /*******************************************************************************
cparata 0:485458fca2bd 331 * Function Name : LSM6DSL_ACC_GYRO_translate_ODR_XL
cparata 0:485458fca2bd 332 * Description : Read ODR_XL
cparata 0:485458fca2bd 333 * Input : LSM6DSL_ACC_GYRO_ODR_XL_t
cparata 0:485458fca2bd 334 * Output : The ODR value in Hz
cparata 0:485458fca2bd 335 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 336 *******************************************************************************/
cparata 0:485458fca2bd 337 status_t LSM6DSL_ACC_GYRO_translate_ODR_XL(LSM6DSL_ACC_GYRO_ODR_XL_t value, u16_t *odr_hz_val)
cparata 0:485458fca2bd 338 {
cparata 0:485458fca2bd 339 switch(value) {
cparata 0:485458fca2bd 340 case LSM6DSL_ACC_GYRO_ODR_XL_POWER_DOWN:
cparata 0:485458fca2bd 341 *odr_hz_val = 0;
cparata 0:485458fca2bd 342 break;
cparata 0:485458fca2bd 343
cparata 0:485458fca2bd 344 case LSM6DSL_ACC_GYRO_ODR_XL_13Hz:
cparata 0:485458fca2bd 345 *odr_hz_val = 13;
cparata 0:485458fca2bd 346 break;
cparata 0:485458fca2bd 347
cparata 0:485458fca2bd 348 case LSM6DSL_ACC_GYRO_ODR_XL_26Hz:
cparata 0:485458fca2bd 349 *odr_hz_val = 26;
cparata 0:485458fca2bd 350 break;
cparata 0:485458fca2bd 351
cparata 0:485458fca2bd 352 case LSM6DSL_ACC_GYRO_ODR_XL_52Hz:
cparata 0:485458fca2bd 353 *odr_hz_val = 52;
cparata 0:485458fca2bd 354 break;
cparata 0:485458fca2bd 355
cparata 0:485458fca2bd 356 case LSM6DSL_ACC_GYRO_ODR_XL_104Hz:
cparata 0:485458fca2bd 357 *odr_hz_val = 104;
cparata 0:485458fca2bd 358 break;
cparata 0:485458fca2bd 359
cparata 0:485458fca2bd 360 case LSM6DSL_ACC_GYRO_ODR_XL_208Hz:
cparata 0:485458fca2bd 361 *odr_hz_val = 208;
cparata 0:485458fca2bd 362 break;
cparata 0:485458fca2bd 363
cparata 0:485458fca2bd 364 case LSM6DSL_ACC_GYRO_ODR_XL_416Hz:
cparata 0:485458fca2bd 365 *odr_hz_val = 416;
cparata 0:485458fca2bd 366 break;
cparata 0:485458fca2bd 367
cparata 0:485458fca2bd 368 case LSM6DSL_ACC_GYRO_ODR_XL_833Hz:
cparata 0:485458fca2bd 369 *odr_hz_val = 833;
cparata 0:485458fca2bd 370 break;
cparata 0:485458fca2bd 371
cparata 0:485458fca2bd 372 case LSM6DSL_ACC_GYRO_ODR_XL_1660Hz:
cparata 0:485458fca2bd 373 *odr_hz_val = 1660;
cparata 0:485458fca2bd 374 break;
cparata 0:485458fca2bd 375
cparata 0:485458fca2bd 376 default:
cparata 0:485458fca2bd 377 return MEMS_ERROR;
cparata 0:485458fca2bd 378 }
cparata 0:485458fca2bd 379
cparata 0:485458fca2bd 380 return MEMS_SUCCESS;
cparata 0:485458fca2bd 381 }
cparata 0:485458fca2bd 382
cparata 0:485458fca2bd 383 /*******************************************************************************
cparata 0:485458fca2bd 384 * Function Name : LSM6DSL_ACC_GYRO_W_FS_G
cparata 0:485458fca2bd 385 * Description : Write FS_G
cparata 0:485458fca2bd 386 * Input : LSM6DSL_ACC_GYRO_FS_G_t
cparata 0:485458fca2bd 387 * Output : None
cparata 0:485458fca2bd 388 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 389 *******************************************************************************/
cparata 0:485458fca2bd 390 status_t LSM6DSL_ACC_GYRO_W_FS_G(void *handle, LSM6DSL_ACC_GYRO_FS_G_t newValue)
cparata 0:485458fca2bd 391 {
cparata 0:485458fca2bd 392 u8_t value;
cparata 0:485458fca2bd 393
cparata 0:485458fca2bd 394 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, &value, 1))
cparata 0:485458fca2bd 395 return MEMS_ERROR;
cparata 0:485458fca2bd 396
cparata 0:485458fca2bd 397 value &= ~LSM6DSL_ACC_GYRO_FS_G_MASK;
cparata 0:485458fca2bd 398 value |= newValue;
cparata 0:485458fca2bd 399
cparata 0:485458fca2bd 400 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, &value, 1) )
cparata 0:485458fca2bd 401 return MEMS_ERROR;
cparata 0:485458fca2bd 402
cparata 0:485458fca2bd 403 return MEMS_SUCCESS;
cparata 0:485458fca2bd 404 }
cparata 0:485458fca2bd 405
cparata 0:485458fca2bd 406 /*******************************************************************************
cparata 0:485458fca2bd 407 * Function Name : LSM6DSL_ACC_GYRO_R_FS_G
cparata 0:485458fca2bd 408 * Description : Read FS_G
cparata 0:485458fca2bd 409 * Input : Pointer to LSM6DSL_ACC_GYRO_FS_G_t
cparata 0:485458fca2bd 410 * Output : Status of FS_G see LSM6DSL_ACC_GYRO_FS_G_t
cparata 0:485458fca2bd 411 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 412 *******************************************************************************/
cparata 0:485458fca2bd 413 status_t LSM6DSL_ACC_GYRO_R_FS_G(void *handle, LSM6DSL_ACC_GYRO_FS_G_t *value)
cparata 0:485458fca2bd 414 {
cparata 0:485458fca2bd 415 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, (u8_t *)value, 1))
cparata 0:485458fca2bd 416 return MEMS_ERROR;
cparata 0:485458fca2bd 417
cparata 0:485458fca2bd 418 *value &= LSM6DSL_ACC_GYRO_FS_G_MASK; //mask
cparata 0:485458fca2bd 419
cparata 0:485458fca2bd 420 return MEMS_SUCCESS;
cparata 0:485458fca2bd 421 }
cparata 0:485458fca2bd 422
cparata 0:485458fca2bd 423 /*******************************************************************************
cparata 0:485458fca2bd 424 * Function Name : status_t LSM6DSL_ACC_GYRO_GetRawGyroData(u8_t *buff)
cparata 0:485458fca2bd 425 * Description : Read GetGyroData output register
cparata 0:485458fca2bd 426 * Input : pointer to [u8_t]
cparata 0:485458fca2bd 427 * Output : GetGyroData buffer u8_t
cparata 0:485458fca2bd 428 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 429 *******************************************************************************/
cparata 0:485458fca2bd 430 status_t LSM6DSL_ACC_GYRO_GetRawGyroData(void *handle, u8_t *buff)
cparata 0:485458fca2bd 431 {
cparata 0:485458fca2bd 432 u8_t i, j, k;
cparata 0:485458fca2bd 433 u8_t numberOfByteForDimension;
cparata 0:485458fca2bd 434
cparata 0:485458fca2bd 435 numberOfByteForDimension=6/3;
cparata 0:485458fca2bd 436
cparata 0:485458fca2bd 437 k=0;
cparata 0:485458fca2bd 438 for (i=0; i<3;i++ )
cparata 0:485458fca2bd 439 {
cparata 0:485458fca2bd 440 for (j=0; j<numberOfByteForDimension;j++ )
cparata 0:485458fca2bd 441 {
cparata 0:485458fca2bd 442 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_OUTX_L_G+k, &buff[k], 1))
cparata 0:485458fca2bd 443 return MEMS_ERROR;
cparata 0:485458fca2bd 444 k++;
cparata 0:485458fca2bd 445 }
cparata 0:485458fca2bd 446 }
cparata 0:485458fca2bd 447
cparata 0:485458fca2bd 448 return MEMS_SUCCESS;
cparata 0:485458fca2bd 449 }
cparata 0:485458fca2bd 450
cparata 0:485458fca2bd 451 /*******************************************************************************
cparata 0:485458fca2bd 452 * Function Name : status_t LSM6DSL_ACC_Get_AngularRate(u8_t *buff)
cparata 0:485458fca2bd 453 * Description : Read GetGyroData output register
cparata 0:485458fca2bd 454 * Input : pointer to [u8_t]
cparata 0:485458fca2bd 455 * Output : Returned values are espressed in mdps
cparata 0:485458fca2bd 456 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 457 *******************************************************************************/
cparata 0:485458fca2bd 458 /*
cparata 0:485458fca2bd 459 * Following is the table of sensitivity values for each case.
cparata 0:485458fca2bd 460 * Values are espressed in udps/digit.
cparata 0:485458fca2bd 461 */
cparata 0:485458fca2bd 462 static const long long LSM6DSL_GYRO_Sensitivity_List[5] = {
cparata 0:485458fca2bd 463 4375, /* FS @125 */
cparata 0:485458fca2bd 464 8750, /* FS @245 */
cparata 0:485458fca2bd 465 17500, /* FS @500 */
cparata 0:485458fca2bd 466 35000, /* FS @1000 */
cparata 0:485458fca2bd 467 70000, /* FS @2000 */
cparata 0:485458fca2bd 468 };
cparata 0:485458fca2bd 469 status_t LSM6DSL_ACC_Get_AngularRate(void *handle, int *buff, u8_t from_fifo)
cparata 0:485458fca2bd 470 {
cparata 0:485458fca2bd 471 LSM6DSL_ACC_GYRO_FS_125_t fs_125;
cparata 0:485458fca2bd 472 LSM6DSL_ACC_GYRO_FS_G_t fs;
cparata 0:485458fca2bd 473 long long sensitivity = 0;
cparata 0:485458fca2bd 474 Type3Axis16bit_U raw_data_tmp;
cparata 0:485458fca2bd 475
cparata 0:485458fca2bd 476 /* Read out current odr, fs, hf setting */
cparata 0:485458fca2bd 477 LSM6DSL_ACC_GYRO_R_FS_125(handle, &fs_125);
cparata 0:485458fca2bd 478 if (fs_125 == LSM6DSL_ACC_GYRO_FS_125_ENABLED) {
cparata 0:485458fca2bd 479 sensitivity = LSM6DSL_GYRO_Sensitivity_List[0];
cparata 0:485458fca2bd 480 } else {
cparata 0:485458fca2bd 481 LSM6DSL_ACC_GYRO_R_FS_G(handle, &fs);
cparata 0:485458fca2bd 482
cparata 0:485458fca2bd 483 /* Determine the sensitivity according to fs */
cparata 0:485458fca2bd 484 switch(fs) {
cparata 0:485458fca2bd 485 case LSM6DSL_ACC_GYRO_FS_G_245dps:
cparata 0:485458fca2bd 486 sensitivity = LSM6DSL_GYRO_Sensitivity_List[1];
cparata 0:485458fca2bd 487 break;
cparata 0:485458fca2bd 488
cparata 0:485458fca2bd 489 case LSM6DSL_ACC_GYRO_FS_G_500dps:
cparata 0:485458fca2bd 490 sensitivity = LSM6DSL_GYRO_Sensitivity_List[2];
cparata 0:485458fca2bd 491 break;
cparata 0:485458fca2bd 492
cparata 0:485458fca2bd 493 case LSM6DSL_ACC_GYRO_FS_G_1000dps:
cparata 0:485458fca2bd 494 sensitivity = LSM6DSL_GYRO_Sensitivity_List[3];
cparata 0:485458fca2bd 495 break;
cparata 0:485458fca2bd 496
cparata 0:485458fca2bd 497 case LSM6DSL_ACC_GYRO_FS_G_2000dps:
cparata 0:485458fca2bd 498 sensitivity = LSM6DSL_GYRO_Sensitivity_List[4];
cparata 0:485458fca2bd 499 break;
cparata 0:485458fca2bd 500 }
cparata 0:485458fca2bd 501 }
cparata 0:485458fca2bd 502
cparata 0:485458fca2bd 503 /* Read out raw accelerometer samples */
cparata 0:485458fca2bd 504 if (from_fifo) {
cparata 0:485458fca2bd 505 u8_t i;
cparata 0:485458fca2bd 506
cparata 0:485458fca2bd 507 /* read all 3 axis from FIFO */
cparata 0:485458fca2bd 508 for(i = 0; i < 3; i++)
cparata 0:485458fca2bd 509 LSM6DSL_ACC_GYRO_Get_GetFIFOData(handle, raw_data_tmp.u8bit + 2*i);
cparata 0:485458fca2bd 510 } else
cparata 0:485458fca2bd 511 LSM6DSL_ACC_GYRO_GetRawGyroData(handle, raw_data_tmp.u8bit);
cparata 0:485458fca2bd 512
cparata 0:485458fca2bd 513 /* Apply proper shift and sensitivity */
cparata 0:485458fca2bd 514 buff[0] = (raw_data_tmp.i16bit[0] * sensitivity + 500)/1000;
cparata 0:485458fca2bd 515 buff[1] = (raw_data_tmp.i16bit[1] * sensitivity + 500)/1000;
cparata 0:485458fca2bd 516 buff[2] = (raw_data_tmp.i16bit[2] * sensitivity + 500)/1000;
cparata 0:485458fca2bd 517
cparata 0:485458fca2bd 518 return MEMS_SUCCESS;
cparata 0:485458fca2bd 519 }
cparata 0:485458fca2bd 520
cparata 0:485458fca2bd 521 /*******************************************************************************
cparata 0:485458fca2bd 522 * Function Name : LSM6DSL_ACC_GYRO_W_ODR_G
cparata 0:485458fca2bd 523 * Description : Write ODR_G
cparata 0:485458fca2bd 524 * Input : LSM6DSL_ACC_GYRO_ODR_G_t
cparata 0:485458fca2bd 525 * Output : None
cparata 0:485458fca2bd 526 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 527 *******************************************************************************/
cparata 0:485458fca2bd 528 status_t LSM6DSL_ACC_GYRO_W_ODR_G(void *handle, LSM6DSL_ACC_GYRO_ODR_G_t newValue)
cparata 0:485458fca2bd 529 {
cparata 0:485458fca2bd 530 u8_t value;
cparata 0:485458fca2bd 531
cparata 0:485458fca2bd 532 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, &value, 1))
cparata 0:485458fca2bd 533 return MEMS_ERROR;
cparata 0:485458fca2bd 534
cparata 0:485458fca2bd 535 value &= ~LSM6DSL_ACC_GYRO_ODR_G_MASK;
cparata 0:485458fca2bd 536 value |= newValue;
cparata 0:485458fca2bd 537
cparata 0:485458fca2bd 538 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, &value, 1) )
cparata 0:485458fca2bd 539 return MEMS_ERROR;
cparata 0:485458fca2bd 540
cparata 0:485458fca2bd 541 return MEMS_SUCCESS;
cparata 0:485458fca2bd 542 }
cparata 0:485458fca2bd 543
cparata 0:485458fca2bd 544 /*******************************************************************************
cparata 0:485458fca2bd 545 * Function Name : LSM6DSL_ACC_GYRO_R_ODR_G
cparata 0:485458fca2bd 546 * Description : Read ODR_G
cparata 0:485458fca2bd 547 * Input : Pointer to LSM6DSL_ACC_GYRO_ODR_G_t
cparata 0:485458fca2bd 548 * Output : Status of ODR_G see LSM6DSL_ACC_GYRO_ODR_G_t
cparata 0:485458fca2bd 549 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 550 *******************************************************************************/
cparata 0:485458fca2bd 551 status_t LSM6DSL_ACC_GYRO_R_ODR_G(void *handle, LSM6DSL_ACC_GYRO_ODR_G_t *value)
cparata 0:485458fca2bd 552 {
cparata 0:485458fca2bd 553 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, (u8_t *)value, 1))
cparata 0:485458fca2bd 554 return MEMS_ERROR;
cparata 0:485458fca2bd 555
cparata 0:485458fca2bd 556 *value &= LSM6DSL_ACC_GYRO_ODR_G_MASK; //mask
cparata 0:485458fca2bd 557
cparata 0:485458fca2bd 558 return MEMS_SUCCESS;
cparata 0:485458fca2bd 559 }
cparata 0:485458fca2bd 560
cparata 0:485458fca2bd 561 /*******************************************************************************
cparata 0:485458fca2bd 562 * Function Name : LSM6DSL_ACC_GYRO_translate_ODR_G
cparata 0:485458fca2bd 563 * Description : Read ODR_G
cparata 0:485458fca2bd 564 * Input : LSM6DSL_ACC_GYRO_ODR_G_t
cparata 0:485458fca2bd 565 * Output : The ODR value in Hz
cparata 0:485458fca2bd 566 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 567 *******************************************************************************/
cparata 0:485458fca2bd 568 status_t LSM6DSL_ACC_GYRO_translate_ODR_G(LSM6DSL_ACC_GYRO_ODR_G_t value, u16_t *odr_hz_val)
cparata 0:485458fca2bd 569 {
cparata 0:485458fca2bd 570 switch(value) {
cparata 0:485458fca2bd 571 case LSM6DSL_ACC_GYRO_ODR_G_POWER_DOWN:
cparata 0:485458fca2bd 572 *odr_hz_val = 0;
cparata 0:485458fca2bd 573 break;
cparata 0:485458fca2bd 574
cparata 0:485458fca2bd 575 case LSM6DSL_ACC_GYRO_ODR_G_13Hz:
cparata 0:485458fca2bd 576 *odr_hz_val = 13;
cparata 0:485458fca2bd 577 break;
cparata 0:485458fca2bd 578
cparata 0:485458fca2bd 579 case LSM6DSL_ACC_GYRO_ODR_G_26Hz:
cparata 0:485458fca2bd 580 *odr_hz_val = 26;
cparata 0:485458fca2bd 581 break;
cparata 0:485458fca2bd 582
cparata 0:485458fca2bd 583 case LSM6DSL_ACC_GYRO_ODR_G_52Hz:
cparata 0:485458fca2bd 584 *odr_hz_val = 52;
cparata 0:485458fca2bd 585 break;
cparata 0:485458fca2bd 586
cparata 0:485458fca2bd 587 case LSM6DSL_ACC_GYRO_ODR_G_104Hz:
cparata 0:485458fca2bd 588 *odr_hz_val = 104;
cparata 0:485458fca2bd 589 break;
cparata 0:485458fca2bd 590
cparata 0:485458fca2bd 591 case LSM6DSL_ACC_GYRO_ODR_G_208Hz:
cparata 0:485458fca2bd 592 *odr_hz_val = 208;
cparata 0:485458fca2bd 593 break;
cparata 0:485458fca2bd 594
cparata 0:485458fca2bd 595 case LSM6DSL_ACC_GYRO_ODR_G_416Hz:
cparata 0:485458fca2bd 596 *odr_hz_val = 416;
cparata 0:485458fca2bd 597 break;
cparata 0:485458fca2bd 598
cparata 0:485458fca2bd 599 case LSM6DSL_ACC_GYRO_ODR_G_833Hz:
cparata 0:485458fca2bd 600 *odr_hz_val = 833;
cparata 0:485458fca2bd 601 break;
cparata 0:485458fca2bd 602
cparata 0:485458fca2bd 603 case LSM6DSL_ACC_GYRO_ODR_G_1660Hz:
cparata 0:485458fca2bd 604 *odr_hz_val = 1660;
cparata 0:485458fca2bd 605 break;
cparata 0:485458fca2bd 606
cparata 0:485458fca2bd 607 default:
cparata 0:485458fca2bd 608 return MEMS_ERROR;
cparata 0:485458fca2bd 609 }
cparata 0:485458fca2bd 610
cparata 0:485458fca2bd 611 return MEMS_SUCCESS;
cparata 0:485458fca2bd 612 }
cparata 0:485458fca2bd 613
cparata 0:485458fca2bd 614 /*******************************************************************************
cparata 0:485458fca2bd 615 * Function Name : LSM6DSL_ACC_GYRO_W_FS_125
cparata 0:485458fca2bd 616 * Description : Write FS_125
cparata 0:485458fca2bd 617 * Input : LSM6DSL_ACC_GYRO_FS_125_t
cparata 0:485458fca2bd 618 * Output : None
cparata 0:485458fca2bd 619 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 620 *******************************************************************************/
cparata 0:485458fca2bd 621 status_t LSM6DSL_ACC_GYRO_W_FS_125(void *handle, LSM6DSL_ACC_GYRO_FS_125_t newValue)
cparata 0:485458fca2bd 622 {
cparata 0:485458fca2bd 623 u8_t value;
cparata 0:485458fca2bd 624
cparata 0:485458fca2bd 625 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, &value, 1))
cparata 0:485458fca2bd 626 return MEMS_ERROR;
cparata 0:485458fca2bd 627
cparata 0:485458fca2bd 628 value &= ~LSM6DSL_ACC_GYRO_FS_125_MASK;
cparata 0:485458fca2bd 629 value |= newValue;
cparata 0:485458fca2bd 630
cparata 0:485458fca2bd 631 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, &value, 1) )
cparata 0:485458fca2bd 632 return MEMS_ERROR;
cparata 0:485458fca2bd 633
cparata 0:485458fca2bd 634 return MEMS_SUCCESS;
cparata 0:485458fca2bd 635 }
cparata 0:485458fca2bd 636
cparata 0:485458fca2bd 637 /*******************************************************************************
cparata 0:485458fca2bd 638 * Function Name : LSM6DSL_ACC_GYRO_R_FS_125
cparata 0:485458fca2bd 639 * Description : Read FS_125
cparata 0:485458fca2bd 640 * Input : Pointer to LSM6DSL_ACC_GYRO_FS_125_t
cparata 0:485458fca2bd 641 * Output : Status of FS_125 see LSM6DSL_ACC_GYRO_FS_125_t
cparata 0:485458fca2bd 642 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 643 *******************************************************************************/
cparata 0:485458fca2bd 644 status_t LSM6DSL_ACC_GYRO_R_FS_125(void *handle, LSM6DSL_ACC_GYRO_FS_125_t *value)
cparata 0:485458fca2bd 645 {
cparata 0:485458fca2bd 646 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, (u8_t *)value, 1))
cparata 0:485458fca2bd 647 return MEMS_ERROR;
cparata 0:485458fca2bd 648
cparata 0:485458fca2bd 649 *value &= LSM6DSL_ACC_GYRO_FS_125_MASK; //mask
cparata 0:485458fca2bd 650
cparata 0:485458fca2bd 651 return MEMS_SUCCESS;
cparata 0:485458fca2bd 652 }
cparata 0:485458fca2bd 653
cparata 0:485458fca2bd 654 /**************** Advanced Function *******************/
cparata 0:485458fca2bd 655
cparata 0:485458fca2bd 656 /*******************************************************************************
cparata 0:485458fca2bd 657 * Function Name : LSM6DSL_ACC_GYRO_W_BW_SEL
cparata 0:485458fca2bd 658 * Description : Write BW_SEL
cparata 0:485458fca2bd 659 * Input : LSM6DSL_ACC_GYRO_BW_SEL_t
cparata 0:485458fca2bd 660 * Output : None
cparata 0:485458fca2bd 661 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 662 *******************************************************************************/
cparata 0:485458fca2bd 663 status_t LSM6DSL_ACC_GYRO_W_BW_SEL(void *handle, LSM6DSL_ACC_GYRO_BW_SEL_t newValue)
cparata 0:485458fca2bd 664 {
cparata 0:485458fca2bd 665 u8_t value;
cparata 0:485458fca2bd 666
cparata 0:485458fca2bd 667 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, &value, 1))
cparata 0:485458fca2bd 668 return MEMS_ERROR;
cparata 0:485458fca2bd 669
cparata 0:485458fca2bd 670 value &= ~LSM6DSL_ACC_GYRO_BW_SEL_MASK;
cparata 0:485458fca2bd 671 value |= newValue;
cparata 0:485458fca2bd 672
cparata 0:485458fca2bd 673 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, &value, 1) )
cparata 0:485458fca2bd 674 return MEMS_ERROR;
cparata 0:485458fca2bd 675
cparata 0:485458fca2bd 676 return MEMS_SUCCESS;
cparata 0:485458fca2bd 677 }
cparata 0:485458fca2bd 678
cparata 0:485458fca2bd 679 /*******************************************************************************
cparata 0:485458fca2bd 680 * Function Name : LSM6DSL_ACC_GYRO_R_BW_SEL
cparata 0:485458fca2bd 681 * Description : Read BW_SEL
cparata 0:485458fca2bd 682 * Input : Pointer to LSM6DSL_ACC_GYRO_BW_SEL_t
cparata 0:485458fca2bd 683 * Output : Status of BW_SEL see LSM6DSL_ACC_GYRO_BW_SEL_t
cparata 0:485458fca2bd 684 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 685 *******************************************************************************/
cparata 0:485458fca2bd 686 status_t LSM6DSL_ACC_GYRO_R_BW_SEL(void *handle, LSM6DSL_ACC_GYRO_BW_SEL_t *value)
cparata 0:485458fca2bd 687 {
cparata 0:485458fca2bd 688 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, (u8_t *)value, 1))
cparata 0:485458fca2bd 689 return MEMS_ERROR;
cparata 0:485458fca2bd 690
cparata 0:485458fca2bd 691 *value &= LSM6DSL_ACC_GYRO_BW_SEL_MASK; //mask
cparata 0:485458fca2bd 692
cparata 0:485458fca2bd 693 return MEMS_SUCCESS;
cparata 0:485458fca2bd 694 }
cparata 0:485458fca2bd 695
cparata 0:485458fca2bd 696 /*******************************************************************************
cparata 0:485458fca2bd 697 * Function Name : LSM6DSL_ACC_GYRO_W_BLE
cparata 0:485458fca2bd 698 * Description : Write BLE
cparata 0:485458fca2bd 699 * Input : LSM6DSL_ACC_GYRO_BLE_t
cparata 0:485458fca2bd 700 * Output : None
cparata 0:485458fca2bd 701 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 702 *******************************************************************************/
cparata 0:485458fca2bd 703 status_t LSM6DSL_ACC_GYRO_W_BLE(void *handle, LSM6DSL_ACC_GYRO_BLE_t newValue)
cparata 0:485458fca2bd 704 {
cparata 0:485458fca2bd 705 u8_t value;
cparata 0:485458fca2bd 706
cparata 0:485458fca2bd 707 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
cparata 0:485458fca2bd 708 return MEMS_ERROR;
cparata 0:485458fca2bd 709
cparata 0:485458fca2bd 710 value &= ~LSM6DSL_ACC_GYRO_BLE_MASK;
cparata 0:485458fca2bd 711 value |= newValue;
cparata 0:485458fca2bd 712
cparata 0:485458fca2bd 713 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
cparata 0:485458fca2bd 714 return MEMS_ERROR;
cparata 0:485458fca2bd 715
cparata 0:485458fca2bd 716 return MEMS_SUCCESS;
cparata 0:485458fca2bd 717 }
cparata 0:485458fca2bd 718
cparata 0:485458fca2bd 719 /*******************************************************************************
cparata 0:485458fca2bd 720 * Function Name : LSM6DSL_ACC_GYRO_R_BLE
cparata 0:485458fca2bd 721 * Description : Read BLE
cparata 0:485458fca2bd 722 * Input : Pointer to LSM6DSL_ACC_GYRO_BLE_t
cparata 0:485458fca2bd 723 * Output : Status of BLE see LSM6DSL_ACC_GYRO_BLE_t
cparata 0:485458fca2bd 724 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 725 *******************************************************************************/
cparata 0:485458fca2bd 726 status_t LSM6DSL_ACC_GYRO_R_BLE(void *handle, LSM6DSL_ACC_GYRO_BLE_t *value)
cparata 0:485458fca2bd 727 {
cparata 0:485458fca2bd 728 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1))
cparata 0:485458fca2bd 729 return MEMS_ERROR;
cparata 0:485458fca2bd 730
cparata 0:485458fca2bd 731 *value &= LSM6DSL_ACC_GYRO_BLE_MASK; //mask
cparata 0:485458fca2bd 732
cparata 0:485458fca2bd 733 return MEMS_SUCCESS;
cparata 0:485458fca2bd 734 }
cparata 0:485458fca2bd 735
cparata 0:485458fca2bd 736 /*******************************************************************************
cparata 0:485458fca2bd 737 * Function Name : LSM6DSL_ACC_GYRO_W_EmbeddedAccess
cparata 0:485458fca2bd 738 * Description : Write EMB_ACC
cparata 0:485458fca2bd 739 * Input : LSM6DSL_ACC_GYRO_EMB_ACC_t
cparata 0:485458fca2bd 740 * Output : None
cparata 0:485458fca2bd 741 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 742 *******************************************************************************/
cparata 0:485458fca2bd 743 status_t LSM6DSL_ACC_GYRO_W_EmbeddedAccess(void *handle, LSM6DSL_ACC_GYRO_EMB_ACC_t newValue)
cparata 0:485458fca2bd 744 {
cparata 0:485458fca2bd 745 u8_t value;
cparata 0:485458fca2bd 746
cparata 0:485458fca2bd 747 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_CFG_ACCESS, &value, 1) )
cparata 0:485458fca2bd 748 return MEMS_ERROR;
cparata 0:485458fca2bd 749
cparata 0:485458fca2bd 750 value &= ~LSM6DSL_ACC_GYRO_EMB_ACC_MASK;
cparata 0:485458fca2bd 751 value |= newValue;
cparata 0:485458fca2bd 752
cparata 0:485458fca2bd 753 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FUNC_CFG_ACCESS, &value, 1) )
cparata 0:485458fca2bd 754 return MEMS_ERROR;
cparata 0:485458fca2bd 755
cparata 0:485458fca2bd 756 return MEMS_SUCCESS;
cparata 0:485458fca2bd 757 }
cparata 0:485458fca2bd 758
cparata 0:485458fca2bd 759 /*******************************************************************************
cparata 0:485458fca2bd 760 * Function Name : LSM6DSL_ACC_GYRO_R_EmbeddedAccess
cparata 0:485458fca2bd 761 * Description : Read EMB_ACC
cparata 0:485458fca2bd 762 * Input : Pointer to LSM6DSL_ACC_GYRO_EMB_ACC_t
cparata 0:485458fca2bd 763 * Output : Status of EMB_ACC see LSM6DSL_ACC_GYRO_EMB_ACC_t
cparata 0:485458fca2bd 764 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 765 *******************************************************************************/
cparata 0:485458fca2bd 766 status_t LSM6DSL_ACC_GYRO_R_EmbeddedAccess(void *handle, LSM6DSL_ACC_GYRO_EMB_ACC_t *value)
cparata 0:485458fca2bd 767 {
cparata 0:485458fca2bd 768 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_CFG_ACCESS, (u8_t *)value, 1) )
cparata 0:485458fca2bd 769 return MEMS_ERROR;
cparata 0:485458fca2bd 770
cparata 0:485458fca2bd 771 *value &= LSM6DSL_ACC_GYRO_EMB_ACC_MASK; //mask
cparata 0:485458fca2bd 772
cparata 0:485458fca2bd 773 return MEMS_SUCCESS;
cparata 0:485458fca2bd 774 }
cparata 0:485458fca2bd 775
cparata 0:485458fca2bd 776 /*******************************************************************************
cparata 0:485458fca2bd 777 * Function Name : LSM6DSL_ACC_GYRO_W_SYNC_RES_RATIO
cparata 0:485458fca2bd 778 * Description : Write RR
cparata 0:485458fca2bd 779 * Input : LSM6DSL_ACC_GYRO_SYNC_RES_RATIO_t
cparata 0:485458fca2bd 780 * Output : None
cparata 0:485458fca2bd 781 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 782 *******************************************************************************/
cparata 0:485458fca2bd 783 status_t LSM6DSL_ACC_GYRO_W_SYNC_RES_RATIO(void *handle, LSM6DSL_ACC_GYRO_SYNC_RES_RATIO_t newValue)
cparata 0:485458fca2bd 784 {
cparata 0:485458fca2bd 785 u8_t value;
cparata 0:485458fca2bd 786
cparata 0:485458fca2bd 787 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_SENSOR_RES_RATIO, &value, 1) )
cparata 0:485458fca2bd 788 return MEMS_ERROR;
cparata 0:485458fca2bd 789
cparata 0:485458fca2bd 790 value &= ~LSM6DSL_ACC_GYRO_SYNC_RES_RATIO_MASK;
cparata 0:485458fca2bd 791 value |= newValue;
cparata 0:485458fca2bd 792
cparata 0:485458fca2bd 793 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_SENSOR_RES_RATIO, &value, 1) )
cparata 0:485458fca2bd 794 return MEMS_ERROR;
cparata 0:485458fca2bd 795
cparata 0:485458fca2bd 796 return MEMS_SUCCESS;
cparata 0:485458fca2bd 797 }
cparata 0:485458fca2bd 798
cparata 0:485458fca2bd 799 /*******************************************************************************
cparata 0:485458fca2bd 800 * Function Name : LSM6DSL_ACC_GYRO_R_SYNC_RES_RATIO
cparata 0:485458fca2bd 801 * Description : Read RR
cparata 0:485458fca2bd 802 * Input : Pointer to LSM6DSL_ACC_GYRO_SYNC_RES_RATIO_t
cparata 0:485458fca2bd 803 * Output : Status of RR see LSM6DSL_ACC_GYRO_SYNC_RES_RATIO_t
cparata 0:485458fca2bd 804 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 805 *******************************************************************************/
cparata 0:485458fca2bd 806 status_t LSM6DSL_ACC_GYRO_R_SYNC_RES_RATIO(void *handle, LSM6DSL_ACC_GYRO_SYNC_RES_RATIO_t *value)
cparata 0:485458fca2bd 807 {
cparata 0:485458fca2bd 808 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_SENSOR_RES_RATIO, (u8_t *)value, 1) )
cparata 0:485458fca2bd 809 return MEMS_ERROR;
cparata 0:485458fca2bd 810
cparata 0:485458fca2bd 811 *value &= LSM6DSL_ACC_GYRO_SYNC_RES_RATIO_MASK; //mask
cparata 0:485458fca2bd 812
cparata 0:485458fca2bd 813 return MEMS_SUCCESS;
cparata 0:485458fca2bd 814 }
cparata 0:485458fca2bd 815
cparata 0:485458fca2bd 816 /*******************************************************************************
cparata 0:485458fca2bd 817 * Function Name : LSM6DSL_ACC_GYRO_W_Stamping_Time_Frame
cparata 0:485458fca2bd 818 * Description : Write TPH
cparata 0:485458fca2bd 819 * Input : u8_t
cparata 0:485458fca2bd 820 * Output : None
cparata 0:485458fca2bd 821 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 822 *******************************************************************************/
cparata 0:485458fca2bd 823 status_t LSM6DSL_ACC_GYRO_W_Stamping_Time_Frame(void *handle, u8_t newValue)
cparata 0:485458fca2bd 824 {
cparata 0:485458fca2bd 825 u8_t value;
cparata 0:485458fca2bd 826
cparata 0:485458fca2bd 827 newValue = newValue << LSM6DSL_ACC_GYRO_TPH_POSITION; //mask
cparata 0:485458fca2bd 828 newValue &= LSM6DSL_ACC_GYRO_TPH_MASK; //coerce
cparata 0:485458fca2bd 829
cparata 0:485458fca2bd 830 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_SENSOR_SYNC_TIME, &value, 1) )
cparata 0:485458fca2bd 831 return MEMS_ERROR;
cparata 0:485458fca2bd 832
cparata 0:485458fca2bd 833 value &= (u8_t)~LSM6DSL_ACC_GYRO_TPH_MASK;
cparata 0:485458fca2bd 834 value |= newValue;
cparata 0:485458fca2bd 835
cparata 0:485458fca2bd 836 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_SENSOR_SYNC_TIME, &value, 1) )
cparata 0:485458fca2bd 837 return MEMS_ERROR;
cparata 0:485458fca2bd 838
cparata 0:485458fca2bd 839 return MEMS_SUCCESS;
cparata 0:485458fca2bd 840 }
cparata 0:485458fca2bd 841
cparata 0:485458fca2bd 842 /*******************************************************************************
cparata 0:485458fca2bd 843 * Function Name : LSM6DSL_ACC_GYRO_R_Stamping_Time_Frame
cparata 0:485458fca2bd 844 * Description : Read TPH
cparata 0:485458fca2bd 845 * Input : Pointer to u8_t
cparata 0:485458fca2bd 846 * Output : Status of TPH
cparata 0:485458fca2bd 847 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 848 *******************************************************************************/
cparata 0:485458fca2bd 849 status_t LSM6DSL_ACC_GYRO_R_Stamping_Time_Frame(void *handle, u8_t *value)
cparata 0:485458fca2bd 850 {
cparata 0:485458fca2bd 851 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_SENSOR_SYNC_TIME, (u8_t *)value, 1) )
cparata 0:485458fca2bd 852 return MEMS_ERROR;
cparata 0:485458fca2bd 853
cparata 0:485458fca2bd 854 *value &= LSM6DSL_ACC_GYRO_TPH_MASK; //coerce
cparata 0:485458fca2bd 855 *value = *value >> LSM6DSL_ACC_GYRO_TPH_POSITION; //mask
cparata 0:485458fca2bd 856
cparata 0:485458fca2bd 857 return MEMS_SUCCESS;
cparata 0:485458fca2bd 858 }
cparata 0:485458fca2bd 859
cparata 0:485458fca2bd 860 /*******************************************************************************
cparata 0:485458fca2bd 861 * Function Name : LSM6DSL_ACC_GYRO_W_FIFO_Watermark
cparata 0:485458fca2bd 862 * Description : Write WTM_FIFO
cparata 0:485458fca2bd 863 * Input : u16_t
cparata 0:485458fca2bd 864 * Output : None
cparata 0:485458fca2bd 865 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 866 *******************************************************************************/
cparata 0:485458fca2bd 867 status_t LSM6DSL_ACC_GYRO_W_FIFO_Watermark(void *handle, u16_t newValue)
cparata 0:485458fca2bd 868 {
cparata 0:485458fca2bd 869 u8_t valueH, valueL;
cparata 0:485458fca2bd 870 u8_t value;
cparata 0:485458fca2bd 871
cparata 0:485458fca2bd 872 valueL = newValue & 0xFF;
cparata 0:485458fca2bd 873 valueH = (newValue >> 8) & 0xFF;
cparata 0:485458fca2bd 874
cparata 0:485458fca2bd 875 /* Low part goes in FIFO_CTRL1 */
cparata 0:485458fca2bd 876 valueL = valueL << LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL1_POSITION; //mask
cparata 0:485458fca2bd 877 valueL &= LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL1_MASK; //coerce
cparata 0:485458fca2bd 878
cparata 0:485458fca2bd 879 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL1, &value, 1) )
cparata 0:485458fca2bd 880 return MEMS_ERROR;
cparata 0:485458fca2bd 881
cparata 0:485458fca2bd 882 value &= (u8_t)~LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL1_MASK;
cparata 0:485458fca2bd 883 value |= valueL;
cparata 0:485458fca2bd 884
cparata 0:485458fca2bd 885 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL1, &value, 1) )
cparata 0:485458fca2bd 886 return MEMS_ERROR;
cparata 0:485458fca2bd 887
cparata 0:485458fca2bd 888 /* High part goes in FIFO_CTRL2 */
cparata 0:485458fca2bd 889 valueH = valueH << LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL2_POSITION; //mask
cparata 0:485458fca2bd 890 valueH &= LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL2_MASK; //coerce
cparata 0:485458fca2bd 891
cparata 0:485458fca2bd 892 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
cparata 0:485458fca2bd 893 return MEMS_ERROR;
cparata 0:485458fca2bd 894
cparata 0:485458fca2bd 895 value &= ~LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL2_MASK;
cparata 0:485458fca2bd 896 value |= valueH;
cparata 0:485458fca2bd 897
cparata 0:485458fca2bd 898 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
cparata 0:485458fca2bd 899 return MEMS_ERROR;
cparata 0:485458fca2bd 900
cparata 0:485458fca2bd 901 return MEMS_SUCCESS;
cparata 0:485458fca2bd 902 }
cparata 0:485458fca2bd 903
cparata 0:485458fca2bd 904 /*******************************************************************************
cparata 0:485458fca2bd 905 * Function Name : LSM6DSL_ACC_GYRO_R_FIFO_Watermark
cparata 0:485458fca2bd 906 * Description : Read WTM_FIFO
cparata 0:485458fca2bd 907 * Input : Pointer to u16_t
cparata 0:485458fca2bd 908 * Output : Status of WTM_FIFO
cparata 0:485458fca2bd 909 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 910 *******************************************************************************/
cparata 0:485458fca2bd 911 status_t LSM6DSL_ACC_GYRO_R_FIFO_Watermark(void *handle, u16_t *value)
cparata 0:485458fca2bd 912 {
cparata 0:485458fca2bd 913 u8_t valueH, valueL;
cparata 0:485458fca2bd 914
cparata 0:485458fca2bd 915 /* Low part from FIFO_CTRL1 */
cparata 0:485458fca2bd 916 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL1, (u8_t *)&valueL, 1) )
cparata 0:485458fca2bd 917 return MEMS_ERROR;
cparata 0:485458fca2bd 918
cparata 0:485458fca2bd 919 valueL &= LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL1_MASK; //coerce
cparata 0:485458fca2bd 920 valueL = valueL >> LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL1_POSITION; //mask
cparata 0:485458fca2bd 921
cparata 0:485458fca2bd 922 /* High part from FIFO_CTRL2 */
cparata 0:485458fca2bd 923 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, (u8_t *)&valueH, 1) )
cparata 0:485458fca2bd 924 return MEMS_ERROR;
cparata 0:485458fca2bd 925
cparata 0:485458fca2bd 926 valueH &= LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL2_MASK; //coerce
cparata 0:485458fca2bd 927 valueH = valueH >> LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL2_POSITION; //mask
cparata 0:485458fca2bd 928
cparata 0:485458fca2bd 929 *value = ((valueH << 8) & 0xFF00) | valueL;
cparata 0:485458fca2bd 930
cparata 0:485458fca2bd 931 return MEMS_SUCCESS;
cparata 0:485458fca2bd 932 }
cparata 0:485458fca2bd 933
cparata 0:485458fca2bd 934 /*******************************************************************************
cparata 0:485458fca2bd 935 * Function Name : LSM6DSL_ACC_GYRO_W_FIFO_TEMP
cparata 0:485458fca2bd 936 * Description : Write FIFO_TEMP_EN
cparata 0:485458fca2bd 937 * Input : LSM6DSL_ACC_GYRO_FIFO_TEMP_t
cparata 0:485458fca2bd 938 * Output : None
cparata 0:485458fca2bd 939 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 940 *******************************************************************************/
cparata 0:485458fca2bd 941 status_t LSM6DSL_ACC_GYRO_W_FIFO_TEMP(void *handle, LSM6DSL_ACC_GYRO_FIFO_TEMP_t newValue)
cparata 0:485458fca2bd 942 {
cparata 0:485458fca2bd 943 u8_t value;
cparata 0:485458fca2bd 944
cparata 0:485458fca2bd 945 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
cparata 0:485458fca2bd 946 return MEMS_ERROR;
cparata 0:485458fca2bd 947
cparata 0:485458fca2bd 948 value &= ~LSM6DSL_ACC_GYRO_FIFO_TEMP_MASK;
cparata 0:485458fca2bd 949 value |= newValue;
cparata 0:485458fca2bd 950
cparata 0:485458fca2bd 951 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
cparata 0:485458fca2bd 952 return MEMS_ERROR;
cparata 0:485458fca2bd 953
cparata 0:485458fca2bd 954 return MEMS_SUCCESS;
cparata 0:485458fca2bd 955 }
cparata 0:485458fca2bd 956
cparata 0:485458fca2bd 957 /*******************************************************************************
cparata 0:485458fca2bd 958 * Function Name : LSM6DSL_ACC_GYRO_R_FIFO_TEMP
cparata 0:485458fca2bd 959 * Description : Read FIFO_TEMP_EN
cparata 0:485458fca2bd 960 * Input : Pointer to LSM6DSL_ACC_GYRO_FIFO_TEMP_t
cparata 0:485458fca2bd 961 * Output : Status of FIFO_TEMP_EN see LSM6DSL_ACC_GYRO_FIFO_TEMP_t
cparata 0:485458fca2bd 962 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 963 *******************************************************************************/
cparata 0:485458fca2bd 964 status_t LSM6DSL_ACC_GYRO_R_FIFO_TEMP(void *handle, LSM6DSL_ACC_GYRO_FIFO_TEMP_t *value)
cparata 0:485458fca2bd 965 {
cparata 0:485458fca2bd 966 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, (u8_t *)value, 1) )
cparata 0:485458fca2bd 967 return MEMS_ERROR;
cparata 0:485458fca2bd 968
cparata 0:485458fca2bd 969 *value &= LSM6DSL_ACC_GYRO_FIFO_TEMP_MASK; //mask
cparata 0:485458fca2bd 970
cparata 0:485458fca2bd 971 return MEMS_SUCCESS;
cparata 0:485458fca2bd 972 }
cparata 0:485458fca2bd 973
cparata 0:485458fca2bd 974 /*******************************************************************************
cparata 0:485458fca2bd 975 * Function Name : LSM6DSL_ACC_GYRO_W_TIM_PEDO_FIFO_Write_En
cparata 0:485458fca2bd 976 * Description : Write TIM_PEDO_FIFO_DRDY
cparata 0:485458fca2bd 977 * Input : LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_DRDY_t
cparata 0:485458fca2bd 978 * Output : None
cparata 0:485458fca2bd 979 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 980 *******************************************************************************/
cparata 0:485458fca2bd 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:485458fca2bd 982 {
cparata 0:485458fca2bd 983 u8_t value;
cparata 0:485458fca2bd 984
cparata 0:485458fca2bd 985 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
cparata 0:485458fca2bd 986 return MEMS_ERROR;
cparata 0:485458fca2bd 987
cparata 0:485458fca2bd 988 value &= ~LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_DRDY_MASK;
cparata 0:485458fca2bd 989 value |= newValue;
cparata 0:485458fca2bd 990
cparata 0:485458fca2bd 991 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
cparata 0:485458fca2bd 992 return MEMS_ERROR;
cparata 0:485458fca2bd 993
cparata 0:485458fca2bd 994 return MEMS_SUCCESS;
cparata 0:485458fca2bd 995 }
cparata 0:485458fca2bd 996
cparata 0:485458fca2bd 997 /*******************************************************************************
cparata 0:485458fca2bd 998 * Function Name : LSM6DSL_ACC_GYRO_R_TIM_PEDO_FIFO_Write_En
cparata 0:485458fca2bd 999 * Description : Read TIM_PEDO_FIFO_DRDY
cparata 0:485458fca2bd 1000 * Input : Pointer to LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_DRDY_t
cparata 0:485458fca2bd 1001 * Output : Status of TIM_PEDO_FIFO_DRDY see LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_DRDY_t
cparata 0:485458fca2bd 1002 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1003 *******************************************************************************/
cparata 0:485458fca2bd 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:485458fca2bd 1005 {
cparata 0:485458fca2bd 1006 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, (u8_t *)value, 1) )
cparata 0:485458fca2bd 1007 return MEMS_ERROR;
cparata 0:485458fca2bd 1008
cparata 0:485458fca2bd 1009 *value &= LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_DRDY_MASK; //mask
cparata 0:485458fca2bd 1010
cparata 0:485458fca2bd 1011 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1012 }
cparata 0:485458fca2bd 1013
cparata 0:485458fca2bd 1014 /*******************************************************************************
cparata 0:485458fca2bd 1015 * Function Name : LSM6DSL_ACC_GYRO_W_TIM_PEDO_FIFO_En
cparata 0:485458fca2bd 1016 * Description : Write TIM_PEDO_FIFO_EN
cparata 0:485458fca2bd 1017 * Input : LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_EN_t
cparata 0:485458fca2bd 1018 * Output : None
cparata 0:485458fca2bd 1019 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1020 *******************************************************************************/
cparata 0:485458fca2bd 1021 status_t LSM6DSL_ACC_GYRO_W_TIM_PEDO_FIFO_En(void *handle, LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_EN_t newValue)
cparata 0:485458fca2bd 1022 {
cparata 0:485458fca2bd 1023 u8_t value;
cparata 0:485458fca2bd 1024
cparata 0:485458fca2bd 1025 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
cparata 0:485458fca2bd 1026 return MEMS_ERROR;
cparata 0:485458fca2bd 1027
cparata 0:485458fca2bd 1028 value &= ~LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_EN_MASK;
cparata 0:485458fca2bd 1029 value |= newValue;
cparata 0:485458fca2bd 1030
cparata 0:485458fca2bd 1031 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
cparata 0:485458fca2bd 1032 return MEMS_ERROR;
cparata 0:485458fca2bd 1033
cparata 0:485458fca2bd 1034 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1035 }
cparata 0:485458fca2bd 1036
cparata 0:485458fca2bd 1037 /*******************************************************************************
cparata 0:485458fca2bd 1038 * Function Name : LSM6DSL_ACC_GYRO_R_TIM_PEDO_FIFO_En
cparata 0:485458fca2bd 1039 * Description : Read TIM_PEDO_FIFO_EN
cparata 0:485458fca2bd 1040 * Input : Pointer to LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_EN_t
cparata 0:485458fca2bd 1041 * Output : Status of TIM_PEDO_FIFO_EN see LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_EN_t
cparata 0:485458fca2bd 1042 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1043 *******************************************************************************/
cparata 0:485458fca2bd 1044 status_t LSM6DSL_ACC_GYRO_R_TIM_PEDO_FIFO_En(void *handle, LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_EN_t *value)
cparata 0:485458fca2bd 1045 {
cparata 0:485458fca2bd 1046 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, (u8_t *)value, 1) )
cparata 0:485458fca2bd 1047 return MEMS_ERROR;
cparata 0:485458fca2bd 1048
cparata 0:485458fca2bd 1049 *value &= LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_EN_MASK; //mask
cparata 0:485458fca2bd 1050
cparata 0:485458fca2bd 1051 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1052 }
cparata 0:485458fca2bd 1053 /*******************************************************************************
cparata 0:485458fca2bd 1054 * Function Name : LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL
cparata 0:485458fca2bd 1055 * Description : Write DEC_FIFO_XL
cparata 0:485458fca2bd 1056 * Input : LSM6DSL_ACC_GYRO_DEC_FIFO_XL_t
cparata 0:485458fca2bd 1057 * Output : None
cparata 0:485458fca2bd 1058 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1059 *******************************************************************************/
cparata 0:485458fca2bd 1060 status_t LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_t newValue)
cparata 0:485458fca2bd 1061 {
cparata 0:485458fca2bd 1062 u8_t value;
cparata 0:485458fca2bd 1063
cparata 0:485458fca2bd 1064 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL3, &value, 1) )
cparata 0:485458fca2bd 1065 return MEMS_ERROR;
cparata 0:485458fca2bd 1066
cparata 0:485458fca2bd 1067 value &= ~LSM6DSL_ACC_GYRO_DEC_FIFO_XL_MASK;
cparata 0:485458fca2bd 1068 value |= newValue;
cparata 0:485458fca2bd 1069
cparata 0:485458fca2bd 1070 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL3, &value, 1) )
cparata 0:485458fca2bd 1071 return MEMS_ERROR;
cparata 0:485458fca2bd 1072
cparata 0:485458fca2bd 1073 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1074 }
cparata 0:485458fca2bd 1075
cparata 0:485458fca2bd 1076 /*******************************************************************************
cparata 0:485458fca2bd 1077 * Function Name : LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL_val
cparata 0:485458fca2bd 1078 * Description : Write DEC_FIFO_XL
cparata 0:485458fca2bd 1079 * Input : u16_t
cparata 0:485458fca2bd 1080 * Output : Program XL decimation value from unsigned short
cparata 0:485458fca2bd 1081 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1082 *******************************************************************************/
cparata 0:485458fca2bd 1083 status_t LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL_val(void *handle, u16_t newValue)
cparata 0:485458fca2bd 1084 {
cparata 0:485458fca2bd 1085 switch(newValue) {
cparata 0:485458fca2bd 1086 case 0:
cparata 0:485458fca2bd 1087 LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_DATA_NOT_IN_FIFO);
cparata 0:485458fca2bd 1088 break;
cparata 0:485458fca2bd 1089
cparata 0:485458fca2bd 1090 case 1:
cparata 0:485458fca2bd 1091 LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_NO_DECIMATION);
cparata 0:485458fca2bd 1092 break;
cparata 0:485458fca2bd 1093
cparata 0:485458fca2bd 1094 case 2:
cparata 0:485458fca2bd 1095 LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_2);
cparata 0:485458fca2bd 1096 break;
cparata 0:485458fca2bd 1097
cparata 0:485458fca2bd 1098 case 3:
cparata 0:485458fca2bd 1099 LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_3);
cparata 0:485458fca2bd 1100 break;
cparata 0:485458fca2bd 1101
cparata 0:485458fca2bd 1102 case 4:
cparata 0:485458fca2bd 1103 LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_4);
cparata 0:485458fca2bd 1104 break;
cparata 0:485458fca2bd 1105
cparata 0:485458fca2bd 1106 case 8:
cparata 0:485458fca2bd 1107 LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_8);
cparata 0:485458fca2bd 1108 break;
cparata 0:485458fca2bd 1109
cparata 0:485458fca2bd 1110 case 16:
cparata 0:485458fca2bd 1111 LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_16);
cparata 0:485458fca2bd 1112 break;
cparata 0:485458fca2bd 1113
cparata 0:485458fca2bd 1114 case 32:
cparata 0:485458fca2bd 1115 LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_32);
cparata 0:485458fca2bd 1116 break;
cparata 0:485458fca2bd 1117
cparata 0:485458fca2bd 1118 default:
cparata 0:485458fca2bd 1119 return MEMS_ERROR;
cparata 0:485458fca2bd 1120 }
cparata 0:485458fca2bd 1121
cparata 0:485458fca2bd 1122 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1123 }
cparata 0:485458fca2bd 1124
cparata 0:485458fca2bd 1125 /*******************************************************************************
cparata 0:485458fca2bd 1126 * Function Name : LSM6DSL_ACC_GYRO_R_DEC_FIFO_XL
cparata 0:485458fca2bd 1127 * Description : Read DEC_FIFO_XL
cparata 0:485458fca2bd 1128 * Input : Pointer to LSM6DSL_ACC_GYRO_DEC_FIFO_XL_t
cparata 0:485458fca2bd 1129 * Output : Status of DEC_FIFO_XL see LSM6DSL_ACC_GYRO_DEC_FIFO_XL_t
cparata 0:485458fca2bd 1130 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1131 *******************************************************************************/
cparata 0:485458fca2bd 1132 status_t LSM6DSL_ACC_GYRO_R_DEC_FIFO_XL(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_t *value)
cparata 0:485458fca2bd 1133 {
cparata 0:485458fca2bd 1134 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL3, (u8_t *)value, 1) )
cparata 0:485458fca2bd 1135 return MEMS_ERROR;
cparata 0:485458fca2bd 1136
cparata 0:485458fca2bd 1137 *value &= LSM6DSL_ACC_GYRO_DEC_FIFO_XL_MASK; //mask
cparata 0:485458fca2bd 1138
cparata 0:485458fca2bd 1139 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1140 }
cparata 0:485458fca2bd 1141
cparata 0:485458fca2bd 1142 /*******************************************************************************
cparata 0:485458fca2bd 1143 * Function Name : LSM6DSL_ACC_GYRO_W_DEC_FIFO_G
cparata 0:485458fca2bd 1144 * Description : Write DEC_FIFO_G
cparata 0:485458fca2bd 1145 * Input : LSM6DSL_ACC_GYRO_DEC_FIFO_G_t
cparata 0:485458fca2bd 1146 * Output : None
cparata 0:485458fca2bd 1147 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1148 *******************************************************************************/
cparata 0:485458fca2bd 1149 status_t LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_t newValue)
cparata 0:485458fca2bd 1150 {
cparata 0:485458fca2bd 1151 u8_t value;
cparata 0:485458fca2bd 1152
cparata 0:485458fca2bd 1153 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL3, &value, 1))
cparata 0:485458fca2bd 1154 return MEMS_ERROR;
cparata 0:485458fca2bd 1155
cparata 0:485458fca2bd 1156 value &= ~LSM6DSL_ACC_GYRO_DEC_FIFO_G_MASK;
cparata 0:485458fca2bd 1157 value |= newValue;
cparata 0:485458fca2bd 1158
cparata 0:485458fca2bd 1159 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL3, &value, 1) )
cparata 0:485458fca2bd 1160 return MEMS_ERROR;
cparata 0:485458fca2bd 1161
cparata 0:485458fca2bd 1162 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1163 }
cparata 0:485458fca2bd 1164
cparata 0:485458fca2bd 1165 /*******************************************************************************
cparata 0:485458fca2bd 1166 * Function Name : LSM6DSL_ACC_GYRO_W_DEC_FIFO_G_val
cparata 0:485458fca2bd 1167 * Description : Write DEC_FIFO_G
cparata 0:485458fca2bd 1168 * Input : u16_t
cparata 0:485458fca2bd 1169 * Output : Program G decimation value from unsigned short
cparata 0:485458fca2bd 1170 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1171 *******************************************************************************/
cparata 0:485458fca2bd 1172 status_t LSM6DSL_ACC_GYRO_W_DEC_FIFO_G_val(void *handle, u16_t newValue)
cparata 0:485458fca2bd 1173 {
cparata 0:485458fca2bd 1174 switch(newValue) {
cparata 0:485458fca2bd 1175 case 0:
cparata 0:485458fca2bd 1176 LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_DATA_NOT_IN_FIFO);
cparata 0:485458fca2bd 1177 break;
cparata 0:485458fca2bd 1178
cparata 0:485458fca2bd 1179 case 1:
cparata 0:485458fca2bd 1180 LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_NO_DECIMATION);
cparata 0:485458fca2bd 1181 break;
cparata 0:485458fca2bd 1182
cparata 0:485458fca2bd 1183 case 2:
cparata 0:485458fca2bd 1184 LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_2);
cparata 0:485458fca2bd 1185 break;
cparata 0:485458fca2bd 1186
cparata 0:485458fca2bd 1187 case 3:
cparata 0:485458fca2bd 1188 LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_3);
cparata 0:485458fca2bd 1189 break;
cparata 0:485458fca2bd 1190
cparata 0:485458fca2bd 1191 case 4:
cparata 0:485458fca2bd 1192 LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_4);
cparata 0:485458fca2bd 1193 break;
cparata 0:485458fca2bd 1194
cparata 0:485458fca2bd 1195 case 8:
cparata 0:485458fca2bd 1196 LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_8);
cparata 0:485458fca2bd 1197 break;
cparata 0:485458fca2bd 1198
cparata 0:485458fca2bd 1199 case 16:
cparata 0:485458fca2bd 1200 LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_16);
cparata 0:485458fca2bd 1201 break;
cparata 0:485458fca2bd 1202
cparata 0:485458fca2bd 1203 case 32:
cparata 0:485458fca2bd 1204 LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_32);
cparata 0:485458fca2bd 1205 break;
cparata 0:485458fca2bd 1206
cparata 0:485458fca2bd 1207 default:
cparata 0:485458fca2bd 1208 return MEMS_ERROR;
cparata 0:485458fca2bd 1209 }
cparata 0:485458fca2bd 1210
cparata 0:485458fca2bd 1211 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1212 }
cparata 0:485458fca2bd 1213
cparata 0:485458fca2bd 1214 /*******************************************************************************
cparata 0:485458fca2bd 1215 * Function Name : LSM6DSL_ACC_GYRO_R_DEC_FIFO_G
cparata 0:485458fca2bd 1216 * Description : Read DEC_FIFO_G
cparata 0:485458fca2bd 1217 * Input : Pointer to LSM6DSL_ACC_GYRO_DEC_FIFO_G_t
cparata 0:485458fca2bd 1218 * Output : Status of DEC_FIFO_G see LSM6DSL_ACC_GYRO_DEC_FIFO_G_t
cparata 0:485458fca2bd 1219 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1220 *******************************************************************************/
cparata 0:485458fca2bd 1221 status_t LSM6DSL_ACC_GYRO_R_DEC_FIFO_G(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_t *value)
cparata 0:485458fca2bd 1222 {
cparata 0:485458fca2bd 1223 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL3, (u8_t *)value, 1))
cparata 0:485458fca2bd 1224 return MEMS_ERROR;
cparata 0:485458fca2bd 1225
cparata 0:485458fca2bd 1226 *value &= LSM6DSL_ACC_GYRO_DEC_FIFO_G_MASK; //mask
cparata 0:485458fca2bd 1227
cparata 0:485458fca2bd 1228 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1229 }
cparata 0:485458fca2bd 1230
cparata 0:485458fca2bd 1231 /*******************************************************************************
cparata 0:485458fca2bd 1232 * Function Name : LSM6DSL_ACC_GYRO_W_DEC_FIFO_DS3
cparata 0:485458fca2bd 1233 * Description : Write DEC_DS3_FIFO
cparata 0:485458fca2bd 1234 * Input : LSM6DSL_ACC_GYRO_DEC_FIFO_DS3_t
cparata 0:485458fca2bd 1235 * Output : None
cparata 0:485458fca2bd 1236 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1237 *******************************************************************************/
cparata 0:485458fca2bd 1238 status_t LSM6DSL_ACC_GYRO_W_DEC_FIFO_DS3(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_DS3_t newValue)
cparata 0:485458fca2bd 1239 {
cparata 0:485458fca2bd 1240 u8_t value;
cparata 0:485458fca2bd 1241
cparata 0:485458fca2bd 1242 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1))
cparata 0:485458fca2bd 1243 return MEMS_ERROR;
cparata 0:485458fca2bd 1244
cparata 0:485458fca2bd 1245 value &= ~LSM6DSL_ACC_GYRO_DEC_FIFO_DS3_MASK;
cparata 0:485458fca2bd 1246 value |= newValue;
cparata 0:485458fca2bd 1247
cparata 0:485458fca2bd 1248 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1) )
cparata 0:485458fca2bd 1249 return MEMS_ERROR;
cparata 0:485458fca2bd 1250
cparata 0:485458fca2bd 1251 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1252 }
cparata 0:485458fca2bd 1253
cparata 0:485458fca2bd 1254 /*******************************************************************************
cparata 0:485458fca2bd 1255 * Function Name : LSM6DSL_ACC_GYRO_R_DEC_FIFO_DS3
cparata 0:485458fca2bd 1256 * Description : Read DEC_DS3_FIFO
cparata 0:485458fca2bd 1257 * Input : Pointer to LSM6DSL_ACC_GYRO_DEC_FIFO_DS3_t
cparata 0:485458fca2bd 1258 * Output : Status of DEC_DS3_FIFO see LSM6DSL_ACC_GYRO_DEC_FIFO_DS3_t
cparata 0:485458fca2bd 1259 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1260 *******************************************************************************/
cparata 0:485458fca2bd 1261 status_t LSM6DSL_ACC_GYRO_R_DEC_FIFO_DS3(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_DS3_t *value)
cparata 0:485458fca2bd 1262 {
cparata 0:485458fca2bd 1263 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, (u8_t *)value, 1))
cparata 0:485458fca2bd 1264 return MEMS_ERROR;
cparata 0:485458fca2bd 1265
cparata 0:485458fca2bd 1266 *value &= LSM6DSL_ACC_GYRO_DEC_FIFO_DS3_MASK; //mask
cparata 0:485458fca2bd 1267
cparata 0:485458fca2bd 1268 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1269 }
cparata 0:485458fca2bd 1270
cparata 0:485458fca2bd 1271 /*******************************************************************************
cparata 0:485458fca2bd 1272 * Function Name : LSM6DSL_ACC_GYRO_W_DEC_FIFO_DS4
cparata 0:485458fca2bd 1273 * Description : Write DEC_DS4_FIFO
cparata 0:485458fca2bd 1274 * Input : LSM6DSL_ACC_GYRO_DEC_FIFO_DS4_t
cparata 0:485458fca2bd 1275 * Output : None
cparata 0:485458fca2bd 1276 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1277 *******************************************************************************/
cparata 0:485458fca2bd 1278 status_t LSM6DSL_ACC_GYRO_W_DEC_FIFO_DS4(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_DS4_t newValue)
cparata 0:485458fca2bd 1279 {
cparata 0:485458fca2bd 1280 u8_t value;
cparata 0:485458fca2bd 1281
cparata 0:485458fca2bd 1282 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1))
cparata 0:485458fca2bd 1283 return MEMS_ERROR;
cparata 0:485458fca2bd 1284
cparata 0:485458fca2bd 1285 value &= ~LSM6DSL_ACC_GYRO_DEC_FIFO_DS4_MASK;
cparata 0:485458fca2bd 1286 value |= newValue;
cparata 0:485458fca2bd 1287
cparata 0:485458fca2bd 1288 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1) )
cparata 0:485458fca2bd 1289 return MEMS_ERROR;
cparata 0:485458fca2bd 1290
cparata 0:485458fca2bd 1291 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1292 }
cparata 0:485458fca2bd 1293
cparata 0:485458fca2bd 1294 /*******************************************************************************
cparata 0:485458fca2bd 1295 * Function Name : LSM6DSL_ACC_GYRO_R_DEC_FIFO_DS4
cparata 0:485458fca2bd 1296 * Description : Read DEC_DS4_FIFO
cparata 0:485458fca2bd 1297 * Input : Pointer to LSM6DSL_ACC_GYRO_DEC_FIFO_DS4_t
cparata 0:485458fca2bd 1298 * Output : Status of DEC_DS4_FIFO see LSM6DSL_ACC_GYRO_DEC_FIFO_DS4_t
cparata 0:485458fca2bd 1299 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1300 *******************************************************************************/
cparata 0:485458fca2bd 1301 status_t LSM6DSL_ACC_GYRO_R_DEC_FIFO_DS4(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_DS4_t *value)
cparata 0:485458fca2bd 1302 {
cparata 0:485458fca2bd 1303 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, (u8_t *)value, 1))
cparata 0:485458fca2bd 1304 return MEMS_ERROR;
cparata 0:485458fca2bd 1305
cparata 0:485458fca2bd 1306 *value &= LSM6DSL_ACC_GYRO_DEC_FIFO_DS4_MASK; //mask
cparata 0:485458fca2bd 1307
cparata 0:485458fca2bd 1308 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1309 }
cparata 0:485458fca2bd 1310
cparata 0:485458fca2bd 1311 /*******************************************************************************
cparata 0:485458fca2bd 1312 * Function Name : LSM6DSL_ACC_GYRO_W_HI_DATA_ONLY
cparata 0:485458fca2bd 1313 * Description : Write HI_DATA_ONLY
cparata 0:485458fca2bd 1314 * Input : LSM6DSL_ACC_GYRO_HI_DATA_ONLY_t
cparata 0:485458fca2bd 1315 * Output : None
cparata 0:485458fca2bd 1316 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1317 *******************************************************************************/
cparata 0:485458fca2bd 1318 status_t LSM6DSL_ACC_GYRO_W_HI_DATA_ONLY(void *handle, LSM6DSL_ACC_GYRO_HI_DATA_ONLY_t newValue)
cparata 0:485458fca2bd 1319 {
cparata 0:485458fca2bd 1320 u8_t value;
cparata 0:485458fca2bd 1321
cparata 0:485458fca2bd 1322 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1))
cparata 0:485458fca2bd 1323 return MEMS_ERROR;
cparata 0:485458fca2bd 1324
cparata 0:485458fca2bd 1325 value &= ~LSM6DSL_ACC_GYRO_HI_DATA_ONLY_MASK;
cparata 0:485458fca2bd 1326 value |= newValue;
cparata 0:485458fca2bd 1327
cparata 0:485458fca2bd 1328 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1) )
cparata 0:485458fca2bd 1329 return MEMS_ERROR;
cparata 0:485458fca2bd 1330
cparata 0:485458fca2bd 1331 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1332 }
cparata 0:485458fca2bd 1333
cparata 0:485458fca2bd 1334 /*******************************************************************************
cparata 0:485458fca2bd 1335 * Function Name : LSM6DSL_ACC_GYRO_R_HI_DATA_ONLY
cparata 0:485458fca2bd 1336 * Description : Read HI_DATA_ONLY
cparata 0:485458fca2bd 1337 * Input : Pointer to LSM6DSL_ACC_GYRO_HI_DATA_ONLY_t
cparata 0:485458fca2bd 1338 * Output : Status of HI_DATA_ONLY see LSM6DSL_ACC_GYRO_HI_DATA_ONLY_t
cparata 0:485458fca2bd 1339 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1340 *******************************************************************************/
cparata 0:485458fca2bd 1341 status_t LSM6DSL_ACC_GYRO_R_HI_DATA_ONLY(void *handle, LSM6DSL_ACC_GYRO_HI_DATA_ONLY_t *value)
cparata 0:485458fca2bd 1342 {
cparata 0:485458fca2bd 1343 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, (u8_t *)value, 1))
cparata 0:485458fca2bd 1344 return MEMS_ERROR;
cparata 0:485458fca2bd 1345
cparata 0:485458fca2bd 1346 *value &= LSM6DSL_ACC_GYRO_HI_DATA_ONLY_MASK; //mask
cparata 0:485458fca2bd 1347
cparata 0:485458fca2bd 1348 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1349 }
cparata 0:485458fca2bd 1350
cparata 0:485458fca2bd 1351 /*******************************************************************************
cparata 0:485458fca2bd 1352 * Function Name : LSM6DSL_ACC_GYRO_W_STOP_ON_FTH
cparata 0:485458fca2bd 1353 * Description : Write STOP_ON_FTH
cparata 0:485458fca2bd 1354 * Input : LSM6DSL_ACC_GYRO_STOP_ON_FTH_t
cparata 0:485458fca2bd 1355 * Output : None
cparata 0:485458fca2bd 1356 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1357 *******************************************************************************/
cparata 0:485458fca2bd 1358 status_t LSM6DSL_ACC_GYRO_W_STOP_ON_FTH(void *handle, LSM6DSL_ACC_GYRO_STOP_ON_FTH_t newValue)
cparata 0:485458fca2bd 1359 {
cparata 0:485458fca2bd 1360 u8_t value;
cparata 0:485458fca2bd 1361
cparata 0:485458fca2bd 1362 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1))
cparata 0:485458fca2bd 1363 return MEMS_ERROR;
cparata 0:485458fca2bd 1364
cparata 0:485458fca2bd 1365 value &= ~LSM6DSL_ACC_GYRO_STOP_ON_FTH_MASK;
cparata 0:485458fca2bd 1366 value |= newValue;
cparata 0:485458fca2bd 1367
cparata 0:485458fca2bd 1368 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1) )
cparata 0:485458fca2bd 1369 return MEMS_ERROR;
cparata 0:485458fca2bd 1370
cparata 0:485458fca2bd 1371 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1372 }
cparata 0:485458fca2bd 1373
cparata 0:485458fca2bd 1374 /*******************************************************************************
cparata 0:485458fca2bd 1375 * Function Name : LSM6DSL_ACC_GYRO_R_STOP_ON_FTH
cparata 0:485458fca2bd 1376 * Description : Read STOP_ON_FTH
cparata 0:485458fca2bd 1377 * Input : Pointer to LSM6DSL_ACC_GYRO_STOP_ON_FTH_t
cparata 0:485458fca2bd 1378 * Output : Status of STOP_ON_FTH see LSM6DSL_ACC_GYRO_STOP_ON_FTH_t
cparata 0:485458fca2bd 1379 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1380 *******************************************************************************/
cparata 0:485458fca2bd 1381 status_t LSM6DSL_ACC_GYRO_R_STOP_ON_FTH(void *handle, LSM6DSL_ACC_GYRO_STOP_ON_FTH_t *value)
cparata 0:485458fca2bd 1382 {
cparata 0:485458fca2bd 1383 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, (u8_t *)value, 1))
cparata 0:485458fca2bd 1384 return MEMS_ERROR;
cparata 0:485458fca2bd 1385
cparata 0:485458fca2bd 1386 *value &= LSM6DSL_ACC_GYRO_STOP_ON_FTH_MASK; //mask
cparata 0:485458fca2bd 1387
cparata 0:485458fca2bd 1388 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1389 }
cparata 0:485458fca2bd 1390
cparata 0:485458fca2bd 1391 /*******************************************************************************
cparata 0:485458fca2bd 1392 * Function Name : LSM6DSL_ACC_GYRO_W_FIFO_MODE
cparata 0:485458fca2bd 1393 * Description : Write FIFO_MODE
cparata 0:485458fca2bd 1394 * Input : LSM6DSL_ACC_GYRO_FIFO_MODE_t
cparata 0:485458fca2bd 1395 * Output : None
cparata 0:485458fca2bd 1396 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1397 *******************************************************************************/
cparata 0:485458fca2bd 1398 status_t LSM6DSL_ACC_GYRO_W_FIFO_MODE(void *handle, LSM6DSL_ACC_GYRO_FIFO_MODE_t newValue)
cparata 0:485458fca2bd 1399 {
cparata 0:485458fca2bd 1400 u8_t value;
cparata 0:485458fca2bd 1401
cparata 0:485458fca2bd 1402 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL5, &value, 1))
cparata 0:485458fca2bd 1403 return MEMS_ERROR;
cparata 0:485458fca2bd 1404
cparata 0:485458fca2bd 1405 value &= ~LSM6DSL_ACC_GYRO_FIFO_MODE_MASK;
cparata 0:485458fca2bd 1406 value |= newValue;
cparata 0:485458fca2bd 1407
cparata 0:485458fca2bd 1408 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL5, &value, 1) )
cparata 0:485458fca2bd 1409 return MEMS_ERROR;
cparata 0:485458fca2bd 1410
cparata 0:485458fca2bd 1411 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1412 }
cparata 0:485458fca2bd 1413
cparata 0:485458fca2bd 1414 /*******************************************************************************
cparata 0:485458fca2bd 1415 * Function Name : LSM6DSL_ACC_GYRO_R_FIFO_MODE
cparata 0:485458fca2bd 1416 * Description : Read FIFO_MODE
cparata 0:485458fca2bd 1417 * Input : Pointer to LSM6DSL_ACC_GYRO_FIFO_MODE_t
cparata 0:485458fca2bd 1418 * Output : Status of FIFO_MODE see LSM6DSL_ACC_GYRO_FIFO_MODE_t
cparata 0:485458fca2bd 1419 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1420 *******************************************************************************/
cparata 0:485458fca2bd 1421 status_t LSM6DSL_ACC_GYRO_R_FIFO_MODE(void *handle, LSM6DSL_ACC_GYRO_FIFO_MODE_t *value)
cparata 0:485458fca2bd 1422 {
cparata 0:485458fca2bd 1423 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL5, (u8_t *)value, 1))
cparata 0:485458fca2bd 1424 return MEMS_ERROR;
cparata 0:485458fca2bd 1425
cparata 0:485458fca2bd 1426 *value &= LSM6DSL_ACC_GYRO_FIFO_MODE_MASK; //mask
cparata 0:485458fca2bd 1427
cparata 0:485458fca2bd 1428 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1429 }
cparata 0:485458fca2bd 1430
cparata 0:485458fca2bd 1431 /*******************************************************************************
cparata 0:485458fca2bd 1432 * Function Name : LSM6DSL_ACC_GYRO_W_ODR_FIFO
cparata 0:485458fca2bd 1433 * Description : Write ODR_FIFO
cparata 0:485458fca2bd 1434 * Input : LSM6DSL_ACC_GYRO_ODR_FIFO_t
cparata 0:485458fca2bd 1435 * Output : None
cparata 0:485458fca2bd 1436 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1437 *******************************************************************************/
cparata 0:485458fca2bd 1438 status_t LSM6DSL_ACC_GYRO_W_ODR_FIFO(void *handle, LSM6DSL_ACC_GYRO_ODR_FIFO_t newValue)
cparata 0:485458fca2bd 1439 {
cparata 0:485458fca2bd 1440 u8_t value;
cparata 0:485458fca2bd 1441
cparata 0:485458fca2bd 1442 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL5, &value, 1))
cparata 0:485458fca2bd 1443 return MEMS_ERROR;
cparata 0:485458fca2bd 1444
cparata 0:485458fca2bd 1445 value &= ~LSM6DSL_ACC_GYRO_ODR_FIFO_MASK;
cparata 0:485458fca2bd 1446 value |= newValue;
cparata 0:485458fca2bd 1447
cparata 0:485458fca2bd 1448 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL5, &value, 1) )
cparata 0:485458fca2bd 1449 return MEMS_ERROR;
cparata 0:485458fca2bd 1450
cparata 0:485458fca2bd 1451 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1452 }
cparata 0:485458fca2bd 1453
cparata 0:485458fca2bd 1454 /*******************************************************************************
cparata 0:485458fca2bd 1455 * Function Name : LSM6DSL_ACC_GYRO_R_ODR_FIFO
cparata 0:485458fca2bd 1456 * Description : Read ODR_FIFO
cparata 0:485458fca2bd 1457 * Input : Pointer to LSM6DSL_ACC_GYRO_ODR_FIFO_t
cparata 0:485458fca2bd 1458 * Output : Status of ODR_FIFO see LSM6DSL_ACC_GYRO_ODR_FIFO_t
cparata 0:485458fca2bd 1459 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1460 *******************************************************************************/
cparata 0:485458fca2bd 1461 status_t LSM6DSL_ACC_GYRO_R_ODR_FIFO(void *handle, LSM6DSL_ACC_GYRO_ODR_FIFO_t *value)
cparata 0:485458fca2bd 1462 {
cparata 0:485458fca2bd 1463 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL5, (u8_t *)value, 1))
cparata 0:485458fca2bd 1464 return MEMS_ERROR;
cparata 0:485458fca2bd 1465
cparata 0:485458fca2bd 1466 *value &= LSM6DSL_ACC_GYRO_ODR_FIFO_MASK; //mask
cparata 0:485458fca2bd 1467
cparata 0:485458fca2bd 1468 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1469 }
cparata 0:485458fca2bd 1470
cparata 0:485458fca2bd 1471 /*******************************************************************************
cparata 0:485458fca2bd 1472 * Function Name : LSM6DSL_ACC_GYRO_W_DRDY_PULSE
cparata 0:485458fca2bd 1473 * Description : Write DRDY_PULSE
cparata 0:485458fca2bd 1474 * Input : LSM6DSL_ACC_GYRO_DRDY_PULSE_t
cparata 0:485458fca2bd 1475 * Output : None
cparata 0:485458fca2bd 1476 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1477 *******************************************************************************/
cparata 0:485458fca2bd 1478 status_t LSM6DSL_ACC_GYRO_W_DRDY_PULSE(void *handle, LSM6DSL_ACC_GYRO_DRDY_PULSE_t newValue)
cparata 0:485458fca2bd 1479 {
cparata 0:485458fca2bd 1480 u8_t value;
cparata 0:485458fca2bd 1481
cparata 0:485458fca2bd 1482 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_DRDY_PULSE_CFG_G, &value, 1))
cparata 0:485458fca2bd 1483 return MEMS_ERROR;
cparata 0:485458fca2bd 1484
cparata 0:485458fca2bd 1485 value &= ~LSM6DSL_ACC_GYRO_DRDY_PULSE_MASK;
cparata 0:485458fca2bd 1486 value |= newValue;
cparata 0:485458fca2bd 1487
cparata 0:485458fca2bd 1488 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_DRDY_PULSE_CFG_G, &value, 1) )
cparata 0:485458fca2bd 1489 return MEMS_ERROR;
cparata 0:485458fca2bd 1490
cparata 0:485458fca2bd 1491 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1492 }
cparata 0:485458fca2bd 1493
cparata 0:485458fca2bd 1494 /*******************************************************************************
cparata 0:485458fca2bd 1495 * Function Name : LSM6DSL_ACC_GYRO_R_DRDY_PULSE
cparata 0:485458fca2bd 1496 * Description : Read DRDY_PULSE
cparata 0:485458fca2bd 1497 * Input : Pointer to LSM6DSL_ACC_GYRO_DRDY_PULSE_t
cparata 0:485458fca2bd 1498 * Output : Status of DRDY_PULSE see LSM6DSL_ACC_GYRO_DRDY_PULSE_t
cparata 0:485458fca2bd 1499 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1500 *******************************************************************************/
cparata 0:485458fca2bd 1501 status_t LSM6DSL_ACC_GYRO_R_DRDY_PULSE(void *handle, LSM6DSL_ACC_GYRO_DRDY_PULSE_t *value)
cparata 0:485458fca2bd 1502 {
cparata 0:485458fca2bd 1503 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_DRDY_PULSE_CFG_G, (u8_t *)value, 1))
cparata 0:485458fca2bd 1504 return MEMS_ERROR;
cparata 0:485458fca2bd 1505
cparata 0:485458fca2bd 1506 *value &= LSM6DSL_ACC_GYRO_DRDY_PULSE_MASK; //mask
cparata 0:485458fca2bd 1507
cparata 0:485458fca2bd 1508 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1509 }
cparata 0:485458fca2bd 1510
cparata 0:485458fca2bd 1511 /*******************************************************************************
cparata 0:485458fca2bd 1512 * Function Name : LSM6DSL_ACC_GYRO_W_DRDY_XL_on_INT1
cparata 0:485458fca2bd 1513 * Description : Write INT1_DRDY_XL
cparata 0:485458fca2bd 1514 * Input : LSM6DSL_ACC_GYRO_INT1_DRDY_XL_t
cparata 0:485458fca2bd 1515 * Output : None
cparata 0:485458fca2bd 1516 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1517 *******************************************************************************/
cparata 0:485458fca2bd 1518 status_t LSM6DSL_ACC_GYRO_W_DRDY_XL_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_DRDY_XL_t newValue)
cparata 0:485458fca2bd 1519 {
cparata 0:485458fca2bd 1520 u8_t value;
cparata 0:485458fca2bd 1521
cparata 0:485458fca2bd 1522 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
cparata 0:485458fca2bd 1523 return MEMS_ERROR;
cparata 0:485458fca2bd 1524
cparata 0:485458fca2bd 1525 value &= ~LSM6DSL_ACC_GYRO_INT1_DRDY_XL_MASK;
cparata 0:485458fca2bd 1526 value |= newValue;
cparata 0:485458fca2bd 1527
cparata 0:485458fca2bd 1528 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
cparata 0:485458fca2bd 1529 return MEMS_ERROR;
cparata 0:485458fca2bd 1530
cparata 0:485458fca2bd 1531 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1532 }
cparata 0:485458fca2bd 1533
cparata 0:485458fca2bd 1534 /*******************************************************************************
cparata 0:485458fca2bd 1535 * Function Name : LSM6DSL_ACC_GYRO_R_DRDY_XL_on_INT1
cparata 0:485458fca2bd 1536 * Description : Read INT1_DRDY_XL
cparata 0:485458fca2bd 1537 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_DRDY_XL_t
cparata 0:485458fca2bd 1538 * Output : Status of INT1_DRDY_XL see LSM6DSL_ACC_GYRO_INT1_DRDY_XL_t
cparata 0:485458fca2bd 1539 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1540 *******************************************************************************/
cparata 0:485458fca2bd 1541 status_t LSM6DSL_ACC_GYRO_R_DRDY_XL_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_DRDY_XL_t *value)
cparata 0:485458fca2bd 1542 {
cparata 0:485458fca2bd 1543 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
cparata 0:485458fca2bd 1544 return MEMS_ERROR;
cparata 0:485458fca2bd 1545
cparata 0:485458fca2bd 1546 *value &= LSM6DSL_ACC_GYRO_INT1_DRDY_XL_MASK; //mask
cparata 0:485458fca2bd 1547
cparata 0:485458fca2bd 1548 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1549 }
cparata 0:485458fca2bd 1550
cparata 0:485458fca2bd 1551 /*******************************************************************************
cparata 0:485458fca2bd 1552 * Function Name : LSM6DSL_ACC_GYRO_W_DRDY_G_on_INT1
cparata 0:485458fca2bd 1553 * Description : Write INT1_DRDY_G
cparata 0:485458fca2bd 1554 * Input : LSM6DSL_ACC_GYRO_INT1_DRDY_G_t
cparata 0:485458fca2bd 1555 * Output : None
cparata 0:485458fca2bd 1556 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1557 *******************************************************************************/
cparata 0:485458fca2bd 1558 status_t LSM6DSL_ACC_GYRO_W_DRDY_G_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_DRDY_G_t newValue)
cparata 0:485458fca2bd 1559 {
cparata 0:485458fca2bd 1560 u8_t value;
cparata 0:485458fca2bd 1561
cparata 0:485458fca2bd 1562 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
cparata 0:485458fca2bd 1563 return MEMS_ERROR;
cparata 0:485458fca2bd 1564
cparata 0:485458fca2bd 1565 value &= ~LSM6DSL_ACC_GYRO_INT1_DRDY_G_MASK;
cparata 0:485458fca2bd 1566 value |= newValue;
cparata 0:485458fca2bd 1567
cparata 0:485458fca2bd 1568 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
cparata 0:485458fca2bd 1569 return MEMS_ERROR;
cparata 0:485458fca2bd 1570
cparata 0:485458fca2bd 1571 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1572 }
cparata 0:485458fca2bd 1573
cparata 0:485458fca2bd 1574 /*******************************************************************************
cparata 0:485458fca2bd 1575 * Function Name : LSM6DSL_ACC_GYRO_R_DRDY_G_on_INT1
cparata 0:485458fca2bd 1576 * Description : Read INT1_DRDY_G
cparata 0:485458fca2bd 1577 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_DRDY_G_t
cparata 0:485458fca2bd 1578 * Output : Status of INT1_DRDY_G see LSM6DSL_ACC_GYRO_INT1_DRDY_G_t
cparata 0:485458fca2bd 1579 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1580 *******************************************************************************/
cparata 0:485458fca2bd 1581 status_t LSM6DSL_ACC_GYRO_R_DRDY_G_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_DRDY_G_t *value)
cparata 0:485458fca2bd 1582 {
cparata 0:485458fca2bd 1583 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
cparata 0:485458fca2bd 1584 return MEMS_ERROR;
cparata 0:485458fca2bd 1585
cparata 0:485458fca2bd 1586 *value &= LSM6DSL_ACC_GYRO_INT1_DRDY_G_MASK; //mask
cparata 0:485458fca2bd 1587
cparata 0:485458fca2bd 1588 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1589 }
cparata 0:485458fca2bd 1590
cparata 0:485458fca2bd 1591 /*******************************************************************************
cparata 0:485458fca2bd 1592 * Function Name : LSM6DSL_ACC_GYRO_W_BOOT_on_INT1
cparata 0:485458fca2bd 1593 * Description : Write INT1_BOOT
cparata 0:485458fca2bd 1594 * Input : LSM6DSL_ACC_GYRO_INT1_BOOT_t
cparata 0:485458fca2bd 1595 * Output : None
cparata 0:485458fca2bd 1596 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1597 *******************************************************************************/
cparata 0:485458fca2bd 1598 status_t LSM6DSL_ACC_GYRO_W_BOOT_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_BOOT_t newValue)
cparata 0:485458fca2bd 1599 {
cparata 0:485458fca2bd 1600 u8_t value;
cparata 0:485458fca2bd 1601
cparata 0:485458fca2bd 1602 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
cparata 0:485458fca2bd 1603 return MEMS_ERROR;
cparata 0:485458fca2bd 1604
cparata 0:485458fca2bd 1605 value &= ~LSM6DSL_ACC_GYRO_INT1_BOOT_MASK;
cparata 0:485458fca2bd 1606 value |= newValue;
cparata 0:485458fca2bd 1607
cparata 0:485458fca2bd 1608 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
cparata 0:485458fca2bd 1609 return MEMS_ERROR;
cparata 0:485458fca2bd 1610
cparata 0:485458fca2bd 1611 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1612 }
cparata 0:485458fca2bd 1613
cparata 0:485458fca2bd 1614 /*******************************************************************************
cparata 0:485458fca2bd 1615 * Function Name : LSM6DSL_ACC_GYRO_R_BOOT_on_INT1
cparata 0:485458fca2bd 1616 * Description : Read INT1_BOOT
cparata 0:485458fca2bd 1617 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_BOOT_t
cparata 0:485458fca2bd 1618 * Output : Status of INT1_BOOT see LSM6DSL_ACC_GYRO_INT1_BOOT_t
cparata 0:485458fca2bd 1619 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1620 *******************************************************************************/
cparata 0:485458fca2bd 1621 status_t LSM6DSL_ACC_GYRO_R_BOOT_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_BOOT_t *value)
cparata 0:485458fca2bd 1622 {
cparata 0:485458fca2bd 1623 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
cparata 0:485458fca2bd 1624 return MEMS_ERROR;
cparata 0:485458fca2bd 1625
cparata 0:485458fca2bd 1626 *value &= LSM6DSL_ACC_GYRO_INT1_BOOT_MASK; //mask
cparata 0:485458fca2bd 1627
cparata 0:485458fca2bd 1628 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1629 }
cparata 0:485458fca2bd 1630
cparata 0:485458fca2bd 1631 /*******************************************************************************
cparata 0:485458fca2bd 1632 * Function Name : LSM6DSL_ACC_GYRO_W_FIFO_TSHLD_on_INT1
cparata 0:485458fca2bd 1633 * Description : Write INT1_FTH
cparata 0:485458fca2bd 1634 * Input : LSM6DSL_ACC_GYRO_INT1_FTH_t
cparata 0:485458fca2bd 1635 * Output : None
cparata 0:485458fca2bd 1636 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1637 *******************************************************************************/
cparata 0:485458fca2bd 1638 status_t LSM6DSL_ACC_GYRO_W_FIFO_TSHLD_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_FTH_t newValue)
cparata 0:485458fca2bd 1639 {
cparata 0:485458fca2bd 1640 u8_t value;
cparata 0:485458fca2bd 1641
cparata 0:485458fca2bd 1642 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
cparata 0:485458fca2bd 1643 return MEMS_ERROR;
cparata 0:485458fca2bd 1644
cparata 0:485458fca2bd 1645 value &= ~LSM6DSL_ACC_GYRO_INT1_FTH_MASK;
cparata 0:485458fca2bd 1646 value |= newValue;
cparata 0:485458fca2bd 1647
cparata 0:485458fca2bd 1648 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
cparata 0:485458fca2bd 1649 return MEMS_ERROR;
cparata 0:485458fca2bd 1650
cparata 0:485458fca2bd 1651 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1652 }
cparata 0:485458fca2bd 1653
cparata 0:485458fca2bd 1654 /*******************************************************************************
cparata 0:485458fca2bd 1655 * Function Name : LSM6DSL_ACC_GYRO_R_FIFO_TSHLD_on_INT1
cparata 0:485458fca2bd 1656 * Description : Read INT1_FTH
cparata 0:485458fca2bd 1657 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_FTH_t
cparata 0:485458fca2bd 1658 * Output : Status of INT1_FTH see LSM6DSL_ACC_GYRO_INT1_FTH_t
cparata 0:485458fca2bd 1659 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1660 *******************************************************************************/
cparata 0:485458fca2bd 1661 status_t LSM6DSL_ACC_GYRO_R_FIFO_TSHLD_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_FTH_t *value)
cparata 0:485458fca2bd 1662 {
cparata 0:485458fca2bd 1663 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
cparata 0:485458fca2bd 1664 return MEMS_ERROR;
cparata 0:485458fca2bd 1665
cparata 0:485458fca2bd 1666 *value &= LSM6DSL_ACC_GYRO_INT1_FTH_MASK; //mask
cparata 0:485458fca2bd 1667
cparata 0:485458fca2bd 1668 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1669 }
cparata 0:485458fca2bd 1670
cparata 0:485458fca2bd 1671 /*******************************************************************************
cparata 0:485458fca2bd 1672 * Function Name : LSM6DSL_ACC_GYRO_W_OVERRUN_on_INT1
cparata 0:485458fca2bd 1673 * Description : Write INT1_OVR
cparata 0:485458fca2bd 1674 * Input : LSM6DSL_ACC_GYRO_INT1_OVR_t
cparata 0:485458fca2bd 1675 * Output : None
cparata 0:485458fca2bd 1676 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1677 *******************************************************************************/
cparata 0:485458fca2bd 1678 status_t LSM6DSL_ACC_GYRO_W_OVERRUN_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_OVR_t newValue)
cparata 0:485458fca2bd 1679 {
cparata 0:485458fca2bd 1680 u8_t value;
cparata 0:485458fca2bd 1681
cparata 0:485458fca2bd 1682 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
cparata 0:485458fca2bd 1683 return MEMS_ERROR;
cparata 0:485458fca2bd 1684
cparata 0:485458fca2bd 1685 value &= ~LSM6DSL_ACC_GYRO_INT1_OVR_MASK;
cparata 0:485458fca2bd 1686 value |= newValue;
cparata 0:485458fca2bd 1687
cparata 0:485458fca2bd 1688 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
cparata 0:485458fca2bd 1689 return MEMS_ERROR;
cparata 0:485458fca2bd 1690
cparata 0:485458fca2bd 1691 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1692 }
cparata 0:485458fca2bd 1693
cparata 0:485458fca2bd 1694 /*******************************************************************************
cparata 0:485458fca2bd 1695 * Function Name : LSM6DSL_ACC_GYRO_R_OVERRUN_on_INT1
cparata 0:485458fca2bd 1696 * Description : Read INT1_OVR
cparata 0:485458fca2bd 1697 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_OVR_t
cparata 0:485458fca2bd 1698 * Output : Status of INT1_OVR see LSM6DSL_ACC_GYRO_INT1_OVR_t
cparata 0:485458fca2bd 1699 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1700 *******************************************************************************/
cparata 0:485458fca2bd 1701 status_t LSM6DSL_ACC_GYRO_R_OVERRUN_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_OVR_t *value)
cparata 0:485458fca2bd 1702 {
cparata 0:485458fca2bd 1703 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
cparata 0:485458fca2bd 1704 return MEMS_ERROR;
cparata 0:485458fca2bd 1705
cparata 0:485458fca2bd 1706 *value &= LSM6DSL_ACC_GYRO_INT1_OVR_MASK; //mask
cparata 0:485458fca2bd 1707
cparata 0:485458fca2bd 1708 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1709 }
cparata 0:485458fca2bd 1710
cparata 0:485458fca2bd 1711 /*******************************************************************************
cparata 0:485458fca2bd 1712 * Function Name : LSM6DSL_ACC_GYRO_W_FULL_FLAG_on_INT1
cparata 0:485458fca2bd 1713 * Description : Write INT1_FULL_FLAG
cparata 0:485458fca2bd 1714 * Input : LSM6DSL_ACC_GYRO_INT1_FULL_FLAG_t
cparata 0:485458fca2bd 1715 * Output : None
cparata 0:485458fca2bd 1716 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1717 *******************************************************************************/
cparata 0:485458fca2bd 1718 status_t LSM6DSL_ACC_GYRO_W_FULL_FLAG_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_FULL_FLAG_t newValue)
cparata 0:485458fca2bd 1719 {
cparata 0:485458fca2bd 1720 u8_t value;
cparata 0:485458fca2bd 1721
cparata 0:485458fca2bd 1722 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
cparata 0:485458fca2bd 1723 return MEMS_ERROR;
cparata 0:485458fca2bd 1724
cparata 0:485458fca2bd 1725 value &= ~LSM6DSL_ACC_GYRO_INT1_FULL_FLAG_MASK;
cparata 0:485458fca2bd 1726 value |= newValue;
cparata 0:485458fca2bd 1727
cparata 0:485458fca2bd 1728 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
cparata 0:485458fca2bd 1729 return MEMS_ERROR;
cparata 0:485458fca2bd 1730
cparata 0:485458fca2bd 1731 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1732 }
cparata 0:485458fca2bd 1733
cparata 0:485458fca2bd 1734 /*******************************************************************************
cparata 0:485458fca2bd 1735 * Function Name : LSM6DSL_ACC_GYRO_R_FULL_FLAG_on_INT1
cparata 0:485458fca2bd 1736 * Description : Read INT1_FULL_FLAG
cparata 0:485458fca2bd 1737 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_FULL_FLAG_t
cparata 0:485458fca2bd 1738 * Output : Status of INT1_FULL_FLAG see LSM6DSL_ACC_GYRO_INT1_FULL_FLAG_t
cparata 0:485458fca2bd 1739 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1740 *******************************************************************************/
cparata 0:485458fca2bd 1741 status_t LSM6DSL_ACC_GYRO_R_FULL_FLAG_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_FULL_FLAG_t *value)
cparata 0:485458fca2bd 1742 {
cparata 0:485458fca2bd 1743 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
cparata 0:485458fca2bd 1744 return MEMS_ERROR;
cparata 0:485458fca2bd 1745
cparata 0:485458fca2bd 1746 *value &= LSM6DSL_ACC_GYRO_INT1_FULL_FLAG_MASK; //mask
cparata 0:485458fca2bd 1747
cparata 0:485458fca2bd 1748 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1749 }
cparata 0:485458fca2bd 1750
cparata 0:485458fca2bd 1751 /*******************************************************************************
cparata 0:485458fca2bd 1752 * Function Name : LSM6DSL_ACC_GYRO_W_SIGN_MOT_on_INT1
cparata 0:485458fca2bd 1753 * Description : Write INT1_SIGN_MOT
cparata 0:485458fca2bd 1754 * Input : LSM6DSL_ACC_GYRO_INT1_SIGN_MOT_t
cparata 0:485458fca2bd 1755 * Output : None
cparata 0:485458fca2bd 1756 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1757 *******************************************************************************/
cparata 0:485458fca2bd 1758 status_t LSM6DSL_ACC_GYRO_W_SIGN_MOT_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_SIGN_MOT_t newValue)
cparata 0:485458fca2bd 1759 {
cparata 0:485458fca2bd 1760 u8_t value;
cparata 0:485458fca2bd 1761
cparata 0:485458fca2bd 1762 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
cparata 0:485458fca2bd 1763 return MEMS_ERROR;
cparata 0:485458fca2bd 1764
cparata 0:485458fca2bd 1765 value &= ~LSM6DSL_ACC_GYRO_INT1_SIGN_MOT_MASK;
cparata 0:485458fca2bd 1766 value |= newValue;
cparata 0:485458fca2bd 1767
cparata 0:485458fca2bd 1768 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
cparata 0:485458fca2bd 1769 return MEMS_ERROR;
cparata 0:485458fca2bd 1770
cparata 0:485458fca2bd 1771 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1772 }
cparata 0:485458fca2bd 1773
cparata 0:485458fca2bd 1774 /*******************************************************************************
cparata 0:485458fca2bd 1775 * Function Name : LSM6DSL_ACC_GYRO_R_SIGN_MOT_on_INT1
cparata 0:485458fca2bd 1776 * Description : Read INT1_SIGN_MOT
cparata 0:485458fca2bd 1777 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_SIGN_MOT_t
cparata 0:485458fca2bd 1778 * Output : Status of INT1_SIGN_MOT see LSM6DSL_ACC_GYRO_INT1_SIGN_MOT_t
cparata 0:485458fca2bd 1779 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1780 *******************************************************************************/
cparata 0:485458fca2bd 1781 status_t LSM6DSL_ACC_GYRO_R_SIGN_MOT_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_SIGN_MOT_t *value)
cparata 0:485458fca2bd 1782 {
cparata 0:485458fca2bd 1783 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
cparata 0:485458fca2bd 1784 return MEMS_ERROR;
cparata 0:485458fca2bd 1785
cparata 0:485458fca2bd 1786 *value &= LSM6DSL_ACC_GYRO_INT1_SIGN_MOT_MASK; //mask
cparata 0:485458fca2bd 1787
cparata 0:485458fca2bd 1788 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1789 }
cparata 0:485458fca2bd 1790
cparata 0:485458fca2bd 1791 /*******************************************************************************
cparata 0:485458fca2bd 1792 * Function Name : LSM6DSL_ACC_GYRO_W_STEP_DET_on_INT1
cparata 0:485458fca2bd 1793 * Description : Write INT1_PEDO
cparata 0:485458fca2bd 1794 * Input : LSM6DSL_ACC_GYRO_INT1_PEDO_t
cparata 0:485458fca2bd 1795 * Output : None
cparata 0:485458fca2bd 1796 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1797 *******************************************************************************/
cparata 0:485458fca2bd 1798 status_t LSM6DSL_ACC_GYRO_W_STEP_DET_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_PEDO_t newValue)
cparata 0:485458fca2bd 1799 {
cparata 0:485458fca2bd 1800 u8_t value;
cparata 0:485458fca2bd 1801
cparata 0:485458fca2bd 1802 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
cparata 0:485458fca2bd 1803 return MEMS_ERROR;
cparata 0:485458fca2bd 1804
cparata 0:485458fca2bd 1805 value &= ~LSM6DSL_ACC_GYRO_INT1_PEDO_MASK;
cparata 0:485458fca2bd 1806 value |= newValue;
cparata 0:485458fca2bd 1807
cparata 0:485458fca2bd 1808 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
cparata 0:485458fca2bd 1809 return MEMS_ERROR;
cparata 0:485458fca2bd 1810
cparata 0:485458fca2bd 1811 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1812 }
cparata 0:485458fca2bd 1813
cparata 0:485458fca2bd 1814 /*******************************************************************************
cparata 0:485458fca2bd 1815 * Function Name : LSM6DSL_ACC_GYRO_R_STEP_DET_on_INT1
cparata 0:485458fca2bd 1816 * Description : Read INT1_PEDO
cparata 0:485458fca2bd 1817 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_PEDO_t
cparata 0:485458fca2bd 1818 * Output : Status of INT1_PEDO see LSM6DSL_ACC_GYRO_INT1_PEDO_t
cparata 0:485458fca2bd 1819 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1820 *******************************************************************************/
cparata 0:485458fca2bd 1821 status_t LSM6DSL_ACC_GYRO_R_STEP_DET_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_PEDO_t *value)
cparata 0:485458fca2bd 1822 {
cparata 0:485458fca2bd 1823 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
cparata 0:485458fca2bd 1824 return MEMS_ERROR;
cparata 0:485458fca2bd 1825
cparata 0:485458fca2bd 1826 *value &= LSM6DSL_ACC_GYRO_INT1_PEDO_MASK; //mask
cparata 0:485458fca2bd 1827
cparata 0:485458fca2bd 1828 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1829 }
cparata 0:485458fca2bd 1830
cparata 0:485458fca2bd 1831 /*******************************************************************************
cparata 0:485458fca2bd 1832 * Function Name : LSM6DSL_ACC_GYRO_W_DRDY_XL_on_INT2
cparata 0:485458fca2bd 1833 * Description : Write INT2_DRDY_XL
cparata 0:485458fca2bd 1834 * Input : LSM6DSL_ACC_GYRO_INT2_DRDY_XL_t
cparata 0:485458fca2bd 1835 * Output : None
cparata 0:485458fca2bd 1836 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1837 *******************************************************************************/
cparata 0:485458fca2bd 1838 status_t LSM6DSL_ACC_GYRO_W_DRDY_XL_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_DRDY_XL_t newValue)
cparata 0:485458fca2bd 1839 {
cparata 0:485458fca2bd 1840 u8_t value;
cparata 0:485458fca2bd 1841
cparata 0:485458fca2bd 1842 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
cparata 0:485458fca2bd 1843 return MEMS_ERROR;
cparata 0:485458fca2bd 1844
cparata 0:485458fca2bd 1845 value &= ~LSM6DSL_ACC_GYRO_INT2_DRDY_XL_MASK;
cparata 0:485458fca2bd 1846 value |= newValue;
cparata 0:485458fca2bd 1847
cparata 0:485458fca2bd 1848 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
cparata 0:485458fca2bd 1849 return MEMS_ERROR;
cparata 0:485458fca2bd 1850
cparata 0:485458fca2bd 1851 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1852 }
cparata 0:485458fca2bd 1853
cparata 0:485458fca2bd 1854 /*******************************************************************************
cparata 0:485458fca2bd 1855 * Function Name : LSM6DSL_ACC_GYRO_R_DRDY_XL_on_INT2
cparata 0:485458fca2bd 1856 * Description : Read INT2_DRDY_XL
cparata 0:485458fca2bd 1857 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_DRDY_XL_t
cparata 0:485458fca2bd 1858 * Output : Status of INT2_DRDY_XL see LSM6DSL_ACC_GYRO_INT2_DRDY_XL_t
cparata 0:485458fca2bd 1859 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1860 *******************************************************************************/
cparata 0:485458fca2bd 1861 status_t LSM6DSL_ACC_GYRO_R_DRDY_XL_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_DRDY_XL_t *value)
cparata 0:485458fca2bd 1862 {
cparata 0:485458fca2bd 1863 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
cparata 0:485458fca2bd 1864 return MEMS_ERROR;
cparata 0:485458fca2bd 1865
cparata 0:485458fca2bd 1866 *value &= LSM6DSL_ACC_GYRO_INT2_DRDY_XL_MASK; //mask
cparata 0:485458fca2bd 1867
cparata 0:485458fca2bd 1868 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1869 }
cparata 0:485458fca2bd 1870
cparata 0:485458fca2bd 1871 /*******************************************************************************
cparata 0:485458fca2bd 1872 * Function Name : LSM6DSL_ACC_GYRO_W_DRDY_G_on_INT2
cparata 0:485458fca2bd 1873 * Description : Write INT2_DRDY_G
cparata 0:485458fca2bd 1874 * Input : LSM6DSL_ACC_GYRO_INT2_DRDY_G_t
cparata 0:485458fca2bd 1875 * Output : None
cparata 0:485458fca2bd 1876 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1877 *******************************************************************************/
cparata 0:485458fca2bd 1878 status_t LSM6DSL_ACC_GYRO_W_DRDY_G_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_DRDY_G_t newValue)
cparata 0:485458fca2bd 1879 {
cparata 0:485458fca2bd 1880 u8_t value;
cparata 0:485458fca2bd 1881
cparata 0:485458fca2bd 1882 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
cparata 0:485458fca2bd 1883 return MEMS_ERROR;
cparata 0:485458fca2bd 1884
cparata 0:485458fca2bd 1885 value &= ~LSM6DSL_ACC_GYRO_INT2_DRDY_G_MASK;
cparata 0:485458fca2bd 1886 value |= newValue;
cparata 0:485458fca2bd 1887
cparata 0:485458fca2bd 1888 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
cparata 0:485458fca2bd 1889 return MEMS_ERROR;
cparata 0:485458fca2bd 1890
cparata 0:485458fca2bd 1891 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1892 }
cparata 0:485458fca2bd 1893
cparata 0:485458fca2bd 1894 /*******************************************************************************
cparata 0:485458fca2bd 1895 * Function Name : LSM6DSL_ACC_GYRO_R_DRDY_G_on_INT2
cparata 0:485458fca2bd 1896 * Description : Read INT2_DRDY_G
cparata 0:485458fca2bd 1897 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_DRDY_G_t
cparata 0:485458fca2bd 1898 * Output : Status of INT2_DRDY_G see LSM6DSL_ACC_GYRO_INT2_DRDY_G_t
cparata 0:485458fca2bd 1899 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1900 *******************************************************************************/
cparata 0:485458fca2bd 1901 status_t LSM6DSL_ACC_GYRO_R_DRDY_G_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_DRDY_G_t *value)
cparata 0:485458fca2bd 1902 {
cparata 0:485458fca2bd 1903 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
cparata 0:485458fca2bd 1904 return MEMS_ERROR;
cparata 0:485458fca2bd 1905
cparata 0:485458fca2bd 1906 *value &= LSM6DSL_ACC_GYRO_INT2_DRDY_G_MASK; //mask
cparata 0:485458fca2bd 1907
cparata 0:485458fca2bd 1908 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1909 }
cparata 0:485458fca2bd 1910
cparata 0:485458fca2bd 1911 /*******************************************************************************
cparata 0:485458fca2bd 1912 * Function Name : LSM6DSL_ACC_GYRO_W_DRDY_TEMP_on_INT2
cparata 0:485458fca2bd 1913 * Description : Write INT2_DRDY_TEMP
cparata 0:485458fca2bd 1914 * Input : LSM6DSL_ACC_GYRO_INT2_DRDY_TEMP_t
cparata 0:485458fca2bd 1915 * Output : None
cparata 0:485458fca2bd 1916 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1917 *******************************************************************************/
cparata 0:485458fca2bd 1918 status_t LSM6DSL_ACC_GYRO_W_DRDY_TEMP_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_DRDY_TEMP_t newValue)
cparata 0:485458fca2bd 1919 {
cparata 0:485458fca2bd 1920 u8_t value;
cparata 0:485458fca2bd 1921
cparata 0:485458fca2bd 1922 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
cparata 0:485458fca2bd 1923 return MEMS_ERROR;
cparata 0:485458fca2bd 1924
cparata 0:485458fca2bd 1925 value &= ~LSM6DSL_ACC_GYRO_INT2_DRDY_TEMP_MASK;
cparata 0:485458fca2bd 1926 value |= newValue;
cparata 0:485458fca2bd 1927
cparata 0:485458fca2bd 1928 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
cparata 0:485458fca2bd 1929 return MEMS_ERROR;
cparata 0:485458fca2bd 1930
cparata 0:485458fca2bd 1931 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1932 }
cparata 0:485458fca2bd 1933
cparata 0:485458fca2bd 1934 /*******************************************************************************
cparata 0:485458fca2bd 1935 * Function Name : LSM6DSL_ACC_GYRO_R_DRDY_TEMP_on_INT2
cparata 0:485458fca2bd 1936 * Description : Read INT2_DRDY_TEMP
cparata 0:485458fca2bd 1937 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_DRDY_TEMP_t
cparata 0:485458fca2bd 1938 * Output : Status of INT2_DRDY_TEMP see LSM6DSL_ACC_GYRO_INT2_DRDY_TEMP_t
cparata 0:485458fca2bd 1939 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1940 *******************************************************************************/
cparata 0:485458fca2bd 1941 status_t LSM6DSL_ACC_GYRO_R_DRDY_TEMP_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_DRDY_TEMP_t *value)
cparata 0:485458fca2bd 1942 {
cparata 0:485458fca2bd 1943 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
cparata 0:485458fca2bd 1944 return MEMS_ERROR;
cparata 0:485458fca2bd 1945
cparata 0:485458fca2bd 1946 *value &= LSM6DSL_ACC_GYRO_INT2_DRDY_TEMP_MASK; //mask
cparata 0:485458fca2bd 1947
cparata 0:485458fca2bd 1948 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1949 }
cparata 0:485458fca2bd 1950
cparata 0:485458fca2bd 1951 /*******************************************************************************
cparata 0:485458fca2bd 1952 * Function Name : LSM6DSL_ACC_GYRO_W_FIFO_TSHLD_on_INT2
cparata 0:485458fca2bd 1953 * Description : Write INT2_FTH
cparata 0:485458fca2bd 1954 * Input : LSM6DSL_ACC_GYRO_INT2_FTH_t
cparata 0:485458fca2bd 1955 * Output : None
cparata 0:485458fca2bd 1956 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1957 *******************************************************************************/
cparata 0:485458fca2bd 1958 status_t LSM6DSL_ACC_GYRO_W_FIFO_TSHLD_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_FTH_t newValue)
cparata 0:485458fca2bd 1959 {
cparata 0:485458fca2bd 1960 u8_t value;
cparata 0:485458fca2bd 1961
cparata 0:485458fca2bd 1962 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
cparata 0:485458fca2bd 1963 return MEMS_ERROR;
cparata 0:485458fca2bd 1964
cparata 0:485458fca2bd 1965 value &= ~LSM6DSL_ACC_GYRO_INT2_FTH_MASK;
cparata 0:485458fca2bd 1966 value |= newValue;
cparata 0:485458fca2bd 1967
cparata 0:485458fca2bd 1968 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
cparata 0:485458fca2bd 1969 return MEMS_ERROR;
cparata 0:485458fca2bd 1970
cparata 0:485458fca2bd 1971 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1972 }
cparata 0:485458fca2bd 1973
cparata 0:485458fca2bd 1974 /*******************************************************************************
cparata 0:485458fca2bd 1975 * Function Name : LSM6DSL_ACC_GYRO_R_FIFO_TSHLD_on_INT2
cparata 0:485458fca2bd 1976 * Description : Read INT2_FTH
cparata 0:485458fca2bd 1977 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_FTH_t
cparata 0:485458fca2bd 1978 * Output : Status of INT2_FTH see LSM6DSL_ACC_GYRO_INT2_FTH_t
cparata 0:485458fca2bd 1979 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1980 *******************************************************************************/
cparata 0:485458fca2bd 1981 status_t LSM6DSL_ACC_GYRO_R_FIFO_TSHLD_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_FTH_t *value)
cparata 0:485458fca2bd 1982 {
cparata 0:485458fca2bd 1983 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
cparata 0:485458fca2bd 1984 return MEMS_ERROR;
cparata 0:485458fca2bd 1985
cparata 0:485458fca2bd 1986 *value &= LSM6DSL_ACC_GYRO_INT2_FTH_MASK; //mask
cparata 0:485458fca2bd 1987
cparata 0:485458fca2bd 1988 return MEMS_SUCCESS;
cparata 0:485458fca2bd 1989 }
cparata 0:485458fca2bd 1990
cparata 0:485458fca2bd 1991 /*******************************************************************************
cparata 0:485458fca2bd 1992 * Function Name : LSM6DSL_ACC_GYRO_W_OVERRUN_on_INT2
cparata 0:485458fca2bd 1993 * Description : Write INT2_OVR
cparata 0:485458fca2bd 1994 * Input : LSM6DSL_ACC_GYRO_INT2_OVR_t
cparata 0:485458fca2bd 1995 * Output : None
cparata 0:485458fca2bd 1996 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 1997 *******************************************************************************/
cparata 0:485458fca2bd 1998 status_t LSM6DSL_ACC_GYRO_W_OVERRUN_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_OVR_t newValue)
cparata 0:485458fca2bd 1999 {
cparata 0:485458fca2bd 2000 u8_t value;
cparata 0:485458fca2bd 2001
cparata 0:485458fca2bd 2002 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
cparata 0:485458fca2bd 2003 return MEMS_ERROR;
cparata 0:485458fca2bd 2004
cparata 0:485458fca2bd 2005 value &= ~LSM6DSL_ACC_GYRO_INT2_OVR_MASK;
cparata 0:485458fca2bd 2006 value |= newValue;
cparata 0:485458fca2bd 2007
cparata 0:485458fca2bd 2008 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
cparata 0:485458fca2bd 2009 return MEMS_ERROR;
cparata 0:485458fca2bd 2010
cparata 0:485458fca2bd 2011 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2012 }
cparata 0:485458fca2bd 2013
cparata 0:485458fca2bd 2014 /*******************************************************************************
cparata 0:485458fca2bd 2015 * Function Name : LSM6DSL_ACC_GYRO_R_OVERRUN_on_INT2
cparata 0:485458fca2bd 2016 * Description : Read INT2_OVR
cparata 0:485458fca2bd 2017 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_OVR_t
cparata 0:485458fca2bd 2018 * Output : Status of INT2_OVR see LSM6DSL_ACC_GYRO_INT2_OVR_t
cparata 0:485458fca2bd 2019 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2020 *******************************************************************************/
cparata 0:485458fca2bd 2021 status_t LSM6DSL_ACC_GYRO_R_OVERRUN_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_OVR_t *value)
cparata 0:485458fca2bd 2022 {
cparata 0:485458fca2bd 2023 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
cparata 0:485458fca2bd 2024 return MEMS_ERROR;
cparata 0:485458fca2bd 2025
cparata 0:485458fca2bd 2026 *value &= LSM6DSL_ACC_GYRO_INT2_OVR_MASK; //mask
cparata 0:485458fca2bd 2027
cparata 0:485458fca2bd 2028 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2029 }
cparata 0:485458fca2bd 2030
cparata 0:485458fca2bd 2031 /*******************************************************************************
cparata 0:485458fca2bd 2032 * Function Name : LSM6DSL_ACC_GYRO_W_FULL_FLAG_on_INT2
cparata 0:485458fca2bd 2033 * Description : Write INT2_FULL_FLAG
cparata 0:485458fca2bd 2034 * Input : LSM6DSL_ACC_GYRO_INT2_FULL_FLAG_t
cparata 0:485458fca2bd 2035 * Output : None
cparata 0:485458fca2bd 2036 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2037 *******************************************************************************/
cparata 0:485458fca2bd 2038 status_t LSM6DSL_ACC_GYRO_W_FULL_FLAG_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_FULL_FLAG_t newValue)
cparata 0:485458fca2bd 2039 {
cparata 0:485458fca2bd 2040 u8_t value;
cparata 0:485458fca2bd 2041
cparata 0:485458fca2bd 2042 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
cparata 0:485458fca2bd 2043 return MEMS_ERROR;
cparata 0:485458fca2bd 2044
cparata 0:485458fca2bd 2045 value &= ~LSM6DSL_ACC_GYRO_INT2_FULL_FLAG_MASK;
cparata 0:485458fca2bd 2046 value |= newValue;
cparata 0:485458fca2bd 2047
cparata 0:485458fca2bd 2048 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
cparata 0:485458fca2bd 2049 return MEMS_ERROR;
cparata 0:485458fca2bd 2050
cparata 0:485458fca2bd 2051 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2052 }
cparata 0:485458fca2bd 2053
cparata 0:485458fca2bd 2054 /*******************************************************************************
cparata 0:485458fca2bd 2055 * Function Name : LSM6DSL_ACC_GYRO_R_FULL_FLAG_on_INT2
cparata 0:485458fca2bd 2056 * Description : Read INT2_FULL_FLAG
cparata 0:485458fca2bd 2057 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_FULL_FLAG_t
cparata 0:485458fca2bd 2058 * Output : Status of INT2_FULL_FLAG see LSM6DSL_ACC_GYRO_INT2_FULL_FLAG_t
cparata 0:485458fca2bd 2059 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2060 *******************************************************************************/
cparata 0:485458fca2bd 2061 status_t LSM6DSL_ACC_GYRO_R_FULL_FLAG_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_FULL_FLAG_t *value)
cparata 0:485458fca2bd 2062 {
cparata 0:485458fca2bd 2063 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
cparata 0:485458fca2bd 2064 return MEMS_ERROR;
cparata 0:485458fca2bd 2065
cparata 0:485458fca2bd 2066 *value &= LSM6DSL_ACC_GYRO_INT2_FULL_FLAG_MASK; //mask
cparata 0:485458fca2bd 2067
cparata 0:485458fca2bd 2068 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2069 }
cparata 0:485458fca2bd 2070
cparata 0:485458fca2bd 2071 /*******************************************************************************
cparata 0:485458fca2bd 2072 * Function Name : LSM6DSL_ACC_GYRO_W_STEP_COUNT_OV_on_INT2
cparata 0:485458fca2bd 2073 * Description : Write INT2_STEP_COUNT_OV
cparata 0:485458fca2bd 2074 * Input : LSM6DSL_ACC_GYRO_INT2_STEP_COUNT_OV_t
cparata 0:485458fca2bd 2075 * Output : None
cparata 0:485458fca2bd 2076 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2077 *******************************************************************************/
cparata 0:485458fca2bd 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:485458fca2bd 2079 {
cparata 0:485458fca2bd 2080 u8_t value;
cparata 0:485458fca2bd 2081
cparata 0:485458fca2bd 2082 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
cparata 0:485458fca2bd 2083 return MEMS_ERROR;
cparata 0:485458fca2bd 2084
cparata 0:485458fca2bd 2085 value &= ~LSM6DSL_ACC_GYRO_INT2_STEP_COUNT_OV_MASK;
cparata 0:485458fca2bd 2086 value |= newValue;
cparata 0:485458fca2bd 2087
cparata 0:485458fca2bd 2088 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
cparata 0:485458fca2bd 2089 return MEMS_ERROR;
cparata 0:485458fca2bd 2090
cparata 0:485458fca2bd 2091 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2092 }
cparata 0:485458fca2bd 2093
cparata 0:485458fca2bd 2094 /*******************************************************************************
cparata 0:485458fca2bd 2095 * Function Name : LSM6DSL_ACC_GYRO_R_STEP_COUNT_OV_on_INT2
cparata 0:485458fca2bd 2096 * Description : Read INT2_STEP_COUNT_OV
cparata 0:485458fca2bd 2097 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_STEP_COUNT_OV_t
cparata 0:485458fca2bd 2098 * Output : Status of INT2_STEP_COUNT_OV see LSM6DSL_ACC_GYRO_INT2_STEP_COUNT_OV_t
cparata 0:485458fca2bd 2099 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2100 *******************************************************************************/
cparata 0:485458fca2bd 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:485458fca2bd 2102 {
cparata 0:485458fca2bd 2103 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
cparata 0:485458fca2bd 2104 return MEMS_ERROR;
cparata 0:485458fca2bd 2105
cparata 0:485458fca2bd 2106 *value &= LSM6DSL_ACC_GYRO_INT2_STEP_COUNT_OV_MASK; //mask
cparata 0:485458fca2bd 2107
cparata 0:485458fca2bd 2108 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2109 }
cparata 0:485458fca2bd 2110
cparata 0:485458fca2bd 2111 /*******************************************************************************
cparata 0:485458fca2bd 2112 * Function Name : LSM6DSL_ACC_GYRO_W_STEP_DELTA_on_INT2
cparata 0:485458fca2bd 2113 * Description : Write INT2_STEP_DELTA
cparata 0:485458fca2bd 2114 * Input : LSM6DSL_ACC_GYRO_INT2_STEP_DELTA_t
cparata 0:485458fca2bd 2115 * Output : None
cparata 0:485458fca2bd 2116 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2117 *******************************************************************************/
cparata 0:485458fca2bd 2118 status_t LSM6DSL_ACC_GYRO_W_STEP_DELTA_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_STEP_DELTA_t newValue)
cparata 0:485458fca2bd 2119 {
cparata 0:485458fca2bd 2120 u8_t value;
cparata 0:485458fca2bd 2121
cparata 0:485458fca2bd 2122 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
cparata 0:485458fca2bd 2123 return MEMS_ERROR;
cparata 0:485458fca2bd 2124
cparata 0:485458fca2bd 2125 value &= ~LSM6DSL_ACC_GYRO_INT2_STEP_DELTA_MASK;
cparata 0:485458fca2bd 2126 value |= newValue;
cparata 0:485458fca2bd 2127
cparata 0:485458fca2bd 2128 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
cparata 0:485458fca2bd 2129 return MEMS_ERROR;
cparata 0:485458fca2bd 2130
cparata 0:485458fca2bd 2131 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2132 }
cparata 0:485458fca2bd 2133
cparata 0:485458fca2bd 2134 /*******************************************************************************
cparata 0:485458fca2bd 2135 * Function Name : LSM6DSL_ACC_GYRO_R_STEP_DELTA_on_INT2
cparata 0:485458fca2bd 2136 * Description : Read INT2_STEP_DELTA
cparata 0:485458fca2bd 2137 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_STEP_DELTA_t
cparata 0:485458fca2bd 2138 * Output : Status of INT2_STEP_DELTA see LSM6DSL_ACC_GYRO_INT2_STEP_DELTA_t
cparata 0:485458fca2bd 2139 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2140 *******************************************************************************/
cparata 0:485458fca2bd 2141 status_t LSM6DSL_ACC_GYRO_R_STEP_DELTA_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_STEP_DELTA_t *value)
cparata 0:485458fca2bd 2142 {
cparata 0:485458fca2bd 2143 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
cparata 0:485458fca2bd 2144 return MEMS_ERROR;
cparata 0:485458fca2bd 2145
cparata 0:485458fca2bd 2146 *value &= LSM6DSL_ACC_GYRO_INT2_STEP_DELTA_MASK; //mask
cparata 0:485458fca2bd 2147
cparata 0:485458fca2bd 2148 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2149 }
cparata 0:485458fca2bd 2150
cparata 0:485458fca2bd 2151 /*******************************************************************************
cparata 0:485458fca2bd 2152 * Function Name : LSM6DSL_ACC_GYRO_W_SW_RESET
cparata 0:485458fca2bd 2153 * Description : Write SW_RESET
cparata 0:485458fca2bd 2154 * Input : LSM6DSL_ACC_GYRO_SW_RESET_t
cparata 0:485458fca2bd 2155 * Output : None
cparata 0:485458fca2bd 2156 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2157 *******************************************************************************/
cparata 0:485458fca2bd 2158 status_t LSM6DSL_ACC_GYRO_W_SW_RESET(void *handle, LSM6DSL_ACC_GYRO_SW_RESET_t newValue)
cparata 0:485458fca2bd 2159 {
cparata 0:485458fca2bd 2160 u8_t value;
cparata 0:485458fca2bd 2161
cparata 0:485458fca2bd 2162 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
cparata 0:485458fca2bd 2163 return MEMS_ERROR;
cparata 0:485458fca2bd 2164
cparata 0:485458fca2bd 2165 value &= ~LSM6DSL_ACC_GYRO_SW_RESET_MASK;
cparata 0:485458fca2bd 2166 value |= newValue;
cparata 0:485458fca2bd 2167
cparata 0:485458fca2bd 2168 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
cparata 0:485458fca2bd 2169 return MEMS_ERROR;
cparata 0:485458fca2bd 2170
cparata 0:485458fca2bd 2171 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2172 }
cparata 0:485458fca2bd 2173
cparata 0:485458fca2bd 2174 /*******************************************************************************
cparata 0:485458fca2bd 2175 * Function Name : LSM6DSL_ACC_GYRO_R_SW_RESET
cparata 0:485458fca2bd 2176 * Description : Read SW_RESET
cparata 0:485458fca2bd 2177 * Input : Pointer to LSM6DSL_ACC_GYRO_SW_RESET_t
cparata 0:485458fca2bd 2178 * Output : Status of SW_RESET see LSM6DSL_ACC_GYRO_SW_RESET_t
cparata 0:485458fca2bd 2179 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2180 *******************************************************************************/
cparata 0:485458fca2bd 2181 status_t LSM6DSL_ACC_GYRO_R_SW_RESET(void *handle, LSM6DSL_ACC_GYRO_SW_RESET_t *value)
cparata 0:485458fca2bd 2182 {
cparata 0:485458fca2bd 2183 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1))
cparata 0:485458fca2bd 2184 return MEMS_ERROR;
cparata 0:485458fca2bd 2185
cparata 0:485458fca2bd 2186 *value &= LSM6DSL_ACC_GYRO_SW_RESET_MASK; //mask
cparata 0:485458fca2bd 2187
cparata 0:485458fca2bd 2188 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2189 }
cparata 0:485458fca2bd 2190
cparata 0:485458fca2bd 2191 /*******************************************************************************
cparata 0:485458fca2bd 2192 * Function Name : LSM6DSL_ACC_GYRO_W_IF_Addr_Incr
cparata 0:485458fca2bd 2193 * Description : Write IF_INC
cparata 0:485458fca2bd 2194 * Input : LSM6DSL_ACC_GYRO_IF_INC_t
cparata 0:485458fca2bd 2195 * Output : None
cparata 0:485458fca2bd 2196 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2197 *******************************************************************************/
cparata 0:485458fca2bd 2198 status_t LSM6DSL_ACC_GYRO_W_IF_Addr_Incr(void *handle, LSM6DSL_ACC_GYRO_IF_INC_t newValue)
cparata 0:485458fca2bd 2199 {
cparata 0:485458fca2bd 2200 u8_t value;
cparata 0:485458fca2bd 2201
cparata 0:485458fca2bd 2202 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
cparata 0:485458fca2bd 2203 return MEMS_ERROR;
cparata 0:485458fca2bd 2204
cparata 0:485458fca2bd 2205 value &= ~LSM6DSL_ACC_GYRO_IF_INC_MASK;
cparata 0:485458fca2bd 2206 value |= newValue;
cparata 0:485458fca2bd 2207
cparata 0:485458fca2bd 2208 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
cparata 0:485458fca2bd 2209 return MEMS_ERROR;
cparata 0:485458fca2bd 2210
cparata 0:485458fca2bd 2211 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2212 }
cparata 0:485458fca2bd 2213
cparata 0:485458fca2bd 2214 /*******************************************************************************
cparata 0:485458fca2bd 2215 * Function Name : LSM6DSL_ACC_GYRO_R_IF_Addr_Incr
cparata 0:485458fca2bd 2216 * Description : Read IF_INC
cparata 0:485458fca2bd 2217 * Input : Pointer to LSM6DSL_ACC_GYRO_IF_INC_t
cparata 0:485458fca2bd 2218 * Output : Status of IF_INC see LSM6DSL_ACC_GYRO_IF_INC_t
cparata 0:485458fca2bd 2219 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2220 *******************************************************************************/
cparata 0:485458fca2bd 2221 status_t LSM6DSL_ACC_GYRO_R_IF_Addr_Incr(void *handle, LSM6DSL_ACC_GYRO_IF_INC_t *value)
cparata 0:485458fca2bd 2222 {
cparata 0:485458fca2bd 2223 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1) )
cparata 0:485458fca2bd 2224 return MEMS_ERROR;
cparata 0:485458fca2bd 2225
cparata 0:485458fca2bd 2226 *value &= LSM6DSL_ACC_GYRO_IF_INC_MASK; //mask
cparata 0:485458fca2bd 2227
cparata 0:485458fca2bd 2228 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2229 }
cparata 0:485458fca2bd 2230
cparata 0:485458fca2bd 2231 /*******************************************************************************
cparata 0:485458fca2bd 2232 * Function Name : LSM6DSL_ACC_GYRO_W_SPI_Mode
cparata 0:485458fca2bd 2233 * Description : Write SIM
cparata 0:485458fca2bd 2234 * Input : LSM6DSL_ACC_GYRO_SIM_t
cparata 0:485458fca2bd 2235 * Output : None
cparata 0:485458fca2bd 2236 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2237 *******************************************************************************/
cparata 0:485458fca2bd 2238 status_t LSM6DSL_ACC_GYRO_W_SPI_Mode(void *handle, LSM6DSL_ACC_GYRO_SIM_t newValue)
cparata 0:485458fca2bd 2239 {
cparata 0:485458fca2bd 2240 u8_t value;
cparata 0:485458fca2bd 2241
cparata 0:485458fca2bd 2242 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
cparata 0:485458fca2bd 2243 return MEMS_ERROR;
cparata 0:485458fca2bd 2244
cparata 0:485458fca2bd 2245 value &= ~LSM6DSL_ACC_GYRO_SIM_MASK;
cparata 0:485458fca2bd 2246 value |= newValue;
cparata 0:485458fca2bd 2247
cparata 0:485458fca2bd 2248 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
cparata 0:485458fca2bd 2249 return MEMS_ERROR;
cparata 0:485458fca2bd 2250
cparata 0:485458fca2bd 2251 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2252 }
cparata 0:485458fca2bd 2253
cparata 0:485458fca2bd 2254 /*******************************************************************************
cparata 0:485458fca2bd 2255 * Function Name : LSM6DSL_ACC_GYRO_R_SPI_Mode
cparata 0:485458fca2bd 2256 * Description : Read SIM
cparata 0:485458fca2bd 2257 * Input : Pointer to LSM6DSL_ACC_GYRO_SIM_t
cparata 0:485458fca2bd 2258 * Output : Status of SIM see LSM6DSL_ACC_GYRO_SIM_t
cparata 0:485458fca2bd 2259 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2260 *******************************************************************************/
cparata 0:485458fca2bd 2261 status_t LSM6DSL_ACC_GYRO_R_SPI_Mode(void *handle, LSM6DSL_ACC_GYRO_SIM_t *value)
cparata 0:485458fca2bd 2262 {
cparata 0:485458fca2bd 2263 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1))
cparata 0:485458fca2bd 2264 return MEMS_ERROR;
cparata 0:485458fca2bd 2265
cparata 0:485458fca2bd 2266 *value &= LSM6DSL_ACC_GYRO_SIM_MASK; //mask
cparata 0:485458fca2bd 2267
cparata 0:485458fca2bd 2268 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2269 }
cparata 0:485458fca2bd 2270
cparata 0:485458fca2bd 2271 /*******************************************************************************
cparata 0:485458fca2bd 2272 * Function Name : LSM6DSL_ACC_GYRO_W_PadSel
cparata 0:485458fca2bd 2273 * Description : Write PP_OD
cparata 0:485458fca2bd 2274 * Input : LSM6DSL_ACC_GYRO_PP_OD_t
cparata 0:485458fca2bd 2275 * Output : None
cparata 0:485458fca2bd 2276 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2277 *******************************************************************************/
cparata 0:485458fca2bd 2278 status_t LSM6DSL_ACC_GYRO_W_PadSel(void *handle, LSM6DSL_ACC_GYRO_PP_OD_t newValue)
cparata 0:485458fca2bd 2279 {
cparata 0:485458fca2bd 2280 u8_t value;
cparata 0:485458fca2bd 2281
cparata 0:485458fca2bd 2282 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
cparata 0:485458fca2bd 2283 return MEMS_ERROR;
cparata 0:485458fca2bd 2284
cparata 0:485458fca2bd 2285 value &= ~LSM6DSL_ACC_GYRO_PP_OD_MASK;
cparata 0:485458fca2bd 2286 value |= newValue;
cparata 0:485458fca2bd 2287
cparata 0:485458fca2bd 2288 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
cparata 0:485458fca2bd 2289 return MEMS_ERROR;
cparata 0:485458fca2bd 2290
cparata 0:485458fca2bd 2291 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2292 }
cparata 0:485458fca2bd 2293
cparata 0:485458fca2bd 2294 /*******************************************************************************
cparata 0:485458fca2bd 2295 * Function Name : LSM6DSL_ACC_GYRO_R_PadSel
cparata 0:485458fca2bd 2296 * Description : Read PP_OD
cparata 0:485458fca2bd 2297 * Input : Pointer to LSM6DSL_ACC_GYRO_PP_OD_t
cparata 0:485458fca2bd 2298 * Output : Status of PP_OD see LSM6DSL_ACC_GYRO_PP_OD_t
cparata 0:485458fca2bd 2299 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2300 *******************************************************************************/
cparata 0:485458fca2bd 2301 status_t LSM6DSL_ACC_GYRO_R_PadSel(void *handle, LSM6DSL_ACC_GYRO_PP_OD_t *value)
cparata 0:485458fca2bd 2302 {
cparata 0:485458fca2bd 2303 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1) )
cparata 0:485458fca2bd 2304 return MEMS_ERROR;
cparata 0:485458fca2bd 2305
cparata 0:485458fca2bd 2306 *value &= LSM6DSL_ACC_GYRO_PP_OD_MASK; //mask
cparata 0:485458fca2bd 2307
cparata 0:485458fca2bd 2308 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2309 }
cparata 0:485458fca2bd 2310
cparata 0:485458fca2bd 2311 /*******************************************************************************
cparata 0:485458fca2bd 2312 * Function Name : LSM6DSL_ACC_GYRO_W_INT_ACT_LEVEL
cparata 0:485458fca2bd 2313 * Description : Write INT_ACT_LEVEL
cparata 0:485458fca2bd 2314 * Input : LSM6DSL_ACC_GYRO_INT_ACT_LEVEL_t
cparata 0:485458fca2bd 2315 * Output : None
cparata 0:485458fca2bd 2316 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2317 *******************************************************************************/
cparata 0:485458fca2bd 2318 status_t LSM6DSL_ACC_GYRO_W_INT_ACT_LEVEL(void *handle, LSM6DSL_ACC_GYRO_INT_ACT_LEVEL_t newValue)
cparata 0:485458fca2bd 2319 {
cparata 0:485458fca2bd 2320 u8_t value;
cparata 0:485458fca2bd 2321
cparata 0:485458fca2bd 2322 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
cparata 0:485458fca2bd 2323 return MEMS_ERROR;
cparata 0:485458fca2bd 2324
cparata 0:485458fca2bd 2325 value &= ~LSM6DSL_ACC_GYRO_INT_ACT_LEVEL_MASK;
cparata 0:485458fca2bd 2326 value |= newValue;
cparata 0:485458fca2bd 2327
cparata 0:485458fca2bd 2328 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
cparata 0:485458fca2bd 2329 return MEMS_ERROR;
cparata 0:485458fca2bd 2330
cparata 0:485458fca2bd 2331 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2332 }
cparata 0:485458fca2bd 2333
cparata 0:485458fca2bd 2334 /*******************************************************************************
cparata 0:485458fca2bd 2335 * Function Name : LSM6DSL_ACC_GYRO_R_INT_ACT_LEVEL
cparata 0:485458fca2bd 2336 * Description : Read INT_ACT_LEVEL
cparata 0:485458fca2bd 2337 * Input : Pointer to LSM6DSL_ACC_GYRO_INT_ACT_LEVEL_t
cparata 0:485458fca2bd 2338 * Output : Status of INT_ACT_LEVEL see LSM6DSL_ACC_GYRO_INT_ACT_LEVEL_t
cparata 0:485458fca2bd 2339 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2340 *******************************************************************************/
cparata 0:485458fca2bd 2341 status_t LSM6DSL_ACC_GYRO_R_INT_ACT_LEVEL(void *handle, LSM6DSL_ACC_GYRO_INT_ACT_LEVEL_t *value)
cparata 0:485458fca2bd 2342 {
cparata 0:485458fca2bd 2343 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1))
cparata 0:485458fca2bd 2344 return MEMS_ERROR;
cparata 0:485458fca2bd 2345
cparata 0:485458fca2bd 2346 *value &= LSM6DSL_ACC_GYRO_INT_ACT_LEVEL_MASK; //mask
cparata 0:485458fca2bd 2347
cparata 0:485458fca2bd 2348 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2349 }
cparata 0:485458fca2bd 2350
cparata 0:485458fca2bd 2351 /*******************************************************************************
cparata 0:485458fca2bd 2352 * Function Name : LSM6DSL_ACC_GYRO_W_BOOT
cparata 0:485458fca2bd 2353 * Description : Write BOOT
cparata 0:485458fca2bd 2354 * Input : LSM6DSL_ACC_GYRO_BOOT_t
cparata 0:485458fca2bd 2355 * Output : None
cparata 0:485458fca2bd 2356 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2357 *******************************************************************************/
cparata 0:485458fca2bd 2358 status_t LSM6DSL_ACC_GYRO_W_BOOT(void *handle, LSM6DSL_ACC_GYRO_BOOT_t newValue)
cparata 0:485458fca2bd 2359 {
cparata 0:485458fca2bd 2360 u8_t value;
cparata 0:485458fca2bd 2361
cparata 0:485458fca2bd 2362 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
cparata 0:485458fca2bd 2363 return MEMS_ERROR;
cparata 0:485458fca2bd 2364
cparata 0:485458fca2bd 2365 value &= ~LSM6DSL_ACC_GYRO_BOOT_MASK;
cparata 0:485458fca2bd 2366 value |= newValue;
cparata 0:485458fca2bd 2367
cparata 0:485458fca2bd 2368 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
cparata 0:485458fca2bd 2369 return MEMS_ERROR;
cparata 0:485458fca2bd 2370
cparata 0:485458fca2bd 2371 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2372 }
cparata 0:485458fca2bd 2373
cparata 0:485458fca2bd 2374 /*******************************************************************************
cparata 0:485458fca2bd 2375 * Function Name : LSM6DSL_ACC_GYRO_R_BOOT
cparata 0:485458fca2bd 2376 * Description : Read BOOT
cparata 0:485458fca2bd 2377 * Input : Pointer to LSM6DSL_ACC_GYRO_BOOT_t
cparata 0:485458fca2bd 2378 * Output : Status of BOOT see LSM6DSL_ACC_GYRO_BOOT_t
cparata 0:485458fca2bd 2379 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2380 *******************************************************************************/
cparata 0:485458fca2bd 2381 status_t LSM6DSL_ACC_GYRO_R_BOOT(void *handle, LSM6DSL_ACC_GYRO_BOOT_t *value)
cparata 0:485458fca2bd 2382 {
cparata 0:485458fca2bd 2383 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1) )
cparata 0:485458fca2bd 2384 return MEMS_ERROR;
cparata 0:485458fca2bd 2385
cparata 0:485458fca2bd 2386 *value &= LSM6DSL_ACC_GYRO_BOOT_MASK; //mask
cparata 0:485458fca2bd 2387
cparata 0:485458fca2bd 2388 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2389 }
cparata 0:485458fca2bd 2390
cparata 0:485458fca2bd 2391 /*******************************************************************************
cparata 0:485458fca2bd 2392 * Function Name : LSM6DSL_ACC_GYRO_LPF1_SEL_G
cparata 0:485458fca2bd 2393 * Description : Write LPF1_SEL_G
cparata 0:485458fca2bd 2394 * Input : LSM6DSL_ACC_GYRO_LPF1_SEL_G_t
cparata 0:485458fca2bd 2395 * Output : None
cparata 0:485458fca2bd 2396 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2397 *******************************************************************************/
cparata 0:485458fca2bd 2398 status_t LSM6DSL_ACC_GYRO_W_LPF1_SEL_G(void *handle, LSM6DSL_ACC_GYRO_LPF1_SEL_G_t newValue)
cparata 0:485458fca2bd 2399 {
cparata 0:485458fca2bd 2400 u8_t value;
cparata 0:485458fca2bd 2401
cparata 0:485458fca2bd 2402 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1))
cparata 0:485458fca2bd 2403 return MEMS_ERROR;
cparata 0:485458fca2bd 2404
cparata 0:485458fca2bd 2405 value &= ~LSM6DSL_ACC_GYRO_LPF1_SEL_G_MASK;
cparata 0:485458fca2bd 2406 value |= newValue;
cparata 0:485458fca2bd 2407
cparata 0:485458fca2bd 2408 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1) )
cparata 0:485458fca2bd 2409 return MEMS_ERROR;
cparata 0:485458fca2bd 2410
cparata 0:485458fca2bd 2411 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2412 }
cparata 0:485458fca2bd 2413
cparata 0:485458fca2bd 2414 /*******************************************************************************
cparata 0:485458fca2bd 2415 * Function Name : LSM6DSL_ACC_GYRO_LPF1_SEL_G
cparata 0:485458fca2bd 2416 * Description : Read LPF1_SEL_G
cparata 0:485458fca2bd 2417 * Input : Pointer to LSM6DSL_ACC_GYRO_LPF1_SEL_G_t
cparata 0:485458fca2bd 2418 * Output : Status of LPF1_SEL_G see LSM6DSL_ACC_GYRO_LPF1_SEL_G_t
cparata 0:485458fca2bd 2419 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2420 *******************************************************************************/
cparata 0:485458fca2bd 2421 status_t LSM6DSL_ACC_GYRO_R_LPF1_SEL_G(void *handle, LSM6DSL_ACC_GYRO_LPF1_SEL_G_t *value)
cparata 0:485458fca2bd 2422 {
cparata 0:485458fca2bd 2423 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, (u8_t *)value, 1) )
cparata 0:485458fca2bd 2424 return MEMS_ERROR;
cparata 0:485458fca2bd 2425
cparata 0:485458fca2bd 2426 *value &= LSM6DSL_ACC_GYRO_LPF1_SEL_G_MASK; //mask
cparata 0:485458fca2bd 2427
cparata 0:485458fca2bd 2428 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2429 }
cparata 0:485458fca2bd 2430
cparata 0:485458fca2bd 2431 /*******************************************************************************
cparata 0:485458fca2bd 2432 * Function Name : LSM6DSL_ACC_GYRO_W_I2C_DISABLE
cparata 0:485458fca2bd 2433 * Description : Write I2C_DISABLE
cparata 0:485458fca2bd 2434 * Input : LSM6DSL_ACC_GYRO_I2C_DISABLE_t
cparata 0:485458fca2bd 2435 * Output : None
cparata 0:485458fca2bd 2436 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2437 *******************************************************************************/
cparata 0:485458fca2bd 2438 status_t LSM6DSL_ACC_GYRO_W_I2C_DISABLE(void *handle, LSM6DSL_ACC_GYRO_I2C_DISABLE_t newValue)
cparata 0:485458fca2bd 2439 {
cparata 0:485458fca2bd 2440 u8_t value;
cparata 0:485458fca2bd 2441
cparata 0:485458fca2bd 2442 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1))
cparata 0:485458fca2bd 2443 return MEMS_ERROR;
cparata 0:485458fca2bd 2444
cparata 0:485458fca2bd 2445 value &= ~LSM6DSL_ACC_GYRO_I2C_DISABLE_MASK;
cparata 0:485458fca2bd 2446 value |= newValue;
cparata 0:485458fca2bd 2447
cparata 0:485458fca2bd 2448 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1) )
cparata 0:485458fca2bd 2449 return MEMS_ERROR;
cparata 0:485458fca2bd 2450
cparata 0:485458fca2bd 2451 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2452 }
cparata 0:485458fca2bd 2453
cparata 0:485458fca2bd 2454 /*******************************************************************************
cparata 0:485458fca2bd 2455 * Function Name : LSM6DSL_ACC_GYRO_R_I2C_DISABLE
cparata 0:485458fca2bd 2456 * Description : Read I2C_DISABLE
cparata 0:485458fca2bd 2457 * Input : Pointer to LSM6DSL_ACC_GYRO_I2C_DISABLE_t
cparata 0:485458fca2bd 2458 * Output : Status of I2C_DISABLE see LSM6DSL_ACC_GYRO_I2C_DISABLE_t
cparata 0:485458fca2bd 2459 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2460 *******************************************************************************/
cparata 0:485458fca2bd 2461 status_t LSM6DSL_ACC_GYRO_R_I2C_DISABLE(void *handle, LSM6DSL_ACC_GYRO_I2C_DISABLE_t *value)
cparata 0:485458fca2bd 2462 {
cparata 0:485458fca2bd 2463 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, (u8_t *)value, 1) )
cparata 0:485458fca2bd 2464 return MEMS_ERROR;
cparata 0:485458fca2bd 2465
cparata 0:485458fca2bd 2466 *value &= LSM6DSL_ACC_GYRO_I2C_DISABLE_MASK; //mask
cparata 0:485458fca2bd 2467
cparata 0:485458fca2bd 2468 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2469 }
cparata 0:485458fca2bd 2470
cparata 0:485458fca2bd 2471 /*******************************************************************************
cparata 0:485458fca2bd 2472 * Function Name : LSM6DSL_ACC_GYRO_W_DRDY_MSK
cparata 0:485458fca2bd 2473 * Description : Write DRDY_MSK
cparata 0:485458fca2bd 2474 * Input : LSM6DSL_ACC_GYRO_DRDY_MSK_t
cparata 0:485458fca2bd 2475 * Output : None
cparata 0:485458fca2bd 2476 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2477 *******************************************************************************/
cparata 0:485458fca2bd 2478 status_t LSM6DSL_ACC_GYRO_W_DRDY_MSK(void *handle, LSM6DSL_ACC_GYRO_DRDY_MSK_t newValue)
cparata 0:485458fca2bd 2479 {
cparata 0:485458fca2bd 2480 u8_t value;
cparata 0:485458fca2bd 2481
cparata 0:485458fca2bd 2482 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1))
cparata 0:485458fca2bd 2483 return MEMS_ERROR;
cparata 0:485458fca2bd 2484
cparata 0:485458fca2bd 2485 value &= ~LSM6DSL_ACC_GYRO_DRDY_MSK_MASK;
cparata 0:485458fca2bd 2486 value |= newValue;
cparata 0:485458fca2bd 2487
cparata 0:485458fca2bd 2488 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1) )
cparata 0:485458fca2bd 2489 return MEMS_ERROR;
cparata 0:485458fca2bd 2490
cparata 0:485458fca2bd 2491 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2492 }
cparata 0:485458fca2bd 2493
cparata 0:485458fca2bd 2494 /*******************************************************************************
cparata 0:485458fca2bd 2495 * Function Name : LSM6DSL_ACC_GYRO_R_DRDY_MSK
cparata 0:485458fca2bd 2496 * Description : Read DRDY_MSK
cparata 0:485458fca2bd 2497 * Input : Pointer to LSM6DSL_ACC_GYRO_DRDY_MSK_t
cparata 0:485458fca2bd 2498 * Output : Status of DRDY_MSK see LSM6DSL_ACC_GYRO_DRDY_MSK_t
cparata 0:485458fca2bd 2499 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2500 *******************************************************************************/
cparata 0:485458fca2bd 2501 status_t LSM6DSL_ACC_GYRO_R_DRDY_MSK(void *handle, LSM6DSL_ACC_GYRO_DRDY_MSK_t *value)
cparata 0:485458fca2bd 2502 {
cparata 0:485458fca2bd 2503 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, (u8_t *)value, 1))
cparata 0:485458fca2bd 2504 return MEMS_ERROR;
cparata 0:485458fca2bd 2505
cparata 0:485458fca2bd 2506 *value &= LSM6DSL_ACC_GYRO_DRDY_MSK_MASK; //mask
cparata 0:485458fca2bd 2507
cparata 0:485458fca2bd 2508 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2509 }
cparata 0:485458fca2bd 2510
cparata 0:485458fca2bd 2511 /*******************************************************************************
cparata 0:485458fca2bd 2512 * Function Name : LSM6DSL_ACC_GYRO_W_INT2_ON_INT1
cparata 0:485458fca2bd 2513 * Description : Write INT2_ON_INT1
cparata 0:485458fca2bd 2514 * Input : LSM6DSL_ACC_GYRO_INT2_ON_INT1_t
cparata 0:485458fca2bd 2515 * Output : None
cparata 0:485458fca2bd 2516 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2517 *******************************************************************************/
cparata 0:485458fca2bd 2518 status_t LSM6DSL_ACC_GYRO_W_INT2_ON_INT1(void *handle, LSM6DSL_ACC_GYRO_INT2_ON_INT1_t newValue)
cparata 0:485458fca2bd 2519 {
cparata 0:485458fca2bd 2520 u8_t value;
cparata 0:485458fca2bd 2521
cparata 0:485458fca2bd 2522 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1))
cparata 0:485458fca2bd 2523 return MEMS_ERROR;
cparata 0:485458fca2bd 2524
cparata 0:485458fca2bd 2525 value &= ~LSM6DSL_ACC_GYRO_INT2_ON_INT1_MASK;
cparata 0:485458fca2bd 2526 value |= newValue;
cparata 0:485458fca2bd 2527
cparata 0:485458fca2bd 2528 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1) )
cparata 0:485458fca2bd 2529 return MEMS_ERROR;
cparata 0:485458fca2bd 2530
cparata 0:485458fca2bd 2531 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2532 }
cparata 0:485458fca2bd 2533
cparata 0:485458fca2bd 2534 /*******************************************************************************
cparata 0:485458fca2bd 2535 * Function Name : LSM6DSL_ACC_GYRO_R_INT2_ON_INT1
cparata 0:485458fca2bd 2536 * Description : Read INT2_ON_INT1
cparata 0:485458fca2bd 2537 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_ON_INT1_t
cparata 0:485458fca2bd 2538 * Output : Status of INT2_ON_INT1 see LSM6DSL_ACC_GYRO_INT2_ON_INT1_t
cparata 0:485458fca2bd 2539 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2540 *******************************************************************************/
cparata 0:485458fca2bd 2541 status_t LSM6DSL_ACC_GYRO_R_INT2_ON_INT1(void *handle, LSM6DSL_ACC_GYRO_INT2_ON_INT1_t *value)
cparata 0:485458fca2bd 2542 {
cparata 0:485458fca2bd 2543 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, (u8_t *)value, 1))
cparata 0:485458fca2bd 2544 return MEMS_ERROR;
cparata 0:485458fca2bd 2545
cparata 0:485458fca2bd 2546 *value &= LSM6DSL_ACC_GYRO_INT2_ON_INT1_MASK; //mask
cparata 0:485458fca2bd 2547
cparata 0:485458fca2bd 2548 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2549 }
cparata 0:485458fca2bd 2550
cparata 0:485458fca2bd 2551 /*******************************************************************************
cparata 0:485458fca2bd 2552 * Function Name : LSM6DSL_ACC_GYRO_W_SleepMode_G
cparata 0:485458fca2bd 2553 * Description : Write SLEEP_G
cparata 0:485458fca2bd 2554 * Input : LSM6DSL_ACC_GYRO_SLEEP_G_t
cparata 0:485458fca2bd 2555 * Output : None
cparata 0:485458fca2bd 2556 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2557 *******************************************************************************/
cparata 0:485458fca2bd 2558 status_t LSM6DSL_ACC_GYRO_W_SleepMode_G(void *handle, LSM6DSL_ACC_GYRO_SLEEP_G_t newValue)
cparata 0:485458fca2bd 2559 {
cparata 0:485458fca2bd 2560 u8_t value;
cparata 0:485458fca2bd 2561
cparata 0:485458fca2bd 2562 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1))
cparata 0:485458fca2bd 2563 return MEMS_ERROR;
cparata 0:485458fca2bd 2564
cparata 0:485458fca2bd 2565 value &= ~LSM6DSL_ACC_GYRO_SLEEP_G_MASK;
cparata 0:485458fca2bd 2566 value |= newValue;
cparata 0:485458fca2bd 2567
cparata 0:485458fca2bd 2568 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1) )
cparata 0:485458fca2bd 2569 return MEMS_ERROR;
cparata 0:485458fca2bd 2570
cparata 0:485458fca2bd 2571 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2572 }
cparata 0:485458fca2bd 2573
cparata 0:485458fca2bd 2574 /*******************************************************************************
cparata 0:485458fca2bd 2575 * Function Name : LSM6DSL_ACC_GYRO_R_SleepMode_G
cparata 0:485458fca2bd 2576 * Description : Read SLEEP_G
cparata 0:485458fca2bd 2577 * Input : Pointer to LSM6DSL_ACC_GYRO_SLEEP_G_t
cparata 0:485458fca2bd 2578 * Output : Status of SLEEP_G see LSM6DSL_ACC_GYRO_SLEEP_G_t
cparata 0:485458fca2bd 2579 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2580 *******************************************************************************/
cparata 0:485458fca2bd 2581 status_t LSM6DSL_ACC_GYRO_R_SleepMode_G(void *handle, LSM6DSL_ACC_GYRO_SLEEP_G_t *value)
cparata 0:485458fca2bd 2582 {
cparata 0:485458fca2bd 2583 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, (u8_t *)value, 1))
cparata 0:485458fca2bd 2584 return MEMS_ERROR;
cparata 0:485458fca2bd 2585
cparata 0:485458fca2bd 2586 *value &= LSM6DSL_ACC_GYRO_SLEEP_G_MASK; //mask
cparata 0:485458fca2bd 2587
cparata 0:485458fca2bd 2588 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2589 }
cparata 0:485458fca2bd 2590
cparata 0:485458fca2bd 2591 /*******************************************************************************
cparata 0:485458fca2bd 2592 * Function Name : LSM6DSL_ACC_GYRO_W_SelfTest_XL
cparata 0:485458fca2bd 2593 * Description : Write ST_XL
cparata 0:485458fca2bd 2594 * Input : LSM6DSL_ACC_GYRO_ST_XL_t
cparata 0:485458fca2bd 2595 * Output : None
cparata 0:485458fca2bd 2596 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2597 *******************************************************************************/
cparata 0:485458fca2bd 2598 status_t LSM6DSL_ACC_GYRO_W_SelfTest_XL(void *handle, LSM6DSL_ACC_GYRO_ST_XL_t newValue)
cparata 0:485458fca2bd 2599 {
cparata 0:485458fca2bd 2600 u8_t value;
cparata 0:485458fca2bd 2601
cparata 0:485458fca2bd 2602 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1))
cparata 0:485458fca2bd 2603 return MEMS_ERROR;
cparata 0:485458fca2bd 2604
cparata 0:485458fca2bd 2605 value &= ~LSM6DSL_ACC_GYRO_ST_XL_MASK;
cparata 0:485458fca2bd 2606 value |= newValue;
cparata 0:485458fca2bd 2607
cparata 0:485458fca2bd 2608 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1) )
cparata 0:485458fca2bd 2609 return MEMS_ERROR;
cparata 0:485458fca2bd 2610
cparata 0:485458fca2bd 2611 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2612 }
cparata 0:485458fca2bd 2613
cparata 0:485458fca2bd 2614 /*******************************************************************************
cparata 0:485458fca2bd 2615 * Function Name : LSM6DSL_ACC_GYRO_R_SelfTest_XL
cparata 0:485458fca2bd 2616 * Description : Read ST_XL
cparata 0:485458fca2bd 2617 * Input : Pointer to LSM6DSL_ACC_GYRO_ST_XL_t
cparata 0:485458fca2bd 2618 * Output : Status of ST_XL see LSM6DSL_ACC_GYRO_ST_XL_t
cparata 0:485458fca2bd 2619 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2620 *******************************************************************************/
cparata 0:485458fca2bd 2621 status_t LSM6DSL_ACC_GYRO_R_SelfTest_XL(void *handle, LSM6DSL_ACC_GYRO_ST_XL_t *value)
cparata 0:485458fca2bd 2622 {
cparata 0:485458fca2bd 2623 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, (u8_t *)value, 1))
cparata 0:485458fca2bd 2624 return MEMS_ERROR;
cparata 0:485458fca2bd 2625
cparata 0:485458fca2bd 2626 *value &= LSM6DSL_ACC_GYRO_ST_XL_MASK; //mask
cparata 0:485458fca2bd 2627
cparata 0:485458fca2bd 2628 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2629 }
cparata 0:485458fca2bd 2630
cparata 0:485458fca2bd 2631 /*******************************************************************************
cparata 0:485458fca2bd 2632 * Function Name : LSM6DSL_ACC_GYRO_W_SelfTest_G
cparata 0:485458fca2bd 2633 * Description : Write ST_G
cparata 0:485458fca2bd 2634 * Input : LSM6DSL_ACC_GYRO_ST_G_t
cparata 0:485458fca2bd 2635 * Output : None
cparata 0:485458fca2bd 2636 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2637 *******************************************************************************/
cparata 0:485458fca2bd 2638 status_t LSM6DSL_ACC_GYRO_W_SelfTest_G(void *handle, LSM6DSL_ACC_GYRO_ST_G_t newValue)
cparata 0:485458fca2bd 2639 {
cparata 0:485458fca2bd 2640 u8_t value;
cparata 0:485458fca2bd 2641
cparata 0:485458fca2bd 2642 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1))
cparata 0:485458fca2bd 2643 return MEMS_ERROR;
cparata 0:485458fca2bd 2644
cparata 0:485458fca2bd 2645 value &= ~LSM6DSL_ACC_GYRO_ST_G_MASK;
cparata 0:485458fca2bd 2646 value |= newValue;
cparata 0:485458fca2bd 2647
cparata 0:485458fca2bd 2648 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1) )
cparata 0:485458fca2bd 2649 return MEMS_ERROR;
cparata 0:485458fca2bd 2650
cparata 0:485458fca2bd 2651 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2652 }
cparata 0:485458fca2bd 2653
cparata 0:485458fca2bd 2654 /*******************************************************************************
cparata 0:485458fca2bd 2655 * Function Name : LSM6DSL_ACC_GYRO_R_SelfTest_G
cparata 0:485458fca2bd 2656 * Description : Read ST_G
cparata 0:485458fca2bd 2657 * Input : Pointer to LSM6DSL_ACC_GYRO_ST_G_t
cparata 0:485458fca2bd 2658 * Output : Status of ST_G see LSM6DSL_ACC_GYRO_ST_G_t
cparata 0:485458fca2bd 2659 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2660 *******************************************************************************/
cparata 0:485458fca2bd 2661 status_t LSM6DSL_ACC_GYRO_R_SelfTest_G(void *handle, LSM6DSL_ACC_GYRO_ST_G_t *value)
cparata 0:485458fca2bd 2662 {
cparata 0:485458fca2bd 2663 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, (u8_t *)value, 1))
cparata 0:485458fca2bd 2664 return MEMS_ERROR;
cparata 0:485458fca2bd 2665
cparata 0:485458fca2bd 2666 *value &= LSM6DSL_ACC_GYRO_ST_G_MASK; //mask
cparata 0:485458fca2bd 2667
cparata 0:485458fca2bd 2668 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2669 }
cparata 0:485458fca2bd 2670
cparata 0:485458fca2bd 2671 /*******************************************************************************
cparata 0:485458fca2bd 2672 * Function Name : LSM6DSL_ACC_GYRO_W_DEN_Polarity
cparata 0:485458fca2bd 2673 * Description : Write DEN_LH
cparata 0:485458fca2bd 2674 * Input : LSM6DSL_ACC_GYRO_DEN_LH_t
cparata 0:485458fca2bd 2675 * Output : None
cparata 0:485458fca2bd 2676 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2677 *******************************************************************************/
cparata 0:485458fca2bd 2678 status_t LSM6DSL_ACC_GYRO_W_DEN_Polarity(void *handle, LSM6DSL_ACC_GYRO_DEN_LH_t newValue)
cparata 0:485458fca2bd 2679 {
cparata 0:485458fca2bd 2680 u8_t value;
cparata 0:485458fca2bd 2681
cparata 0:485458fca2bd 2682 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1))
cparata 0:485458fca2bd 2683 return MEMS_ERROR;
cparata 0:485458fca2bd 2684
cparata 0:485458fca2bd 2685 value &= ~LSM6DSL_ACC_GYRO_DEN_LH_MASK;
cparata 0:485458fca2bd 2686 value |= newValue;
cparata 0:485458fca2bd 2687
cparata 0:485458fca2bd 2688 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1) )
cparata 0:485458fca2bd 2689 return MEMS_ERROR;
cparata 0:485458fca2bd 2690
cparata 0:485458fca2bd 2691 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2692 }
cparata 0:485458fca2bd 2693
cparata 0:485458fca2bd 2694 /*******************************************************************************
cparata 0:485458fca2bd 2695 * Function Name : LSM6DSL_ACC_GYRO_R_DEN_Polarity
cparata 0:485458fca2bd 2696 * Description : Read DEN_LH
cparata 0:485458fca2bd 2697 * Input : Pointer to LSM6DSL_ACC_GYRO_DEN_LH_t
cparata 0:485458fca2bd 2698 * Output : Status of DEN_LH see LSM6DSL_ACC_GYRO_DEN_LH_t
cparata 0:485458fca2bd 2699 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2700 *******************************************************************************/
cparata 0:485458fca2bd 2701 status_t LSM6DSL_ACC_GYRO_R_DEN_Polarity(void *handle, LSM6DSL_ACC_GYRO_DEN_LH_t *value)
cparata 0:485458fca2bd 2702 {
cparata 0:485458fca2bd 2703 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, (u8_t *)value, 1))
cparata 0:485458fca2bd 2704 return MEMS_ERROR;
cparata 0:485458fca2bd 2705
cparata 0:485458fca2bd 2706 *value &= LSM6DSL_ACC_GYRO_DEN_LH_MASK; //mask
cparata 0:485458fca2bd 2707
cparata 0:485458fca2bd 2708 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2709 }
cparata 0:485458fca2bd 2710
cparata 0:485458fca2bd 2711 /*******************************************************************************
cparata 0:485458fca2bd 2712 * Function Name : LSM6DSL_ACC_GYRO_W_CircularBurstMode
cparata 0:485458fca2bd 2713 * Description : Write ST_ROUNDING
cparata 0:485458fca2bd 2714 * Input : LSM6DSL_ACC_GYRO_ROUNDING_t
cparata 0:485458fca2bd 2715 * Output : None
cparata 0:485458fca2bd 2716 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2717 *******************************************************************************/
cparata 0:485458fca2bd 2718 status_t LSM6DSL_ACC_GYRO_W_CircularBurstMode(void *handle, LSM6DSL_ACC_GYRO_ROUNDING_t newValue)
cparata 0:485458fca2bd 2719 {
cparata 0:485458fca2bd 2720 u8_t value;
cparata 0:485458fca2bd 2721
cparata 0:485458fca2bd 2722 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1))
cparata 0:485458fca2bd 2723 return MEMS_ERROR;
cparata 0:485458fca2bd 2724
cparata 0:485458fca2bd 2725 value &= ~LSM6DSL_ACC_GYRO_LSM6DSL_ACC_GYRO_ROUNDING_t_MASK;
cparata 0:485458fca2bd 2726 value |= newValue;
cparata 0:485458fca2bd 2727
cparata 0:485458fca2bd 2728 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1) )
cparata 0:485458fca2bd 2729 return MEMS_ERROR;
cparata 0:485458fca2bd 2730
cparata 0:485458fca2bd 2731 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2732 }
cparata 0:485458fca2bd 2733
cparata 0:485458fca2bd 2734 /*******************************************************************************
cparata 0:485458fca2bd 2735 * Function Name : LSM6DSL_ACC_GYRO_R_CircularBurstMode
cparata 0:485458fca2bd 2736 * Description : Read ST_ROUNDING
cparata 0:485458fca2bd 2737 * Input : Pointer to LSM6DSL_ACC_GYRO_ROUNDING_t
cparata 0:485458fca2bd 2738 * Output : Status of ST_ROUNDING see LSM6DSL_ACC_GYRO_ROUNDING_t
cparata 0:485458fca2bd 2739 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2740 *******************************************************************************/
cparata 0:485458fca2bd 2741 status_t LSM6DSL_ACC_GYRO_R_CircularBurstMode(void *handle, LSM6DSL_ACC_GYRO_ROUNDING_t *value)
cparata 0:485458fca2bd 2742 {
cparata 0:485458fca2bd 2743 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, (u8_t *)value, 1))
cparata 0:485458fca2bd 2744 return MEMS_ERROR;
cparata 0:485458fca2bd 2745
cparata 0:485458fca2bd 2746 *value &= LSM6DSL_ACC_GYRO_LSM6DSL_ACC_GYRO_ROUNDING_t_MASK; //mask
cparata 0:485458fca2bd 2747
cparata 0:485458fca2bd 2748 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2749 }
cparata 0:485458fca2bd 2750
cparata 0:485458fca2bd 2751 /*******************************************************************************
cparata 0:485458fca2bd 2752 * Function Name : LSM6DSL_ACC_GYRO_W_LP_BW_G
cparata 0:485458fca2bd 2753 * Description : Write FTYPE
cparata 0:485458fca2bd 2754 * Input : LSM6DSL_ACC_GYRO_FTYPE_t
cparata 0:485458fca2bd 2755 * Output : None
cparata 0:485458fca2bd 2756 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2757 *******************************************************************************/
cparata 0:485458fca2bd 2758 status_t LSM6DSL_ACC_GYRO_W_LP_BW_G(void *handle, LSM6DSL_ACC_GYRO_FTYPE_t newValue)
cparata 0:485458fca2bd 2759 {
cparata 0:485458fca2bd 2760 u8_t value;
cparata 0:485458fca2bd 2761
cparata 0:485458fca2bd 2762 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1))
cparata 0:485458fca2bd 2763 return MEMS_ERROR;
cparata 0:485458fca2bd 2764
cparata 0:485458fca2bd 2765 value &= ~LSM6DSL_ACC_GYRO_FTYPE_MASK;
cparata 0:485458fca2bd 2766 value |= newValue;
cparata 0:485458fca2bd 2767
cparata 0:485458fca2bd 2768 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1) )
cparata 0:485458fca2bd 2769 return MEMS_ERROR;
cparata 0:485458fca2bd 2770
cparata 0:485458fca2bd 2771 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2772 }
cparata 0:485458fca2bd 2773
cparata 0:485458fca2bd 2774 /*******************************************************************************
cparata 0:485458fca2bd 2775 * Function Name : LSM6DSL_ACC_GYRO_R_LP_BW_G
cparata 0:485458fca2bd 2776 * Description : Read FTYPE
cparata 0:485458fca2bd 2777 * Input : Pointer to LSM6DSL_ACC_GYRO_FTYPE_t
cparata 0:485458fca2bd 2778 * Output : Status of FTYPE see LSM6DSL_ACC_GYRO_FTYPE_t
cparata 0:485458fca2bd 2779 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2780 *******************************************************************************/
cparata 0:485458fca2bd 2781 status_t LSM6DSL_ACC_GYRO_R_LP_BW_G(void *handle, LSM6DSL_ACC_GYRO_FTYPE_t *value)
cparata 0:485458fca2bd 2782 {
cparata 0:485458fca2bd 2783 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, (u8_t *)value, 1))
cparata 0:485458fca2bd 2784 return MEMS_ERROR;
cparata 0:485458fca2bd 2785
cparata 0:485458fca2bd 2786 *value &= LSM6DSL_ACC_GYRO_FTYPE_MASK; //mask
cparata 0:485458fca2bd 2787
cparata 0:485458fca2bd 2788 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2789 }
cparata 0:485458fca2bd 2790
cparata 0:485458fca2bd 2791 /*******************************************************************************
cparata 0:485458fca2bd 2792 * Function Name : LSM6DSL_ACC_GYRO_W_UserOffsetWeight
cparata 0:485458fca2bd 2793 * Description : Write USR_OFF_W
cparata 0:485458fca2bd 2794 * Input : LSM6DSL_ACC_GYRO_USR_OFF_W_t
cparata 0:485458fca2bd 2795 * Output : None
cparata 0:485458fca2bd 2796 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2797 *******************************************************************************/
cparata 0:485458fca2bd 2798 status_t LSM6DSL_ACC_GYRO_W_UserOffsetWeight(void *handle, LSM6DSL_ACC_GYRO_USR_OFF_W_t newValue)
cparata 0:485458fca2bd 2799 {
cparata 0:485458fca2bd 2800 u8_t value;
cparata 0:485458fca2bd 2801
cparata 0:485458fca2bd 2802 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1))
cparata 0:485458fca2bd 2803 return MEMS_ERROR;
cparata 0:485458fca2bd 2804
cparata 0:485458fca2bd 2805 value &= ~LSM6DSL_ACC_GYRO_USR_OFF_W_MASK;
cparata 0:485458fca2bd 2806 value |= newValue;
cparata 0:485458fca2bd 2807
cparata 0:485458fca2bd 2808 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1) )
cparata 0:485458fca2bd 2809 return MEMS_ERROR;
cparata 0:485458fca2bd 2810
cparata 0:485458fca2bd 2811 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2812 }
cparata 0:485458fca2bd 2813
cparata 0:485458fca2bd 2814 /*******************************************************************************
cparata 0:485458fca2bd 2815 * Function Name : LSM6DSL_ACC_GYRO_R_UserOffsetWeight
cparata 0:485458fca2bd 2816 * Description : Read USR_OFF_W
cparata 0:485458fca2bd 2817 * Input : Pointer to LSM6DSL_ACC_GYRO_USR_OFF_W_t
cparata 0:485458fca2bd 2818 * Output : Status of USR_OFF_W see LSM6DSL_ACC_GYRO_USR_OFF_W_t
cparata 0:485458fca2bd 2819 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2820 *******************************************************************************/
cparata 0:485458fca2bd 2821 status_t LSM6DSL_ACC_GYRO_R_UserOffsetWeight(void *handle, LSM6DSL_ACC_GYRO_USR_OFF_W_t *value)
cparata 0:485458fca2bd 2822 {
cparata 0:485458fca2bd 2823 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, (u8_t *)value, 1))
cparata 0:485458fca2bd 2824 return MEMS_ERROR;
cparata 0:485458fca2bd 2825
cparata 0:485458fca2bd 2826 *value &= LSM6DSL_ACC_GYRO_USR_OFF_W_MASK; //mask
cparata 0:485458fca2bd 2827
cparata 0:485458fca2bd 2828 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2829 }
cparata 0:485458fca2bd 2830
cparata 0:485458fca2bd 2831 /*******************************************************************************
cparata 0:485458fca2bd 2832 * Function Name : LSM6DSL_ACC_GYRO_W_LowPower_XL
cparata 0:485458fca2bd 2833 * Description : Write LP_XL
cparata 0:485458fca2bd 2834 * Input : LSM6DSL_ACC_GYRO_LP_XL_t
cparata 0:485458fca2bd 2835 * Output : None
cparata 0:485458fca2bd 2836 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2837 *******************************************************************************/
cparata 0:485458fca2bd 2838 status_t LSM6DSL_ACC_GYRO_W_LowPower_XL(void *handle, LSM6DSL_ACC_GYRO_LP_XL_t newValue)
cparata 0:485458fca2bd 2839 {
cparata 0:485458fca2bd 2840 u8_t value;
cparata 0:485458fca2bd 2841
cparata 0:485458fca2bd 2842 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1))
cparata 0:485458fca2bd 2843 return MEMS_ERROR;
cparata 0:485458fca2bd 2844
cparata 0:485458fca2bd 2845 value &= ~LSM6DSL_ACC_GYRO_LP_XL_MASK;
cparata 0:485458fca2bd 2846 value |= newValue;
cparata 0:485458fca2bd 2847
cparata 0:485458fca2bd 2848 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1) )
cparata 0:485458fca2bd 2849 return MEMS_ERROR;
cparata 0:485458fca2bd 2850
cparata 0:485458fca2bd 2851 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2852 }
cparata 0:485458fca2bd 2853
cparata 0:485458fca2bd 2854 /*******************************************************************************
cparata 0:485458fca2bd 2855 * Function Name : LSM6DSL_ACC_GYRO_R_LowPower_XL
cparata 0:485458fca2bd 2856 * Description : Read LP_XL
cparata 0:485458fca2bd 2857 * Input : Pointer to LSM6DSL_ACC_GYRO_LP_XL_t
cparata 0:485458fca2bd 2858 * Output : Status of LP_XL see LSM6DSL_ACC_GYRO_LP_XL_t
cparata 0:485458fca2bd 2859 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2860 *******************************************************************************/
cparata 0:485458fca2bd 2861 status_t LSM6DSL_ACC_GYRO_R_LowPower_XL(void *handle, LSM6DSL_ACC_GYRO_LP_XL_t *value)
cparata 0:485458fca2bd 2862 {
cparata 0:485458fca2bd 2863 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, (u8_t *)value, 1))
cparata 0:485458fca2bd 2864 return MEMS_ERROR;
cparata 0:485458fca2bd 2865
cparata 0:485458fca2bd 2866 *value &= LSM6DSL_ACC_GYRO_LP_XL_MASK; //mask
cparata 0:485458fca2bd 2867
cparata 0:485458fca2bd 2868 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2869 }
cparata 0:485458fca2bd 2870 /*******************************************************************************
cparata 0:485458fca2bd 2871 * Function Name : LSM6DSL_ACC_GYRO_W_DEN_LVL2_EN
cparata 0:485458fca2bd 2872 * Description : Write DEN_LVL2_EN
cparata 0:485458fca2bd 2873 * Input : LSM6DSL_ACC_GYRO_DEN_LVL2_EN_t
cparata 0:485458fca2bd 2874 * Output : None
cparata 0:485458fca2bd 2875 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2876 *******************************************************************************/
cparata 0:485458fca2bd 2877 status_t LSM6DSL_ACC_GYRO_W_DEN_LVL2_EN(void *handle, LSM6DSL_ACC_GYRO_DEN_LVL2_EN_t newValue)
cparata 0:485458fca2bd 2878 {
cparata 0:485458fca2bd 2879 u8_t value;
cparata 0:485458fca2bd 2880
cparata 0:485458fca2bd 2881 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1))
cparata 0:485458fca2bd 2882 return MEMS_ERROR;
cparata 0:485458fca2bd 2883
cparata 0:485458fca2bd 2884 value &= ~LSM6DSL_ACC_GYRO_DEN_LVL2_EN_MASK;
cparata 0:485458fca2bd 2885 value |= newValue;
cparata 0:485458fca2bd 2886
cparata 0:485458fca2bd 2887 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1) )
cparata 0:485458fca2bd 2888 return MEMS_ERROR;
cparata 0:485458fca2bd 2889
cparata 0:485458fca2bd 2890 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2891 }
cparata 0:485458fca2bd 2892
cparata 0:485458fca2bd 2893 /*******************************************************************************
cparata 0:485458fca2bd 2894 * Function Name : LSM6DSL_ACC_GYRO_R_DEN_LVL2_EN
cparata 0:485458fca2bd 2895 * Description : Read DEN_LVL2_EN
cparata 0:485458fca2bd 2896 * Input : Pointer to LSM6DSL_ACC_GYRO_DEN_LVL2_EN_t
cparata 0:485458fca2bd 2897 * Output : Status of DEN_LVL2_EN see LSM6DSL_ACC_GYRO_DEN_LVL2_EN_t
cparata 0:485458fca2bd 2898 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2899 *******************************************************************************/
cparata 0:485458fca2bd 2900 status_t LSM6DSL_ACC_GYRO_R_DEN_LVL2_EN(void *handle, LSM6DSL_ACC_GYRO_DEN_LVL2_EN_t *value)
cparata 0:485458fca2bd 2901 {
cparata 0:485458fca2bd 2902 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, (u8_t *)value, 1))
cparata 0:485458fca2bd 2903 return MEMS_ERROR;
cparata 0:485458fca2bd 2904
cparata 0:485458fca2bd 2905 *value &= LSM6DSL_ACC_GYRO_DEN_LVL2_EN_MASK; //mask
cparata 0:485458fca2bd 2906
cparata 0:485458fca2bd 2907 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2908 }
cparata 0:485458fca2bd 2909 /*******************************************************************************
cparata 0:485458fca2bd 2910 * Function Name : LSM6DSL_ACC_GYRO_W_DEN_LVL_EN
cparata 0:485458fca2bd 2911 * Description : Write DEN_LVL_EN
cparata 0:485458fca2bd 2912 * Input : LSM6DSL_ACC_GYRO_DEN_LVL_EN_t
cparata 0:485458fca2bd 2913 * Output : None
cparata 0:485458fca2bd 2914 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2915 *******************************************************************************/
cparata 0:485458fca2bd 2916 status_t LSM6DSL_ACC_GYRO_W_DEN_LVL_EN(void *handle, LSM6DSL_ACC_GYRO_DEN_LVL_EN_t newValue)
cparata 0:485458fca2bd 2917 {
cparata 0:485458fca2bd 2918 u8_t value;
cparata 0:485458fca2bd 2919
cparata 0:485458fca2bd 2920 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1))
cparata 0:485458fca2bd 2921 return MEMS_ERROR;
cparata 0:485458fca2bd 2922
cparata 0:485458fca2bd 2923 value &= ~LSM6DSL_ACC_GYRO_DEN_LVL_EN_MASK;
cparata 0:485458fca2bd 2924 value |= newValue;
cparata 0:485458fca2bd 2925
cparata 0:485458fca2bd 2926 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1) )
cparata 0:485458fca2bd 2927 return MEMS_ERROR;
cparata 0:485458fca2bd 2928
cparata 0:485458fca2bd 2929 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2930 }
cparata 0:485458fca2bd 2931
cparata 0:485458fca2bd 2932 /*******************************************************************************
cparata 0:485458fca2bd 2933 * Function Name : LSM6DSL_ACC_GYRO_R_DEN_LVL_EN
cparata 0:485458fca2bd 2934 * Description : Read DEN_LVL_EN
cparata 0:485458fca2bd 2935 * Input : Pointer to LSM6DSL_ACC_GYRO_DEN_LVL_EN_t
cparata 0:485458fca2bd 2936 * Output : Status of DEN_LVL_EN see LSM6DSL_ACC_GYRO_DEN_LVL_EN_t
cparata 0:485458fca2bd 2937 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2938 *******************************************************************************/
cparata 0:485458fca2bd 2939 status_t LSM6DSL_ACC_GYRO_R_DEN_LVL_EN(void *handle, LSM6DSL_ACC_GYRO_DEN_LVL_EN_t *value)
cparata 0:485458fca2bd 2940 {
cparata 0:485458fca2bd 2941 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, (u8_t *)value, 1) )
cparata 0:485458fca2bd 2942 return MEMS_ERROR;
cparata 0:485458fca2bd 2943
cparata 0:485458fca2bd 2944 *value &= LSM6DSL_ACC_GYRO_DEN_LVL_EN_MASK; //mask
cparata 0:485458fca2bd 2945
cparata 0:485458fca2bd 2946 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2947 }
cparata 0:485458fca2bd 2948 /*******************************************************************************
cparata 0:485458fca2bd 2949 * Function Name : LSM6DSL_ACC_GYRO_W_ExternalTrigger
cparata 0:485458fca2bd 2950 * Description : Write DEN_EDGE_EN
cparata 0:485458fca2bd 2951 * Input : LSM6DSL_ACC_GYRO_DEN_EDGE_EN_t
cparata 0:485458fca2bd 2952 * Output : None
cparata 0:485458fca2bd 2953 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2954 *******************************************************************************/
cparata 0:485458fca2bd 2955 status_t LSM6DSL_ACC_GYRO_W_ExternalTrigger(void *handle, LSM6DSL_ACC_GYRO_DEN_EDGE_EN_t newValue)
cparata 0:485458fca2bd 2956 {
cparata 0:485458fca2bd 2957 u8_t value;
cparata 0:485458fca2bd 2958
cparata 0:485458fca2bd 2959 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1) )
cparata 0:485458fca2bd 2960 return MEMS_ERROR;
cparata 0:485458fca2bd 2961
cparata 0:485458fca2bd 2962 value &= ~LSM6DSL_ACC_GYRO_DEN_EDGE_EN_MASK;
cparata 0:485458fca2bd 2963 value |= newValue;
cparata 0:485458fca2bd 2964
cparata 0:485458fca2bd 2965 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1) )
cparata 0:485458fca2bd 2966 return MEMS_ERROR;
cparata 0:485458fca2bd 2967
cparata 0:485458fca2bd 2968 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2969 }
cparata 0:485458fca2bd 2970
cparata 0:485458fca2bd 2971 /*******************************************************************************
cparata 0:485458fca2bd 2972 * Function Name : LSM6DSL_ACC_GYRO_R_ExternalTrigger
cparata 0:485458fca2bd 2973 * Description : Read DEN_EDGE_EN
cparata 0:485458fca2bd 2974 * Input : Pointer to LSM6DSL_ACC_GYRO_DEN_EDGE_EN_t
cparata 0:485458fca2bd 2975 * Output : Status of DEN_EDGE_EN see LSM6DSL_ACC_GYRO_DEN_EDGE_EN_t
cparata 0:485458fca2bd 2976 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2977 *******************************************************************************/
cparata 0:485458fca2bd 2978 status_t LSM6DSL_ACC_GYRO_R_ExternalTrigger(void *handle, LSM6DSL_ACC_GYRO_DEN_EDGE_EN_t *value)
cparata 0:485458fca2bd 2979 {
cparata 0:485458fca2bd 2980 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, (u8_t *)value, 1) )
cparata 0:485458fca2bd 2981 return MEMS_ERROR;
cparata 0:485458fca2bd 2982
cparata 0:485458fca2bd 2983 *value &= LSM6DSL_ACC_GYRO_DEN_EDGE_EN_MASK; //mask
cparata 0:485458fca2bd 2984
cparata 0:485458fca2bd 2985 return MEMS_SUCCESS;
cparata 0:485458fca2bd 2986 }
cparata 0:485458fca2bd 2987
cparata 0:485458fca2bd 2988 /*******************************************************************************
cparata 0:485458fca2bd 2989 * Function Name : LSM6DSL_ACC_GYRO_W_HPM_G
cparata 0:485458fca2bd 2990 * Description : Write HPM_G
cparata 0:485458fca2bd 2991 * Input : LSM6DSL_ACC_GYRO_HPM_G_t
cparata 0:485458fca2bd 2992 * Output : None
cparata 0:485458fca2bd 2993 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 2994 *******************************************************************************/
cparata 0:485458fca2bd 2995 status_t LSM6DSL_ACC_GYRO_W_HPM_G(void *handle, LSM6DSL_ACC_GYRO_HPM_G_t newValue)
cparata 0:485458fca2bd 2996 {
cparata 0:485458fca2bd 2997 u8_t value;
cparata 0:485458fca2bd 2998
cparata 0:485458fca2bd 2999 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:485458fca2bd 3000 return MEMS_ERROR;
cparata 0:485458fca2bd 3001
cparata 0:485458fca2bd 3002 value &= ~LSM6DSL_ACC_GYRO_HPM_G_MASK;
cparata 0:485458fca2bd 3003 value |= newValue;
cparata 0:485458fca2bd 3004
cparata 0:485458fca2bd 3005 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:485458fca2bd 3006 return MEMS_ERROR;
cparata 0:485458fca2bd 3007
cparata 0:485458fca2bd 3008 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3009 }
cparata 0:485458fca2bd 3010
cparata 0:485458fca2bd 3011 /*******************************************************************************
cparata 0:485458fca2bd 3012 * Function Name : LSM6DSL_ACC_GYRO_R_HPM_G
cparata 0:485458fca2bd 3013 * Description : Read HPM_G
cparata 0:485458fca2bd 3014 * Input : Pointer to LSM6DSL_ACC_GYRO_HPM_G_t
cparata 0:485458fca2bd 3015 * Output : Status of HPM_G see LSM6DSL_ACC_GYRO_HPM_G_t
cparata 0:485458fca2bd 3016 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3017 *******************************************************************************/
cparata 0:485458fca2bd 3018 status_t LSM6DSL_ACC_GYRO_R_HPM_G(void *handle, LSM6DSL_ACC_GYRO_HPM_G_t *value)
cparata 0:485458fca2bd 3019 {
cparata 0:485458fca2bd 3020 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, (u8_t *)value, 1) )
cparata 0:485458fca2bd 3021 return MEMS_ERROR;
cparata 0:485458fca2bd 3022
cparata 0:485458fca2bd 3023 *value &= LSM6DSL_ACC_GYRO_HPM_G_MASK; //mask
cparata 0:485458fca2bd 3024
cparata 0:485458fca2bd 3025 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3026 }
cparata 0:485458fca2bd 3027
cparata 0:485458fca2bd 3028 /*******************************************************************************
cparata 0:485458fca2bd 3029 * Function Name : LSM6DSL_ACC_GYRO_W_RoundingOnStatusRegisters
cparata 0:485458fca2bd 3030 * Description : Write HPM_G
cparata 0:485458fca2bd 3031 * Input : LSM6DSL_ACC_GYRO_RND_STATUS_t
cparata 0:485458fca2bd 3032 * Output : None
cparata 0:485458fca2bd 3033 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3034 *******************************************************************************/
cparata 0:485458fca2bd 3035 status_t LSM6DSL_ACC_GYRO_W_RoundingOnStatusRegisters(void *handle, LSM6DSL_ACC_GYRO_RND_STATUS_t newValue)
cparata 0:485458fca2bd 3036 {
cparata 0:485458fca2bd 3037 u8_t value;
cparata 0:485458fca2bd 3038
cparata 0:485458fca2bd 3039 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:485458fca2bd 3040 return MEMS_ERROR;
cparata 0:485458fca2bd 3041
cparata 0:485458fca2bd 3042 value &= ~LSM6DSL_ACC_GYRO_RND_STATUS_MASK;
cparata 0:485458fca2bd 3043 value |= newValue;
cparata 0:485458fca2bd 3044
cparata 0:485458fca2bd 3045 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:485458fca2bd 3046 return MEMS_ERROR;
cparata 0:485458fca2bd 3047
cparata 0:485458fca2bd 3048 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3049 }
cparata 0:485458fca2bd 3050
cparata 0:485458fca2bd 3051 /*******************************************************************************
cparata 0:485458fca2bd 3052 * Function Name : LSM6DSL_ACC_GYRO_R_RoundingOnStatusRegisters
cparata 0:485458fca2bd 3053 * Description : Read HPM_G
cparata 0:485458fca2bd 3054 * Input : Pointer to LSM6DSL_ACC_GYRO_RND_STATUS_t
cparata 0:485458fca2bd 3055 * Output : Status of HPM_G see LSM6DSL_ACC_GYRO_RND_STATUS_t
cparata 0:485458fca2bd 3056 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3057 *******************************************************************************/
cparata 0:485458fca2bd 3058 status_t LSM6DSL_ACC_GYRO_R_RoundingOnStatusRegisters(void *handle, LSM6DSL_ACC_GYRO_RND_STATUS_t *value)
cparata 0:485458fca2bd 3059 {
cparata 0:485458fca2bd 3060 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, (u8_t *)value, 1))
cparata 0:485458fca2bd 3061 return MEMS_ERROR;
cparata 0:485458fca2bd 3062
cparata 0:485458fca2bd 3063 *value &= LSM6DSL_ACC_GYRO_RND_STATUS_MASK; //mask
cparata 0:485458fca2bd 3064
cparata 0:485458fca2bd 3065 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3066 }
cparata 0:485458fca2bd 3067
cparata 0:485458fca2bd 3068 /*******************************************************************************
cparata 0:485458fca2bd 3069 * Function Name : LSM6DSL_ACC_GYRO_W_HPFilter_En
cparata 0:485458fca2bd 3070 * Description : Write HP_EN
cparata 0:485458fca2bd 3071 * Input : LSM6DSL_ACC_GYRO_HP_EN_t
cparata 0:485458fca2bd 3072 * Output : None
cparata 0:485458fca2bd 3073 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3074 *******************************************************************************/
cparata 0:485458fca2bd 3075 status_t LSM6DSL_ACC_GYRO_W_HPFilter_En(void *handle, LSM6DSL_ACC_GYRO_HP_EN_t newValue)
cparata 0:485458fca2bd 3076 {
cparata 0:485458fca2bd 3077 u8_t value;
cparata 0:485458fca2bd 3078
cparata 0:485458fca2bd 3079 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:485458fca2bd 3080 return MEMS_ERROR;
cparata 0:485458fca2bd 3081
cparata 0:485458fca2bd 3082 value &= ~LSM6DSL_ACC_GYRO_HP_EN_MASK;
cparata 0:485458fca2bd 3083 value |= newValue;
cparata 0:485458fca2bd 3084
cparata 0:485458fca2bd 3085 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:485458fca2bd 3086 return MEMS_ERROR;
cparata 0:485458fca2bd 3087
cparata 0:485458fca2bd 3088 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3089 }
cparata 0:485458fca2bd 3090
cparata 0:485458fca2bd 3091 /*******************************************************************************
cparata 0:485458fca2bd 3092 * Function Name : LSM6DSL_ACC_GYRO_R_HPFilter_En
cparata 0:485458fca2bd 3093 * Description : Read HP_EN
cparata 0:485458fca2bd 3094 * Input : Pointer to LSM6DSL_ACC_GYRO_HP_EN_t
cparata 0:485458fca2bd 3095 * Output : Status of HP_EN see LSM6DSL_ACC_GYRO_HP_EN_t
cparata 0:485458fca2bd 3096 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3097 *******************************************************************************/
cparata 0:485458fca2bd 3098 status_t LSM6DSL_ACC_GYRO_R_HPFilter_En(void *handle, LSM6DSL_ACC_GYRO_HP_EN_t *value)
cparata 0:485458fca2bd 3099 {
cparata 0:485458fca2bd 3100 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, (u8_t *)value, 1) )
cparata 0:485458fca2bd 3101 return MEMS_ERROR;
cparata 0:485458fca2bd 3102
cparata 0:485458fca2bd 3103 *value &= LSM6DSL_ACC_GYRO_HP_EN_MASK; //mask
cparata 0:485458fca2bd 3104
cparata 0:485458fca2bd 3105 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3106 }
cparata 0:485458fca2bd 3107 /*******************************************************************************
cparata 0:485458fca2bd 3108 * Function Name : LSM6DSL_ACC_GYRO_W_LP_Mode
cparata 0:485458fca2bd 3109 * Description : Write LP_EN
cparata 0:485458fca2bd 3110 * Input : LSM6DSL_ACC_GYRO_LP_EN_t
cparata 0:485458fca2bd 3111 * Output : None
cparata 0:485458fca2bd 3112 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3113 *******************************************************************************/
cparata 0:485458fca2bd 3114 status_t LSM6DSL_ACC_GYRO_W_LP_Mode(void *handle, LSM6DSL_ACC_GYRO_LP_EN_t newValue)
cparata 0:485458fca2bd 3115 {
cparata 0:485458fca2bd 3116 u8_t value;
cparata 0:485458fca2bd 3117
cparata 0:485458fca2bd 3118 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:485458fca2bd 3119 return MEMS_ERROR;
cparata 0:485458fca2bd 3120
cparata 0:485458fca2bd 3121 value &= ~LSM6DSL_ACC_GYRO_LP_EN_MASK;
cparata 0:485458fca2bd 3122 value |= newValue;
cparata 0:485458fca2bd 3123
cparata 0:485458fca2bd 3124 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:485458fca2bd 3125 return MEMS_ERROR;
cparata 0:485458fca2bd 3126
cparata 0:485458fca2bd 3127 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3128 }
cparata 0:485458fca2bd 3129
cparata 0:485458fca2bd 3130 /*******************************************************************************
cparata 0:485458fca2bd 3131 * Function Name : LSM6DSL_ACC_GYRO_R_LP_Mode
cparata 0:485458fca2bd 3132 * Description : Read LP_EN
cparata 0:485458fca2bd 3133 * Input : Pointer to LSM6DSL_ACC_GYRO_LP_EN_t
cparata 0:485458fca2bd 3134 * Output : Status of LP_EN see LSM6DSL_ACC_GYRO_LP_EN_t
cparata 0:485458fca2bd 3135 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3136 *******************************************************************************/
cparata 0:485458fca2bd 3137 status_t LSM6DSL_ACC_GYRO_R_LP_Mode(void *handle, LSM6DSL_ACC_GYRO_LP_EN_t *value)
cparata 0:485458fca2bd 3138 {
cparata 0:485458fca2bd 3139 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, (u8_t *)value, 1) )
cparata 0:485458fca2bd 3140 return MEMS_ERROR;
cparata 0:485458fca2bd 3141
cparata 0:485458fca2bd 3142 *value &= LSM6DSL_ACC_GYRO_LP_EN_MASK; //mask
cparata 0:485458fca2bd 3143
cparata 0:485458fca2bd 3144 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3145 }
cparata 0:485458fca2bd 3146
cparata 0:485458fca2bd 3147 /*******************************************************************************
cparata 0:485458fca2bd 3148 * Function Name : LSM6DSL_ACC_GYRO_W_ROUNDING_STATUS
cparata 0:485458fca2bd 3149 * Description : Write ROUNDING_STATUS
cparata 0:485458fca2bd 3150 * Input : LSM6DSL_ACC_GYRO_ROUNDING_STATUS_t
cparata 0:485458fca2bd 3151 * Output : None
cparata 0:485458fca2bd 3152 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3153 *******************************************************************************/
cparata 0:485458fca2bd 3154 status_t LSM6DSL_ACC_GYRO_W_ROUNDING_STATUS(void *handle, LSM6DSL_ACC_GYRO_ROUNDING_STATUS_t newValue)
cparata 0:485458fca2bd 3155 {
cparata 0:485458fca2bd 3156 u8_t value;
cparata 0:485458fca2bd 3157
cparata 0:485458fca2bd 3158 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:485458fca2bd 3159 return MEMS_ERROR;
cparata 0:485458fca2bd 3160
cparata 0:485458fca2bd 3161 value &= ~LSM6DSL_ACC_GYRO_ROUNDING_STATUS_MASK;
cparata 0:485458fca2bd 3162 value |= newValue;
cparata 0:485458fca2bd 3163
cparata 0:485458fca2bd 3164 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:485458fca2bd 3165 return MEMS_ERROR;
cparata 0:485458fca2bd 3166
cparata 0:485458fca2bd 3167 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3168 }
cparata 0:485458fca2bd 3169
cparata 0:485458fca2bd 3170 /*******************************************************************************
cparata 0:485458fca2bd 3171 * Function Name : LSM6DSL_ACC_GYRO_R_ROUNDING_STATUS
cparata 0:485458fca2bd 3172 * Description : Read ROUNDING_STATUS
cparata 0:485458fca2bd 3173 * Input : Pointer to LSM6DSL_ACC_GYRO_ROUNDING_STATUS_t
cparata 0:485458fca2bd 3174 * Output : Status of ROUNDING_STATUS see LSM6DSL_ACC_GYRO_ROUNDING_STATUS_t
cparata 0:485458fca2bd 3175 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3176 *******************************************************************************/
cparata 0:485458fca2bd 3177 status_t LSM6DSL_ACC_GYRO_R_ROUNDING_STATUS(void *handle, LSM6DSL_ACC_GYRO_ROUNDING_STATUS_t *value)
cparata 0:485458fca2bd 3178 {
cparata 0:485458fca2bd 3179 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, (u8_t *)value, 1) )
cparata 0:485458fca2bd 3180 return MEMS_ERROR;
cparata 0:485458fca2bd 3181
cparata 0:485458fca2bd 3182 *value &= LSM6DSL_ACC_GYRO_ROUNDING_STATUS_MASK; //mask
cparata 0:485458fca2bd 3183
cparata 0:485458fca2bd 3184 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3185 }
cparata 0:485458fca2bd 3186
cparata 0:485458fca2bd 3187 /*******************************************************************************
cparata 0:485458fca2bd 3188 * Function Name : LSM6DSL_ACC_GYRO_W_HP_G_RST
cparata 0:485458fca2bd 3189 * Description : Write HP_G_RST
cparata 0:485458fca2bd 3190 * Input : LSM6DSL_ACC_GYRO_HP_G_RST_t
cparata 0:485458fca2bd 3191 * Output : None
cparata 0:485458fca2bd 3192 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3193 *******************************************************************************/
cparata 0:485458fca2bd 3194 status_t LSM6DSL_ACC_GYRO_W_HP_G_RST(void *handle, LSM6DSL_ACC_GYRO_HP_G_RST_t newValue)
cparata 0:485458fca2bd 3195 {
cparata 0:485458fca2bd 3196 u8_t value;
cparata 0:485458fca2bd 3197
cparata 0:485458fca2bd 3198 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:485458fca2bd 3199 return MEMS_ERROR;
cparata 0:485458fca2bd 3200
cparata 0:485458fca2bd 3201 value &= ~LSM6DSL_ACC_GYRO_HP_G_RST_MASK;
cparata 0:485458fca2bd 3202 value |= newValue;
cparata 0:485458fca2bd 3203
cparata 0:485458fca2bd 3204 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:485458fca2bd 3205 return MEMS_ERROR;
cparata 0:485458fca2bd 3206
cparata 0:485458fca2bd 3207 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3208 }
cparata 0:485458fca2bd 3209
cparata 0:485458fca2bd 3210 /*******************************************************************************
cparata 0:485458fca2bd 3211 * Function Name : LSM6DSL_ACC_GYRO_R_HP_G_RST
cparata 0:485458fca2bd 3212 * Description : Read HP_G_RST
cparata 0:485458fca2bd 3213 * Input : Pointer to LSM6DSL_ACC_GYRO_HP_G_RST_t
cparata 0:485458fca2bd 3214 * Output : Status of HP_G_RST see LSM6DSL_ACC_GYRO_HP_G_RST_t
cparata 0:485458fca2bd 3215 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3216 *******************************************************************************/
cparata 0:485458fca2bd 3217 status_t LSM6DSL_ACC_GYRO_R_HP_G_RST(void *handle, LSM6DSL_ACC_GYRO_HP_G_RST_t *value)
cparata 0:485458fca2bd 3218 {
cparata 0:485458fca2bd 3219 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, (u8_t *)value, 1) )
cparata 0:485458fca2bd 3220 return MEMS_ERROR;
cparata 0:485458fca2bd 3221
cparata 0:485458fca2bd 3222 *value &= LSM6DSL_ACC_GYRO_HP_G_RST_MASK; //mask
cparata 0:485458fca2bd 3223
cparata 0:485458fca2bd 3224 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3225 }
cparata 0:485458fca2bd 3226
cparata 0:485458fca2bd 3227 /*******************************************************************************
cparata 0:485458fca2bd 3228 * Function Name : LSM6DSL_ACC_GYRO_W_InComposit
cparata 0:485458fca2bd 3229 * Description : Write INPUT_COMPOSITE
cparata 0:485458fca2bd 3230 * Input : LSM6DSL_ACC_GYRO_IN_COMP_t
cparata 0:485458fca2bd 3231 * Output : None
cparata 0:485458fca2bd 3232 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3233 *******************************************************************************/
cparata 0:485458fca2bd 3234 status_t LSM6DSL_ACC_GYRO_W_InComposit(void *handle, LSM6DSL_ACC_GYRO_IN_COMP_t newValue)
cparata 0:485458fca2bd 3235 {
cparata 0:485458fca2bd 3236 u8_t value;
cparata 0:485458fca2bd 3237
cparata 0:485458fca2bd 3238 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:485458fca2bd 3239 return MEMS_ERROR;
cparata 0:485458fca2bd 3240
cparata 0:485458fca2bd 3241 value &= ~LSM6DSL_ACC_GYRO_IN_COMP_MASK;
cparata 0:485458fca2bd 3242 value |= newValue;
cparata 0:485458fca2bd 3243
cparata 0:485458fca2bd 3244 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:485458fca2bd 3245 return MEMS_ERROR;
cparata 0:485458fca2bd 3246
cparata 0:485458fca2bd 3247 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3248 }
cparata 0:485458fca2bd 3249
cparata 0:485458fca2bd 3250 /*******************************************************************************
cparata 0:485458fca2bd 3251 * Function Name : LSM6DSL_ACC_GYRO_R_InComposit
cparata 0:485458fca2bd 3252 * Description : Read INPUT_COMPOSITE
cparata 0:485458fca2bd 3253 * Input : Pointer to LSM6DSL_ACC_GYRO_IN_COMP_t
cparata 0:485458fca2bd 3254 * Output : Status of INPUT_COMPOSITE see LSM6DSL_ACC_GYRO_IN_COMP_t
cparata 0:485458fca2bd 3255 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3256 *******************************************************************************/
cparata 0:485458fca2bd 3257 status_t LSM6DSL_ACC_GYRO_R_InComposit(void *handle, LSM6DSL_ACC_GYRO_IN_COMP_t *value)
cparata 0:485458fca2bd 3258 {
cparata 0:485458fca2bd 3259 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, (u8_t *)value, 1) )
cparata 0:485458fca2bd 3260 return MEMS_ERROR;
cparata 0:485458fca2bd 3261
cparata 0:485458fca2bd 3262 *value &= LSM6DSL_ACC_GYRO_IN_COMP_MASK; //mask
cparata 0:485458fca2bd 3263
cparata 0:485458fca2bd 3264 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3265 }
cparata 0:485458fca2bd 3266
cparata 0:485458fca2bd 3267 /*******************************************************************************
cparata 0:485458fca2bd 3268 * Function Name : LSM6DSL_ACC_GYRO_W_HPfilterReference
cparata 0:485458fca2bd 3269 * Description : Write HP_REF_MODE
cparata 0:485458fca2bd 3270 * Input : LSM6DSL_ACC_GYRO_HP_REF_MODE_t
cparata 0:485458fca2bd 3271 * Output : None
cparata 0:485458fca2bd 3272 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3273 *******************************************************************************/
cparata 0:485458fca2bd 3274 status_t LSM6DSL_ACC_GYRO_W_HPfilterReference(void *handle, LSM6DSL_ACC_GYRO_HP_REF_MODE_t newValue)
cparata 0:485458fca2bd 3275 {
cparata 0:485458fca2bd 3276 u8_t value;
cparata 0:485458fca2bd 3277
cparata 0:485458fca2bd 3278 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:485458fca2bd 3279 return MEMS_ERROR;
cparata 0:485458fca2bd 3280
cparata 0:485458fca2bd 3281 value &= ~LSM6DSL_ACC_GYRO_HP_REF_MODE_MASK;
cparata 0:485458fca2bd 3282 value |= newValue;
cparata 0:485458fca2bd 3283
cparata 0:485458fca2bd 3284 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:485458fca2bd 3285 return MEMS_ERROR;
cparata 0:485458fca2bd 3286
cparata 0:485458fca2bd 3287 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3288 }
cparata 0:485458fca2bd 3289
cparata 0:485458fca2bd 3290 /*******************************************************************************
cparata 0:485458fca2bd 3291 * Function Name : LSM6DSL_ACC_GYRO_R_HPfilterReference
cparata 0:485458fca2bd 3292 * Description : Read HP_REF_MODE
cparata 0:485458fca2bd 3293 * Input : Pointer to LSM6DSL_ACC_GYRO_HP_REF_MODE_t
cparata 0:485458fca2bd 3294 * Output : Status of HP_REF_MODE see LSM6DSL_ACC_GYRO_HP_REF_MODE_t
cparata 0:485458fca2bd 3295 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3296 *******************************************************************************/
cparata 0:485458fca2bd 3297 status_t LSM6DSL_ACC_GYRO_R_HPfilterReference(void *handle, LSM6DSL_ACC_GYRO_HP_REF_MODE_t *value)
cparata 0:485458fca2bd 3298 {
cparata 0:485458fca2bd 3299 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, (u8_t *)value, 1) )
cparata 0:485458fca2bd 3300 return MEMS_ERROR;
cparata 0:485458fca2bd 3301
cparata 0:485458fca2bd 3302 *value &= LSM6DSL_ACC_GYRO_HP_REF_MODE_MASK; //mask
cparata 0:485458fca2bd 3303
cparata 0:485458fca2bd 3304 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3305 }
cparata 0:485458fca2bd 3306
cparata 0:485458fca2bd 3307 /*******************************************************************************
cparata 0:485458fca2bd 3308 * Function Name : LSM6DSL_ACC_GYRO_W_HPCF_XL
cparata 0:485458fca2bd 3309 * Description : Write HPCF_XL
cparata 0:485458fca2bd 3310 * Input : LSM6DSL_ACC_GYRO_HPCF_XL_t
cparata 0:485458fca2bd 3311 * Output : None
cparata 0:485458fca2bd 3312 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3313 *******************************************************************************/
cparata 0:485458fca2bd 3314 status_t LSM6DSL_ACC_GYRO_W_HPCF_XL(void *handle, LSM6DSL_ACC_GYRO_HPCF_XL_t newValue)
cparata 0:485458fca2bd 3315 {
cparata 0:485458fca2bd 3316 u8_t value;
cparata 0:485458fca2bd 3317
cparata 0:485458fca2bd 3318 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:485458fca2bd 3319 return MEMS_ERROR;
cparata 0:485458fca2bd 3320
cparata 0:485458fca2bd 3321 value &= ~LSM6DSL_ACC_GYRO_HPCF_XL_MASK;
cparata 0:485458fca2bd 3322 value |= newValue;
cparata 0:485458fca2bd 3323
cparata 0:485458fca2bd 3324 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:485458fca2bd 3325 return MEMS_ERROR;
cparata 0:485458fca2bd 3326
cparata 0:485458fca2bd 3327 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3328 }
cparata 0:485458fca2bd 3329
cparata 0:485458fca2bd 3330 /*******************************************************************************
cparata 0:485458fca2bd 3331 * Function Name : LSM6DSL_ACC_GYRO_R_HPCF_XL
cparata 0:485458fca2bd 3332 * Description : Read HPCF_XL
cparata 0:485458fca2bd 3333 * Input : Pointer to LSM6DSL_ACC_GYRO_HPCF_XL_t
cparata 0:485458fca2bd 3334 * Output : Status of HPCF_XL see LSM6DSL_ACC_GYRO_HPCF_XL_t
cparata 0:485458fca2bd 3335 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3336 *******************************************************************************/
cparata 0:485458fca2bd 3337 status_t LSM6DSL_ACC_GYRO_R_HPCF_XL(void *handle, LSM6DSL_ACC_GYRO_HPCF_XL_t *value)
cparata 0:485458fca2bd 3338 {
cparata 0:485458fca2bd 3339 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, (u8_t *)value, 1) )
cparata 0:485458fca2bd 3340 return MEMS_ERROR;
cparata 0:485458fca2bd 3341
cparata 0:485458fca2bd 3342 *value &= LSM6DSL_ACC_GYRO_HPCF_XL_MASK; //mask
cparata 0:485458fca2bd 3343
cparata 0:485458fca2bd 3344 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3345 }
cparata 0:485458fca2bd 3346
cparata 0:485458fca2bd 3347 /*******************************************************************************
cparata 0:485458fca2bd 3348 * Function Name : LSM6DSL_ACC_GYRO_W_LowPassFiltSel_XL
cparata 0:485458fca2bd 3349 * Description : Write LPF2_XL_EN
cparata 0:485458fca2bd 3350 * Input : LSM6DSL_ACC_GYRO_LPF2_XL_t
cparata 0:485458fca2bd 3351 * Output : None
cparata 0:485458fca2bd 3352 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3353 *******************************************************************************/
cparata 0:485458fca2bd 3354 status_t LSM6DSL_ACC_GYRO_W_LowPassFiltSel_XL(void *handle, LSM6DSL_ACC_GYRO_LPF2_XL_t newValue)
cparata 0:485458fca2bd 3355 {
cparata 0:485458fca2bd 3356 u8_t value;
cparata 0:485458fca2bd 3357
cparata 0:485458fca2bd 3358 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:485458fca2bd 3359 return MEMS_ERROR;
cparata 0:485458fca2bd 3360
cparata 0:485458fca2bd 3361 value &= ~LSM6DSL_ACC_GYRO_LPF2_XL_MASK;
cparata 0:485458fca2bd 3362 value |= newValue;
cparata 0:485458fca2bd 3363
cparata 0:485458fca2bd 3364 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:485458fca2bd 3365 return MEMS_ERROR;
cparata 0:485458fca2bd 3366
cparata 0:485458fca2bd 3367 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3368 }
cparata 0:485458fca2bd 3369
cparata 0:485458fca2bd 3370 /*******************************************************************************
cparata 0:485458fca2bd 3371 * Function Name : LSM6DSL_ACC_GYRO_R_LowPassFiltSel_XL
cparata 0:485458fca2bd 3372 * Description : Read LPF2_XL_EN
cparata 0:485458fca2bd 3373 * Input : Pointer to LSM6DSL_ACC_GYRO_LPF2_XL_t
cparata 0:485458fca2bd 3374 * Output : Status of LPF2_XL_EN see LSM6DSL_ACC_GYRO_LPF2_XL_t
cparata 0:485458fca2bd 3375 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3376 *******************************************************************************/
cparata 0:485458fca2bd 3377 status_t LSM6DSL_ACC_GYRO_R_LowPassFiltSel_XL(void *handle, LSM6DSL_ACC_GYRO_LPF2_XL_t *value)
cparata 0:485458fca2bd 3378 {
cparata 0:485458fca2bd 3379 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, (u8_t *)value, 1) )
cparata 0:485458fca2bd 3380 return MEMS_ERROR;
cparata 0:485458fca2bd 3381
cparata 0:485458fca2bd 3382 *value &= LSM6DSL_ACC_GYRO_LPF2_XL_MASK; //mask
cparata 0:485458fca2bd 3383
cparata 0:485458fca2bd 3384 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3385 }
cparata 0:485458fca2bd 3386
cparata 0:485458fca2bd 3387 /*******************************************************************************
cparata 0:485458fca2bd 3388 * Function Name : LSM6DSL_ACC_GYRO_W_LOW_PASS_ON_6D
cparata 0:485458fca2bd 3389 * Description : Write LOW_PASS_ON_6D
cparata 0:485458fca2bd 3390 * Input : LSM6DSL_ACC_GYRO_LOW_PASS_ON_6D_t
cparata 0:485458fca2bd 3391 * Output : None
cparata 0:485458fca2bd 3392 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3393 *******************************************************************************/
cparata 0:485458fca2bd 3394 status_t LSM6DSL_ACC_GYRO_W_LOW_PASS_ON_6D(void *handle, LSM6DSL_ACC_GYRO_LOW_PASS_ON_6D_t newValue)
cparata 0:485458fca2bd 3395 {
cparata 0:485458fca2bd 3396 u8_t value;
cparata 0:485458fca2bd 3397
cparata 0:485458fca2bd 3398 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:485458fca2bd 3399 return MEMS_ERROR;
cparata 0:485458fca2bd 3400
cparata 0:485458fca2bd 3401 value &= ~LSM6DSL_ACC_GYRO_LOW_PASS_ON_6D_MASK;
cparata 0:485458fca2bd 3402 value |= newValue;
cparata 0:485458fca2bd 3403
cparata 0:485458fca2bd 3404 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:485458fca2bd 3405 return MEMS_ERROR;
cparata 0:485458fca2bd 3406
cparata 0:485458fca2bd 3407 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3408 }
cparata 0:485458fca2bd 3409
cparata 0:485458fca2bd 3410 /*******************************************************************************
cparata 0:485458fca2bd 3411 * Function Name : LSM6DSL_ACC_GYRO_R_LOW_PASS_ON_6D
cparata 0:485458fca2bd 3412 * Description : Read LOW_PASS_ON_6D
cparata 0:485458fca2bd 3413 * Input : Pointer to LSM6DSL_ACC_GYRO_LOW_PASS_ON_6D_t
cparata 0:485458fca2bd 3414 * Output : Status of LOW_PASS_ON_6D see LSM6DSL_ACC_GYRO_LOW_PASS_ON_6D_t
cparata 0:485458fca2bd 3415 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3416 *******************************************************************************/
cparata 0:485458fca2bd 3417 status_t LSM6DSL_ACC_GYRO_R_LOW_PASS_ON_6D(void *handle, LSM6DSL_ACC_GYRO_LOW_PASS_ON_6D_t *value)
cparata 0:485458fca2bd 3418 {
cparata 0:485458fca2bd 3419 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, (u8_t *)value, 1) )
cparata 0:485458fca2bd 3420 return MEMS_ERROR;
cparata 0:485458fca2bd 3421
cparata 0:485458fca2bd 3422 *value &= LSM6DSL_ACC_GYRO_LOW_PASS_ON_6D_MASK; //mask
cparata 0:485458fca2bd 3423
cparata 0:485458fca2bd 3424 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3425 }
cparata 0:485458fca2bd 3426
cparata 0:485458fca2bd 3427 /*******************************************************************************
cparata 0:485458fca2bd 3428 * Function Name : LSM6DSL_ACC_GYRO_W_HP_SLOPE_XL
cparata 0:485458fca2bd 3429 * Description : Write HP_SLOPE_XL_EN
cparata 0:485458fca2bd 3430 * Input : LSM6DSL_ACC_GYRO_HP_SLOPE_XL_t
cparata 0:485458fca2bd 3431 * Output : None
cparata 0:485458fca2bd 3432 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3433 *******************************************************************************/
cparata 0:485458fca2bd 3434 status_t LSM6DSL_ACC_GYRO_W_HP_SLOPE_XL(void *handle, LSM6DSL_ACC_GYRO_HP_SLOPE_XL_t newValue)
cparata 0:485458fca2bd 3435 {
cparata 0:485458fca2bd 3436 u8_t value;
cparata 0:485458fca2bd 3437
cparata 0:485458fca2bd 3438 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:485458fca2bd 3439 return MEMS_ERROR;
cparata 0:485458fca2bd 3440
cparata 0:485458fca2bd 3441 value &= ~LSM6DSL_ACC_GYRO_HP_SLOPE_XL_MASK;
cparata 0:485458fca2bd 3442 value |= newValue;
cparata 0:485458fca2bd 3443
cparata 0:485458fca2bd 3444 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:485458fca2bd 3445 return MEMS_ERROR;
cparata 0:485458fca2bd 3446
cparata 0:485458fca2bd 3447 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3448 }
cparata 0:485458fca2bd 3449
cparata 0:485458fca2bd 3450 /*******************************************************************************
cparata 0:485458fca2bd 3451 * Function Name : LSM6DSL_ACC_GYRO_R_HP_SLOPE_XL
cparata 0:485458fca2bd 3452 * Description : Read HP_SLOPE_XL_EN
cparata 0:485458fca2bd 3453 * Input : Pointer to LSM6DSL_ACC_GYRO_HP_SLOPE_XL_t
cparata 0:485458fca2bd 3454 * Output : Status of HP_SLOPE_XL_EN see LSM6DSL_ACC_GYRO_HP_SLOPE_XL_t
cparata 0:485458fca2bd 3455 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3456 *******************************************************************************/
cparata 0:485458fca2bd 3457 status_t LSM6DSL_ACC_GYRO_R_HP_SLOPE_XL(void *handle, LSM6DSL_ACC_GYRO_HP_SLOPE_XL_t *value)
cparata 0:485458fca2bd 3458 {
cparata 0:485458fca2bd 3459 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, (u8_t *)value, 1) )
cparata 0:485458fca2bd 3460 return MEMS_ERROR;
cparata 0:485458fca2bd 3461
cparata 0:485458fca2bd 3462 *value &= LSM6DSL_ACC_GYRO_HP_SLOPE_XL_MASK; //mask
cparata 0:485458fca2bd 3463
cparata 0:485458fca2bd 3464 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3465 }
cparata 0:485458fca2bd 3466
cparata 0:485458fca2bd 3467 /*******************************************************************************
cparata 0:485458fca2bd 3468 * Function Name : LSM6DSL_ACC_GYRO_W_SOFT
cparata 0:485458fca2bd 3469 * Description : Write SOFT_EN
cparata 0:485458fca2bd 3470 * Input : LSM6DSL_ACC_GYRO_SOFT_t
cparata 0:485458fca2bd 3471 * Output : None
cparata 0:485458fca2bd 3472 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3473 *******************************************************************************/
cparata 0:485458fca2bd 3474 status_t LSM6DSL_ACC_GYRO_W_SOFT(void *handle, LSM6DSL_ACC_GYRO_SOFT_t newValue)
cparata 0:485458fca2bd 3475 {
cparata 0:485458fca2bd 3476 u8_t value;
cparata 0:485458fca2bd 3477
cparata 0:485458fca2bd 3478 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL9_XL, &value, 1) )
cparata 0:485458fca2bd 3479 return MEMS_ERROR;
cparata 0:485458fca2bd 3480
cparata 0:485458fca2bd 3481 value &= ~LSM6DSL_ACC_GYRO_SOFT_MASK;
cparata 0:485458fca2bd 3482 value |= newValue;
cparata 0:485458fca2bd 3483
cparata 0:485458fca2bd 3484 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL9_XL, &value, 1) )
cparata 0:485458fca2bd 3485 return MEMS_ERROR;
cparata 0:485458fca2bd 3486
cparata 0:485458fca2bd 3487 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3488 }
cparata 0:485458fca2bd 3489
cparata 0:485458fca2bd 3490 /*******************************************************************************
cparata 0:485458fca2bd 3491 * Function Name : LSM6DSL_ACC_GYRO_R_SOFT
cparata 0:485458fca2bd 3492 * Description : Read SOFT_EN
cparata 0:485458fca2bd 3493 * Input : Pointer to LSM6DSL_ACC_GYRO_SOFT_t
cparata 0:485458fca2bd 3494 * Output : Status of SOFT_EN see LSM6DSL_ACC_GYRO_SOFT_t
cparata 0:485458fca2bd 3495 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3496 *******************************************************************************/
cparata 0:485458fca2bd 3497 status_t LSM6DSL_ACC_GYRO_R_SOFT(void *handle, LSM6DSL_ACC_GYRO_SOFT_t *value)
cparata 0:485458fca2bd 3498 {
cparata 0:485458fca2bd 3499 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL9_XL, (u8_t *)value, 1) )
cparata 0:485458fca2bd 3500 return MEMS_ERROR;
cparata 0:485458fca2bd 3501
cparata 0:485458fca2bd 3502 *value &= LSM6DSL_ACC_GYRO_SOFT_MASK; //mask
cparata 0:485458fca2bd 3503
cparata 0:485458fca2bd 3504 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3505 }
cparata 0:485458fca2bd 3506
cparata 0:485458fca2bd 3507 /*******************************************************************************
cparata 0:485458fca2bd 3508 * Function Name : LSM6DSL_ACC_GYRO_W_SignifcantMotion
cparata 0:485458fca2bd 3509 * Description : Write SIGN_MOTION_EN
cparata 0:485458fca2bd 3510 * Input : LSM6DSL_ACC_GYRO_SIGN_MOTION_EN_t
cparata 0:485458fca2bd 3511 * Output : None
cparata 0:485458fca2bd 3512 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3513 *******************************************************************************/
cparata 0:485458fca2bd 3514 status_t LSM6DSL_ACC_GYRO_W_SignifcantMotion(void *handle, LSM6DSL_ACC_GYRO_SIGN_MOTION_EN_t newValue)
cparata 0:485458fca2bd 3515 {
cparata 0:485458fca2bd 3516 u8_t value;
cparata 0:485458fca2bd 3517
cparata 0:485458fca2bd 3518 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:485458fca2bd 3519 return MEMS_ERROR;
cparata 0:485458fca2bd 3520
cparata 0:485458fca2bd 3521 value &= ~LSM6DSL_ACC_GYRO_SIGN_MOTION_EN_MASK;
cparata 0:485458fca2bd 3522 value |= newValue;
cparata 0:485458fca2bd 3523
cparata 0:485458fca2bd 3524 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:485458fca2bd 3525 return MEMS_ERROR;
cparata 0:485458fca2bd 3526
cparata 0:485458fca2bd 3527 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3528 }
cparata 0:485458fca2bd 3529
cparata 0:485458fca2bd 3530 /*******************************************************************************
cparata 0:485458fca2bd 3531 * Function Name : LSM6DSL_ACC_GYRO_R_SignifcantMotion
cparata 0:485458fca2bd 3532 * Description : Read SIGN_MOTION_EN
cparata 0:485458fca2bd 3533 * Input : Pointer to LSM6DSL_ACC_GYRO_SIGN_MOTION_EN_t
cparata 0:485458fca2bd 3534 * Output : Status of SIGN_MOTION_EN see LSM6DSL_ACC_GYRO_SIGN_MOTION_EN_t
cparata 0:485458fca2bd 3535 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3536 *******************************************************************************/
cparata 0:485458fca2bd 3537 status_t LSM6DSL_ACC_GYRO_R_SignifcantMotion(void *handle, LSM6DSL_ACC_GYRO_SIGN_MOTION_EN_t *value)
cparata 0:485458fca2bd 3538 {
cparata 0:485458fca2bd 3539 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, (u8_t *)value, 1) )
cparata 0:485458fca2bd 3540 return MEMS_ERROR;
cparata 0:485458fca2bd 3541
cparata 0:485458fca2bd 3542 *value &= LSM6DSL_ACC_GYRO_SIGN_MOTION_EN_MASK; //mask
cparata 0:485458fca2bd 3543
cparata 0:485458fca2bd 3544 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3545 }
cparata 0:485458fca2bd 3546 /*******************************************************************************
cparata 0:485458fca2bd 3547 * Function Name : LSM6DSL_ACC_GYRO_W_PedoStepReset
cparata 0:485458fca2bd 3548 * Description : Write PEDO_RST_STEP
cparata 0:485458fca2bd 3549 * Input : LSM6DSL_ACC_GYRO_PEDO_RST_STEP_t
cparata 0:485458fca2bd 3550 * Output : None
cparata 0:485458fca2bd 3551 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3552 *******************************************************************************/
cparata 0:485458fca2bd 3553 status_t LSM6DSL_ACC_GYRO_W_PedoStepReset(void *handle, LSM6DSL_ACC_GYRO_PEDO_RST_STEP_t newValue)
cparata 0:485458fca2bd 3554 {
cparata 0:485458fca2bd 3555 u8_t value;
cparata 0:485458fca2bd 3556
cparata 0:485458fca2bd 3557 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:485458fca2bd 3558 return MEMS_ERROR;
cparata 0:485458fca2bd 3559
cparata 0:485458fca2bd 3560 value &= ~LSM6DSL_ACC_GYRO_PEDO_RST_STEP_MASK;
cparata 0:485458fca2bd 3561 value |= newValue;
cparata 0:485458fca2bd 3562
cparata 0:485458fca2bd 3563 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:485458fca2bd 3564 return MEMS_ERROR;
cparata 0:485458fca2bd 3565
cparata 0:485458fca2bd 3566 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3567 }
cparata 0:485458fca2bd 3568
cparata 0:485458fca2bd 3569 /*******************************************************************************
cparata 0:485458fca2bd 3570 * Function Name : LSM6DSL_ACC_GYRO_R_PedoStepReset
cparata 0:485458fca2bd 3571 * Description : Read PEDO_RST_STEP
cparata 0:485458fca2bd 3572 * Input : Pointer to LSM6DSL_ACC_GYRO_PEDO_RST_STEP_t
cparata 0:485458fca2bd 3573 * Output : Status of PEDO_RST_STEP see LSM6DSL_ACC_GYRO_PEDO_RST_STEP_t
cparata 0:485458fca2bd 3574 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3575 *******************************************************************************/
cparata 0:485458fca2bd 3576 status_t LSM6DSL_ACC_GYRO_R_PedoStepReset(void *handle, LSM6DSL_ACC_GYRO_PEDO_RST_STEP_t *value)
cparata 0:485458fca2bd 3577 {
cparata 0:485458fca2bd 3578 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, (u8_t *)value, 1) )
cparata 0:485458fca2bd 3579 return MEMS_ERROR;
cparata 0:485458fca2bd 3580
cparata 0:485458fca2bd 3581 *value &= LSM6DSL_ACC_GYRO_PEDO_RST_STEP_MASK; //mask
cparata 0:485458fca2bd 3582
cparata 0:485458fca2bd 3583 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3584 }
cparata 0:485458fca2bd 3585 /*******************************************************************************
cparata 0:485458fca2bd 3586 * Function Name : LSM6DSL_ACC_GYRO_W_TILT
cparata 0:485458fca2bd 3587 * Description : Write XEN_G
cparata 0:485458fca2bd 3588 * Input : LSM6DSL_ACC_GYRO_TILT_G_t
cparata 0:485458fca2bd 3589 * Output : None
cparata 0:485458fca2bd 3590 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3591 *******************************************************************************/
cparata 0:485458fca2bd 3592 status_t LSM6DSL_ACC_GYRO_W_TILT(void *handle, LSM6DSL_ACC_GYRO_TILT_G_t newValue)
cparata 0:485458fca2bd 3593 {
cparata 0:485458fca2bd 3594 u8_t value;
cparata 0:485458fca2bd 3595
cparata 0:485458fca2bd 3596 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:485458fca2bd 3597 return MEMS_ERROR;
cparata 0:485458fca2bd 3598
cparata 0:485458fca2bd 3599 value &= ~LSM6DSL_ACC_GYRO_TILT_MASK;
cparata 0:485458fca2bd 3600 value |= newValue;
cparata 0:485458fca2bd 3601
cparata 0:485458fca2bd 3602 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:485458fca2bd 3603 return MEMS_ERROR;
cparata 0:485458fca2bd 3604
cparata 0:485458fca2bd 3605 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3606 }
cparata 0:485458fca2bd 3607
cparata 0:485458fca2bd 3608 /*******************************************************************************
cparata 0:485458fca2bd 3609 * Function Name : LSM6DSL_ACC_GYRO_R_TILT
cparata 0:485458fca2bd 3610 * Description : Read XEN_G
cparata 0:485458fca2bd 3611 * Input : Pointer to LSM6DSL_ACC_GYRO_TILT_G_t
cparata 0:485458fca2bd 3612 * Output : Status of XEN_G see LSM6DSL_ACC_GYRO_TILT_G_t
cparata 0:485458fca2bd 3613 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3614 *******************************************************************************/
cparata 0:485458fca2bd 3615 status_t LSM6DSL_ACC_GYRO_R_TILT(void *handle, LSM6DSL_ACC_GYRO_TILT_G_t *value)
cparata 0:485458fca2bd 3616 {
cparata 0:485458fca2bd 3617 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, (u8_t *)value, 1) )
cparata 0:485458fca2bd 3618 return MEMS_ERROR;
cparata 0:485458fca2bd 3619
cparata 0:485458fca2bd 3620 *value &= LSM6DSL_ACC_GYRO_TILT_MASK; //mask
cparata 0:485458fca2bd 3621
cparata 0:485458fca2bd 3622 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3623 }
cparata 0:485458fca2bd 3624 /*******************************************************************************
cparata 0:485458fca2bd 3625 * Function Name : LSM6DSL_ACC_GYRO_W_PEDO
cparata 0:485458fca2bd 3626 * Description : Write PEDO_EN
cparata 0:485458fca2bd 3627 * Input : LSM6DSL_ACC_GYRO_PEDO_t
cparata 0:485458fca2bd 3628 * Output : None
cparata 0:485458fca2bd 3629 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3630 *******************************************************************************/
cparata 0:485458fca2bd 3631 status_t LSM6DSL_ACC_GYRO_W_PEDO(void *handle, LSM6DSL_ACC_GYRO_PEDO_t newValue)
cparata 0:485458fca2bd 3632 {
cparata 0:485458fca2bd 3633 u8_t value;
cparata 0:485458fca2bd 3634
cparata 0:485458fca2bd 3635 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:485458fca2bd 3636 return MEMS_ERROR;
cparata 0:485458fca2bd 3637
cparata 0:485458fca2bd 3638 value &= ~LSM6DSL_ACC_GYRO_PEDO_MASK;
cparata 0:485458fca2bd 3639 value |= newValue;
cparata 0:485458fca2bd 3640
cparata 0:485458fca2bd 3641 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:485458fca2bd 3642 return MEMS_ERROR;
cparata 0:485458fca2bd 3643
cparata 0:485458fca2bd 3644 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3645 }
cparata 0:485458fca2bd 3646
cparata 0:485458fca2bd 3647 /*******************************************************************************
cparata 0:485458fca2bd 3648 * Function Name : LSM6DSL_ACC_GYRO_R_PEDO
cparata 0:485458fca2bd 3649 * Description : Read PEDO_EN
cparata 0:485458fca2bd 3650 * Input : Pointer to LSM6DSL_ACC_GYRO_PEDO_t
cparata 0:485458fca2bd 3651 * Output : Status of PEDO_EN see LSM6DSL_ACC_GYRO_PEDO_t
cparata 0:485458fca2bd 3652 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3653 *******************************************************************************/
cparata 0:485458fca2bd 3654 status_t LSM6DSL_ACC_GYRO_R_PEDO(void *handle, LSM6DSL_ACC_GYRO_PEDO_t *value)
cparata 0:485458fca2bd 3655 {
cparata 0:485458fca2bd 3656 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, (u8_t *)value, 1) )
cparata 0:485458fca2bd 3657 return MEMS_ERROR;
cparata 0:485458fca2bd 3658
cparata 0:485458fca2bd 3659 *value &= LSM6DSL_ACC_GYRO_PEDO_MASK; //mask
cparata 0:485458fca2bd 3660
cparata 0:485458fca2bd 3661 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3662 }
cparata 0:485458fca2bd 3663
cparata 0:485458fca2bd 3664 /*******************************************************************************
cparata 0:485458fca2bd 3665 * Function Name : LSM6DSL_ACC_GYRO_W_TIMER
cparata 0:485458fca2bd 3666 * Description : Write TIMER_EN
cparata 0:485458fca2bd 3667 * Input : LSM6DSL_ACC_GYRO_TIMER_t
cparata 0:485458fca2bd 3668 * Output : None
cparata 0:485458fca2bd 3669 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3670 *******************************************************************************/
cparata 0:485458fca2bd 3671 status_t LSM6DSL_ACC_GYRO_W_TIMER(void *handle, LSM6DSL_ACC_GYRO_TIMER_t newValue)
cparata 0:485458fca2bd 3672 {
cparata 0:485458fca2bd 3673 u8_t value;
cparata 0:485458fca2bd 3674
cparata 0:485458fca2bd 3675 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:485458fca2bd 3676 return MEMS_ERROR;
cparata 0:485458fca2bd 3677
cparata 0:485458fca2bd 3678 value &= ~LSM6DSL_ACC_GYRO_TIMER_MASK;
cparata 0:485458fca2bd 3679 value |= newValue;
cparata 0:485458fca2bd 3680
cparata 0:485458fca2bd 3681 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:485458fca2bd 3682 return MEMS_ERROR;
cparata 0:485458fca2bd 3683
cparata 0:485458fca2bd 3684 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3685 }
cparata 0:485458fca2bd 3686
cparata 0:485458fca2bd 3687 /*******************************************************************************
cparata 0:485458fca2bd 3688 * Function Name : LSM6DSL_ACC_GYRO_R_TIMER
cparata 0:485458fca2bd 3689 * Description : Read TIMER_EN
cparata 0:485458fca2bd 3690 * Input : Pointer to LSM6DSL_ACC_GYRO_TIMER_t
cparata 0:485458fca2bd 3691 * Output : Status of TIMER_EN see LSM6DSL_ACC_GYRO_TIMER_t
cparata 0:485458fca2bd 3692 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3693 *******************************************************************************/
cparata 0:485458fca2bd 3694 status_t LSM6DSL_ACC_GYRO_R_TIMER(void *handle, LSM6DSL_ACC_GYRO_TIMER_t *value)
cparata 0:485458fca2bd 3695 {
cparata 0:485458fca2bd 3696 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, (u8_t *)value, 1) )
cparata 0:485458fca2bd 3697 return MEMS_ERROR;
cparata 0:485458fca2bd 3698
cparata 0:485458fca2bd 3699 *value &= LSM6DSL_ACC_GYRO_TIMER_MASK; //mask
cparata 0:485458fca2bd 3700
cparata 0:485458fca2bd 3701 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3702 }
cparata 0:485458fca2bd 3703
cparata 0:485458fca2bd 3704 /*******************************************************************************
cparata 0:485458fca2bd 3705 * Function Name : LSM6DSL_ACC_GYRO_W_FUNC_EN
cparata 0:485458fca2bd 3706 * Description : Write FUNC_EN
cparata 0:485458fca2bd 3707 * Input : LSM6DSL_ACC_GYRO_FUNC_EN_t
cparata 0:485458fca2bd 3708 * Output : None
cparata 0:485458fca2bd 3709 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3710 *******************************************************************************/
cparata 0:485458fca2bd 3711 status_t LSM6DSL_ACC_GYRO_W_FUNC_EN(void *handle, LSM6DSL_ACC_GYRO_FUNC_EN_t newValue)
cparata 0:485458fca2bd 3712 {
cparata 0:485458fca2bd 3713 u8_t value;
cparata 0:485458fca2bd 3714
cparata 0:485458fca2bd 3715 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:485458fca2bd 3716 return MEMS_ERROR;
cparata 0:485458fca2bd 3717
cparata 0:485458fca2bd 3718 value &= ~LSM6DSL_ACC_GYRO_FUNC_EN_MASK;
cparata 0:485458fca2bd 3719 value |= newValue;
cparata 0:485458fca2bd 3720
cparata 0:485458fca2bd 3721 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:485458fca2bd 3722 return MEMS_ERROR;
cparata 0:485458fca2bd 3723
cparata 0:485458fca2bd 3724 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3725 }
cparata 0:485458fca2bd 3726
cparata 0:485458fca2bd 3727 /*******************************************************************************
cparata 0:485458fca2bd 3728 * Function Name : LSM6DSL_ACC_GYRO_R_FUNC_EN
cparata 0:485458fca2bd 3729 * Description : Read FUNC_EN
cparata 0:485458fca2bd 3730 * Input : Pointer to LSM6DSL_ACC_GYRO_FUNC_EN_t
cparata 0:485458fca2bd 3731 * Output : Status of FUNC_EN see LSM6DSL_ACC_GYRO_FUNC_EN_t
cparata 0:485458fca2bd 3732 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3733 *******************************************************************************/
cparata 0:485458fca2bd 3734 status_t LSM6DSL_ACC_GYRO_R_FUNC_EN(void *handle, LSM6DSL_ACC_GYRO_FUNC_EN_t *value)
cparata 0:485458fca2bd 3735 {
cparata 0:485458fca2bd 3736 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, (u8_t *)value, 1) )
cparata 0:485458fca2bd 3737 return MEMS_ERROR;
cparata 0:485458fca2bd 3738
cparata 0:485458fca2bd 3739 *value &= LSM6DSL_ACC_GYRO_FUNC_EN_MASK; //mask
cparata 0:485458fca2bd 3740
cparata 0:485458fca2bd 3741 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3742 }
cparata 0:485458fca2bd 3743
cparata 0:485458fca2bd 3744 /*******************************************************************************
cparata 0:485458fca2bd 3745 * Function Name : LSM6DSL_ACC_GYRO_W_I2C_MASTER_Enable
cparata 0:485458fca2bd 3746 * Description : Write MASTER_ON
cparata 0:485458fca2bd 3747 * Input : LSM6DSL_ACC_GYRO_MASTER_ON_t
cparata 0:485458fca2bd 3748 * Output : None
cparata 0:485458fca2bd 3749 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3750 *******************************************************************************/
cparata 0:485458fca2bd 3751 status_t LSM6DSL_ACC_GYRO_W_I2C_MASTER_Enable(void *handle, LSM6DSL_ACC_GYRO_MASTER_ON_t newValue)
cparata 0:485458fca2bd 3752 {
cparata 0:485458fca2bd 3753 u8_t value;
cparata 0:485458fca2bd 3754
cparata 0:485458fca2bd 3755 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:485458fca2bd 3756 return MEMS_ERROR;
cparata 0:485458fca2bd 3757
cparata 0:485458fca2bd 3758 value &= ~LSM6DSL_ACC_GYRO_MASTER_ON_MASK;
cparata 0:485458fca2bd 3759 value |= newValue;
cparata 0:485458fca2bd 3760
cparata 0:485458fca2bd 3761 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:485458fca2bd 3762 return MEMS_ERROR;
cparata 0:485458fca2bd 3763
cparata 0:485458fca2bd 3764 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3765 }
cparata 0:485458fca2bd 3766
cparata 0:485458fca2bd 3767 /*******************************************************************************
cparata 0:485458fca2bd 3768 * Function Name : LSM6DSL_ACC_GYRO_R_I2C_MASTER_Enable
cparata 0:485458fca2bd 3769 * Description : Read MASTER_ON
cparata 0:485458fca2bd 3770 * Input : Pointer to LSM6DSL_ACC_GYRO_MASTER_ON_t
cparata 0:485458fca2bd 3771 * Output : Status of MASTER_ON see LSM6DSL_ACC_GYRO_MASTER_ON_t
cparata 0:485458fca2bd 3772 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3773 *******************************************************************************/
cparata 0:485458fca2bd 3774 status_t LSM6DSL_ACC_GYRO_R_I2C_MASTER_Enable(void *handle, LSM6DSL_ACC_GYRO_MASTER_ON_t *value)
cparata 0:485458fca2bd 3775 {
cparata 0:485458fca2bd 3776 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, (u8_t *)value, 1) )
cparata 0:485458fca2bd 3777 return MEMS_ERROR;
cparata 0:485458fca2bd 3778
cparata 0:485458fca2bd 3779 *value &= LSM6DSL_ACC_GYRO_MASTER_ON_MASK; //mask
cparata 0:485458fca2bd 3780
cparata 0:485458fca2bd 3781 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3782 }
cparata 0:485458fca2bd 3783
cparata 0:485458fca2bd 3784 /*******************************************************************************
cparata 0:485458fca2bd 3785 * Function Name : LSM6DSL_ACC_GYRO_W_IronCorrection_EN
cparata 0:485458fca2bd 3786 * Description : Write IRON_EN
cparata 0:485458fca2bd 3787 * Input : LSM6DSL_ACC_GYRO_IRON_EN_t
cparata 0:485458fca2bd 3788 * Output : None
cparata 0:485458fca2bd 3789 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3790 *******************************************************************************/
cparata 0:485458fca2bd 3791 status_t LSM6DSL_ACC_GYRO_W_IronCorrection_EN(void *handle, LSM6DSL_ACC_GYRO_IRON_EN_t newValue)
cparata 0:485458fca2bd 3792 {
cparata 0:485458fca2bd 3793 u8_t value;
cparata 0:485458fca2bd 3794
cparata 0:485458fca2bd 3795 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:485458fca2bd 3796 return MEMS_ERROR;
cparata 0:485458fca2bd 3797
cparata 0:485458fca2bd 3798 value &= ~LSM6DSL_ACC_GYRO_IRON_EN_MASK;
cparata 0:485458fca2bd 3799 value |= newValue;
cparata 0:485458fca2bd 3800
cparata 0:485458fca2bd 3801 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:485458fca2bd 3802 return MEMS_ERROR;
cparata 0:485458fca2bd 3803
cparata 0:485458fca2bd 3804 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3805 }
cparata 0:485458fca2bd 3806
cparata 0:485458fca2bd 3807 /*******************************************************************************
cparata 0:485458fca2bd 3808 * Function Name : LSM6DSL_ACC_GYRO_R_IronCorrection_EN
cparata 0:485458fca2bd 3809 * Description : Read IRON_EN
cparata 0:485458fca2bd 3810 * Input : Pointer to LSM6DSL_ACC_GYRO_IRON_EN_t
cparata 0:485458fca2bd 3811 * Output : Status of IRON_EN see LSM6DSL_ACC_GYRO_IRON_EN_t
cparata 0:485458fca2bd 3812 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3813 *******************************************************************************/
cparata 0:485458fca2bd 3814 status_t LSM6DSL_ACC_GYRO_R_IronCorrection_EN(void *handle, LSM6DSL_ACC_GYRO_IRON_EN_t *value)
cparata 0:485458fca2bd 3815 {
cparata 0:485458fca2bd 3816 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, (u8_t *)value, 1) )
cparata 0:485458fca2bd 3817 return MEMS_ERROR;
cparata 0:485458fca2bd 3818
cparata 0:485458fca2bd 3819 *value &= LSM6DSL_ACC_GYRO_IRON_EN_MASK; //mask
cparata 0:485458fca2bd 3820
cparata 0:485458fca2bd 3821 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3822 }
cparata 0:485458fca2bd 3823
cparata 0:485458fca2bd 3824 /*******************************************************************************
cparata 0:485458fca2bd 3825 * Function Name : LSM6DSL_ACC_GYRO_W_PASS_THRU_MODE
cparata 0:485458fca2bd 3826 * Description : Write PASS_THRU_MODE
cparata 0:485458fca2bd 3827 * Input : LSM6DSL_ACC_GYRO_PASS_THRU_MODE_t
cparata 0:485458fca2bd 3828 * Output : None
cparata 0:485458fca2bd 3829 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3830 *******************************************************************************/
cparata 0:485458fca2bd 3831 status_t LSM6DSL_ACC_GYRO_W_PASS_THRU_MODE(void *handle, LSM6DSL_ACC_GYRO_PASS_THRU_MODE_t newValue)
cparata 0:485458fca2bd 3832 {
cparata 0:485458fca2bd 3833 u8_t value;
cparata 0:485458fca2bd 3834
cparata 0:485458fca2bd 3835 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:485458fca2bd 3836 return MEMS_ERROR;
cparata 0:485458fca2bd 3837
cparata 0:485458fca2bd 3838 value &= ~LSM6DSL_ACC_GYRO_PASS_THRU_MODE_MASK;
cparata 0:485458fca2bd 3839 value |= newValue;
cparata 0:485458fca2bd 3840
cparata 0:485458fca2bd 3841 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:485458fca2bd 3842 return MEMS_ERROR;
cparata 0:485458fca2bd 3843
cparata 0:485458fca2bd 3844 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3845 }
cparata 0:485458fca2bd 3846
cparata 0:485458fca2bd 3847 /*******************************************************************************
cparata 0:485458fca2bd 3848 * Function Name : LSM6DSL_ACC_GYRO_R_PASS_THRU_MODE
cparata 0:485458fca2bd 3849 * Description : Read PASS_THRU_MODE
cparata 0:485458fca2bd 3850 * Input : Pointer to LSM6DSL_ACC_GYRO_PASS_THRU_MODE_t
cparata 0:485458fca2bd 3851 * Output : Status of PASS_THRU_MODE see LSM6DSL_ACC_GYRO_PASS_THRU_MODE_t
cparata 0:485458fca2bd 3852 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3853 *******************************************************************************/
cparata 0:485458fca2bd 3854 status_t LSM6DSL_ACC_GYRO_R_PASS_THRU_MODE(void *handle, LSM6DSL_ACC_GYRO_PASS_THRU_MODE_t *value)
cparata 0:485458fca2bd 3855 {
cparata 0:485458fca2bd 3856 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, (u8_t *)value, 1) )
cparata 0:485458fca2bd 3857 return MEMS_ERROR;
cparata 0:485458fca2bd 3858
cparata 0:485458fca2bd 3859 *value &= LSM6DSL_ACC_GYRO_PASS_THRU_MODE_MASK; //mask
cparata 0:485458fca2bd 3860
cparata 0:485458fca2bd 3861 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3862 }
cparata 0:485458fca2bd 3863
cparata 0:485458fca2bd 3864 /*******************************************************************************
cparata 0:485458fca2bd 3865 * Function Name : LSM6DSL_ACC_GYRO_W_PULL_UP_EN
cparata 0:485458fca2bd 3866 * Description : Write PULL_UP_EN
cparata 0:485458fca2bd 3867 * Input : LSM6DSL_ACC_GYRO_PULL_UP_EN_t
cparata 0:485458fca2bd 3868 * Output : None
cparata 0:485458fca2bd 3869 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3870 *******************************************************************************/
cparata 0:485458fca2bd 3871 status_t LSM6DSL_ACC_GYRO_W_PULL_UP_EN(void *handle, LSM6DSL_ACC_GYRO_PULL_UP_EN_t newValue)
cparata 0:485458fca2bd 3872 {
cparata 0:485458fca2bd 3873 u8_t value;
cparata 0:485458fca2bd 3874
cparata 0:485458fca2bd 3875 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:485458fca2bd 3876 return MEMS_ERROR;
cparata 0:485458fca2bd 3877
cparata 0:485458fca2bd 3878 value &= ~LSM6DSL_ACC_GYRO_PULL_UP_EN_MASK;
cparata 0:485458fca2bd 3879 value |= newValue;
cparata 0:485458fca2bd 3880
cparata 0:485458fca2bd 3881 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:485458fca2bd 3882 return MEMS_ERROR;
cparata 0:485458fca2bd 3883
cparata 0:485458fca2bd 3884 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3885 }
cparata 0:485458fca2bd 3886
cparata 0:485458fca2bd 3887 /*******************************************************************************
cparata 0:485458fca2bd 3888 * Function Name : LSM6DSL_ACC_GYRO_R_PULL_UP_EN
cparata 0:485458fca2bd 3889 * Description : Read PULL_UP_EN
cparata 0:485458fca2bd 3890 * Input : Pointer to LSM6DSL_ACC_GYRO_PULL_UP_EN_t
cparata 0:485458fca2bd 3891 * Output : Status of PULL_UP_EN see LSM6DSL_ACC_GYRO_PULL_UP_EN_t
cparata 0:485458fca2bd 3892 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3893 *******************************************************************************/
cparata 0:485458fca2bd 3894 status_t LSM6DSL_ACC_GYRO_R_PULL_UP_EN(void *handle, LSM6DSL_ACC_GYRO_PULL_UP_EN_t *value)
cparata 0:485458fca2bd 3895 {
cparata 0:485458fca2bd 3896 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, (u8_t *)value, 1) )
cparata 0:485458fca2bd 3897 return MEMS_ERROR;
cparata 0:485458fca2bd 3898
cparata 0:485458fca2bd 3899 *value &= LSM6DSL_ACC_GYRO_PULL_UP_EN_MASK; //mask
cparata 0:485458fca2bd 3900
cparata 0:485458fca2bd 3901 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3902 }
cparata 0:485458fca2bd 3903
cparata 0:485458fca2bd 3904 /*******************************************************************************
cparata 0:485458fca2bd 3905 * Function Name : LSM6DSL_ACC_GYRO_W_SensorHUB_Trigger_Sel
cparata 0:485458fca2bd 3906 * Description : Write START_CONFIG
cparata 0:485458fca2bd 3907 * Input : LSM6DSL_ACC_GYRO_START_CONFIG_t
cparata 0:485458fca2bd 3908 * Output : None
cparata 0:485458fca2bd 3909 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3910 *******************************************************************************/
cparata 0:485458fca2bd 3911 status_t LSM6DSL_ACC_GYRO_W_SensorHUB_Trigger_Sel(void *handle, LSM6DSL_ACC_GYRO_START_CONFIG_t newValue)
cparata 0:485458fca2bd 3912 {
cparata 0:485458fca2bd 3913 u8_t value;
cparata 0:485458fca2bd 3914
cparata 0:485458fca2bd 3915 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:485458fca2bd 3916 return MEMS_ERROR;
cparata 0:485458fca2bd 3917
cparata 0:485458fca2bd 3918 value &= ~LSM6DSL_ACC_GYRO_START_CONFIG_MASK;
cparata 0:485458fca2bd 3919 value |= newValue;
cparata 0:485458fca2bd 3920
cparata 0:485458fca2bd 3921 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:485458fca2bd 3922 return MEMS_ERROR;
cparata 0:485458fca2bd 3923
cparata 0:485458fca2bd 3924 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3925 }
cparata 0:485458fca2bd 3926
cparata 0:485458fca2bd 3927 /*******************************************************************************
cparata 0:485458fca2bd 3928 * Function Name : LSM6DSL_ACC_GYRO_R_SensorHUB_Trigger_Sel
cparata 0:485458fca2bd 3929 * Description : Read START_CONFIG
cparata 0:485458fca2bd 3930 * Input : Pointer to LSM6DSL_ACC_GYRO_START_CONFIG_t
cparata 0:485458fca2bd 3931 * Output : Status of START_CONFIG see LSM6DSL_ACC_GYRO_START_CONFIG_t
cparata 0:485458fca2bd 3932 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3933 *******************************************************************************/
cparata 0:485458fca2bd 3934 status_t LSM6DSL_ACC_GYRO_R_SensorHUB_Trigger_Sel(void *handle, LSM6DSL_ACC_GYRO_START_CONFIG_t *value)
cparata 0:485458fca2bd 3935 {
cparata 0:485458fca2bd 3936 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, (u8_t *)value, 1) )
cparata 0:485458fca2bd 3937 return MEMS_ERROR;
cparata 0:485458fca2bd 3938
cparata 0:485458fca2bd 3939 *value &= LSM6DSL_ACC_GYRO_START_CONFIG_MASK; //mask
cparata 0:485458fca2bd 3940
cparata 0:485458fca2bd 3941 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3942 }
cparata 0:485458fca2bd 3943
cparata 0:485458fca2bd 3944 /*******************************************************************************
cparata 0:485458fca2bd 3945 * Function Name : LSM6DSL_ACC_GYRO_W_DATA_VAL_SEL_FIFO
cparata 0:485458fca2bd 3946 * Description : Write DATA_VAL_SEL_FIFO
cparata 0:485458fca2bd 3947 * Input : LSM6DSL_ACC_GYRO_DATA_VAL_SEL_FIFO_t
cparata 0:485458fca2bd 3948 * Output : None
cparata 0:485458fca2bd 3949 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3950 *******************************************************************************/
cparata 0:485458fca2bd 3951 status_t LSM6DSL_ACC_GYRO_W_DATA_VAL_SEL_FIFO(void *handle, LSM6DSL_ACC_GYRO_DATA_VAL_SEL_FIFO_t newValue)
cparata 0:485458fca2bd 3952 {
cparata 0:485458fca2bd 3953 u8_t value;
cparata 0:485458fca2bd 3954
cparata 0:485458fca2bd 3955 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:485458fca2bd 3956 return MEMS_ERROR;
cparata 0:485458fca2bd 3957
cparata 0:485458fca2bd 3958 value &= ~LSM6DSL_ACC_GYRO_DATA_VAL_SEL_FIFO_MASK;
cparata 0:485458fca2bd 3959 value |= newValue;
cparata 0:485458fca2bd 3960
cparata 0:485458fca2bd 3961 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:485458fca2bd 3962 return MEMS_ERROR;
cparata 0:485458fca2bd 3963
cparata 0:485458fca2bd 3964 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3965 }
cparata 0:485458fca2bd 3966
cparata 0:485458fca2bd 3967 /*******************************************************************************
cparata 0:485458fca2bd 3968 * Function Name : LSM6DSL_ACC_GYRO_R_DATA_VAL_SEL_FIFO
cparata 0:485458fca2bd 3969 * Description : Read DATA_VAL_SEL_FIFO
cparata 0:485458fca2bd 3970 * Input : Pointer to LSM6DSL_ACC_GYRO_DATA_VAL_SEL_FIFO_t
cparata 0:485458fca2bd 3971 * Output : Status of DATA_VAL_SEL_FIFO see LSM6DSL_ACC_GYRO_DATA_VAL_SEL_FIFO_t
cparata 0:485458fca2bd 3972 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3973 *******************************************************************************/
cparata 0:485458fca2bd 3974 status_t LSM6DSL_ACC_GYRO_R_DATA_VAL_SEL_FIFO(void *handle, LSM6DSL_ACC_GYRO_DATA_VAL_SEL_FIFO_t *value)
cparata 0:485458fca2bd 3975 {
cparata 0:485458fca2bd 3976 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, (u8_t *)value, 1) )
cparata 0:485458fca2bd 3977 return MEMS_ERROR;
cparata 0:485458fca2bd 3978
cparata 0:485458fca2bd 3979 *value &= LSM6DSL_ACC_GYRO_DATA_VAL_SEL_FIFO_MASK; //mask
cparata 0:485458fca2bd 3980
cparata 0:485458fca2bd 3981 return MEMS_SUCCESS;
cparata 0:485458fca2bd 3982 }
cparata 0:485458fca2bd 3983
cparata 0:485458fca2bd 3984 /*******************************************************************************
cparata 0:485458fca2bd 3985 * Function Name : LSM6DSL_ACC_GYRO_W_DRDY_ON_INT1
cparata 0:485458fca2bd 3986 * Description : Write DRDY_ON_INT1
cparata 0:485458fca2bd 3987 * Input : LSM6DSL_ACC_GYRO_DRDY_ON_INT1_t
cparata 0:485458fca2bd 3988 * Output : None
cparata 0:485458fca2bd 3989 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 3990 *******************************************************************************/
cparata 0:485458fca2bd 3991 status_t LSM6DSL_ACC_GYRO_W_DRDY_ON_INT1(void *handle, LSM6DSL_ACC_GYRO_DRDY_ON_INT1_t newValue)
cparata 0:485458fca2bd 3992 {
cparata 0:485458fca2bd 3993 u8_t value;
cparata 0:485458fca2bd 3994
cparata 0:485458fca2bd 3995 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:485458fca2bd 3996 return MEMS_ERROR;
cparata 0:485458fca2bd 3997
cparata 0:485458fca2bd 3998 value &= ~LSM6DSL_ACC_GYRO_DRDY_ON_INT1_MASK;
cparata 0:485458fca2bd 3999 value |= newValue;
cparata 0:485458fca2bd 4000
cparata 0:485458fca2bd 4001 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:485458fca2bd 4002 return MEMS_ERROR;
cparata 0:485458fca2bd 4003
cparata 0:485458fca2bd 4004 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4005 }
cparata 0:485458fca2bd 4006 /*******************************************************************************
cparata 0:485458fca2bd 4007 * Function Name : LSM6DSL_ACC_GYRO_R_DRDY_ON_INT1
cparata 0:485458fca2bd 4008 * Description : Read DRDY_ON_INT1
cparata 0:485458fca2bd 4009 * Input : Pointer to LSM6DSL_ACC_GYRO_DRDY_ON_INT1_t
cparata 0:485458fca2bd 4010 * Output : Status of DRDY_ON_INT1 see LSM6DSL_ACC_GYRO_DRDY_ON_INT1_t
cparata 0:485458fca2bd 4011 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4012 *******************************************************************************/
cparata 0:485458fca2bd 4013 status_t LSM6DSL_ACC_GYRO_R_DRDY_ON_INT1(void *handle, LSM6DSL_ACC_GYRO_DRDY_ON_INT1_t *value)
cparata 0:485458fca2bd 4014 {
cparata 0:485458fca2bd 4015 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4016 return MEMS_ERROR;
cparata 0:485458fca2bd 4017
cparata 0:485458fca2bd 4018 *value &= LSM6DSL_ACC_GYRO_DRDY_ON_INT1_MASK; //mask
cparata 0:485458fca2bd 4019
cparata 0:485458fca2bd 4020 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4021 }
cparata 0:485458fca2bd 4022
cparata 0:485458fca2bd 4023 /*******************************************************************************
cparata 0:485458fca2bd 4024 * Function Name : LSM6DSL_ACC_GYRO_R_Z_WU
cparata 0:485458fca2bd 4025 * Description : Read Z_WU
cparata 0:485458fca2bd 4026 * Input : Pointer to LSM6DSL_ACC_GYRO_Z_WU_t
cparata 0:485458fca2bd 4027 * Output : Status of Z_WU see LSM6DSL_ACC_GYRO_Z_WU_t
cparata 0:485458fca2bd 4028 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4029 *******************************************************************************/
cparata 0:485458fca2bd 4030 status_t LSM6DSL_ACC_GYRO_R_Z_WU(void *handle, LSM6DSL_ACC_GYRO_Z_WU_t *value)
cparata 0:485458fca2bd 4031 {
cparata 0:485458fca2bd 4032 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4033 return MEMS_ERROR;
cparata 0:485458fca2bd 4034
cparata 0:485458fca2bd 4035 *value &= LSM6DSL_ACC_GYRO_Z_WU_MASK; //mask
cparata 0:485458fca2bd 4036
cparata 0:485458fca2bd 4037 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4038 }
cparata 0:485458fca2bd 4039
cparata 0:485458fca2bd 4040 /*******************************************************************************
cparata 0:485458fca2bd 4041 * Function Name : LSM6DSL_ACC_GYRO_R_Y_WU
cparata 0:485458fca2bd 4042 * Description : Read Y_WU
cparata 0:485458fca2bd 4043 * Input : Pointer to LSM6DSL_ACC_GYRO_Y_WU_t
cparata 0:485458fca2bd 4044 * Output : Status of Y_WU see LSM6DSL_ACC_GYRO_Y_WU_t
cparata 0:485458fca2bd 4045 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4046 *******************************************************************************/
cparata 0:485458fca2bd 4047 status_t LSM6DSL_ACC_GYRO_R_Y_WU(void *handle, LSM6DSL_ACC_GYRO_Y_WU_t *value)
cparata 0:485458fca2bd 4048 {
cparata 0:485458fca2bd 4049 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4050 return MEMS_ERROR;
cparata 0:485458fca2bd 4051
cparata 0:485458fca2bd 4052 *value &= LSM6DSL_ACC_GYRO_Y_WU_MASK; //mask
cparata 0:485458fca2bd 4053
cparata 0:485458fca2bd 4054 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4055 }
cparata 0:485458fca2bd 4056
cparata 0:485458fca2bd 4057 /*******************************************************************************
cparata 0:485458fca2bd 4058 * Function Name : LSM6DSL_ACC_GYRO_R_X_WU
cparata 0:485458fca2bd 4059 * Description : Read X_WU
cparata 0:485458fca2bd 4060 * Input : Pointer to LSM6DSL_ACC_GYRO_X_WU_t
cparata 0:485458fca2bd 4061 * Output : Status of X_WU see LSM6DSL_ACC_GYRO_X_WU_t
cparata 0:485458fca2bd 4062 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4063 *******************************************************************************/
cparata 0:485458fca2bd 4064 status_t LSM6DSL_ACC_GYRO_R_X_WU(void *handle, LSM6DSL_ACC_GYRO_X_WU_t *value)
cparata 0:485458fca2bd 4065 {
cparata 0:485458fca2bd 4066 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4067 return MEMS_ERROR;
cparata 0:485458fca2bd 4068
cparata 0:485458fca2bd 4069 *value &= LSM6DSL_ACC_GYRO_X_WU_MASK; //mask
cparata 0:485458fca2bd 4070
cparata 0:485458fca2bd 4071 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4072 }
cparata 0:485458fca2bd 4073
cparata 0:485458fca2bd 4074 /*******************************************************************************
cparata 0:485458fca2bd 4075 * Function Name : LSM6DSL_ACC_GYRO_R_WU_EV_STATUS
cparata 0:485458fca2bd 4076 * Description : Read WU_EV_STATUS
cparata 0:485458fca2bd 4077 * Input : Pointer to LSM6DSL_ACC_GYRO_WU_EV_STATUS_t
cparata 0:485458fca2bd 4078 * Output : Status of WU_EV_STATUS see LSM6DSL_ACC_GYRO_WU_EV_STATUS_t
cparata 0:485458fca2bd 4079 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4080 *******************************************************************************/
cparata 0:485458fca2bd 4081 status_t LSM6DSL_ACC_GYRO_R_WU_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_WU_EV_STATUS_t *value)
cparata 0:485458fca2bd 4082 {
cparata 0:485458fca2bd 4083 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4084 return MEMS_ERROR;
cparata 0:485458fca2bd 4085
cparata 0:485458fca2bd 4086 *value &= LSM6DSL_ACC_GYRO_WU_EV_STATUS_MASK; //mask
cparata 0:485458fca2bd 4087
cparata 0:485458fca2bd 4088 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4089 }
cparata 0:485458fca2bd 4090
cparata 0:485458fca2bd 4091 /*******************************************************************************
cparata 0:485458fca2bd 4092 * Function Name : LSM6DSL_ACC_GYRO_R_SLEEP_EV_STATUS
cparata 0:485458fca2bd 4093 * Description : Read SLEEP_EV_STATUS
cparata 0:485458fca2bd 4094 * Input : Pointer to LSM6DSL_ACC_GYRO_SLEEP_EV_STATUS_t
cparata 0:485458fca2bd 4095 * Output : Status of SLEEP_EV_STATUS see LSM6DSL_ACC_GYRO_SLEEP_EV_STATUS_t
cparata 0:485458fca2bd 4096 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4097 *******************************************************************************/
cparata 0:485458fca2bd 4098 status_t LSM6DSL_ACC_GYRO_R_SLEEP_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_SLEEP_EV_STATUS_t *value)
cparata 0:485458fca2bd 4099 {
cparata 0:485458fca2bd 4100 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4101 return MEMS_ERROR;
cparata 0:485458fca2bd 4102
cparata 0:485458fca2bd 4103 *value &= LSM6DSL_ACC_GYRO_SLEEP_EV_STATUS_MASK; //mask
cparata 0:485458fca2bd 4104
cparata 0:485458fca2bd 4105 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4106 }
cparata 0:485458fca2bd 4107
cparata 0:485458fca2bd 4108 /*******************************************************************************
cparata 0:485458fca2bd 4109 * Function Name : LSM6DSL_ACC_GYRO_R_FF_EV_STATUS
cparata 0:485458fca2bd 4110 * Description : Read FF_EV_STATUS
cparata 0:485458fca2bd 4111 * Input : Pointer to LSM6DSL_ACC_GYRO_FF_EV_STATUS_t
cparata 0:485458fca2bd 4112 * Output : Status of FF_EV_STATUS see LSM6DSL_ACC_GYRO_FF_EV_STATUS_t
cparata 0:485458fca2bd 4113 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4114 *******************************************************************************/
cparata 0:485458fca2bd 4115 status_t LSM6DSL_ACC_GYRO_R_FF_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_FF_EV_STATUS_t *value)
cparata 0:485458fca2bd 4116 {
cparata 0:485458fca2bd 4117 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4118 return MEMS_ERROR;
cparata 0:485458fca2bd 4119
cparata 0:485458fca2bd 4120 *value &= LSM6DSL_ACC_GYRO_FF_EV_STATUS_MASK; //mask
cparata 0:485458fca2bd 4121
cparata 0:485458fca2bd 4122 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4123 }
cparata 0:485458fca2bd 4124
cparata 0:485458fca2bd 4125 /*******************************************************************************
cparata 0:485458fca2bd 4126 * Function Name : LSM6DSL_ACC_GYRO_R_Z_TAP
cparata 0:485458fca2bd 4127 * Description : Read Z_TAP
cparata 0:485458fca2bd 4128 * Input : Pointer to LSM6DSL_ACC_GYRO_Z_TAP_t
cparata 0:485458fca2bd 4129 * Output : Status of Z_TAP see LSM6DSL_ACC_GYRO_Z_TAP_t
cparata 0:485458fca2bd 4130 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4131 *******************************************************************************/
cparata 0:485458fca2bd 4132 status_t LSM6DSL_ACC_GYRO_R_Z_TAP(void *handle, LSM6DSL_ACC_GYRO_Z_TAP_t *value)
cparata 0:485458fca2bd 4133 {
cparata 0:485458fca2bd 4134 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_SRC, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4135 return MEMS_ERROR;
cparata 0:485458fca2bd 4136
cparata 0:485458fca2bd 4137 *value &= LSM6DSL_ACC_GYRO_Z_TAP_MASK; //mask
cparata 0:485458fca2bd 4138
cparata 0:485458fca2bd 4139 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4140 }
cparata 0:485458fca2bd 4141
cparata 0:485458fca2bd 4142 /*******************************************************************************
cparata 0:485458fca2bd 4143 * Function Name : LSM6DSL_ACC_GYRO_R_Y_TAP
cparata 0:485458fca2bd 4144 * Description : Read Y_TAP
cparata 0:485458fca2bd 4145 * Input : Pointer to LSM6DSL_ACC_GYRO_Y_TAP_t
cparata 0:485458fca2bd 4146 * Output : Status of Y_TAP see LSM6DSL_ACC_GYRO_Y_TAP_t
cparata 0:485458fca2bd 4147 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4148 *******************************************************************************/
cparata 0:485458fca2bd 4149 status_t LSM6DSL_ACC_GYRO_R_Y_TAP(void *handle, LSM6DSL_ACC_GYRO_Y_TAP_t *value)
cparata 0:485458fca2bd 4150 {
cparata 0:485458fca2bd 4151 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_SRC, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4152 return MEMS_ERROR;
cparata 0:485458fca2bd 4153
cparata 0:485458fca2bd 4154 *value &= LSM6DSL_ACC_GYRO_Y_TAP_MASK; //mask
cparata 0:485458fca2bd 4155
cparata 0:485458fca2bd 4156 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4157 }
cparata 0:485458fca2bd 4158
cparata 0:485458fca2bd 4159 /*******************************************************************************
cparata 0:485458fca2bd 4160 * Function Name : LSM6DSL_ACC_GYRO_R_X_TAP
cparata 0:485458fca2bd 4161 * Description : Read X_TAP
cparata 0:485458fca2bd 4162 * Input : Pointer to LSM6DSL_ACC_GYRO_X_TAP_t
cparata 0:485458fca2bd 4163 * Output : Status of X_TAP see LSM6DSL_ACC_GYRO_X_TAP_t
cparata 0:485458fca2bd 4164 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4165 *******************************************************************************/
cparata 0:485458fca2bd 4166 status_t LSM6DSL_ACC_GYRO_R_X_TAP(void *handle, LSM6DSL_ACC_GYRO_X_TAP_t *value)
cparata 0:485458fca2bd 4167 {
cparata 0:485458fca2bd 4168 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_SRC, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4169 return MEMS_ERROR;
cparata 0:485458fca2bd 4170
cparata 0:485458fca2bd 4171 *value &= LSM6DSL_ACC_GYRO_X_TAP_MASK; //mask
cparata 0:485458fca2bd 4172
cparata 0:485458fca2bd 4173 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4174 }
cparata 0:485458fca2bd 4175
cparata 0:485458fca2bd 4176 /*******************************************************************************
cparata 0:485458fca2bd 4177 * Function Name : LSM6DSL_ACC_GYRO_R_TAP_SIGN
cparata 0:485458fca2bd 4178 * Description : Read TAP_SIGN
cparata 0:485458fca2bd 4179 * Input : Pointer to LSM6DSL_ACC_GYRO_TAP_SIGN_t
cparata 0:485458fca2bd 4180 * Output : Status of TAP_SIGN see LSM6DSL_ACC_GYRO_TAP_SIGN_t
cparata 0:485458fca2bd 4181 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4182 *******************************************************************************/
cparata 0:485458fca2bd 4183 status_t LSM6DSL_ACC_GYRO_R_TAP_SIGN(void *handle, LSM6DSL_ACC_GYRO_TAP_SIGN_t *value)
cparata 0:485458fca2bd 4184 {
cparata 0:485458fca2bd 4185 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_SRC, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4186 return MEMS_ERROR;
cparata 0:485458fca2bd 4187
cparata 0:485458fca2bd 4188 *value &= LSM6DSL_ACC_GYRO_TAP_SIGN_MASK; //mask
cparata 0:485458fca2bd 4189
cparata 0:485458fca2bd 4190 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4191 }
cparata 0:485458fca2bd 4192
cparata 0:485458fca2bd 4193 /*******************************************************************************
cparata 0:485458fca2bd 4194 * Function Name : LSM6DSL_ACC_GYRO_R_DOUBLE_TAP_EV_STATUS
cparata 0:485458fca2bd 4195 * Description : Read DOUBLE_TAP_EV_STATUS
cparata 0:485458fca2bd 4196 * Input : Pointer to LSM6DSL_ACC_GYRO_DOUBLE_TAP_EV_STATUS_t
cparata 0:485458fca2bd 4197 * Output : Status of DOUBLE_TAP_EV_STATUS see LSM6DSL_ACC_GYRO_DOUBLE_TAP_EV_STATUS_t
cparata 0:485458fca2bd 4198 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4199 *******************************************************************************/
cparata 0:485458fca2bd 4200 status_t LSM6DSL_ACC_GYRO_R_DOUBLE_TAP_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_DOUBLE_TAP_EV_STATUS_t *value)
cparata 0:485458fca2bd 4201 {
cparata 0:485458fca2bd 4202 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_SRC, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4203 return MEMS_ERROR;
cparata 0:485458fca2bd 4204
cparata 0:485458fca2bd 4205 *value &= LSM6DSL_ACC_GYRO_DOUBLE_TAP_EV_STATUS_MASK; //mask
cparata 0:485458fca2bd 4206
cparata 0:485458fca2bd 4207 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4208 }
cparata 0:485458fca2bd 4209
cparata 0:485458fca2bd 4210 /*******************************************************************************
cparata 0:485458fca2bd 4211 * Function Name : LSM6DSL_ACC_GYRO_R_SINGLE_TAP_EV_STATUS
cparata 0:485458fca2bd 4212 * Description : Read SINGLE_TAP_EV_STATUS
cparata 0:485458fca2bd 4213 * Input : Pointer to LSM6DSL_ACC_GYRO_SINGLE_TAP_EV_STATUS_t
cparata 0:485458fca2bd 4214 * Output : Status of SINGLE_TAP_EV_STATUS see LSM6DSL_ACC_GYRO_SINGLE_TAP_EV_STATUS_t
cparata 0:485458fca2bd 4215 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4216 *******************************************************************************/
cparata 0:485458fca2bd 4217 status_t LSM6DSL_ACC_GYRO_R_SINGLE_TAP_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_SINGLE_TAP_EV_STATUS_t *value)
cparata 0:485458fca2bd 4218 {
cparata 0:485458fca2bd 4219 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_SRC, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4220 return MEMS_ERROR;
cparata 0:485458fca2bd 4221
cparata 0:485458fca2bd 4222 *value &= LSM6DSL_ACC_GYRO_SINGLE_TAP_EV_STATUS_MASK; //mask
cparata 0:485458fca2bd 4223
cparata 0:485458fca2bd 4224 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4225 }
cparata 0:485458fca2bd 4226
cparata 0:485458fca2bd 4227 /*******************************************************************************
cparata 0:485458fca2bd 4228 * Function Name : LSM6DSL_ACC_GYRO_R_TAP_EV_STATUS
cparata 0:485458fca2bd 4229 * Description : Read TAP_EV_STATUS
cparata 0:485458fca2bd 4230 * Input : Pointer to LSM6DSL_ACC_GYRO_TAP_EV_STATUS_t
cparata 0:485458fca2bd 4231 * Output : Status of TAP_EV_STATUS see LSM6DSL_ACC_GYRO_TAP_EV_STATUS_t
cparata 0:485458fca2bd 4232 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4233 *******************************************************************************/
cparata 0:485458fca2bd 4234 status_t LSM6DSL_ACC_GYRO_R_TAP_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_TAP_EV_STATUS_t *value)
cparata 0:485458fca2bd 4235 {
cparata 0:485458fca2bd 4236 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_SRC, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4237 return MEMS_ERROR;
cparata 0:485458fca2bd 4238
cparata 0:485458fca2bd 4239 *value &= LSM6DSL_ACC_GYRO_TAP_EV_STATUS_MASK; //mask
cparata 0:485458fca2bd 4240
cparata 0:485458fca2bd 4241 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4242 }
cparata 0:485458fca2bd 4243
cparata 0:485458fca2bd 4244 /*******************************************************************************
cparata 0:485458fca2bd 4245 * Function Name : LSM6DSL_ACC_GYRO_R_DSD_XL
cparata 0:485458fca2bd 4246 * Description : Read DSD_XL
cparata 0:485458fca2bd 4247 * Input : Pointer to LSM6DSL_ACC_GYRO_DSD_XL_t
cparata 0:485458fca2bd 4248 * Output : Status of DSD_XL see LSM6DSL_ACC_GYRO_DSD_XL_t
cparata 0:485458fca2bd 4249 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4250 *******************************************************************************/
cparata 0:485458fca2bd 4251 status_t LSM6DSL_ACC_GYRO_R_DSD_XL(void *handle, LSM6DSL_ACC_GYRO_DSD_XL_t *value)
cparata 0:485458fca2bd 4252 {
cparata 0:485458fca2bd 4253 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_D6D_SRC, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4254 return MEMS_ERROR;
cparata 0:485458fca2bd 4255
cparata 0:485458fca2bd 4256 *value &= LSM6DSL_ACC_GYRO_DSD_XL_MASK; //mask
cparata 0:485458fca2bd 4257
cparata 0:485458fca2bd 4258 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4259 }
cparata 0:485458fca2bd 4260
cparata 0:485458fca2bd 4261 /*******************************************************************************
cparata 0:485458fca2bd 4262 * Function Name : LSM6DSL_ACC_GYRO_R_DSD_XH
cparata 0:485458fca2bd 4263 * Description : Read DSD_XH
cparata 0:485458fca2bd 4264 * Input : Pointer to LSM6DSL_ACC_GYRO_DSD_XH_t
cparata 0:485458fca2bd 4265 * Output : Status of DSD_XH see LSM6DSL_ACC_GYRO_DSD_XH_t
cparata 0:485458fca2bd 4266 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4267 *******************************************************************************/
cparata 0:485458fca2bd 4268 status_t LSM6DSL_ACC_GYRO_R_DSD_XH(void *handle, LSM6DSL_ACC_GYRO_DSD_XH_t *value)
cparata 0:485458fca2bd 4269 {
cparata 0:485458fca2bd 4270 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_D6D_SRC, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4271 return MEMS_ERROR;
cparata 0:485458fca2bd 4272
cparata 0:485458fca2bd 4273 *value &= LSM6DSL_ACC_GYRO_DSD_XH_MASK; //mask
cparata 0:485458fca2bd 4274
cparata 0:485458fca2bd 4275 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4276 }
cparata 0:485458fca2bd 4277
cparata 0:485458fca2bd 4278 /*******************************************************************************
cparata 0:485458fca2bd 4279 * Function Name : LSM6DSL_ACC_GYRO_R_DSD_YL
cparata 0:485458fca2bd 4280 * Description : Read DSD_YL
cparata 0:485458fca2bd 4281 * Input : Pointer to LSM6DSL_ACC_GYRO_DSD_YL_t
cparata 0:485458fca2bd 4282 * Output : Status of DSD_YL see LSM6DSL_ACC_GYRO_DSD_YL_t
cparata 0:485458fca2bd 4283 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4284 *******************************************************************************/
cparata 0:485458fca2bd 4285 status_t LSM6DSL_ACC_GYRO_R_DSD_YL(void *handle, LSM6DSL_ACC_GYRO_DSD_YL_t *value)
cparata 0:485458fca2bd 4286 {
cparata 0:485458fca2bd 4287 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_D6D_SRC, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4288 return MEMS_ERROR;
cparata 0:485458fca2bd 4289
cparata 0:485458fca2bd 4290 *value &= LSM6DSL_ACC_GYRO_DSD_YL_MASK; //mask
cparata 0:485458fca2bd 4291
cparata 0:485458fca2bd 4292 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4293 }
cparata 0:485458fca2bd 4294
cparata 0:485458fca2bd 4295 /*******************************************************************************
cparata 0:485458fca2bd 4296 * Function Name : LSM6DSL_ACC_GYRO_R_DSD_YH
cparata 0:485458fca2bd 4297 * Description : Read DSD_YH
cparata 0:485458fca2bd 4298 * Input : Pointer to LSM6DSL_ACC_GYRO_DSD_YH_t
cparata 0:485458fca2bd 4299 * Output : Status of DSD_YH see LSM6DSL_ACC_GYRO_DSD_YH_t
cparata 0:485458fca2bd 4300 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4301 *******************************************************************************/
cparata 0:485458fca2bd 4302 status_t LSM6DSL_ACC_GYRO_R_DSD_YH(void *handle, LSM6DSL_ACC_GYRO_DSD_YH_t *value)
cparata 0:485458fca2bd 4303 {
cparata 0:485458fca2bd 4304 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_D6D_SRC, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4305 return MEMS_ERROR;
cparata 0:485458fca2bd 4306
cparata 0:485458fca2bd 4307 *value &= LSM6DSL_ACC_GYRO_DSD_YH_MASK; //mask
cparata 0:485458fca2bd 4308
cparata 0:485458fca2bd 4309 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4310 }
cparata 0:485458fca2bd 4311
cparata 0:485458fca2bd 4312 /*******************************************************************************
cparata 0:485458fca2bd 4313 * Function Name : LSM6DSL_ACC_GYRO_R_DSD_ZL
cparata 0:485458fca2bd 4314 * Description : Read DSD_ZL
cparata 0:485458fca2bd 4315 * Input : Pointer to LSM6DSL_ACC_GYRO_DSD_ZL_t
cparata 0:485458fca2bd 4316 * Output : Status of DSD_ZL see LSM6DSL_ACC_GYRO_DSD_ZL_t
cparata 0:485458fca2bd 4317 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4318 *******************************************************************************/
cparata 0:485458fca2bd 4319 status_t LSM6DSL_ACC_GYRO_R_DSD_ZL(void *handle, LSM6DSL_ACC_GYRO_DSD_ZL_t *value)
cparata 0:485458fca2bd 4320 {
cparata 0:485458fca2bd 4321 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_D6D_SRC, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4322 return MEMS_ERROR;
cparata 0:485458fca2bd 4323
cparata 0:485458fca2bd 4324 *value &= LSM6DSL_ACC_GYRO_DSD_ZL_MASK; //mask
cparata 0:485458fca2bd 4325
cparata 0:485458fca2bd 4326 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4327 }
cparata 0:485458fca2bd 4328
cparata 0:485458fca2bd 4329 /*******************************************************************************
cparata 0:485458fca2bd 4330 * Function Name : LSM6DSL_ACC_GYRO_R_DSD_ZH
cparata 0:485458fca2bd 4331 * Description : Read DSD_ZH
cparata 0:485458fca2bd 4332 * Input : Pointer to LSM6DSL_ACC_GYRO_DSD_ZH_t
cparata 0:485458fca2bd 4333 * Output : Status of DSD_ZH see LSM6DSL_ACC_GYRO_DSD_ZH_t
cparata 0:485458fca2bd 4334 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4335 *******************************************************************************/
cparata 0:485458fca2bd 4336 status_t LSM6DSL_ACC_GYRO_R_DSD_ZH(void *handle, LSM6DSL_ACC_GYRO_DSD_ZH_t *value)
cparata 0:485458fca2bd 4337 {
cparata 0:485458fca2bd 4338 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_D6D_SRC, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4339 return MEMS_ERROR;
cparata 0:485458fca2bd 4340
cparata 0:485458fca2bd 4341 *value &= LSM6DSL_ACC_GYRO_DSD_ZH_MASK; //mask
cparata 0:485458fca2bd 4342
cparata 0:485458fca2bd 4343 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4344 }
cparata 0:485458fca2bd 4345
cparata 0:485458fca2bd 4346 /*******************************************************************************
cparata 0:485458fca2bd 4347 * Function Name : LSM6DSL_ACC_GYRO_R_D6D_EV_STATUS
cparata 0:485458fca2bd 4348 * Description : Read D6D_EV_STATUS
cparata 0:485458fca2bd 4349 * Input : Pointer to LSM6DSL_ACC_GYRO_D6D_EV_STATUS_t
cparata 0:485458fca2bd 4350 * Output : Status of D6D_EV_STATUS see LSM6DSL_ACC_GYRO_D6D_EV_STATUS_t
cparata 0:485458fca2bd 4351 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4352 *******************************************************************************/
cparata 0:485458fca2bd 4353 status_t LSM6DSL_ACC_GYRO_R_D6D_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_D6D_EV_STATUS_t *value)
cparata 0:485458fca2bd 4354 {
cparata 0:485458fca2bd 4355 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_D6D_SRC, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4356 return MEMS_ERROR;
cparata 0:485458fca2bd 4357
cparata 0:485458fca2bd 4358 *value &= LSM6DSL_ACC_GYRO_D6D_EV_STATUS_MASK; //mask
cparata 0:485458fca2bd 4359
cparata 0:485458fca2bd 4360 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4361 }
cparata 0:485458fca2bd 4362
cparata 0:485458fca2bd 4363 /*******************************************************************************
cparata 0:485458fca2bd 4364 * Function Name : LSM6DSL_ACC_GYRO_R_XLDA
cparata 0:485458fca2bd 4365 * Description : Read XLDA
cparata 0:485458fca2bd 4366 * Input : Pointer to LSM6DSL_ACC_GYRO_XLDA_t
cparata 0:485458fca2bd 4367 * Output : Status of XLDA see LSM6DSL_ACC_GYRO_XLDA_t
cparata 0:485458fca2bd 4368 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4369 *******************************************************************************/
cparata 0:485458fca2bd 4370 status_t LSM6DSL_ACC_GYRO_R_XLDA(void *handle, LSM6DSL_ACC_GYRO_XLDA_t *value)
cparata 0:485458fca2bd 4371 {
cparata 0:485458fca2bd 4372 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_STATUS_REG, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4373 return MEMS_ERROR;
cparata 0:485458fca2bd 4374
cparata 0:485458fca2bd 4375 *value &= LSM6DSL_ACC_GYRO_XLDA_MASK; //mask
cparata 0:485458fca2bd 4376
cparata 0:485458fca2bd 4377 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4378 }
cparata 0:485458fca2bd 4379
cparata 0:485458fca2bd 4380 /*******************************************************************************
cparata 0:485458fca2bd 4381 * Function Name : LSM6DSL_ACC_GYRO_R_GDA
cparata 0:485458fca2bd 4382 * Description : Read GDA
cparata 0:485458fca2bd 4383 * Input : Pointer to LSM6DSL_ACC_GYRO_GDA_t
cparata 0:485458fca2bd 4384 * Output : Status of GDA see LSM6DSL_ACC_GYRO_GDA_t
cparata 0:485458fca2bd 4385 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4386 *******************************************************************************/
cparata 0:485458fca2bd 4387 status_t LSM6DSL_ACC_GYRO_R_GDA(void *handle, LSM6DSL_ACC_GYRO_GDA_t *value)
cparata 0:485458fca2bd 4388 {
cparata 0:485458fca2bd 4389 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_STATUS_REG, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4390 return MEMS_ERROR;
cparata 0:485458fca2bd 4391
cparata 0:485458fca2bd 4392 *value &= LSM6DSL_ACC_GYRO_GDA_MASK; //mask
cparata 0:485458fca2bd 4393
cparata 0:485458fca2bd 4394 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4395 }
cparata 0:485458fca2bd 4396
cparata 0:485458fca2bd 4397 /*******************************************************************************
cparata 0:485458fca2bd 4398 * Function Name : LSM6DSL_ACC_GYRO_R_TDA
cparata 0:485458fca2bd 4399 * Description : Read GDA
cparata 0:485458fca2bd 4400 * Input : Pointer to LSM6DSL_ACC_GYRO_TDA_t
cparata 0:485458fca2bd 4401 * Output : Status of GDA see LSM6DSL_ACC_GYRO_TDA_t
cparata 0:485458fca2bd 4402 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4403 *******************************************************************************/
cparata 0:485458fca2bd 4404 status_t LSM6DSL_ACC_GYRO_R_TDA(void *handle, LSM6DSL_ACC_GYRO_TDA_t *value)
cparata 0:485458fca2bd 4405 {
cparata 0:485458fca2bd 4406 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_STATUS_REG, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4407 return MEMS_ERROR;
cparata 0:485458fca2bd 4408
cparata 0:485458fca2bd 4409 *value &= LSM6DSL_ACC_GYRO_TDA_MASK; //mask
cparata 0:485458fca2bd 4410
cparata 0:485458fca2bd 4411 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4412 }
cparata 0:485458fca2bd 4413
cparata 0:485458fca2bd 4414 /*******************************************************************************
cparata 0:485458fca2bd 4415 * Function Name : LSM6DSL_ACC_GYRO_R_FIFONumOfEntries
cparata 0:485458fca2bd 4416 * Description : Read DIFF_FIFO
cparata 0:485458fca2bd 4417 * Input : Pointer to u16_t
cparata 0:485458fca2bd 4418 * Output : Status of DIFF_FIFO
cparata 0:485458fca2bd 4419 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4420 *******************************************************************************/
cparata 0:485458fca2bd 4421 status_t LSM6DSL_ACC_GYRO_R_FIFONumOfEntries(void *handle, u16_t *value)
cparata 0:485458fca2bd 4422 {
cparata 0:485458fca2bd 4423 u8_t valueH, valueL;
cparata 0:485458fca2bd 4424
cparata 0:485458fca2bd 4425 /* Low part from FIFO_STATUS1 */
cparata 0:485458fca2bd 4426 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS1, (u8_t *)&valueL, 1) )
cparata 0:485458fca2bd 4427 return MEMS_ERROR;
cparata 0:485458fca2bd 4428
cparata 0:485458fca2bd 4429 valueL &= LSM6DSL_ACC_GYRO_DIFF_FIFO_STATUS1_MASK; //coerce
cparata 0:485458fca2bd 4430 valueL = valueL >> LSM6DSL_ACC_GYRO_DIFF_FIFO_STATUS1_POSITION; //mask
cparata 0:485458fca2bd 4431
cparata 0:485458fca2bd 4432 /* High part from FIFO_STATUS2 */
cparata 0:485458fca2bd 4433 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS2, (u8_t *)&valueH, 1) )
cparata 0:485458fca2bd 4434 return MEMS_ERROR;
cparata 0:485458fca2bd 4435
cparata 0:485458fca2bd 4436 valueH &= LSM6DSL_ACC_GYRO_DIFF_FIFO_STATUS2_MASK; //coerce
cparata 0:485458fca2bd 4437 valueH = valueH >> LSM6DSL_ACC_GYRO_DIFF_FIFO_STATUS2_POSITION; //mask
cparata 0:485458fca2bd 4438
cparata 0:485458fca2bd 4439 *value = ((valueH << 8) & 0xFF00) | valueL;
cparata 0:485458fca2bd 4440
cparata 0:485458fca2bd 4441 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4442 }
cparata 0:485458fca2bd 4443
cparata 0:485458fca2bd 4444 /*******************************************************************************
cparata 0:485458fca2bd 4445 * Function Name : LSM6DSL_ACC_GYRO_R_FIFOEmpty
cparata 0:485458fca2bd 4446 * Description : Read FIFO_EMPTY
cparata 0:485458fca2bd 4447 * Input : Pointer to LSM6DSL_ACC_GYRO_FIFO_EMPTY_t
cparata 0:485458fca2bd 4448 * Output : Status of FIFO_EMPTY see LSM6DSL_ACC_GYRO_FIFO_EMPTY_t
cparata 0:485458fca2bd 4449 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4450 *******************************************************************************/
cparata 0:485458fca2bd 4451 status_t LSM6DSL_ACC_GYRO_R_FIFOEmpty(void *handle, LSM6DSL_ACC_GYRO_FIFO_EMPTY_t *value)
cparata 0:485458fca2bd 4452 {
cparata 0:485458fca2bd 4453 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS2, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4454 return MEMS_ERROR;
cparata 0:485458fca2bd 4455
cparata 0:485458fca2bd 4456 *value &= LSM6DSL_ACC_GYRO_FIFO_EMPTY_MASK; //mask
cparata 0:485458fca2bd 4457
cparata 0:485458fca2bd 4458 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4459 }
cparata 0:485458fca2bd 4460
cparata 0:485458fca2bd 4461 /*******************************************************************************
cparata 0:485458fca2bd 4462 * Function Name : LSM6DSL_ACC_GYRO_R_FIFOFull
cparata 0:485458fca2bd 4463 * Description : Read FIFO_FULL
cparata 0:485458fca2bd 4464 * Input : Pointer to LSM6DSL_ACC_GYRO_FIFO_FULL_t
cparata 0:485458fca2bd 4465 * Output : Status of FIFO_FULL see LSM6DSL_ACC_GYRO_FIFO_FULL_t
cparata 0:485458fca2bd 4466 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4467 *******************************************************************************/
cparata 0:485458fca2bd 4468 status_t LSM6DSL_ACC_GYRO_R_FIFOFull(void *handle, LSM6DSL_ACC_GYRO_FIFO_FULL_t *value)
cparata 0:485458fca2bd 4469 {
cparata 0:485458fca2bd 4470 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS2, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4471 return MEMS_ERROR;
cparata 0:485458fca2bd 4472
cparata 0:485458fca2bd 4473 *value &= LSM6DSL_ACC_GYRO_FIFO_FULL_MASK; //mask
cparata 0:485458fca2bd 4474
cparata 0:485458fca2bd 4475 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4476 }
cparata 0:485458fca2bd 4477
cparata 0:485458fca2bd 4478 /*******************************************************************************
cparata 0:485458fca2bd 4479 * Function Name : LSM6DSL_ACC_GYRO_R_OVERRUN
cparata 0:485458fca2bd 4480 * Description : Read OVERRUN
cparata 0:485458fca2bd 4481 * Input : Pointer to LSM6DSL_ACC_GYRO_OVERRUN_t
cparata 0:485458fca2bd 4482 * Output : Status of OVERRUN see LSM6DSL_ACC_GYRO_OVERRUN_t
cparata 0:485458fca2bd 4483 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4484 *******************************************************************************/
cparata 0:485458fca2bd 4485 status_t LSM6DSL_ACC_GYRO_R_OVERRUN(void *handle, LSM6DSL_ACC_GYRO_OVERRUN_t *value)
cparata 0:485458fca2bd 4486 {
cparata 0:485458fca2bd 4487 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS2, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4488 return MEMS_ERROR;
cparata 0:485458fca2bd 4489
cparata 0:485458fca2bd 4490 *value &= LSM6DSL_ACC_GYRO_OVERRUN_MASK; //mask
cparata 0:485458fca2bd 4491
cparata 0:485458fca2bd 4492 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4493 }
cparata 0:485458fca2bd 4494
cparata 0:485458fca2bd 4495 /*******************************************************************************
cparata 0:485458fca2bd 4496 * Function Name : LSM6DSL_ACC_GYRO_R_WaterMark
cparata 0:485458fca2bd 4497 * Description : Read WTM
cparata 0:485458fca2bd 4498 * Input : Pointer to LSM6DSL_ACC_GYRO_WTM_t
cparata 0:485458fca2bd 4499 * Output : Status of WTM see LSM6DSL_ACC_GYRO_WTM_t
cparata 0:485458fca2bd 4500 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4501 *******************************************************************************/
cparata 0:485458fca2bd 4502 status_t LSM6DSL_ACC_GYRO_R_WaterMark(void *handle, LSM6DSL_ACC_GYRO_WTM_t *value)
cparata 0:485458fca2bd 4503 {
cparata 0:485458fca2bd 4504 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS2, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4505 return MEMS_ERROR;
cparata 0:485458fca2bd 4506
cparata 0:485458fca2bd 4507 *value &= LSM6DSL_ACC_GYRO_WTM_MASK; //mask
cparata 0:485458fca2bd 4508
cparata 0:485458fca2bd 4509 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4510 }
cparata 0:485458fca2bd 4511
cparata 0:485458fca2bd 4512 /*******************************************************************************
cparata 0:485458fca2bd 4513 * Function Name : LSM6DSL_ACC_GYRO_R_FIFOPattern
cparata 0:485458fca2bd 4514 * Description : Read FIFO_PATTERN
cparata 0:485458fca2bd 4515 * Input : Pointer to u16_t
cparata 0:485458fca2bd 4516 * Output : Status of FIFO_PATTERN
cparata 0:485458fca2bd 4517 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4518 *******************************************************************************/
cparata 0:485458fca2bd 4519 status_t LSM6DSL_ACC_GYRO_R_FIFOPattern(void *handle, u16_t *value)
cparata 0:485458fca2bd 4520 {
cparata 0:485458fca2bd 4521 u8_t valueH, valueL;
cparata 0:485458fca2bd 4522
cparata 0:485458fca2bd 4523 /* Low part from FIFO_STATUS3 */
cparata 0:485458fca2bd 4524 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS3, (u8_t *)&valueL, 1) )
cparata 0:485458fca2bd 4525 return MEMS_ERROR;
cparata 0:485458fca2bd 4526
cparata 0:485458fca2bd 4527 valueL &= LSM6DSL_ACC_GYRO_FIFO_STATUS3_PATTERN_MASK; //coerce
cparata 0:485458fca2bd 4528 valueL = valueL >> LSM6DSL_ACC_GYRO_FIFO_STATUS3_PATTERN_POSITION; //mask
cparata 0:485458fca2bd 4529
cparata 0:485458fca2bd 4530 /* High part from FIFO_STATUS4 */
cparata 0:485458fca2bd 4531 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS4, (u8_t *)&valueH, 1) )
cparata 0:485458fca2bd 4532 return MEMS_ERROR;
cparata 0:485458fca2bd 4533
cparata 0:485458fca2bd 4534 valueH &= LSM6DSL_ACC_GYRO_FIFO_STATUS4_PATTERN_MASK; //coerce
cparata 0:485458fca2bd 4535 valueH = valueH >> LSM6DSL_ACC_GYRO_FIFO_STATUS4_PATTERN_POSITION; //mask
cparata 0:485458fca2bd 4536
cparata 0:485458fca2bd 4537 *value = ((valueH << 8) & 0xFF00) | valueL;
cparata 0:485458fca2bd 4538
cparata 0:485458fca2bd 4539 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4540 }
cparata 0:485458fca2bd 4541
cparata 0:485458fca2bd 4542 /*******************************************************************************
cparata 0:485458fca2bd 4543 * Function Name : LSM6DSL_ACC_GYRO_R_SENS_HUB_END
cparata 0:485458fca2bd 4544 * Description : Read SENS_HUB_END
cparata 0:485458fca2bd 4545 * Input : Pointer to LSM6DSL_ACC_GYRO_SENS_HUB_END_t
cparata 0:485458fca2bd 4546 * Output : Status of SENS_HUB_END see LSM6DSL_ACC_GYRO_SENS_HUB_END_t
cparata 0:485458fca2bd 4547 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4548 *******************************************************************************/
cparata 0:485458fca2bd 4549 status_t LSM6DSL_ACC_GYRO_R_SENS_HUB_END(void *handle, LSM6DSL_ACC_GYRO_SENS_HUB_END_t *value)
cparata 0:485458fca2bd 4550 {
cparata 0:485458fca2bd 4551 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4552 return MEMS_ERROR;
cparata 0:485458fca2bd 4553
cparata 0:485458fca2bd 4554 *value &= LSM6DSL_ACC_GYRO_SENS_HUB_END_MASK; //mask
cparata 0:485458fca2bd 4555
cparata 0:485458fca2bd 4556 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4557 }
cparata 0:485458fca2bd 4558
cparata 0:485458fca2bd 4559 /*******************************************************************************
cparata 0:485458fca2bd 4560 * Function Name : LSM6DSL_ACC_GYRO_R_SOFT_IRON_END
cparata 0:485458fca2bd 4561 * Description : Read SOFT_IRON_END
cparata 0:485458fca2bd 4562 * Input : Pointer to LSM6DSL_ACC_GYRO_SOFT_IRON_END_t
cparata 0:485458fca2bd 4563 * Output : Status of SOFT_IRON_END see LSM6DSL_ACC_GYRO_SOFT_IRON_END_t
cparata 0:485458fca2bd 4564 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4565 *******************************************************************************/
cparata 0:485458fca2bd 4566 status_t LSM6DSL_ACC_GYRO_R_SOFT_IRON_END(void *handle, LSM6DSL_ACC_GYRO_SOFT_IRON_END_t *value)
cparata 0:485458fca2bd 4567 {
cparata 0:485458fca2bd 4568 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4569 return MEMS_ERROR;
cparata 0:485458fca2bd 4570
cparata 0:485458fca2bd 4571 *value &= LSM6DSL_ACC_GYRO_SOFT_IRON_END_MASK; //mask
cparata 0:485458fca2bd 4572
cparata 0:485458fca2bd 4573 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4574 }
cparata 0:485458fca2bd 4575
cparata 0:485458fca2bd 4576 /*******************************************************************************
cparata 0:485458fca2bd 4577 * Function Name : LSM6DSL_ACC_GYRO_R_HardIron
cparata 0:485458fca2bd 4578 * Description : Read HI_FAIL
cparata 0:485458fca2bd 4579 * Input : Pointer to LSM6DSL_ACC_GYRO_SOFT_HARD_IRON_STAT_t
cparata 0:485458fca2bd 4580 * Output : Status of HI_FAIL see LSM6DSL_ACC_GYRO_SOFT_HARD_IRON_STAT_t
cparata 0:485458fca2bd 4581 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4582 *******************************************************************************/
cparata 0:485458fca2bd 4583 status_t LSM6DSL_ACC_GYRO_R_HardIron(void *handle, LSM6DSL_ACC_GYRO_SOFT_HARD_IRON_STAT_t *value)
cparata 0:485458fca2bd 4584 {
cparata 0:485458fca2bd 4585 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4586 return MEMS_ERROR;
cparata 0:485458fca2bd 4587
cparata 0:485458fca2bd 4588 *value &= LSM6DSL_ACC_GYRO_HARD_IRON_STAT_MASK; //mask
cparata 0:485458fca2bd 4589
cparata 0:485458fca2bd 4590 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4591 }
cparata 0:485458fca2bd 4592
cparata 0:485458fca2bd 4593 /*******************************************************************************
cparata 0:485458fca2bd 4594 * Function Name : LSM6DSL_ACC_GYRO_R_STEP_OVERFLOW
cparata 0:485458fca2bd 4595 * Description : Read STEP_OVERFLOW
cparata 0:485458fca2bd 4596 * Input : Pointer to LSM6DSL_ACC_GYRO_STEP_OVERFLOW_t
cparata 0:485458fca2bd 4597 * Output : Status of STEP_OVERFLOW see LSM6DSL_ACC_GYRO_STEP_OVERFLOW_t
cparata 0:485458fca2bd 4598 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4599 *******************************************************************************/
cparata 0:485458fca2bd 4600 status_t LSM6DSL_ACC_GYRO_R_STEP_OVERFLOW(void *handle, LSM6DSL_ACC_GYRO_STEP_OVERFLOW_t *value)
cparata 0:485458fca2bd 4601 {
cparata 0:485458fca2bd 4602 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4603 return MEMS_ERROR;
cparata 0:485458fca2bd 4604
cparata 0:485458fca2bd 4605 *value &= LSM6DSL_ACC_GYRO_STEP_OVERFLOW_MASK; //mask
cparata 0:485458fca2bd 4606
cparata 0:485458fca2bd 4607 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4608 }
cparata 0:485458fca2bd 4609
cparata 0:485458fca2bd 4610 /*******************************************************************************
cparata 0:485458fca2bd 4611 * Function Name : LSM6DSL_ACC_GYRO_R_STEP_COUNT_DELTA
cparata 0:485458fca2bd 4612 * Description : Read STEP_COUNT_DELTA_IA
cparata 0:485458fca2bd 4613 * Input : Pointer to LSM6DSL_ACC_GYRO_STEP_COUNT_DELTA_t
cparata 0:485458fca2bd 4614 * Output : Status of STEP_COUNT_DELTA_IA see LSM6DSL_ACC_GYRO_STEP_COUNT_DELTA_t
cparata 0:485458fca2bd 4615 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4616 *******************************************************************************/
cparata 0:485458fca2bd 4617 status_t LSM6DSL_ACC_GYRO_R_STEP_COUNT_DELTA(void *handle, LSM6DSL_ACC_GYRO_STEP_COUNT_DELTA_t *value)
cparata 0:485458fca2bd 4618 {
cparata 0:485458fca2bd 4619 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4620 return MEMS_ERROR;
cparata 0:485458fca2bd 4621
cparata 0:485458fca2bd 4622 *value &= LSM6DSL_ACC_GYRO_STEP_COUNT_DELTA_MASK; //mask
cparata 0:485458fca2bd 4623
cparata 0:485458fca2bd 4624 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4625 }
cparata 0:485458fca2bd 4626
cparata 0:485458fca2bd 4627 /*******************************************************************************
cparata 0:485458fca2bd 4628 * Function Name : LSM6DSL_ACC_GYRO_R_PEDO_EV_STATUS
cparata 0:485458fca2bd 4629 * Description : Read PEDO_EV_STATUS
cparata 0:485458fca2bd 4630 * Input : Pointer to LSM6DSL_ACC_GYRO_PEDO_EV_STATUS_t
cparata 0:485458fca2bd 4631 * Output : Status of PEDO_EV_STATUS see LSM6DSL_ACC_GYRO_PEDO_EV_STATUS_t
cparata 0:485458fca2bd 4632 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4633 *******************************************************************************/
cparata 0:485458fca2bd 4634 status_t LSM6DSL_ACC_GYRO_R_PEDO_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_PEDO_EV_STATUS_t *value)
cparata 0:485458fca2bd 4635 {
cparata 0:485458fca2bd 4636 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4637 return MEMS_ERROR;
cparata 0:485458fca2bd 4638
cparata 0:485458fca2bd 4639 *value &= LSM6DSL_ACC_GYRO_PEDO_EV_STATUS_MASK; //mask
cparata 0:485458fca2bd 4640
cparata 0:485458fca2bd 4641 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4642 }
cparata 0:485458fca2bd 4643
cparata 0:485458fca2bd 4644 /*******************************************************************************
cparata 0:485458fca2bd 4645 * Function Name : LSM6DSL_ACC_GYRO_R_TILT_EV_STATUS
cparata 0:485458fca2bd 4646 * Description : Read TILT_EV_STATUS
cparata 0:485458fca2bd 4647 * Input : Pointer to LSM6DSL_ACC_GYRO_TILT_EV_STATUS_t
cparata 0:485458fca2bd 4648 * Output : Status of TILT_EV_STATUS see LSM6DSL_ACC_GYRO_TILT_EV_STATUS_t
cparata 0:485458fca2bd 4649 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4650 *******************************************************************************/
cparata 0:485458fca2bd 4651 status_t LSM6DSL_ACC_GYRO_R_TILT_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_TILT_EV_STATUS_t *value)
cparata 0:485458fca2bd 4652 {
cparata 0:485458fca2bd 4653 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4654 return MEMS_ERROR;
cparata 0:485458fca2bd 4655
cparata 0:485458fca2bd 4656 *value &= LSM6DSL_ACC_GYRO_TILT_EV_STATUS_MASK; //mask
cparata 0:485458fca2bd 4657
cparata 0:485458fca2bd 4658 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4659 }
cparata 0:485458fca2bd 4660
cparata 0:485458fca2bd 4661 /*******************************************************************************
cparata 0:485458fca2bd 4662 * Function Name : LSM6DSL_ACC_GYRO_R_SIGN_MOT_EV_STATUS
cparata 0:485458fca2bd 4663 * Description : Read SIGN_MOT_EV_STATUS
cparata 0:485458fca2bd 4664 * Input : Pointer to LSM6DSL_ACC_GYRO_SIGN_MOT_EV_STATUS_t
cparata 0:485458fca2bd 4665 * Output : Status of SIGN_MOT_EV_STATUS see LSM6DSL_ACC_GYRO_SIGN_MOT_EV_STATUS_t
cparata 0:485458fca2bd 4666 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4667 *******************************************************************************/
cparata 0:485458fca2bd 4668 status_t LSM6DSL_ACC_GYRO_R_SIGN_MOT_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_SIGN_MOT_EV_STATUS_t *value)
cparata 0:485458fca2bd 4669 {
cparata 0:485458fca2bd 4670 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4671 return MEMS_ERROR;
cparata 0:485458fca2bd 4672
cparata 0:485458fca2bd 4673 *value &= LSM6DSL_ACC_GYRO_SIGN_MOT_EV_STATUS_MASK; //mask
cparata 0:485458fca2bd 4674
cparata 0:485458fca2bd 4675 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4676 }
cparata 0:485458fca2bd 4677
cparata 0:485458fca2bd 4678 /*******************************************************************************
cparata 0:485458fca2bd 4679 * Function Name : LSM6DSL_ACC_GYRO_W_LIR
cparata 0:485458fca2bd 4680 * Description : Write LIR
cparata 0:485458fca2bd 4681 * Input : LSM6DSL_ACC_GYRO_LIR_t
cparata 0:485458fca2bd 4682 * Output : None
cparata 0:485458fca2bd 4683 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4684 *******************************************************************************/
cparata 0:485458fca2bd 4685 status_t LSM6DSL_ACC_GYRO_W_LIR(void *handle, LSM6DSL_ACC_GYRO_LIR_t newValue)
cparata 0:485458fca2bd 4686 {
cparata 0:485458fca2bd 4687 u8_t value;
cparata 0:485458fca2bd 4688
cparata 0:485458fca2bd 4689 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:485458fca2bd 4690 return MEMS_ERROR;
cparata 0:485458fca2bd 4691
cparata 0:485458fca2bd 4692 value &= ~LSM6DSL_ACC_GYRO_LIR_MASK;
cparata 0:485458fca2bd 4693 value |= newValue;
cparata 0:485458fca2bd 4694
cparata 0:485458fca2bd 4695 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:485458fca2bd 4696 return MEMS_ERROR;
cparata 0:485458fca2bd 4697
cparata 0:485458fca2bd 4698 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4699 }
cparata 0:485458fca2bd 4700
cparata 0:485458fca2bd 4701 /*******************************************************************************
cparata 0:485458fca2bd 4702 * Function Name : LSM6DSL_ACC_GYRO_R_LIR
cparata 0:485458fca2bd 4703 * Description : Read LIR
cparata 0:485458fca2bd 4704 * Input : Pointer to LSM6DSL_ACC_GYRO_LIR_t
cparata 0:485458fca2bd 4705 * Output : Status of LIR see LSM6DSL_ACC_GYRO_LIR_t
cparata 0:485458fca2bd 4706 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4707 *******************************************************************************/
cparata 0:485458fca2bd 4708 status_t LSM6DSL_ACC_GYRO_R_LIR(void *handle, LSM6DSL_ACC_GYRO_LIR_t *value)
cparata 0:485458fca2bd 4709 {
cparata 0:485458fca2bd 4710 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4711 return MEMS_ERROR;
cparata 0:485458fca2bd 4712
cparata 0:485458fca2bd 4713 *value &= LSM6DSL_ACC_GYRO_LIR_MASK; //mask
cparata 0:485458fca2bd 4714
cparata 0:485458fca2bd 4715 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4716 }
cparata 0:485458fca2bd 4717
cparata 0:485458fca2bd 4718 /*******************************************************************************
cparata 0:485458fca2bd 4719 * Function Name : LSM6DSL_ACC_GYRO_W_TAP_Z_EN
cparata 0:485458fca2bd 4720 * Description : Write TAP_Z_EN
cparata 0:485458fca2bd 4721 * Input : LSM6DSL_ACC_GYRO_TAP_Z_EN_t
cparata 0:485458fca2bd 4722 * Output : None
cparata 0:485458fca2bd 4723 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4724 *******************************************************************************/
cparata 0:485458fca2bd 4725 status_t LSM6DSL_ACC_GYRO_W_TAP_Z_EN(void *handle, LSM6DSL_ACC_GYRO_TAP_Z_EN_t newValue)
cparata 0:485458fca2bd 4726 {
cparata 0:485458fca2bd 4727 u8_t value;
cparata 0:485458fca2bd 4728
cparata 0:485458fca2bd 4729 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:485458fca2bd 4730 return MEMS_ERROR;
cparata 0:485458fca2bd 4731
cparata 0:485458fca2bd 4732 value &= ~LSM6DSL_ACC_GYRO_TAP_Z_EN_MASK;
cparata 0:485458fca2bd 4733 value |= newValue;
cparata 0:485458fca2bd 4734
cparata 0:485458fca2bd 4735 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:485458fca2bd 4736 return MEMS_ERROR;
cparata 0:485458fca2bd 4737
cparata 0:485458fca2bd 4738 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4739 }
cparata 0:485458fca2bd 4740
cparata 0:485458fca2bd 4741 /*******************************************************************************
cparata 0:485458fca2bd 4742 * Function Name : LSM6DSL_ACC_GYRO_R_TAP_Z_EN
cparata 0:485458fca2bd 4743 * Description : Read TAP_Z_EN
cparata 0:485458fca2bd 4744 * Input : Pointer to LSM6DSL_ACC_GYRO_TAP_Z_EN_t
cparata 0:485458fca2bd 4745 * Output : Status of TAP_Z_EN see LSM6DSL_ACC_GYRO_TAP_Z_EN_t
cparata 0:485458fca2bd 4746 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4747 *******************************************************************************/
cparata 0:485458fca2bd 4748 status_t LSM6DSL_ACC_GYRO_R_TAP_Z_EN(void *handle, LSM6DSL_ACC_GYRO_TAP_Z_EN_t *value)
cparata 0:485458fca2bd 4749 {
cparata 0:485458fca2bd 4750 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4751 return MEMS_ERROR;
cparata 0:485458fca2bd 4752
cparata 0:485458fca2bd 4753 *value &= LSM6DSL_ACC_GYRO_TAP_Z_EN_MASK; //mask
cparata 0:485458fca2bd 4754
cparata 0:485458fca2bd 4755 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4756 }
cparata 0:485458fca2bd 4757
cparata 0:485458fca2bd 4758 /*******************************************************************************
cparata 0:485458fca2bd 4759 * Function Name : LSM6DSL_ACC_GYRO_W_TAP_Y_EN
cparata 0:485458fca2bd 4760 * Description : Write TAP_Y_EN
cparata 0:485458fca2bd 4761 * Input : LSM6DSL_ACC_GYRO_TAP_Y_EN_t
cparata 0:485458fca2bd 4762 * Output : None
cparata 0:485458fca2bd 4763 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4764 *******************************************************************************/
cparata 0:485458fca2bd 4765 status_t LSM6DSL_ACC_GYRO_W_TAP_Y_EN(void *handle, LSM6DSL_ACC_GYRO_TAP_Y_EN_t newValue)
cparata 0:485458fca2bd 4766 {
cparata 0:485458fca2bd 4767 u8_t value;
cparata 0:485458fca2bd 4768
cparata 0:485458fca2bd 4769 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:485458fca2bd 4770 return MEMS_ERROR;
cparata 0:485458fca2bd 4771
cparata 0:485458fca2bd 4772 value &= ~LSM6DSL_ACC_GYRO_TAP_Y_EN_MASK;
cparata 0:485458fca2bd 4773 value |= newValue;
cparata 0:485458fca2bd 4774
cparata 0:485458fca2bd 4775 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:485458fca2bd 4776 return MEMS_ERROR;
cparata 0:485458fca2bd 4777
cparata 0:485458fca2bd 4778 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4779 }
cparata 0:485458fca2bd 4780
cparata 0:485458fca2bd 4781 /*******************************************************************************
cparata 0:485458fca2bd 4782 * Function Name : LSM6DSL_ACC_GYRO_R_TAP_Y_EN
cparata 0:485458fca2bd 4783 * Description : Read TAP_Y_EN
cparata 0:485458fca2bd 4784 * Input : Pointer to LSM6DSL_ACC_GYRO_TAP_Y_EN_t
cparata 0:485458fca2bd 4785 * Output : Status of TAP_Y_EN see LSM6DSL_ACC_GYRO_TAP_Y_EN_t
cparata 0:485458fca2bd 4786 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4787 *******************************************************************************/
cparata 0:485458fca2bd 4788 status_t LSM6DSL_ACC_GYRO_R_TAP_Y_EN(void *handle, LSM6DSL_ACC_GYRO_TAP_Y_EN_t *value)
cparata 0:485458fca2bd 4789 {
cparata 0:485458fca2bd 4790 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4791 return MEMS_ERROR;
cparata 0:485458fca2bd 4792
cparata 0:485458fca2bd 4793 *value &= LSM6DSL_ACC_GYRO_TAP_Y_EN_MASK; //mask
cparata 0:485458fca2bd 4794
cparata 0:485458fca2bd 4795 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4796 }
cparata 0:485458fca2bd 4797
cparata 0:485458fca2bd 4798 /*******************************************************************************
cparata 0:485458fca2bd 4799 * Function Name : LSM6DSL_ACC_GYRO_W_TAP_X_EN
cparata 0:485458fca2bd 4800 * Description : Write TAP_X_EN
cparata 0:485458fca2bd 4801 * Input : LSM6DSL_ACC_GYRO_TAP_X_EN_t
cparata 0:485458fca2bd 4802 * Output : None
cparata 0:485458fca2bd 4803 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4804 *******************************************************************************/
cparata 0:485458fca2bd 4805 status_t LSM6DSL_ACC_GYRO_W_TAP_X_EN(void *handle, LSM6DSL_ACC_GYRO_TAP_X_EN_t newValue)
cparata 0:485458fca2bd 4806 {
cparata 0:485458fca2bd 4807 u8_t value;
cparata 0:485458fca2bd 4808
cparata 0:485458fca2bd 4809 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:485458fca2bd 4810 return MEMS_ERROR;
cparata 0:485458fca2bd 4811
cparata 0:485458fca2bd 4812 value &= ~LSM6DSL_ACC_GYRO_TAP_X_EN_MASK;
cparata 0:485458fca2bd 4813 value |= newValue;
cparata 0:485458fca2bd 4814
cparata 0:485458fca2bd 4815 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:485458fca2bd 4816 return MEMS_ERROR;
cparata 0:485458fca2bd 4817
cparata 0:485458fca2bd 4818 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4819 }
cparata 0:485458fca2bd 4820
cparata 0:485458fca2bd 4821 /*******************************************************************************
cparata 0:485458fca2bd 4822 * Function Name : LSM6DSL_ACC_GYRO_R_TAP_X_EN
cparata 0:485458fca2bd 4823 * Description : Read TAP_X_EN
cparata 0:485458fca2bd 4824 * Input : Pointer to LSM6DSL_ACC_GYRO_TAP_X_EN_t
cparata 0:485458fca2bd 4825 * Output : Status of TAP_X_EN see LSM6DSL_ACC_GYRO_TAP_X_EN_t
cparata 0:485458fca2bd 4826 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4827 *******************************************************************************/
cparata 0:485458fca2bd 4828 status_t LSM6DSL_ACC_GYRO_R_TAP_X_EN(void *handle, LSM6DSL_ACC_GYRO_TAP_X_EN_t *value)
cparata 0:485458fca2bd 4829 {
cparata 0:485458fca2bd 4830 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4831 return MEMS_ERROR;
cparata 0:485458fca2bd 4832
cparata 0:485458fca2bd 4833 *value &= LSM6DSL_ACC_GYRO_TAP_X_EN_MASK; //mask
cparata 0:485458fca2bd 4834
cparata 0:485458fca2bd 4835 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4836 }
cparata 0:485458fca2bd 4837
cparata 0:485458fca2bd 4838 /*******************************************************************************
cparata 0:485458fca2bd 4839 * Function Name : LSM6DSL_ACC_GYRO_W_SLOPE_FDS
cparata 0:485458fca2bd 4840 * Description : Write SLOPE_FDS
cparata 0:485458fca2bd 4841 * Input : LSM6DSL_ACC_GYRO_SLOPE_FDS_t
cparata 0:485458fca2bd 4842 * Output : None
cparata 0:485458fca2bd 4843 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4844 *******************************************************************************/
cparata 0:485458fca2bd 4845 status_t LSM6DSL_ACC_GYRO_W_SLOPE_FDS(void *handle, LSM6DSL_ACC_GYRO_SLOPE_FDS_t newValue)
cparata 0:485458fca2bd 4846 {
cparata 0:485458fca2bd 4847 u8_t value;
cparata 0:485458fca2bd 4848
cparata 0:485458fca2bd 4849 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:485458fca2bd 4850 return MEMS_ERROR;
cparata 0:485458fca2bd 4851
cparata 0:485458fca2bd 4852 value &= ~LSM6DSL_ACC_GYRO_SLOPE_FDS_MASK;
cparata 0:485458fca2bd 4853 value |= newValue;
cparata 0:485458fca2bd 4854
cparata 0:485458fca2bd 4855 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:485458fca2bd 4856 return MEMS_ERROR;
cparata 0:485458fca2bd 4857
cparata 0:485458fca2bd 4858 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4859 }
cparata 0:485458fca2bd 4860
cparata 0:485458fca2bd 4861 /*******************************************************************************
cparata 0:485458fca2bd 4862 * Function Name : LSM6DSL_ACC_GYRO_R_SLOPE_FDS
cparata 0:485458fca2bd 4863 * Description : Read SLOPE_FDS
cparata 0:485458fca2bd 4864 * Input : Pointer to LSM6DSL_ACC_GYRO_SLOPE_FDS_t
cparata 0:485458fca2bd 4865 * Output : Status of SLOPE_FDS see LSM6DSL_ACC_GYRO_SLOPE_FDS_t
cparata 0:485458fca2bd 4866 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4867 *******************************************************************************/
cparata 0:485458fca2bd 4868 status_t LSM6DSL_ACC_GYRO_R_SLOPE_FDS(void *handle, LSM6DSL_ACC_GYRO_SLOPE_FDS_t *value)
cparata 0:485458fca2bd 4869 {
cparata 0:485458fca2bd 4870 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4871 return MEMS_ERROR;
cparata 0:485458fca2bd 4872
cparata 0:485458fca2bd 4873 *value &= LSM6DSL_ACC_GYRO_SLOPE_FDS_MASK; //mask
cparata 0:485458fca2bd 4874
cparata 0:485458fca2bd 4875 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4876 }
cparata 0:485458fca2bd 4877
cparata 0:485458fca2bd 4878 /*******************************************************************************
cparata 0:485458fca2bd 4879 * Function Name : LSM6DSL_ACC_GYRO_W_BASIC_INT
cparata 0:485458fca2bd 4880 * Description : Write INTERRUPTS_ENABLE
cparata 0:485458fca2bd 4881 * Input : LSM6DSL_ACC_GYRO_INT_EN_t
cparata 0:485458fca2bd 4882 * Output : None
cparata 0:485458fca2bd 4883 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4884 *******************************************************************************/
cparata 0:485458fca2bd 4885 status_t LSM6DSL_ACC_GYRO_W_BASIC_INT(void *handle, LSM6DSL_ACC_GYRO_INT_EN_t newValue)
cparata 0:485458fca2bd 4886 {
cparata 0:485458fca2bd 4887 u8_t value;
cparata 0:485458fca2bd 4888
cparata 0:485458fca2bd 4889 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:485458fca2bd 4890 return MEMS_ERROR;
cparata 0:485458fca2bd 4891
cparata 0:485458fca2bd 4892 value &= ~LSM6DSL_ACC_GYRO_INT_EN_MASK;
cparata 0:485458fca2bd 4893 value |= newValue;
cparata 0:485458fca2bd 4894
cparata 0:485458fca2bd 4895 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:485458fca2bd 4896 return MEMS_ERROR;
cparata 0:485458fca2bd 4897
cparata 0:485458fca2bd 4898 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4899 }
cparata 0:485458fca2bd 4900
cparata 0:485458fca2bd 4901 /*******************************************************************************
cparata 0:485458fca2bd 4902 * Function Name : LSM6DSL_ACC_GYRO_R_BASIC_INT
cparata 0:485458fca2bd 4903 * Description : Read INTERRUPTS_ENABLE
cparata 0:485458fca2bd 4904 * Input : Pointer to LSM6DSL_ACC_GYRO_INT_EN_t
cparata 0:485458fca2bd 4905 * Output : Status of INTERRUPTS_ENABLE see LSM6DSL_ACC_GYRO_INT_EN_t
cparata 0:485458fca2bd 4906 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4907 *******************************************************************************/
cparata 0:485458fca2bd 4908 status_t LSM6DSL_ACC_GYRO_R_BASIC_INT(void *handle, LSM6DSL_ACC_GYRO_INT_EN_t *value)
cparata 0:485458fca2bd 4909 {
cparata 0:485458fca2bd 4910 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4911 return MEMS_ERROR;
cparata 0:485458fca2bd 4912
cparata 0:485458fca2bd 4913 *value &= LSM6DSL_ACC_GYRO_INT_EN_MASK; //mask
cparata 0:485458fca2bd 4914
cparata 0:485458fca2bd 4915 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4916 }
cparata 0:485458fca2bd 4917
cparata 0:485458fca2bd 4918 /*******************************************************************************
cparata 0:485458fca2bd 4919 * Function Name : LSM6DSL_ACC_GYRO_W_TAP_THS
cparata 0:485458fca2bd 4920 * Description : Write TAP_THS
cparata 0:485458fca2bd 4921 * Input : u8_t
cparata 0:485458fca2bd 4922 * Output : None
cparata 0:485458fca2bd 4923 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4924 *******************************************************************************/
cparata 0:485458fca2bd 4925 status_t LSM6DSL_ACC_GYRO_W_TAP_THS(void *handle, u8_t newValue)
cparata 0:485458fca2bd 4926 {
cparata 0:485458fca2bd 4927 u8_t value;
cparata 0:485458fca2bd 4928
cparata 0:485458fca2bd 4929 newValue = newValue << LSM6DSL_ACC_GYRO_TAP_THS_POSITION; //mask
cparata 0:485458fca2bd 4930 newValue &= LSM6DSL_ACC_GYRO_TAP_THS_MASK; //coerce
cparata 0:485458fca2bd 4931
cparata 0:485458fca2bd 4932 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, &value, 1) )
cparata 0:485458fca2bd 4933 return MEMS_ERROR;
cparata 0:485458fca2bd 4934
cparata 0:485458fca2bd 4935 value &= ~LSM6DSL_ACC_GYRO_TAP_THS_MASK;
cparata 0:485458fca2bd 4936 value |= newValue;
cparata 0:485458fca2bd 4937
cparata 0:485458fca2bd 4938 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, &value, 1) )
cparata 0:485458fca2bd 4939 return MEMS_ERROR;
cparata 0:485458fca2bd 4940
cparata 0:485458fca2bd 4941 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4942 }
cparata 0:485458fca2bd 4943
cparata 0:485458fca2bd 4944 /*******************************************************************************
cparata 0:485458fca2bd 4945 * Function Name : LSM6DSL_ACC_GYRO_R_TAP_THS
cparata 0:485458fca2bd 4946 * Description : Read TAP_THS
cparata 0:485458fca2bd 4947 * Input : Pointer to u8_t
cparata 0:485458fca2bd 4948 * Output : Status of TAP_THS
cparata 0:485458fca2bd 4949 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4950 *******************************************************************************/
cparata 0:485458fca2bd 4951 status_t LSM6DSL_ACC_GYRO_R_TAP_THS(void *handle, u8_t *value)
cparata 0:485458fca2bd 4952 {
cparata 0:485458fca2bd 4953 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4954 return MEMS_ERROR;
cparata 0:485458fca2bd 4955
cparata 0:485458fca2bd 4956 *value &= LSM6DSL_ACC_GYRO_TAP_THS_MASK; //coerce
cparata 0:485458fca2bd 4957 *value = *value >> LSM6DSL_ACC_GYRO_TAP_THS_POSITION; //mask
cparata 0:485458fca2bd 4958
cparata 0:485458fca2bd 4959 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4960 }
cparata 0:485458fca2bd 4961
cparata 0:485458fca2bd 4962 /*******************************************************************************
cparata 0:485458fca2bd 4963 * Function Name : LSM6DSL_ACC_GYRO_W_SIXD_THS
cparata 0:485458fca2bd 4964 * Description : Write SIXD_THS
cparata 0:485458fca2bd 4965 * Input : LSM6DSL_ACC_GYRO_SIXD_THS_t
cparata 0:485458fca2bd 4966 * Output : None
cparata 0:485458fca2bd 4967 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4968 *******************************************************************************/
cparata 0:485458fca2bd 4969 status_t LSM6DSL_ACC_GYRO_W_SIXD_THS(void *handle, LSM6DSL_ACC_GYRO_SIXD_THS_t newValue)
cparata 0:485458fca2bd 4970 {
cparata 0:485458fca2bd 4971 u8_t value;
cparata 0:485458fca2bd 4972
cparata 0:485458fca2bd 4973 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, &value, 1) )
cparata 0:485458fca2bd 4974 return MEMS_ERROR;
cparata 0:485458fca2bd 4975
cparata 0:485458fca2bd 4976 value &= ~LSM6DSL_ACC_GYRO_SIXD_THS_MASK;
cparata 0:485458fca2bd 4977 value |= newValue;
cparata 0:485458fca2bd 4978
cparata 0:485458fca2bd 4979 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, &value, 1) )
cparata 0:485458fca2bd 4980 return MEMS_ERROR;
cparata 0:485458fca2bd 4981
cparata 0:485458fca2bd 4982 return MEMS_SUCCESS;
cparata 0:485458fca2bd 4983 }
cparata 0:485458fca2bd 4984
cparata 0:485458fca2bd 4985 /*******************************************************************************
cparata 0:485458fca2bd 4986 * Function Name : LSM6DSL_ACC_GYRO_R_SIXD_THS
cparata 0:485458fca2bd 4987 * Description : Read SIXD_THS
cparata 0:485458fca2bd 4988 * Input : Pointer to LSM6DSL_ACC_GYRO_SIXD_THS_t
cparata 0:485458fca2bd 4989 * Output : Status of SIXD_THS see LSM6DSL_ACC_GYRO_SIXD_THS_t
cparata 0:485458fca2bd 4990 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 4991 *******************************************************************************/
cparata 0:485458fca2bd 4992 status_t LSM6DSL_ACC_GYRO_R_SIXD_THS(void *handle, LSM6DSL_ACC_GYRO_SIXD_THS_t *value)
cparata 0:485458fca2bd 4993 {
cparata 0:485458fca2bd 4994 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, (u8_t *)value, 1) )
cparata 0:485458fca2bd 4995 return MEMS_ERROR;
cparata 0:485458fca2bd 4996
cparata 0:485458fca2bd 4997 *value &= LSM6DSL_ACC_GYRO_SIXD_THS_MASK; //mask
cparata 0:485458fca2bd 4998
cparata 0:485458fca2bd 4999 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5000 }
cparata 0:485458fca2bd 5001
cparata 0:485458fca2bd 5002 /*******************************************************************************
cparata 0:485458fca2bd 5003 * Function Name : LSM6DSL_ACC_GYRO_W_D4D
cparata 0:485458fca2bd 5004 * Description : Write D4D_EN
cparata 0:485458fca2bd 5005 * Input : LSM6DSL_ACC_GYRO_D4D_t
cparata 0:485458fca2bd 5006 * Output : None
cparata 0:485458fca2bd 5007 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5008 *******************************************************************************/
cparata 0:485458fca2bd 5009 status_t LSM6DSL_ACC_GYRO_W_D4D(void *handle, LSM6DSL_ACC_GYRO_D4D_t newValue)
cparata 0:485458fca2bd 5010 {
cparata 0:485458fca2bd 5011 u8_t value;
cparata 0:485458fca2bd 5012
cparata 0:485458fca2bd 5013 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, &value, 1) )
cparata 0:485458fca2bd 5014 return MEMS_ERROR;
cparata 0:485458fca2bd 5015
cparata 0:485458fca2bd 5016 value &= ~LSM6DSL_ACC_GYRO_D4D_MASK;
cparata 0:485458fca2bd 5017 value |= newValue;
cparata 0:485458fca2bd 5018
cparata 0:485458fca2bd 5019 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, &value, 1) )
cparata 0:485458fca2bd 5020 return MEMS_ERROR;
cparata 0:485458fca2bd 5021
cparata 0:485458fca2bd 5022 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5023 }
cparata 0:485458fca2bd 5024
cparata 0:485458fca2bd 5025 /*******************************************************************************
cparata 0:485458fca2bd 5026 * Function Name : LSM6DSL_ACC_GYRO_R_D4D
cparata 0:485458fca2bd 5027 * Description : Read D4D_EN
cparata 0:485458fca2bd 5028 * Input : Pointer to LSM6DSL_ACC_GYRO_D4D_t
cparata 0:485458fca2bd 5029 * Output : Status of D4D_EN see LSM6DSL_ACC_GYRO_D4D_t
cparata 0:485458fca2bd 5030 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5031 *******************************************************************************/
cparata 0:485458fca2bd 5032 status_t LSM6DSL_ACC_GYRO_R_D4D(void *handle, LSM6DSL_ACC_GYRO_D4D_t *value)
cparata 0:485458fca2bd 5033 {
cparata 0:485458fca2bd 5034 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, (u8_t *)value, 1) )
cparata 0:485458fca2bd 5035 return MEMS_ERROR;
cparata 0:485458fca2bd 5036
cparata 0:485458fca2bd 5037 *value &= LSM6DSL_ACC_GYRO_D4D_MASK; //mask
cparata 0:485458fca2bd 5038
cparata 0:485458fca2bd 5039 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5040 }
cparata 0:485458fca2bd 5041
cparata 0:485458fca2bd 5042 /*******************************************************************************
cparata 0:485458fca2bd 5043 * Function Name : LSM6DSL_ACC_GYRO_W_SHOCK_Duration
cparata 0:485458fca2bd 5044 * Description : Write SHOCK
cparata 0:485458fca2bd 5045 * Input : u8_t
cparata 0:485458fca2bd 5046 * Output : None
cparata 0:485458fca2bd 5047 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5048 *******************************************************************************/
cparata 0:485458fca2bd 5049 status_t LSM6DSL_ACC_GYRO_W_SHOCK_Duration(void *handle, u8_t newValue)
cparata 0:485458fca2bd 5050 {
cparata 0:485458fca2bd 5051 u8_t value;
cparata 0:485458fca2bd 5052
cparata 0:485458fca2bd 5053 newValue = newValue << LSM6DSL_ACC_GYRO_SHOCK_POSITION; //mask
cparata 0:485458fca2bd 5054 newValue &= LSM6DSL_ACC_GYRO_SHOCK_MASK; //coerce
cparata 0:485458fca2bd 5055
cparata 0:485458fca2bd 5056 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, &value, 1) )
cparata 0:485458fca2bd 5057 return MEMS_ERROR;
cparata 0:485458fca2bd 5058
cparata 0:485458fca2bd 5059 value &= ~LSM6DSL_ACC_GYRO_SHOCK_MASK;
cparata 0:485458fca2bd 5060 value |= newValue;
cparata 0:485458fca2bd 5061
cparata 0:485458fca2bd 5062 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, &value, 1) )
cparata 0:485458fca2bd 5063 return MEMS_ERROR;
cparata 0:485458fca2bd 5064
cparata 0:485458fca2bd 5065 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5066 }
cparata 0:485458fca2bd 5067
cparata 0:485458fca2bd 5068 /*******************************************************************************
cparata 0:485458fca2bd 5069 * Function Name : LSM6DSL_ACC_GYRO_R_SHOCK_Duration
cparata 0:485458fca2bd 5070 * Description : Read SHOCK
cparata 0:485458fca2bd 5071 * Input : Pointer to u8_t
cparata 0:485458fca2bd 5072 * Output : Status of SHOCK
cparata 0:485458fca2bd 5073 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5074 *******************************************************************************/
cparata 0:485458fca2bd 5075 status_t LSM6DSL_ACC_GYRO_R_SHOCK_Duration(void *handle, u8_t *value)
cparata 0:485458fca2bd 5076 {
cparata 0:485458fca2bd 5077 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, (u8_t *)value, 1) )
cparata 0:485458fca2bd 5078 return MEMS_ERROR;
cparata 0:485458fca2bd 5079
cparata 0:485458fca2bd 5080 *value &= LSM6DSL_ACC_GYRO_SHOCK_MASK; //coerce
cparata 0:485458fca2bd 5081 *value = *value >> LSM6DSL_ACC_GYRO_SHOCK_POSITION; //mask
cparata 0:485458fca2bd 5082
cparata 0:485458fca2bd 5083 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5084 }
cparata 0:485458fca2bd 5085 /*******************************************************************************
cparata 0:485458fca2bd 5086 * Function Name : LSM6DSL_ACC_GYRO_W_QUIET_Duration
cparata 0:485458fca2bd 5087 * Description : Write QUIET
cparata 0:485458fca2bd 5088 * Input : u8_t
cparata 0:485458fca2bd 5089 * Output : None
cparata 0:485458fca2bd 5090 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5091 *******************************************************************************/
cparata 0:485458fca2bd 5092 status_t LSM6DSL_ACC_GYRO_W_QUIET_Duration(void *handle, u8_t newValue)
cparata 0:485458fca2bd 5093 {
cparata 0:485458fca2bd 5094 u8_t value;
cparata 0:485458fca2bd 5095
cparata 0:485458fca2bd 5096 newValue = newValue << LSM6DSL_ACC_GYRO_QUIET_POSITION; //mask
cparata 0:485458fca2bd 5097 newValue &= LSM6DSL_ACC_GYRO_QUIET_MASK; //coerce
cparata 0:485458fca2bd 5098
cparata 0:485458fca2bd 5099 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, &value, 1) )
cparata 0:485458fca2bd 5100 return MEMS_ERROR;
cparata 0:485458fca2bd 5101
cparata 0:485458fca2bd 5102 value &= ~LSM6DSL_ACC_GYRO_QUIET_MASK;
cparata 0:485458fca2bd 5103 value |= newValue;
cparata 0:485458fca2bd 5104
cparata 0:485458fca2bd 5105 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, &value, 1) )
cparata 0:485458fca2bd 5106 return MEMS_ERROR;
cparata 0:485458fca2bd 5107
cparata 0:485458fca2bd 5108 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5109 }
cparata 0:485458fca2bd 5110
cparata 0:485458fca2bd 5111 /*******************************************************************************
cparata 0:485458fca2bd 5112 * Function Name : LSM6DSL_ACC_GYRO_R_QUIET_Duration
cparata 0:485458fca2bd 5113 * Description : Read QUIET
cparata 0:485458fca2bd 5114 * Input : Pointer to u8_t
cparata 0:485458fca2bd 5115 * Output : Status of QUIET
cparata 0:485458fca2bd 5116 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5117 *******************************************************************************/
cparata 0:485458fca2bd 5118 status_t LSM6DSL_ACC_GYRO_R_QUIET_Duration(void *handle, u8_t *value)
cparata 0:485458fca2bd 5119 {
cparata 0:485458fca2bd 5120 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, (u8_t *)value, 1) )
cparata 0:485458fca2bd 5121 return MEMS_ERROR;
cparata 0:485458fca2bd 5122
cparata 0:485458fca2bd 5123 *value &= LSM6DSL_ACC_GYRO_QUIET_MASK; //coerce
cparata 0:485458fca2bd 5124 *value = *value >> LSM6DSL_ACC_GYRO_QUIET_POSITION; //mask
cparata 0:485458fca2bd 5125
cparata 0:485458fca2bd 5126 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5127 }
cparata 0:485458fca2bd 5128
cparata 0:485458fca2bd 5129 /*******************************************************************************
cparata 0:485458fca2bd 5130 * Function Name : LSM6DSL_ACC_GYRO_W_DUR
cparata 0:485458fca2bd 5131 * Description : Write DUR
cparata 0:485458fca2bd 5132 * Input : u8_t
cparata 0:485458fca2bd 5133 * Output : None
cparata 0:485458fca2bd 5134 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5135 *******************************************************************************/
cparata 0:485458fca2bd 5136 status_t LSM6DSL_ACC_GYRO_W_DUR(void *handle, u8_t newValue)
cparata 0:485458fca2bd 5137 {
cparata 0:485458fca2bd 5138 u8_t value;
cparata 0:485458fca2bd 5139
cparata 0:485458fca2bd 5140 newValue = newValue << LSM6DSL_ACC_GYRO_DUR_POSITION; //mask
cparata 0:485458fca2bd 5141 newValue &= LSM6DSL_ACC_GYRO_DUR_MASK; //coerce
cparata 0:485458fca2bd 5142
cparata 0:485458fca2bd 5143 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, &value, 1) )
cparata 0:485458fca2bd 5144 return MEMS_ERROR;
cparata 0:485458fca2bd 5145
cparata 0:485458fca2bd 5146 value &= ~LSM6DSL_ACC_GYRO_DUR_MASK;
cparata 0:485458fca2bd 5147 value |= newValue;
cparata 0:485458fca2bd 5148
cparata 0:485458fca2bd 5149 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, &value, 1) )
cparata 0:485458fca2bd 5150 return MEMS_ERROR;
cparata 0:485458fca2bd 5151
cparata 0:485458fca2bd 5152 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5153 }
cparata 0:485458fca2bd 5154
cparata 0:485458fca2bd 5155 /*******************************************************************************
cparata 0:485458fca2bd 5156 * Function Name : LSM6DSL_ACC_GYRO_R_DUR
cparata 0:485458fca2bd 5157 * Description : Read DUR
cparata 0:485458fca2bd 5158 * Input : Pointer to u8_t
cparata 0:485458fca2bd 5159 * Output : Status of DUR
cparata 0:485458fca2bd 5160 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5161 *******************************************************************************/
cparata 0:485458fca2bd 5162 status_t LSM6DSL_ACC_GYRO_R_DUR(void *handle, u8_t *value)
cparata 0:485458fca2bd 5163 {
cparata 0:485458fca2bd 5164 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, (u8_t *)value, 1) )
cparata 0:485458fca2bd 5165 return MEMS_ERROR;
cparata 0:485458fca2bd 5166
cparata 0:485458fca2bd 5167 *value &= LSM6DSL_ACC_GYRO_DUR_MASK; //coerce
cparata 0:485458fca2bd 5168 *value = *value >> LSM6DSL_ACC_GYRO_DUR_POSITION; //mask
cparata 0:485458fca2bd 5169
cparata 0:485458fca2bd 5170 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5171 }
cparata 0:485458fca2bd 5172
cparata 0:485458fca2bd 5173 /*******************************************************************************
cparata 0:485458fca2bd 5174 * Function Name : LSM6DSL_ACC_GYRO_W_WK_THS
cparata 0:485458fca2bd 5175 * Description : Write WK_THS
cparata 0:485458fca2bd 5176 * Input : u8_t
cparata 0:485458fca2bd 5177 * Output : None
cparata 0:485458fca2bd 5178 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5179 *******************************************************************************/
cparata 0:485458fca2bd 5180 status_t LSM6DSL_ACC_GYRO_W_WK_THS(void *handle, u8_t newValue)
cparata 0:485458fca2bd 5181 {
cparata 0:485458fca2bd 5182 u8_t value;
cparata 0:485458fca2bd 5183
cparata 0:485458fca2bd 5184 newValue = newValue << LSM6DSL_ACC_GYRO_WK_THS_POSITION; //mask
cparata 0:485458fca2bd 5185 newValue &= LSM6DSL_ACC_GYRO_WK_THS_MASK; //coerce
cparata 0:485458fca2bd 5186
cparata 0:485458fca2bd 5187 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_THS, &value, 1) )
cparata 0:485458fca2bd 5188 return MEMS_ERROR;
cparata 0:485458fca2bd 5189
cparata 0:485458fca2bd 5190 value &= ~LSM6DSL_ACC_GYRO_WK_THS_MASK;
cparata 0:485458fca2bd 5191 value |= newValue;
cparata 0:485458fca2bd 5192
cparata 0:485458fca2bd 5193 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_THS, &value, 1) )
cparata 0:485458fca2bd 5194 return MEMS_ERROR;
cparata 0:485458fca2bd 5195
cparata 0:485458fca2bd 5196 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5197 }
cparata 0:485458fca2bd 5198
cparata 0:485458fca2bd 5199 /*******************************************************************************
cparata 0:485458fca2bd 5200 * Function Name : LSM6DSL_ACC_GYRO_R_WK_THS
cparata 0:485458fca2bd 5201 * Description : Read WK_THS
cparata 0:485458fca2bd 5202 * Input : Pointer to u8_t
cparata 0:485458fca2bd 5203 * Output : Status of WK_THS
cparata 0:485458fca2bd 5204 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5205 *******************************************************************************/
cparata 0:485458fca2bd 5206 status_t LSM6DSL_ACC_GYRO_R_WK_THS(void *handle, u8_t *value)
cparata 0:485458fca2bd 5207 {
cparata 0:485458fca2bd 5208 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_THS, (u8_t *)value, 1) )
cparata 0:485458fca2bd 5209 return MEMS_ERROR;
cparata 0:485458fca2bd 5210
cparata 0:485458fca2bd 5211 *value &= LSM6DSL_ACC_GYRO_WK_THS_MASK; //coerce
cparata 0:485458fca2bd 5212 *value = *value >> LSM6DSL_ACC_GYRO_WK_THS_POSITION; //mask
cparata 0:485458fca2bd 5213
cparata 0:485458fca2bd 5214 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5215 }
cparata 0:485458fca2bd 5216
cparata 0:485458fca2bd 5217 /*******************************************************************************
cparata 0:485458fca2bd 5218 * Function Name : LSM6DSL_ACC_GYRO_W_SINGLE_DOUBLE_TAP_EV
cparata 0:485458fca2bd 5219 * Description : Write SINGLE_DOUBLE_TAP
cparata 0:485458fca2bd 5220 * Input : LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_t
cparata 0:485458fca2bd 5221 * Output : None
cparata 0:485458fca2bd 5222 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5223 *******************************************************************************/
cparata 0:485458fca2bd 5224 status_t LSM6DSL_ACC_GYRO_W_SINGLE_DOUBLE_TAP_EV(void *handle, LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_t newValue)
cparata 0:485458fca2bd 5225 {
cparata 0:485458fca2bd 5226 u8_t value;
cparata 0:485458fca2bd 5227
cparata 0:485458fca2bd 5228 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_THS, &value, 1) )
cparata 0:485458fca2bd 5229 return MEMS_ERROR;
cparata 0:485458fca2bd 5230
cparata 0:485458fca2bd 5231 value &= ~LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_MASK;
cparata 0:485458fca2bd 5232 value |= newValue;
cparata 0:485458fca2bd 5233
cparata 0:485458fca2bd 5234 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_THS, &value, 1) )
cparata 0:485458fca2bd 5235 return MEMS_ERROR;
cparata 0:485458fca2bd 5236
cparata 0:485458fca2bd 5237 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5238 }
cparata 0:485458fca2bd 5239
cparata 0:485458fca2bd 5240 /*******************************************************************************
cparata 0:485458fca2bd 5241 * Function Name : LSM6DSL_ACC_GYRO_R_SINGLE_DOUBLE_TAP_EV
cparata 0:485458fca2bd 5242 * Description : Read SINGLE_DOUBLE_TAP
cparata 0:485458fca2bd 5243 * Input : Pointer to LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_t
cparata 0:485458fca2bd 5244 * Output : Status of SINGLE_DOUBLE_TAP see LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_t
cparata 0:485458fca2bd 5245 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5246 *******************************************************************************/
cparata 0:485458fca2bd 5247 status_t LSM6DSL_ACC_GYRO_R_SINGLE_DOUBLE_TAP_EV(void *handle, LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_t *value)
cparata 0:485458fca2bd 5248 {
cparata 0:485458fca2bd 5249 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_THS, (u8_t *)value, 1) )
cparata 0:485458fca2bd 5250 return MEMS_ERROR;
cparata 0:485458fca2bd 5251
cparata 0:485458fca2bd 5252 *value &= LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_MASK; //mask
cparata 0:485458fca2bd 5253
cparata 0:485458fca2bd 5254 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5255 }
cparata 0:485458fca2bd 5256
cparata 0:485458fca2bd 5257 /*******************************************************************************
cparata 0:485458fca2bd 5258 * Function Name : LSM6DSL_ACC_GYRO_W_SLEEP_DUR
cparata 0:485458fca2bd 5259 * Description : Write SLEEP_DUR
cparata 0:485458fca2bd 5260 * Input : u8_t
cparata 0:485458fca2bd 5261 * Output : None
cparata 0:485458fca2bd 5262 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5263 *******************************************************************************/
cparata 0:485458fca2bd 5264 status_t LSM6DSL_ACC_GYRO_W_SLEEP_DUR(void *handle, u8_t newValue)
cparata 0:485458fca2bd 5265 {
cparata 0:485458fca2bd 5266 u8_t value;
cparata 0:485458fca2bd 5267
cparata 0:485458fca2bd 5268 newValue = newValue << LSM6DSL_ACC_GYRO_SLEEP_DUR_POSITION; //mask
cparata 0:485458fca2bd 5269 newValue &= LSM6DSL_ACC_GYRO_SLEEP_DUR_MASK; //coerce
cparata 0:485458fca2bd 5270
cparata 0:485458fca2bd 5271 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
cparata 0:485458fca2bd 5272 return MEMS_ERROR;
cparata 0:485458fca2bd 5273
cparata 0:485458fca2bd 5274 value &= ~LSM6DSL_ACC_GYRO_SLEEP_DUR_MASK;
cparata 0:485458fca2bd 5275 value |= newValue;
cparata 0:485458fca2bd 5276
cparata 0:485458fca2bd 5277 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
cparata 0:485458fca2bd 5278 return MEMS_ERROR;
cparata 0:485458fca2bd 5279
cparata 0:485458fca2bd 5280 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5281 }
cparata 0:485458fca2bd 5282
cparata 0:485458fca2bd 5283 /*******************************************************************************
cparata 0:485458fca2bd 5284 * Function Name : LSM6DSL_ACC_GYRO_R_SLEEP_DUR
cparata 0:485458fca2bd 5285 * Description : Read SLEEP_DUR
cparata 0:485458fca2bd 5286 * Input : Pointer to u8_t
cparata 0:485458fca2bd 5287 * Output : Status of SLEEP_DUR
cparata 0:485458fca2bd 5288 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5289 *******************************************************************************/
cparata 0:485458fca2bd 5290 status_t LSM6DSL_ACC_GYRO_R_SLEEP_DUR(void *handle, u8_t *value)
cparata 0:485458fca2bd 5291 {
cparata 0:485458fca2bd 5292 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, (u8_t *)value, 1) )
cparata 0:485458fca2bd 5293 return MEMS_ERROR;
cparata 0:485458fca2bd 5294
cparata 0:485458fca2bd 5295 *value &= LSM6DSL_ACC_GYRO_SLEEP_DUR_MASK; //coerce
cparata 0:485458fca2bd 5296 *value = *value >> LSM6DSL_ACC_GYRO_SLEEP_DUR_POSITION; //mask
cparata 0:485458fca2bd 5297
cparata 0:485458fca2bd 5298 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5299 }
cparata 0:485458fca2bd 5300
cparata 0:485458fca2bd 5301 /*******************************************************************************
cparata 0:485458fca2bd 5302 * Function Name : LSM6DSL_ACC_GYRO_W_TIMER_HR
cparata 0:485458fca2bd 5303 * Description : Write TIMER_HR
cparata 0:485458fca2bd 5304 * Input : LSM6DSL_ACC_GYRO_TIMER_HR_t
cparata 0:485458fca2bd 5305 * Output : None
cparata 0:485458fca2bd 5306 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5307 *******************************************************************************/
cparata 0:485458fca2bd 5308 status_t LSM6DSL_ACC_GYRO_W_TIMER_HR(void *handle, LSM6DSL_ACC_GYRO_TIMER_HR_t newValue)
cparata 0:485458fca2bd 5309 {
cparata 0:485458fca2bd 5310 u8_t value;
cparata 0:485458fca2bd 5311
cparata 0:485458fca2bd 5312 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
cparata 0:485458fca2bd 5313 return MEMS_ERROR;
cparata 0:485458fca2bd 5314
cparata 0:485458fca2bd 5315 value &= ~LSM6DSL_ACC_GYRO_TIMER_HR_MASK;
cparata 0:485458fca2bd 5316 value |= newValue;
cparata 0:485458fca2bd 5317
cparata 0:485458fca2bd 5318 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
cparata 0:485458fca2bd 5319 return MEMS_ERROR;
cparata 0:485458fca2bd 5320
cparata 0:485458fca2bd 5321 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5322 }
cparata 0:485458fca2bd 5323
cparata 0:485458fca2bd 5324 /*******************************************************************************
cparata 0:485458fca2bd 5325 * Function Name : LSM6DSL_ACC_GYRO_R_TIMER_HR
cparata 0:485458fca2bd 5326 * Description : Read TIMER_HR
cparata 0:485458fca2bd 5327 * Input : Pointer to LSM6DSL_ACC_GYRO_TIMER_HR_t
cparata 0:485458fca2bd 5328 * Output : Status of TIMER_HR see LSM6DSL_ACC_GYRO_TIMER_HR_t
cparata 0:485458fca2bd 5329 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5330 *******************************************************************************/
cparata 0:485458fca2bd 5331 status_t LSM6DSL_ACC_GYRO_R_TIMER_HR(void *handle, LSM6DSL_ACC_GYRO_TIMER_HR_t *value)
cparata 0:485458fca2bd 5332 {
cparata 0:485458fca2bd 5333 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, (u8_t *)value, 1) )
cparata 0:485458fca2bd 5334 return MEMS_ERROR;
cparata 0:485458fca2bd 5335
cparata 0:485458fca2bd 5336 *value &= LSM6DSL_ACC_GYRO_TIMER_HR_MASK; //mask
cparata 0:485458fca2bd 5337
cparata 0:485458fca2bd 5338 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5339 }
cparata 0:485458fca2bd 5340
cparata 0:485458fca2bd 5341 /*******************************************************************************
cparata 0:485458fca2bd 5342 * Function Name : LSM6DSL_ACC_GYRO_W_WAKE_DUR
cparata 0:485458fca2bd 5343 * Description : Write WAKE_DUR
cparata 0:485458fca2bd 5344 * Input : u8_t
cparata 0:485458fca2bd 5345 * Output : None
cparata 0:485458fca2bd 5346 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5347 *******************************************************************************/
cparata 0:485458fca2bd 5348 status_t LSM6DSL_ACC_GYRO_W_WAKE_DUR(void *handle, u8_t newValue)
cparata 0:485458fca2bd 5349 {
cparata 0:485458fca2bd 5350 u8_t value;
cparata 0:485458fca2bd 5351
cparata 0:485458fca2bd 5352 newValue = newValue << LSM6DSL_ACC_GYRO_WAKE_DUR_POSITION; //mask
cparata 0:485458fca2bd 5353 newValue &= LSM6DSL_ACC_GYRO_WAKE_DUR_MASK; //coerce
cparata 0:485458fca2bd 5354
cparata 0:485458fca2bd 5355 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
cparata 0:485458fca2bd 5356 return MEMS_ERROR;
cparata 0:485458fca2bd 5357
cparata 0:485458fca2bd 5358 value &= ~LSM6DSL_ACC_GYRO_WAKE_DUR_MASK;
cparata 0:485458fca2bd 5359 value |= newValue;
cparata 0:485458fca2bd 5360
cparata 0:485458fca2bd 5361 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
cparata 0:485458fca2bd 5362 return MEMS_ERROR;
cparata 0:485458fca2bd 5363
cparata 0:485458fca2bd 5364 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5365 }
cparata 0:485458fca2bd 5366
cparata 0:485458fca2bd 5367 /*******************************************************************************
cparata 0:485458fca2bd 5368 * Function Name : LSM6DSL_ACC_GYRO_R_WAKE_DUR
cparata 0:485458fca2bd 5369 * Description : Read WAKE_DUR
cparata 0:485458fca2bd 5370 * Input : Pointer to u8_t
cparata 0:485458fca2bd 5371 * Output : Status of WAKE_DUR
cparata 0:485458fca2bd 5372 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5373 *******************************************************************************/
cparata 0:485458fca2bd 5374 status_t LSM6DSL_ACC_GYRO_R_WAKE_DUR(void *handle, u8_t *value)
cparata 0:485458fca2bd 5375 {
cparata 0:485458fca2bd 5376 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, (u8_t *)value, 1) )
cparata 0:485458fca2bd 5377 return MEMS_ERROR;
cparata 0:485458fca2bd 5378
cparata 0:485458fca2bd 5379 *value &= LSM6DSL_ACC_GYRO_WAKE_DUR_MASK; //coerce
cparata 0:485458fca2bd 5380 *value = *value >> LSM6DSL_ACC_GYRO_WAKE_DUR_POSITION; //mask
cparata 0:485458fca2bd 5381
cparata 0:485458fca2bd 5382 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5383 }
cparata 0:485458fca2bd 5384
cparata 0:485458fca2bd 5385 /*******************************************************************************
cparata 0:485458fca2bd 5386 * Function Name : LSM6DSL_ACC_GYRO_W_FF_THS
cparata 0:485458fca2bd 5387 * Description : Write FF_THS
cparata 0:485458fca2bd 5388 * Input : LSM6DSL_ACC_GYRO_FF_THS_t
cparata 0:485458fca2bd 5389 * Output : None
cparata 0:485458fca2bd 5390 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5391 *******************************************************************************/
cparata 0:485458fca2bd 5392 status_t LSM6DSL_ACC_GYRO_W_FF_THS(void *handle, LSM6DSL_ACC_GYRO_FF_THS_t newValue)
cparata 0:485458fca2bd 5393 {
cparata 0:485458fca2bd 5394 u8_t value;
cparata 0:485458fca2bd 5395
cparata 0:485458fca2bd 5396 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FREE_FALL, &value, 1) )
cparata 0:485458fca2bd 5397 return MEMS_ERROR;
cparata 0:485458fca2bd 5398
cparata 0:485458fca2bd 5399 value &= ~LSM6DSL_ACC_GYRO_FF_THS_MASK;
cparata 0:485458fca2bd 5400 value |= newValue;
cparata 0:485458fca2bd 5401
cparata 0:485458fca2bd 5402 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FREE_FALL, &value, 1) )
cparata 0:485458fca2bd 5403 return MEMS_ERROR;
cparata 0:485458fca2bd 5404
cparata 0:485458fca2bd 5405 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5406 }
cparata 0:485458fca2bd 5407
cparata 0:485458fca2bd 5408 /*******************************************************************************
cparata 0:485458fca2bd 5409 * Function Name : LSM6DSL_ACC_GYRO_R_FF_THS
cparata 0:485458fca2bd 5410 * Description : Read FF_THS
cparata 0:485458fca2bd 5411 * Input : Pointer to LSM6DSL_ACC_GYRO_FF_THS_t
cparata 0:485458fca2bd 5412 * Output : Status of FF_THS see LSM6DSL_ACC_GYRO_FF_THS_t
cparata 0:485458fca2bd 5413 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5414 *******************************************************************************/
cparata 0:485458fca2bd 5415 status_t LSM6DSL_ACC_GYRO_R_FF_THS(void *handle, LSM6DSL_ACC_GYRO_FF_THS_t *value)
cparata 0:485458fca2bd 5416 {
cparata 0:485458fca2bd 5417 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FREE_FALL, (u8_t *)value, 1) )
cparata 0:485458fca2bd 5418 return MEMS_ERROR;
cparata 0:485458fca2bd 5419
cparata 0:485458fca2bd 5420 *value &= LSM6DSL_ACC_GYRO_FF_THS_MASK; //mask
cparata 0:485458fca2bd 5421
cparata 0:485458fca2bd 5422 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5423 }
cparata 0:485458fca2bd 5424
cparata 0:485458fca2bd 5425 /*******************************************************************************
cparata 0:485458fca2bd 5426 * Function Name : LSM6DSL_ACC_GYRO_W_FF_Duration
cparata 0:485458fca2bd 5427 * Description : Write FF_DUR
cparata 0:485458fca2bd 5428 * Input : u8_t
cparata 0:485458fca2bd 5429 * Output : None
cparata 0:485458fca2bd 5430 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5431 *******************************************************************************/
cparata 0:485458fca2bd 5432 status_t LSM6DSL_ACC_GYRO_W_FF_Duration(void *handle, u8_t newValue)
cparata 0:485458fca2bd 5433 {
cparata 0:485458fca2bd 5434 u8_t valueH, valueL;
cparata 0:485458fca2bd 5435 u8_t value;
cparata 0:485458fca2bd 5436
cparata 0:485458fca2bd 5437 valueL = newValue & 0x1F;
cparata 0:485458fca2bd 5438 valueH = (newValue >> 5) & 0x1;
cparata 0:485458fca2bd 5439
cparata 0:485458fca2bd 5440 /* Low part in FREE_FALL reg */
cparata 0:485458fca2bd 5441 valueL = valueL << LSM6DSL_ACC_GYRO_FF_FREE_FALL_DUR_POSITION; //mask
cparata 0:485458fca2bd 5442 valueL &= LSM6DSL_ACC_GYRO_FF_FREE_FALL_DUR_MASK; //coerce
cparata 0:485458fca2bd 5443
cparata 0:485458fca2bd 5444 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FREE_FALL, &value, 1) )
cparata 0:485458fca2bd 5445 return MEMS_ERROR;
cparata 0:485458fca2bd 5446
cparata 0:485458fca2bd 5447 value &= ~LSM6DSL_ACC_GYRO_FF_FREE_FALL_DUR_MASK;
cparata 0:485458fca2bd 5448 value |= valueL;
cparata 0:485458fca2bd 5449
cparata 0:485458fca2bd 5450 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FREE_FALL, &value, 1) )
cparata 0:485458fca2bd 5451 return MEMS_ERROR;
cparata 0:485458fca2bd 5452
cparata 0:485458fca2bd 5453 /* High part in WAKE_UP_DUR reg */
cparata 0:485458fca2bd 5454 valueH = valueH << LSM6DSL_ACC_GYRO_FF_WAKE_UP_DUR_POSITION; //mask
cparata 0:485458fca2bd 5455 valueH &= LSM6DSL_ACC_GYRO_FF_WAKE_UP_DUR_MASK; //coerce
cparata 0:485458fca2bd 5456
cparata 0:485458fca2bd 5457 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
cparata 0:485458fca2bd 5458 return MEMS_ERROR;
cparata 0:485458fca2bd 5459
cparata 0:485458fca2bd 5460 value &= ~LSM6DSL_ACC_GYRO_FF_WAKE_UP_DUR_MASK;
cparata 0:485458fca2bd 5461 value |= valueH;
cparata 0:485458fca2bd 5462
cparata 0:485458fca2bd 5463 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
cparata 0:485458fca2bd 5464 return MEMS_ERROR;
cparata 0:485458fca2bd 5465
cparata 0:485458fca2bd 5466 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5467 }
cparata 0:485458fca2bd 5468
cparata 0:485458fca2bd 5469 /*******************************************************************************
cparata 0:485458fca2bd 5470 * Function Name : LSM6DSL_ACC_GYRO_R_FF_Duration
cparata 0:485458fca2bd 5471 * Description : Read FF_DUR
cparata 0:485458fca2bd 5472 * Input : Pointer to u8_t
cparata 0:485458fca2bd 5473 * Output : Status of FF_DUR
cparata 0:485458fca2bd 5474 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5475 *******************************************************************************/
cparata 0:485458fca2bd 5476 status_t LSM6DSL_ACC_GYRO_R_FF_Duration(void *handle, u8_t *value)
cparata 0:485458fca2bd 5477 {
cparata 0:485458fca2bd 5478 u8_t valueH, valueL;
cparata 0:485458fca2bd 5479
cparata 0:485458fca2bd 5480 /* Low part from FREE_FALL reg */
cparata 0:485458fca2bd 5481 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FREE_FALL, (u8_t *)&valueL, 1) )
cparata 0:485458fca2bd 5482 return MEMS_ERROR;
cparata 0:485458fca2bd 5483
cparata 0:485458fca2bd 5484 valueL &= LSM6DSL_ACC_GYRO_FF_FREE_FALL_DUR_MASK; //coerce
cparata 0:485458fca2bd 5485 valueL = valueL >> LSM6DSL_ACC_GYRO_FF_FREE_FALL_DUR_POSITION; //mask
cparata 0:485458fca2bd 5486
cparata 0:485458fca2bd 5487 /* High part from WAKE_UP_DUR reg */
cparata 0:485458fca2bd 5488 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, (u8_t *)&valueH, 1) )
cparata 0:485458fca2bd 5489 return MEMS_ERROR;
cparata 0:485458fca2bd 5490
cparata 0:485458fca2bd 5491 valueH &= LSM6DSL_ACC_GYRO_FF_WAKE_UP_DUR_MASK; //coerce
cparata 0:485458fca2bd 5492 valueH = valueH >> LSM6DSL_ACC_GYRO_FF_WAKE_UP_DUR_POSITION; //mask
cparata 0:485458fca2bd 5493
cparata 0:485458fca2bd 5494 *value = ((valueH << 5) & 0x20) | valueL;
cparata 0:485458fca2bd 5495
cparata 0:485458fca2bd 5496 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5497 }
cparata 0:485458fca2bd 5498
cparata 0:485458fca2bd 5499 /*******************************************************************************
cparata 0:485458fca2bd 5500 * Function Name : LSM6DSL_ACC_GYRO_W_TimerEvRouteInt1
cparata 0:485458fca2bd 5501 * Description : Write INT1_TIMER
cparata 0:485458fca2bd 5502 * Input : LSM6DSL_ACC_GYRO_INT1_TIMER_t
cparata 0:485458fca2bd 5503 * Output : None
cparata 0:485458fca2bd 5504 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5505 *******************************************************************************/
cparata 0:485458fca2bd 5506 status_t LSM6DSL_ACC_GYRO_W_TimerEvRouteInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_TIMER_t newValue)
cparata 0:485458fca2bd 5507 {
cparata 0:485458fca2bd 5508 u8_t value;
cparata 0:485458fca2bd 5509
cparata 0:485458fca2bd 5510 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:485458fca2bd 5511 return MEMS_ERROR;
cparata 0:485458fca2bd 5512
cparata 0:485458fca2bd 5513 value &= ~LSM6DSL_ACC_GYRO_INT1_TIMER_MASK;
cparata 0:485458fca2bd 5514 value |= newValue;
cparata 0:485458fca2bd 5515
cparata 0:485458fca2bd 5516 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:485458fca2bd 5517 return MEMS_ERROR;
cparata 0:485458fca2bd 5518
cparata 0:485458fca2bd 5519 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5520 }
cparata 0:485458fca2bd 5521
cparata 0:485458fca2bd 5522 /*******************************************************************************
cparata 0:485458fca2bd 5523 * Function Name : LSM6DSL_ACC_GYRO_R_TimerEvRouteInt1
cparata 0:485458fca2bd 5524 * Description : Read INT1_TIMER
cparata 0:485458fca2bd 5525 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_TIMER_t
cparata 0:485458fca2bd 5526 * Output : Status of INT1_TIMER see LSM6DSL_ACC_GYRO_INT1_TIMER_t
cparata 0:485458fca2bd 5527 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5528 *******************************************************************************/
cparata 0:485458fca2bd 5529 status_t LSM6DSL_ACC_GYRO_R_TimerEvRouteInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_TIMER_t *value)
cparata 0:485458fca2bd 5530 {
cparata 0:485458fca2bd 5531 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
cparata 0:485458fca2bd 5532 return MEMS_ERROR;
cparata 0:485458fca2bd 5533
cparata 0:485458fca2bd 5534 *value &= LSM6DSL_ACC_GYRO_INT1_TIMER_MASK; //mask
cparata 0:485458fca2bd 5535
cparata 0:485458fca2bd 5536 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5537 }
cparata 0:485458fca2bd 5538
cparata 0:485458fca2bd 5539 /*******************************************************************************
cparata 0:485458fca2bd 5540 * Function Name : LSM6DSL_ACC_GYRO_W_TiltEvOnInt1
cparata 0:485458fca2bd 5541 * Description : Write INT1_TILT
cparata 0:485458fca2bd 5542 * Input : LSM6DSL_ACC_GYRO_INT1_TILT_t
cparata 0:485458fca2bd 5543 * Output : None
cparata 0:485458fca2bd 5544 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5545 *******************************************************************************/
cparata 0:485458fca2bd 5546 status_t LSM6DSL_ACC_GYRO_W_TiltEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_TILT_t newValue)
cparata 0:485458fca2bd 5547 {
cparata 0:485458fca2bd 5548 u8_t value;
cparata 0:485458fca2bd 5549
cparata 0:485458fca2bd 5550 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:485458fca2bd 5551 return MEMS_ERROR;
cparata 0:485458fca2bd 5552
cparata 0:485458fca2bd 5553 value &= ~LSM6DSL_ACC_GYRO_INT1_TILT_MASK;
cparata 0:485458fca2bd 5554 value |= newValue;
cparata 0:485458fca2bd 5555
cparata 0:485458fca2bd 5556 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:485458fca2bd 5557 return MEMS_ERROR;
cparata 0:485458fca2bd 5558
cparata 0:485458fca2bd 5559 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5560 }
cparata 0:485458fca2bd 5561
cparata 0:485458fca2bd 5562 /*******************************************************************************
cparata 0:485458fca2bd 5563 * Function Name : LSM6DSL_ACC_GYRO_R_TiltEvOnInt1
cparata 0:485458fca2bd 5564 * Description : Read INT1_TILT
cparata 0:485458fca2bd 5565 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_TILT_t
cparata 0:485458fca2bd 5566 * Output : Status of INT1_TILT see LSM6DSL_ACC_GYRO_INT1_TILT_t
cparata 0:485458fca2bd 5567 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5568 *******************************************************************************/
cparata 0:485458fca2bd 5569 status_t LSM6DSL_ACC_GYRO_R_TiltEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_TILT_t *value)
cparata 0:485458fca2bd 5570 {
cparata 0:485458fca2bd 5571 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
cparata 0:485458fca2bd 5572 return MEMS_ERROR;
cparata 0:485458fca2bd 5573
cparata 0:485458fca2bd 5574 *value &= LSM6DSL_ACC_GYRO_INT1_TILT_MASK; //mask
cparata 0:485458fca2bd 5575
cparata 0:485458fca2bd 5576 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5577 }
cparata 0:485458fca2bd 5578
cparata 0:485458fca2bd 5579 /*******************************************************************************
cparata 0:485458fca2bd 5580 * Function Name : LSM6DSL_ACC_GYRO_W_6DEvOnInt1
cparata 0:485458fca2bd 5581 * Description : Write INT1_6D
cparata 0:485458fca2bd 5582 * Input : LSM6DSL_ACC_GYRO_INT1_6D_t
cparata 0:485458fca2bd 5583 * Output : None
cparata 0:485458fca2bd 5584 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5585 *******************************************************************************/
cparata 0:485458fca2bd 5586 status_t LSM6DSL_ACC_GYRO_W_6DEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_6D_t newValue)
cparata 0:485458fca2bd 5587 {
cparata 0:485458fca2bd 5588 u8_t value;
cparata 0:485458fca2bd 5589
cparata 0:485458fca2bd 5590 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:485458fca2bd 5591 return MEMS_ERROR;
cparata 0:485458fca2bd 5592
cparata 0:485458fca2bd 5593 value &= ~LSM6DSL_ACC_GYRO_INT1_6D_MASK;
cparata 0:485458fca2bd 5594 value |= newValue;
cparata 0:485458fca2bd 5595
cparata 0:485458fca2bd 5596 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:485458fca2bd 5597 return MEMS_ERROR;
cparata 0:485458fca2bd 5598
cparata 0:485458fca2bd 5599 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5600 }
cparata 0:485458fca2bd 5601
cparata 0:485458fca2bd 5602 /*******************************************************************************
cparata 0:485458fca2bd 5603 * Function Name : LSM6DSL_ACC_GYRO_R_6DEvOnInt1
cparata 0:485458fca2bd 5604 * Description : Read INT1_6D
cparata 0:485458fca2bd 5605 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_6D_t
cparata 0:485458fca2bd 5606 * Output : Status of INT1_6D see LSM6DSL_ACC_GYRO_INT1_6D_t
cparata 0:485458fca2bd 5607 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5608 *******************************************************************************/
cparata 0:485458fca2bd 5609 status_t LSM6DSL_ACC_GYRO_R_6DEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_6D_t *value)
cparata 0:485458fca2bd 5610 {
cparata 0:485458fca2bd 5611 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
cparata 0:485458fca2bd 5612 return MEMS_ERROR;
cparata 0:485458fca2bd 5613
cparata 0:485458fca2bd 5614 *value &= LSM6DSL_ACC_GYRO_INT1_6D_MASK; //mask
cparata 0:485458fca2bd 5615
cparata 0:485458fca2bd 5616 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5617 }
cparata 0:485458fca2bd 5618
cparata 0:485458fca2bd 5619 /*******************************************************************************
cparata 0:485458fca2bd 5620 * Function Name : LSM6DSL_ACC_GYRO_W_TapEvOnInt1
cparata 0:485458fca2bd 5621 * Description : Write INT1_TAP
cparata 0:485458fca2bd 5622 * Input : LSM6DSL_ACC_GYRO_INT1_TAP_t
cparata 0:485458fca2bd 5623 * Output : None
cparata 0:485458fca2bd 5624 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5625 *******************************************************************************/
cparata 0:485458fca2bd 5626 status_t LSM6DSL_ACC_GYRO_W_TapEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_TAP_t newValue)
cparata 0:485458fca2bd 5627 {
cparata 0:485458fca2bd 5628 u8_t value;
cparata 0:485458fca2bd 5629
cparata 0:485458fca2bd 5630 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:485458fca2bd 5631 return MEMS_ERROR;
cparata 0:485458fca2bd 5632
cparata 0:485458fca2bd 5633 value &= ~LSM6DSL_ACC_GYRO_INT1_TAP_MASK;
cparata 0:485458fca2bd 5634 value |= newValue;
cparata 0:485458fca2bd 5635
cparata 0:485458fca2bd 5636 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:485458fca2bd 5637 return MEMS_ERROR;
cparata 0:485458fca2bd 5638
cparata 0:485458fca2bd 5639 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5640 }
cparata 0:485458fca2bd 5641
cparata 0:485458fca2bd 5642 /*******************************************************************************
cparata 0:485458fca2bd 5643 * Function Name : LSM6DSL_ACC_GYRO_R_TapEvOnInt1
cparata 0:485458fca2bd 5644 * Description : Read INT1_TAP
cparata 0:485458fca2bd 5645 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_TAP_t
cparata 0:485458fca2bd 5646 * Output : Status of INT1_TAP see LSM6DSL_ACC_GYRO_INT1_TAP_t
cparata 0:485458fca2bd 5647 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5648 *******************************************************************************/
cparata 0:485458fca2bd 5649 status_t LSM6DSL_ACC_GYRO_R_TapEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_TAP_t *value)
cparata 0:485458fca2bd 5650 {
cparata 0:485458fca2bd 5651 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
cparata 0:485458fca2bd 5652 return MEMS_ERROR;
cparata 0:485458fca2bd 5653
cparata 0:485458fca2bd 5654 *value &= LSM6DSL_ACC_GYRO_INT1_TAP_MASK; //mask
cparata 0:485458fca2bd 5655
cparata 0:485458fca2bd 5656 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5657 }
cparata 0:485458fca2bd 5658
cparata 0:485458fca2bd 5659 /*******************************************************************************
cparata 0:485458fca2bd 5660 * Function Name : LSM6DSL_ACC_GYRO_W_FFEvOnInt1
cparata 0:485458fca2bd 5661 * Description : Write INT1_FF
cparata 0:485458fca2bd 5662 * Input : LSM6DSL_ACC_GYRO_INT1_FF_t
cparata 0:485458fca2bd 5663 * Output : None
cparata 0:485458fca2bd 5664 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5665 *******************************************************************************/
cparata 0:485458fca2bd 5666 status_t LSM6DSL_ACC_GYRO_W_FFEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_FF_t newValue)
cparata 0:485458fca2bd 5667 {
cparata 0:485458fca2bd 5668 u8_t value;
cparata 0:485458fca2bd 5669
cparata 0:485458fca2bd 5670 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:485458fca2bd 5671 return MEMS_ERROR;
cparata 0:485458fca2bd 5672
cparata 0:485458fca2bd 5673 value &= ~LSM6DSL_ACC_GYRO_INT1_FF_MASK;
cparata 0:485458fca2bd 5674 value |= newValue;
cparata 0:485458fca2bd 5675
cparata 0:485458fca2bd 5676 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:485458fca2bd 5677 return MEMS_ERROR;
cparata 0:485458fca2bd 5678
cparata 0:485458fca2bd 5679 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5680 }
cparata 0:485458fca2bd 5681
cparata 0:485458fca2bd 5682 /*******************************************************************************
cparata 0:485458fca2bd 5683 * Function Name : LSM6DSL_ACC_GYRO_R_FFEvOnInt1
cparata 0:485458fca2bd 5684 * Description : Read INT1_FF
cparata 0:485458fca2bd 5685 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_FF_t
cparata 0:485458fca2bd 5686 * Output : Status of INT1_FF see LSM6DSL_ACC_GYRO_INT1_FF_t
cparata 0:485458fca2bd 5687 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5688 *******************************************************************************/
cparata 0:485458fca2bd 5689 status_t LSM6DSL_ACC_GYRO_R_FFEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_FF_t *value)
cparata 0:485458fca2bd 5690 {
cparata 0:485458fca2bd 5691 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
cparata 0:485458fca2bd 5692 return MEMS_ERROR;
cparata 0:485458fca2bd 5693
cparata 0:485458fca2bd 5694 *value &= LSM6DSL_ACC_GYRO_INT1_FF_MASK; //mask
cparata 0:485458fca2bd 5695
cparata 0:485458fca2bd 5696 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5697 }
cparata 0:485458fca2bd 5698
cparata 0:485458fca2bd 5699 /*******************************************************************************
cparata 0:485458fca2bd 5700 * Function Name : LSM6DSL_ACC_GYRO_W_WUEvOnInt1
cparata 0:485458fca2bd 5701 * Description : Write INT1_WU
cparata 0:485458fca2bd 5702 * Input : LSM6DSL_ACC_GYRO_INT1_WU_t
cparata 0:485458fca2bd 5703 * Output : None
cparata 0:485458fca2bd 5704 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5705 *******************************************************************************/
cparata 0:485458fca2bd 5706 status_t LSM6DSL_ACC_GYRO_W_WUEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_WU_t newValue)
cparata 0:485458fca2bd 5707 {
cparata 0:485458fca2bd 5708 u8_t value;
cparata 0:485458fca2bd 5709
cparata 0:485458fca2bd 5710 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:485458fca2bd 5711 return MEMS_ERROR;
cparata 0:485458fca2bd 5712
cparata 0:485458fca2bd 5713 value &= ~LSM6DSL_ACC_GYRO_INT1_WU_MASK;
cparata 0:485458fca2bd 5714 value |= newValue;
cparata 0:485458fca2bd 5715
cparata 0:485458fca2bd 5716 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:485458fca2bd 5717 return MEMS_ERROR;
cparata 0:485458fca2bd 5718
cparata 0:485458fca2bd 5719 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5720 }
cparata 0:485458fca2bd 5721
cparata 0:485458fca2bd 5722 /*******************************************************************************
cparata 0:485458fca2bd 5723 * Function Name : LSM6DSL_ACC_GYRO_R_WUEvOnInt1
cparata 0:485458fca2bd 5724 * Description : Read INT1_WU
cparata 0:485458fca2bd 5725 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_WU_t
cparata 0:485458fca2bd 5726 * Output : Status of INT1_WU see LSM6DSL_ACC_GYRO_INT1_WU_t
cparata 0:485458fca2bd 5727 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5728 *******************************************************************************/
cparata 0:485458fca2bd 5729 status_t LSM6DSL_ACC_GYRO_R_WUEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_WU_t *value)
cparata 0:485458fca2bd 5730 {
cparata 0:485458fca2bd 5731 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
cparata 0:485458fca2bd 5732 return MEMS_ERROR;
cparata 0:485458fca2bd 5733
cparata 0:485458fca2bd 5734 *value &= LSM6DSL_ACC_GYRO_INT1_WU_MASK; //mask
cparata 0:485458fca2bd 5735
cparata 0:485458fca2bd 5736 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5737 }
cparata 0:485458fca2bd 5738
cparata 0:485458fca2bd 5739 /*******************************************************************************
cparata 0:485458fca2bd 5740 * Function Name : LSM6DSL_ACC_GYRO_W_SingleTapOnInt1
cparata 0:485458fca2bd 5741 * Description : Write INT1_SINGLE_TAP
cparata 0:485458fca2bd 5742 * Input : LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_t
cparata 0:485458fca2bd 5743 * Output : None
cparata 0:485458fca2bd 5744 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5745 *******************************************************************************/
cparata 0:485458fca2bd 5746 status_t LSM6DSL_ACC_GYRO_W_SingleTapOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_t newValue)
cparata 0:485458fca2bd 5747 {
cparata 0:485458fca2bd 5748 u8_t value;
cparata 0:485458fca2bd 5749
cparata 0:485458fca2bd 5750 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:485458fca2bd 5751 return MEMS_ERROR;
cparata 0:485458fca2bd 5752
cparata 0:485458fca2bd 5753 value &= ~LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_MASK;
cparata 0:485458fca2bd 5754 value |= newValue;
cparata 0:485458fca2bd 5755
cparata 0:485458fca2bd 5756 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:485458fca2bd 5757 return MEMS_ERROR;
cparata 0:485458fca2bd 5758
cparata 0:485458fca2bd 5759 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5760 }
cparata 0:485458fca2bd 5761
cparata 0:485458fca2bd 5762 /*******************************************************************************
cparata 0:485458fca2bd 5763 * Function Name : LSM6DSL_ACC_GYRO_R_SingleTapOnInt1
cparata 0:485458fca2bd 5764 * Description : Read INT1_SINGLE_TAP
cparata 0:485458fca2bd 5765 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_t
cparata 0:485458fca2bd 5766 * Output : Status of INT1_SINGLE_TAP see LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_t
cparata 0:485458fca2bd 5767 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5768 *******************************************************************************/
cparata 0:485458fca2bd 5769 status_t LSM6DSL_ACC_GYRO_R_SingleTapOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_t *value)
cparata 0:485458fca2bd 5770 {
cparata 0:485458fca2bd 5771 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
cparata 0:485458fca2bd 5772 return MEMS_ERROR;
cparata 0:485458fca2bd 5773
cparata 0:485458fca2bd 5774 *value &= LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_MASK; //mask
cparata 0:485458fca2bd 5775
cparata 0:485458fca2bd 5776 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5777 }
cparata 0:485458fca2bd 5778
cparata 0:485458fca2bd 5779 /*******************************************************************************
cparata 0:485458fca2bd 5780 * Function Name : LSM6DSL_ACC_GYRO_W_SleepEvOnInt1
cparata 0:485458fca2bd 5781 * Description : Write INT1_SLEEP
cparata 0:485458fca2bd 5782 * Input : LSM6DSL_ACC_GYRO_INT1_SLEEP_t
cparata 0:485458fca2bd 5783 * Output : None
cparata 0:485458fca2bd 5784 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5785 *******************************************************************************/
cparata 0:485458fca2bd 5786 status_t LSM6DSL_ACC_GYRO_W_SleepEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_SLEEP_t newValue)
cparata 0:485458fca2bd 5787 {
cparata 0:485458fca2bd 5788 u8_t value;
cparata 0:485458fca2bd 5789
cparata 0:485458fca2bd 5790 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:485458fca2bd 5791 return MEMS_ERROR;
cparata 0:485458fca2bd 5792
cparata 0:485458fca2bd 5793 value &= ~LSM6DSL_ACC_GYRO_INT1_SLEEP_MASK;
cparata 0:485458fca2bd 5794 value |= newValue;
cparata 0:485458fca2bd 5795
cparata 0:485458fca2bd 5796 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:485458fca2bd 5797 return MEMS_ERROR;
cparata 0:485458fca2bd 5798
cparata 0:485458fca2bd 5799 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5800 }
cparata 0:485458fca2bd 5801
cparata 0:485458fca2bd 5802 /*******************************************************************************
cparata 0:485458fca2bd 5803 * Function Name : LSM6DSL_ACC_GYRO_R_SleepEvOnInt1
cparata 0:485458fca2bd 5804 * Description : Read INT1_SLEEP
cparata 0:485458fca2bd 5805 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_SLEEP_t
cparata 0:485458fca2bd 5806 * Output : Status of INT1_SLEEP see LSM6DSL_ACC_GYRO_INT1_SLEEP_t
cparata 0:485458fca2bd 5807 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5808 *******************************************************************************/
cparata 0:485458fca2bd 5809 status_t LSM6DSL_ACC_GYRO_R_SleepEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_SLEEP_t *value)
cparata 0:485458fca2bd 5810 {
cparata 0:485458fca2bd 5811 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
cparata 0:485458fca2bd 5812 return MEMS_ERROR;
cparata 0:485458fca2bd 5813
cparata 0:485458fca2bd 5814 *value &= LSM6DSL_ACC_GYRO_INT1_SLEEP_MASK; //mask
cparata 0:485458fca2bd 5815
cparata 0:485458fca2bd 5816 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5817 }
cparata 0:485458fca2bd 5818
cparata 0:485458fca2bd 5819 /*******************************************************************************
cparata 0:485458fca2bd 5820 * Function Name : LSM6DSL_ACC_GYRO_W_MagCorrection_Int2
cparata 0:485458fca2bd 5821 * Description : Write INT2_IRON
cparata 0:485458fca2bd 5822 * Input : LSM6DSL_ACC_GYRO_INT2_IRON_t
cparata 0:485458fca2bd 5823 * Output : None
cparata 0:485458fca2bd 5824 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5825 *******************************************************************************/
cparata 0:485458fca2bd 5826 status_t LSM6DSL_ACC_GYRO_W_MagCorrection_Int2(void *handle, LSM6DSL_ACC_GYRO_INT2_IRON_t newValue)
cparata 0:485458fca2bd 5827 {
cparata 0:485458fca2bd 5828 u8_t value;
cparata 0:485458fca2bd 5829
cparata 0:485458fca2bd 5830 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:485458fca2bd 5831 return MEMS_ERROR;
cparata 0:485458fca2bd 5832
cparata 0:485458fca2bd 5833 value &= ~LSM6DSL_ACC_GYRO_INT2_IRON_MASK;
cparata 0:485458fca2bd 5834 value |= newValue;
cparata 0:485458fca2bd 5835
cparata 0:485458fca2bd 5836 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:485458fca2bd 5837 return MEMS_ERROR;
cparata 0:485458fca2bd 5838
cparata 0:485458fca2bd 5839 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5840 }
cparata 0:485458fca2bd 5841
cparata 0:485458fca2bd 5842 /*******************************************************************************
cparata 0:485458fca2bd 5843 * Function Name : LSM6DSL_ACC_GYRO_R_MagCorrection_Int2
cparata 0:485458fca2bd 5844 * Description : Read INT2_IRON
cparata 0:485458fca2bd 5845 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_IRON_t
cparata 0:485458fca2bd 5846 * Output : Status of INT2_IRON see LSM6DSL_ACC_GYRO_INT2_IRON_t
cparata 0:485458fca2bd 5847 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5848 *******************************************************************************/
cparata 0:485458fca2bd 5849 status_t LSM6DSL_ACC_GYRO_R_MagCorrection_Int2(void *handle, LSM6DSL_ACC_GYRO_INT2_IRON_t *value)
cparata 0:485458fca2bd 5850 {
cparata 0:485458fca2bd 5851 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
cparata 0:485458fca2bd 5852 return MEMS_ERROR;
cparata 0:485458fca2bd 5853
cparata 0:485458fca2bd 5854 *value &= LSM6DSL_ACC_GYRO_INT2_IRON_MASK; //mask
cparata 0:485458fca2bd 5855
cparata 0:485458fca2bd 5856 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5857 }
cparata 0:485458fca2bd 5858
cparata 0:485458fca2bd 5859 /*******************************************************************************
cparata 0:485458fca2bd 5860 * Function Name : LSM6DSL_ACC_GYRO_W_TiltEvOnInt2
cparata 0:485458fca2bd 5861 * Description : Write INT2_TILT
cparata 0:485458fca2bd 5862 * Input : LSM6DSL_ACC_GYRO_INT2_TILT_t
cparata 0:485458fca2bd 5863 * Output : None
cparata 0:485458fca2bd 5864 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5865 *******************************************************************************/
cparata 0:485458fca2bd 5866 status_t LSM6DSL_ACC_GYRO_W_TiltEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_TILT_t newValue)
cparata 0:485458fca2bd 5867 {
cparata 0:485458fca2bd 5868 u8_t value;
cparata 0:485458fca2bd 5869
cparata 0:485458fca2bd 5870 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:485458fca2bd 5871 return MEMS_ERROR;
cparata 0:485458fca2bd 5872
cparata 0:485458fca2bd 5873 value &= ~LSM6DSL_ACC_GYRO_INT2_TILT_MASK;
cparata 0:485458fca2bd 5874 value |= newValue;
cparata 0:485458fca2bd 5875
cparata 0:485458fca2bd 5876 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:485458fca2bd 5877 return MEMS_ERROR;
cparata 0:485458fca2bd 5878
cparata 0:485458fca2bd 5879 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5880 }
cparata 0:485458fca2bd 5881
cparata 0:485458fca2bd 5882 /*******************************************************************************
cparata 0:485458fca2bd 5883 * Function Name : LSM6DSL_ACC_GYRO_R_TiltEvOnInt2
cparata 0:485458fca2bd 5884 * Description : Read INT2_TILT
cparata 0:485458fca2bd 5885 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_TILT_t
cparata 0:485458fca2bd 5886 * Output : Status of INT2_TILT see LSM6DSL_ACC_GYRO_INT2_TILT_t
cparata 0:485458fca2bd 5887 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5888 *******************************************************************************/
cparata 0:485458fca2bd 5889 status_t LSM6DSL_ACC_GYRO_R_TiltEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_TILT_t *value)
cparata 0:485458fca2bd 5890 {
cparata 0:485458fca2bd 5891 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
cparata 0:485458fca2bd 5892 return MEMS_ERROR;
cparata 0:485458fca2bd 5893
cparata 0:485458fca2bd 5894 *value &= LSM6DSL_ACC_GYRO_INT2_TILT_MASK; //mask
cparata 0:485458fca2bd 5895
cparata 0:485458fca2bd 5896 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5897 }
cparata 0:485458fca2bd 5898
cparata 0:485458fca2bd 5899 /*******************************************************************************
cparata 0:485458fca2bd 5900 * Function Name : LSM6DSL_ACC_GYRO_W_6DEvOnInt2
cparata 0:485458fca2bd 5901 * Description : Write INT2_6D
cparata 0:485458fca2bd 5902 * Input : LSM6DSL_ACC_GYRO_INT2_6D_t
cparata 0:485458fca2bd 5903 * Output : None
cparata 0:485458fca2bd 5904 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5905 *******************************************************************************/
cparata 0:485458fca2bd 5906 status_t LSM6DSL_ACC_GYRO_W_6DEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_6D_t newValue)
cparata 0:485458fca2bd 5907 {
cparata 0:485458fca2bd 5908 u8_t value;
cparata 0:485458fca2bd 5909
cparata 0:485458fca2bd 5910 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:485458fca2bd 5911 return MEMS_ERROR;
cparata 0:485458fca2bd 5912
cparata 0:485458fca2bd 5913 value &= ~LSM6DSL_ACC_GYRO_INT2_6D_MASK;
cparata 0:485458fca2bd 5914 value |= newValue;
cparata 0:485458fca2bd 5915
cparata 0:485458fca2bd 5916 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:485458fca2bd 5917 return MEMS_ERROR;
cparata 0:485458fca2bd 5918
cparata 0:485458fca2bd 5919 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5920 }
cparata 0:485458fca2bd 5921
cparata 0:485458fca2bd 5922 /*******************************************************************************
cparata 0:485458fca2bd 5923 * Function Name : LSM6DSL_ACC_GYRO_R_6DEvOnInt2
cparata 0:485458fca2bd 5924 * Description : Read INT2_6D
cparata 0:485458fca2bd 5925 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_6D_t
cparata 0:485458fca2bd 5926 * Output : Status of INT2_6D see LSM6DSL_ACC_GYRO_INT2_6D_t
cparata 0:485458fca2bd 5927 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5928 *******************************************************************************/
cparata 0:485458fca2bd 5929 status_t LSM6DSL_ACC_GYRO_R_6DEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_6D_t *value)
cparata 0:485458fca2bd 5930 {
cparata 0:485458fca2bd 5931 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
cparata 0:485458fca2bd 5932 return MEMS_ERROR;
cparata 0:485458fca2bd 5933
cparata 0:485458fca2bd 5934 *value &= LSM6DSL_ACC_GYRO_INT2_6D_MASK; //mask
cparata 0:485458fca2bd 5935
cparata 0:485458fca2bd 5936 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5937 }
cparata 0:485458fca2bd 5938
cparata 0:485458fca2bd 5939 /*******************************************************************************
cparata 0:485458fca2bd 5940 * Function Name : LSM6DSL_ACC_GYRO_W_TapEvOnInt2
cparata 0:485458fca2bd 5941 * Description : Write INT2_TAP
cparata 0:485458fca2bd 5942 * Input : LSM6DSL_ACC_GYRO_INT2_TAP_t
cparata 0:485458fca2bd 5943 * Output : None
cparata 0:485458fca2bd 5944 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5945 *******************************************************************************/
cparata 0:485458fca2bd 5946 status_t LSM6DSL_ACC_GYRO_W_TapEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_TAP_t newValue)
cparata 0:485458fca2bd 5947 {
cparata 0:485458fca2bd 5948 u8_t value;
cparata 0:485458fca2bd 5949
cparata 0:485458fca2bd 5950 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:485458fca2bd 5951 return MEMS_ERROR;
cparata 0:485458fca2bd 5952
cparata 0:485458fca2bd 5953 value &= ~LSM6DSL_ACC_GYRO_INT2_TAP_MASK;
cparata 0:485458fca2bd 5954 value |= newValue;
cparata 0:485458fca2bd 5955
cparata 0:485458fca2bd 5956 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:485458fca2bd 5957 return MEMS_ERROR;
cparata 0:485458fca2bd 5958
cparata 0:485458fca2bd 5959 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5960 }
cparata 0:485458fca2bd 5961
cparata 0:485458fca2bd 5962 /*******************************************************************************
cparata 0:485458fca2bd 5963 * Function Name : LSM6DSL_ACC_GYRO_R_TapEvOnInt2
cparata 0:485458fca2bd 5964 * Description : Read INT2_TAP
cparata 0:485458fca2bd 5965 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_TAP_t
cparata 0:485458fca2bd 5966 * Output : Status of INT2_TAP see LSM6DSL_ACC_GYRO_INT2_TAP_t
cparata 0:485458fca2bd 5967 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5968 *******************************************************************************/
cparata 0:485458fca2bd 5969 status_t LSM6DSL_ACC_GYRO_R_TapEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_TAP_t *value)
cparata 0:485458fca2bd 5970 {
cparata 0:485458fca2bd 5971 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
cparata 0:485458fca2bd 5972 return MEMS_ERROR;
cparata 0:485458fca2bd 5973
cparata 0:485458fca2bd 5974 *value &= LSM6DSL_ACC_GYRO_INT2_TAP_MASK; //mask
cparata 0:485458fca2bd 5975
cparata 0:485458fca2bd 5976 return MEMS_SUCCESS;
cparata 0:485458fca2bd 5977 }
cparata 0:485458fca2bd 5978
cparata 0:485458fca2bd 5979 /*******************************************************************************
cparata 0:485458fca2bd 5980 * Function Name : LSM6DSL_ACC_GYRO_W_FFEvOnInt2
cparata 0:485458fca2bd 5981 * Description : Write INT2_FF
cparata 0:485458fca2bd 5982 * Input : LSM6DSL_ACC_GYRO_INT2_FF_t
cparata 0:485458fca2bd 5983 * Output : None
cparata 0:485458fca2bd 5984 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 5985 *******************************************************************************/
cparata 0:485458fca2bd 5986 status_t LSM6DSL_ACC_GYRO_W_FFEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_FF_t newValue)
cparata 0:485458fca2bd 5987 {
cparata 0:485458fca2bd 5988 u8_t value;
cparata 0:485458fca2bd 5989
cparata 0:485458fca2bd 5990 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:485458fca2bd 5991 return MEMS_ERROR;
cparata 0:485458fca2bd 5992
cparata 0:485458fca2bd 5993 value &= ~LSM6DSL_ACC_GYRO_INT2_FF_MASK;
cparata 0:485458fca2bd 5994 value |= newValue;
cparata 0:485458fca2bd 5995
cparata 0:485458fca2bd 5996 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:485458fca2bd 5997 return MEMS_ERROR;
cparata 0:485458fca2bd 5998
cparata 0:485458fca2bd 5999 return MEMS_SUCCESS;
cparata 0:485458fca2bd 6000 }
cparata 0:485458fca2bd 6001
cparata 0:485458fca2bd 6002 /*******************************************************************************
cparata 0:485458fca2bd 6003 * Function Name : LSM6DSL_ACC_GYRO_R_FFEvOnInt2
cparata 0:485458fca2bd 6004 * Description : Read INT2_FF
cparata 0:485458fca2bd 6005 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_FF_t
cparata 0:485458fca2bd 6006 * Output : Status of INT2_FF see LSM6DSL_ACC_GYRO_INT2_FF_t
cparata 0:485458fca2bd 6007 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 6008 *******************************************************************************/
cparata 0:485458fca2bd 6009 status_t LSM6DSL_ACC_GYRO_R_FFEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_FF_t *value)
cparata 0:485458fca2bd 6010 {
cparata 0:485458fca2bd 6011 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
cparata 0:485458fca2bd 6012 return MEMS_ERROR;
cparata 0:485458fca2bd 6013
cparata 0:485458fca2bd 6014 *value &= LSM6DSL_ACC_GYRO_INT2_FF_MASK; //mask
cparata 0:485458fca2bd 6015
cparata 0:485458fca2bd 6016 return MEMS_SUCCESS;
cparata 0:485458fca2bd 6017 }
cparata 0:485458fca2bd 6018
cparata 0:485458fca2bd 6019 /*******************************************************************************
cparata 0:485458fca2bd 6020 * Function Name : LSM6DSL_ACC_GYRO_W_WUEvOnInt2
cparata 0:485458fca2bd 6021 * Description : Write INT2_WU
cparata 0:485458fca2bd 6022 * Input : LSM6DSL_ACC_GYRO_INT2_WU_t
cparata 0:485458fca2bd 6023 * Output : None
cparata 0:485458fca2bd 6024 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 6025 *******************************************************************************/
cparata 0:485458fca2bd 6026 status_t LSM6DSL_ACC_GYRO_W_WUEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_WU_t newValue)
cparata 0:485458fca2bd 6027 {
cparata 0:485458fca2bd 6028 u8_t value;
cparata 0:485458fca2bd 6029
cparata 0:485458fca2bd 6030 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:485458fca2bd 6031 return MEMS_ERROR;
cparata 0:485458fca2bd 6032
cparata 0:485458fca2bd 6033 value &= ~LSM6DSL_ACC_GYRO_INT2_WU_MASK;
cparata 0:485458fca2bd 6034 value |= newValue;
cparata 0:485458fca2bd 6035
cparata 0:485458fca2bd 6036 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:485458fca2bd 6037 return MEMS_ERROR;
cparata 0:485458fca2bd 6038
cparata 0:485458fca2bd 6039 return MEMS_SUCCESS;
cparata 0:485458fca2bd 6040 }
cparata 0:485458fca2bd 6041
cparata 0:485458fca2bd 6042 /*******************************************************************************
cparata 0:485458fca2bd 6043 * Function Name : LSM6DSL_ACC_GYRO_R_WUEvOnInt2
cparata 0:485458fca2bd 6044 * Description : Read INT2_WU
cparata 0:485458fca2bd 6045 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_WU_t
cparata 0:485458fca2bd 6046 * Output : Status of INT2_WU see LSM6DSL_ACC_GYRO_INT2_WU_t
cparata 0:485458fca2bd 6047 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 6048 *******************************************************************************/
cparata 0:485458fca2bd 6049 status_t LSM6DSL_ACC_GYRO_R_WUEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_WU_t *value)
cparata 0:485458fca2bd 6050 {
cparata 0:485458fca2bd 6051 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
cparata 0:485458fca2bd 6052 return MEMS_ERROR;
cparata 0:485458fca2bd 6053
cparata 0:485458fca2bd 6054 *value &= LSM6DSL_ACC_GYRO_INT2_WU_MASK; //mask
cparata 0:485458fca2bd 6055
cparata 0:485458fca2bd 6056 return MEMS_SUCCESS;
cparata 0:485458fca2bd 6057 }
cparata 0:485458fca2bd 6058
cparata 0:485458fca2bd 6059 /*******************************************************************************
cparata 0:485458fca2bd 6060 * Function Name : LSM6DSL_ACC_GYRO_W_SingleTapOnInt2
cparata 0:485458fca2bd 6061 * Description : Write INT2_SINGLE_TAP
cparata 0:485458fca2bd 6062 * Input : LSM6DSL_ACC_GYRO_INT2_SINGLE_TAP_t
cparata 0:485458fca2bd 6063 * Output : None
cparata 0:485458fca2bd 6064 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 6065 *******************************************************************************/
cparata 0:485458fca2bd 6066 status_t LSM6DSL_ACC_GYRO_W_SingleTapOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_SINGLE_TAP_t newValue)
cparata 0:485458fca2bd 6067 {
cparata 0:485458fca2bd 6068 u8_t value;
cparata 0:485458fca2bd 6069
cparata 0:485458fca2bd 6070 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:485458fca2bd 6071 return MEMS_ERROR;
cparata 0:485458fca2bd 6072
cparata 0:485458fca2bd 6073 value &= ~LSM6DSL_ACC_GYRO_INT2_SINGLE_TAP_MASK;
cparata 0:485458fca2bd 6074 value |= newValue;
cparata 0:485458fca2bd 6075
cparata 0:485458fca2bd 6076 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:485458fca2bd 6077 return MEMS_ERROR;
cparata 0:485458fca2bd 6078
cparata 0:485458fca2bd 6079 return MEMS_SUCCESS;
cparata 0:485458fca2bd 6080 }
cparata 0:485458fca2bd 6081
cparata 0:485458fca2bd 6082 /*******************************************************************************
cparata 0:485458fca2bd 6083 * Function Name : LSM6DSL_ACC_GYRO_R_SingleTapOnInt2
cparata 0:485458fca2bd 6084 * Description : Read INT2_SINGLE_TAP
cparata 0:485458fca2bd 6085 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_SINGLE_TAP_t
cparata 0:485458fca2bd 6086 * Output : Status of INT2_SINGLE_TAP see LSM6DSL_ACC_GYRO_INT2_SINGLE_TAP_t
cparata 0:485458fca2bd 6087 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 6088 *******************************************************************************/
cparata 0:485458fca2bd 6089 status_t LSM6DSL_ACC_GYRO_R_SingleTapOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_SINGLE_TAP_t *value)
cparata 0:485458fca2bd 6090 {
cparata 0:485458fca2bd 6091 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
cparata 0:485458fca2bd 6092 return MEMS_ERROR;
cparata 0:485458fca2bd 6093
cparata 0:485458fca2bd 6094 *value &= LSM6DSL_ACC_GYRO_INT2_SINGLE_TAP_MASK; //mask
cparata 0:485458fca2bd 6095
cparata 0:485458fca2bd 6096 return MEMS_SUCCESS;
cparata 0:485458fca2bd 6097 }
cparata 0:485458fca2bd 6098
cparata 0:485458fca2bd 6099 /*******************************************************************************
cparata 0:485458fca2bd 6100 * Function Name : LSM6DSL_ACC_GYRO_W_SleepEvOnInt2
cparata 0:485458fca2bd 6101 * Description : Write INT2_SLEEP
cparata 0:485458fca2bd 6102 * Input : LSM6DSL_ACC_GYRO_INT2_SLEEP_t
cparata 0:485458fca2bd 6103 * Output : None
cparata 0:485458fca2bd 6104 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 6105 *******************************************************************************/
cparata 0:485458fca2bd 6106 status_t LSM6DSL_ACC_GYRO_W_SleepEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_SLEEP_t newValue)
cparata 0:485458fca2bd 6107 {
cparata 0:485458fca2bd 6108 u8_t value;
cparata 0:485458fca2bd 6109
cparata 0:485458fca2bd 6110 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:485458fca2bd 6111 return MEMS_ERROR;
cparata 0:485458fca2bd 6112
cparata 0:485458fca2bd 6113 value &= ~LSM6DSL_ACC_GYRO_INT2_SLEEP_MASK;
cparata 0:485458fca2bd 6114 value |= newValue;
cparata 0:485458fca2bd 6115
cparata 0:485458fca2bd 6116 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:485458fca2bd 6117 return MEMS_ERROR;
cparata 0:485458fca2bd 6118
cparata 0:485458fca2bd 6119 return MEMS_SUCCESS;
cparata 0:485458fca2bd 6120 }
cparata 0:485458fca2bd 6121
cparata 0:485458fca2bd 6122 /*******************************************************************************
cparata 0:485458fca2bd 6123 * Function Name : LSM6DSL_ACC_GYRO_R_SleepEvOnInt2
cparata 0:485458fca2bd 6124 * Description : Read INT2_SLEEP
cparata 0:485458fca2bd 6125 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_SLEEP_t
cparata 0:485458fca2bd 6126 * Output : Status of INT2_SLEEP see LSM6DSL_ACC_GYRO_INT2_SLEEP_t
cparata 0:485458fca2bd 6127 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 6128 *******************************************************************************/
cparata 0:485458fca2bd 6129 status_t LSM6DSL_ACC_GYRO_R_SleepEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_SLEEP_t *value)
cparata 0:485458fca2bd 6130 {
cparata 0:485458fca2bd 6131 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
cparata 0:485458fca2bd 6132 return MEMS_ERROR;
cparata 0:485458fca2bd 6133
cparata 0:485458fca2bd 6134 *value &= LSM6DSL_ACC_GYRO_INT2_SLEEP_MASK; //mask
cparata 0:485458fca2bd 6135
cparata 0:485458fca2bd 6136 return MEMS_SUCCESS;
cparata 0:485458fca2bd 6137 }
cparata 0:485458fca2bd 6138
cparata 0:485458fca2bd 6139 /*******************************************************************************
cparata 0:485458fca2bd 6140 * Function Name : status_t LSM6DSL_ACC_GYRO_Get_GetFIFOData(u8_t *buff)
cparata 0:485458fca2bd 6141 * Description : Read GetFIFOData output register
cparata 0:485458fca2bd 6142 * Input : pointer to [u8_t]
cparata 0:485458fca2bd 6143 * Output : GetFIFOData buffer u8_t
cparata 0:485458fca2bd 6144 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 6145 *******************************************************************************/
cparata 0:485458fca2bd 6146 status_t LSM6DSL_ACC_GYRO_Get_GetFIFOData(void *handle, u8_t *buff)
cparata 0:485458fca2bd 6147 {
cparata 0:485458fca2bd 6148 u8_t i, j, k;
cparata 0:485458fca2bd 6149 u8_t numberOfByteForDimension;
cparata 0:485458fca2bd 6150
cparata 0:485458fca2bd 6151 numberOfByteForDimension=2/1;
cparata 0:485458fca2bd 6152
cparata 0:485458fca2bd 6153 k=0;
cparata 0:485458fca2bd 6154 for (i=0; i<1;i++ )
cparata 0:485458fca2bd 6155 {
cparata 0:485458fca2bd 6156 for (j=0; j<numberOfByteForDimension;j++ )
cparata 0:485458fca2bd 6157 {
cparata 0:485458fca2bd 6158 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_DATA_OUT_L+k, &buff[k], 1))
cparata 0:485458fca2bd 6159 return MEMS_ERROR;
cparata 0:485458fca2bd 6160 k++;
cparata 0:485458fca2bd 6161 }
cparata 0:485458fca2bd 6162 }
cparata 0:485458fca2bd 6163
cparata 0:485458fca2bd 6164 return MEMS_SUCCESS;
cparata 0:485458fca2bd 6165 }
cparata 0:485458fca2bd 6166
cparata 0:485458fca2bd 6167 /*******************************************************************************
cparata 0:485458fca2bd 6168 * Function Name : status_t LSM6DSL_ACC_GYRO_Get_GetTimestamp(u8_t *buff)
cparata 0:485458fca2bd 6169 * Description : Read GetTimestamp output register
cparata 0:485458fca2bd 6170 * Input : pointer to [u8_t]
cparata 0:485458fca2bd 6171 * Output : GetTimestamp buffer u8_t
cparata 0:485458fca2bd 6172 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 6173 *******************************************************************************/
cparata 0:485458fca2bd 6174 status_t LSM6DSL_ACC_GYRO_Get_GetTimestamp(void *handle, u8_t *buff)
cparata 0:485458fca2bd 6175 {
cparata 0:485458fca2bd 6176 u8_t i, j, k;
cparata 0:485458fca2bd 6177 u8_t numberOfByteForDimension;
cparata 0:485458fca2bd 6178
cparata 0:485458fca2bd 6179 numberOfByteForDimension=3/1;
cparata 0:485458fca2bd 6180
cparata 0:485458fca2bd 6181 k=0;
cparata 0:485458fca2bd 6182 for (i=0; i<1;i++ )
cparata 0:485458fca2bd 6183 {
cparata 0:485458fca2bd 6184 for (j=0; j<numberOfByteForDimension;j++ )
cparata 0:485458fca2bd 6185 {
cparata 0:485458fca2bd 6186 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TIMESTAMP0_REG+k, &buff[k], 1))
cparata 0:485458fca2bd 6187 return MEMS_ERROR;
cparata 0:485458fca2bd 6188 k++;
cparata 0:485458fca2bd 6189 }
cparata 0:485458fca2bd 6190 }
cparata 0:485458fca2bd 6191
cparata 0:485458fca2bd 6192 return MEMS_SUCCESS;
cparata 0:485458fca2bd 6193 }
cparata 0:485458fca2bd 6194
cparata 0:485458fca2bd 6195 /*******************************************************************************
cparata 0:485458fca2bd 6196 * Function Name : status_t LSM6DSL_ACC_GYRO_Get_GetStepCounter(u8_t *buff)
cparata 0:485458fca2bd 6197 * Description : Read GetStepCounter output register
cparata 0:485458fca2bd 6198 * Input : pointer to [u8_t]
cparata 0:485458fca2bd 6199 * Output : GetStepCounter buffer u8_t
cparata 0:485458fca2bd 6200 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 6201 *******************************************************************************/
cparata 0:485458fca2bd 6202 status_t LSM6DSL_ACC_GYRO_Get_GetStepCounter(void *handle, u8_t *buff)
cparata 0:485458fca2bd 6203 {
cparata 0:485458fca2bd 6204 u8_t i, j, k;
cparata 0:485458fca2bd 6205 u8_t numberOfByteForDimension;
cparata 0:485458fca2bd 6206
cparata 0:485458fca2bd 6207 numberOfByteForDimension=2/1;
cparata 0:485458fca2bd 6208
cparata 0:485458fca2bd 6209 k=0;
cparata 0:485458fca2bd 6210 for (i=0; i<1;i++ )
cparata 0:485458fca2bd 6211 {
cparata 0:485458fca2bd 6212 for (j=0; j<numberOfByteForDimension;j++ )
cparata 0:485458fca2bd 6213 {
cparata 0:485458fca2bd 6214 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_STEP_COUNTER_L+k, &buff[k], 1))
cparata 0:485458fca2bd 6215 return MEMS_ERROR;
cparata 0:485458fca2bd 6216 k++;
cparata 0:485458fca2bd 6217 }
cparata 0:485458fca2bd 6218 }
cparata 0:485458fca2bd 6219
cparata 0:485458fca2bd 6220 return MEMS_SUCCESS;
cparata 0:485458fca2bd 6221 }
cparata 0:485458fca2bd 6222
cparata 0:485458fca2bd 6223 /*******************************************************************************
cparata 0:485458fca2bd 6224 * Function Name : LSM6DSL_ACC_GYRO_W_PedoThreshold(void *handle, u8_t newValue)
cparata 0:485458fca2bd 6225 * Description : Set accelerometer threshold for pedometer
cparata 0:485458fca2bd 6226 * Input : pointer to [u8_t]
cparata 0:485458fca2bd 6227 * Output : None
cparata 0:485458fca2bd 6228 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:485458fca2bd 6229 *******************************************************************************/
cparata 0:485458fca2bd 6230 status_t LSM6DSL_ACC_GYRO_W_PedoThreshold(void *handle, u8_t newValue)
cparata 0:485458fca2bd 6231 {
cparata 0:485458fca2bd 6232 u8_t value;
cparata 0:485458fca2bd 6233
cparata 0:485458fca2bd 6234 /* Open Embedded Function Register page*/
cparata 0:485458fca2bd 6235 LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_ENABLED);
cparata 0:485458fca2bd 6236
cparata 0:485458fca2bd 6237 /* read current value */
cparata 0:485458fca2bd 6238 LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CONFIG_PEDO_THS_MIN, &value, 1);
cparata 0:485458fca2bd 6239
cparata 0:485458fca2bd 6240 value &= ~0x1F;
cparata 0:485458fca2bd 6241 value |= (newValue & 0x1F);
cparata 0:485458fca2bd 6242
cparata 0:485458fca2bd 6243 /* write new value */
cparata 0:485458fca2bd 6244 LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CONFIG_PEDO_THS_MIN, &value, 1);
cparata 0:485458fca2bd 6245
cparata 0:485458fca2bd 6246 /* Close Embedded Function Register page*/
cparata 0:485458fca2bd 6247 LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_DISABLED);
cparata 0:485458fca2bd 6248
cparata 0:485458fca2bd 6249 return MEMS_SUCCESS;
cparata 0:485458fca2bd 6250 }
cparata 0:485458fca2bd 6251
cparata 0:485458fca2bd 6252 /************** Use Sensor Hub *******************/
cparata 0:485458fca2bd 6253 /*
cparata 0:485458fca2bd 6254 * Program the nine Soft Iron Matrix coefficients.
cparata 0:485458fca2bd 6255 * The SI_Matrix buffer must provide coefficients
cparata 0:485458fca2bd 6256 * in xx, xy, xz, yx, yy, yz, zx, zy, zz order.
cparata 0:485458fca2bd 6257 */
cparata 0:485458fca2bd 6258 status_t LSM6DSL_ACC_GYRO_SH_init_SI_Matrix(void *handle, u8_t *SI_matrix)
cparata 0:485458fca2bd 6259 {
cparata 0:485458fca2bd 6260 /* Open Embedded Function Register page*/
cparata 0:485458fca2bd 6261 LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_ENABLED);
cparata 0:485458fca2bd 6262
cparata 0:485458fca2bd 6263 /* Write the Soft Iron Matrix coefficients */
cparata 0:485458fca2bd 6264 LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MAG_SI_XX, SI_matrix, 9);
cparata 0:485458fca2bd 6265
cparata 0:485458fca2bd 6266 /* Close Embedded Function Register page*/
cparata 0:485458fca2bd 6267 LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_DISABLED);
cparata 0:485458fca2bd 6268
cparata 0:485458fca2bd 6269 return MEMS_SUCCESS;
cparata 0:485458fca2bd 6270 }
cparata 0:485458fca2bd 6271
cparata 0:485458fca2bd 6272 /* Read a remote device through I2C Sensor Hub Slave 0 */
cparata 0:485458fca2bd 6273 status_t LSM6DSL_ACC_GYRO_SH0_Program(void *handle, u8_t SlvAddr, u8_t Reg, u8_t len)
cparata 0:485458fca2bd 6274 {
cparata 0:485458fca2bd 6275 /* Open Embedded Function Register page*/
cparata 0:485458fca2bd 6276 LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_ENABLED);
cparata 0:485458fca2bd 6277
cparata 0:485458fca2bd 6278 /* Write remote device I2C slave address */
cparata 0:485458fca2bd 6279 SlvAddr |= 0x1; /* Raise the read op bit */
cparata 0:485458fca2bd 6280 LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_SLV0_ADD, &SlvAddr, 1);
cparata 0:485458fca2bd 6281
cparata 0:485458fca2bd 6282 /* Write remote device I2C subaddress */
cparata 0:485458fca2bd 6283 LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_SLV0_SUBADD, &Reg, 1);
cparata 0:485458fca2bd 6284
cparata 0:485458fca2bd 6285 /* Write number of bytes to read [SLAVE0_CONFIG - 04h ]*/
cparata 0:485458fca2bd 6286 u8_t sl0_cfg = 0;
cparata 0:485458fca2bd 6287 sl0_cfg |= 0x00; //00 bit [7-6] : no decimation
cparata 0:485458fca2bd 6288 sl0_cfg |= 0x00; //00 bit [5-4] : one sensor
cparata 0:485458fca2bd 6289 sl0_cfg |= 0x00; // 0 bit [3] : source mode read disabled
cparata 0:485458fca2bd 6290 sl0_cfg |= len & 0x07; // bit [2-0] : number of bytes
cparata 0:485458fca2bd 6291
cparata 0:485458fca2bd 6292 LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_SLAVE0_CONFIG, &sl0_cfg, 1);
cparata 0:485458fca2bd 6293
cparata 0:485458fca2bd 6294 /* Close Embedded Function Register page*/
cparata 0:485458fca2bd 6295 LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_DISABLED);
cparata 0:485458fca2bd 6296
cparata 0:485458fca2bd 6297 /* Enable FUNC */
cparata 0:485458fca2bd 6298 LSM6DSL_ACC_GYRO_W_FUNC_EN(handle, LSM6DSL_ACC_GYRO_FUNC_EN_ENABLED);
cparata 0:485458fca2bd 6299
cparata 0:485458fca2bd 6300 /* MASTER_EN */
cparata 0:485458fca2bd 6301 LSM6DSL_ACC_GYRO_W_I2C_MASTER_Enable(handle, LSM6DSL_ACC_GYRO_MASTER_ON_ENABLED);
cparata 0:485458fca2bd 6302
cparata 0:485458fca2bd 6303 return MEMS_SUCCESS;
cparata 0:485458fca2bd 6304 }
cparata 0:485458fca2bd 6305
cparata 0:485458fca2bd 6306 /* Read a remote device through I2C Sensor Hub Slave 0 */
cparata 0:485458fca2bd 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:485458fca2bd 6308 {
cparata 0:485458fca2bd 6309 LSM6DSL_ACC_GYRO_SENS_HUB_END_t op_cmpl = LSM6DSL_ACC_GYRO_SENS_HUB_END_STILL_ONGOING;
cparata 0:485458fca2bd 6310 LSM6DSL_ACC_GYRO_XLDA_t op_update = LSM6DSL_ACC_GYRO_XLDA_NO_DATA_AVAIL;
cparata 0:485458fca2bd 6311 u8_t dummy[6];
cparata 0:485458fca2bd 6312
cparata 0:485458fca2bd 6313 LSM6DSL_ACC_GYRO_W_ODR_XL(handle, LSM6DSL_ACC_GYRO_ODR_XL_POWER_DOWN);
cparata 0:485458fca2bd 6314
cparata 0:485458fca2bd 6315 LSM6DSL_ACC_GYRO_SH0_Program(handle, SlvAddr, Reg, len);
cparata 0:485458fca2bd 6316
cparata 0:485458fca2bd 6317 /* Syncronize the SH with internal trigger (xl) */
cparata 0:485458fca2bd 6318 LSM6DSL_ACC_GYRO_W_ODR_XL(handle, LSM6DSL_ACC_GYRO_ODR_XL_104Hz);
cparata 0:485458fca2bd 6319
cparata 0:485458fca2bd 6320 /* Wait until operation is not completed */
cparata 0:485458fca2bd 6321 LSM6DSL_ACC_GYRO_GetRawAccData(handle, dummy);
cparata 0:485458fca2bd 6322 do {
cparata 0:485458fca2bd 6323 LSM6DSL_ACC_GYRO_R_XLDA(handle, &op_update);
cparata 0:485458fca2bd 6324 } while(op_update != LSM6DSL_ACC_GYRO_XLDA_DATA_AVAIL);
cparata 0:485458fca2bd 6325 do {
cparata 0:485458fca2bd 6326 LSM6DSL_ACC_GYRO_R_SENS_HUB_END(handle, &op_cmpl);
cparata 0:485458fca2bd 6327 } while(op_cmpl != LSM6DSL_ACC_GYRO_SENS_HUB_END_OP_COMPLETED);
cparata 0:485458fca2bd 6328
cparata 0:485458fca2bd 6329
cparata 0:485458fca2bd 6330 /* Read the result */
cparata 0:485458fca2bd 6331 LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_SENSORHUB1_REG, Bufp, len);
cparata 0:485458fca2bd 6332
cparata 0:485458fca2bd 6333 LSM6DSL_ACC_GYRO_W_ODR_XL(handle, LSM6DSL_ACC_GYRO_ODR_XL_POWER_DOWN);
cparata 0:485458fca2bd 6334
cparata 0:485458fca2bd 6335 if (stop) {
cparata 0:485458fca2bd 6336 /* Stop everything */
cparata 0:485458fca2bd 6337 LSM6DSL_ACC_GYRO_W_FUNC_EN(handle, LSM6DSL_ACC_GYRO_FUNC_EN_DISABLED);
cparata 0:485458fca2bd 6338 LSM6DSL_ACC_GYRO_W_I2C_MASTER_Enable(handle, LSM6DSL_ACC_GYRO_MASTER_ON_DISABLED);
cparata 0:485458fca2bd 6339 }
cparata 0:485458fca2bd 6340
cparata 0:485458fca2bd 6341 return MEMS_SUCCESS;
cparata 0:485458fca2bd 6342 }
cparata 0:485458fca2bd 6343
cparata 0:485458fca2bd 6344 /* Write a remote device through I2C Sensor Hub Slave 0 */
cparata 0:485458fca2bd 6345 status_t LSM6DSL_ACC_GYRO_SH0_WriteByte(void *handle, u8_t SlvAddr, u8_t Reg, u8_t Bufp)
cparata 0:485458fca2bd 6346 {
cparata 0:485458fca2bd 6347 LSM6DSL_ACC_GYRO_SENS_HUB_END_t op_cmpl = LSM6DSL_ACC_GYRO_SENS_HUB_END_STILL_ONGOING;
cparata 0:485458fca2bd 6348 LSM6DSL_ACC_GYRO_XLDA_t op_update = LSM6DSL_ACC_GYRO_XLDA_NO_DATA_AVAIL;
cparata 0:485458fca2bd 6349 u8_t dummy[6];
cparata 0:485458fca2bd 6350
cparata 0:485458fca2bd 6351 /* Open Embedded Function Register page*/
cparata 0:485458fca2bd 6352 LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_ENABLED);
cparata 0:485458fca2bd 6353
cparata 0:485458fca2bd 6354 /* Write remote device I2C slave address */
cparata 0:485458fca2bd 6355 LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_SLV0_ADD, &SlvAddr, 1);
cparata 0:485458fca2bd 6356
cparata 0:485458fca2bd 6357 /* Write remote device I2C subaddress */
cparata 0:485458fca2bd 6358 LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_SLV0_SUBADD, &Reg, 1);
cparata 0:485458fca2bd 6359
cparata 0:485458fca2bd 6360 /* Write the data */
cparata 0:485458fca2bd 6361 LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_DATAWRITE_SRC_MODE_SUB_SLV0, &Bufp, 1);
cparata 0:485458fca2bd 6362
cparata 0:485458fca2bd 6363 /* Close Embedded Function Register page*/
cparata 0:485458fca2bd 6364 LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_DISABLED);
cparata 0:485458fca2bd 6365
cparata 0:485458fca2bd 6366 /* Enable FUNC */
cparata 0:485458fca2bd 6367 LSM6DSL_ACC_GYRO_W_FUNC_EN(handle, LSM6DSL_ACC_GYRO_FUNC_EN_ENABLED);
cparata 0:485458fca2bd 6368
cparata 0:485458fca2bd 6369 /* Enable PULL_UP_EN and MASTER_EN */
cparata 0:485458fca2bd 6370 //LSM6DSL_ACC_GYRO_W_PULL_UP_EN(handle, LSM6DSL_ACC_GYRO_PULL_UP_EN_ENABLED);
cparata 0:485458fca2bd 6371 LSM6DSL_ACC_GYRO_W_I2C_MASTER_Enable(handle, LSM6DSL_ACC_GYRO_MASTER_ON_ENABLED);
cparata 0:485458fca2bd 6372
cparata 0:485458fca2bd 6373 /* Syncronize the SH with internal trigger (xl) */
cparata 0:485458fca2bd 6374 LSM6DSL_ACC_GYRO_W_ODR_XL(handle, LSM6DSL_ACC_GYRO_ODR_XL_104Hz);
cparata 0:485458fca2bd 6375
cparata 0:485458fca2bd 6376 /* Wait until operation is not completed */
cparata 0:485458fca2bd 6377 LSM6DSL_ACC_GYRO_GetRawAccData(handle, dummy);
cparata 0:485458fca2bd 6378 do {
cparata 0:485458fca2bd 6379 LSM6DSL_ACC_GYRO_R_XLDA(handle, &op_update);
cparata 0:485458fca2bd 6380 } while(op_update != LSM6DSL_ACC_GYRO_XLDA_DATA_AVAIL);
cparata 0:485458fca2bd 6381 do {
cparata 0:485458fca2bd 6382 LSM6DSL_ACC_GYRO_R_SENS_HUB_END(handle, &op_cmpl);
cparata 0:485458fca2bd 6383 } while(op_cmpl != LSM6DSL_ACC_GYRO_SENS_HUB_END_OP_COMPLETED);
cparata 0:485458fca2bd 6384
cparata 0:485458fca2bd 6385 LSM6DSL_ACC_GYRO_W_ODR_XL(handle, LSM6DSL_ACC_GYRO_ODR_XL_POWER_DOWN);
cparata 0:485458fca2bd 6386
cparata 0:485458fca2bd 6387 /* Stop everything */
cparata 0:485458fca2bd 6388 LSM6DSL_ACC_GYRO_W_FUNC_EN(handle, LSM6DSL_ACC_GYRO_FUNC_EN_DISABLED);
cparata 0:485458fca2bd 6389 LSM6DSL_ACC_GYRO_W_I2C_MASTER_Enable(handle, LSM6DSL_ACC_GYRO_MASTER_ON_DISABLED);
cparata 0:485458fca2bd 6390
cparata 0:485458fca2bd 6391
cparata 0:485458fca2bd 6392 return MEMS_SUCCESS;
cparata 0:485458fca2bd 6393 }