Example of wake up detection for LSM6DSL in X-NUCLEO-IKS01A2

Dependencies:   X_NUCLEO_IKS01A2 mbed

Fork of WakeUp_IKS01A2 by ST Expansion SW Team

Wake up Demo Application based on sensor expansion board X-NUCLEO-IKS01A2

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

Committer:
cparata
Date:
Fri Aug 19 12:35:45 2016 +0000
Revision:
2:7ad7571557a5
Parent:
0:e7e920b85676
Add interfaces to all components

Who changed what in which revision?

UserRevisionLine numberNew contents of line
cparata 0:e7e920b85676 1 /**
cparata 0:e7e920b85676 2 ******************************************************************************
cparata 0:e7e920b85676 3 * @file LSM6DSL_ACC_GYRO_driver.c
cparata 0:e7e920b85676 4 * @author MEMS Application Team
cparata 0:e7e920b85676 5 * @version V1.5
cparata 0:e7e920b85676 6 * @date 17-May-2016
cparata 0:e7e920b85676 7 * @brief LSM6DSL driver file
cparata 0:e7e920b85676 8 ******************************************************************************
cparata 0:e7e920b85676 9 * @attention
cparata 0:e7e920b85676 10 *
cparata 0:e7e920b85676 11 * <h2><center>&copy; COPYRIGHT(c) 2016 STMicroelectronics</center></h2>
cparata 0:e7e920b85676 12 *
cparata 0:e7e920b85676 13 * Redistribution and use in source and binary forms, with or without modification,
cparata 0:e7e920b85676 14 * are permitted provided that the following conditions are met:
cparata 0:e7e920b85676 15 * 1. Redistributions of source code must retain the above copyright notice,
cparata 0:e7e920b85676 16 * this list of conditions and the following disclaimer.
cparata 0:e7e920b85676 17 * 2. Redistributions in binary form must reproduce the above copyright notice,
cparata 0:e7e920b85676 18 * this list of conditions and the following disclaimer in the documentation
cparata 0:e7e920b85676 19 * and/or other materials provided with the distribution.
cparata 0:e7e920b85676 20 * 3. Neither the name of STMicroelectronics nor the names of its contributors
cparata 0:e7e920b85676 21 * may be used to endorse or promote products derived from this software
cparata 0:e7e920b85676 22 * without specific prior written permission.
cparata 0:e7e920b85676 23 *
cparata 0:e7e920b85676 24 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
cparata 0:e7e920b85676 25 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
cparata 0:e7e920b85676 26 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
cparata 0:e7e920b85676 27 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
cparata 0:e7e920b85676 28 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
cparata 0:e7e920b85676 29 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
cparata 0:e7e920b85676 30 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
cparata 0:e7e920b85676 31 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
cparata 0:e7e920b85676 32 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
cparata 0:e7e920b85676 33 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
cparata 0:e7e920b85676 34 *
cparata 0:e7e920b85676 35 ******************************************************************************
cparata 0:e7e920b85676 36 */
cparata 0:e7e920b85676 37
cparata 0:e7e920b85676 38 /* Includes ------------------------------------------------------------------*/
cparata 0:e7e920b85676 39 #include "LSM6DSL_ACC_GYRO_driver.h"
cparata 0:e7e920b85676 40
cparata 0:e7e920b85676 41 /* Imported function prototypes ----------------------------------------------*/
cparata 0:e7e920b85676 42 extern uint8_t LSM6DSL_IO_Write(void *handle, uint8_t WriteAddr, uint8_t *pBuffer, uint16_t nBytesToWrite);
cparata 0:e7e920b85676 43 extern uint8_t LSM6DSL_IO_Read(void *handle, uint8_t ReadAddr, uint8_t *pBuffer, uint16_t nBytesToRead);
cparata 0:e7e920b85676 44
cparata 0:e7e920b85676 45 /* Private typedef -----------------------------------------------------------*/
cparata 0:e7e920b85676 46
cparata 0:e7e920b85676 47 /* Private define ------------------------------------------------------------*/
cparata 0:e7e920b85676 48
cparata 0:e7e920b85676 49 /* Private macro -------------------------------------------------------------*/
cparata 0:e7e920b85676 50
cparata 0:e7e920b85676 51 /* Private variables ---------------------------------------------------------*/
cparata 0:e7e920b85676 52
cparata 0:e7e920b85676 53 /* Private functions ---------------------------------------------------------*/
cparata 0:e7e920b85676 54
cparata 0:e7e920b85676 55 /* Exported functions ---------------------------------------------------------*/
cparata 0:e7e920b85676 56
cparata 0:e7e920b85676 57 /************** Generic Function *******************/
cparata 0:e7e920b85676 58
cparata 0:e7e920b85676 59 /*******************************************************************************
cparata 0:e7e920b85676 60 * Function Name : LSM6DSL_ACC_GYRO_ReadReg
cparata 0:e7e920b85676 61 * Description : Generic Reading function. It must be fullfilled with either
cparata 0:e7e920b85676 62 * : I2C or SPI reading functions
cparata 0:e7e920b85676 63 * Input : Register Address, length of buffer
cparata 0:e7e920b85676 64 * Output : Data REad
cparata 0:e7e920b85676 65 * Return : None
cparata 0:e7e920b85676 66 *******************************************************************************/
cparata 0:e7e920b85676 67 status_t LSM6DSL_ACC_GYRO_ReadReg(void *handle, u8_t Reg, u8_t* Data, u16_t len)
cparata 0:e7e920b85676 68 {
cparata 0:e7e920b85676 69 if (LSM6DSL_IO_Read(handle, Reg, Data, len))
cparata 0:e7e920b85676 70 {
cparata 0:e7e920b85676 71 return MEMS_ERROR;
cparata 0:e7e920b85676 72 }
cparata 0:e7e920b85676 73 else
cparata 0:e7e920b85676 74 {
cparata 0:e7e920b85676 75 return MEMS_SUCCESS;
cparata 0:e7e920b85676 76 }
cparata 0:e7e920b85676 77 }
cparata 0:e7e920b85676 78
cparata 0:e7e920b85676 79 /*******************************************************************************
cparata 0:e7e920b85676 80 * Function Name : LSM6DSL_ACC_GYRO_WriteReg
cparata 0:e7e920b85676 81 * Description : Generic Writing function. It must be fullfilled with either
cparata 0:e7e920b85676 82 * : I2C or SPI writing function
cparata 0:e7e920b85676 83 * Input : Register Address, Data to be written, length of buffer
cparata 0:e7e920b85676 84 * Output : None
cparata 0:e7e920b85676 85 * Return : None
cparata 0:e7e920b85676 86 *******************************************************************************/
cparata 0:e7e920b85676 87 status_t LSM6DSL_ACC_GYRO_WriteReg(void *handle, u8_t Reg, u8_t *Data, u16_t len)
cparata 0:e7e920b85676 88 {
cparata 0:e7e920b85676 89 if (LSM6DSL_IO_Write(handle, Reg, Data, len))
cparata 0:e7e920b85676 90 {
cparata 0:e7e920b85676 91 return MEMS_ERROR;
cparata 0:e7e920b85676 92 }
cparata 0:e7e920b85676 93 else
cparata 0:e7e920b85676 94 {
cparata 0:e7e920b85676 95 return MEMS_SUCCESS;
cparata 0:e7e920b85676 96 }
cparata 0:e7e920b85676 97 }
cparata 0:e7e920b85676 98
cparata 0:e7e920b85676 99 /**************** Base Function *******************/
cparata 0:e7e920b85676 100
cparata 0:e7e920b85676 101 /*******************************************************************************
cparata 0:e7e920b85676 102 * Function Name : LSM6DSL_ACC_GYRO_R_WHO_AM_I
cparata 0:e7e920b85676 103 * Description : Read WHO_AM_I_BIT
cparata 0:e7e920b85676 104 * Input : Pointer to u8_t
cparata 0:e7e920b85676 105 * Output : Status of WHO_AM_I_BIT
cparata 0:e7e920b85676 106 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 107 *******************************************************************************/
cparata 0:e7e920b85676 108 status_t LSM6DSL_ACC_GYRO_R_WHO_AM_I(void *handle, u8_t *value)
cparata 0:e7e920b85676 109 {
cparata 0:e7e920b85676 110 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WHO_AM_I_REG, (u8_t *)value, 1))
cparata 0:e7e920b85676 111 return MEMS_ERROR;
cparata 0:e7e920b85676 112
cparata 0:e7e920b85676 113 *value &= LSM6DSL_ACC_GYRO_WHO_AM_I_BIT_MASK; //coerce
cparata 0:e7e920b85676 114 *value = *value >> LSM6DSL_ACC_GYRO_WHO_AM_I_BIT_POSITION; //mask
cparata 0:e7e920b85676 115
cparata 0:e7e920b85676 116 return MEMS_SUCCESS;
cparata 0:e7e920b85676 117 }
cparata 0:e7e920b85676 118
cparata 0:e7e920b85676 119 /*******************************************************************************
cparata 0:e7e920b85676 120 * Function Name : LSM6DSL_ACC_GYRO_W_BDU
cparata 0:e7e920b85676 121 * Description : Write BDU
cparata 0:e7e920b85676 122 * Input : LSM6DSL_ACC_GYRO_BDU_t
cparata 0:e7e920b85676 123 * Output : None
cparata 0:e7e920b85676 124 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 125 *******************************************************************************/
cparata 0:e7e920b85676 126 status_t LSM6DSL_ACC_GYRO_W_BDU(void *handle, LSM6DSL_ACC_GYRO_BDU_t newValue)
cparata 0:e7e920b85676 127 {
cparata 0:e7e920b85676 128 u8_t value;
cparata 0:e7e920b85676 129
cparata 0:e7e920b85676 130 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
cparata 0:e7e920b85676 131 return MEMS_ERROR;
cparata 0:e7e920b85676 132
cparata 0:e7e920b85676 133 value &= ~LSM6DSL_ACC_GYRO_BDU_MASK;
cparata 0:e7e920b85676 134 value |= newValue;
cparata 0:e7e920b85676 135
cparata 0:e7e920b85676 136 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
cparata 0:e7e920b85676 137 return MEMS_ERROR;
cparata 0:e7e920b85676 138
cparata 0:e7e920b85676 139 return MEMS_SUCCESS;
cparata 0:e7e920b85676 140 }
cparata 0:e7e920b85676 141
cparata 0:e7e920b85676 142 /*******************************************************************************
cparata 0:e7e920b85676 143 * Function Name : LSM6DSL_ACC_GYRO_R_BDU
cparata 0:e7e920b85676 144 * Description : Read BDU
cparata 0:e7e920b85676 145 * Input : Pointer to LSM6DSL_ACC_GYRO_BDU_t
cparata 0:e7e920b85676 146 * Output : Status of BDU see LSM6DSL_ACC_GYRO_BDU_t
cparata 0:e7e920b85676 147 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 148 *******************************************************************************/
cparata 0:e7e920b85676 149 status_t LSM6DSL_ACC_GYRO_R_BDU(void *handle, LSM6DSL_ACC_GYRO_BDU_t *value)
cparata 0:e7e920b85676 150 {
cparata 0:e7e920b85676 151 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1))
cparata 0:e7e920b85676 152 return MEMS_ERROR;
cparata 0:e7e920b85676 153
cparata 0:e7e920b85676 154 *value &= LSM6DSL_ACC_GYRO_BDU_MASK; //mask
cparata 0:e7e920b85676 155
cparata 0:e7e920b85676 156 return MEMS_SUCCESS;
cparata 0:e7e920b85676 157 }
cparata 0:e7e920b85676 158
cparata 0:e7e920b85676 159 /*******************************************************************************
cparata 0:e7e920b85676 160 * Function Name : LSM6DSL_ACC_GYRO_W_FS_XL
cparata 0:e7e920b85676 161 * Description : Write FS_XL
cparata 0:e7e920b85676 162 * Input : LSM6DSL_ACC_GYRO_FS_XL_t
cparata 0:e7e920b85676 163 * Output : None
cparata 0:e7e920b85676 164 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 165 *******************************************************************************/
cparata 0:e7e920b85676 166 status_t LSM6DSL_ACC_GYRO_W_FS_XL(void *handle, LSM6DSL_ACC_GYRO_FS_XL_t newValue)
cparata 0:e7e920b85676 167 {
cparata 0:e7e920b85676 168 u8_t value;
cparata 0:e7e920b85676 169
cparata 0:e7e920b85676 170 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, &value, 1))
cparata 0:e7e920b85676 171 return MEMS_ERROR;
cparata 0:e7e920b85676 172
cparata 0:e7e920b85676 173 value &= ~LSM6DSL_ACC_GYRO_FS_XL_MASK;
cparata 0:e7e920b85676 174 value |= newValue;
cparata 0:e7e920b85676 175
cparata 0:e7e920b85676 176 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, &value, 1) )
cparata 0:e7e920b85676 177 return MEMS_ERROR;
cparata 0:e7e920b85676 178
cparata 0:e7e920b85676 179 return MEMS_SUCCESS;
cparata 0:e7e920b85676 180 }
cparata 0:e7e920b85676 181
cparata 0:e7e920b85676 182 /*******************************************************************************
cparata 0:e7e920b85676 183 * Function Name : LSM6DSL_ACC_GYRO_R_FS_XL
cparata 0:e7e920b85676 184 * Description : Read FS_XL
cparata 0:e7e920b85676 185 * Input : Pointer to LSM6DSL_ACC_GYRO_FS_XL_t
cparata 0:e7e920b85676 186 * Output : Status of FS_XL see LSM6DSL_ACC_GYRO_FS_XL_t
cparata 0:e7e920b85676 187 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 188 *******************************************************************************/
cparata 0:e7e920b85676 189 status_t LSM6DSL_ACC_GYRO_R_FS_XL(void *handle, LSM6DSL_ACC_GYRO_FS_XL_t *value)
cparata 0:e7e920b85676 190 {
cparata 0:e7e920b85676 191 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, (u8_t *)value, 1))
cparata 0:e7e920b85676 192 return MEMS_ERROR;
cparata 0:e7e920b85676 193
cparata 0:e7e920b85676 194 *value &= LSM6DSL_ACC_GYRO_FS_XL_MASK; //mask
cparata 0:e7e920b85676 195
cparata 0:e7e920b85676 196 return MEMS_SUCCESS;
cparata 0:e7e920b85676 197 }
cparata 0:e7e920b85676 198
cparata 0:e7e920b85676 199 /*******************************************************************************
cparata 0:e7e920b85676 200 * Function Name : status_t LSM6DSL_ACC_GYRO_GetRawAccData(u8_t *buff)
cparata 0:e7e920b85676 201 * Description : Read GetAccData output register
cparata 0:e7e920b85676 202 * Input : pointer to [u8_t]
cparata 0:e7e920b85676 203 * Output : GetAccData buffer u8_t
cparata 0:e7e920b85676 204 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 205 *******************************************************************************/
cparata 0:e7e920b85676 206 status_t LSM6DSL_ACC_GYRO_GetRawAccData(void *handle, u8_t *buff)
cparata 0:e7e920b85676 207 {
cparata 0:e7e920b85676 208 u8_t i, j, k;
cparata 0:e7e920b85676 209 u8_t numberOfByteForDimension;
cparata 0:e7e920b85676 210
cparata 0:e7e920b85676 211 numberOfByteForDimension=6/3;
cparata 0:e7e920b85676 212
cparata 0:e7e920b85676 213 k=0;
cparata 0:e7e920b85676 214 for (i=0; i<3;i++ )
cparata 0:e7e920b85676 215 {
cparata 0:e7e920b85676 216 for (j=0; j<numberOfByteForDimension;j++ )
cparata 0:e7e920b85676 217 {
cparata 0:e7e920b85676 218 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_OUTX_L_XL+k, &buff[k], 1))
cparata 0:e7e920b85676 219 return MEMS_ERROR;
cparata 0:e7e920b85676 220 k++;
cparata 0:e7e920b85676 221 }
cparata 0:e7e920b85676 222 }
cparata 0:e7e920b85676 223
cparata 0:e7e920b85676 224 return MEMS_SUCCESS;
cparata 0:e7e920b85676 225 }
cparata 0:e7e920b85676 226
cparata 0:e7e920b85676 227 /*******************************************************************************
cparata 0:e7e920b85676 228 * Function Name : status_t LSM6DSL_ACC_Get_Acceleration(void *handle, int *buff, u8_t from_fifo)
cparata 0:e7e920b85676 229 * Description : Read GetAccData output register
cparata 0:e7e920b85676 230 * Input : pointer to [u8_t]
cparata 0:e7e920b85676 231 * Output : values are expressed in mg
cparata 0:e7e920b85676 232 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 233 *******************************************************************************/
cparata 0:e7e920b85676 234 /*
cparata 0:e7e920b85676 235 * Following is the table of sensitivity values for each case.
cparata 0:e7e920b85676 236 * Values are expressed in ug/digit.
cparata 0:e7e920b85676 237 */
cparata 0:e7e920b85676 238 static const long long LSM6DSL_ACC_Sensitivity_List[4] = {
cparata 0:e7e920b85676 239 61, /* FS @2g */
cparata 0:e7e920b85676 240 122, /* FS @4g */
cparata 0:e7e920b85676 241 244, /* FS @8g */
cparata 0:e7e920b85676 242 488, /* FS @16g */
cparata 0:e7e920b85676 243 };
cparata 0:e7e920b85676 244 status_t LSM6DSL_ACC_Get_Acceleration(void *handle, int *buff, u8_t from_fifo)
cparata 0:e7e920b85676 245 {
cparata 0:e7e920b85676 246 LSM6DSL_ACC_GYRO_FS_XL_t fs;
cparata 0:e7e920b85676 247 long long sensitivity = 0;
cparata 0:e7e920b85676 248 Type3Axis16bit_U raw_data_tmp;
cparata 0:e7e920b85676 249
cparata 0:e7e920b85676 250 /* Read out current odr, fs, hf setting */
cparata 0:e7e920b85676 251 LSM6DSL_ACC_GYRO_R_FS_XL(handle, &fs);
cparata 0:e7e920b85676 252
cparata 0:e7e920b85676 253 /* Determine the sensitivity according to fs */
cparata 0:e7e920b85676 254 switch(fs) {
cparata 0:e7e920b85676 255 case LSM6DSL_ACC_GYRO_FS_XL_2g:
cparata 0:e7e920b85676 256 sensitivity = LSM6DSL_ACC_Sensitivity_List[0];
cparata 0:e7e920b85676 257 break;
cparata 0:e7e920b85676 258
cparata 0:e7e920b85676 259 case LSM6DSL_ACC_GYRO_FS_XL_4g:
cparata 0:e7e920b85676 260 sensitivity = LSM6DSL_ACC_Sensitivity_List[1];
cparata 0:e7e920b85676 261 break;
cparata 0:e7e920b85676 262
cparata 0:e7e920b85676 263 case LSM6DSL_ACC_GYRO_FS_XL_8g:
cparata 0:e7e920b85676 264 sensitivity = LSM6DSL_ACC_Sensitivity_List[2];
cparata 0:e7e920b85676 265 break;
cparata 0:e7e920b85676 266
cparata 0:e7e920b85676 267 case LSM6DSL_ACC_GYRO_FS_XL_16g:
cparata 0:e7e920b85676 268 sensitivity = LSM6DSL_ACC_Sensitivity_List[3];
cparata 0:e7e920b85676 269 break;
cparata 0:e7e920b85676 270 }
cparata 0:e7e920b85676 271
cparata 0:e7e920b85676 272 /* Read out raw accelerometer samples */
cparata 0:e7e920b85676 273 if (from_fifo) {
cparata 0:e7e920b85676 274 u8_t i;
cparata 0:e7e920b85676 275
cparata 0:e7e920b85676 276 /* read all 3 axis from FIFO */
cparata 0:e7e920b85676 277 for(i = 0; i < 3; i++)
cparata 0:e7e920b85676 278 LSM6DSL_ACC_GYRO_Get_GetFIFOData(handle, raw_data_tmp.u8bit + 2*i);
cparata 0:e7e920b85676 279 } else
cparata 0:e7e920b85676 280 LSM6DSL_ACC_GYRO_GetRawAccData(handle, raw_data_tmp.u8bit);
cparata 0:e7e920b85676 281
cparata 0:e7e920b85676 282 /* Apply proper shift and sensitivity */
cparata 0:e7e920b85676 283 buff[0] = (raw_data_tmp.i16bit[0] * sensitivity + 500)/1000;
cparata 0:e7e920b85676 284 buff[1] = (raw_data_tmp.i16bit[1] * sensitivity + 500)/1000;
cparata 0:e7e920b85676 285 buff[2] = (raw_data_tmp.i16bit[2] * sensitivity + 500)/1000;
cparata 0:e7e920b85676 286
cparata 0:e7e920b85676 287 return MEMS_SUCCESS;
cparata 0:e7e920b85676 288 }
cparata 0:e7e920b85676 289
cparata 0:e7e920b85676 290 /*******************************************************************************
cparata 0:e7e920b85676 291 * Function Name : LSM6DSL_ACC_GYRO_W_ODR_XL
cparata 0:e7e920b85676 292 * Description : Write ODR_XL
cparata 0:e7e920b85676 293 * Input : LSM6DSL_ACC_GYRO_ODR_XL_t
cparata 0:e7e920b85676 294 * Output : None
cparata 0:e7e920b85676 295 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 296 *******************************************************************************/
cparata 0:e7e920b85676 297 status_t LSM6DSL_ACC_GYRO_W_ODR_XL(void *handle, LSM6DSL_ACC_GYRO_ODR_XL_t newValue)
cparata 0:e7e920b85676 298 {
cparata 0:e7e920b85676 299 u8_t value;
cparata 0:e7e920b85676 300
cparata 0:e7e920b85676 301 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, &value, 1))
cparata 0:e7e920b85676 302 return MEMS_ERROR;
cparata 0:e7e920b85676 303
cparata 0:e7e920b85676 304 value &= ~LSM6DSL_ACC_GYRO_ODR_XL_MASK;
cparata 0:e7e920b85676 305 value |= newValue;
cparata 0:e7e920b85676 306
cparata 0:e7e920b85676 307 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, &value, 1) )
cparata 0:e7e920b85676 308 return MEMS_ERROR;
cparata 0:e7e920b85676 309
cparata 0:e7e920b85676 310 return MEMS_SUCCESS;
cparata 0:e7e920b85676 311 }
cparata 0:e7e920b85676 312
cparata 0:e7e920b85676 313 /*******************************************************************************
cparata 0:e7e920b85676 314 * Function Name : LSM6DSL_ACC_GYRO_R_ODR_XL
cparata 0:e7e920b85676 315 * Description : Read ODR_XL
cparata 0:e7e920b85676 316 * Input : Pointer to LSM6DSL_ACC_GYRO_ODR_XL_t
cparata 0:e7e920b85676 317 * Output : Status of ODR_XL see LSM6DSL_ACC_GYRO_ODR_XL_t
cparata 0:e7e920b85676 318 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 319 *******************************************************************************/
cparata 0:e7e920b85676 320 status_t LSM6DSL_ACC_GYRO_R_ODR_XL(void *handle, LSM6DSL_ACC_GYRO_ODR_XL_t *value)
cparata 0:e7e920b85676 321 {
cparata 0:e7e920b85676 322 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, (u8_t *)value, 1))
cparata 0:e7e920b85676 323 return MEMS_ERROR;
cparata 0:e7e920b85676 324
cparata 0:e7e920b85676 325 *value &= LSM6DSL_ACC_GYRO_ODR_XL_MASK; //mask
cparata 0:e7e920b85676 326
cparata 0:e7e920b85676 327 return MEMS_SUCCESS;
cparata 0:e7e920b85676 328 }
cparata 0:e7e920b85676 329
cparata 0:e7e920b85676 330 /*******************************************************************************
cparata 0:e7e920b85676 331 * Function Name : LSM6DSL_ACC_GYRO_translate_ODR_XL
cparata 0:e7e920b85676 332 * Description : Read ODR_XL
cparata 0:e7e920b85676 333 * Input : LSM6DSL_ACC_GYRO_ODR_XL_t
cparata 0:e7e920b85676 334 * Output : The ODR value in Hz
cparata 0:e7e920b85676 335 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 336 *******************************************************************************/
cparata 0:e7e920b85676 337 status_t LSM6DSL_ACC_GYRO_translate_ODR_XL(LSM6DSL_ACC_GYRO_ODR_XL_t value, u16_t *odr_hz_val)
cparata 0:e7e920b85676 338 {
cparata 0:e7e920b85676 339 switch(value) {
cparata 0:e7e920b85676 340 case LSM6DSL_ACC_GYRO_ODR_XL_POWER_DOWN:
cparata 0:e7e920b85676 341 *odr_hz_val = 0;
cparata 0:e7e920b85676 342 break;
cparata 0:e7e920b85676 343
cparata 0:e7e920b85676 344 case LSM6DSL_ACC_GYRO_ODR_XL_13Hz:
cparata 0:e7e920b85676 345 *odr_hz_val = 13;
cparata 0:e7e920b85676 346 break;
cparata 0:e7e920b85676 347
cparata 0:e7e920b85676 348 case LSM6DSL_ACC_GYRO_ODR_XL_26Hz:
cparata 0:e7e920b85676 349 *odr_hz_val = 26;
cparata 0:e7e920b85676 350 break;
cparata 0:e7e920b85676 351
cparata 0:e7e920b85676 352 case LSM6DSL_ACC_GYRO_ODR_XL_52Hz:
cparata 0:e7e920b85676 353 *odr_hz_val = 52;
cparata 0:e7e920b85676 354 break;
cparata 0:e7e920b85676 355
cparata 0:e7e920b85676 356 case LSM6DSL_ACC_GYRO_ODR_XL_104Hz:
cparata 0:e7e920b85676 357 *odr_hz_val = 104;
cparata 0:e7e920b85676 358 break;
cparata 0:e7e920b85676 359
cparata 0:e7e920b85676 360 case LSM6DSL_ACC_GYRO_ODR_XL_208Hz:
cparata 0:e7e920b85676 361 *odr_hz_val = 208;
cparata 0:e7e920b85676 362 break;
cparata 0:e7e920b85676 363
cparata 0:e7e920b85676 364 case LSM6DSL_ACC_GYRO_ODR_XL_416Hz:
cparata 0:e7e920b85676 365 *odr_hz_val = 416;
cparata 0:e7e920b85676 366 break;
cparata 0:e7e920b85676 367
cparata 0:e7e920b85676 368 case LSM6DSL_ACC_GYRO_ODR_XL_833Hz:
cparata 0:e7e920b85676 369 *odr_hz_val = 833;
cparata 0:e7e920b85676 370 break;
cparata 0:e7e920b85676 371
cparata 0:e7e920b85676 372 case LSM6DSL_ACC_GYRO_ODR_XL_1660Hz:
cparata 0:e7e920b85676 373 *odr_hz_val = 1660;
cparata 0:e7e920b85676 374 break;
cparata 0:e7e920b85676 375
cparata 0:e7e920b85676 376 default:
cparata 0:e7e920b85676 377 return MEMS_ERROR;
cparata 0:e7e920b85676 378 }
cparata 0:e7e920b85676 379
cparata 0:e7e920b85676 380 return MEMS_SUCCESS;
cparata 0:e7e920b85676 381 }
cparata 0:e7e920b85676 382
cparata 0:e7e920b85676 383 /*******************************************************************************
cparata 0:e7e920b85676 384 * Function Name : LSM6DSL_ACC_GYRO_W_FS_G
cparata 0:e7e920b85676 385 * Description : Write FS_G
cparata 0:e7e920b85676 386 * Input : LSM6DSL_ACC_GYRO_FS_G_t
cparata 0:e7e920b85676 387 * Output : None
cparata 0:e7e920b85676 388 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 389 *******************************************************************************/
cparata 0:e7e920b85676 390 status_t LSM6DSL_ACC_GYRO_W_FS_G(void *handle, LSM6DSL_ACC_GYRO_FS_G_t newValue)
cparata 0:e7e920b85676 391 {
cparata 0:e7e920b85676 392 u8_t value;
cparata 0:e7e920b85676 393
cparata 0:e7e920b85676 394 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, &value, 1))
cparata 0:e7e920b85676 395 return MEMS_ERROR;
cparata 0:e7e920b85676 396
cparata 0:e7e920b85676 397 value &= ~LSM6DSL_ACC_GYRO_FS_G_MASK;
cparata 0:e7e920b85676 398 value |= newValue;
cparata 0:e7e920b85676 399
cparata 0:e7e920b85676 400 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, &value, 1) )
cparata 0:e7e920b85676 401 return MEMS_ERROR;
cparata 0:e7e920b85676 402
cparata 0:e7e920b85676 403 return MEMS_SUCCESS;
cparata 0:e7e920b85676 404 }
cparata 0:e7e920b85676 405
cparata 0:e7e920b85676 406 /*******************************************************************************
cparata 0:e7e920b85676 407 * Function Name : LSM6DSL_ACC_GYRO_R_FS_G
cparata 0:e7e920b85676 408 * Description : Read FS_G
cparata 0:e7e920b85676 409 * Input : Pointer to LSM6DSL_ACC_GYRO_FS_G_t
cparata 0:e7e920b85676 410 * Output : Status of FS_G see LSM6DSL_ACC_GYRO_FS_G_t
cparata 0:e7e920b85676 411 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 412 *******************************************************************************/
cparata 0:e7e920b85676 413 status_t LSM6DSL_ACC_GYRO_R_FS_G(void *handle, LSM6DSL_ACC_GYRO_FS_G_t *value)
cparata 0:e7e920b85676 414 {
cparata 0:e7e920b85676 415 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, (u8_t *)value, 1))
cparata 0:e7e920b85676 416 return MEMS_ERROR;
cparata 0:e7e920b85676 417
cparata 0:e7e920b85676 418 *value &= LSM6DSL_ACC_GYRO_FS_G_MASK; //mask
cparata 0:e7e920b85676 419
cparata 0:e7e920b85676 420 return MEMS_SUCCESS;
cparata 0:e7e920b85676 421 }
cparata 0:e7e920b85676 422
cparata 0:e7e920b85676 423 /*******************************************************************************
cparata 0:e7e920b85676 424 * Function Name : status_t LSM6DSL_ACC_GYRO_GetRawGyroData(u8_t *buff)
cparata 0:e7e920b85676 425 * Description : Read GetGyroData output register
cparata 0:e7e920b85676 426 * Input : pointer to [u8_t]
cparata 0:e7e920b85676 427 * Output : GetGyroData buffer u8_t
cparata 0:e7e920b85676 428 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 429 *******************************************************************************/
cparata 0:e7e920b85676 430 status_t LSM6DSL_ACC_GYRO_GetRawGyroData(void *handle, u8_t *buff)
cparata 0:e7e920b85676 431 {
cparata 0:e7e920b85676 432 u8_t i, j, k;
cparata 0:e7e920b85676 433 u8_t numberOfByteForDimension;
cparata 0:e7e920b85676 434
cparata 0:e7e920b85676 435 numberOfByteForDimension=6/3;
cparata 0:e7e920b85676 436
cparata 0:e7e920b85676 437 k=0;
cparata 0:e7e920b85676 438 for (i=0; i<3;i++ )
cparata 0:e7e920b85676 439 {
cparata 0:e7e920b85676 440 for (j=0; j<numberOfByteForDimension;j++ )
cparata 0:e7e920b85676 441 {
cparata 0:e7e920b85676 442 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_OUTX_L_G+k, &buff[k], 1))
cparata 0:e7e920b85676 443 return MEMS_ERROR;
cparata 0:e7e920b85676 444 k++;
cparata 0:e7e920b85676 445 }
cparata 0:e7e920b85676 446 }
cparata 0:e7e920b85676 447
cparata 0:e7e920b85676 448 return MEMS_SUCCESS;
cparata 0:e7e920b85676 449 }
cparata 0:e7e920b85676 450
cparata 0:e7e920b85676 451 /*******************************************************************************
cparata 0:e7e920b85676 452 * Function Name : status_t LSM6DSL_ACC_Get_AngularRate(u8_t *buff)
cparata 0:e7e920b85676 453 * Description : Read GetGyroData output register
cparata 0:e7e920b85676 454 * Input : pointer to [u8_t]
cparata 0:e7e920b85676 455 * Output : Returned values are espressed in mdps
cparata 0:e7e920b85676 456 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 457 *******************************************************************************/
cparata 0:e7e920b85676 458 /*
cparata 0:e7e920b85676 459 * Following is the table of sensitivity values for each case.
cparata 0:e7e920b85676 460 * Values are espressed in udps/digit.
cparata 0:e7e920b85676 461 */
cparata 0:e7e920b85676 462 static const long long LSM6DSL_GYRO_Sensitivity_List[5] = {
cparata 0:e7e920b85676 463 4375, /* FS @125 */
cparata 0:e7e920b85676 464 8750, /* FS @245 */
cparata 0:e7e920b85676 465 17500, /* FS @500 */
cparata 0:e7e920b85676 466 35000, /* FS @1000 */
cparata 0:e7e920b85676 467 70000, /* FS @2000 */
cparata 0:e7e920b85676 468 };
cparata 0:e7e920b85676 469 status_t LSM6DSL_ACC_Get_AngularRate(void *handle, int *buff, u8_t from_fifo)
cparata 0:e7e920b85676 470 {
cparata 0:e7e920b85676 471 LSM6DSL_ACC_GYRO_FS_125_t fs_125;
cparata 0:e7e920b85676 472 LSM6DSL_ACC_GYRO_FS_G_t fs;
cparata 0:e7e920b85676 473 long long sensitivity = 0;
cparata 0:e7e920b85676 474 Type3Axis16bit_U raw_data_tmp;
cparata 0:e7e920b85676 475
cparata 0:e7e920b85676 476 /* Read out current odr, fs, hf setting */
cparata 0:e7e920b85676 477 LSM6DSL_ACC_GYRO_R_FS_125(handle, &fs_125);
cparata 0:e7e920b85676 478 if (fs_125 == LSM6DSL_ACC_GYRO_FS_125_ENABLED) {
cparata 0:e7e920b85676 479 sensitivity = LSM6DSL_GYRO_Sensitivity_List[0];
cparata 0:e7e920b85676 480 } else {
cparata 0:e7e920b85676 481 LSM6DSL_ACC_GYRO_R_FS_G(handle, &fs);
cparata 0:e7e920b85676 482
cparata 0:e7e920b85676 483 /* Determine the sensitivity according to fs */
cparata 0:e7e920b85676 484 switch(fs) {
cparata 0:e7e920b85676 485 case LSM6DSL_ACC_GYRO_FS_G_245dps:
cparata 0:e7e920b85676 486 sensitivity = LSM6DSL_GYRO_Sensitivity_List[1];
cparata 0:e7e920b85676 487 break;
cparata 0:e7e920b85676 488
cparata 0:e7e920b85676 489 case LSM6DSL_ACC_GYRO_FS_G_500dps:
cparata 0:e7e920b85676 490 sensitivity = LSM6DSL_GYRO_Sensitivity_List[2];
cparata 0:e7e920b85676 491 break;
cparata 0:e7e920b85676 492
cparata 0:e7e920b85676 493 case LSM6DSL_ACC_GYRO_FS_G_1000dps:
cparata 0:e7e920b85676 494 sensitivity = LSM6DSL_GYRO_Sensitivity_List[3];
cparata 0:e7e920b85676 495 break;
cparata 0:e7e920b85676 496
cparata 0:e7e920b85676 497 case LSM6DSL_ACC_GYRO_FS_G_2000dps:
cparata 0:e7e920b85676 498 sensitivity = LSM6DSL_GYRO_Sensitivity_List[4];
cparata 0:e7e920b85676 499 break;
cparata 0:e7e920b85676 500 }
cparata 0:e7e920b85676 501 }
cparata 0:e7e920b85676 502
cparata 0:e7e920b85676 503 /* Read out raw accelerometer samples */
cparata 0:e7e920b85676 504 if (from_fifo) {
cparata 0:e7e920b85676 505 u8_t i;
cparata 0:e7e920b85676 506
cparata 0:e7e920b85676 507 /* read all 3 axis from FIFO */
cparata 0:e7e920b85676 508 for(i = 0; i < 3; i++)
cparata 0:e7e920b85676 509 LSM6DSL_ACC_GYRO_Get_GetFIFOData(handle, raw_data_tmp.u8bit + 2*i);
cparata 0:e7e920b85676 510 } else
cparata 0:e7e920b85676 511 LSM6DSL_ACC_GYRO_GetRawGyroData(handle, raw_data_tmp.u8bit);
cparata 0:e7e920b85676 512
cparata 0:e7e920b85676 513 /* Apply proper shift and sensitivity */
cparata 0:e7e920b85676 514 buff[0] = (raw_data_tmp.i16bit[0] * sensitivity + 500)/1000;
cparata 0:e7e920b85676 515 buff[1] = (raw_data_tmp.i16bit[1] * sensitivity + 500)/1000;
cparata 0:e7e920b85676 516 buff[2] = (raw_data_tmp.i16bit[2] * sensitivity + 500)/1000;
cparata 0:e7e920b85676 517
cparata 0:e7e920b85676 518 return MEMS_SUCCESS;
cparata 0:e7e920b85676 519 }
cparata 0:e7e920b85676 520
cparata 0:e7e920b85676 521 /*******************************************************************************
cparata 0:e7e920b85676 522 * Function Name : LSM6DSL_ACC_GYRO_W_ODR_G
cparata 0:e7e920b85676 523 * Description : Write ODR_G
cparata 0:e7e920b85676 524 * Input : LSM6DSL_ACC_GYRO_ODR_G_t
cparata 0:e7e920b85676 525 * Output : None
cparata 0:e7e920b85676 526 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 527 *******************************************************************************/
cparata 0:e7e920b85676 528 status_t LSM6DSL_ACC_GYRO_W_ODR_G(void *handle, LSM6DSL_ACC_GYRO_ODR_G_t newValue)
cparata 0:e7e920b85676 529 {
cparata 0:e7e920b85676 530 u8_t value;
cparata 0:e7e920b85676 531
cparata 0:e7e920b85676 532 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, &value, 1))
cparata 0:e7e920b85676 533 return MEMS_ERROR;
cparata 0:e7e920b85676 534
cparata 0:e7e920b85676 535 value &= ~LSM6DSL_ACC_GYRO_ODR_G_MASK;
cparata 0:e7e920b85676 536 value |= newValue;
cparata 0:e7e920b85676 537
cparata 0:e7e920b85676 538 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, &value, 1) )
cparata 0:e7e920b85676 539 return MEMS_ERROR;
cparata 0:e7e920b85676 540
cparata 0:e7e920b85676 541 return MEMS_SUCCESS;
cparata 0:e7e920b85676 542 }
cparata 0:e7e920b85676 543
cparata 0:e7e920b85676 544 /*******************************************************************************
cparata 0:e7e920b85676 545 * Function Name : LSM6DSL_ACC_GYRO_R_ODR_G
cparata 0:e7e920b85676 546 * Description : Read ODR_G
cparata 0:e7e920b85676 547 * Input : Pointer to LSM6DSL_ACC_GYRO_ODR_G_t
cparata 0:e7e920b85676 548 * Output : Status of ODR_G see LSM6DSL_ACC_GYRO_ODR_G_t
cparata 0:e7e920b85676 549 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 550 *******************************************************************************/
cparata 0:e7e920b85676 551 status_t LSM6DSL_ACC_GYRO_R_ODR_G(void *handle, LSM6DSL_ACC_GYRO_ODR_G_t *value)
cparata 0:e7e920b85676 552 {
cparata 0:e7e920b85676 553 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, (u8_t *)value, 1))
cparata 0:e7e920b85676 554 return MEMS_ERROR;
cparata 0:e7e920b85676 555
cparata 0:e7e920b85676 556 *value &= LSM6DSL_ACC_GYRO_ODR_G_MASK; //mask
cparata 0:e7e920b85676 557
cparata 0:e7e920b85676 558 return MEMS_SUCCESS;
cparata 0:e7e920b85676 559 }
cparata 0:e7e920b85676 560
cparata 0:e7e920b85676 561 /*******************************************************************************
cparata 0:e7e920b85676 562 * Function Name : LSM6DSL_ACC_GYRO_translate_ODR_G
cparata 0:e7e920b85676 563 * Description : Read ODR_G
cparata 0:e7e920b85676 564 * Input : LSM6DSL_ACC_GYRO_ODR_G_t
cparata 0:e7e920b85676 565 * Output : The ODR value in Hz
cparata 0:e7e920b85676 566 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 567 *******************************************************************************/
cparata 0:e7e920b85676 568 status_t LSM6DSL_ACC_GYRO_translate_ODR_G(LSM6DSL_ACC_GYRO_ODR_G_t value, u16_t *odr_hz_val)
cparata 0:e7e920b85676 569 {
cparata 0:e7e920b85676 570 switch(value) {
cparata 0:e7e920b85676 571 case LSM6DSL_ACC_GYRO_ODR_G_POWER_DOWN:
cparata 0:e7e920b85676 572 *odr_hz_val = 0;
cparata 0:e7e920b85676 573 break;
cparata 0:e7e920b85676 574
cparata 0:e7e920b85676 575 case LSM6DSL_ACC_GYRO_ODR_G_13Hz:
cparata 0:e7e920b85676 576 *odr_hz_val = 13;
cparata 0:e7e920b85676 577 break;
cparata 0:e7e920b85676 578
cparata 0:e7e920b85676 579 case LSM6DSL_ACC_GYRO_ODR_G_26Hz:
cparata 0:e7e920b85676 580 *odr_hz_val = 26;
cparata 0:e7e920b85676 581 break;
cparata 0:e7e920b85676 582
cparata 0:e7e920b85676 583 case LSM6DSL_ACC_GYRO_ODR_G_52Hz:
cparata 0:e7e920b85676 584 *odr_hz_val = 52;
cparata 0:e7e920b85676 585 break;
cparata 0:e7e920b85676 586
cparata 0:e7e920b85676 587 case LSM6DSL_ACC_GYRO_ODR_G_104Hz:
cparata 0:e7e920b85676 588 *odr_hz_val = 104;
cparata 0:e7e920b85676 589 break;
cparata 0:e7e920b85676 590
cparata 0:e7e920b85676 591 case LSM6DSL_ACC_GYRO_ODR_G_208Hz:
cparata 0:e7e920b85676 592 *odr_hz_val = 208;
cparata 0:e7e920b85676 593 break;
cparata 0:e7e920b85676 594
cparata 0:e7e920b85676 595 case LSM6DSL_ACC_GYRO_ODR_G_416Hz:
cparata 0:e7e920b85676 596 *odr_hz_val = 416;
cparata 0:e7e920b85676 597 break;
cparata 0:e7e920b85676 598
cparata 0:e7e920b85676 599 case LSM6DSL_ACC_GYRO_ODR_G_833Hz:
cparata 0:e7e920b85676 600 *odr_hz_val = 833;
cparata 0:e7e920b85676 601 break;
cparata 0:e7e920b85676 602
cparata 0:e7e920b85676 603 case LSM6DSL_ACC_GYRO_ODR_G_1660Hz:
cparata 0:e7e920b85676 604 *odr_hz_val = 1660;
cparata 0:e7e920b85676 605 break;
cparata 0:e7e920b85676 606
cparata 0:e7e920b85676 607 default:
cparata 0:e7e920b85676 608 return MEMS_ERROR;
cparata 0:e7e920b85676 609 }
cparata 0:e7e920b85676 610
cparata 0:e7e920b85676 611 return MEMS_SUCCESS;
cparata 0:e7e920b85676 612 }
cparata 0:e7e920b85676 613
cparata 0:e7e920b85676 614 /*******************************************************************************
cparata 0:e7e920b85676 615 * Function Name : LSM6DSL_ACC_GYRO_W_FS_125
cparata 0:e7e920b85676 616 * Description : Write FS_125
cparata 0:e7e920b85676 617 * Input : LSM6DSL_ACC_GYRO_FS_125_t
cparata 0:e7e920b85676 618 * Output : None
cparata 0:e7e920b85676 619 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 620 *******************************************************************************/
cparata 0:e7e920b85676 621 status_t LSM6DSL_ACC_GYRO_W_FS_125(void *handle, LSM6DSL_ACC_GYRO_FS_125_t newValue)
cparata 0:e7e920b85676 622 {
cparata 0:e7e920b85676 623 u8_t value;
cparata 0:e7e920b85676 624
cparata 0:e7e920b85676 625 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, &value, 1))
cparata 0:e7e920b85676 626 return MEMS_ERROR;
cparata 0:e7e920b85676 627
cparata 0:e7e920b85676 628 value &= ~LSM6DSL_ACC_GYRO_FS_125_MASK;
cparata 0:e7e920b85676 629 value |= newValue;
cparata 0:e7e920b85676 630
cparata 0:e7e920b85676 631 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, &value, 1) )
cparata 0:e7e920b85676 632 return MEMS_ERROR;
cparata 0:e7e920b85676 633
cparata 0:e7e920b85676 634 return MEMS_SUCCESS;
cparata 0:e7e920b85676 635 }
cparata 0:e7e920b85676 636
cparata 0:e7e920b85676 637 /*******************************************************************************
cparata 0:e7e920b85676 638 * Function Name : LSM6DSL_ACC_GYRO_R_FS_125
cparata 0:e7e920b85676 639 * Description : Read FS_125
cparata 0:e7e920b85676 640 * Input : Pointer to LSM6DSL_ACC_GYRO_FS_125_t
cparata 0:e7e920b85676 641 * Output : Status of FS_125 see LSM6DSL_ACC_GYRO_FS_125_t
cparata 0:e7e920b85676 642 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 643 *******************************************************************************/
cparata 0:e7e920b85676 644 status_t LSM6DSL_ACC_GYRO_R_FS_125(void *handle, LSM6DSL_ACC_GYRO_FS_125_t *value)
cparata 0:e7e920b85676 645 {
cparata 0:e7e920b85676 646 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, (u8_t *)value, 1))
cparata 0:e7e920b85676 647 return MEMS_ERROR;
cparata 0:e7e920b85676 648
cparata 0:e7e920b85676 649 *value &= LSM6DSL_ACC_GYRO_FS_125_MASK; //mask
cparata 0:e7e920b85676 650
cparata 0:e7e920b85676 651 return MEMS_SUCCESS;
cparata 0:e7e920b85676 652 }
cparata 0:e7e920b85676 653
cparata 0:e7e920b85676 654 /**************** Advanced Function *******************/
cparata 0:e7e920b85676 655
cparata 0:e7e920b85676 656 /*******************************************************************************
cparata 0:e7e920b85676 657 * Function Name : LSM6DSL_ACC_GYRO_W_BW_SEL
cparata 0:e7e920b85676 658 * Description : Write BW_SEL
cparata 0:e7e920b85676 659 * Input : LSM6DSL_ACC_GYRO_BW_SEL_t
cparata 0:e7e920b85676 660 * Output : None
cparata 0:e7e920b85676 661 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 662 *******************************************************************************/
cparata 0:e7e920b85676 663 status_t LSM6DSL_ACC_GYRO_W_BW_SEL(void *handle, LSM6DSL_ACC_GYRO_BW_SEL_t newValue)
cparata 0:e7e920b85676 664 {
cparata 0:e7e920b85676 665 u8_t value;
cparata 0:e7e920b85676 666
cparata 0:e7e920b85676 667 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, &value, 1))
cparata 0:e7e920b85676 668 return MEMS_ERROR;
cparata 0:e7e920b85676 669
cparata 0:e7e920b85676 670 value &= ~LSM6DSL_ACC_GYRO_BW_SEL_MASK;
cparata 0:e7e920b85676 671 value |= newValue;
cparata 0:e7e920b85676 672
cparata 0:e7e920b85676 673 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, &value, 1) )
cparata 0:e7e920b85676 674 return MEMS_ERROR;
cparata 0:e7e920b85676 675
cparata 0:e7e920b85676 676 return MEMS_SUCCESS;
cparata 0:e7e920b85676 677 }
cparata 0:e7e920b85676 678
cparata 0:e7e920b85676 679 /*******************************************************************************
cparata 0:e7e920b85676 680 * Function Name : LSM6DSL_ACC_GYRO_R_BW_SEL
cparata 0:e7e920b85676 681 * Description : Read BW_SEL
cparata 0:e7e920b85676 682 * Input : Pointer to LSM6DSL_ACC_GYRO_BW_SEL_t
cparata 0:e7e920b85676 683 * Output : Status of BW_SEL see LSM6DSL_ACC_GYRO_BW_SEL_t
cparata 0:e7e920b85676 684 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 685 *******************************************************************************/
cparata 0:e7e920b85676 686 status_t LSM6DSL_ACC_GYRO_R_BW_SEL(void *handle, LSM6DSL_ACC_GYRO_BW_SEL_t *value)
cparata 0:e7e920b85676 687 {
cparata 0:e7e920b85676 688 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, (u8_t *)value, 1))
cparata 0:e7e920b85676 689 return MEMS_ERROR;
cparata 0:e7e920b85676 690
cparata 0:e7e920b85676 691 *value &= LSM6DSL_ACC_GYRO_BW_SEL_MASK; //mask
cparata 0:e7e920b85676 692
cparata 0:e7e920b85676 693 return MEMS_SUCCESS;
cparata 0:e7e920b85676 694 }
cparata 0:e7e920b85676 695
cparata 0:e7e920b85676 696 /*******************************************************************************
cparata 0:e7e920b85676 697 * Function Name : LSM6DSL_ACC_GYRO_W_BLE
cparata 0:e7e920b85676 698 * Description : Write BLE
cparata 0:e7e920b85676 699 * Input : LSM6DSL_ACC_GYRO_BLE_t
cparata 0:e7e920b85676 700 * Output : None
cparata 0:e7e920b85676 701 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 702 *******************************************************************************/
cparata 0:e7e920b85676 703 status_t LSM6DSL_ACC_GYRO_W_BLE(void *handle, LSM6DSL_ACC_GYRO_BLE_t newValue)
cparata 0:e7e920b85676 704 {
cparata 0:e7e920b85676 705 u8_t value;
cparata 0:e7e920b85676 706
cparata 0:e7e920b85676 707 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
cparata 0:e7e920b85676 708 return MEMS_ERROR;
cparata 0:e7e920b85676 709
cparata 0:e7e920b85676 710 value &= ~LSM6DSL_ACC_GYRO_BLE_MASK;
cparata 0:e7e920b85676 711 value |= newValue;
cparata 0:e7e920b85676 712
cparata 0:e7e920b85676 713 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
cparata 0:e7e920b85676 714 return MEMS_ERROR;
cparata 0:e7e920b85676 715
cparata 0:e7e920b85676 716 return MEMS_SUCCESS;
cparata 0:e7e920b85676 717 }
cparata 0:e7e920b85676 718
cparata 0:e7e920b85676 719 /*******************************************************************************
cparata 0:e7e920b85676 720 * Function Name : LSM6DSL_ACC_GYRO_R_BLE
cparata 0:e7e920b85676 721 * Description : Read BLE
cparata 0:e7e920b85676 722 * Input : Pointer to LSM6DSL_ACC_GYRO_BLE_t
cparata 0:e7e920b85676 723 * Output : Status of BLE see LSM6DSL_ACC_GYRO_BLE_t
cparata 0:e7e920b85676 724 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 725 *******************************************************************************/
cparata 0:e7e920b85676 726 status_t LSM6DSL_ACC_GYRO_R_BLE(void *handle, LSM6DSL_ACC_GYRO_BLE_t *value)
cparata 0:e7e920b85676 727 {
cparata 0:e7e920b85676 728 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1))
cparata 0:e7e920b85676 729 return MEMS_ERROR;
cparata 0:e7e920b85676 730
cparata 0:e7e920b85676 731 *value &= LSM6DSL_ACC_GYRO_BLE_MASK; //mask
cparata 0:e7e920b85676 732
cparata 0:e7e920b85676 733 return MEMS_SUCCESS;
cparata 0:e7e920b85676 734 }
cparata 0:e7e920b85676 735
cparata 0:e7e920b85676 736 /*******************************************************************************
cparata 0:e7e920b85676 737 * Function Name : LSM6DSL_ACC_GYRO_W_EmbeddedAccess
cparata 0:e7e920b85676 738 * Description : Write EMB_ACC
cparata 0:e7e920b85676 739 * Input : LSM6DSL_ACC_GYRO_EMB_ACC_t
cparata 0:e7e920b85676 740 * Output : None
cparata 0:e7e920b85676 741 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 742 *******************************************************************************/
cparata 0:e7e920b85676 743 status_t LSM6DSL_ACC_GYRO_W_EmbeddedAccess(void *handle, LSM6DSL_ACC_GYRO_EMB_ACC_t newValue)
cparata 0:e7e920b85676 744 {
cparata 0:e7e920b85676 745 u8_t value;
cparata 0:e7e920b85676 746
cparata 0:e7e920b85676 747 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_CFG_ACCESS, &value, 1) )
cparata 0:e7e920b85676 748 return MEMS_ERROR;
cparata 0:e7e920b85676 749
cparata 0:e7e920b85676 750 value &= ~LSM6DSL_ACC_GYRO_EMB_ACC_MASK;
cparata 0:e7e920b85676 751 value |= newValue;
cparata 0:e7e920b85676 752
cparata 0:e7e920b85676 753 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FUNC_CFG_ACCESS, &value, 1) )
cparata 0:e7e920b85676 754 return MEMS_ERROR;
cparata 0:e7e920b85676 755
cparata 0:e7e920b85676 756 return MEMS_SUCCESS;
cparata 0:e7e920b85676 757 }
cparata 0:e7e920b85676 758
cparata 0:e7e920b85676 759 /*******************************************************************************
cparata 0:e7e920b85676 760 * Function Name : LSM6DSL_ACC_GYRO_R_EmbeddedAccess
cparata 0:e7e920b85676 761 * Description : Read EMB_ACC
cparata 0:e7e920b85676 762 * Input : Pointer to LSM6DSL_ACC_GYRO_EMB_ACC_t
cparata 0:e7e920b85676 763 * Output : Status of EMB_ACC see LSM6DSL_ACC_GYRO_EMB_ACC_t
cparata 0:e7e920b85676 764 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 765 *******************************************************************************/
cparata 0:e7e920b85676 766 status_t LSM6DSL_ACC_GYRO_R_EmbeddedAccess(void *handle, LSM6DSL_ACC_GYRO_EMB_ACC_t *value)
cparata 0:e7e920b85676 767 {
cparata 0:e7e920b85676 768 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_CFG_ACCESS, (u8_t *)value, 1) )
cparata 0:e7e920b85676 769 return MEMS_ERROR;
cparata 0:e7e920b85676 770
cparata 0:e7e920b85676 771 *value &= LSM6DSL_ACC_GYRO_EMB_ACC_MASK; //mask
cparata 0:e7e920b85676 772
cparata 0:e7e920b85676 773 return MEMS_SUCCESS;
cparata 0:e7e920b85676 774 }
cparata 0:e7e920b85676 775
cparata 0:e7e920b85676 776 /*******************************************************************************
cparata 0:e7e920b85676 777 * Function Name : LSM6DSL_ACC_GYRO_W_SYNC_RES_RATIO
cparata 0:e7e920b85676 778 * Description : Write RR
cparata 0:e7e920b85676 779 * Input : LSM6DSL_ACC_GYRO_SYNC_RES_RATIO_t
cparata 0:e7e920b85676 780 * Output : None
cparata 0:e7e920b85676 781 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 782 *******************************************************************************/
cparata 0:e7e920b85676 783 status_t LSM6DSL_ACC_GYRO_W_SYNC_RES_RATIO(void *handle, LSM6DSL_ACC_GYRO_SYNC_RES_RATIO_t newValue)
cparata 0:e7e920b85676 784 {
cparata 0:e7e920b85676 785 u8_t value;
cparata 0:e7e920b85676 786
cparata 0:e7e920b85676 787 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_SENSOR_RES_RATIO, &value, 1) )
cparata 0:e7e920b85676 788 return MEMS_ERROR;
cparata 0:e7e920b85676 789
cparata 0:e7e920b85676 790 value &= ~LSM6DSL_ACC_GYRO_SYNC_RES_RATIO_MASK;
cparata 0:e7e920b85676 791 value |= newValue;
cparata 0:e7e920b85676 792
cparata 0:e7e920b85676 793 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_SENSOR_RES_RATIO, &value, 1) )
cparata 0:e7e920b85676 794 return MEMS_ERROR;
cparata 0:e7e920b85676 795
cparata 0:e7e920b85676 796 return MEMS_SUCCESS;
cparata 0:e7e920b85676 797 }
cparata 0:e7e920b85676 798
cparata 0:e7e920b85676 799 /*******************************************************************************
cparata 0:e7e920b85676 800 * Function Name : LSM6DSL_ACC_GYRO_R_SYNC_RES_RATIO
cparata 0:e7e920b85676 801 * Description : Read RR
cparata 0:e7e920b85676 802 * Input : Pointer to LSM6DSL_ACC_GYRO_SYNC_RES_RATIO_t
cparata 0:e7e920b85676 803 * Output : Status of RR see LSM6DSL_ACC_GYRO_SYNC_RES_RATIO_t
cparata 0:e7e920b85676 804 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 805 *******************************************************************************/
cparata 0:e7e920b85676 806 status_t LSM6DSL_ACC_GYRO_R_SYNC_RES_RATIO(void *handle, LSM6DSL_ACC_GYRO_SYNC_RES_RATIO_t *value)
cparata 0:e7e920b85676 807 {
cparata 0:e7e920b85676 808 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_SENSOR_RES_RATIO, (u8_t *)value, 1) )
cparata 0:e7e920b85676 809 return MEMS_ERROR;
cparata 0:e7e920b85676 810
cparata 0:e7e920b85676 811 *value &= LSM6DSL_ACC_GYRO_SYNC_RES_RATIO_MASK; //mask
cparata 0:e7e920b85676 812
cparata 0:e7e920b85676 813 return MEMS_SUCCESS;
cparata 0:e7e920b85676 814 }
cparata 0:e7e920b85676 815
cparata 0:e7e920b85676 816 /*******************************************************************************
cparata 0:e7e920b85676 817 * Function Name : LSM6DSL_ACC_GYRO_W_Stamping_Time_Frame
cparata 0:e7e920b85676 818 * Description : Write TPH
cparata 0:e7e920b85676 819 * Input : u8_t
cparata 0:e7e920b85676 820 * Output : None
cparata 0:e7e920b85676 821 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 822 *******************************************************************************/
cparata 0:e7e920b85676 823 status_t LSM6DSL_ACC_GYRO_W_Stamping_Time_Frame(void *handle, u8_t newValue)
cparata 0:e7e920b85676 824 {
cparata 0:e7e920b85676 825 u8_t value;
cparata 0:e7e920b85676 826
cparata 0:e7e920b85676 827 newValue = newValue << LSM6DSL_ACC_GYRO_TPH_POSITION; //mask
cparata 0:e7e920b85676 828 newValue &= LSM6DSL_ACC_GYRO_TPH_MASK; //coerce
cparata 0:e7e920b85676 829
cparata 0:e7e920b85676 830 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_SENSOR_SYNC_TIME, &value, 1) )
cparata 0:e7e920b85676 831 return MEMS_ERROR;
cparata 0:e7e920b85676 832
cparata 0:e7e920b85676 833 value &= (u8_t)~LSM6DSL_ACC_GYRO_TPH_MASK;
cparata 0:e7e920b85676 834 value |= newValue;
cparata 0:e7e920b85676 835
cparata 0:e7e920b85676 836 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_SENSOR_SYNC_TIME, &value, 1) )
cparata 0:e7e920b85676 837 return MEMS_ERROR;
cparata 0:e7e920b85676 838
cparata 0:e7e920b85676 839 return MEMS_SUCCESS;
cparata 0:e7e920b85676 840 }
cparata 0:e7e920b85676 841
cparata 0:e7e920b85676 842 /*******************************************************************************
cparata 0:e7e920b85676 843 * Function Name : LSM6DSL_ACC_GYRO_R_Stamping_Time_Frame
cparata 0:e7e920b85676 844 * Description : Read TPH
cparata 0:e7e920b85676 845 * Input : Pointer to u8_t
cparata 0:e7e920b85676 846 * Output : Status of TPH
cparata 0:e7e920b85676 847 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 848 *******************************************************************************/
cparata 0:e7e920b85676 849 status_t LSM6DSL_ACC_GYRO_R_Stamping_Time_Frame(void *handle, u8_t *value)
cparata 0:e7e920b85676 850 {
cparata 0:e7e920b85676 851 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_SENSOR_SYNC_TIME, (u8_t *)value, 1) )
cparata 0:e7e920b85676 852 return MEMS_ERROR;
cparata 0:e7e920b85676 853
cparata 0:e7e920b85676 854 *value &= LSM6DSL_ACC_GYRO_TPH_MASK; //coerce
cparata 0:e7e920b85676 855 *value = *value >> LSM6DSL_ACC_GYRO_TPH_POSITION; //mask
cparata 0:e7e920b85676 856
cparata 0:e7e920b85676 857 return MEMS_SUCCESS;
cparata 0:e7e920b85676 858 }
cparata 0:e7e920b85676 859
cparata 0:e7e920b85676 860 /*******************************************************************************
cparata 0:e7e920b85676 861 * Function Name : LSM6DSL_ACC_GYRO_W_FIFO_Watermark
cparata 0:e7e920b85676 862 * Description : Write WTM_FIFO
cparata 0:e7e920b85676 863 * Input : u16_t
cparata 0:e7e920b85676 864 * Output : None
cparata 0:e7e920b85676 865 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 866 *******************************************************************************/
cparata 0:e7e920b85676 867 status_t LSM6DSL_ACC_GYRO_W_FIFO_Watermark(void *handle, u16_t newValue)
cparata 0:e7e920b85676 868 {
cparata 0:e7e920b85676 869 u8_t valueH, valueL;
cparata 0:e7e920b85676 870 u8_t value;
cparata 0:e7e920b85676 871
cparata 0:e7e920b85676 872 valueL = newValue & 0xFF;
cparata 0:e7e920b85676 873 valueH = (newValue >> 8) & 0xFF;
cparata 0:e7e920b85676 874
cparata 0:e7e920b85676 875 /* Low part goes in FIFO_CTRL1 */
cparata 0:e7e920b85676 876 valueL = valueL << LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL1_POSITION; //mask
cparata 0:e7e920b85676 877 valueL &= LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL1_MASK; //coerce
cparata 0:e7e920b85676 878
cparata 0:e7e920b85676 879 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL1, &value, 1) )
cparata 0:e7e920b85676 880 return MEMS_ERROR;
cparata 0:e7e920b85676 881
cparata 0:e7e920b85676 882 value &= (u8_t)~LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL1_MASK;
cparata 0:e7e920b85676 883 value |= valueL;
cparata 0:e7e920b85676 884
cparata 0:e7e920b85676 885 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL1, &value, 1) )
cparata 0:e7e920b85676 886 return MEMS_ERROR;
cparata 0:e7e920b85676 887
cparata 0:e7e920b85676 888 /* High part goes in FIFO_CTRL2 */
cparata 0:e7e920b85676 889 valueH = valueH << LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL2_POSITION; //mask
cparata 0:e7e920b85676 890 valueH &= LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL2_MASK; //coerce
cparata 0:e7e920b85676 891
cparata 0:e7e920b85676 892 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
cparata 0:e7e920b85676 893 return MEMS_ERROR;
cparata 0:e7e920b85676 894
cparata 0:e7e920b85676 895 value &= ~LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL2_MASK;
cparata 0:e7e920b85676 896 value |= valueH;
cparata 0:e7e920b85676 897
cparata 0:e7e920b85676 898 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
cparata 0:e7e920b85676 899 return MEMS_ERROR;
cparata 0:e7e920b85676 900
cparata 0:e7e920b85676 901 return MEMS_SUCCESS;
cparata 0:e7e920b85676 902 }
cparata 0:e7e920b85676 903
cparata 0:e7e920b85676 904 /*******************************************************************************
cparata 0:e7e920b85676 905 * Function Name : LSM6DSL_ACC_GYRO_R_FIFO_Watermark
cparata 0:e7e920b85676 906 * Description : Read WTM_FIFO
cparata 0:e7e920b85676 907 * Input : Pointer to u16_t
cparata 0:e7e920b85676 908 * Output : Status of WTM_FIFO
cparata 0:e7e920b85676 909 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 910 *******************************************************************************/
cparata 0:e7e920b85676 911 status_t LSM6DSL_ACC_GYRO_R_FIFO_Watermark(void *handle, u16_t *value)
cparata 0:e7e920b85676 912 {
cparata 0:e7e920b85676 913 u8_t valueH, valueL;
cparata 0:e7e920b85676 914
cparata 0:e7e920b85676 915 /* Low part from FIFO_CTRL1 */
cparata 0:e7e920b85676 916 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL1, (u8_t *)&valueL, 1) )
cparata 0:e7e920b85676 917 return MEMS_ERROR;
cparata 0:e7e920b85676 918
cparata 0:e7e920b85676 919 valueL &= LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL1_MASK; //coerce
cparata 0:e7e920b85676 920 valueL = valueL >> LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL1_POSITION; //mask
cparata 0:e7e920b85676 921
cparata 0:e7e920b85676 922 /* High part from FIFO_CTRL2 */
cparata 0:e7e920b85676 923 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, (u8_t *)&valueH, 1) )
cparata 0:e7e920b85676 924 return MEMS_ERROR;
cparata 0:e7e920b85676 925
cparata 0:e7e920b85676 926 valueH &= LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL2_MASK; //coerce
cparata 0:e7e920b85676 927 valueH = valueH >> LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL2_POSITION; //mask
cparata 0:e7e920b85676 928
cparata 0:e7e920b85676 929 *value = ((valueH << 8) & 0xFF00) | valueL;
cparata 0:e7e920b85676 930
cparata 0:e7e920b85676 931 return MEMS_SUCCESS;
cparata 0:e7e920b85676 932 }
cparata 0:e7e920b85676 933
cparata 0:e7e920b85676 934 /*******************************************************************************
cparata 0:e7e920b85676 935 * Function Name : LSM6DSL_ACC_GYRO_W_FIFO_TEMP
cparata 0:e7e920b85676 936 * Description : Write FIFO_TEMP_EN
cparata 0:e7e920b85676 937 * Input : LSM6DSL_ACC_GYRO_FIFO_TEMP_t
cparata 0:e7e920b85676 938 * Output : None
cparata 0:e7e920b85676 939 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 940 *******************************************************************************/
cparata 0:e7e920b85676 941 status_t LSM6DSL_ACC_GYRO_W_FIFO_TEMP(void *handle, LSM6DSL_ACC_GYRO_FIFO_TEMP_t newValue)
cparata 0:e7e920b85676 942 {
cparata 0:e7e920b85676 943 u8_t value;
cparata 0:e7e920b85676 944
cparata 0:e7e920b85676 945 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
cparata 0:e7e920b85676 946 return MEMS_ERROR;
cparata 0:e7e920b85676 947
cparata 0:e7e920b85676 948 value &= ~LSM6DSL_ACC_GYRO_FIFO_TEMP_MASK;
cparata 0:e7e920b85676 949 value |= newValue;
cparata 0:e7e920b85676 950
cparata 0:e7e920b85676 951 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
cparata 0:e7e920b85676 952 return MEMS_ERROR;
cparata 0:e7e920b85676 953
cparata 0:e7e920b85676 954 return MEMS_SUCCESS;
cparata 0:e7e920b85676 955 }
cparata 0:e7e920b85676 956
cparata 0:e7e920b85676 957 /*******************************************************************************
cparata 0:e7e920b85676 958 * Function Name : LSM6DSL_ACC_GYRO_R_FIFO_TEMP
cparata 0:e7e920b85676 959 * Description : Read FIFO_TEMP_EN
cparata 0:e7e920b85676 960 * Input : Pointer to LSM6DSL_ACC_GYRO_FIFO_TEMP_t
cparata 0:e7e920b85676 961 * Output : Status of FIFO_TEMP_EN see LSM6DSL_ACC_GYRO_FIFO_TEMP_t
cparata 0:e7e920b85676 962 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 963 *******************************************************************************/
cparata 0:e7e920b85676 964 status_t LSM6DSL_ACC_GYRO_R_FIFO_TEMP(void *handle, LSM6DSL_ACC_GYRO_FIFO_TEMP_t *value)
cparata 0:e7e920b85676 965 {
cparata 0:e7e920b85676 966 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, (u8_t *)value, 1) )
cparata 0:e7e920b85676 967 return MEMS_ERROR;
cparata 0:e7e920b85676 968
cparata 0:e7e920b85676 969 *value &= LSM6DSL_ACC_GYRO_FIFO_TEMP_MASK; //mask
cparata 0:e7e920b85676 970
cparata 0:e7e920b85676 971 return MEMS_SUCCESS;
cparata 0:e7e920b85676 972 }
cparata 0:e7e920b85676 973
cparata 0:e7e920b85676 974 /*******************************************************************************
cparata 0:e7e920b85676 975 * Function Name : LSM6DSL_ACC_GYRO_W_TIM_PEDO_FIFO_Write_En
cparata 0:e7e920b85676 976 * Description : Write TIM_PEDO_FIFO_DRDY
cparata 0:e7e920b85676 977 * Input : LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_DRDY_t
cparata 0:e7e920b85676 978 * Output : None
cparata 0:e7e920b85676 979 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 980 *******************************************************************************/
cparata 0:e7e920b85676 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:e7e920b85676 982 {
cparata 0:e7e920b85676 983 u8_t value;
cparata 0:e7e920b85676 984
cparata 0:e7e920b85676 985 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
cparata 0:e7e920b85676 986 return MEMS_ERROR;
cparata 0:e7e920b85676 987
cparata 0:e7e920b85676 988 value &= ~LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_DRDY_MASK;
cparata 0:e7e920b85676 989 value |= newValue;
cparata 0:e7e920b85676 990
cparata 0:e7e920b85676 991 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
cparata 0:e7e920b85676 992 return MEMS_ERROR;
cparata 0:e7e920b85676 993
cparata 0:e7e920b85676 994 return MEMS_SUCCESS;
cparata 0:e7e920b85676 995 }
cparata 0:e7e920b85676 996
cparata 0:e7e920b85676 997 /*******************************************************************************
cparata 0:e7e920b85676 998 * Function Name : LSM6DSL_ACC_GYRO_R_TIM_PEDO_FIFO_Write_En
cparata 0:e7e920b85676 999 * Description : Read TIM_PEDO_FIFO_DRDY
cparata 0:e7e920b85676 1000 * Input : Pointer to LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_DRDY_t
cparata 0:e7e920b85676 1001 * Output : Status of TIM_PEDO_FIFO_DRDY see LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_DRDY_t
cparata 0:e7e920b85676 1002 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1003 *******************************************************************************/
cparata 0:e7e920b85676 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:e7e920b85676 1005 {
cparata 0:e7e920b85676 1006 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, (u8_t *)value, 1) )
cparata 0:e7e920b85676 1007 return MEMS_ERROR;
cparata 0:e7e920b85676 1008
cparata 0:e7e920b85676 1009 *value &= LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_DRDY_MASK; //mask
cparata 0:e7e920b85676 1010
cparata 0:e7e920b85676 1011 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1012 }
cparata 0:e7e920b85676 1013
cparata 0:e7e920b85676 1014 /*******************************************************************************
cparata 0:e7e920b85676 1015 * Function Name : LSM6DSL_ACC_GYRO_W_TIM_PEDO_FIFO_En
cparata 0:e7e920b85676 1016 * Description : Write TIM_PEDO_FIFO_EN
cparata 0:e7e920b85676 1017 * Input : LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_EN_t
cparata 0:e7e920b85676 1018 * Output : None
cparata 0:e7e920b85676 1019 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1020 *******************************************************************************/
cparata 0:e7e920b85676 1021 status_t LSM6DSL_ACC_GYRO_W_TIM_PEDO_FIFO_En(void *handle, LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_EN_t newValue)
cparata 0:e7e920b85676 1022 {
cparata 0:e7e920b85676 1023 u8_t value;
cparata 0:e7e920b85676 1024
cparata 0:e7e920b85676 1025 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
cparata 0:e7e920b85676 1026 return MEMS_ERROR;
cparata 0:e7e920b85676 1027
cparata 0:e7e920b85676 1028 value &= ~LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_EN_MASK;
cparata 0:e7e920b85676 1029 value |= newValue;
cparata 0:e7e920b85676 1030
cparata 0:e7e920b85676 1031 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
cparata 0:e7e920b85676 1032 return MEMS_ERROR;
cparata 0:e7e920b85676 1033
cparata 0:e7e920b85676 1034 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1035 }
cparata 0:e7e920b85676 1036
cparata 0:e7e920b85676 1037 /*******************************************************************************
cparata 0:e7e920b85676 1038 * Function Name : LSM6DSL_ACC_GYRO_R_TIM_PEDO_FIFO_En
cparata 0:e7e920b85676 1039 * Description : Read TIM_PEDO_FIFO_EN
cparata 0:e7e920b85676 1040 * Input : Pointer to LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_EN_t
cparata 0:e7e920b85676 1041 * Output : Status of TIM_PEDO_FIFO_EN see LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_EN_t
cparata 0:e7e920b85676 1042 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1043 *******************************************************************************/
cparata 0:e7e920b85676 1044 status_t LSM6DSL_ACC_GYRO_R_TIM_PEDO_FIFO_En(void *handle, LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_EN_t *value)
cparata 0:e7e920b85676 1045 {
cparata 0:e7e920b85676 1046 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, (u8_t *)value, 1) )
cparata 0:e7e920b85676 1047 return MEMS_ERROR;
cparata 0:e7e920b85676 1048
cparata 0:e7e920b85676 1049 *value &= LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_EN_MASK; //mask
cparata 0:e7e920b85676 1050
cparata 0:e7e920b85676 1051 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1052 }
cparata 0:e7e920b85676 1053 /*******************************************************************************
cparata 0:e7e920b85676 1054 * Function Name : LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL
cparata 0:e7e920b85676 1055 * Description : Write DEC_FIFO_XL
cparata 0:e7e920b85676 1056 * Input : LSM6DSL_ACC_GYRO_DEC_FIFO_XL_t
cparata 0:e7e920b85676 1057 * Output : None
cparata 0:e7e920b85676 1058 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1059 *******************************************************************************/
cparata 0:e7e920b85676 1060 status_t LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_t newValue)
cparata 0:e7e920b85676 1061 {
cparata 0:e7e920b85676 1062 u8_t value;
cparata 0:e7e920b85676 1063
cparata 0:e7e920b85676 1064 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL3, &value, 1) )
cparata 0:e7e920b85676 1065 return MEMS_ERROR;
cparata 0:e7e920b85676 1066
cparata 0:e7e920b85676 1067 value &= ~LSM6DSL_ACC_GYRO_DEC_FIFO_XL_MASK;
cparata 0:e7e920b85676 1068 value |= newValue;
cparata 0:e7e920b85676 1069
cparata 0:e7e920b85676 1070 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL3, &value, 1) )
cparata 0:e7e920b85676 1071 return MEMS_ERROR;
cparata 0:e7e920b85676 1072
cparata 0:e7e920b85676 1073 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1074 }
cparata 0:e7e920b85676 1075
cparata 0:e7e920b85676 1076 /*******************************************************************************
cparata 0:e7e920b85676 1077 * Function Name : LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL_val
cparata 0:e7e920b85676 1078 * Description : Write DEC_FIFO_XL
cparata 0:e7e920b85676 1079 * Input : u16_t
cparata 0:e7e920b85676 1080 * Output : Program XL decimation value from unsigned short
cparata 0:e7e920b85676 1081 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1082 *******************************************************************************/
cparata 0:e7e920b85676 1083 status_t LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL_val(void *handle, u16_t newValue)
cparata 0:e7e920b85676 1084 {
cparata 0:e7e920b85676 1085 switch(newValue) {
cparata 0:e7e920b85676 1086 case 0:
cparata 0:e7e920b85676 1087 LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_DATA_NOT_IN_FIFO);
cparata 0:e7e920b85676 1088 break;
cparata 0:e7e920b85676 1089
cparata 0:e7e920b85676 1090 case 1:
cparata 0:e7e920b85676 1091 LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_NO_DECIMATION);
cparata 0:e7e920b85676 1092 break;
cparata 0:e7e920b85676 1093
cparata 0:e7e920b85676 1094 case 2:
cparata 0:e7e920b85676 1095 LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_2);
cparata 0:e7e920b85676 1096 break;
cparata 0:e7e920b85676 1097
cparata 0:e7e920b85676 1098 case 3:
cparata 0:e7e920b85676 1099 LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_3);
cparata 0:e7e920b85676 1100 break;
cparata 0:e7e920b85676 1101
cparata 0:e7e920b85676 1102 case 4:
cparata 0:e7e920b85676 1103 LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_4);
cparata 0:e7e920b85676 1104 break;
cparata 0:e7e920b85676 1105
cparata 0:e7e920b85676 1106 case 8:
cparata 0:e7e920b85676 1107 LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_8);
cparata 0:e7e920b85676 1108 break;
cparata 0:e7e920b85676 1109
cparata 0:e7e920b85676 1110 case 16:
cparata 0:e7e920b85676 1111 LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_16);
cparata 0:e7e920b85676 1112 break;
cparata 0:e7e920b85676 1113
cparata 0:e7e920b85676 1114 case 32:
cparata 0:e7e920b85676 1115 LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_32);
cparata 0:e7e920b85676 1116 break;
cparata 0:e7e920b85676 1117
cparata 0:e7e920b85676 1118 default:
cparata 0:e7e920b85676 1119 return MEMS_ERROR;
cparata 0:e7e920b85676 1120 }
cparata 0:e7e920b85676 1121
cparata 0:e7e920b85676 1122 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1123 }
cparata 0:e7e920b85676 1124
cparata 0:e7e920b85676 1125 /*******************************************************************************
cparata 0:e7e920b85676 1126 * Function Name : LSM6DSL_ACC_GYRO_R_DEC_FIFO_XL
cparata 0:e7e920b85676 1127 * Description : Read DEC_FIFO_XL
cparata 0:e7e920b85676 1128 * Input : Pointer to LSM6DSL_ACC_GYRO_DEC_FIFO_XL_t
cparata 0:e7e920b85676 1129 * Output : Status of DEC_FIFO_XL see LSM6DSL_ACC_GYRO_DEC_FIFO_XL_t
cparata 0:e7e920b85676 1130 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1131 *******************************************************************************/
cparata 0:e7e920b85676 1132 status_t LSM6DSL_ACC_GYRO_R_DEC_FIFO_XL(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_t *value)
cparata 0:e7e920b85676 1133 {
cparata 0:e7e920b85676 1134 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL3, (u8_t *)value, 1) )
cparata 0:e7e920b85676 1135 return MEMS_ERROR;
cparata 0:e7e920b85676 1136
cparata 0:e7e920b85676 1137 *value &= LSM6DSL_ACC_GYRO_DEC_FIFO_XL_MASK; //mask
cparata 0:e7e920b85676 1138
cparata 0:e7e920b85676 1139 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1140 }
cparata 0:e7e920b85676 1141
cparata 0:e7e920b85676 1142 /*******************************************************************************
cparata 0:e7e920b85676 1143 * Function Name : LSM6DSL_ACC_GYRO_W_DEC_FIFO_G
cparata 0:e7e920b85676 1144 * Description : Write DEC_FIFO_G
cparata 0:e7e920b85676 1145 * Input : LSM6DSL_ACC_GYRO_DEC_FIFO_G_t
cparata 0:e7e920b85676 1146 * Output : None
cparata 0:e7e920b85676 1147 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1148 *******************************************************************************/
cparata 0:e7e920b85676 1149 status_t LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_t newValue)
cparata 0:e7e920b85676 1150 {
cparata 0:e7e920b85676 1151 u8_t value;
cparata 0:e7e920b85676 1152
cparata 0:e7e920b85676 1153 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL3, &value, 1))
cparata 0:e7e920b85676 1154 return MEMS_ERROR;
cparata 0:e7e920b85676 1155
cparata 0:e7e920b85676 1156 value &= ~LSM6DSL_ACC_GYRO_DEC_FIFO_G_MASK;
cparata 0:e7e920b85676 1157 value |= newValue;
cparata 0:e7e920b85676 1158
cparata 0:e7e920b85676 1159 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL3, &value, 1) )
cparata 0:e7e920b85676 1160 return MEMS_ERROR;
cparata 0:e7e920b85676 1161
cparata 0:e7e920b85676 1162 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1163 }
cparata 0:e7e920b85676 1164
cparata 0:e7e920b85676 1165 /*******************************************************************************
cparata 0:e7e920b85676 1166 * Function Name : LSM6DSL_ACC_GYRO_W_DEC_FIFO_G_val
cparata 0:e7e920b85676 1167 * Description : Write DEC_FIFO_G
cparata 0:e7e920b85676 1168 * Input : u16_t
cparata 0:e7e920b85676 1169 * Output : Program G decimation value from unsigned short
cparata 0:e7e920b85676 1170 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1171 *******************************************************************************/
cparata 0:e7e920b85676 1172 status_t LSM6DSL_ACC_GYRO_W_DEC_FIFO_G_val(void *handle, u16_t newValue)
cparata 0:e7e920b85676 1173 {
cparata 0:e7e920b85676 1174 switch(newValue) {
cparata 0:e7e920b85676 1175 case 0:
cparata 0:e7e920b85676 1176 LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_DATA_NOT_IN_FIFO);
cparata 0:e7e920b85676 1177 break;
cparata 0:e7e920b85676 1178
cparata 0:e7e920b85676 1179 case 1:
cparata 0:e7e920b85676 1180 LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_NO_DECIMATION);
cparata 0:e7e920b85676 1181 break;
cparata 0:e7e920b85676 1182
cparata 0:e7e920b85676 1183 case 2:
cparata 0:e7e920b85676 1184 LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_2);
cparata 0:e7e920b85676 1185 break;
cparata 0:e7e920b85676 1186
cparata 0:e7e920b85676 1187 case 3:
cparata 0:e7e920b85676 1188 LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_3);
cparata 0:e7e920b85676 1189 break;
cparata 0:e7e920b85676 1190
cparata 0:e7e920b85676 1191 case 4:
cparata 0:e7e920b85676 1192 LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_4);
cparata 0:e7e920b85676 1193 break;
cparata 0:e7e920b85676 1194
cparata 0:e7e920b85676 1195 case 8:
cparata 0:e7e920b85676 1196 LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_8);
cparata 0:e7e920b85676 1197 break;
cparata 0:e7e920b85676 1198
cparata 0:e7e920b85676 1199 case 16:
cparata 0:e7e920b85676 1200 LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_16);
cparata 0:e7e920b85676 1201 break;
cparata 0:e7e920b85676 1202
cparata 0:e7e920b85676 1203 case 32:
cparata 0:e7e920b85676 1204 LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_32);
cparata 0:e7e920b85676 1205 break;
cparata 0:e7e920b85676 1206
cparata 0:e7e920b85676 1207 default:
cparata 0:e7e920b85676 1208 return MEMS_ERROR;
cparata 0:e7e920b85676 1209 }
cparata 0:e7e920b85676 1210
cparata 0:e7e920b85676 1211 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1212 }
cparata 0:e7e920b85676 1213
cparata 0:e7e920b85676 1214 /*******************************************************************************
cparata 0:e7e920b85676 1215 * Function Name : LSM6DSL_ACC_GYRO_R_DEC_FIFO_G
cparata 0:e7e920b85676 1216 * Description : Read DEC_FIFO_G
cparata 0:e7e920b85676 1217 * Input : Pointer to LSM6DSL_ACC_GYRO_DEC_FIFO_G_t
cparata 0:e7e920b85676 1218 * Output : Status of DEC_FIFO_G see LSM6DSL_ACC_GYRO_DEC_FIFO_G_t
cparata 0:e7e920b85676 1219 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1220 *******************************************************************************/
cparata 0:e7e920b85676 1221 status_t LSM6DSL_ACC_GYRO_R_DEC_FIFO_G(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_t *value)
cparata 0:e7e920b85676 1222 {
cparata 0:e7e920b85676 1223 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL3, (u8_t *)value, 1))
cparata 0:e7e920b85676 1224 return MEMS_ERROR;
cparata 0:e7e920b85676 1225
cparata 0:e7e920b85676 1226 *value &= LSM6DSL_ACC_GYRO_DEC_FIFO_G_MASK; //mask
cparata 0:e7e920b85676 1227
cparata 0:e7e920b85676 1228 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1229 }
cparata 0:e7e920b85676 1230
cparata 0:e7e920b85676 1231 /*******************************************************************************
cparata 0:e7e920b85676 1232 * Function Name : LSM6DSL_ACC_GYRO_W_DEC_FIFO_DS3
cparata 0:e7e920b85676 1233 * Description : Write DEC_DS3_FIFO
cparata 0:e7e920b85676 1234 * Input : LSM6DSL_ACC_GYRO_DEC_FIFO_DS3_t
cparata 0:e7e920b85676 1235 * Output : None
cparata 0:e7e920b85676 1236 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1237 *******************************************************************************/
cparata 0:e7e920b85676 1238 status_t LSM6DSL_ACC_GYRO_W_DEC_FIFO_DS3(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_DS3_t newValue)
cparata 0:e7e920b85676 1239 {
cparata 0:e7e920b85676 1240 u8_t value;
cparata 0:e7e920b85676 1241
cparata 0:e7e920b85676 1242 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1))
cparata 0:e7e920b85676 1243 return MEMS_ERROR;
cparata 0:e7e920b85676 1244
cparata 0:e7e920b85676 1245 value &= ~LSM6DSL_ACC_GYRO_DEC_FIFO_DS3_MASK;
cparata 0:e7e920b85676 1246 value |= newValue;
cparata 0:e7e920b85676 1247
cparata 0:e7e920b85676 1248 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1) )
cparata 0:e7e920b85676 1249 return MEMS_ERROR;
cparata 0:e7e920b85676 1250
cparata 0:e7e920b85676 1251 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1252 }
cparata 0:e7e920b85676 1253
cparata 0:e7e920b85676 1254 /*******************************************************************************
cparata 0:e7e920b85676 1255 * Function Name : LSM6DSL_ACC_GYRO_R_DEC_FIFO_DS3
cparata 0:e7e920b85676 1256 * Description : Read DEC_DS3_FIFO
cparata 0:e7e920b85676 1257 * Input : Pointer to LSM6DSL_ACC_GYRO_DEC_FIFO_DS3_t
cparata 0:e7e920b85676 1258 * Output : Status of DEC_DS3_FIFO see LSM6DSL_ACC_GYRO_DEC_FIFO_DS3_t
cparata 0:e7e920b85676 1259 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1260 *******************************************************************************/
cparata 0:e7e920b85676 1261 status_t LSM6DSL_ACC_GYRO_R_DEC_FIFO_DS3(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_DS3_t *value)
cparata 0:e7e920b85676 1262 {
cparata 0:e7e920b85676 1263 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, (u8_t *)value, 1))
cparata 0:e7e920b85676 1264 return MEMS_ERROR;
cparata 0:e7e920b85676 1265
cparata 0:e7e920b85676 1266 *value &= LSM6DSL_ACC_GYRO_DEC_FIFO_DS3_MASK; //mask
cparata 0:e7e920b85676 1267
cparata 0:e7e920b85676 1268 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1269 }
cparata 0:e7e920b85676 1270
cparata 0:e7e920b85676 1271 /*******************************************************************************
cparata 0:e7e920b85676 1272 * Function Name : LSM6DSL_ACC_GYRO_W_DEC_FIFO_DS4
cparata 0:e7e920b85676 1273 * Description : Write DEC_DS4_FIFO
cparata 0:e7e920b85676 1274 * Input : LSM6DSL_ACC_GYRO_DEC_FIFO_DS4_t
cparata 0:e7e920b85676 1275 * Output : None
cparata 0:e7e920b85676 1276 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1277 *******************************************************************************/
cparata 0:e7e920b85676 1278 status_t LSM6DSL_ACC_GYRO_W_DEC_FIFO_DS4(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_DS4_t newValue)
cparata 0:e7e920b85676 1279 {
cparata 0:e7e920b85676 1280 u8_t value;
cparata 0:e7e920b85676 1281
cparata 0:e7e920b85676 1282 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1))
cparata 0:e7e920b85676 1283 return MEMS_ERROR;
cparata 0:e7e920b85676 1284
cparata 0:e7e920b85676 1285 value &= ~LSM6DSL_ACC_GYRO_DEC_FIFO_DS4_MASK;
cparata 0:e7e920b85676 1286 value |= newValue;
cparata 0:e7e920b85676 1287
cparata 0:e7e920b85676 1288 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1) )
cparata 0:e7e920b85676 1289 return MEMS_ERROR;
cparata 0:e7e920b85676 1290
cparata 0:e7e920b85676 1291 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1292 }
cparata 0:e7e920b85676 1293
cparata 0:e7e920b85676 1294 /*******************************************************************************
cparata 0:e7e920b85676 1295 * Function Name : LSM6DSL_ACC_GYRO_R_DEC_FIFO_DS4
cparata 0:e7e920b85676 1296 * Description : Read DEC_DS4_FIFO
cparata 0:e7e920b85676 1297 * Input : Pointer to LSM6DSL_ACC_GYRO_DEC_FIFO_DS4_t
cparata 0:e7e920b85676 1298 * Output : Status of DEC_DS4_FIFO see LSM6DSL_ACC_GYRO_DEC_FIFO_DS4_t
cparata 0:e7e920b85676 1299 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1300 *******************************************************************************/
cparata 0:e7e920b85676 1301 status_t LSM6DSL_ACC_GYRO_R_DEC_FIFO_DS4(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_DS4_t *value)
cparata 0:e7e920b85676 1302 {
cparata 0:e7e920b85676 1303 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, (u8_t *)value, 1))
cparata 0:e7e920b85676 1304 return MEMS_ERROR;
cparata 0:e7e920b85676 1305
cparata 0:e7e920b85676 1306 *value &= LSM6DSL_ACC_GYRO_DEC_FIFO_DS4_MASK; //mask
cparata 0:e7e920b85676 1307
cparata 0:e7e920b85676 1308 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1309 }
cparata 0:e7e920b85676 1310
cparata 0:e7e920b85676 1311 /*******************************************************************************
cparata 0:e7e920b85676 1312 * Function Name : LSM6DSL_ACC_GYRO_W_HI_DATA_ONLY
cparata 0:e7e920b85676 1313 * Description : Write HI_DATA_ONLY
cparata 0:e7e920b85676 1314 * Input : LSM6DSL_ACC_GYRO_HI_DATA_ONLY_t
cparata 0:e7e920b85676 1315 * Output : None
cparata 0:e7e920b85676 1316 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1317 *******************************************************************************/
cparata 0:e7e920b85676 1318 status_t LSM6DSL_ACC_GYRO_W_HI_DATA_ONLY(void *handle, LSM6DSL_ACC_GYRO_HI_DATA_ONLY_t newValue)
cparata 0:e7e920b85676 1319 {
cparata 0:e7e920b85676 1320 u8_t value;
cparata 0:e7e920b85676 1321
cparata 0:e7e920b85676 1322 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1))
cparata 0:e7e920b85676 1323 return MEMS_ERROR;
cparata 0:e7e920b85676 1324
cparata 0:e7e920b85676 1325 value &= ~LSM6DSL_ACC_GYRO_HI_DATA_ONLY_MASK;
cparata 0:e7e920b85676 1326 value |= newValue;
cparata 0:e7e920b85676 1327
cparata 0:e7e920b85676 1328 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1) )
cparata 0:e7e920b85676 1329 return MEMS_ERROR;
cparata 0:e7e920b85676 1330
cparata 0:e7e920b85676 1331 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1332 }
cparata 0:e7e920b85676 1333
cparata 0:e7e920b85676 1334 /*******************************************************************************
cparata 0:e7e920b85676 1335 * Function Name : LSM6DSL_ACC_GYRO_R_HI_DATA_ONLY
cparata 0:e7e920b85676 1336 * Description : Read HI_DATA_ONLY
cparata 0:e7e920b85676 1337 * Input : Pointer to LSM6DSL_ACC_GYRO_HI_DATA_ONLY_t
cparata 0:e7e920b85676 1338 * Output : Status of HI_DATA_ONLY see LSM6DSL_ACC_GYRO_HI_DATA_ONLY_t
cparata 0:e7e920b85676 1339 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1340 *******************************************************************************/
cparata 0:e7e920b85676 1341 status_t LSM6DSL_ACC_GYRO_R_HI_DATA_ONLY(void *handle, LSM6DSL_ACC_GYRO_HI_DATA_ONLY_t *value)
cparata 0:e7e920b85676 1342 {
cparata 0:e7e920b85676 1343 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, (u8_t *)value, 1))
cparata 0:e7e920b85676 1344 return MEMS_ERROR;
cparata 0:e7e920b85676 1345
cparata 0:e7e920b85676 1346 *value &= LSM6DSL_ACC_GYRO_HI_DATA_ONLY_MASK; //mask
cparata 0:e7e920b85676 1347
cparata 0:e7e920b85676 1348 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1349 }
cparata 0:e7e920b85676 1350
cparata 0:e7e920b85676 1351 /*******************************************************************************
cparata 0:e7e920b85676 1352 * Function Name : LSM6DSL_ACC_GYRO_W_STOP_ON_FTH
cparata 0:e7e920b85676 1353 * Description : Write STOP_ON_FTH
cparata 0:e7e920b85676 1354 * Input : LSM6DSL_ACC_GYRO_STOP_ON_FTH_t
cparata 0:e7e920b85676 1355 * Output : None
cparata 0:e7e920b85676 1356 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1357 *******************************************************************************/
cparata 0:e7e920b85676 1358 status_t LSM6DSL_ACC_GYRO_W_STOP_ON_FTH(void *handle, LSM6DSL_ACC_GYRO_STOP_ON_FTH_t newValue)
cparata 0:e7e920b85676 1359 {
cparata 0:e7e920b85676 1360 u8_t value;
cparata 0:e7e920b85676 1361
cparata 0:e7e920b85676 1362 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1))
cparata 0:e7e920b85676 1363 return MEMS_ERROR;
cparata 0:e7e920b85676 1364
cparata 0:e7e920b85676 1365 value &= ~LSM6DSL_ACC_GYRO_STOP_ON_FTH_MASK;
cparata 0:e7e920b85676 1366 value |= newValue;
cparata 0:e7e920b85676 1367
cparata 0:e7e920b85676 1368 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1) )
cparata 0:e7e920b85676 1369 return MEMS_ERROR;
cparata 0:e7e920b85676 1370
cparata 0:e7e920b85676 1371 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1372 }
cparata 0:e7e920b85676 1373
cparata 0:e7e920b85676 1374 /*******************************************************************************
cparata 0:e7e920b85676 1375 * Function Name : LSM6DSL_ACC_GYRO_R_STOP_ON_FTH
cparata 0:e7e920b85676 1376 * Description : Read STOP_ON_FTH
cparata 0:e7e920b85676 1377 * Input : Pointer to LSM6DSL_ACC_GYRO_STOP_ON_FTH_t
cparata 0:e7e920b85676 1378 * Output : Status of STOP_ON_FTH see LSM6DSL_ACC_GYRO_STOP_ON_FTH_t
cparata 0:e7e920b85676 1379 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1380 *******************************************************************************/
cparata 0:e7e920b85676 1381 status_t LSM6DSL_ACC_GYRO_R_STOP_ON_FTH(void *handle, LSM6DSL_ACC_GYRO_STOP_ON_FTH_t *value)
cparata 0:e7e920b85676 1382 {
cparata 0:e7e920b85676 1383 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, (u8_t *)value, 1))
cparata 0:e7e920b85676 1384 return MEMS_ERROR;
cparata 0:e7e920b85676 1385
cparata 0:e7e920b85676 1386 *value &= LSM6DSL_ACC_GYRO_STOP_ON_FTH_MASK; //mask
cparata 0:e7e920b85676 1387
cparata 0:e7e920b85676 1388 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1389 }
cparata 0:e7e920b85676 1390
cparata 0:e7e920b85676 1391 /*******************************************************************************
cparata 0:e7e920b85676 1392 * Function Name : LSM6DSL_ACC_GYRO_W_FIFO_MODE
cparata 0:e7e920b85676 1393 * Description : Write FIFO_MODE
cparata 0:e7e920b85676 1394 * Input : LSM6DSL_ACC_GYRO_FIFO_MODE_t
cparata 0:e7e920b85676 1395 * Output : None
cparata 0:e7e920b85676 1396 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1397 *******************************************************************************/
cparata 0:e7e920b85676 1398 status_t LSM6DSL_ACC_GYRO_W_FIFO_MODE(void *handle, LSM6DSL_ACC_GYRO_FIFO_MODE_t newValue)
cparata 0:e7e920b85676 1399 {
cparata 0:e7e920b85676 1400 u8_t value;
cparata 0:e7e920b85676 1401
cparata 0:e7e920b85676 1402 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL5, &value, 1))
cparata 0:e7e920b85676 1403 return MEMS_ERROR;
cparata 0:e7e920b85676 1404
cparata 0:e7e920b85676 1405 value &= ~LSM6DSL_ACC_GYRO_FIFO_MODE_MASK;
cparata 0:e7e920b85676 1406 value |= newValue;
cparata 0:e7e920b85676 1407
cparata 0:e7e920b85676 1408 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL5, &value, 1) )
cparata 0:e7e920b85676 1409 return MEMS_ERROR;
cparata 0:e7e920b85676 1410
cparata 0:e7e920b85676 1411 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1412 }
cparata 0:e7e920b85676 1413
cparata 0:e7e920b85676 1414 /*******************************************************************************
cparata 0:e7e920b85676 1415 * Function Name : LSM6DSL_ACC_GYRO_R_FIFO_MODE
cparata 0:e7e920b85676 1416 * Description : Read FIFO_MODE
cparata 0:e7e920b85676 1417 * Input : Pointer to LSM6DSL_ACC_GYRO_FIFO_MODE_t
cparata 0:e7e920b85676 1418 * Output : Status of FIFO_MODE see LSM6DSL_ACC_GYRO_FIFO_MODE_t
cparata 0:e7e920b85676 1419 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1420 *******************************************************************************/
cparata 0:e7e920b85676 1421 status_t LSM6DSL_ACC_GYRO_R_FIFO_MODE(void *handle, LSM6DSL_ACC_GYRO_FIFO_MODE_t *value)
cparata 0:e7e920b85676 1422 {
cparata 0:e7e920b85676 1423 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL5, (u8_t *)value, 1))
cparata 0:e7e920b85676 1424 return MEMS_ERROR;
cparata 0:e7e920b85676 1425
cparata 0:e7e920b85676 1426 *value &= LSM6DSL_ACC_GYRO_FIFO_MODE_MASK; //mask
cparata 0:e7e920b85676 1427
cparata 0:e7e920b85676 1428 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1429 }
cparata 0:e7e920b85676 1430
cparata 0:e7e920b85676 1431 /*******************************************************************************
cparata 0:e7e920b85676 1432 * Function Name : LSM6DSL_ACC_GYRO_W_ODR_FIFO
cparata 0:e7e920b85676 1433 * Description : Write ODR_FIFO
cparata 0:e7e920b85676 1434 * Input : LSM6DSL_ACC_GYRO_ODR_FIFO_t
cparata 0:e7e920b85676 1435 * Output : None
cparata 0:e7e920b85676 1436 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1437 *******************************************************************************/
cparata 0:e7e920b85676 1438 status_t LSM6DSL_ACC_GYRO_W_ODR_FIFO(void *handle, LSM6DSL_ACC_GYRO_ODR_FIFO_t newValue)
cparata 0:e7e920b85676 1439 {
cparata 0:e7e920b85676 1440 u8_t value;
cparata 0:e7e920b85676 1441
cparata 0:e7e920b85676 1442 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL5, &value, 1))
cparata 0:e7e920b85676 1443 return MEMS_ERROR;
cparata 0:e7e920b85676 1444
cparata 0:e7e920b85676 1445 value &= ~LSM6DSL_ACC_GYRO_ODR_FIFO_MASK;
cparata 0:e7e920b85676 1446 value |= newValue;
cparata 0:e7e920b85676 1447
cparata 0:e7e920b85676 1448 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL5, &value, 1) )
cparata 0:e7e920b85676 1449 return MEMS_ERROR;
cparata 0:e7e920b85676 1450
cparata 0:e7e920b85676 1451 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1452 }
cparata 0:e7e920b85676 1453
cparata 0:e7e920b85676 1454 /*******************************************************************************
cparata 0:e7e920b85676 1455 * Function Name : LSM6DSL_ACC_GYRO_R_ODR_FIFO
cparata 0:e7e920b85676 1456 * Description : Read ODR_FIFO
cparata 0:e7e920b85676 1457 * Input : Pointer to LSM6DSL_ACC_GYRO_ODR_FIFO_t
cparata 0:e7e920b85676 1458 * Output : Status of ODR_FIFO see LSM6DSL_ACC_GYRO_ODR_FIFO_t
cparata 0:e7e920b85676 1459 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1460 *******************************************************************************/
cparata 0:e7e920b85676 1461 status_t LSM6DSL_ACC_GYRO_R_ODR_FIFO(void *handle, LSM6DSL_ACC_GYRO_ODR_FIFO_t *value)
cparata 0:e7e920b85676 1462 {
cparata 0:e7e920b85676 1463 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL5, (u8_t *)value, 1))
cparata 0:e7e920b85676 1464 return MEMS_ERROR;
cparata 0:e7e920b85676 1465
cparata 0:e7e920b85676 1466 *value &= LSM6DSL_ACC_GYRO_ODR_FIFO_MASK; //mask
cparata 0:e7e920b85676 1467
cparata 0:e7e920b85676 1468 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1469 }
cparata 0:e7e920b85676 1470
cparata 0:e7e920b85676 1471 /*******************************************************************************
cparata 0:e7e920b85676 1472 * Function Name : LSM6DSL_ACC_GYRO_W_DRDY_PULSE
cparata 0:e7e920b85676 1473 * Description : Write DRDY_PULSE
cparata 0:e7e920b85676 1474 * Input : LSM6DSL_ACC_GYRO_DRDY_PULSE_t
cparata 0:e7e920b85676 1475 * Output : None
cparata 0:e7e920b85676 1476 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1477 *******************************************************************************/
cparata 0:e7e920b85676 1478 status_t LSM6DSL_ACC_GYRO_W_DRDY_PULSE(void *handle, LSM6DSL_ACC_GYRO_DRDY_PULSE_t newValue)
cparata 0:e7e920b85676 1479 {
cparata 0:e7e920b85676 1480 u8_t value;
cparata 0:e7e920b85676 1481
cparata 0:e7e920b85676 1482 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_DRDY_PULSE_CFG_G, &value, 1))
cparata 0:e7e920b85676 1483 return MEMS_ERROR;
cparata 0:e7e920b85676 1484
cparata 0:e7e920b85676 1485 value &= ~LSM6DSL_ACC_GYRO_DRDY_PULSE_MASK;
cparata 0:e7e920b85676 1486 value |= newValue;
cparata 0:e7e920b85676 1487
cparata 0:e7e920b85676 1488 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_DRDY_PULSE_CFG_G, &value, 1) )
cparata 0:e7e920b85676 1489 return MEMS_ERROR;
cparata 0:e7e920b85676 1490
cparata 0:e7e920b85676 1491 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1492 }
cparata 0:e7e920b85676 1493
cparata 0:e7e920b85676 1494 /*******************************************************************************
cparata 0:e7e920b85676 1495 * Function Name : LSM6DSL_ACC_GYRO_R_DRDY_PULSE
cparata 0:e7e920b85676 1496 * Description : Read DRDY_PULSE
cparata 0:e7e920b85676 1497 * Input : Pointer to LSM6DSL_ACC_GYRO_DRDY_PULSE_t
cparata 0:e7e920b85676 1498 * Output : Status of DRDY_PULSE see LSM6DSL_ACC_GYRO_DRDY_PULSE_t
cparata 0:e7e920b85676 1499 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1500 *******************************************************************************/
cparata 0:e7e920b85676 1501 status_t LSM6DSL_ACC_GYRO_R_DRDY_PULSE(void *handle, LSM6DSL_ACC_GYRO_DRDY_PULSE_t *value)
cparata 0:e7e920b85676 1502 {
cparata 0:e7e920b85676 1503 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_DRDY_PULSE_CFG_G, (u8_t *)value, 1))
cparata 0:e7e920b85676 1504 return MEMS_ERROR;
cparata 0:e7e920b85676 1505
cparata 0:e7e920b85676 1506 *value &= LSM6DSL_ACC_GYRO_DRDY_PULSE_MASK; //mask
cparata 0:e7e920b85676 1507
cparata 0:e7e920b85676 1508 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1509 }
cparata 0:e7e920b85676 1510
cparata 0:e7e920b85676 1511 /*******************************************************************************
cparata 0:e7e920b85676 1512 * Function Name : LSM6DSL_ACC_GYRO_W_DRDY_XL_on_INT1
cparata 0:e7e920b85676 1513 * Description : Write INT1_DRDY_XL
cparata 0:e7e920b85676 1514 * Input : LSM6DSL_ACC_GYRO_INT1_DRDY_XL_t
cparata 0:e7e920b85676 1515 * Output : None
cparata 0:e7e920b85676 1516 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1517 *******************************************************************************/
cparata 0:e7e920b85676 1518 status_t LSM6DSL_ACC_GYRO_W_DRDY_XL_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_DRDY_XL_t newValue)
cparata 0:e7e920b85676 1519 {
cparata 0:e7e920b85676 1520 u8_t value;
cparata 0:e7e920b85676 1521
cparata 0:e7e920b85676 1522 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
cparata 0:e7e920b85676 1523 return MEMS_ERROR;
cparata 0:e7e920b85676 1524
cparata 0:e7e920b85676 1525 value &= ~LSM6DSL_ACC_GYRO_INT1_DRDY_XL_MASK;
cparata 0:e7e920b85676 1526 value |= newValue;
cparata 0:e7e920b85676 1527
cparata 0:e7e920b85676 1528 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
cparata 0:e7e920b85676 1529 return MEMS_ERROR;
cparata 0:e7e920b85676 1530
cparata 0:e7e920b85676 1531 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1532 }
cparata 0:e7e920b85676 1533
cparata 0:e7e920b85676 1534 /*******************************************************************************
cparata 0:e7e920b85676 1535 * Function Name : LSM6DSL_ACC_GYRO_R_DRDY_XL_on_INT1
cparata 0:e7e920b85676 1536 * Description : Read INT1_DRDY_XL
cparata 0:e7e920b85676 1537 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_DRDY_XL_t
cparata 0:e7e920b85676 1538 * Output : Status of INT1_DRDY_XL see LSM6DSL_ACC_GYRO_INT1_DRDY_XL_t
cparata 0:e7e920b85676 1539 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1540 *******************************************************************************/
cparata 0:e7e920b85676 1541 status_t LSM6DSL_ACC_GYRO_R_DRDY_XL_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_DRDY_XL_t *value)
cparata 0:e7e920b85676 1542 {
cparata 0:e7e920b85676 1543 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
cparata 0:e7e920b85676 1544 return MEMS_ERROR;
cparata 0:e7e920b85676 1545
cparata 0:e7e920b85676 1546 *value &= LSM6DSL_ACC_GYRO_INT1_DRDY_XL_MASK; //mask
cparata 0:e7e920b85676 1547
cparata 0:e7e920b85676 1548 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1549 }
cparata 0:e7e920b85676 1550
cparata 0:e7e920b85676 1551 /*******************************************************************************
cparata 0:e7e920b85676 1552 * Function Name : LSM6DSL_ACC_GYRO_W_DRDY_G_on_INT1
cparata 0:e7e920b85676 1553 * Description : Write INT1_DRDY_G
cparata 0:e7e920b85676 1554 * Input : LSM6DSL_ACC_GYRO_INT1_DRDY_G_t
cparata 0:e7e920b85676 1555 * Output : None
cparata 0:e7e920b85676 1556 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1557 *******************************************************************************/
cparata 0:e7e920b85676 1558 status_t LSM6DSL_ACC_GYRO_W_DRDY_G_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_DRDY_G_t newValue)
cparata 0:e7e920b85676 1559 {
cparata 0:e7e920b85676 1560 u8_t value;
cparata 0:e7e920b85676 1561
cparata 0:e7e920b85676 1562 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
cparata 0:e7e920b85676 1563 return MEMS_ERROR;
cparata 0:e7e920b85676 1564
cparata 0:e7e920b85676 1565 value &= ~LSM6DSL_ACC_GYRO_INT1_DRDY_G_MASK;
cparata 0:e7e920b85676 1566 value |= newValue;
cparata 0:e7e920b85676 1567
cparata 0:e7e920b85676 1568 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
cparata 0:e7e920b85676 1569 return MEMS_ERROR;
cparata 0:e7e920b85676 1570
cparata 0:e7e920b85676 1571 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1572 }
cparata 0:e7e920b85676 1573
cparata 0:e7e920b85676 1574 /*******************************************************************************
cparata 0:e7e920b85676 1575 * Function Name : LSM6DSL_ACC_GYRO_R_DRDY_G_on_INT1
cparata 0:e7e920b85676 1576 * Description : Read INT1_DRDY_G
cparata 0:e7e920b85676 1577 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_DRDY_G_t
cparata 0:e7e920b85676 1578 * Output : Status of INT1_DRDY_G see LSM6DSL_ACC_GYRO_INT1_DRDY_G_t
cparata 0:e7e920b85676 1579 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1580 *******************************************************************************/
cparata 0:e7e920b85676 1581 status_t LSM6DSL_ACC_GYRO_R_DRDY_G_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_DRDY_G_t *value)
cparata 0:e7e920b85676 1582 {
cparata 0:e7e920b85676 1583 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
cparata 0:e7e920b85676 1584 return MEMS_ERROR;
cparata 0:e7e920b85676 1585
cparata 0:e7e920b85676 1586 *value &= LSM6DSL_ACC_GYRO_INT1_DRDY_G_MASK; //mask
cparata 0:e7e920b85676 1587
cparata 0:e7e920b85676 1588 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1589 }
cparata 0:e7e920b85676 1590
cparata 0:e7e920b85676 1591 /*******************************************************************************
cparata 0:e7e920b85676 1592 * Function Name : LSM6DSL_ACC_GYRO_W_BOOT_on_INT1
cparata 0:e7e920b85676 1593 * Description : Write INT1_BOOT
cparata 0:e7e920b85676 1594 * Input : LSM6DSL_ACC_GYRO_INT1_BOOT_t
cparata 0:e7e920b85676 1595 * Output : None
cparata 0:e7e920b85676 1596 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1597 *******************************************************************************/
cparata 0:e7e920b85676 1598 status_t LSM6DSL_ACC_GYRO_W_BOOT_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_BOOT_t newValue)
cparata 0:e7e920b85676 1599 {
cparata 0:e7e920b85676 1600 u8_t value;
cparata 0:e7e920b85676 1601
cparata 0:e7e920b85676 1602 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
cparata 0:e7e920b85676 1603 return MEMS_ERROR;
cparata 0:e7e920b85676 1604
cparata 0:e7e920b85676 1605 value &= ~LSM6DSL_ACC_GYRO_INT1_BOOT_MASK;
cparata 0:e7e920b85676 1606 value |= newValue;
cparata 0:e7e920b85676 1607
cparata 0:e7e920b85676 1608 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
cparata 0:e7e920b85676 1609 return MEMS_ERROR;
cparata 0:e7e920b85676 1610
cparata 0:e7e920b85676 1611 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1612 }
cparata 0:e7e920b85676 1613
cparata 0:e7e920b85676 1614 /*******************************************************************************
cparata 0:e7e920b85676 1615 * Function Name : LSM6DSL_ACC_GYRO_R_BOOT_on_INT1
cparata 0:e7e920b85676 1616 * Description : Read INT1_BOOT
cparata 0:e7e920b85676 1617 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_BOOT_t
cparata 0:e7e920b85676 1618 * Output : Status of INT1_BOOT see LSM6DSL_ACC_GYRO_INT1_BOOT_t
cparata 0:e7e920b85676 1619 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1620 *******************************************************************************/
cparata 0:e7e920b85676 1621 status_t LSM6DSL_ACC_GYRO_R_BOOT_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_BOOT_t *value)
cparata 0:e7e920b85676 1622 {
cparata 0:e7e920b85676 1623 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
cparata 0:e7e920b85676 1624 return MEMS_ERROR;
cparata 0:e7e920b85676 1625
cparata 0:e7e920b85676 1626 *value &= LSM6DSL_ACC_GYRO_INT1_BOOT_MASK; //mask
cparata 0:e7e920b85676 1627
cparata 0:e7e920b85676 1628 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1629 }
cparata 0:e7e920b85676 1630
cparata 0:e7e920b85676 1631 /*******************************************************************************
cparata 0:e7e920b85676 1632 * Function Name : LSM6DSL_ACC_GYRO_W_FIFO_TSHLD_on_INT1
cparata 0:e7e920b85676 1633 * Description : Write INT1_FTH
cparata 0:e7e920b85676 1634 * Input : LSM6DSL_ACC_GYRO_INT1_FTH_t
cparata 0:e7e920b85676 1635 * Output : None
cparata 0:e7e920b85676 1636 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1637 *******************************************************************************/
cparata 0:e7e920b85676 1638 status_t LSM6DSL_ACC_GYRO_W_FIFO_TSHLD_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_FTH_t newValue)
cparata 0:e7e920b85676 1639 {
cparata 0:e7e920b85676 1640 u8_t value;
cparata 0:e7e920b85676 1641
cparata 0:e7e920b85676 1642 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
cparata 0:e7e920b85676 1643 return MEMS_ERROR;
cparata 0:e7e920b85676 1644
cparata 0:e7e920b85676 1645 value &= ~LSM6DSL_ACC_GYRO_INT1_FTH_MASK;
cparata 0:e7e920b85676 1646 value |= newValue;
cparata 0:e7e920b85676 1647
cparata 0:e7e920b85676 1648 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
cparata 0:e7e920b85676 1649 return MEMS_ERROR;
cparata 0:e7e920b85676 1650
cparata 0:e7e920b85676 1651 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1652 }
cparata 0:e7e920b85676 1653
cparata 0:e7e920b85676 1654 /*******************************************************************************
cparata 0:e7e920b85676 1655 * Function Name : LSM6DSL_ACC_GYRO_R_FIFO_TSHLD_on_INT1
cparata 0:e7e920b85676 1656 * Description : Read INT1_FTH
cparata 0:e7e920b85676 1657 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_FTH_t
cparata 0:e7e920b85676 1658 * Output : Status of INT1_FTH see LSM6DSL_ACC_GYRO_INT1_FTH_t
cparata 0:e7e920b85676 1659 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1660 *******************************************************************************/
cparata 0:e7e920b85676 1661 status_t LSM6DSL_ACC_GYRO_R_FIFO_TSHLD_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_FTH_t *value)
cparata 0:e7e920b85676 1662 {
cparata 0:e7e920b85676 1663 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
cparata 0:e7e920b85676 1664 return MEMS_ERROR;
cparata 0:e7e920b85676 1665
cparata 0:e7e920b85676 1666 *value &= LSM6DSL_ACC_GYRO_INT1_FTH_MASK; //mask
cparata 0:e7e920b85676 1667
cparata 0:e7e920b85676 1668 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1669 }
cparata 0:e7e920b85676 1670
cparata 0:e7e920b85676 1671 /*******************************************************************************
cparata 0:e7e920b85676 1672 * Function Name : LSM6DSL_ACC_GYRO_W_OVERRUN_on_INT1
cparata 0:e7e920b85676 1673 * Description : Write INT1_OVR
cparata 0:e7e920b85676 1674 * Input : LSM6DSL_ACC_GYRO_INT1_OVR_t
cparata 0:e7e920b85676 1675 * Output : None
cparata 0:e7e920b85676 1676 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1677 *******************************************************************************/
cparata 0:e7e920b85676 1678 status_t LSM6DSL_ACC_GYRO_W_OVERRUN_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_OVR_t newValue)
cparata 0:e7e920b85676 1679 {
cparata 0:e7e920b85676 1680 u8_t value;
cparata 0:e7e920b85676 1681
cparata 0:e7e920b85676 1682 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
cparata 0:e7e920b85676 1683 return MEMS_ERROR;
cparata 0:e7e920b85676 1684
cparata 0:e7e920b85676 1685 value &= ~LSM6DSL_ACC_GYRO_INT1_OVR_MASK;
cparata 0:e7e920b85676 1686 value |= newValue;
cparata 0:e7e920b85676 1687
cparata 0:e7e920b85676 1688 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
cparata 0:e7e920b85676 1689 return MEMS_ERROR;
cparata 0:e7e920b85676 1690
cparata 0:e7e920b85676 1691 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1692 }
cparata 0:e7e920b85676 1693
cparata 0:e7e920b85676 1694 /*******************************************************************************
cparata 0:e7e920b85676 1695 * Function Name : LSM6DSL_ACC_GYRO_R_OVERRUN_on_INT1
cparata 0:e7e920b85676 1696 * Description : Read INT1_OVR
cparata 0:e7e920b85676 1697 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_OVR_t
cparata 0:e7e920b85676 1698 * Output : Status of INT1_OVR see LSM6DSL_ACC_GYRO_INT1_OVR_t
cparata 0:e7e920b85676 1699 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1700 *******************************************************************************/
cparata 0:e7e920b85676 1701 status_t LSM6DSL_ACC_GYRO_R_OVERRUN_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_OVR_t *value)
cparata 0:e7e920b85676 1702 {
cparata 0:e7e920b85676 1703 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
cparata 0:e7e920b85676 1704 return MEMS_ERROR;
cparata 0:e7e920b85676 1705
cparata 0:e7e920b85676 1706 *value &= LSM6DSL_ACC_GYRO_INT1_OVR_MASK; //mask
cparata 0:e7e920b85676 1707
cparata 0:e7e920b85676 1708 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1709 }
cparata 0:e7e920b85676 1710
cparata 0:e7e920b85676 1711 /*******************************************************************************
cparata 0:e7e920b85676 1712 * Function Name : LSM6DSL_ACC_GYRO_W_FULL_FLAG_on_INT1
cparata 0:e7e920b85676 1713 * Description : Write INT1_FULL_FLAG
cparata 0:e7e920b85676 1714 * Input : LSM6DSL_ACC_GYRO_INT1_FULL_FLAG_t
cparata 0:e7e920b85676 1715 * Output : None
cparata 0:e7e920b85676 1716 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1717 *******************************************************************************/
cparata 0:e7e920b85676 1718 status_t LSM6DSL_ACC_GYRO_W_FULL_FLAG_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_FULL_FLAG_t newValue)
cparata 0:e7e920b85676 1719 {
cparata 0:e7e920b85676 1720 u8_t value;
cparata 0:e7e920b85676 1721
cparata 0:e7e920b85676 1722 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
cparata 0:e7e920b85676 1723 return MEMS_ERROR;
cparata 0:e7e920b85676 1724
cparata 0:e7e920b85676 1725 value &= ~LSM6DSL_ACC_GYRO_INT1_FULL_FLAG_MASK;
cparata 0:e7e920b85676 1726 value |= newValue;
cparata 0:e7e920b85676 1727
cparata 0:e7e920b85676 1728 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
cparata 0:e7e920b85676 1729 return MEMS_ERROR;
cparata 0:e7e920b85676 1730
cparata 0:e7e920b85676 1731 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1732 }
cparata 0:e7e920b85676 1733
cparata 0:e7e920b85676 1734 /*******************************************************************************
cparata 0:e7e920b85676 1735 * Function Name : LSM6DSL_ACC_GYRO_R_FULL_FLAG_on_INT1
cparata 0:e7e920b85676 1736 * Description : Read INT1_FULL_FLAG
cparata 0:e7e920b85676 1737 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_FULL_FLAG_t
cparata 0:e7e920b85676 1738 * Output : Status of INT1_FULL_FLAG see LSM6DSL_ACC_GYRO_INT1_FULL_FLAG_t
cparata 0:e7e920b85676 1739 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1740 *******************************************************************************/
cparata 0:e7e920b85676 1741 status_t LSM6DSL_ACC_GYRO_R_FULL_FLAG_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_FULL_FLAG_t *value)
cparata 0:e7e920b85676 1742 {
cparata 0:e7e920b85676 1743 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
cparata 0:e7e920b85676 1744 return MEMS_ERROR;
cparata 0:e7e920b85676 1745
cparata 0:e7e920b85676 1746 *value &= LSM6DSL_ACC_GYRO_INT1_FULL_FLAG_MASK; //mask
cparata 0:e7e920b85676 1747
cparata 0:e7e920b85676 1748 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1749 }
cparata 0:e7e920b85676 1750
cparata 0:e7e920b85676 1751 /*******************************************************************************
cparata 0:e7e920b85676 1752 * Function Name : LSM6DSL_ACC_GYRO_W_SIGN_MOT_on_INT1
cparata 0:e7e920b85676 1753 * Description : Write INT1_SIGN_MOT
cparata 0:e7e920b85676 1754 * Input : LSM6DSL_ACC_GYRO_INT1_SIGN_MOT_t
cparata 0:e7e920b85676 1755 * Output : None
cparata 0:e7e920b85676 1756 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1757 *******************************************************************************/
cparata 0:e7e920b85676 1758 status_t LSM6DSL_ACC_GYRO_W_SIGN_MOT_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_SIGN_MOT_t newValue)
cparata 0:e7e920b85676 1759 {
cparata 0:e7e920b85676 1760 u8_t value;
cparata 0:e7e920b85676 1761
cparata 0:e7e920b85676 1762 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
cparata 0:e7e920b85676 1763 return MEMS_ERROR;
cparata 0:e7e920b85676 1764
cparata 0:e7e920b85676 1765 value &= ~LSM6DSL_ACC_GYRO_INT1_SIGN_MOT_MASK;
cparata 0:e7e920b85676 1766 value |= newValue;
cparata 0:e7e920b85676 1767
cparata 0:e7e920b85676 1768 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
cparata 0:e7e920b85676 1769 return MEMS_ERROR;
cparata 0:e7e920b85676 1770
cparata 0:e7e920b85676 1771 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1772 }
cparata 0:e7e920b85676 1773
cparata 0:e7e920b85676 1774 /*******************************************************************************
cparata 0:e7e920b85676 1775 * Function Name : LSM6DSL_ACC_GYRO_R_SIGN_MOT_on_INT1
cparata 0:e7e920b85676 1776 * Description : Read INT1_SIGN_MOT
cparata 0:e7e920b85676 1777 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_SIGN_MOT_t
cparata 0:e7e920b85676 1778 * Output : Status of INT1_SIGN_MOT see LSM6DSL_ACC_GYRO_INT1_SIGN_MOT_t
cparata 0:e7e920b85676 1779 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1780 *******************************************************************************/
cparata 0:e7e920b85676 1781 status_t LSM6DSL_ACC_GYRO_R_SIGN_MOT_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_SIGN_MOT_t *value)
cparata 0:e7e920b85676 1782 {
cparata 0:e7e920b85676 1783 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
cparata 0:e7e920b85676 1784 return MEMS_ERROR;
cparata 0:e7e920b85676 1785
cparata 0:e7e920b85676 1786 *value &= LSM6DSL_ACC_GYRO_INT1_SIGN_MOT_MASK; //mask
cparata 0:e7e920b85676 1787
cparata 0:e7e920b85676 1788 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1789 }
cparata 0:e7e920b85676 1790
cparata 0:e7e920b85676 1791 /*******************************************************************************
cparata 0:e7e920b85676 1792 * Function Name : LSM6DSL_ACC_GYRO_W_STEP_DET_on_INT1
cparata 0:e7e920b85676 1793 * Description : Write INT1_PEDO
cparata 0:e7e920b85676 1794 * Input : LSM6DSL_ACC_GYRO_INT1_PEDO_t
cparata 0:e7e920b85676 1795 * Output : None
cparata 0:e7e920b85676 1796 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1797 *******************************************************************************/
cparata 0:e7e920b85676 1798 status_t LSM6DSL_ACC_GYRO_W_STEP_DET_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_PEDO_t newValue)
cparata 0:e7e920b85676 1799 {
cparata 0:e7e920b85676 1800 u8_t value;
cparata 0:e7e920b85676 1801
cparata 0:e7e920b85676 1802 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
cparata 0:e7e920b85676 1803 return MEMS_ERROR;
cparata 0:e7e920b85676 1804
cparata 0:e7e920b85676 1805 value &= ~LSM6DSL_ACC_GYRO_INT1_PEDO_MASK;
cparata 0:e7e920b85676 1806 value |= newValue;
cparata 0:e7e920b85676 1807
cparata 0:e7e920b85676 1808 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
cparata 0:e7e920b85676 1809 return MEMS_ERROR;
cparata 0:e7e920b85676 1810
cparata 0:e7e920b85676 1811 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1812 }
cparata 0:e7e920b85676 1813
cparata 0:e7e920b85676 1814 /*******************************************************************************
cparata 0:e7e920b85676 1815 * Function Name : LSM6DSL_ACC_GYRO_R_STEP_DET_on_INT1
cparata 0:e7e920b85676 1816 * Description : Read INT1_PEDO
cparata 0:e7e920b85676 1817 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_PEDO_t
cparata 0:e7e920b85676 1818 * Output : Status of INT1_PEDO see LSM6DSL_ACC_GYRO_INT1_PEDO_t
cparata 0:e7e920b85676 1819 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1820 *******************************************************************************/
cparata 0:e7e920b85676 1821 status_t LSM6DSL_ACC_GYRO_R_STEP_DET_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_PEDO_t *value)
cparata 0:e7e920b85676 1822 {
cparata 0:e7e920b85676 1823 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
cparata 0:e7e920b85676 1824 return MEMS_ERROR;
cparata 0:e7e920b85676 1825
cparata 0:e7e920b85676 1826 *value &= LSM6DSL_ACC_GYRO_INT1_PEDO_MASK; //mask
cparata 0:e7e920b85676 1827
cparata 0:e7e920b85676 1828 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1829 }
cparata 0:e7e920b85676 1830
cparata 0:e7e920b85676 1831 /*******************************************************************************
cparata 0:e7e920b85676 1832 * Function Name : LSM6DSL_ACC_GYRO_W_DRDY_XL_on_INT2
cparata 0:e7e920b85676 1833 * Description : Write INT2_DRDY_XL
cparata 0:e7e920b85676 1834 * Input : LSM6DSL_ACC_GYRO_INT2_DRDY_XL_t
cparata 0:e7e920b85676 1835 * Output : None
cparata 0:e7e920b85676 1836 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1837 *******************************************************************************/
cparata 0:e7e920b85676 1838 status_t LSM6DSL_ACC_GYRO_W_DRDY_XL_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_DRDY_XL_t newValue)
cparata 0:e7e920b85676 1839 {
cparata 0:e7e920b85676 1840 u8_t value;
cparata 0:e7e920b85676 1841
cparata 0:e7e920b85676 1842 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
cparata 0:e7e920b85676 1843 return MEMS_ERROR;
cparata 0:e7e920b85676 1844
cparata 0:e7e920b85676 1845 value &= ~LSM6DSL_ACC_GYRO_INT2_DRDY_XL_MASK;
cparata 0:e7e920b85676 1846 value |= newValue;
cparata 0:e7e920b85676 1847
cparata 0:e7e920b85676 1848 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
cparata 0:e7e920b85676 1849 return MEMS_ERROR;
cparata 0:e7e920b85676 1850
cparata 0:e7e920b85676 1851 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1852 }
cparata 0:e7e920b85676 1853
cparata 0:e7e920b85676 1854 /*******************************************************************************
cparata 0:e7e920b85676 1855 * Function Name : LSM6DSL_ACC_GYRO_R_DRDY_XL_on_INT2
cparata 0:e7e920b85676 1856 * Description : Read INT2_DRDY_XL
cparata 0:e7e920b85676 1857 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_DRDY_XL_t
cparata 0:e7e920b85676 1858 * Output : Status of INT2_DRDY_XL see LSM6DSL_ACC_GYRO_INT2_DRDY_XL_t
cparata 0:e7e920b85676 1859 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1860 *******************************************************************************/
cparata 0:e7e920b85676 1861 status_t LSM6DSL_ACC_GYRO_R_DRDY_XL_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_DRDY_XL_t *value)
cparata 0:e7e920b85676 1862 {
cparata 0:e7e920b85676 1863 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
cparata 0:e7e920b85676 1864 return MEMS_ERROR;
cparata 0:e7e920b85676 1865
cparata 0:e7e920b85676 1866 *value &= LSM6DSL_ACC_GYRO_INT2_DRDY_XL_MASK; //mask
cparata 0:e7e920b85676 1867
cparata 0:e7e920b85676 1868 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1869 }
cparata 0:e7e920b85676 1870
cparata 0:e7e920b85676 1871 /*******************************************************************************
cparata 0:e7e920b85676 1872 * Function Name : LSM6DSL_ACC_GYRO_W_DRDY_G_on_INT2
cparata 0:e7e920b85676 1873 * Description : Write INT2_DRDY_G
cparata 0:e7e920b85676 1874 * Input : LSM6DSL_ACC_GYRO_INT2_DRDY_G_t
cparata 0:e7e920b85676 1875 * Output : None
cparata 0:e7e920b85676 1876 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1877 *******************************************************************************/
cparata 0:e7e920b85676 1878 status_t LSM6DSL_ACC_GYRO_W_DRDY_G_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_DRDY_G_t newValue)
cparata 0:e7e920b85676 1879 {
cparata 0:e7e920b85676 1880 u8_t value;
cparata 0:e7e920b85676 1881
cparata 0:e7e920b85676 1882 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
cparata 0:e7e920b85676 1883 return MEMS_ERROR;
cparata 0:e7e920b85676 1884
cparata 0:e7e920b85676 1885 value &= ~LSM6DSL_ACC_GYRO_INT2_DRDY_G_MASK;
cparata 0:e7e920b85676 1886 value |= newValue;
cparata 0:e7e920b85676 1887
cparata 0:e7e920b85676 1888 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
cparata 0:e7e920b85676 1889 return MEMS_ERROR;
cparata 0:e7e920b85676 1890
cparata 0:e7e920b85676 1891 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1892 }
cparata 0:e7e920b85676 1893
cparata 0:e7e920b85676 1894 /*******************************************************************************
cparata 0:e7e920b85676 1895 * Function Name : LSM6DSL_ACC_GYRO_R_DRDY_G_on_INT2
cparata 0:e7e920b85676 1896 * Description : Read INT2_DRDY_G
cparata 0:e7e920b85676 1897 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_DRDY_G_t
cparata 0:e7e920b85676 1898 * Output : Status of INT2_DRDY_G see LSM6DSL_ACC_GYRO_INT2_DRDY_G_t
cparata 0:e7e920b85676 1899 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1900 *******************************************************************************/
cparata 0:e7e920b85676 1901 status_t LSM6DSL_ACC_GYRO_R_DRDY_G_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_DRDY_G_t *value)
cparata 0:e7e920b85676 1902 {
cparata 0:e7e920b85676 1903 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
cparata 0:e7e920b85676 1904 return MEMS_ERROR;
cparata 0:e7e920b85676 1905
cparata 0:e7e920b85676 1906 *value &= LSM6DSL_ACC_GYRO_INT2_DRDY_G_MASK; //mask
cparata 0:e7e920b85676 1907
cparata 0:e7e920b85676 1908 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1909 }
cparata 0:e7e920b85676 1910
cparata 0:e7e920b85676 1911 /*******************************************************************************
cparata 0:e7e920b85676 1912 * Function Name : LSM6DSL_ACC_GYRO_W_DRDY_TEMP_on_INT2
cparata 0:e7e920b85676 1913 * Description : Write INT2_DRDY_TEMP
cparata 0:e7e920b85676 1914 * Input : LSM6DSL_ACC_GYRO_INT2_DRDY_TEMP_t
cparata 0:e7e920b85676 1915 * Output : None
cparata 0:e7e920b85676 1916 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1917 *******************************************************************************/
cparata 0:e7e920b85676 1918 status_t LSM6DSL_ACC_GYRO_W_DRDY_TEMP_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_DRDY_TEMP_t newValue)
cparata 0:e7e920b85676 1919 {
cparata 0:e7e920b85676 1920 u8_t value;
cparata 0:e7e920b85676 1921
cparata 0:e7e920b85676 1922 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
cparata 0:e7e920b85676 1923 return MEMS_ERROR;
cparata 0:e7e920b85676 1924
cparata 0:e7e920b85676 1925 value &= ~LSM6DSL_ACC_GYRO_INT2_DRDY_TEMP_MASK;
cparata 0:e7e920b85676 1926 value |= newValue;
cparata 0:e7e920b85676 1927
cparata 0:e7e920b85676 1928 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
cparata 0:e7e920b85676 1929 return MEMS_ERROR;
cparata 0:e7e920b85676 1930
cparata 0:e7e920b85676 1931 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1932 }
cparata 0:e7e920b85676 1933
cparata 0:e7e920b85676 1934 /*******************************************************************************
cparata 0:e7e920b85676 1935 * Function Name : LSM6DSL_ACC_GYRO_R_DRDY_TEMP_on_INT2
cparata 0:e7e920b85676 1936 * Description : Read INT2_DRDY_TEMP
cparata 0:e7e920b85676 1937 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_DRDY_TEMP_t
cparata 0:e7e920b85676 1938 * Output : Status of INT2_DRDY_TEMP see LSM6DSL_ACC_GYRO_INT2_DRDY_TEMP_t
cparata 0:e7e920b85676 1939 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1940 *******************************************************************************/
cparata 0:e7e920b85676 1941 status_t LSM6DSL_ACC_GYRO_R_DRDY_TEMP_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_DRDY_TEMP_t *value)
cparata 0:e7e920b85676 1942 {
cparata 0:e7e920b85676 1943 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
cparata 0:e7e920b85676 1944 return MEMS_ERROR;
cparata 0:e7e920b85676 1945
cparata 0:e7e920b85676 1946 *value &= LSM6DSL_ACC_GYRO_INT2_DRDY_TEMP_MASK; //mask
cparata 0:e7e920b85676 1947
cparata 0:e7e920b85676 1948 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1949 }
cparata 0:e7e920b85676 1950
cparata 0:e7e920b85676 1951 /*******************************************************************************
cparata 0:e7e920b85676 1952 * Function Name : LSM6DSL_ACC_GYRO_W_FIFO_TSHLD_on_INT2
cparata 0:e7e920b85676 1953 * Description : Write INT2_FTH
cparata 0:e7e920b85676 1954 * Input : LSM6DSL_ACC_GYRO_INT2_FTH_t
cparata 0:e7e920b85676 1955 * Output : None
cparata 0:e7e920b85676 1956 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1957 *******************************************************************************/
cparata 0:e7e920b85676 1958 status_t LSM6DSL_ACC_GYRO_W_FIFO_TSHLD_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_FTH_t newValue)
cparata 0:e7e920b85676 1959 {
cparata 0:e7e920b85676 1960 u8_t value;
cparata 0:e7e920b85676 1961
cparata 0:e7e920b85676 1962 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
cparata 0:e7e920b85676 1963 return MEMS_ERROR;
cparata 0:e7e920b85676 1964
cparata 0:e7e920b85676 1965 value &= ~LSM6DSL_ACC_GYRO_INT2_FTH_MASK;
cparata 0:e7e920b85676 1966 value |= newValue;
cparata 0:e7e920b85676 1967
cparata 0:e7e920b85676 1968 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
cparata 0:e7e920b85676 1969 return MEMS_ERROR;
cparata 0:e7e920b85676 1970
cparata 0:e7e920b85676 1971 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1972 }
cparata 0:e7e920b85676 1973
cparata 0:e7e920b85676 1974 /*******************************************************************************
cparata 0:e7e920b85676 1975 * Function Name : LSM6DSL_ACC_GYRO_R_FIFO_TSHLD_on_INT2
cparata 0:e7e920b85676 1976 * Description : Read INT2_FTH
cparata 0:e7e920b85676 1977 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_FTH_t
cparata 0:e7e920b85676 1978 * Output : Status of INT2_FTH see LSM6DSL_ACC_GYRO_INT2_FTH_t
cparata 0:e7e920b85676 1979 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1980 *******************************************************************************/
cparata 0:e7e920b85676 1981 status_t LSM6DSL_ACC_GYRO_R_FIFO_TSHLD_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_FTH_t *value)
cparata 0:e7e920b85676 1982 {
cparata 0:e7e920b85676 1983 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
cparata 0:e7e920b85676 1984 return MEMS_ERROR;
cparata 0:e7e920b85676 1985
cparata 0:e7e920b85676 1986 *value &= LSM6DSL_ACC_GYRO_INT2_FTH_MASK; //mask
cparata 0:e7e920b85676 1987
cparata 0:e7e920b85676 1988 return MEMS_SUCCESS;
cparata 0:e7e920b85676 1989 }
cparata 0:e7e920b85676 1990
cparata 0:e7e920b85676 1991 /*******************************************************************************
cparata 0:e7e920b85676 1992 * Function Name : LSM6DSL_ACC_GYRO_W_OVERRUN_on_INT2
cparata 0:e7e920b85676 1993 * Description : Write INT2_OVR
cparata 0:e7e920b85676 1994 * Input : LSM6DSL_ACC_GYRO_INT2_OVR_t
cparata 0:e7e920b85676 1995 * Output : None
cparata 0:e7e920b85676 1996 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 1997 *******************************************************************************/
cparata 0:e7e920b85676 1998 status_t LSM6DSL_ACC_GYRO_W_OVERRUN_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_OVR_t newValue)
cparata 0:e7e920b85676 1999 {
cparata 0:e7e920b85676 2000 u8_t value;
cparata 0:e7e920b85676 2001
cparata 0:e7e920b85676 2002 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
cparata 0:e7e920b85676 2003 return MEMS_ERROR;
cparata 0:e7e920b85676 2004
cparata 0:e7e920b85676 2005 value &= ~LSM6DSL_ACC_GYRO_INT2_OVR_MASK;
cparata 0:e7e920b85676 2006 value |= newValue;
cparata 0:e7e920b85676 2007
cparata 0:e7e920b85676 2008 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
cparata 0:e7e920b85676 2009 return MEMS_ERROR;
cparata 0:e7e920b85676 2010
cparata 0:e7e920b85676 2011 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2012 }
cparata 0:e7e920b85676 2013
cparata 0:e7e920b85676 2014 /*******************************************************************************
cparata 0:e7e920b85676 2015 * Function Name : LSM6DSL_ACC_GYRO_R_OVERRUN_on_INT2
cparata 0:e7e920b85676 2016 * Description : Read INT2_OVR
cparata 0:e7e920b85676 2017 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_OVR_t
cparata 0:e7e920b85676 2018 * Output : Status of INT2_OVR see LSM6DSL_ACC_GYRO_INT2_OVR_t
cparata 0:e7e920b85676 2019 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2020 *******************************************************************************/
cparata 0:e7e920b85676 2021 status_t LSM6DSL_ACC_GYRO_R_OVERRUN_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_OVR_t *value)
cparata 0:e7e920b85676 2022 {
cparata 0:e7e920b85676 2023 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
cparata 0:e7e920b85676 2024 return MEMS_ERROR;
cparata 0:e7e920b85676 2025
cparata 0:e7e920b85676 2026 *value &= LSM6DSL_ACC_GYRO_INT2_OVR_MASK; //mask
cparata 0:e7e920b85676 2027
cparata 0:e7e920b85676 2028 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2029 }
cparata 0:e7e920b85676 2030
cparata 0:e7e920b85676 2031 /*******************************************************************************
cparata 0:e7e920b85676 2032 * Function Name : LSM6DSL_ACC_GYRO_W_FULL_FLAG_on_INT2
cparata 0:e7e920b85676 2033 * Description : Write INT2_FULL_FLAG
cparata 0:e7e920b85676 2034 * Input : LSM6DSL_ACC_GYRO_INT2_FULL_FLAG_t
cparata 0:e7e920b85676 2035 * Output : None
cparata 0:e7e920b85676 2036 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2037 *******************************************************************************/
cparata 0:e7e920b85676 2038 status_t LSM6DSL_ACC_GYRO_W_FULL_FLAG_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_FULL_FLAG_t newValue)
cparata 0:e7e920b85676 2039 {
cparata 0:e7e920b85676 2040 u8_t value;
cparata 0:e7e920b85676 2041
cparata 0:e7e920b85676 2042 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
cparata 0:e7e920b85676 2043 return MEMS_ERROR;
cparata 0:e7e920b85676 2044
cparata 0:e7e920b85676 2045 value &= ~LSM6DSL_ACC_GYRO_INT2_FULL_FLAG_MASK;
cparata 0:e7e920b85676 2046 value |= newValue;
cparata 0:e7e920b85676 2047
cparata 0:e7e920b85676 2048 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
cparata 0:e7e920b85676 2049 return MEMS_ERROR;
cparata 0:e7e920b85676 2050
cparata 0:e7e920b85676 2051 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2052 }
cparata 0:e7e920b85676 2053
cparata 0:e7e920b85676 2054 /*******************************************************************************
cparata 0:e7e920b85676 2055 * Function Name : LSM6DSL_ACC_GYRO_R_FULL_FLAG_on_INT2
cparata 0:e7e920b85676 2056 * Description : Read INT2_FULL_FLAG
cparata 0:e7e920b85676 2057 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_FULL_FLAG_t
cparata 0:e7e920b85676 2058 * Output : Status of INT2_FULL_FLAG see LSM6DSL_ACC_GYRO_INT2_FULL_FLAG_t
cparata 0:e7e920b85676 2059 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2060 *******************************************************************************/
cparata 0:e7e920b85676 2061 status_t LSM6DSL_ACC_GYRO_R_FULL_FLAG_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_FULL_FLAG_t *value)
cparata 0:e7e920b85676 2062 {
cparata 0:e7e920b85676 2063 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
cparata 0:e7e920b85676 2064 return MEMS_ERROR;
cparata 0:e7e920b85676 2065
cparata 0:e7e920b85676 2066 *value &= LSM6DSL_ACC_GYRO_INT2_FULL_FLAG_MASK; //mask
cparata 0:e7e920b85676 2067
cparata 0:e7e920b85676 2068 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2069 }
cparata 0:e7e920b85676 2070
cparata 0:e7e920b85676 2071 /*******************************************************************************
cparata 0:e7e920b85676 2072 * Function Name : LSM6DSL_ACC_GYRO_W_STEP_COUNT_OV_on_INT2
cparata 0:e7e920b85676 2073 * Description : Write INT2_STEP_COUNT_OV
cparata 0:e7e920b85676 2074 * Input : LSM6DSL_ACC_GYRO_INT2_STEP_COUNT_OV_t
cparata 0:e7e920b85676 2075 * Output : None
cparata 0:e7e920b85676 2076 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2077 *******************************************************************************/
cparata 0:e7e920b85676 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:e7e920b85676 2079 {
cparata 0:e7e920b85676 2080 u8_t value;
cparata 0:e7e920b85676 2081
cparata 0:e7e920b85676 2082 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
cparata 0:e7e920b85676 2083 return MEMS_ERROR;
cparata 0:e7e920b85676 2084
cparata 0:e7e920b85676 2085 value &= ~LSM6DSL_ACC_GYRO_INT2_STEP_COUNT_OV_MASK;
cparata 0:e7e920b85676 2086 value |= newValue;
cparata 0:e7e920b85676 2087
cparata 0:e7e920b85676 2088 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
cparata 0:e7e920b85676 2089 return MEMS_ERROR;
cparata 0:e7e920b85676 2090
cparata 0:e7e920b85676 2091 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2092 }
cparata 0:e7e920b85676 2093
cparata 0:e7e920b85676 2094 /*******************************************************************************
cparata 0:e7e920b85676 2095 * Function Name : LSM6DSL_ACC_GYRO_R_STEP_COUNT_OV_on_INT2
cparata 0:e7e920b85676 2096 * Description : Read INT2_STEP_COUNT_OV
cparata 0:e7e920b85676 2097 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_STEP_COUNT_OV_t
cparata 0:e7e920b85676 2098 * Output : Status of INT2_STEP_COUNT_OV see LSM6DSL_ACC_GYRO_INT2_STEP_COUNT_OV_t
cparata 0:e7e920b85676 2099 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2100 *******************************************************************************/
cparata 0:e7e920b85676 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:e7e920b85676 2102 {
cparata 0:e7e920b85676 2103 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
cparata 0:e7e920b85676 2104 return MEMS_ERROR;
cparata 0:e7e920b85676 2105
cparata 0:e7e920b85676 2106 *value &= LSM6DSL_ACC_GYRO_INT2_STEP_COUNT_OV_MASK; //mask
cparata 0:e7e920b85676 2107
cparata 0:e7e920b85676 2108 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2109 }
cparata 0:e7e920b85676 2110
cparata 0:e7e920b85676 2111 /*******************************************************************************
cparata 0:e7e920b85676 2112 * Function Name : LSM6DSL_ACC_GYRO_W_STEP_DELTA_on_INT2
cparata 0:e7e920b85676 2113 * Description : Write INT2_STEP_DELTA
cparata 0:e7e920b85676 2114 * Input : LSM6DSL_ACC_GYRO_INT2_STEP_DELTA_t
cparata 0:e7e920b85676 2115 * Output : None
cparata 0:e7e920b85676 2116 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2117 *******************************************************************************/
cparata 0:e7e920b85676 2118 status_t LSM6DSL_ACC_GYRO_W_STEP_DELTA_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_STEP_DELTA_t newValue)
cparata 0:e7e920b85676 2119 {
cparata 0:e7e920b85676 2120 u8_t value;
cparata 0:e7e920b85676 2121
cparata 0:e7e920b85676 2122 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
cparata 0:e7e920b85676 2123 return MEMS_ERROR;
cparata 0:e7e920b85676 2124
cparata 0:e7e920b85676 2125 value &= ~LSM6DSL_ACC_GYRO_INT2_STEP_DELTA_MASK;
cparata 0:e7e920b85676 2126 value |= newValue;
cparata 0:e7e920b85676 2127
cparata 0:e7e920b85676 2128 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
cparata 0:e7e920b85676 2129 return MEMS_ERROR;
cparata 0:e7e920b85676 2130
cparata 0:e7e920b85676 2131 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2132 }
cparata 0:e7e920b85676 2133
cparata 0:e7e920b85676 2134 /*******************************************************************************
cparata 0:e7e920b85676 2135 * Function Name : LSM6DSL_ACC_GYRO_R_STEP_DELTA_on_INT2
cparata 0:e7e920b85676 2136 * Description : Read INT2_STEP_DELTA
cparata 0:e7e920b85676 2137 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_STEP_DELTA_t
cparata 0:e7e920b85676 2138 * Output : Status of INT2_STEP_DELTA see LSM6DSL_ACC_GYRO_INT2_STEP_DELTA_t
cparata 0:e7e920b85676 2139 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2140 *******************************************************************************/
cparata 0:e7e920b85676 2141 status_t LSM6DSL_ACC_GYRO_R_STEP_DELTA_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_STEP_DELTA_t *value)
cparata 0:e7e920b85676 2142 {
cparata 0:e7e920b85676 2143 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
cparata 0:e7e920b85676 2144 return MEMS_ERROR;
cparata 0:e7e920b85676 2145
cparata 0:e7e920b85676 2146 *value &= LSM6DSL_ACC_GYRO_INT2_STEP_DELTA_MASK; //mask
cparata 0:e7e920b85676 2147
cparata 0:e7e920b85676 2148 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2149 }
cparata 0:e7e920b85676 2150
cparata 0:e7e920b85676 2151 /*******************************************************************************
cparata 0:e7e920b85676 2152 * Function Name : LSM6DSL_ACC_GYRO_W_SW_RESET
cparata 0:e7e920b85676 2153 * Description : Write SW_RESET
cparata 0:e7e920b85676 2154 * Input : LSM6DSL_ACC_GYRO_SW_RESET_t
cparata 0:e7e920b85676 2155 * Output : None
cparata 0:e7e920b85676 2156 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2157 *******************************************************************************/
cparata 0:e7e920b85676 2158 status_t LSM6DSL_ACC_GYRO_W_SW_RESET(void *handle, LSM6DSL_ACC_GYRO_SW_RESET_t newValue)
cparata 0:e7e920b85676 2159 {
cparata 0:e7e920b85676 2160 u8_t value;
cparata 0:e7e920b85676 2161
cparata 0:e7e920b85676 2162 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
cparata 0:e7e920b85676 2163 return MEMS_ERROR;
cparata 0:e7e920b85676 2164
cparata 0:e7e920b85676 2165 value &= ~LSM6DSL_ACC_GYRO_SW_RESET_MASK;
cparata 0:e7e920b85676 2166 value |= newValue;
cparata 0:e7e920b85676 2167
cparata 0:e7e920b85676 2168 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
cparata 0:e7e920b85676 2169 return MEMS_ERROR;
cparata 0:e7e920b85676 2170
cparata 0:e7e920b85676 2171 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2172 }
cparata 0:e7e920b85676 2173
cparata 0:e7e920b85676 2174 /*******************************************************************************
cparata 0:e7e920b85676 2175 * Function Name : LSM6DSL_ACC_GYRO_R_SW_RESET
cparata 0:e7e920b85676 2176 * Description : Read SW_RESET
cparata 0:e7e920b85676 2177 * Input : Pointer to LSM6DSL_ACC_GYRO_SW_RESET_t
cparata 0:e7e920b85676 2178 * Output : Status of SW_RESET see LSM6DSL_ACC_GYRO_SW_RESET_t
cparata 0:e7e920b85676 2179 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2180 *******************************************************************************/
cparata 0:e7e920b85676 2181 status_t LSM6DSL_ACC_GYRO_R_SW_RESET(void *handle, LSM6DSL_ACC_GYRO_SW_RESET_t *value)
cparata 0:e7e920b85676 2182 {
cparata 0:e7e920b85676 2183 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1))
cparata 0:e7e920b85676 2184 return MEMS_ERROR;
cparata 0:e7e920b85676 2185
cparata 0:e7e920b85676 2186 *value &= LSM6DSL_ACC_GYRO_SW_RESET_MASK; //mask
cparata 0:e7e920b85676 2187
cparata 0:e7e920b85676 2188 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2189 }
cparata 0:e7e920b85676 2190
cparata 0:e7e920b85676 2191 /*******************************************************************************
cparata 0:e7e920b85676 2192 * Function Name : LSM6DSL_ACC_GYRO_W_IF_Addr_Incr
cparata 0:e7e920b85676 2193 * Description : Write IF_INC
cparata 0:e7e920b85676 2194 * Input : LSM6DSL_ACC_GYRO_IF_INC_t
cparata 0:e7e920b85676 2195 * Output : None
cparata 0:e7e920b85676 2196 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2197 *******************************************************************************/
cparata 0:e7e920b85676 2198 status_t LSM6DSL_ACC_GYRO_W_IF_Addr_Incr(void *handle, LSM6DSL_ACC_GYRO_IF_INC_t newValue)
cparata 0:e7e920b85676 2199 {
cparata 0:e7e920b85676 2200 u8_t value;
cparata 0:e7e920b85676 2201
cparata 0:e7e920b85676 2202 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
cparata 0:e7e920b85676 2203 return MEMS_ERROR;
cparata 0:e7e920b85676 2204
cparata 0:e7e920b85676 2205 value &= ~LSM6DSL_ACC_GYRO_IF_INC_MASK;
cparata 0:e7e920b85676 2206 value |= newValue;
cparata 0:e7e920b85676 2207
cparata 0:e7e920b85676 2208 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
cparata 0:e7e920b85676 2209 return MEMS_ERROR;
cparata 0:e7e920b85676 2210
cparata 0:e7e920b85676 2211 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2212 }
cparata 0:e7e920b85676 2213
cparata 0:e7e920b85676 2214 /*******************************************************************************
cparata 0:e7e920b85676 2215 * Function Name : LSM6DSL_ACC_GYRO_R_IF_Addr_Incr
cparata 0:e7e920b85676 2216 * Description : Read IF_INC
cparata 0:e7e920b85676 2217 * Input : Pointer to LSM6DSL_ACC_GYRO_IF_INC_t
cparata 0:e7e920b85676 2218 * Output : Status of IF_INC see LSM6DSL_ACC_GYRO_IF_INC_t
cparata 0:e7e920b85676 2219 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2220 *******************************************************************************/
cparata 0:e7e920b85676 2221 status_t LSM6DSL_ACC_GYRO_R_IF_Addr_Incr(void *handle, LSM6DSL_ACC_GYRO_IF_INC_t *value)
cparata 0:e7e920b85676 2222 {
cparata 0:e7e920b85676 2223 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1) )
cparata 0:e7e920b85676 2224 return MEMS_ERROR;
cparata 0:e7e920b85676 2225
cparata 0:e7e920b85676 2226 *value &= LSM6DSL_ACC_GYRO_IF_INC_MASK; //mask
cparata 0:e7e920b85676 2227
cparata 0:e7e920b85676 2228 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2229 }
cparata 0:e7e920b85676 2230
cparata 0:e7e920b85676 2231 /*******************************************************************************
cparata 0:e7e920b85676 2232 * Function Name : LSM6DSL_ACC_GYRO_W_SPI_Mode
cparata 0:e7e920b85676 2233 * Description : Write SIM
cparata 0:e7e920b85676 2234 * Input : LSM6DSL_ACC_GYRO_SIM_t
cparata 0:e7e920b85676 2235 * Output : None
cparata 0:e7e920b85676 2236 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2237 *******************************************************************************/
cparata 0:e7e920b85676 2238 status_t LSM6DSL_ACC_GYRO_W_SPI_Mode(void *handle, LSM6DSL_ACC_GYRO_SIM_t newValue)
cparata 0:e7e920b85676 2239 {
cparata 0:e7e920b85676 2240 u8_t value;
cparata 0:e7e920b85676 2241
cparata 0:e7e920b85676 2242 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
cparata 0:e7e920b85676 2243 return MEMS_ERROR;
cparata 0:e7e920b85676 2244
cparata 0:e7e920b85676 2245 value &= ~LSM6DSL_ACC_GYRO_SIM_MASK;
cparata 0:e7e920b85676 2246 value |= newValue;
cparata 0:e7e920b85676 2247
cparata 0:e7e920b85676 2248 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
cparata 0:e7e920b85676 2249 return MEMS_ERROR;
cparata 0:e7e920b85676 2250
cparata 0:e7e920b85676 2251 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2252 }
cparata 0:e7e920b85676 2253
cparata 0:e7e920b85676 2254 /*******************************************************************************
cparata 0:e7e920b85676 2255 * Function Name : LSM6DSL_ACC_GYRO_R_SPI_Mode
cparata 0:e7e920b85676 2256 * Description : Read SIM
cparata 0:e7e920b85676 2257 * Input : Pointer to LSM6DSL_ACC_GYRO_SIM_t
cparata 0:e7e920b85676 2258 * Output : Status of SIM see LSM6DSL_ACC_GYRO_SIM_t
cparata 0:e7e920b85676 2259 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2260 *******************************************************************************/
cparata 0:e7e920b85676 2261 status_t LSM6DSL_ACC_GYRO_R_SPI_Mode(void *handle, LSM6DSL_ACC_GYRO_SIM_t *value)
cparata 0:e7e920b85676 2262 {
cparata 0:e7e920b85676 2263 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1))
cparata 0:e7e920b85676 2264 return MEMS_ERROR;
cparata 0:e7e920b85676 2265
cparata 0:e7e920b85676 2266 *value &= LSM6DSL_ACC_GYRO_SIM_MASK; //mask
cparata 0:e7e920b85676 2267
cparata 0:e7e920b85676 2268 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2269 }
cparata 0:e7e920b85676 2270
cparata 0:e7e920b85676 2271 /*******************************************************************************
cparata 0:e7e920b85676 2272 * Function Name : LSM6DSL_ACC_GYRO_W_PadSel
cparata 0:e7e920b85676 2273 * Description : Write PP_OD
cparata 0:e7e920b85676 2274 * Input : LSM6DSL_ACC_GYRO_PP_OD_t
cparata 0:e7e920b85676 2275 * Output : None
cparata 0:e7e920b85676 2276 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2277 *******************************************************************************/
cparata 0:e7e920b85676 2278 status_t LSM6DSL_ACC_GYRO_W_PadSel(void *handle, LSM6DSL_ACC_GYRO_PP_OD_t newValue)
cparata 0:e7e920b85676 2279 {
cparata 0:e7e920b85676 2280 u8_t value;
cparata 0:e7e920b85676 2281
cparata 0:e7e920b85676 2282 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
cparata 0:e7e920b85676 2283 return MEMS_ERROR;
cparata 0:e7e920b85676 2284
cparata 0:e7e920b85676 2285 value &= ~LSM6DSL_ACC_GYRO_PP_OD_MASK;
cparata 0:e7e920b85676 2286 value |= newValue;
cparata 0:e7e920b85676 2287
cparata 0:e7e920b85676 2288 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
cparata 0:e7e920b85676 2289 return MEMS_ERROR;
cparata 0:e7e920b85676 2290
cparata 0:e7e920b85676 2291 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2292 }
cparata 0:e7e920b85676 2293
cparata 0:e7e920b85676 2294 /*******************************************************************************
cparata 0:e7e920b85676 2295 * Function Name : LSM6DSL_ACC_GYRO_R_PadSel
cparata 0:e7e920b85676 2296 * Description : Read PP_OD
cparata 0:e7e920b85676 2297 * Input : Pointer to LSM6DSL_ACC_GYRO_PP_OD_t
cparata 0:e7e920b85676 2298 * Output : Status of PP_OD see LSM6DSL_ACC_GYRO_PP_OD_t
cparata 0:e7e920b85676 2299 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2300 *******************************************************************************/
cparata 0:e7e920b85676 2301 status_t LSM6DSL_ACC_GYRO_R_PadSel(void *handle, LSM6DSL_ACC_GYRO_PP_OD_t *value)
cparata 0:e7e920b85676 2302 {
cparata 0:e7e920b85676 2303 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1) )
cparata 0:e7e920b85676 2304 return MEMS_ERROR;
cparata 0:e7e920b85676 2305
cparata 0:e7e920b85676 2306 *value &= LSM6DSL_ACC_GYRO_PP_OD_MASK; //mask
cparata 0:e7e920b85676 2307
cparata 0:e7e920b85676 2308 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2309 }
cparata 0:e7e920b85676 2310
cparata 0:e7e920b85676 2311 /*******************************************************************************
cparata 0:e7e920b85676 2312 * Function Name : LSM6DSL_ACC_GYRO_W_INT_ACT_LEVEL
cparata 0:e7e920b85676 2313 * Description : Write INT_ACT_LEVEL
cparata 0:e7e920b85676 2314 * Input : LSM6DSL_ACC_GYRO_INT_ACT_LEVEL_t
cparata 0:e7e920b85676 2315 * Output : None
cparata 0:e7e920b85676 2316 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2317 *******************************************************************************/
cparata 0:e7e920b85676 2318 status_t LSM6DSL_ACC_GYRO_W_INT_ACT_LEVEL(void *handle, LSM6DSL_ACC_GYRO_INT_ACT_LEVEL_t newValue)
cparata 0:e7e920b85676 2319 {
cparata 0:e7e920b85676 2320 u8_t value;
cparata 0:e7e920b85676 2321
cparata 0:e7e920b85676 2322 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
cparata 0:e7e920b85676 2323 return MEMS_ERROR;
cparata 0:e7e920b85676 2324
cparata 0:e7e920b85676 2325 value &= ~LSM6DSL_ACC_GYRO_INT_ACT_LEVEL_MASK;
cparata 0:e7e920b85676 2326 value |= newValue;
cparata 0:e7e920b85676 2327
cparata 0:e7e920b85676 2328 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
cparata 0:e7e920b85676 2329 return MEMS_ERROR;
cparata 0:e7e920b85676 2330
cparata 0:e7e920b85676 2331 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2332 }
cparata 0:e7e920b85676 2333
cparata 0:e7e920b85676 2334 /*******************************************************************************
cparata 0:e7e920b85676 2335 * Function Name : LSM6DSL_ACC_GYRO_R_INT_ACT_LEVEL
cparata 0:e7e920b85676 2336 * Description : Read INT_ACT_LEVEL
cparata 0:e7e920b85676 2337 * Input : Pointer to LSM6DSL_ACC_GYRO_INT_ACT_LEVEL_t
cparata 0:e7e920b85676 2338 * Output : Status of INT_ACT_LEVEL see LSM6DSL_ACC_GYRO_INT_ACT_LEVEL_t
cparata 0:e7e920b85676 2339 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2340 *******************************************************************************/
cparata 0:e7e920b85676 2341 status_t LSM6DSL_ACC_GYRO_R_INT_ACT_LEVEL(void *handle, LSM6DSL_ACC_GYRO_INT_ACT_LEVEL_t *value)
cparata 0:e7e920b85676 2342 {
cparata 0:e7e920b85676 2343 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1))
cparata 0:e7e920b85676 2344 return MEMS_ERROR;
cparata 0:e7e920b85676 2345
cparata 0:e7e920b85676 2346 *value &= LSM6DSL_ACC_GYRO_INT_ACT_LEVEL_MASK; //mask
cparata 0:e7e920b85676 2347
cparata 0:e7e920b85676 2348 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2349 }
cparata 0:e7e920b85676 2350
cparata 0:e7e920b85676 2351 /*******************************************************************************
cparata 0:e7e920b85676 2352 * Function Name : LSM6DSL_ACC_GYRO_W_BOOT
cparata 0:e7e920b85676 2353 * Description : Write BOOT
cparata 0:e7e920b85676 2354 * Input : LSM6DSL_ACC_GYRO_BOOT_t
cparata 0:e7e920b85676 2355 * Output : None
cparata 0:e7e920b85676 2356 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2357 *******************************************************************************/
cparata 0:e7e920b85676 2358 status_t LSM6DSL_ACC_GYRO_W_BOOT(void *handle, LSM6DSL_ACC_GYRO_BOOT_t newValue)
cparata 0:e7e920b85676 2359 {
cparata 0:e7e920b85676 2360 u8_t value;
cparata 0:e7e920b85676 2361
cparata 0:e7e920b85676 2362 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
cparata 0:e7e920b85676 2363 return MEMS_ERROR;
cparata 0:e7e920b85676 2364
cparata 0:e7e920b85676 2365 value &= ~LSM6DSL_ACC_GYRO_BOOT_MASK;
cparata 0:e7e920b85676 2366 value |= newValue;
cparata 0:e7e920b85676 2367
cparata 0:e7e920b85676 2368 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
cparata 0:e7e920b85676 2369 return MEMS_ERROR;
cparata 0:e7e920b85676 2370
cparata 0:e7e920b85676 2371 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2372 }
cparata 0:e7e920b85676 2373
cparata 0:e7e920b85676 2374 /*******************************************************************************
cparata 0:e7e920b85676 2375 * Function Name : LSM6DSL_ACC_GYRO_R_BOOT
cparata 0:e7e920b85676 2376 * Description : Read BOOT
cparata 0:e7e920b85676 2377 * Input : Pointer to LSM6DSL_ACC_GYRO_BOOT_t
cparata 0:e7e920b85676 2378 * Output : Status of BOOT see LSM6DSL_ACC_GYRO_BOOT_t
cparata 0:e7e920b85676 2379 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2380 *******************************************************************************/
cparata 0:e7e920b85676 2381 status_t LSM6DSL_ACC_GYRO_R_BOOT(void *handle, LSM6DSL_ACC_GYRO_BOOT_t *value)
cparata 0:e7e920b85676 2382 {
cparata 0:e7e920b85676 2383 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1) )
cparata 0:e7e920b85676 2384 return MEMS_ERROR;
cparata 0:e7e920b85676 2385
cparata 0:e7e920b85676 2386 *value &= LSM6DSL_ACC_GYRO_BOOT_MASK; //mask
cparata 0:e7e920b85676 2387
cparata 0:e7e920b85676 2388 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2389 }
cparata 0:e7e920b85676 2390
cparata 0:e7e920b85676 2391 /*******************************************************************************
cparata 0:e7e920b85676 2392 * Function Name : LSM6DSL_ACC_GYRO_LPF1_SEL_G
cparata 0:e7e920b85676 2393 * Description : Write LPF1_SEL_G
cparata 0:e7e920b85676 2394 * Input : LSM6DSL_ACC_GYRO_LPF1_SEL_G_t
cparata 0:e7e920b85676 2395 * Output : None
cparata 0:e7e920b85676 2396 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2397 *******************************************************************************/
cparata 0:e7e920b85676 2398 status_t LSM6DSL_ACC_GYRO_W_LPF1_SEL_G(void *handle, LSM6DSL_ACC_GYRO_LPF1_SEL_G_t newValue)
cparata 0:e7e920b85676 2399 {
cparata 0:e7e920b85676 2400 u8_t value;
cparata 0:e7e920b85676 2401
cparata 0:e7e920b85676 2402 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1))
cparata 0:e7e920b85676 2403 return MEMS_ERROR;
cparata 0:e7e920b85676 2404
cparata 0:e7e920b85676 2405 value &= ~LSM6DSL_ACC_GYRO_LPF1_SEL_G_MASK;
cparata 0:e7e920b85676 2406 value |= newValue;
cparata 0:e7e920b85676 2407
cparata 0:e7e920b85676 2408 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1) )
cparata 0:e7e920b85676 2409 return MEMS_ERROR;
cparata 0:e7e920b85676 2410
cparata 0:e7e920b85676 2411 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2412 }
cparata 0:e7e920b85676 2413
cparata 0:e7e920b85676 2414 /*******************************************************************************
cparata 0:e7e920b85676 2415 * Function Name : LSM6DSL_ACC_GYRO_LPF1_SEL_G
cparata 0:e7e920b85676 2416 * Description : Read LPF1_SEL_G
cparata 0:e7e920b85676 2417 * Input : Pointer to LSM6DSL_ACC_GYRO_LPF1_SEL_G_t
cparata 0:e7e920b85676 2418 * Output : Status of LPF1_SEL_G see LSM6DSL_ACC_GYRO_LPF1_SEL_G_t
cparata 0:e7e920b85676 2419 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2420 *******************************************************************************/
cparata 0:e7e920b85676 2421 status_t LSM6DSL_ACC_GYRO_R_LPF1_SEL_G(void *handle, LSM6DSL_ACC_GYRO_LPF1_SEL_G_t *value)
cparata 0:e7e920b85676 2422 {
cparata 0:e7e920b85676 2423 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, (u8_t *)value, 1) )
cparata 0:e7e920b85676 2424 return MEMS_ERROR;
cparata 0:e7e920b85676 2425
cparata 0:e7e920b85676 2426 *value &= LSM6DSL_ACC_GYRO_LPF1_SEL_G_MASK; //mask
cparata 0:e7e920b85676 2427
cparata 0:e7e920b85676 2428 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2429 }
cparata 0:e7e920b85676 2430
cparata 0:e7e920b85676 2431 /*******************************************************************************
cparata 0:e7e920b85676 2432 * Function Name : LSM6DSL_ACC_GYRO_W_I2C_DISABLE
cparata 0:e7e920b85676 2433 * Description : Write I2C_DISABLE
cparata 0:e7e920b85676 2434 * Input : LSM6DSL_ACC_GYRO_I2C_DISABLE_t
cparata 0:e7e920b85676 2435 * Output : None
cparata 0:e7e920b85676 2436 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2437 *******************************************************************************/
cparata 0:e7e920b85676 2438 status_t LSM6DSL_ACC_GYRO_W_I2C_DISABLE(void *handle, LSM6DSL_ACC_GYRO_I2C_DISABLE_t newValue)
cparata 0:e7e920b85676 2439 {
cparata 0:e7e920b85676 2440 u8_t value;
cparata 0:e7e920b85676 2441
cparata 0:e7e920b85676 2442 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1))
cparata 0:e7e920b85676 2443 return MEMS_ERROR;
cparata 0:e7e920b85676 2444
cparata 0:e7e920b85676 2445 value &= ~LSM6DSL_ACC_GYRO_I2C_DISABLE_MASK;
cparata 0:e7e920b85676 2446 value |= newValue;
cparata 0:e7e920b85676 2447
cparata 0:e7e920b85676 2448 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1) )
cparata 0:e7e920b85676 2449 return MEMS_ERROR;
cparata 0:e7e920b85676 2450
cparata 0:e7e920b85676 2451 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2452 }
cparata 0:e7e920b85676 2453
cparata 0:e7e920b85676 2454 /*******************************************************************************
cparata 0:e7e920b85676 2455 * Function Name : LSM6DSL_ACC_GYRO_R_I2C_DISABLE
cparata 0:e7e920b85676 2456 * Description : Read I2C_DISABLE
cparata 0:e7e920b85676 2457 * Input : Pointer to LSM6DSL_ACC_GYRO_I2C_DISABLE_t
cparata 0:e7e920b85676 2458 * Output : Status of I2C_DISABLE see LSM6DSL_ACC_GYRO_I2C_DISABLE_t
cparata 0:e7e920b85676 2459 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2460 *******************************************************************************/
cparata 0:e7e920b85676 2461 status_t LSM6DSL_ACC_GYRO_R_I2C_DISABLE(void *handle, LSM6DSL_ACC_GYRO_I2C_DISABLE_t *value)
cparata 0:e7e920b85676 2462 {
cparata 0:e7e920b85676 2463 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, (u8_t *)value, 1) )
cparata 0:e7e920b85676 2464 return MEMS_ERROR;
cparata 0:e7e920b85676 2465
cparata 0:e7e920b85676 2466 *value &= LSM6DSL_ACC_GYRO_I2C_DISABLE_MASK; //mask
cparata 0:e7e920b85676 2467
cparata 0:e7e920b85676 2468 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2469 }
cparata 0:e7e920b85676 2470
cparata 0:e7e920b85676 2471 /*******************************************************************************
cparata 0:e7e920b85676 2472 * Function Name : LSM6DSL_ACC_GYRO_W_DRDY_MSK
cparata 0:e7e920b85676 2473 * Description : Write DRDY_MSK
cparata 0:e7e920b85676 2474 * Input : LSM6DSL_ACC_GYRO_DRDY_MSK_t
cparata 0:e7e920b85676 2475 * Output : None
cparata 0:e7e920b85676 2476 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2477 *******************************************************************************/
cparata 0:e7e920b85676 2478 status_t LSM6DSL_ACC_GYRO_W_DRDY_MSK(void *handle, LSM6DSL_ACC_GYRO_DRDY_MSK_t newValue)
cparata 0:e7e920b85676 2479 {
cparata 0:e7e920b85676 2480 u8_t value;
cparata 0:e7e920b85676 2481
cparata 0:e7e920b85676 2482 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1))
cparata 0:e7e920b85676 2483 return MEMS_ERROR;
cparata 0:e7e920b85676 2484
cparata 0:e7e920b85676 2485 value &= ~LSM6DSL_ACC_GYRO_DRDY_MSK_MASK;
cparata 0:e7e920b85676 2486 value |= newValue;
cparata 0:e7e920b85676 2487
cparata 0:e7e920b85676 2488 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1) )
cparata 0:e7e920b85676 2489 return MEMS_ERROR;
cparata 0:e7e920b85676 2490
cparata 0:e7e920b85676 2491 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2492 }
cparata 0:e7e920b85676 2493
cparata 0:e7e920b85676 2494 /*******************************************************************************
cparata 0:e7e920b85676 2495 * Function Name : LSM6DSL_ACC_GYRO_R_DRDY_MSK
cparata 0:e7e920b85676 2496 * Description : Read DRDY_MSK
cparata 0:e7e920b85676 2497 * Input : Pointer to LSM6DSL_ACC_GYRO_DRDY_MSK_t
cparata 0:e7e920b85676 2498 * Output : Status of DRDY_MSK see LSM6DSL_ACC_GYRO_DRDY_MSK_t
cparata 0:e7e920b85676 2499 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2500 *******************************************************************************/
cparata 0:e7e920b85676 2501 status_t LSM6DSL_ACC_GYRO_R_DRDY_MSK(void *handle, LSM6DSL_ACC_GYRO_DRDY_MSK_t *value)
cparata 0:e7e920b85676 2502 {
cparata 0:e7e920b85676 2503 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, (u8_t *)value, 1))
cparata 0:e7e920b85676 2504 return MEMS_ERROR;
cparata 0:e7e920b85676 2505
cparata 0:e7e920b85676 2506 *value &= LSM6DSL_ACC_GYRO_DRDY_MSK_MASK; //mask
cparata 0:e7e920b85676 2507
cparata 0:e7e920b85676 2508 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2509 }
cparata 0:e7e920b85676 2510
cparata 0:e7e920b85676 2511 /*******************************************************************************
cparata 0:e7e920b85676 2512 * Function Name : LSM6DSL_ACC_GYRO_W_INT2_ON_INT1
cparata 0:e7e920b85676 2513 * Description : Write INT2_ON_INT1
cparata 0:e7e920b85676 2514 * Input : LSM6DSL_ACC_GYRO_INT2_ON_INT1_t
cparata 0:e7e920b85676 2515 * Output : None
cparata 0:e7e920b85676 2516 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2517 *******************************************************************************/
cparata 0:e7e920b85676 2518 status_t LSM6DSL_ACC_GYRO_W_INT2_ON_INT1(void *handle, LSM6DSL_ACC_GYRO_INT2_ON_INT1_t newValue)
cparata 0:e7e920b85676 2519 {
cparata 0:e7e920b85676 2520 u8_t value;
cparata 0:e7e920b85676 2521
cparata 0:e7e920b85676 2522 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1))
cparata 0:e7e920b85676 2523 return MEMS_ERROR;
cparata 0:e7e920b85676 2524
cparata 0:e7e920b85676 2525 value &= ~LSM6DSL_ACC_GYRO_INT2_ON_INT1_MASK;
cparata 0:e7e920b85676 2526 value |= newValue;
cparata 0:e7e920b85676 2527
cparata 0:e7e920b85676 2528 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1) )
cparata 0:e7e920b85676 2529 return MEMS_ERROR;
cparata 0:e7e920b85676 2530
cparata 0:e7e920b85676 2531 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2532 }
cparata 0:e7e920b85676 2533
cparata 0:e7e920b85676 2534 /*******************************************************************************
cparata 0:e7e920b85676 2535 * Function Name : LSM6DSL_ACC_GYRO_R_INT2_ON_INT1
cparata 0:e7e920b85676 2536 * Description : Read INT2_ON_INT1
cparata 0:e7e920b85676 2537 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_ON_INT1_t
cparata 0:e7e920b85676 2538 * Output : Status of INT2_ON_INT1 see LSM6DSL_ACC_GYRO_INT2_ON_INT1_t
cparata 0:e7e920b85676 2539 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2540 *******************************************************************************/
cparata 0:e7e920b85676 2541 status_t LSM6DSL_ACC_GYRO_R_INT2_ON_INT1(void *handle, LSM6DSL_ACC_GYRO_INT2_ON_INT1_t *value)
cparata 0:e7e920b85676 2542 {
cparata 0:e7e920b85676 2543 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, (u8_t *)value, 1))
cparata 0:e7e920b85676 2544 return MEMS_ERROR;
cparata 0:e7e920b85676 2545
cparata 0:e7e920b85676 2546 *value &= LSM6DSL_ACC_GYRO_INT2_ON_INT1_MASK; //mask
cparata 0:e7e920b85676 2547
cparata 0:e7e920b85676 2548 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2549 }
cparata 0:e7e920b85676 2550
cparata 0:e7e920b85676 2551 /*******************************************************************************
cparata 0:e7e920b85676 2552 * Function Name : LSM6DSL_ACC_GYRO_W_SleepMode_G
cparata 0:e7e920b85676 2553 * Description : Write SLEEP_G
cparata 0:e7e920b85676 2554 * Input : LSM6DSL_ACC_GYRO_SLEEP_G_t
cparata 0:e7e920b85676 2555 * Output : None
cparata 0:e7e920b85676 2556 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2557 *******************************************************************************/
cparata 0:e7e920b85676 2558 status_t LSM6DSL_ACC_GYRO_W_SleepMode_G(void *handle, LSM6DSL_ACC_GYRO_SLEEP_G_t newValue)
cparata 0:e7e920b85676 2559 {
cparata 0:e7e920b85676 2560 u8_t value;
cparata 0:e7e920b85676 2561
cparata 0:e7e920b85676 2562 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1))
cparata 0:e7e920b85676 2563 return MEMS_ERROR;
cparata 0:e7e920b85676 2564
cparata 0:e7e920b85676 2565 value &= ~LSM6DSL_ACC_GYRO_SLEEP_G_MASK;
cparata 0:e7e920b85676 2566 value |= newValue;
cparata 0:e7e920b85676 2567
cparata 0:e7e920b85676 2568 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1) )
cparata 0:e7e920b85676 2569 return MEMS_ERROR;
cparata 0:e7e920b85676 2570
cparata 0:e7e920b85676 2571 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2572 }
cparata 0:e7e920b85676 2573
cparata 0:e7e920b85676 2574 /*******************************************************************************
cparata 0:e7e920b85676 2575 * Function Name : LSM6DSL_ACC_GYRO_R_SleepMode_G
cparata 0:e7e920b85676 2576 * Description : Read SLEEP_G
cparata 0:e7e920b85676 2577 * Input : Pointer to LSM6DSL_ACC_GYRO_SLEEP_G_t
cparata 0:e7e920b85676 2578 * Output : Status of SLEEP_G see LSM6DSL_ACC_GYRO_SLEEP_G_t
cparata 0:e7e920b85676 2579 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2580 *******************************************************************************/
cparata 0:e7e920b85676 2581 status_t LSM6DSL_ACC_GYRO_R_SleepMode_G(void *handle, LSM6DSL_ACC_GYRO_SLEEP_G_t *value)
cparata 0:e7e920b85676 2582 {
cparata 0:e7e920b85676 2583 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, (u8_t *)value, 1))
cparata 0:e7e920b85676 2584 return MEMS_ERROR;
cparata 0:e7e920b85676 2585
cparata 0:e7e920b85676 2586 *value &= LSM6DSL_ACC_GYRO_SLEEP_G_MASK; //mask
cparata 0:e7e920b85676 2587
cparata 0:e7e920b85676 2588 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2589 }
cparata 0:e7e920b85676 2590
cparata 0:e7e920b85676 2591 /*******************************************************************************
cparata 0:e7e920b85676 2592 * Function Name : LSM6DSL_ACC_GYRO_W_SelfTest_XL
cparata 0:e7e920b85676 2593 * Description : Write ST_XL
cparata 0:e7e920b85676 2594 * Input : LSM6DSL_ACC_GYRO_ST_XL_t
cparata 0:e7e920b85676 2595 * Output : None
cparata 0:e7e920b85676 2596 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2597 *******************************************************************************/
cparata 0:e7e920b85676 2598 status_t LSM6DSL_ACC_GYRO_W_SelfTest_XL(void *handle, LSM6DSL_ACC_GYRO_ST_XL_t newValue)
cparata 0:e7e920b85676 2599 {
cparata 0:e7e920b85676 2600 u8_t value;
cparata 0:e7e920b85676 2601
cparata 0:e7e920b85676 2602 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1))
cparata 0:e7e920b85676 2603 return MEMS_ERROR;
cparata 0:e7e920b85676 2604
cparata 0:e7e920b85676 2605 value &= ~LSM6DSL_ACC_GYRO_ST_XL_MASK;
cparata 0:e7e920b85676 2606 value |= newValue;
cparata 0:e7e920b85676 2607
cparata 0:e7e920b85676 2608 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1) )
cparata 0:e7e920b85676 2609 return MEMS_ERROR;
cparata 0:e7e920b85676 2610
cparata 0:e7e920b85676 2611 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2612 }
cparata 0:e7e920b85676 2613
cparata 0:e7e920b85676 2614 /*******************************************************************************
cparata 0:e7e920b85676 2615 * Function Name : LSM6DSL_ACC_GYRO_R_SelfTest_XL
cparata 0:e7e920b85676 2616 * Description : Read ST_XL
cparata 0:e7e920b85676 2617 * Input : Pointer to LSM6DSL_ACC_GYRO_ST_XL_t
cparata 0:e7e920b85676 2618 * Output : Status of ST_XL see LSM6DSL_ACC_GYRO_ST_XL_t
cparata 0:e7e920b85676 2619 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2620 *******************************************************************************/
cparata 0:e7e920b85676 2621 status_t LSM6DSL_ACC_GYRO_R_SelfTest_XL(void *handle, LSM6DSL_ACC_GYRO_ST_XL_t *value)
cparata 0:e7e920b85676 2622 {
cparata 0:e7e920b85676 2623 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, (u8_t *)value, 1))
cparata 0:e7e920b85676 2624 return MEMS_ERROR;
cparata 0:e7e920b85676 2625
cparata 0:e7e920b85676 2626 *value &= LSM6DSL_ACC_GYRO_ST_XL_MASK; //mask
cparata 0:e7e920b85676 2627
cparata 0:e7e920b85676 2628 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2629 }
cparata 0:e7e920b85676 2630
cparata 0:e7e920b85676 2631 /*******************************************************************************
cparata 0:e7e920b85676 2632 * Function Name : LSM6DSL_ACC_GYRO_W_SelfTest_G
cparata 0:e7e920b85676 2633 * Description : Write ST_G
cparata 0:e7e920b85676 2634 * Input : LSM6DSL_ACC_GYRO_ST_G_t
cparata 0:e7e920b85676 2635 * Output : None
cparata 0:e7e920b85676 2636 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2637 *******************************************************************************/
cparata 0:e7e920b85676 2638 status_t LSM6DSL_ACC_GYRO_W_SelfTest_G(void *handle, LSM6DSL_ACC_GYRO_ST_G_t newValue)
cparata 0:e7e920b85676 2639 {
cparata 0:e7e920b85676 2640 u8_t value;
cparata 0:e7e920b85676 2641
cparata 0:e7e920b85676 2642 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1))
cparata 0:e7e920b85676 2643 return MEMS_ERROR;
cparata 0:e7e920b85676 2644
cparata 0:e7e920b85676 2645 value &= ~LSM6DSL_ACC_GYRO_ST_G_MASK;
cparata 0:e7e920b85676 2646 value |= newValue;
cparata 0:e7e920b85676 2647
cparata 0:e7e920b85676 2648 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1) )
cparata 0:e7e920b85676 2649 return MEMS_ERROR;
cparata 0:e7e920b85676 2650
cparata 0:e7e920b85676 2651 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2652 }
cparata 0:e7e920b85676 2653
cparata 0:e7e920b85676 2654 /*******************************************************************************
cparata 0:e7e920b85676 2655 * Function Name : LSM6DSL_ACC_GYRO_R_SelfTest_G
cparata 0:e7e920b85676 2656 * Description : Read ST_G
cparata 0:e7e920b85676 2657 * Input : Pointer to LSM6DSL_ACC_GYRO_ST_G_t
cparata 0:e7e920b85676 2658 * Output : Status of ST_G see LSM6DSL_ACC_GYRO_ST_G_t
cparata 0:e7e920b85676 2659 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2660 *******************************************************************************/
cparata 0:e7e920b85676 2661 status_t LSM6DSL_ACC_GYRO_R_SelfTest_G(void *handle, LSM6DSL_ACC_GYRO_ST_G_t *value)
cparata 0:e7e920b85676 2662 {
cparata 0:e7e920b85676 2663 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, (u8_t *)value, 1))
cparata 0:e7e920b85676 2664 return MEMS_ERROR;
cparata 0:e7e920b85676 2665
cparata 0:e7e920b85676 2666 *value &= LSM6DSL_ACC_GYRO_ST_G_MASK; //mask
cparata 0:e7e920b85676 2667
cparata 0:e7e920b85676 2668 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2669 }
cparata 0:e7e920b85676 2670
cparata 0:e7e920b85676 2671 /*******************************************************************************
cparata 0:e7e920b85676 2672 * Function Name : LSM6DSL_ACC_GYRO_W_DEN_Polarity
cparata 0:e7e920b85676 2673 * Description : Write DEN_LH
cparata 0:e7e920b85676 2674 * Input : LSM6DSL_ACC_GYRO_DEN_LH_t
cparata 0:e7e920b85676 2675 * Output : None
cparata 0:e7e920b85676 2676 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2677 *******************************************************************************/
cparata 0:e7e920b85676 2678 status_t LSM6DSL_ACC_GYRO_W_DEN_Polarity(void *handle, LSM6DSL_ACC_GYRO_DEN_LH_t newValue)
cparata 0:e7e920b85676 2679 {
cparata 0:e7e920b85676 2680 u8_t value;
cparata 0:e7e920b85676 2681
cparata 0:e7e920b85676 2682 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1))
cparata 0:e7e920b85676 2683 return MEMS_ERROR;
cparata 0:e7e920b85676 2684
cparata 0:e7e920b85676 2685 value &= ~LSM6DSL_ACC_GYRO_DEN_LH_MASK;
cparata 0:e7e920b85676 2686 value |= newValue;
cparata 0:e7e920b85676 2687
cparata 0:e7e920b85676 2688 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1) )
cparata 0:e7e920b85676 2689 return MEMS_ERROR;
cparata 0:e7e920b85676 2690
cparata 0:e7e920b85676 2691 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2692 }
cparata 0:e7e920b85676 2693
cparata 0:e7e920b85676 2694 /*******************************************************************************
cparata 0:e7e920b85676 2695 * Function Name : LSM6DSL_ACC_GYRO_R_DEN_Polarity
cparata 0:e7e920b85676 2696 * Description : Read DEN_LH
cparata 0:e7e920b85676 2697 * Input : Pointer to LSM6DSL_ACC_GYRO_DEN_LH_t
cparata 0:e7e920b85676 2698 * Output : Status of DEN_LH see LSM6DSL_ACC_GYRO_DEN_LH_t
cparata 0:e7e920b85676 2699 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2700 *******************************************************************************/
cparata 0:e7e920b85676 2701 status_t LSM6DSL_ACC_GYRO_R_DEN_Polarity(void *handle, LSM6DSL_ACC_GYRO_DEN_LH_t *value)
cparata 0:e7e920b85676 2702 {
cparata 0:e7e920b85676 2703 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, (u8_t *)value, 1))
cparata 0:e7e920b85676 2704 return MEMS_ERROR;
cparata 0:e7e920b85676 2705
cparata 0:e7e920b85676 2706 *value &= LSM6DSL_ACC_GYRO_DEN_LH_MASK; //mask
cparata 0:e7e920b85676 2707
cparata 0:e7e920b85676 2708 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2709 }
cparata 0:e7e920b85676 2710
cparata 0:e7e920b85676 2711 /*******************************************************************************
cparata 0:e7e920b85676 2712 * Function Name : LSM6DSL_ACC_GYRO_W_CircularBurstMode
cparata 0:e7e920b85676 2713 * Description : Write ST_ROUNDING
cparata 0:e7e920b85676 2714 * Input : LSM6DSL_ACC_GYRO_ROUNDING_t
cparata 0:e7e920b85676 2715 * Output : None
cparata 0:e7e920b85676 2716 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2717 *******************************************************************************/
cparata 0:e7e920b85676 2718 status_t LSM6DSL_ACC_GYRO_W_CircularBurstMode(void *handle, LSM6DSL_ACC_GYRO_ROUNDING_t newValue)
cparata 0:e7e920b85676 2719 {
cparata 0:e7e920b85676 2720 u8_t value;
cparata 0:e7e920b85676 2721
cparata 0:e7e920b85676 2722 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1))
cparata 0:e7e920b85676 2723 return MEMS_ERROR;
cparata 0:e7e920b85676 2724
cparata 0:e7e920b85676 2725 value &= ~LSM6DSL_ACC_GYRO_LSM6DSL_ACC_GYRO_ROUNDING_t_MASK;
cparata 0:e7e920b85676 2726 value |= newValue;
cparata 0:e7e920b85676 2727
cparata 0:e7e920b85676 2728 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1) )
cparata 0:e7e920b85676 2729 return MEMS_ERROR;
cparata 0:e7e920b85676 2730
cparata 0:e7e920b85676 2731 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2732 }
cparata 0:e7e920b85676 2733
cparata 0:e7e920b85676 2734 /*******************************************************************************
cparata 0:e7e920b85676 2735 * Function Name : LSM6DSL_ACC_GYRO_R_CircularBurstMode
cparata 0:e7e920b85676 2736 * Description : Read ST_ROUNDING
cparata 0:e7e920b85676 2737 * Input : Pointer to LSM6DSL_ACC_GYRO_ROUNDING_t
cparata 0:e7e920b85676 2738 * Output : Status of ST_ROUNDING see LSM6DSL_ACC_GYRO_ROUNDING_t
cparata 0:e7e920b85676 2739 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2740 *******************************************************************************/
cparata 0:e7e920b85676 2741 status_t LSM6DSL_ACC_GYRO_R_CircularBurstMode(void *handle, LSM6DSL_ACC_GYRO_ROUNDING_t *value)
cparata 0:e7e920b85676 2742 {
cparata 0:e7e920b85676 2743 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, (u8_t *)value, 1))
cparata 0:e7e920b85676 2744 return MEMS_ERROR;
cparata 0:e7e920b85676 2745
cparata 0:e7e920b85676 2746 *value &= LSM6DSL_ACC_GYRO_LSM6DSL_ACC_GYRO_ROUNDING_t_MASK; //mask
cparata 0:e7e920b85676 2747
cparata 0:e7e920b85676 2748 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2749 }
cparata 0:e7e920b85676 2750
cparata 0:e7e920b85676 2751 /*******************************************************************************
cparata 0:e7e920b85676 2752 * Function Name : LSM6DSL_ACC_GYRO_W_LP_BW_G
cparata 0:e7e920b85676 2753 * Description : Write FTYPE
cparata 0:e7e920b85676 2754 * Input : LSM6DSL_ACC_GYRO_FTYPE_t
cparata 0:e7e920b85676 2755 * Output : None
cparata 0:e7e920b85676 2756 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2757 *******************************************************************************/
cparata 0:e7e920b85676 2758 status_t LSM6DSL_ACC_GYRO_W_LP_BW_G(void *handle, LSM6DSL_ACC_GYRO_FTYPE_t newValue)
cparata 0:e7e920b85676 2759 {
cparata 0:e7e920b85676 2760 u8_t value;
cparata 0:e7e920b85676 2761
cparata 0:e7e920b85676 2762 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1))
cparata 0:e7e920b85676 2763 return MEMS_ERROR;
cparata 0:e7e920b85676 2764
cparata 0:e7e920b85676 2765 value &= ~LSM6DSL_ACC_GYRO_FTYPE_MASK;
cparata 0:e7e920b85676 2766 value |= newValue;
cparata 0:e7e920b85676 2767
cparata 0:e7e920b85676 2768 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1) )
cparata 0:e7e920b85676 2769 return MEMS_ERROR;
cparata 0:e7e920b85676 2770
cparata 0:e7e920b85676 2771 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2772 }
cparata 0:e7e920b85676 2773
cparata 0:e7e920b85676 2774 /*******************************************************************************
cparata 0:e7e920b85676 2775 * Function Name : LSM6DSL_ACC_GYRO_R_LP_BW_G
cparata 0:e7e920b85676 2776 * Description : Read FTYPE
cparata 0:e7e920b85676 2777 * Input : Pointer to LSM6DSL_ACC_GYRO_FTYPE_t
cparata 0:e7e920b85676 2778 * Output : Status of FTYPE see LSM6DSL_ACC_GYRO_FTYPE_t
cparata 0:e7e920b85676 2779 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2780 *******************************************************************************/
cparata 0:e7e920b85676 2781 status_t LSM6DSL_ACC_GYRO_R_LP_BW_G(void *handle, LSM6DSL_ACC_GYRO_FTYPE_t *value)
cparata 0:e7e920b85676 2782 {
cparata 0:e7e920b85676 2783 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, (u8_t *)value, 1))
cparata 0:e7e920b85676 2784 return MEMS_ERROR;
cparata 0:e7e920b85676 2785
cparata 0:e7e920b85676 2786 *value &= LSM6DSL_ACC_GYRO_FTYPE_MASK; //mask
cparata 0:e7e920b85676 2787
cparata 0:e7e920b85676 2788 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2789 }
cparata 0:e7e920b85676 2790
cparata 0:e7e920b85676 2791 /*******************************************************************************
cparata 0:e7e920b85676 2792 * Function Name : LSM6DSL_ACC_GYRO_W_UserOffsetWeight
cparata 0:e7e920b85676 2793 * Description : Write USR_OFF_W
cparata 0:e7e920b85676 2794 * Input : LSM6DSL_ACC_GYRO_USR_OFF_W_t
cparata 0:e7e920b85676 2795 * Output : None
cparata 0:e7e920b85676 2796 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2797 *******************************************************************************/
cparata 0:e7e920b85676 2798 status_t LSM6DSL_ACC_GYRO_W_UserOffsetWeight(void *handle, LSM6DSL_ACC_GYRO_USR_OFF_W_t newValue)
cparata 0:e7e920b85676 2799 {
cparata 0:e7e920b85676 2800 u8_t value;
cparata 0:e7e920b85676 2801
cparata 0:e7e920b85676 2802 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1))
cparata 0:e7e920b85676 2803 return MEMS_ERROR;
cparata 0:e7e920b85676 2804
cparata 0:e7e920b85676 2805 value &= ~LSM6DSL_ACC_GYRO_USR_OFF_W_MASK;
cparata 0:e7e920b85676 2806 value |= newValue;
cparata 0:e7e920b85676 2807
cparata 0:e7e920b85676 2808 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1) )
cparata 0:e7e920b85676 2809 return MEMS_ERROR;
cparata 0:e7e920b85676 2810
cparata 0:e7e920b85676 2811 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2812 }
cparata 0:e7e920b85676 2813
cparata 0:e7e920b85676 2814 /*******************************************************************************
cparata 0:e7e920b85676 2815 * Function Name : LSM6DSL_ACC_GYRO_R_UserOffsetWeight
cparata 0:e7e920b85676 2816 * Description : Read USR_OFF_W
cparata 0:e7e920b85676 2817 * Input : Pointer to LSM6DSL_ACC_GYRO_USR_OFF_W_t
cparata 0:e7e920b85676 2818 * Output : Status of USR_OFF_W see LSM6DSL_ACC_GYRO_USR_OFF_W_t
cparata 0:e7e920b85676 2819 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2820 *******************************************************************************/
cparata 0:e7e920b85676 2821 status_t LSM6DSL_ACC_GYRO_R_UserOffsetWeight(void *handle, LSM6DSL_ACC_GYRO_USR_OFF_W_t *value)
cparata 0:e7e920b85676 2822 {
cparata 0:e7e920b85676 2823 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, (u8_t *)value, 1))
cparata 0:e7e920b85676 2824 return MEMS_ERROR;
cparata 0:e7e920b85676 2825
cparata 0:e7e920b85676 2826 *value &= LSM6DSL_ACC_GYRO_USR_OFF_W_MASK; //mask
cparata 0:e7e920b85676 2827
cparata 0:e7e920b85676 2828 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2829 }
cparata 0:e7e920b85676 2830
cparata 0:e7e920b85676 2831 /*******************************************************************************
cparata 0:e7e920b85676 2832 * Function Name : LSM6DSL_ACC_GYRO_W_LowPower_XL
cparata 0:e7e920b85676 2833 * Description : Write LP_XL
cparata 0:e7e920b85676 2834 * Input : LSM6DSL_ACC_GYRO_LP_XL_t
cparata 0:e7e920b85676 2835 * Output : None
cparata 0:e7e920b85676 2836 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2837 *******************************************************************************/
cparata 0:e7e920b85676 2838 status_t LSM6DSL_ACC_GYRO_W_LowPower_XL(void *handle, LSM6DSL_ACC_GYRO_LP_XL_t newValue)
cparata 0:e7e920b85676 2839 {
cparata 0:e7e920b85676 2840 u8_t value;
cparata 0:e7e920b85676 2841
cparata 0:e7e920b85676 2842 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1))
cparata 0:e7e920b85676 2843 return MEMS_ERROR;
cparata 0:e7e920b85676 2844
cparata 0:e7e920b85676 2845 value &= ~LSM6DSL_ACC_GYRO_LP_XL_MASK;
cparata 0:e7e920b85676 2846 value |= newValue;
cparata 0:e7e920b85676 2847
cparata 0:e7e920b85676 2848 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1) )
cparata 0:e7e920b85676 2849 return MEMS_ERROR;
cparata 0:e7e920b85676 2850
cparata 0:e7e920b85676 2851 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2852 }
cparata 0:e7e920b85676 2853
cparata 0:e7e920b85676 2854 /*******************************************************************************
cparata 0:e7e920b85676 2855 * Function Name : LSM6DSL_ACC_GYRO_R_LowPower_XL
cparata 0:e7e920b85676 2856 * Description : Read LP_XL
cparata 0:e7e920b85676 2857 * Input : Pointer to LSM6DSL_ACC_GYRO_LP_XL_t
cparata 0:e7e920b85676 2858 * Output : Status of LP_XL see LSM6DSL_ACC_GYRO_LP_XL_t
cparata 0:e7e920b85676 2859 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2860 *******************************************************************************/
cparata 0:e7e920b85676 2861 status_t LSM6DSL_ACC_GYRO_R_LowPower_XL(void *handle, LSM6DSL_ACC_GYRO_LP_XL_t *value)
cparata 0:e7e920b85676 2862 {
cparata 0:e7e920b85676 2863 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, (u8_t *)value, 1))
cparata 0:e7e920b85676 2864 return MEMS_ERROR;
cparata 0:e7e920b85676 2865
cparata 0:e7e920b85676 2866 *value &= LSM6DSL_ACC_GYRO_LP_XL_MASK; //mask
cparata 0:e7e920b85676 2867
cparata 0:e7e920b85676 2868 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2869 }
cparata 0:e7e920b85676 2870 /*******************************************************************************
cparata 0:e7e920b85676 2871 * Function Name : LSM6DSL_ACC_GYRO_W_DEN_LVL2_EN
cparata 0:e7e920b85676 2872 * Description : Write DEN_LVL2_EN
cparata 0:e7e920b85676 2873 * Input : LSM6DSL_ACC_GYRO_DEN_LVL2_EN_t
cparata 0:e7e920b85676 2874 * Output : None
cparata 0:e7e920b85676 2875 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2876 *******************************************************************************/
cparata 0:e7e920b85676 2877 status_t LSM6DSL_ACC_GYRO_W_DEN_LVL2_EN(void *handle, LSM6DSL_ACC_GYRO_DEN_LVL2_EN_t newValue)
cparata 0:e7e920b85676 2878 {
cparata 0:e7e920b85676 2879 u8_t value;
cparata 0:e7e920b85676 2880
cparata 0:e7e920b85676 2881 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1))
cparata 0:e7e920b85676 2882 return MEMS_ERROR;
cparata 0:e7e920b85676 2883
cparata 0:e7e920b85676 2884 value &= ~LSM6DSL_ACC_GYRO_DEN_LVL2_EN_MASK;
cparata 0:e7e920b85676 2885 value |= newValue;
cparata 0:e7e920b85676 2886
cparata 0:e7e920b85676 2887 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1) )
cparata 0:e7e920b85676 2888 return MEMS_ERROR;
cparata 0:e7e920b85676 2889
cparata 0:e7e920b85676 2890 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2891 }
cparata 0:e7e920b85676 2892
cparata 0:e7e920b85676 2893 /*******************************************************************************
cparata 0:e7e920b85676 2894 * Function Name : LSM6DSL_ACC_GYRO_R_DEN_LVL2_EN
cparata 0:e7e920b85676 2895 * Description : Read DEN_LVL2_EN
cparata 0:e7e920b85676 2896 * Input : Pointer to LSM6DSL_ACC_GYRO_DEN_LVL2_EN_t
cparata 0:e7e920b85676 2897 * Output : Status of DEN_LVL2_EN see LSM6DSL_ACC_GYRO_DEN_LVL2_EN_t
cparata 0:e7e920b85676 2898 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2899 *******************************************************************************/
cparata 0:e7e920b85676 2900 status_t LSM6DSL_ACC_GYRO_R_DEN_LVL2_EN(void *handle, LSM6DSL_ACC_GYRO_DEN_LVL2_EN_t *value)
cparata 0:e7e920b85676 2901 {
cparata 0:e7e920b85676 2902 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, (u8_t *)value, 1))
cparata 0:e7e920b85676 2903 return MEMS_ERROR;
cparata 0:e7e920b85676 2904
cparata 0:e7e920b85676 2905 *value &= LSM6DSL_ACC_GYRO_DEN_LVL2_EN_MASK; //mask
cparata 0:e7e920b85676 2906
cparata 0:e7e920b85676 2907 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2908 }
cparata 0:e7e920b85676 2909 /*******************************************************************************
cparata 0:e7e920b85676 2910 * Function Name : LSM6DSL_ACC_GYRO_W_DEN_LVL_EN
cparata 0:e7e920b85676 2911 * Description : Write DEN_LVL_EN
cparata 0:e7e920b85676 2912 * Input : LSM6DSL_ACC_GYRO_DEN_LVL_EN_t
cparata 0:e7e920b85676 2913 * Output : None
cparata 0:e7e920b85676 2914 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2915 *******************************************************************************/
cparata 0:e7e920b85676 2916 status_t LSM6DSL_ACC_GYRO_W_DEN_LVL_EN(void *handle, LSM6DSL_ACC_GYRO_DEN_LVL_EN_t newValue)
cparata 0:e7e920b85676 2917 {
cparata 0:e7e920b85676 2918 u8_t value;
cparata 0:e7e920b85676 2919
cparata 0:e7e920b85676 2920 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1))
cparata 0:e7e920b85676 2921 return MEMS_ERROR;
cparata 0:e7e920b85676 2922
cparata 0:e7e920b85676 2923 value &= ~LSM6DSL_ACC_GYRO_DEN_LVL_EN_MASK;
cparata 0:e7e920b85676 2924 value |= newValue;
cparata 0:e7e920b85676 2925
cparata 0:e7e920b85676 2926 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1) )
cparata 0:e7e920b85676 2927 return MEMS_ERROR;
cparata 0:e7e920b85676 2928
cparata 0:e7e920b85676 2929 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2930 }
cparata 0:e7e920b85676 2931
cparata 0:e7e920b85676 2932 /*******************************************************************************
cparata 0:e7e920b85676 2933 * Function Name : LSM6DSL_ACC_GYRO_R_DEN_LVL_EN
cparata 0:e7e920b85676 2934 * Description : Read DEN_LVL_EN
cparata 0:e7e920b85676 2935 * Input : Pointer to LSM6DSL_ACC_GYRO_DEN_LVL_EN_t
cparata 0:e7e920b85676 2936 * Output : Status of DEN_LVL_EN see LSM6DSL_ACC_GYRO_DEN_LVL_EN_t
cparata 0:e7e920b85676 2937 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2938 *******************************************************************************/
cparata 0:e7e920b85676 2939 status_t LSM6DSL_ACC_GYRO_R_DEN_LVL_EN(void *handle, LSM6DSL_ACC_GYRO_DEN_LVL_EN_t *value)
cparata 0:e7e920b85676 2940 {
cparata 0:e7e920b85676 2941 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, (u8_t *)value, 1) )
cparata 0:e7e920b85676 2942 return MEMS_ERROR;
cparata 0:e7e920b85676 2943
cparata 0:e7e920b85676 2944 *value &= LSM6DSL_ACC_GYRO_DEN_LVL_EN_MASK; //mask
cparata 0:e7e920b85676 2945
cparata 0:e7e920b85676 2946 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2947 }
cparata 0:e7e920b85676 2948 /*******************************************************************************
cparata 0:e7e920b85676 2949 * Function Name : LSM6DSL_ACC_GYRO_W_ExternalTrigger
cparata 0:e7e920b85676 2950 * Description : Write DEN_EDGE_EN
cparata 0:e7e920b85676 2951 * Input : LSM6DSL_ACC_GYRO_DEN_EDGE_EN_t
cparata 0:e7e920b85676 2952 * Output : None
cparata 0:e7e920b85676 2953 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2954 *******************************************************************************/
cparata 0:e7e920b85676 2955 status_t LSM6DSL_ACC_GYRO_W_ExternalTrigger(void *handle, LSM6DSL_ACC_GYRO_DEN_EDGE_EN_t newValue)
cparata 0:e7e920b85676 2956 {
cparata 0:e7e920b85676 2957 u8_t value;
cparata 0:e7e920b85676 2958
cparata 0:e7e920b85676 2959 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1) )
cparata 0:e7e920b85676 2960 return MEMS_ERROR;
cparata 0:e7e920b85676 2961
cparata 0:e7e920b85676 2962 value &= ~LSM6DSL_ACC_GYRO_DEN_EDGE_EN_MASK;
cparata 0:e7e920b85676 2963 value |= newValue;
cparata 0:e7e920b85676 2964
cparata 0:e7e920b85676 2965 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1) )
cparata 0:e7e920b85676 2966 return MEMS_ERROR;
cparata 0:e7e920b85676 2967
cparata 0:e7e920b85676 2968 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2969 }
cparata 0:e7e920b85676 2970
cparata 0:e7e920b85676 2971 /*******************************************************************************
cparata 0:e7e920b85676 2972 * Function Name : LSM6DSL_ACC_GYRO_R_ExternalTrigger
cparata 0:e7e920b85676 2973 * Description : Read DEN_EDGE_EN
cparata 0:e7e920b85676 2974 * Input : Pointer to LSM6DSL_ACC_GYRO_DEN_EDGE_EN_t
cparata 0:e7e920b85676 2975 * Output : Status of DEN_EDGE_EN see LSM6DSL_ACC_GYRO_DEN_EDGE_EN_t
cparata 0:e7e920b85676 2976 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2977 *******************************************************************************/
cparata 0:e7e920b85676 2978 status_t LSM6DSL_ACC_GYRO_R_ExternalTrigger(void *handle, LSM6DSL_ACC_GYRO_DEN_EDGE_EN_t *value)
cparata 0:e7e920b85676 2979 {
cparata 0:e7e920b85676 2980 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, (u8_t *)value, 1) )
cparata 0:e7e920b85676 2981 return MEMS_ERROR;
cparata 0:e7e920b85676 2982
cparata 0:e7e920b85676 2983 *value &= LSM6DSL_ACC_GYRO_DEN_EDGE_EN_MASK; //mask
cparata 0:e7e920b85676 2984
cparata 0:e7e920b85676 2985 return MEMS_SUCCESS;
cparata 0:e7e920b85676 2986 }
cparata 0:e7e920b85676 2987
cparata 0:e7e920b85676 2988 /*******************************************************************************
cparata 0:e7e920b85676 2989 * Function Name : LSM6DSL_ACC_GYRO_W_HPM_G
cparata 0:e7e920b85676 2990 * Description : Write HPM_G
cparata 0:e7e920b85676 2991 * Input : LSM6DSL_ACC_GYRO_HPM_G_t
cparata 0:e7e920b85676 2992 * Output : None
cparata 0:e7e920b85676 2993 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 2994 *******************************************************************************/
cparata 0:e7e920b85676 2995 status_t LSM6DSL_ACC_GYRO_W_HPM_G(void *handle, LSM6DSL_ACC_GYRO_HPM_G_t newValue)
cparata 0:e7e920b85676 2996 {
cparata 0:e7e920b85676 2997 u8_t value;
cparata 0:e7e920b85676 2998
cparata 0:e7e920b85676 2999 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:e7e920b85676 3000 return MEMS_ERROR;
cparata 0:e7e920b85676 3001
cparata 0:e7e920b85676 3002 value &= ~LSM6DSL_ACC_GYRO_HPM_G_MASK;
cparata 0:e7e920b85676 3003 value |= newValue;
cparata 0:e7e920b85676 3004
cparata 0:e7e920b85676 3005 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:e7e920b85676 3006 return MEMS_ERROR;
cparata 0:e7e920b85676 3007
cparata 0:e7e920b85676 3008 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3009 }
cparata 0:e7e920b85676 3010
cparata 0:e7e920b85676 3011 /*******************************************************************************
cparata 0:e7e920b85676 3012 * Function Name : LSM6DSL_ACC_GYRO_R_HPM_G
cparata 0:e7e920b85676 3013 * Description : Read HPM_G
cparata 0:e7e920b85676 3014 * Input : Pointer to LSM6DSL_ACC_GYRO_HPM_G_t
cparata 0:e7e920b85676 3015 * Output : Status of HPM_G see LSM6DSL_ACC_GYRO_HPM_G_t
cparata 0:e7e920b85676 3016 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3017 *******************************************************************************/
cparata 0:e7e920b85676 3018 status_t LSM6DSL_ACC_GYRO_R_HPM_G(void *handle, LSM6DSL_ACC_GYRO_HPM_G_t *value)
cparata 0:e7e920b85676 3019 {
cparata 0:e7e920b85676 3020 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, (u8_t *)value, 1) )
cparata 0:e7e920b85676 3021 return MEMS_ERROR;
cparata 0:e7e920b85676 3022
cparata 0:e7e920b85676 3023 *value &= LSM6DSL_ACC_GYRO_HPM_G_MASK; //mask
cparata 0:e7e920b85676 3024
cparata 0:e7e920b85676 3025 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3026 }
cparata 0:e7e920b85676 3027
cparata 0:e7e920b85676 3028 /*******************************************************************************
cparata 0:e7e920b85676 3029 * Function Name : LSM6DSL_ACC_GYRO_W_RoundingOnStatusRegisters
cparata 0:e7e920b85676 3030 * Description : Write HPM_G
cparata 0:e7e920b85676 3031 * Input : LSM6DSL_ACC_GYRO_RND_STATUS_t
cparata 0:e7e920b85676 3032 * Output : None
cparata 0:e7e920b85676 3033 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3034 *******************************************************************************/
cparata 0:e7e920b85676 3035 status_t LSM6DSL_ACC_GYRO_W_RoundingOnStatusRegisters(void *handle, LSM6DSL_ACC_GYRO_RND_STATUS_t newValue)
cparata 0:e7e920b85676 3036 {
cparata 0:e7e920b85676 3037 u8_t value;
cparata 0:e7e920b85676 3038
cparata 0:e7e920b85676 3039 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:e7e920b85676 3040 return MEMS_ERROR;
cparata 0:e7e920b85676 3041
cparata 0:e7e920b85676 3042 value &= ~LSM6DSL_ACC_GYRO_RND_STATUS_MASK;
cparata 0:e7e920b85676 3043 value |= newValue;
cparata 0:e7e920b85676 3044
cparata 0:e7e920b85676 3045 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:e7e920b85676 3046 return MEMS_ERROR;
cparata 0:e7e920b85676 3047
cparata 0:e7e920b85676 3048 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3049 }
cparata 0:e7e920b85676 3050
cparata 0:e7e920b85676 3051 /*******************************************************************************
cparata 0:e7e920b85676 3052 * Function Name : LSM6DSL_ACC_GYRO_R_RoundingOnStatusRegisters
cparata 0:e7e920b85676 3053 * Description : Read HPM_G
cparata 0:e7e920b85676 3054 * Input : Pointer to LSM6DSL_ACC_GYRO_RND_STATUS_t
cparata 0:e7e920b85676 3055 * Output : Status of HPM_G see LSM6DSL_ACC_GYRO_RND_STATUS_t
cparata 0:e7e920b85676 3056 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3057 *******************************************************************************/
cparata 0:e7e920b85676 3058 status_t LSM6DSL_ACC_GYRO_R_RoundingOnStatusRegisters(void *handle, LSM6DSL_ACC_GYRO_RND_STATUS_t *value)
cparata 0:e7e920b85676 3059 {
cparata 0:e7e920b85676 3060 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, (u8_t *)value, 1))
cparata 0:e7e920b85676 3061 return MEMS_ERROR;
cparata 0:e7e920b85676 3062
cparata 0:e7e920b85676 3063 *value &= LSM6DSL_ACC_GYRO_RND_STATUS_MASK; //mask
cparata 0:e7e920b85676 3064
cparata 0:e7e920b85676 3065 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3066 }
cparata 0:e7e920b85676 3067
cparata 0:e7e920b85676 3068 /*******************************************************************************
cparata 0:e7e920b85676 3069 * Function Name : LSM6DSL_ACC_GYRO_W_HPFilter_En
cparata 0:e7e920b85676 3070 * Description : Write HP_EN
cparata 0:e7e920b85676 3071 * Input : LSM6DSL_ACC_GYRO_HP_EN_t
cparata 0:e7e920b85676 3072 * Output : None
cparata 0:e7e920b85676 3073 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3074 *******************************************************************************/
cparata 0:e7e920b85676 3075 status_t LSM6DSL_ACC_GYRO_W_HPFilter_En(void *handle, LSM6DSL_ACC_GYRO_HP_EN_t newValue)
cparata 0:e7e920b85676 3076 {
cparata 0:e7e920b85676 3077 u8_t value;
cparata 0:e7e920b85676 3078
cparata 0:e7e920b85676 3079 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:e7e920b85676 3080 return MEMS_ERROR;
cparata 0:e7e920b85676 3081
cparata 0:e7e920b85676 3082 value &= ~LSM6DSL_ACC_GYRO_HP_EN_MASK;
cparata 0:e7e920b85676 3083 value |= newValue;
cparata 0:e7e920b85676 3084
cparata 0:e7e920b85676 3085 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:e7e920b85676 3086 return MEMS_ERROR;
cparata 0:e7e920b85676 3087
cparata 0:e7e920b85676 3088 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3089 }
cparata 0:e7e920b85676 3090
cparata 0:e7e920b85676 3091 /*******************************************************************************
cparata 0:e7e920b85676 3092 * Function Name : LSM6DSL_ACC_GYRO_R_HPFilter_En
cparata 0:e7e920b85676 3093 * Description : Read HP_EN
cparata 0:e7e920b85676 3094 * Input : Pointer to LSM6DSL_ACC_GYRO_HP_EN_t
cparata 0:e7e920b85676 3095 * Output : Status of HP_EN see LSM6DSL_ACC_GYRO_HP_EN_t
cparata 0:e7e920b85676 3096 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3097 *******************************************************************************/
cparata 0:e7e920b85676 3098 status_t LSM6DSL_ACC_GYRO_R_HPFilter_En(void *handle, LSM6DSL_ACC_GYRO_HP_EN_t *value)
cparata 0:e7e920b85676 3099 {
cparata 0:e7e920b85676 3100 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, (u8_t *)value, 1) )
cparata 0:e7e920b85676 3101 return MEMS_ERROR;
cparata 0:e7e920b85676 3102
cparata 0:e7e920b85676 3103 *value &= LSM6DSL_ACC_GYRO_HP_EN_MASK; //mask
cparata 0:e7e920b85676 3104
cparata 0:e7e920b85676 3105 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3106 }
cparata 0:e7e920b85676 3107 /*******************************************************************************
cparata 0:e7e920b85676 3108 * Function Name : LSM6DSL_ACC_GYRO_W_LP_Mode
cparata 0:e7e920b85676 3109 * Description : Write LP_EN
cparata 0:e7e920b85676 3110 * Input : LSM6DSL_ACC_GYRO_LP_EN_t
cparata 0:e7e920b85676 3111 * Output : None
cparata 0:e7e920b85676 3112 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3113 *******************************************************************************/
cparata 0:e7e920b85676 3114 status_t LSM6DSL_ACC_GYRO_W_LP_Mode(void *handle, LSM6DSL_ACC_GYRO_LP_EN_t newValue)
cparata 0:e7e920b85676 3115 {
cparata 0:e7e920b85676 3116 u8_t value;
cparata 0:e7e920b85676 3117
cparata 0:e7e920b85676 3118 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:e7e920b85676 3119 return MEMS_ERROR;
cparata 0:e7e920b85676 3120
cparata 0:e7e920b85676 3121 value &= ~LSM6DSL_ACC_GYRO_LP_EN_MASK;
cparata 0:e7e920b85676 3122 value |= newValue;
cparata 0:e7e920b85676 3123
cparata 0:e7e920b85676 3124 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:e7e920b85676 3125 return MEMS_ERROR;
cparata 0:e7e920b85676 3126
cparata 0:e7e920b85676 3127 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3128 }
cparata 0:e7e920b85676 3129
cparata 0:e7e920b85676 3130 /*******************************************************************************
cparata 0:e7e920b85676 3131 * Function Name : LSM6DSL_ACC_GYRO_R_LP_Mode
cparata 0:e7e920b85676 3132 * Description : Read LP_EN
cparata 0:e7e920b85676 3133 * Input : Pointer to LSM6DSL_ACC_GYRO_LP_EN_t
cparata 0:e7e920b85676 3134 * Output : Status of LP_EN see LSM6DSL_ACC_GYRO_LP_EN_t
cparata 0:e7e920b85676 3135 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3136 *******************************************************************************/
cparata 0:e7e920b85676 3137 status_t LSM6DSL_ACC_GYRO_R_LP_Mode(void *handle, LSM6DSL_ACC_GYRO_LP_EN_t *value)
cparata 0:e7e920b85676 3138 {
cparata 0:e7e920b85676 3139 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, (u8_t *)value, 1) )
cparata 0:e7e920b85676 3140 return MEMS_ERROR;
cparata 0:e7e920b85676 3141
cparata 0:e7e920b85676 3142 *value &= LSM6DSL_ACC_GYRO_LP_EN_MASK; //mask
cparata 0:e7e920b85676 3143
cparata 0:e7e920b85676 3144 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3145 }
cparata 0:e7e920b85676 3146
cparata 0:e7e920b85676 3147 /*******************************************************************************
cparata 0:e7e920b85676 3148 * Function Name : LSM6DSL_ACC_GYRO_W_ROUNDING_STATUS
cparata 0:e7e920b85676 3149 * Description : Write ROUNDING_STATUS
cparata 0:e7e920b85676 3150 * Input : LSM6DSL_ACC_GYRO_ROUNDING_STATUS_t
cparata 0:e7e920b85676 3151 * Output : None
cparata 0:e7e920b85676 3152 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3153 *******************************************************************************/
cparata 0:e7e920b85676 3154 status_t LSM6DSL_ACC_GYRO_W_ROUNDING_STATUS(void *handle, LSM6DSL_ACC_GYRO_ROUNDING_STATUS_t newValue)
cparata 0:e7e920b85676 3155 {
cparata 0:e7e920b85676 3156 u8_t value;
cparata 0:e7e920b85676 3157
cparata 0:e7e920b85676 3158 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:e7e920b85676 3159 return MEMS_ERROR;
cparata 0:e7e920b85676 3160
cparata 0:e7e920b85676 3161 value &= ~LSM6DSL_ACC_GYRO_ROUNDING_STATUS_MASK;
cparata 0:e7e920b85676 3162 value |= newValue;
cparata 0:e7e920b85676 3163
cparata 0:e7e920b85676 3164 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:e7e920b85676 3165 return MEMS_ERROR;
cparata 0:e7e920b85676 3166
cparata 0:e7e920b85676 3167 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3168 }
cparata 0:e7e920b85676 3169
cparata 0:e7e920b85676 3170 /*******************************************************************************
cparata 0:e7e920b85676 3171 * Function Name : LSM6DSL_ACC_GYRO_R_ROUNDING_STATUS
cparata 0:e7e920b85676 3172 * Description : Read ROUNDING_STATUS
cparata 0:e7e920b85676 3173 * Input : Pointer to LSM6DSL_ACC_GYRO_ROUNDING_STATUS_t
cparata 0:e7e920b85676 3174 * Output : Status of ROUNDING_STATUS see LSM6DSL_ACC_GYRO_ROUNDING_STATUS_t
cparata 0:e7e920b85676 3175 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3176 *******************************************************************************/
cparata 0:e7e920b85676 3177 status_t LSM6DSL_ACC_GYRO_R_ROUNDING_STATUS(void *handle, LSM6DSL_ACC_GYRO_ROUNDING_STATUS_t *value)
cparata 0:e7e920b85676 3178 {
cparata 0:e7e920b85676 3179 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, (u8_t *)value, 1) )
cparata 0:e7e920b85676 3180 return MEMS_ERROR;
cparata 0:e7e920b85676 3181
cparata 0:e7e920b85676 3182 *value &= LSM6DSL_ACC_GYRO_ROUNDING_STATUS_MASK; //mask
cparata 0:e7e920b85676 3183
cparata 0:e7e920b85676 3184 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3185 }
cparata 0:e7e920b85676 3186
cparata 0:e7e920b85676 3187 /*******************************************************************************
cparata 0:e7e920b85676 3188 * Function Name : LSM6DSL_ACC_GYRO_W_HP_G_RST
cparata 0:e7e920b85676 3189 * Description : Write HP_G_RST
cparata 0:e7e920b85676 3190 * Input : LSM6DSL_ACC_GYRO_HP_G_RST_t
cparata 0:e7e920b85676 3191 * Output : None
cparata 0:e7e920b85676 3192 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3193 *******************************************************************************/
cparata 0:e7e920b85676 3194 status_t LSM6DSL_ACC_GYRO_W_HP_G_RST(void *handle, LSM6DSL_ACC_GYRO_HP_G_RST_t newValue)
cparata 0:e7e920b85676 3195 {
cparata 0:e7e920b85676 3196 u8_t value;
cparata 0:e7e920b85676 3197
cparata 0:e7e920b85676 3198 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:e7e920b85676 3199 return MEMS_ERROR;
cparata 0:e7e920b85676 3200
cparata 0:e7e920b85676 3201 value &= ~LSM6DSL_ACC_GYRO_HP_G_RST_MASK;
cparata 0:e7e920b85676 3202 value |= newValue;
cparata 0:e7e920b85676 3203
cparata 0:e7e920b85676 3204 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:e7e920b85676 3205 return MEMS_ERROR;
cparata 0:e7e920b85676 3206
cparata 0:e7e920b85676 3207 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3208 }
cparata 0:e7e920b85676 3209
cparata 0:e7e920b85676 3210 /*******************************************************************************
cparata 0:e7e920b85676 3211 * Function Name : LSM6DSL_ACC_GYRO_R_HP_G_RST
cparata 0:e7e920b85676 3212 * Description : Read HP_G_RST
cparata 0:e7e920b85676 3213 * Input : Pointer to LSM6DSL_ACC_GYRO_HP_G_RST_t
cparata 0:e7e920b85676 3214 * Output : Status of HP_G_RST see LSM6DSL_ACC_GYRO_HP_G_RST_t
cparata 0:e7e920b85676 3215 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3216 *******************************************************************************/
cparata 0:e7e920b85676 3217 status_t LSM6DSL_ACC_GYRO_R_HP_G_RST(void *handle, LSM6DSL_ACC_GYRO_HP_G_RST_t *value)
cparata 0:e7e920b85676 3218 {
cparata 0:e7e920b85676 3219 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, (u8_t *)value, 1) )
cparata 0:e7e920b85676 3220 return MEMS_ERROR;
cparata 0:e7e920b85676 3221
cparata 0:e7e920b85676 3222 *value &= LSM6DSL_ACC_GYRO_HP_G_RST_MASK; //mask
cparata 0:e7e920b85676 3223
cparata 0:e7e920b85676 3224 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3225 }
cparata 0:e7e920b85676 3226
cparata 0:e7e920b85676 3227 /*******************************************************************************
cparata 0:e7e920b85676 3228 * Function Name : LSM6DSL_ACC_GYRO_W_InComposit
cparata 0:e7e920b85676 3229 * Description : Write INPUT_COMPOSITE
cparata 0:e7e920b85676 3230 * Input : LSM6DSL_ACC_GYRO_IN_COMP_t
cparata 0:e7e920b85676 3231 * Output : None
cparata 0:e7e920b85676 3232 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3233 *******************************************************************************/
cparata 0:e7e920b85676 3234 status_t LSM6DSL_ACC_GYRO_W_InComposit(void *handle, LSM6DSL_ACC_GYRO_IN_COMP_t newValue)
cparata 0:e7e920b85676 3235 {
cparata 0:e7e920b85676 3236 u8_t value;
cparata 0:e7e920b85676 3237
cparata 0:e7e920b85676 3238 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:e7e920b85676 3239 return MEMS_ERROR;
cparata 0:e7e920b85676 3240
cparata 0:e7e920b85676 3241 value &= ~LSM6DSL_ACC_GYRO_IN_COMP_MASK;
cparata 0:e7e920b85676 3242 value |= newValue;
cparata 0:e7e920b85676 3243
cparata 0:e7e920b85676 3244 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:e7e920b85676 3245 return MEMS_ERROR;
cparata 0:e7e920b85676 3246
cparata 0:e7e920b85676 3247 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3248 }
cparata 0:e7e920b85676 3249
cparata 0:e7e920b85676 3250 /*******************************************************************************
cparata 0:e7e920b85676 3251 * Function Name : LSM6DSL_ACC_GYRO_R_InComposit
cparata 0:e7e920b85676 3252 * Description : Read INPUT_COMPOSITE
cparata 0:e7e920b85676 3253 * Input : Pointer to LSM6DSL_ACC_GYRO_IN_COMP_t
cparata 0:e7e920b85676 3254 * Output : Status of INPUT_COMPOSITE see LSM6DSL_ACC_GYRO_IN_COMP_t
cparata 0:e7e920b85676 3255 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3256 *******************************************************************************/
cparata 0:e7e920b85676 3257 status_t LSM6DSL_ACC_GYRO_R_InComposit(void *handle, LSM6DSL_ACC_GYRO_IN_COMP_t *value)
cparata 0:e7e920b85676 3258 {
cparata 0:e7e920b85676 3259 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, (u8_t *)value, 1) )
cparata 0:e7e920b85676 3260 return MEMS_ERROR;
cparata 0:e7e920b85676 3261
cparata 0:e7e920b85676 3262 *value &= LSM6DSL_ACC_GYRO_IN_COMP_MASK; //mask
cparata 0:e7e920b85676 3263
cparata 0:e7e920b85676 3264 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3265 }
cparata 0:e7e920b85676 3266
cparata 0:e7e920b85676 3267 /*******************************************************************************
cparata 0:e7e920b85676 3268 * Function Name : LSM6DSL_ACC_GYRO_W_HPfilterReference
cparata 0:e7e920b85676 3269 * Description : Write HP_REF_MODE
cparata 0:e7e920b85676 3270 * Input : LSM6DSL_ACC_GYRO_HP_REF_MODE_t
cparata 0:e7e920b85676 3271 * Output : None
cparata 0:e7e920b85676 3272 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3273 *******************************************************************************/
cparata 0:e7e920b85676 3274 status_t LSM6DSL_ACC_GYRO_W_HPfilterReference(void *handle, LSM6DSL_ACC_GYRO_HP_REF_MODE_t newValue)
cparata 0:e7e920b85676 3275 {
cparata 0:e7e920b85676 3276 u8_t value;
cparata 0:e7e920b85676 3277
cparata 0:e7e920b85676 3278 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:e7e920b85676 3279 return MEMS_ERROR;
cparata 0:e7e920b85676 3280
cparata 0:e7e920b85676 3281 value &= ~LSM6DSL_ACC_GYRO_HP_REF_MODE_MASK;
cparata 0:e7e920b85676 3282 value |= newValue;
cparata 0:e7e920b85676 3283
cparata 0:e7e920b85676 3284 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:e7e920b85676 3285 return MEMS_ERROR;
cparata 0:e7e920b85676 3286
cparata 0:e7e920b85676 3287 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3288 }
cparata 0:e7e920b85676 3289
cparata 0:e7e920b85676 3290 /*******************************************************************************
cparata 0:e7e920b85676 3291 * Function Name : LSM6DSL_ACC_GYRO_R_HPfilterReference
cparata 0:e7e920b85676 3292 * Description : Read HP_REF_MODE
cparata 0:e7e920b85676 3293 * Input : Pointer to LSM6DSL_ACC_GYRO_HP_REF_MODE_t
cparata 0:e7e920b85676 3294 * Output : Status of HP_REF_MODE see LSM6DSL_ACC_GYRO_HP_REF_MODE_t
cparata 0:e7e920b85676 3295 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3296 *******************************************************************************/
cparata 0:e7e920b85676 3297 status_t LSM6DSL_ACC_GYRO_R_HPfilterReference(void *handle, LSM6DSL_ACC_GYRO_HP_REF_MODE_t *value)
cparata 0:e7e920b85676 3298 {
cparata 0:e7e920b85676 3299 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, (u8_t *)value, 1) )
cparata 0:e7e920b85676 3300 return MEMS_ERROR;
cparata 0:e7e920b85676 3301
cparata 0:e7e920b85676 3302 *value &= LSM6DSL_ACC_GYRO_HP_REF_MODE_MASK; //mask
cparata 0:e7e920b85676 3303
cparata 0:e7e920b85676 3304 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3305 }
cparata 0:e7e920b85676 3306
cparata 0:e7e920b85676 3307 /*******************************************************************************
cparata 0:e7e920b85676 3308 * Function Name : LSM6DSL_ACC_GYRO_W_HPCF_XL
cparata 0:e7e920b85676 3309 * Description : Write HPCF_XL
cparata 0:e7e920b85676 3310 * Input : LSM6DSL_ACC_GYRO_HPCF_XL_t
cparata 0:e7e920b85676 3311 * Output : None
cparata 0:e7e920b85676 3312 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3313 *******************************************************************************/
cparata 0:e7e920b85676 3314 status_t LSM6DSL_ACC_GYRO_W_HPCF_XL(void *handle, LSM6DSL_ACC_GYRO_HPCF_XL_t newValue)
cparata 0:e7e920b85676 3315 {
cparata 0:e7e920b85676 3316 u8_t value;
cparata 0:e7e920b85676 3317
cparata 0:e7e920b85676 3318 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:e7e920b85676 3319 return MEMS_ERROR;
cparata 0:e7e920b85676 3320
cparata 0:e7e920b85676 3321 value &= ~LSM6DSL_ACC_GYRO_HPCF_XL_MASK;
cparata 0:e7e920b85676 3322 value |= newValue;
cparata 0:e7e920b85676 3323
cparata 0:e7e920b85676 3324 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:e7e920b85676 3325 return MEMS_ERROR;
cparata 0:e7e920b85676 3326
cparata 0:e7e920b85676 3327 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3328 }
cparata 0:e7e920b85676 3329
cparata 0:e7e920b85676 3330 /*******************************************************************************
cparata 0:e7e920b85676 3331 * Function Name : LSM6DSL_ACC_GYRO_R_HPCF_XL
cparata 0:e7e920b85676 3332 * Description : Read HPCF_XL
cparata 0:e7e920b85676 3333 * Input : Pointer to LSM6DSL_ACC_GYRO_HPCF_XL_t
cparata 0:e7e920b85676 3334 * Output : Status of HPCF_XL see LSM6DSL_ACC_GYRO_HPCF_XL_t
cparata 0:e7e920b85676 3335 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3336 *******************************************************************************/
cparata 0:e7e920b85676 3337 status_t LSM6DSL_ACC_GYRO_R_HPCF_XL(void *handle, LSM6DSL_ACC_GYRO_HPCF_XL_t *value)
cparata 0:e7e920b85676 3338 {
cparata 0:e7e920b85676 3339 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, (u8_t *)value, 1) )
cparata 0:e7e920b85676 3340 return MEMS_ERROR;
cparata 0:e7e920b85676 3341
cparata 0:e7e920b85676 3342 *value &= LSM6DSL_ACC_GYRO_HPCF_XL_MASK; //mask
cparata 0:e7e920b85676 3343
cparata 0:e7e920b85676 3344 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3345 }
cparata 0:e7e920b85676 3346
cparata 0:e7e920b85676 3347 /*******************************************************************************
cparata 0:e7e920b85676 3348 * Function Name : LSM6DSL_ACC_GYRO_W_LowPassFiltSel_XL
cparata 0:e7e920b85676 3349 * Description : Write LPF2_XL_EN
cparata 0:e7e920b85676 3350 * Input : LSM6DSL_ACC_GYRO_LPF2_XL_t
cparata 0:e7e920b85676 3351 * Output : None
cparata 0:e7e920b85676 3352 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3353 *******************************************************************************/
cparata 0:e7e920b85676 3354 status_t LSM6DSL_ACC_GYRO_W_LowPassFiltSel_XL(void *handle, LSM6DSL_ACC_GYRO_LPF2_XL_t newValue)
cparata 0:e7e920b85676 3355 {
cparata 0:e7e920b85676 3356 u8_t value;
cparata 0:e7e920b85676 3357
cparata 0:e7e920b85676 3358 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:e7e920b85676 3359 return MEMS_ERROR;
cparata 0:e7e920b85676 3360
cparata 0:e7e920b85676 3361 value &= ~LSM6DSL_ACC_GYRO_LPF2_XL_MASK;
cparata 0:e7e920b85676 3362 value |= newValue;
cparata 0:e7e920b85676 3363
cparata 0:e7e920b85676 3364 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:e7e920b85676 3365 return MEMS_ERROR;
cparata 0:e7e920b85676 3366
cparata 0:e7e920b85676 3367 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3368 }
cparata 0:e7e920b85676 3369
cparata 0:e7e920b85676 3370 /*******************************************************************************
cparata 0:e7e920b85676 3371 * Function Name : LSM6DSL_ACC_GYRO_R_LowPassFiltSel_XL
cparata 0:e7e920b85676 3372 * Description : Read LPF2_XL_EN
cparata 0:e7e920b85676 3373 * Input : Pointer to LSM6DSL_ACC_GYRO_LPF2_XL_t
cparata 0:e7e920b85676 3374 * Output : Status of LPF2_XL_EN see LSM6DSL_ACC_GYRO_LPF2_XL_t
cparata 0:e7e920b85676 3375 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3376 *******************************************************************************/
cparata 0:e7e920b85676 3377 status_t LSM6DSL_ACC_GYRO_R_LowPassFiltSel_XL(void *handle, LSM6DSL_ACC_GYRO_LPF2_XL_t *value)
cparata 0:e7e920b85676 3378 {
cparata 0:e7e920b85676 3379 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, (u8_t *)value, 1) )
cparata 0:e7e920b85676 3380 return MEMS_ERROR;
cparata 0:e7e920b85676 3381
cparata 0:e7e920b85676 3382 *value &= LSM6DSL_ACC_GYRO_LPF2_XL_MASK; //mask
cparata 0:e7e920b85676 3383
cparata 0:e7e920b85676 3384 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3385 }
cparata 0:e7e920b85676 3386
cparata 0:e7e920b85676 3387 /*******************************************************************************
cparata 0:e7e920b85676 3388 * Function Name : LSM6DSL_ACC_GYRO_W_LOW_PASS_ON_6D
cparata 0:e7e920b85676 3389 * Description : Write LOW_PASS_ON_6D
cparata 0:e7e920b85676 3390 * Input : LSM6DSL_ACC_GYRO_LOW_PASS_ON_6D_t
cparata 0:e7e920b85676 3391 * Output : None
cparata 0:e7e920b85676 3392 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3393 *******************************************************************************/
cparata 0:e7e920b85676 3394 status_t LSM6DSL_ACC_GYRO_W_LOW_PASS_ON_6D(void *handle, LSM6DSL_ACC_GYRO_LOW_PASS_ON_6D_t newValue)
cparata 0:e7e920b85676 3395 {
cparata 0:e7e920b85676 3396 u8_t value;
cparata 0:e7e920b85676 3397
cparata 0:e7e920b85676 3398 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:e7e920b85676 3399 return MEMS_ERROR;
cparata 0:e7e920b85676 3400
cparata 0:e7e920b85676 3401 value &= ~LSM6DSL_ACC_GYRO_LOW_PASS_ON_6D_MASK;
cparata 0:e7e920b85676 3402 value |= newValue;
cparata 0:e7e920b85676 3403
cparata 0:e7e920b85676 3404 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:e7e920b85676 3405 return MEMS_ERROR;
cparata 0:e7e920b85676 3406
cparata 0:e7e920b85676 3407 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3408 }
cparata 0:e7e920b85676 3409
cparata 0:e7e920b85676 3410 /*******************************************************************************
cparata 0:e7e920b85676 3411 * Function Name : LSM6DSL_ACC_GYRO_R_LOW_PASS_ON_6D
cparata 0:e7e920b85676 3412 * Description : Read LOW_PASS_ON_6D
cparata 0:e7e920b85676 3413 * Input : Pointer to LSM6DSL_ACC_GYRO_LOW_PASS_ON_6D_t
cparata 0:e7e920b85676 3414 * Output : Status of LOW_PASS_ON_6D see LSM6DSL_ACC_GYRO_LOW_PASS_ON_6D_t
cparata 0:e7e920b85676 3415 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3416 *******************************************************************************/
cparata 0:e7e920b85676 3417 status_t LSM6DSL_ACC_GYRO_R_LOW_PASS_ON_6D(void *handle, LSM6DSL_ACC_GYRO_LOW_PASS_ON_6D_t *value)
cparata 0:e7e920b85676 3418 {
cparata 0:e7e920b85676 3419 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, (u8_t *)value, 1) )
cparata 0:e7e920b85676 3420 return MEMS_ERROR;
cparata 0:e7e920b85676 3421
cparata 0:e7e920b85676 3422 *value &= LSM6DSL_ACC_GYRO_LOW_PASS_ON_6D_MASK; //mask
cparata 0:e7e920b85676 3423
cparata 0:e7e920b85676 3424 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3425 }
cparata 0:e7e920b85676 3426
cparata 0:e7e920b85676 3427 /*******************************************************************************
cparata 0:e7e920b85676 3428 * Function Name : LSM6DSL_ACC_GYRO_W_HP_SLOPE_XL
cparata 0:e7e920b85676 3429 * Description : Write HP_SLOPE_XL_EN
cparata 0:e7e920b85676 3430 * Input : LSM6DSL_ACC_GYRO_HP_SLOPE_XL_t
cparata 0:e7e920b85676 3431 * Output : None
cparata 0:e7e920b85676 3432 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3433 *******************************************************************************/
cparata 0:e7e920b85676 3434 status_t LSM6DSL_ACC_GYRO_W_HP_SLOPE_XL(void *handle, LSM6DSL_ACC_GYRO_HP_SLOPE_XL_t newValue)
cparata 0:e7e920b85676 3435 {
cparata 0:e7e920b85676 3436 u8_t value;
cparata 0:e7e920b85676 3437
cparata 0:e7e920b85676 3438 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:e7e920b85676 3439 return MEMS_ERROR;
cparata 0:e7e920b85676 3440
cparata 0:e7e920b85676 3441 value &= ~LSM6DSL_ACC_GYRO_HP_SLOPE_XL_MASK;
cparata 0:e7e920b85676 3442 value |= newValue;
cparata 0:e7e920b85676 3443
cparata 0:e7e920b85676 3444 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:e7e920b85676 3445 return MEMS_ERROR;
cparata 0:e7e920b85676 3446
cparata 0:e7e920b85676 3447 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3448 }
cparata 0:e7e920b85676 3449
cparata 0:e7e920b85676 3450 /*******************************************************************************
cparata 0:e7e920b85676 3451 * Function Name : LSM6DSL_ACC_GYRO_R_HP_SLOPE_XL
cparata 0:e7e920b85676 3452 * Description : Read HP_SLOPE_XL_EN
cparata 0:e7e920b85676 3453 * Input : Pointer to LSM6DSL_ACC_GYRO_HP_SLOPE_XL_t
cparata 0:e7e920b85676 3454 * Output : Status of HP_SLOPE_XL_EN see LSM6DSL_ACC_GYRO_HP_SLOPE_XL_t
cparata 0:e7e920b85676 3455 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3456 *******************************************************************************/
cparata 0:e7e920b85676 3457 status_t LSM6DSL_ACC_GYRO_R_HP_SLOPE_XL(void *handle, LSM6DSL_ACC_GYRO_HP_SLOPE_XL_t *value)
cparata 0:e7e920b85676 3458 {
cparata 0:e7e920b85676 3459 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, (u8_t *)value, 1) )
cparata 0:e7e920b85676 3460 return MEMS_ERROR;
cparata 0:e7e920b85676 3461
cparata 0:e7e920b85676 3462 *value &= LSM6DSL_ACC_GYRO_HP_SLOPE_XL_MASK; //mask
cparata 0:e7e920b85676 3463
cparata 0:e7e920b85676 3464 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3465 }
cparata 0:e7e920b85676 3466
cparata 0:e7e920b85676 3467 /*******************************************************************************
cparata 0:e7e920b85676 3468 * Function Name : LSM6DSL_ACC_GYRO_W_SOFT
cparata 0:e7e920b85676 3469 * Description : Write SOFT_EN
cparata 0:e7e920b85676 3470 * Input : LSM6DSL_ACC_GYRO_SOFT_t
cparata 0:e7e920b85676 3471 * Output : None
cparata 0:e7e920b85676 3472 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3473 *******************************************************************************/
cparata 0:e7e920b85676 3474 status_t LSM6DSL_ACC_GYRO_W_SOFT(void *handle, LSM6DSL_ACC_GYRO_SOFT_t newValue)
cparata 0:e7e920b85676 3475 {
cparata 0:e7e920b85676 3476 u8_t value;
cparata 0:e7e920b85676 3477
cparata 0:e7e920b85676 3478 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL9_XL, &value, 1) )
cparata 0:e7e920b85676 3479 return MEMS_ERROR;
cparata 0:e7e920b85676 3480
cparata 0:e7e920b85676 3481 value &= ~LSM6DSL_ACC_GYRO_SOFT_MASK;
cparata 0:e7e920b85676 3482 value |= newValue;
cparata 0:e7e920b85676 3483
cparata 0:e7e920b85676 3484 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL9_XL, &value, 1) )
cparata 0:e7e920b85676 3485 return MEMS_ERROR;
cparata 0:e7e920b85676 3486
cparata 0:e7e920b85676 3487 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3488 }
cparata 0:e7e920b85676 3489
cparata 0:e7e920b85676 3490 /*******************************************************************************
cparata 0:e7e920b85676 3491 * Function Name : LSM6DSL_ACC_GYRO_R_SOFT
cparata 0:e7e920b85676 3492 * Description : Read SOFT_EN
cparata 0:e7e920b85676 3493 * Input : Pointer to LSM6DSL_ACC_GYRO_SOFT_t
cparata 0:e7e920b85676 3494 * Output : Status of SOFT_EN see LSM6DSL_ACC_GYRO_SOFT_t
cparata 0:e7e920b85676 3495 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3496 *******************************************************************************/
cparata 0:e7e920b85676 3497 status_t LSM6DSL_ACC_GYRO_R_SOFT(void *handle, LSM6DSL_ACC_GYRO_SOFT_t *value)
cparata 0:e7e920b85676 3498 {
cparata 0:e7e920b85676 3499 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL9_XL, (u8_t *)value, 1) )
cparata 0:e7e920b85676 3500 return MEMS_ERROR;
cparata 0:e7e920b85676 3501
cparata 0:e7e920b85676 3502 *value &= LSM6DSL_ACC_GYRO_SOFT_MASK; //mask
cparata 0:e7e920b85676 3503
cparata 0:e7e920b85676 3504 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3505 }
cparata 0:e7e920b85676 3506
cparata 0:e7e920b85676 3507 /*******************************************************************************
cparata 0:e7e920b85676 3508 * Function Name : LSM6DSL_ACC_GYRO_W_SignifcantMotion
cparata 0:e7e920b85676 3509 * Description : Write SIGN_MOTION_EN
cparata 0:e7e920b85676 3510 * Input : LSM6DSL_ACC_GYRO_SIGN_MOTION_EN_t
cparata 0:e7e920b85676 3511 * Output : None
cparata 0:e7e920b85676 3512 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3513 *******************************************************************************/
cparata 0:e7e920b85676 3514 status_t LSM6DSL_ACC_GYRO_W_SignifcantMotion(void *handle, LSM6DSL_ACC_GYRO_SIGN_MOTION_EN_t newValue)
cparata 0:e7e920b85676 3515 {
cparata 0:e7e920b85676 3516 u8_t value;
cparata 0:e7e920b85676 3517
cparata 0:e7e920b85676 3518 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:e7e920b85676 3519 return MEMS_ERROR;
cparata 0:e7e920b85676 3520
cparata 0:e7e920b85676 3521 value &= ~LSM6DSL_ACC_GYRO_SIGN_MOTION_EN_MASK;
cparata 0:e7e920b85676 3522 value |= newValue;
cparata 0:e7e920b85676 3523
cparata 0:e7e920b85676 3524 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:e7e920b85676 3525 return MEMS_ERROR;
cparata 0:e7e920b85676 3526
cparata 0:e7e920b85676 3527 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3528 }
cparata 0:e7e920b85676 3529
cparata 0:e7e920b85676 3530 /*******************************************************************************
cparata 0:e7e920b85676 3531 * Function Name : LSM6DSL_ACC_GYRO_R_SignifcantMotion
cparata 0:e7e920b85676 3532 * Description : Read SIGN_MOTION_EN
cparata 0:e7e920b85676 3533 * Input : Pointer to LSM6DSL_ACC_GYRO_SIGN_MOTION_EN_t
cparata 0:e7e920b85676 3534 * Output : Status of SIGN_MOTION_EN see LSM6DSL_ACC_GYRO_SIGN_MOTION_EN_t
cparata 0:e7e920b85676 3535 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3536 *******************************************************************************/
cparata 0:e7e920b85676 3537 status_t LSM6DSL_ACC_GYRO_R_SignifcantMotion(void *handle, LSM6DSL_ACC_GYRO_SIGN_MOTION_EN_t *value)
cparata 0:e7e920b85676 3538 {
cparata 0:e7e920b85676 3539 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, (u8_t *)value, 1) )
cparata 0:e7e920b85676 3540 return MEMS_ERROR;
cparata 0:e7e920b85676 3541
cparata 0:e7e920b85676 3542 *value &= LSM6DSL_ACC_GYRO_SIGN_MOTION_EN_MASK; //mask
cparata 0:e7e920b85676 3543
cparata 0:e7e920b85676 3544 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3545 }
cparata 0:e7e920b85676 3546 /*******************************************************************************
cparata 0:e7e920b85676 3547 * Function Name : LSM6DSL_ACC_GYRO_W_PedoStepReset
cparata 0:e7e920b85676 3548 * Description : Write PEDO_RST_STEP
cparata 0:e7e920b85676 3549 * Input : LSM6DSL_ACC_GYRO_PEDO_RST_STEP_t
cparata 0:e7e920b85676 3550 * Output : None
cparata 0:e7e920b85676 3551 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3552 *******************************************************************************/
cparata 0:e7e920b85676 3553 status_t LSM6DSL_ACC_GYRO_W_PedoStepReset(void *handle, LSM6DSL_ACC_GYRO_PEDO_RST_STEP_t newValue)
cparata 0:e7e920b85676 3554 {
cparata 0:e7e920b85676 3555 u8_t value;
cparata 0:e7e920b85676 3556
cparata 0:e7e920b85676 3557 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:e7e920b85676 3558 return MEMS_ERROR;
cparata 0:e7e920b85676 3559
cparata 0:e7e920b85676 3560 value &= ~LSM6DSL_ACC_GYRO_PEDO_RST_STEP_MASK;
cparata 0:e7e920b85676 3561 value |= newValue;
cparata 0:e7e920b85676 3562
cparata 0:e7e920b85676 3563 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:e7e920b85676 3564 return MEMS_ERROR;
cparata 0:e7e920b85676 3565
cparata 0:e7e920b85676 3566 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3567 }
cparata 0:e7e920b85676 3568
cparata 0:e7e920b85676 3569 /*******************************************************************************
cparata 0:e7e920b85676 3570 * Function Name : LSM6DSL_ACC_GYRO_R_PedoStepReset
cparata 0:e7e920b85676 3571 * Description : Read PEDO_RST_STEP
cparata 0:e7e920b85676 3572 * Input : Pointer to LSM6DSL_ACC_GYRO_PEDO_RST_STEP_t
cparata 0:e7e920b85676 3573 * Output : Status of PEDO_RST_STEP see LSM6DSL_ACC_GYRO_PEDO_RST_STEP_t
cparata 0:e7e920b85676 3574 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3575 *******************************************************************************/
cparata 0:e7e920b85676 3576 status_t LSM6DSL_ACC_GYRO_R_PedoStepReset(void *handle, LSM6DSL_ACC_GYRO_PEDO_RST_STEP_t *value)
cparata 0:e7e920b85676 3577 {
cparata 0:e7e920b85676 3578 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, (u8_t *)value, 1) )
cparata 0:e7e920b85676 3579 return MEMS_ERROR;
cparata 0:e7e920b85676 3580
cparata 0:e7e920b85676 3581 *value &= LSM6DSL_ACC_GYRO_PEDO_RST_STEP_MASK; //mask
cparata 0:e7e920b85676 3582
cparata 0:e7e920b85676 3583 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3584 }
cparata 0:e7e920b85676 3585 /*******************************************************************************
cparata 0:e7e920b85676 3586 * Function Name : LSM6DSL_ACC_GYRO_W_TILT
cparata 0:e7e920b85676 3587 * Description : Write XEN_G
cparata 0:e7e920b85676 3588 * Input : LSM6DSL_ACC_GYRO_TILT_G_t
cparata 0:e7e920b85676 3589 * Output : None
cparata 0:e7e920b85676 3590 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3591 *******************************************************************************/
cparata 0:e7e920b85676 3592 status_t LSM6DSL_ACC_GYRO_W_TILT(void *handle, LSM6DSL_ACC_GYRO_TILT_G_t newValue)
cparata 0:e7e920b85676 3593 {
cparata 0:e7e920b85676 3594 u8_t value;
cparata 0:e7e920b85676 3595
cparata 0:e7e920b85676 3596 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:e7e920b85676 3597 return MEMS_ERROR;
cparata 0:e7e920b85676 3598
cparata 0:e7e920b85676 3599 value &= ~LSM6DSL_ACC_GYRO_TILT_MASK;
cparata 0:e7e920b85676 3600 value |= newValue;
cparata 0:e7e920b85676 3601
cparata 0:e7e920b85676 3602 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:e7e920b85676 3603 return MEMS_ERROR;
cparata 0:e7e920b85676 3604
cparata 0:e7e920b85676 3605 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3606 }
cparata 0:e7e920b85676 3607
cparata 0:e7e920b85676 3608 /*******************************************************************************
cparata 0:e7e920b85676 3609 * Function Name : LSM6DSL_ACC_GYRO_R_TILT
cparata 0:e7e920b85676 3610 * Description : Read XEN_G
cparata 0:e7e920b85676 3611 * Input : Pointer to LSM6DSL_ACC_GYRO_TILT_G_t
cparata 0:e7e920b85676 3612 * Output : Status of XEN_G see LSM6DSL_ACC_GYRO_TILT_G_t
cparata 0:e7e920b85676 3613 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3614 *******************************************************************************/
cparata 0:e7e920b85676 3615 status_t LSM6DSL_ACC_GYRO_R_TILT(void *handle, LSM6DSL_ACC_GYRO_TILT_G_t *value)
cparata 0:e7e920b85676 3616 {
cparata 0:e7e920b85676 3617 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, (u8_t *)value, 1) )
cparata 0:e7e920b85676 3618 return MEMS_ERROR;
cparata 0:e7e920b85676 3619
cparata 0:e7e920b85676 3620 *value &= LSM6DSL_ACC_GYRO_TILT_MASK; //mask
cparata 0:e7e920b85676 3621
cparata 0:e7e920b85676 3622 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3623 }
cparata 0:e7e920b85676 3624 /*******************************************************************************
cparata 0:e7e920b85676 3625 * Function Name : LSM6DSL_ACC_GYRO_W_PEDO
cparata 0:e7e920b85676 3626 * Description : Write PEDO_EN
cparata 0:e7e920b85676 3627 * Input : LSM6DSL_ACC_GYRO_PEDO_t
cparata 0:e7e920b85676 3628 * Output : None
cparata 0:e7e920b85676 3629 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3630 *******************************************************************************/
cparata 0:e7e920b85676 3631 status_t LSM6DSL_ACC_GYRO_W_PEDO(void *handle, LSM6DSL_ACC_GYRO_PEDO_t newValue)
cparata 0:e7e920b85676 3632 {
cparata 0:e7e920b85676 3633 u8_t value;
cparata 0:e7e920b85676 3634
cparata 0:e7e920b85676 3635 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:e7e920b85676 3636 return MEMS_ERROR;
cparata 0:e7e920b85676 3637
cparata 0:e7e920b85676 3638 value &= ~LSM6DSL_ACC_GYRO_PEDO_MASK;
cparata 0:e7e920b85676 3639 value |= newValue;
cparata 0:e7e920b85676 3640
cparata 0:e7e920b85676 3641 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:e7e920b85676 3642 return MEMS_ERROR;
cparata 0:e7e920b85676 3643
cparata 0:e7e920b85676 3644 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3645 }
cparata 0:e7e920b85676 3646
cparata 0:e7e920b85676 3647 /*******************************************************************************
cparata 0:e7e920b85676 3648 * Function Name : LSM6DSL_ACC_GYRO_R_PEDO
cparata 0:e7e920b85676 3649 * Description : Read PEDO_EN
cparata 0:e7e920b85676 3650 * Input : Pointer to LSM6DSL_ACC_GYRO_PEDO_t
cparata 0:e7e920b85676 3651 * Output : Status of PEDO_EN see LSM6DSL_ACC_GYRO_PEDO_t
cparata 0:e7e920b85676 3652 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3653 *******************************************************************************/
cparata 0:e7e920b85676 3654 status_t LSM6DSL_ACC_GYRO_R_PEDO(void *handle, LSM6DSL_ACC_GYRO_PEDO_t *value)
cparata 0:e7e920b85676 3655 {
cparata 0:e7e920b85676 3656 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, (u8_t *)value, 1) )
cparata 0:e7e920b85676 3657 return MEMS_ERROR;
cparata 0:e7e920b85676 3658
cparata 0:e7e920b85676 3659 *value &= LSM6DSL_ACC_GYRO_PEDO_MASK; //mask
cparata 0:e7e920b85676 3660
cparata 0:e7e920b85676 3661 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3662 }
cparata 0:e7e920b85676 3663
cparata 0:e7e920b85676 3664 /*******************************************************************************
cparata 0:e7e920b85676 3665 * Function Name : LSM6DSL_ACC_GYRO_W_TIMER
cparata 0:e7e920b85676 3666 * Description : Write TIMER_EN
cparata 0:e7e920b85676 3667 * Input : LSM6DSL_ACC_GYRO_TIMER_t
cparata 0:e7e920b85676 3668 * Output : None
cparata 0:e7e920b85676 3669 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3670 *******************************************************************************/
cparata 0:e7e920b85676 3671 status_t LSM6DSL_ACC_GYRO_W_TIMER(void *handle, LSM6DSL_ACC_GYRO_TIMER_t newValue)
cparata 0:e7e920b85676 3672 {
cparata 0:e7e920b85676 3673 u8_t value;
cparata 0:e7e920b85676 3674
cparata 0:e7e920b85676 3675 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:e7e920b85676 3676 return MEMS_ERROR;
cparata 0:e7e920b85676 3677
cparata 0:e7e920b85676 3678 value &= ~LSM6DSL_ACC_GYRO_TIMER_MASK;
cparata 0:e7e920b85676 3679 value |= newValue;
cparata 0:e7e920b85676 3680
cparata 0:e7e920b85676 3681 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:e7e920b85676 3682 return MEMS_ERROR;
cparata 0:e7e920b85676 3683
cparata 0:e7e920b85676 3684 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3685 }
cparata 0:e7e920b85676 3686
cparata 0:e7e920b85676 3687 /*******************************************************************************
cparata 0:e7e920b85676 3688 * Function Name : LSM6DSL_ACC_GYRO_R_TIMER
cparata 0:e7e920b85676 3689 * Description : Read TIMER_EN
cparata 0:e7e920b85676 3690 * Input : Pointer to LSM6DSL_ACC_GYRO_TIMER_t
cparata 0:e7e920b85676 3691 * Output : Status of TIMER_EN see LSM6DSL_ACC_GYRO_TIMER_t
cparata 0:e7e920b85676 3692 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3693 *******************************************************************************/
cparata 0:e7e920b85676 3694 status_t LSM6DSL_ACC_GYRO_R_TIMER(void *handle, LSM6DSL_ACC_GYRO_TIMER_t *value)
cparata 0:e7e920b85676 3695 {
cparata 0:e7e920b85676 3696 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, (u8_t *)value, 1) )
cparata 0:e7e920b85676 3697 return MEMS_ERROR;
cparata 0:e7e920b85676 3698
cparata 0:e7e920b85676 3699 *value &= LSM6DSL_ACC_GYRO_TIMER_MASK; //mask
cparata 0:e7e920b85676 3700
cparata 0:e7e920b85676 3701 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3702 }
cparata 0:e7e920b85676 3703
cparata 0:e7e920b85676 3704 /*******************************************************************************
cparata 0:e7e920b85676 3705 * Function Name : LSM6DSL_ACC_GYRO_W_FUNC_EN
cparata 0:e7e920b85676 3706 * Description : Write FUNC_EN
cparata 0:e7e920b85676 3707 * Input : LSM6DSL_ACC_GYRO_FUNC_EN_t
cparata 0:e7e920b85676 3708 * Output : None
cparata 0:e7e920b85676 3709 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3710 *******************************************************************************/
cparata 0:e7e920b85676 3711 status_t LSM6DSL_ACC_GYRO_W_FUNC_EN(void *handle, LSM6DSL_ACC_GYRO_FUNC_EN_t newValue)
cparata 0:e7e920b85676 3712 {
cparata 0:e7e920b85676 3713 u8_t value;
cparata 0:e7e920b85676 3714
cparata 0:e7e920b85676 3715 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:e7e920b85676 3716 return MEMS_ERROR;
cparata 0:e7e920b85676 3717
cparata 0:e7e920b85676 3718 value &= ~LSM6DSL_ACC_GYRO_FUNC_EN_MASK;
cparata 0:e7e920b85676 3719 value |= newValue;
cparata 0:e7e920b85676 3720
cparata 0:e7e920b85676 3721 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:e7e920b85676 3722 return MEMS_ERROR;
cparata 0:e7e920b85676 3723
cparata 0:e7e920b85676 3724 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3725 }
cparata 0:e7e920b85676 3726
cparata 0:e7e920b85676 3727 /*******************************************************************************
cparata 0:e7e920b85676 3728 * Function Name : LSM6DSL_ACC_GYRO_R_FUNC_EN
cparata 0:e7e920b85676 3729 * Description : Read FUNC_EN
cparata 0:e7e920b85676 3730 * Input : Pointer to LSM6DSL_ACC_GYRO_FUNC_EN_t
cparata 0:e7e920b85676 3731 * Output : Status of FUNC_EN see LSM6DSL_ACC_GYRO_FUNC_EN_t
cparata 0:e7e920b85676 3732 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3733 *******************************************************************************/
cparata 0:e7e920b85676 3734 status_t LSM6DSL_ACC_GYRO_R_FUNC_EN(void *handle, LSM6DSL_ACC_GYRO_FUNC_EN_t *value)
cparata 0:e7e920b85676 3735 {
cparata 0:e7e920b85676 3736 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, (u8_t *)value, 1) )
cparata 0:e7e920b85676 3737 return MEMS_ERROR;
cparata 0:e7e920b85676 3738
cparata 0:e7e920b85676 3739 *value &= LSM6DSL_ACC_GYRO_FUNC_EN_MASK; //mask
cparata 0:e7e920b85676 3740
cparata 0:e7e920b85676 3741 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3742 }
cparata 0:e7e920b85676 3743
cparata 0:e7e920b85676 3744 /*******************************************************************************
cparata 0:e7e920b85676 3745 * Function Name : LSM6DSL_ACC_GYRO_W_I2C_MASTER_Enable
cparata 0:e7e920b85676 3746 * Description : Write MASTER_ON
cparata 0:e7e920b85676 3747 * Input : LSM6DSL_ACC_GYRO_MASTER_ON_t
cparata 0:e7e920b85676 3748 * Output : None
cparata 0:e7e920b85676 3749 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3750 *******************************************************************************/
cparata 0:e7e920b85676 3751 status_t LSM6DSL_ACC_GYRO_W_I2C_MASTER_Enable(void *handle, LSM6DSL_ACC_GYRO_MASTER_ON_t newValue)
cparata 0:e7e920b85676 3752 {
cparata 0:e7e920b85676 3753 u8_t value;
cparata 0:e7e920b85676 3754
cparata 0:e7e920b85676 3755 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:e7e920b85676 3756 return MEMS_ERROR;
cparata 0:e7e920b85676 3757
cparata 0:e7e920b85676 3758 value &= ~LSM6DSL_ACC_GYRO_MASTER_ON_MASK;
cparata 0:e7e920b85676 3759 value |= newValue;
cparata 0:e7e920b85676 3760
cparata 0:e7e920b85676 3761 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:e7e920b85676 3762 return MEMS_ERROR;
cparata 0:e7e920b85676 3763
cparata 0:e7e920b85676 3764 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3765 }
cparata 0:e7e920b85676 3766
cparata 0:e7e920b85676 3767 /*******************************************************************************
cparata 0:e7e920b85676 3768 * Function Name : LSM6DSL_ACC_GYRO_R_I2C_MASTER_Enable
cparata 0:e7e920b85676 3769 * Description : Read MASTER_ON
cparata 0:e7e920b85676 3770 * Input : Pointer to LSM6DSL_ACC_GYRO_MASTER_ON_t
cparata 0:e7e920b85676 3771 * Output : Status of MASTER_ON see LSM6DSL_ACC_GYRO_MASTER_ON_t
cparata 0:e7e920b85676 3772 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3773 *******************************************************************************/
cparata 0:e7e920b85676 3774 status_t LSM6DSL_ACC_GYRO_R_I2C_MASTER_Enable(void *handle, LSM6DSL_ACC_GYRO_MASTER_ON_t *value)
cparata 0:e7e920b85676 3775 {
cparata 0:e7e920b85676 3776 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, (u8_t *)value, 1) )
cparata 0:e7e920b85676 3777 return MEMS_ERROR;
cparata 0:e7e920b85676 3778
cparata 0:e7e920b85676 3779 *value &= LSM6DSL_ACC_GYRO_MASTER_ON_MASK; //mask
cparata 0:e7e920b85676 3780
cparata 0:e7e920b85676 3781 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3782 }
cparata 0:e7e920b85676 3783
cparata 0:e7e920b85676 3784 /*******************************************************************************
cparata 0:e7e920b85676 3785 * Function Name : LSM6DSL_ACC_GYRO_W_IronCorrection_EN
cparata 0:e7e920b85676 3786 * Description : Write IRON_EN
cparata 0:e7e920b85676 3787 * Input : LSM6DSL_ACC_GYRO_IRON_EN_t
cparata 0:e7e920b85676 3788 * Output : None
cparata 0:e7e920b85676 3789 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3790 *******************************************************************************/
cparata 0:e7e920b85676 3791 status_t LSM6DSL_ACC_GYRO_W_IronCorrection_EN(void *handle, LSM6DSL_ACC_GYRO_IRON_EN_t newValue)
cparata 0:e7e920b85676 3792 {
cparata 0:e7e920b85676 3793 u8_t value;
cparata 0:e7e920b85676 3794
cparata 0:e7e920b85676 3795 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:e7e920b85676 3796 return MEMS_ERROR;
cparata 0:e7e920b85676 3797
cparata 0:e7e920b85676 3798 value &= ~LSM6DSL_ACC_GYRO_IRON_EN_MASK;
cparata 0:e7e920b85676 3799 value |= newValue;
cparata 0:e7e920b85676 3800
cparata 0:e7e920b85676 3801 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:e7e920b85676 3802 return MEMS_ERROR;
cparata 0:e7e920b85676 3803
cparata 0:e7e920b85676 3804 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3805 }
cparata 0:e7e920b85676 3806
cparata 0:e7e920b85676 3807 /*******************************************************************************
cparata 0:e7e920b85676 3808 * Function Name : LSM6DSL_ACC_GYRO_R_IronCorrection_EN
cparata 0:e7e920b85676 3809 * Description : Read IRON_EN
cparata 0:e7e920b85676 3810 * Input : Pointer to LSM6DSL_ACC_GYRO_IRON_EN_t
cparata 0:e7e920b85676 3811 * Output : Status of IRON_EN see LSM6DSL_ACC_GYRO_IRON_EN_t
cparata 0:e7e920b85676 3812 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3813 *******************************************************************************/
cparata 0:e7e920b85676 3814 status_t LSM6DSL_ACC_GYRO_R_IronCorrection_EN(void *handle, LSM6DSL_ACC_GYRO_IRON_EN_t *value)
cparata 0:e7e920b85676 3815 {
cparata 0:e7e920b85676 3816 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, (u8_t *)value, 1) )
cparata 0:e7e920b85676 3817 return MEMS_ERROR;
cparata 0:e7e920b85676 3818
cparata 0:e7e920b85676 3819 *value &= LSM6DSL_ACC_GYRO_IRON_EN_MASK; //mask
cparata 0:e7e920b85676 3820
cparata 0:e7e920b85676 3821 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3822 }
cparata 0:e7e920b85676 3823
cparata 0:e7e920b85676 3824 /*******************************************************************************
cparata 0:e7e920b85676 3825 * Function Name : LSM6DSL_ACC_GYRO_W_PASS_THRU_MODE
cparata 0:e7e920b85676 3826 * Description : Write PASS_THRU_MODE
cparata 0:e7e920b85676 3827 * Input : LSM6DSL_ACC_GYRO_PASS_THRU_MODE_t
cparata 0:e7e920b85676 3828 * Output : None
cparata 0:e7e920b85676 3829 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3830 *******************************************************************************/
cparata 0:e7e920b85676 3831 status_t LSM6DSL_ACC_GYRO_W_PASS_THRU_MODE(void *handle, LSM6DSL_ACC_GYRO_PASS_THRU_MODE_t newValue)
cparata 0:e7e920b85676 3832 {
cparata 0:e7e920b85676 3833 u8_t value;
cparata 0:e7e920b85676 3834
cparata 0:e7e920b85676 3835 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:e7e920b85676 3836 return MEMS_ERROR;
cparata 0:e7e920b85676 3837
cparata 0:e7e920b85676 3838 value &= ~LSM6DSL_ACC_GYRO_PASS_THRU_MODE_MASK;
cparata 0:e7e920b85676 3839 value |= newValue;
cparata 0:e7e920b85676 3840
cparata 0:e7e920b85676 3841 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:e7e920b85676 3842 return MEMS_ERROR;
cparata 0:e7e920b85676 3843
cparata 0:e7e920b85676 3844 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3845 }
cparata 0:e7e920b85676 3846
cparata 0:e7e920b85676 3847 /*******************************************************************************
cparata 0:e7e920b85676 3848 * Function Name : LSM6DSL_ACC_GYRO_R_PASS_THRU_MODE
cparata 0:e7e920b85676 3849 * Description : Read PASS_THRU_MODE
cparata 0:e7e920b85676 3850 * Input : Pointer to LSM6DSL_ACC_GYRO_PASS_THRU_MODE_t
cparata 0:e7e920b85676 3851 * Output : Status of PASS_THRU_MODE see LSM6DSL_ACC_GYRO_PASS_THRU_MODE_t
cparata 0:e7e920b85676 3852 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3853 *******************************************************************************/
cparata 0:e7e920b85676 3854 status_t LSM6DSL_ACC_GYRO_R_PASS_THRU_MODE(void *handle, LSM6DSL_ACC_GYRO_PASS_THRU_MODE_t *value)
cparata 0:e7e920b85676 3855 {
cparata 0:e7e920b85676 3856 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, (u8_t *)value, 1) )
cparata 0:e7e920b85676 3857 return MEMS_ERROR;
cparata 0:e7e920b85676 3858
cparata 0:e7e920b85676 3859 *value &= LSM6DSL_ACC_GYRO_PASS_THRU_MODE_MASK; //mask
cparata 0:e7e920b85676 3860
cparata 0:e7e920b85676 3861 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3862 }
cparata 0:e7e920b85676 3863
cparata 0:e7e920b85676 3864 /*******************************************************************************
cparata 0:e7e920b85676 3865 * Function Name : LSM6DSL_ACC_GYRO_W_PULL_UP_EN
cparata 0:e7e920b85676 3866 * Description : Write PULL_UP_EN
cparata 0:e7e920b85676 3867 * Input : LSM6DSL_ACC_GYRO_PULL_UP_EN_t
cparata 0:e7e920b85676 3868 * Output : None
cparata 0:e7e920b85676 3869 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3870 *******************************************************************************/
cparata 0:e7e920b85676 3871 status_t LSM6DSL_ACC_GYRO_W_PULL_UP_EN(void *handle, LSM6DSL_ACC_GYRO_PULL_UP_EN_t newValue)
cparata 0:e7e920b85676 3872 {
cparata 0:e7e920b85676 3873 u8_t value;
cparata 0:e7e920b85676 3874
cparata 0:e7e920b85676 3875 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:e7e920b85676 3876 return MEMS_ERROR;
cparata 0:e7e920b85676 3877
cparata 0:e7e920b85676 3878 value &= ~LSM6DSL_ACC_GYRO_PULL_UP_EN_MASK;
cparata 0:e7e920b85676 3879 value |= newValue;
cparata 0:e7e920b85676 3880
cparata 0:e7e920b85676 3881 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:e7e920b85676 3882 return MEMS_ERROR;
cparata 0:e7e920b85676 3883
cparata 0:e7e920b85676 3884 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3885 }
cparata 0:e7e920b85676 3886
cparata 0:e7e920b85676 3887 /*******************************************************************************
cparata 0:e7e920b85676 3888 * Function Name : LSM6DSL_ACC_GYRO_R_PULL_UP_EN
cparata 0:e7e920b85676 3889 * Description : Read PULL_UP_EN
cparata 0:e7e920b85676 3890 * Input : Pointer to LSM6DSL_ACC_GYRO_PULL_UP_EN_t
cparata 0:e7e920b85676 3891 * Output : Status of PULL_UP_EN see LSM6DSL_ACC_GYRO_PULL_UP_EN_t
cparata 0:e7e920b85676 3892 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3893 *******************************************************************************/
cparata 0:e7e920b85676 3894 status_t LSM6DSL_ACC_GYRO_R_PULL_UP_EN(void *handle, LSM6DSL_ACC_GYRO_PULL_UP_EN_t *value)
cparata 0:e7e920b85676 3895 {
cparata 0:e7e920b85676 3896 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, (u8_t *)value, 1) )
cparata 0:e7e920b85676 3897 return MEMS_ERROR;
cparata 0:e7e920b85676 3898
cparata 0:e7e920b85676 3899 *value &= LSM6DSL_ACC_GYRO_PULL_UP_EN_MASK; //mask
cparata 0:e7e920b85676 3900
cparata 0:e7e920b85676 3901 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3902 }
cparata 0:e7e920b85676 3903
cparata 0:e7e920b85676 3904 /*******************************************************************************
cparata 0:e7e920b85676 3905 * Function Name : LSM6DSL_ACC_GYRO_W_SensorHUB_Trigger_Sel
cparata 0:e7e920b85676 3906 * Description : Write START_CONFIG
cparata 0:e7e920b85676 3907 * Input : LSM6DSL_ACC_GYRO_START_CONFIG_t
cparata 0:e7e920b85676 3908 * Output : None
cparata 0:e7e920b85676 3909 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3910 *******************************************************************************/
cparata 0:e7e920b85676 3911 status_t LSM6DSL_ACC_GYRO_W_SensorHUB_Trigger_Sel(void *handle, LSM6DSL_ACC_GYRO_START_CONFIG_t newValue)
cparata 0:e7e920b85676 3912 {
cparata 0:e7e920b85676 3913 u8_t value;
cparata 0:e7e920b85676 3914
cparata 0:e7e920b85676 3915 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:e7e920b85676 3916 return MEMS_ERROR;
cparata 0:e7e920b85676 3917
cparata 0:e7e920b85676 3918 value &= ~LSM6DSL_ACC_GYRO_START_CONFIG_MASK;
cparata 0:e7e920b85676 3919 value |= newValue;
cparata 0:e7e920b85676 3920
cparata 0:e7e920b85676 3921 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:e7e920b85676 3922 return MEMS_ERROR;
cparata 0:e7e920b85676 3923
cparata 0:e7e920b85676 3924 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3925 }
cparata 0:e7e920b85676 3926
cparata 0:e7e920b85676 3927 /*******************************************************************************
cparata 0:e7e920b85676 3928 * Function Name : LSM6DSL_ACC_GYRO_R_SensorHUB_Trigger_Sel
cparata 0:e7e920b85676 3929 * Description : Read START_CONFIG
cparata 0:e7e920b85676 3930 * Input : Pointer to LSM6DSL_ACC_GYRO_START_CONFIG_t
cparata 0:e7e920b85676 3931 * Output : Status of START_CONFIG see LSM6DSL_ACC_GYRO_START_CONFIG_t
cparata 0:e7e920b85676 3932 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3933 *******************************************************************************/
cparata 0:e7e920b85676 3934 status_t LSM6DSL_ACC_GYRO_R_SensorHUB_Trigger_Sel(void *handle, LSM6DSL_ACC_GYRO_START_CONFIG_t *value)
cparata 0:e7e920b85676 3935 {
cparata 0:e7e920b85676 3936 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, (u8_t *)value, 1) )
cparata 0:e7e920b85676 3937 return MEMS_ERROR;
cparata 0:e7e920b85676 3938
cparata 0:e7e920b85676 3939 *value &= LSM6DSL_ACC_GYRO_START_CONFIG_MASK; //mask
cparata 0:e7e920b85676 3940
cparata 0:e7e920b85676 3941 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3942 }
cparata 0:e7e920b85676 3943
cparata 0:e7e920b85676 3944 /*******************************************************************************
cparata 0:e7e920b85676 3945 * Function Name : LSM6DSL_ACC_GYRO_W_DATA_VAL_SEL_FIFO
cparata 0:e7e920b85676 3946 * Description : Write DATA_VAL_SEL_FIFO
cparata 0:e7e920b85676 3947 * Input : LSM6DSL_ACC_GYRO_DATA_VAL_SEL_FIFO_t
cparata 0:e7e920b85676 3948 * Output : None
cparata 0:e7e920b85676 3949 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3950 *******************************************************************************/
cparata 0:e7e920b85676 3951 status_t LSM6DSL_ACC_GYRO_W_DATA_VAL_SEL_FIFO(void *handle, LSM6DSL_ACC_GYRO_DATA_VAL_SEL_FIFO_t newValue)
cparata 0:e7e920b85676 3952 {
cparata 0:e7e920b85676 3953 u8_t value;
cparata 0:e7e920b85676 3954
cparata 0:e7e920b85676 3955 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:e7e920b85676 3956 return MEMS_ERROR;
cparata 0:e7e920b85676 3957
cparata 0:e7e920b85676 3958 value &= ~LSM6DSL_ACC_GYRO_DATA_VAL_SEL_FIFO_MASK;
cparata 0:e7e920b85676 3959 value |= newValue;
cparata 0:e7e920b85676 3960
cparata 0:e7e920b85676 3961 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:e7e920b85676 3962 return MEMS_ERROR;
cparata 0:e7e920b85676 3963
cparata 0:e7e920b85676 3964 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3965 }
cparata 0:e7e920b85676 3966
cparata 0:e7e920b85676 3967 /*******************************************************************************
cparata 0:e7e920b85676 3968 * Function Name : LSM6DSL_ACC_GYRO_R_DATA_VAL_SEL_FIFO
cparata 0:e7e920b85676 3969 * Description : Read DATA_VAL_SEL_FIFO
cparata 0:e7e920b85676 3970 * Input : Pointer to LSM6DSL_ACC_GYRO_DATA_VAL_SEL_FIFO_t
cparata 0:e7e920b85676 3971 * Output : Status of DATA_VAL_SEL_FIFO see LSM6DSL_ACC_GYRO_DATA_VAL_SEL_FIFO_t
cparata 0:e7e920b85676 3972 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3973 *******************************************************************************/
cparata 0:e7e920b85676 3974 status_t LSM6DSL_ACC_GYRO_R_DATA_VAL_SEL_FIFO(void *handle, LSM6DSL_ACC_GYRO_DATA_VAL_SEL_FIFO_t *value)
cparata 0:e7e920b85676 3975 {
cparata 0:e7e920b85676 3976 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, (u8_t *)value, 1) )
cparata 0:e7e920b85676 3977 return MEMS_ERROR;
cparata 0:e7e920b85676 3978
cparata 0:e7e920b85676 3979 *value &= LSM6DSL_ACC_GYRO_DATA_VAL_SEL_FIFO_MASK; //mask
cparata 0:e7e920b85676 3980
cparata 0:e7e920b85676 3981 return MEMS_SUCCESS;
cparata 0:e7e920b85676 3982 }
cparata 0:e7e920b85676 3983
cparata 0:e7e920b85676 3984 /*******************************************************************************
cparata 0:e7e920b85676 3985 * Function Name : LSM6DSL_ACC_GYRO_W_DRDY_ON_INT1
cparata 0:e7e920b85676 3986 * Description : Write DRDY_ON_INT1
cparata 0:e7e920b85676 3987 * Input : LSM6DSL_ACC_GYRO_DRDY_ON_INT1_t
cparata 0:e7e920b85676 3988 * Output : None
cparata 0:e7e920b85676 3989 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 3990 *******************************************************************************/
cparata 0:e7e920b85676 3991 status_t LSM6DSL_ACC_GYRO_W_DRDY_ON_INT1(void *handle, LSM6DSL_ACC_GYRO_DRDY_ON_INT1_t newValue)
cparata 0:e7e920b85676 3992 {
cparata 0:e7e920b85676 3993 u8_t value;
cparata 0:e7e920b85676 3994
cparata 0:e7e920b85676 3995 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:e7e920b85676 3996 return MEMS_ERROR;
cparata 0:e7e920b85676 3997
cparata 0:e7e920b85676 3998 value &= ~LSM6DSL_ACC_GYRO_DRDY_ON_INT1_MASK;
cparata 0:e7e920b85676 3999 value |= newValue;
cparata 0:e7e920b85676 4000
cparata 0:e7e920b85676 4001 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:e7e920b85676 4002 return MEMS_ERROR;
cparata 0:e7e920b85676 4003
cparata 0:e7e920b85676 4004 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4005 }
cparata 0:e7e920b85676 4006 /*******************************************************************************
cparata 0:e7e920b85676 4007 * Function Name : LSM6DSL_ACC_GYRO_R_DRDY_ON_INT1
cparata 0:e7e920b85676 4008 * Description : Read DRDY_ON_INT1
cparata 0:e7e920b85676 4009 * Input : Pointer to LSM6DSL_ACC_GYRO_DRDY_ON_INT1_t
cparata 0:e7e920b85676 4010 * Output : Status of DRDY_ON_INT1 see LSM6DSL_ACC_GYRO_DRDY_ON_INT1_t
cparata 0:e7e920b85676 4011 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4012 *******************************************************************************/
cparata 0:e7e920b85676 4013 status_t LSM6DSL_ACC_GYRO_R_DRDY_ON_INT1(void *handle, LSM6DSL_ACC_GYRO_DRDY_ON_INT1_t *value)
cparata 0:e7e920b85676 4014 {
cparata 0:e7e920b85676 4015 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4016 return MEMS_ERROR;
cparata 0:e7e920b85676 4017
cparata 0:e7e920b85676 4018 *value &= LSM6DSL_ACC_GYRO_DRDY_ON_INT1_MASK; //mask
cparata 0:e7e920b85676 4019
cparata 0:e7e920b85676 4020 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4021 }
cparata 0:e7e920b85676 4022
cparata 0:e7e920b85676 4023 /*******************************************************************************
cparata 0:e7e920b85676 4024 * Function Name : LSM6DSL_ACC_GYRO_R_Z_WU
cparata 0:e7e920b85676 4025 * Description : Read Z_WU
cparata 0:e7e920b85676 4026 * Input : Pointer to LSM6DSL_ACC_GYRO_Z_WU_t
cparata 0:e7e920b85676 4027 * Output : Status of Z_WU see LSM6DSL_ACC_GYRO_Z_WU_t
cparata 0:e7e920b85676 4028 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4029 *******************************************************************************/
cparata 0:e7e920b85676 4030 status_t LSM6DSL_ACC_GYRO_R_Z_WU(void *handle, LSM6DSL_ACC_GYRO_Z_WU_t *value)
cparata 0:e7e920b85676 4031 {
cparata 0:e7e920b85676 4032 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4033 return MEMS_ERROR;
cparata 0:e7e920b85676 4034
cparata 0:e7e920b85676 4035 *value &= LSM6DSL_ACC_GYRO_Z_WU_MASK; //mask
cparata 0:e7e920b85676 4036
cparata 0:e7e920b85676 4037 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4038 }
cparata 0:e7e920b85676 4039
cparata 0:e7e920b85676 4040 /*******************************************************************************
cparata 0:e7e920b85676 4041 * Function Name : LSM6DSL_ACC_GYRO_R_Y_WU
cparata 0:e7e920b85676 4042 * Description : Read Y_WU
cparata 0:e7e920b85676 4043 * Input : Pointer to LSM6DSL_ACC_GYRO_Y_WU_t
cparata 0:e7e920b85676 4044 * Output : Status of Y_WU see LSM6DSL_ACC_GYRO_Y_WU_t
cparata 0:e7e920b85676 4045 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4046 *******************************************************************************/
cparata 0:e7e920b85676 4047 status_t LSM6DSL_ACC_GYRO_R_Y_WU(void *handle, LSM6DSL_ACC_GYRO_Y_WU_t *value)
cparata 0:e7e920b85676 4048 {
cparata 0:e7e920b85676 4049 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4050 return MEMS_ERROR;
cparata 0:e7e920b85676 4051
cparata 0:e7e920b85676 4052 *value &= LSM6DSL_ACC_GYRO_Y_WU_MASK; //mask
cparata 0:e7e920b85676 4053
cparata 0:e7e920b85676 4054 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4055 }
cparata 0:e7e920b85676 4056
cparata 0:e7e920b85676 4057 /*******************************************************************************
cparata 0:e7e920b85676 4058 * Function Name : LSM6DSL_ACC_GYRO_R_X_WU
cparata 0:e7e920b85676 4059 * Description : Read X_WU
cparata 0:e7e920b85676 4060 * Input : Pointer to LSM6DSL_ACC_GYRO_X_WU_t
cparata 0:e7e920b85676 4061 * Output : Status of X_WU see LSM6DSL_ACC_GYRO_X_WU_t
cparata 0:e7e920b85676 4062 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4063 *******************************************************************************/
cparata 0:e7e920b85676 4064 status_t LSM6DSL_ACC_GYRO_R_X_WU(void *handle, LSM6DSL_ACC_GYRO_X_WU_t *value)
cparata 0:e7e920b85676 4065 {
cparata 0:e7e920b85676 4066 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4067 return MEMS_ERROR;
cparata 0:e7e920b85676 4068
cparata 0:e7e920b85676 4069 *value &= LSM6DSL_ACC_GYRO_X_WU_MASK; //mask
cparata 0:e7e920b85676 4070
cparata 0:e7e920b85676 4071 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4072 }
cparata 0:e7e920b85676 4073
cparata 0:e7e920b85676 4074 /*******************************************************************************
cparata 0:e7e920b85676 4075 * Function Name : LSM6DSL_ACC_GYRO_R_WU_EV_STATUS
cparata 0:e7e920b85676 4076 * Description : Read WU_EV_STATUS
cparata 0:e7e920b85676 4077 * Input : Pointer to LSM6DSL_ACC_GYRO_WU_EV_STATUS_t
cparata 0:e7e920b85676 4078 * Output : Status of WU_EV_STATUS see LSM6DSL_ACC_GYRO_WU_EV_STATUS_t
cparata 0:e7e920b85676 4079 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4080 *******************************************************************************/
cparata 0:e7e920b85676 4081 status_t LSM6DSL_ACC_GYRO_R_WU_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_WU_EV_STATUS_t *value)
cparata 0:e7e920b85676 4082 {
cparata 0:e7e920b85676 4083 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4084 return MEMS_ERROR;
cparata 0:e7e920b85676 4085
cparata 0:e7e920b85676 4086 *value &= LSM6DSL_ACC_GYRO_WU_EV_STATUS_MASK; //mask
cparata 0:e7e920b85676 4087
cparata 0:e7e920b85676 4088 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4089 }
cparata 0:e7e920b85676 4090
cparata 0:e7e920b85676 4091 /*******************************************************************************
cparata 0:e7e920b85676 4092 * Function Name : LSM6DSL_ACC_GYRO_R_SLEEP_EV_STATUS
cparata 0:e7e920b85676 4093 * Description : Read SLEEP_EV_STATUS
cparata 0:e7e920b85676 4094 * Input : Pointer to LSM6DSL_ACC_GYRO_SLEEP_EV_STATUS_t
cparata 0:e7e920b85676 4095 * Output : Status of SLEEP_EV_STATUS see LSM6DSL_ACC_GYRO_SLEEP_EV_STATUS_t
cparata 0:e7e920b85676 4096 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4097 *******************************************************************************/
cparata 0:e7e920b85676 4098 status_t LSM6DSL_ACC_GYRO_R_SLEEP_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_SLEEP_EV_STATUS_t *value)
cparata 0:e7e920b85676 4099 {
cparata 0:e7e920b85676 4100 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4101 return MEMS_ERROR;
cparata 0:e7e920b85676 4102
cparata 0:e7e920b85676 4103 *value &= LSM6DSL_ACC_GYRO_SLEEP_EV_STATUS_MASK; //mask
cparata 0:e7e920b85676 4104
cparata 0:e7e920b85676 4105 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4106 }
cparata 0:e7e920b85676 4107
cparata 0:e7e920b85676 4108 /*******************************************************************************
cparata 0:e7e920b85676 4109 * Function Name : LSM6DSL_ACC_GYRO_R_FF_EV_STATUS
cparata 0:e7e920b85676 4110 * Description : Read FF_EV_STATUS
cparata 0:e7e920b85676 4111 * Input : Pointer to LSM6DSL_ACC_GYRO_FF_EV_STATUS_t
cparata 0:e7e920b85676 4112 * Output : Status of FF_EV_STATUS see LSM6DSL_ACC_GYRO_FF_EV_STATUS_t
cparata 0:e7e920b85676 4113 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4114 *******************************************************************************/
cparata 0:e7e920b85676 4115 status_t LSM6DSL_ACC_GYRO_R_FF_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_FF_EV_STATUS_t *value)
cparata 0:e7e920b85676 4116 {
cparata 0:e7e920b85676 4117 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4118 return MEMS_ERROR;
cparata 0:e7e920b85676 4119
cparata 0:e7e920b85676 4120 *value &= LSM6DSL_ACC_GYRO_FF_EV_STATUS_MASK; //mask
cparata 0:e7e920b85676 4121
cparata 0:e7e920b85676 4122 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4123 }
cparata 0:e7e920b85676 4124
cparata 0:e7e920b85676 4125 /*******************************************************************************
cparata 0:e7e920b85676 4126 * Function Name : LSM6DSL_ACC_GYRO_R_Z_TAP
cparata 0:e7e920b85676 4127 * Description : Read Z_TAP
cparata 0:e7e920b85676 4128 * Input : Pointer to LSM6DSL_ACC_GYRO_Z_TAP_t
cparata 0:e7e920b85676 4129 * Output : Status of Z_TAP see LSM6DSL_ACC_GYRO_Z_TAP_t
cparata 0:e7e920b85676 4130 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4131 *******************************************************************************/
cparata 0:e7e920b85676 4132 status_t LSM6DSL_ACC_GYRO_R_Z_TAP(void *handle, LSM6DSL_ACC_GYRO_Z_TAP_t *value)
cparata 0:e7e920b85676 4133 {
cparata 0:e7e920b85676 4134 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_SRC, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4135 return MEMS_ERROR;
cparata 0:e7e920b85676 4136
cparata 0:e7e920b85676 4137 *value &= LSM6DSL_ACC_GYRO_Z_TAP_MASK; //mask
cparata 0:e7e920b85676 4138
cparata 0:e7e920b85676 4139 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4140 }
cparata 0:e7e920b85676 4141
cparata 0:e7e920b85676 4142 /*******************************************************************************
cparata 0:e7e920b85676 4143 * Function Name : LSM6DSL_ACC_GYRO_R_Y_TAP
cparata 0:e7e920b85676 4144 * Description : Read Y_TAP
cparata 0:e7e920b85676 4145 * Input : Pointer to LSM6DSL_ACC_GYRO_Y_TAP_t
cparata 0:e7e920b85676 4146 * Output : Status of Y_TAP see LSM6DSL_ACC_GYRO_Y_TAP_t
cparata 0:e7e920b85676 4147 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4148 *******************************************************************************/
cparata 0:e7e920b85676 4149 status_t LSM6DSL_ACC_GYRO_R_Y_TAP(void *handle, LSM6DSL_ACC_GYRO_Y_TAP_t *value)
cparata 0:e7e920b85676 4150 {
cparata 0:e7e920b85676 4151 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_SRC, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4152 return MEMS_ERROR;
cparata 0:e7e920b85676 4153
cparata 0:e7e920b85676 4154 *value &= LSM6DSL_ACC_GYRO_Y_TAP_MASK; //mask
cparata 0:e7e920b85676 4155
cparata 0:e7e920b85676 4156 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4157 }
cparata 0:e7e920b85676 4158
cparata 0:e7e920b85676 4159 /*******************************************************************************
cparata 0:e7e920b85676 4160 * Function Name : LSM6DSL_ACC_GYRO_R_X_TAP
cparata 0:e7e920b85676 4161 * Description : Read X_TAP
cparata 0:e7e920b85676 4162 * Input : Pointer to LSM6DSL_ACC_GYRO_X_TAP_t
cparata 0:e7e920b85676 4163 * Output : Status of X_TAP see LSM6DSL_ACC_GYRO_X_TAP_t
cparata 0:e7e920b85676 4164 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4165 *******************************************************************************/
cparata 0:e7e920b85676 4166 status_t LSM6DSL_ACC_GYRO_R_X_TAP(void *handle, LSM6DSL_ACC_GYRO_X_TAP_t *value)
cparata 0:e7e920b85676 4167 {
cparata 0:e7e920b85676 4168 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_SRC, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4169 return MEMS_ERROR;
cparata 0:e7e920b85676 4170
cparata 0:e7e920b85676 4171 *value &= LSM6DSL_ACC_GYRO_X_TAP_MASK; //mask
cparata 0:e7e920b85676 4172
cparata 0:e7e920b85676 4173 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4174 }
cparata 0:e7e920b85676 4175
cparata 0:e7e920b85676 4176 /*******************************************************************************
cparata 0:e7e920b85676 4177 * Function Name : LSM6DSL_ACC_GYRO_R_TAP_SIGN
cparata 0:e7e920b85676 4178 * Description : Read TAP_SIGN
cparata 0:e7e920b85676 4179 * Input : Pointer to LSM6DSL_ACC_GYRO_TAP_SIGN_t
cparata 0:e7e920b85676 4180 * Output : Status of TAP_SIGN see LSM6DSL_ACC_GYRO_TAP_SIGN_t
cparata 0:e7e920b85676 4181 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4182 *******************************************************************************/
cparata 0:e7e920b85676 4183 status_t LSM6DSL_ACC_GYRO_R_TAP_SIGN(void *handle, LSM6DSL_ACC_GYRO_TAP_SIGN_t *value)
cparata 0:e7e920b85676 4184 {
cparata 0:e7e920b85676 4185 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_SRC, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4186 return MEMS_ERROR;
cparata 0:e7e920b85676 4187
cparata 0:e7e920b85676 4188 *value &= LSM6DSL_ACC_GYRO_TAP_SIGN_MASK; //mask
cparata 0:e7e920b85676 4189
cparata 0:e7e920b85676 4190 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4191 }
cparata 0:e7e920b85676 4192
cparata 0:e7e920b85676 4193 /*******************************************************************************
cparata 0:e7e920b85676 4194 * Function Name : LSM6DSL_ACC_GYRO_R_DOUBLE_TAP_EV_STATUS
cparata 0:e7e920b85676 4195 * Description : Read DOUBLE_TAP_EV_STATUS
cparata 0:e7e920b85676 4196 * Input : Pointer to LSM6DSL_ACC_GYRO_DOUBLE_TAP_EV_STATUS_t
cparata 0:e7e920b85676 4197 * Output : Status of DOUBLE_TAP_EV_STATUS see LSM6DSL_ACC_GYRO_DOUBLE_TAP_EV_STATUS_t
cparata 0:e7e920b85676 4198 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4199 *******************************************************************************/
cparata 0:e7e920b85676 4200 status_t LSM6DSL_ACC_GYRO_R_DOUBLE_TAP_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_DOUBLE_TAP_EV_STATUS_t *value)
cparata 0:e7e920b85676 4201 {
cparata 0:e7e920b85676 4202 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_SRC, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4203 return MEMS_ERROR;
cparata 0:e7e920b85676 4204
cparata 0:e7e920b85676 4205 *value &= LSM6DSL_ACC_GYRO_DOUBLE_TAP_EV_STATUS_MASK; //mask
cparata 0:e7e920b85676 4206
cparata 0:e7e920b85676 4207 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4208 }
cparata 0:e7e920b85676 4209
cparata 0:e7e920b85676 4210 /*******************************************************************************
cparata 0:e7e920b85676 4211 * Function Name : LSM6DSL_ACC_GYRO_R_SINGLE_TAP_EV_STATUS
cparata 0:e7e920b85676 4212 * Description : Read SINGLE_TAP_EV_STATUS
cparata 0:e7e920b85676 4213 * Input : Pointer to LSM6DSL_ACC_GYRO_SINGLE_TAP_EV_STATUS_t
cparata 0:e7e920b85676 4214 * Output : Status of SINGLE_TAP_EV_STATUS see LSM6DSL_ACC_GYRO_SINGLE_TAP_EV_STATUS_t
cparata 0:e7e920b85676 4215 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4216 *******************************************************************************/
cparata 0:e7e920b85676 4217 status_t LSM6DSL_ACC_GYRO_R_SINGLE_TAP_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_SINGLE_TAP_EV_STATUS_t *value)
cparata 0:e7e920b85676 4218 {
cparata 0:e7e920b85676 4219 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_SRC, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4220 return MEMS_ERROR;
cparata 0:e7e920b85676 4221
cparata 0:e7e920b85676 4222 *value &= LSM6DSL_ACC_GYRO_SINGLE_TAP_EV_STATUS_MASK; //mask
cparata 0:e7e920b85676 4223
cparata 0:e7e920b85676 4224 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4225 }
cparata 0:e7e920b85676 4226
cparata 0:e7e920b85676 4227 /*******************************************************************************
cparata 0:e7e920b85676 4228 * Function Name : LSM6DSL_ACC_GYRO_R_TAP_EV_STATUS
cparata 0:e7e920b85676 4229 * Description : Read TAP_EV_STATUS
cparata 0:e7e920b85676 4230 * Input : Pointer to LSM6DSL_ACC_GYRO_TAP_EV_STATUS_t
cparata 0:e7e920b85676 4231 * Output : Status of TAP_EV_STATUS see LSM6DSL_ACC_GYRO_TAP_EV_STATUS_t
cparata 0:e7e920b85676 4232 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4233 *******************************************************************************/
cparata 0:e7e920b85676 4234 status_t LSM6DSL_ACC_GYRO_R_TAP_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_TAP_EV_STATUS_t *value)
cparata 0:e7e920b85676 4235 {
cparata 0:e7e920b85676 4236 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_SRC, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4237 return MEMS_ERROR;
cparata 0:e7e920b85676 4238
cparata 0:e7e920b85676 4239 *value &= LSM6DSL_ACC_GYRO_TAP_EV_STATUS_MASK; //mask
cparata 0:e7e920b85676 4240
cparata 0:e7e920b85676 4241 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4242 }
cparata 0:e7e920b85676 4243
cparata 0:e7e920b85676 4244 /*******************************************************************************
cparata 0:e7e920b85676 4245 * Function Name : LSM6DSL_ACC_GYRO_R_DSD_XL
cparata 0:e7e920b85676 4246 * Description : Read DSD_XL
cparata 0:e7e920b85676 4247 * Input : Pointer to LSM6DSL_ACC_GYRO_DSD_XL_t
cparata 0:e7e920b85676 4248 * Output : Status of DSD_XL see LSM6DSL_ACC_GYRO_DSD_XL_t
cparata 0:e7e920b85676 4249 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4250 *******************************************************************************/
cparata 0:e7e920b85676 4251 status_t LSM6DSL_ACC_GYRO_R_DSD_XL(void *handle, LSM6DSL_ACC_GYRO_DSD_XL_t *value)
cparata 0:e7e920b85676 4252 {
cparata 0:e7e920b85676 4253 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_D6D_SRC, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4254 return MEMS_ERROR;
cparata 0:e7e920b85676 4255
cparata 0:e7e920b85676 4256 *value &= LSM6DSL_ACC_GYRO_DSD_XL_MASK; //mask
cparata 0:e7e920b85676 4257
cparata 0:e7e920b85676 4258 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4259 }
cparata 0:e7e920b85676 4260
cparata 0:e7e920b85676 4261 /*******************************************************************************
cparata 0:e7e920b85676 4262 * Function Name : LSM6DSL_ACC_GYRO_R_DSD_XH
cparata 0:e7e920b85676 4263 * Description : Read DSD_XH
cparata 0:e7e920b85676 4264 * Input : Pointer to LSM6DSL_ACC_GYRO_DSD_XH_t
cparata 0:e7e920b85676 4265 * Output : Status of DSD_XH see LSM6DSL_ACC_GYRO_DSD_XH_t
cparata 0:e7e920b85676 4266 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4267 *******************************************************************************/
cparata 0:e7e920b85676 4268 status_t LSM6DSL_ACC_GYRO_R_DSD_XH(void *handle, LSM6DSL_ACC_GYRO_DSD_XH_t *value)
cparata 0:e7e920b85676 4269 {
cparata 0:e7e920b85676 4270 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_D6D_SRC, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4271 return MEMS_ERROR;
cparata 0:e7e920b85676 4272
cparata 0:e7e920b85676 4273 *value &= LSM6DSL_ACC_GYRO_DSD_XH_MASK; //mask
cparata 0:e7e920b85676 4274
cparata 0:e7e920b85676 4275 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4276 }
cparata 0:e7e920b85676 4277
cparata 0:e7e920b85676 4278 /*******************************************************************************
cparata 0:e7e920b85676 4279 * Function Name : LSM6DSL_ACC_GYRO_R_DSD_YL
cparata 0:e7e920b85676 4280 * Description : Read DSD_YL
cparata 0:e7e920b85676 4281 * Input : Pointer to LSM6DSL_ACC_GYRO_DSD_YL_t
cparata 0:e7e920b85676 4282 * Output : Status of DSD_YL see LSM6DSL_ACC_GYRO_DSD_YL_t
cparata 0:e7e920b85676 4283 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4284 *******************************************************************************/
cparata 0:e7e920b85676 4285 status_t LSM6DSL_ACC_GYRO_R_DSD_YL(void *handle, LSM6DSL_ACC_GYRO_DSD_YL_t *value)
cparata 0:e7e920b85676 4286 {
cparata 0:e7e920b85676 4287 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_D6D_SRC, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4288 return MEMS_ERROR;
cparata 0:e7e920b85676 4289
cparata 0:e7e920b85676 4290 *value &= LSM6DSL_ACC_GYRO_DSD_YL_MASK; //mask
cparata 0:e7e920b85676 4291
cparata 0:e7e920b85676 4292 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4293 }
cparata 0:e7e920b85676 4294
cparata 0:e7e920b85676 4295 /*******************************************************************************
cparata 0:e7e920b85676 4296 * Function Name : LSM6DSL_ACC_GYRO_R_DSD_YH
cparata 0:e7e920b85676 4297 * Description : Read DSD_YH
cparata 0:e7e920b85676 4298 * Input : Pointer to LSM6DSL_ACC_GYRO_DSD_YH_t
cparata 0:e7e920b85676 4299 * Output : Status of DSD_YH see LSM6DSL_ACC_GYRO_DSD_YH_t
cparata 0:e7e920b85676 4300 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4301 *******************************************************************************/
cparata 0:e7e920b85676 4302 status_t LSM6DSL_ACC_GYRO_R_DSD_YH(void *handle, LSM6DSL_ACC_GYRO_DSD_YH_t *value)
cparata 0:e7e920b85676 4303 {
cparata 0:e7e920b85676 4304 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_D6D_SRC, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4305 return MEMS_ERROR;
cparata 0:e7e920b85676 4306
cparata 0:e7e920b85676 4307 *value &= LSM6DSL_ACC_GYRO_DSD_YH_MASK; //mask
cparata 0:e7e920b85676 4308
cparata 0:e7e920b85676 4309 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4310 }
cparata 0:e7e920b85676 4311
cparata 0:e7e920b85676 4312 /*******************************************************************************
cparata 0:e7e920b85676 4313 * Function Name : LSM6DSL_ACC_GYRO_R_DSD_ZL
cparata 0:e7e920b85676 4314 * Description : Read DSD_ZL
cparata 0:e7e920b85676 4315 * Input : Pointer to LSM6DSL_ACC_GYRO_DSD_ZL_t
cparata 0:e7e920b85676 4316 * Output : Status of DSD_ZL see LSM6DSL_ACC_GYRO_DSD_ZL_t
cparata 0:e7e920b85676 4317 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4318 *******************************************************************************/
cparata 0:e7e920b85676 4319 status_t LSM6DSL_ACC_GYRO_R_DSD_ZL(void *handle, LSM6DSL_ACC_GYRO_DSD_ZL_t *value)
cparata 0:e7e920b85676 4320 {
cparata 0:e7e920b85676 4321 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_D6D_SRC, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4322 return MEMS_ERROR;
cparata 0:e7e920b85676 4323
cparata 0:e7e920b85676 4324 *value &= LSM6DSL_ACC_GYRO_DSD_ZL_MASK; //mask
cparata 0:e7e920b85676 4325
cparata 0:e7e920b85676 4326 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4327 }
cparata 0:e7e920b85676 4328
cparata 0:e7e920b85676 4329 /*******************************************************************************
cparata 0:e7e920b85676 4330 * Function Name : LSM6DSL_ACC_GYRO_R_DSD_ZH
cparata 0:e7e920b85676 4331 * Description : Read DSD_ZH
cparata 0:e7e920b85676 4332 * Input : Pointer to LSM6DSL_ACC_GYRO_DSD_ZH_t
cparata 0:e7e920b85676 4333 * Output : Status of DSD_ZH see LSM6DSL_ACC_GYRO_DSD_ZH_t
cparata 0:e7e920b85676 4334 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4335 *******************************************************************************/
cparata 0:e7e920b85676 4336 status_t LSM6DSL_ACC_GYRO_R_DSD_ZH(void *handle, LSM6DSL_ACC_GYRO_DSD_ZH_t *value)
cparata 0:e7e920b85676 4337 {
cparata 0:e7e920b85676 4338 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_D6D_SRC, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4339 return MEMS_ERROR;
cparata 0:e7e920b85676 4340
cparata 0:e7e920b85676 4341 *value &= LSM6DSL_ACC_GYRO_DSD_ZH_MASK; //mask
cparata 0:e7e920b85676 4342
cparata 0:e7e920b85676 4343 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4344 }
cparata 0:e7e920b85676 4345
cparata 0:e7e920b85676 4346 /*******************************************************************************
cparata 0:e7e920b85676 4347 * Function Name : LSM6DSL_ACC_GYRO_R_D6D_EV_STATUS
cparata 0:e7e920b85676 4348 * Description : Read D6D_EV_STATUS
cparata 0:e7e920b85676 4349 * Input : Pointer to LSM6DSL_ACC_GYRO_D6D_EV_STATUS_t
cparata 0:e7e920b85676 4350 * Output : Status of D6D_EV_STATUS see LSM6DSL_ACC_GYRO_D6D_EV_STATUS_t
cparata 0:e7e920b85676 4351 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4352 *******************************************************************************/
cparata 0:e7e920b85676 4353 status_t LSM6DSL_ACC_GYRO_R_D6D_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_D6D_EV_STATUS_t *value)
cparata 0:e7e920b85676 4354 {
cparata 0:e7e920b85676 4355 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_D6D_SRC, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4356 return MEMS_ERROR;
cparata 0:e7e920b85676 4357
cparata 0:e7e920b85676 4358 *value &= LSM6DSL_ACC_GYRO_D6D_EV_STATUS_MASK; //mask
cparata 0:e7e920b85676 4359
cparata 0:e7e920b85676 4360 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4361 }
cparata 0:e7e920b85676 4362
cparata 0:e7e920b85676 4363 /*******************************************************************************
cparata 0:e7e920b85676 4364 * Function Name : LSM6DSL_ACC_GYRO_R_XLDA
cparata 0:e7e920b85676 4365 * Description : Read XLDA
cparata 0:e7e920b85676 4366 * Input : Pointer to LSM6DSL_ACC_GYRO_XLDA_t
cparata 0:e7e920b85676 4367 * Output : Status of XLDA see LSM6DSL_ACC_GYRO_XLDA_t
cparata 0:e7e920b85676 4368 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4369 *******************************************************************************/
cparata 0:e7e920b85676 4370 status_t LSM6DSL_ACC_GYRO_R_XLDA(void *handle, LSM6DSL_ACC_GYRO_XLDA_t *value)
cparata 0:e7e920b85676 4371 {
cparata 0:e7e920b85676 4372 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_STATUS_REG, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4373 return MEMS_ERROR;
cparata 0:e7e920b85676 4374
cparata 0:e7e920b85676 4375 *value &= LSM6DSL_ACC_GYRO_XLDA_MASK; //mask
cparata 0:e7e920b85676 4376
cparata 0:e7e920b85676 4377 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4378 }
cparata 0:e7e920b85676 4379
cparata 0:e7e920b85676 4380 /*******************************************************************************
cparata 0:e7e920b85676 4381 * Function Name : LSM6DSL_ACC_GYRO_R_GDA
cparata 0:e7e920b85676 4382 * Description : Read GDA
cparata 0:e7e920b85676 4383 * Input : Pointer to LSM6DSL_ACC_GYRO_GDA_t
cparata 0:e7e920b85676 4384 * Output : Status of GDA see LSM6DSL_ACC_GYRO_GDA_t
cparata 0:e7e920b85676 4385 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4386 *******************************************************************************/
cparata 0:e7e920b85676 4387 status_t LSM6DSL_ACC_GYRO_R_GDA(void *handle, LSM6DSL_ACC_GYRO_GDA_t *value)
cparata 0:e7e920b85676 4388 {
cparata 0:e7e920b85676 4389 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_STATUS_REG, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4390 return MEMS_ERROR;
cparata 0:e7e920b85676 4391
cparata 0:e7e920b85676 4392 *value &= LSM6DSL_ACC_GYRO_GDA_MASK; //mask
cparata 0:e7e920b85676 4393
cparata 0:e7e920b85676 4394 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4395 }
cparata 0:e7e920b85676 4396
cparata 0:e7e920b85676 4397 /*******************************************************************************
cparata 0:e7e920b85676 4398 * Function Name : LSM6DSL_ACC_GYRO_R_TDA
cparata 0:e7e920b85676 4399 * Description : Read GDA
cparata 0:e7e920b85676 4400 * Input : Pointer to LSM6DSL_ACC_GYRO_TDA_t
cparata 0:e7e920b85676 4401 * Output : Status of GDA see LSM6DSL_ACC_GYRO_TDA_t
cparata 0:e7e920b85676 4402 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4403 *******************************************************************************/
cparata 0:e7e920b85676 4404 status_t LSM6DSL_ACC_GYRO_R_TDA(void *handle, LSM6DSL_ACC_GYRO_TDA_t *value)
cparata 0:e7e920b85676 4405 {
cparata 0:e7e920b85676 4406 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_STATUS_REG, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4407 return MEMS_ERROR;
cparata 0:e7e920b85676 4408
cparata 0:e7e920b85676 4409 *value &= LSM6DSL_ACC_GYRO_TDA_MASK; //mask
cparata 0:e7e920b85676 4410
cparata 0:e7e920b85676 4411 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4412 }
cparata 0:e7e920b85676 4413
cparata 0:e7e920b85676 4414 /*******************************************************************************
cparata 0:e7e920b85676 4415 * Function Name : LSM6DSL_ACC_GYRO_R_FIFONumOfEntries
cparata 0:e7e920b85676 4416 * Description : Read DIFF_FIFO
cparata 0:e7e920b85676 4417 * Input : Pointer to u16_t
cparata 0:e7e920b85676 4418 * Output : Status of DIFF_FIFO
cparata 0:e7e920b85676 4419 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4420 *******************************************************************************/
cparata 0:e7e920b85676 4421 status_t LSM6DSL_ACC_GYRO_R_FIFONumOfEntries(void *handle, u16_t *value)
cparata 0:e7e920b85676 4422 {
cparata 0:e7e920b85676 4423 u8_t valueH, valueL;
cparata 0:e7e920b85676 4424
cparata 0:e7e920b85676 4425 /* Low part from FIFO_STATUS1 */
cparata 0:e7e920b85676 4426 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS1, (u8_t *)&valueL, 1) )
cparata 0:e7e920b85676 4427 return MEMS_ERROR;
cparata 0:e7e920b85676 4428
cparata 0:e7e920b85676 4429 valueL &= LSM6DSL_ACC_GYRO_DIFF_FIFO_STATUS1_MASK; //coerce
cparata 0:e7e920b85676 4430 valueL = valueL >> LSM6DSL_ACC_GYRO_DIFF_FIFO_STATUS1_POSITION; //mask
cparata 0:e7e920b85676 4431
cparata 0:e7e920b85676 4432 /* High part from FIFO_STATUS2 */
cparata 0:e7e920b85676 4433 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS2, (u8_t *)&valueH, 1) )
cparata 0:e7e920b85676 4434 return MEMS_ERROR;
cparata 0:e7e920b85676 4435
cparata 0:e7e920b85676 4436 valueH &= LSM6DSL_ACC_GYRO_DIFF_FIFO_STATUS2_MASK; //coerce
cparata 0:e7e920b85676 4437 valueH = valueH >> LSM6DSL_ACC_GYRO_DIFF_FIFO_STATUS2_POSITION; //mask
cparata 0:e7e920b85676 4438
cparata 0:e7e920b85676 4439 *value = ((valueH << 8) & 0xFF00) | valueL;
cparata 0:e7e920b85676 4440
cparata 0:e7e920b85676 4441 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4442 }
cparata 0:e7e920b85676 4443
cparata 0:e7e920b85676 4444 /*******************************************************************************
cparata 0:e7e920b85676 4445 * Function Name : LSM6DSL_ACC_GYRO_R_FIFOEmpty
cparata 0:e7e920b85676 4446 * Description : Read FIFO_EMPTY
cparata 0:e7e920b85676 4447 * Input : Pointer to LSM6DSL_ACC_GYRO_FIFO_EMPTY_t
cparata 0:e7e920b85676 4448 * Output : Status of FIFO_EMPTY see LSM6DSL_ACC_GYRO_FIFO_EMPTY_t
cparata 0:e7e920b85676 4449 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4450 *******************************************************************************/
cparata 0:e7e920b85676 4451 status_t LSM6DSL_ACC_GYRO_R_FIFOEmpty(void *handle, LSM6DSL_ACC_GYRO_FIFO_EMPTY_t *value)
cparata 0:e7e920b85676 4452 {
cparata 0:e7e920b85676 4453 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS2, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4454 return MEMS_ERROR;
cparata 0:e7e920b85676 4455
cparata 0:e7e920b85676 4456 *value &= LSM6DSL_ACC_GYRO_FIFO_EMPTY_MASK; //mask
cparata 0:e7e920b85676 4457
cparata 0:e7e920b85676 4458 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4459 }
cparata 0:e7e920b85676 4460
cparata 0:e7e920b85676 4461 /*******************************************************************************
cparata 0:e7e920b85676 4462 * Function Name : LSM6DSL_ACC_GYRO_R_FIFOFull
cparata 0:e7e920b85676 4463 * Description : Read FIFO_FULL
cparata 0:e7e920b85676 4464 * Input : Pointer to LSM6DSL_ACC_GYRO_FIFO_FULL_t
cparata 0:e7e920b85676 4465 * Output : Status of FIFO_FULL see LSM6DSL_ACC_GYRO_FIFO_FULL_t
cparata 0:e7e920b85676 4466 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4467 *******************************************************************************/
cparata 0:e7e920b85676 4468 status_t LSM6DSL_ACC_GYRO_R_FIFOFull(void *handle, LSM6DSL_ACC_GYRO_FIFO_FULL_t *value)
cparata 0:e7e920b85676 4469 {
cparata 0:e7e920b85676 4470 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS2, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4471 return MEMS_ERROR;
cparata 0:e7e920b85676 4472
cparata 0:e7e920b85676 4473 *value &= LSM6DSL_ACC_GYRO_FIFO_FULL_MASK; //mask
cparata 0:e7e920b85676 4474
cparata 0:e7e920b85676 4475 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4476 }
cparata 0:e7e920b85676 4477
cparata 0:e7e920b85676 4478 /*******************************************************************************
cparata 0:e7e920b85676 4479 * Function Name : LSM6DSL_ACC_GYRO_R_OVERRUN
cparata 0:e7e920b85676 4480 * Description : Read OVERRUN
cparata 0:e7e920b85676 4481 * Input : Pointer to LSM6DSL_ACC_GYRO_OVERRUN_t
cparata 0:e7e920b85676 4482 * Output : Status of OVERRUN see LSM6DSL_ACC_GYRO_OVERRUN_t
cparata 0:e7e920b85676 4483 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4484 *******************************************************************************/
cparata 0:e7e920b85676 4485 status_t LSM6DSL_ACC_GYRO_R_OVERRUN(void *handle, LSM6DSL_ACC_GYRO_OVERRUN_t *value)
cparata 0:e7e920b85676 4486 {
cparata 0:e7e920b85676 4487 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS2, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4488 return MEMS_ERROR;
cparata 0:e7e920b85676 4489
cparata 0:e7e920b85676 4490 *value &= LSM6DSL_ACC_GYRO_OVERRUN_MASK; //mask
cparata 0:e7e920b85676 4491
cparata 0:e7e920b85676 4492 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4493 }
cparata 0:e7e920b85676 4494
cparata 0:e7e920b85676 4495 /*******************************************************************************
cparata 0:e7e920b85676 4496 * Function Name : LSM6DSL_ACC_GYRO_R_WaterMark
cparata 0:e7e920b85676 4497 * Description : Read WTM
cparata 0:e7e920b85676 4498 * Input : Pointer to LSM6DSL_ACC_GYRO_WTM_t
cparata 0:e7e920b85676 4499 * Output : Status of WTM see LSM6DSL_ACC_GYRO_WTM_t
cparata 0:e7e920b85676 4500 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4501 *******************************************************************************/
cparata 0:e7e920b85676 4502 status_t LSM6DSL_ACC_GYRO_R_WaterMark(void *handle, LSM6DSL_ACC_GYRO_WTM_t *value)
cparata 0:e7e920b85676 4503 {
cparata 0:e7e920b85676 4504 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS2, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4505 return MEMS_ERROR;
cparata 0:e7e920b85676 4506
cparata 0:e7e920b85676 4507 *value &= LSM6DSL_ACC_GYRO_WTM_MASK; //mask
cparata 0:e7e920b85676 4508
cparata 0:e7e920b85676 4509 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4510 }
cparata 0:e7e920b85676 4511
cparata 0:e7e920b85676 4512 /*******************************************************************************
cparata 0:e7e920b85676 4513 * Function Name : LSM6DSL_ACC_GYRO_R_FIFOPattern
cparata 0:e7e920b85676 4514 * Description : Read FIFO_PATTERN
cparata 0:e7e920b85676 4515 * Input : Pointer to u16_t
cparata 0:e7e920b85676 4516 * Output : Status of FIFO_PATTERN
cparata 0:e7e920b85676 4517 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4518 *******************************************************************************/
cparata 0:e7e920b85676 4519 status_t LSM6DSL_ACC_GYRO_R_FIFOPattern(void *handle, u16_t *value)
cparata 0:e7e920b85676 4520 {
cparata 0:e7e920b85676 4521 u8_t valueH, valueL;
cparata 0:e7e920b85676 4522
cparata 0:e7e920b85676 4523 /* Low part from FIFO_STATUS3 */
cparata 0:e7e920b85676 4524 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS3, (u8_t *)&valueL, 1) )
cparata 0:e7e920b85676 4525 return MEMS_ERROR;
cparata 0:e7e920b85676 4526
cparata 0:e7e920b85676 4527 valueL &= LSM6DSL_ACC_GYRO_FIFO_STATUS3_PATTERN_MASK; //coerce
cparata 0:e7e920b85676 4528 valueL = valueL >> LSM6DSL_ACC_GYRO_FIFO_STATUS3_PATTERN_POSITION; //mask
cparata 0:e7e920b85676 4529
cparata 0:e7e920b85676 4530 /* High part from FIFO_STATUS4 */
cparata 0:e7e920b85676 4531 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS4, (u8_t *)&valueH, 1) )
cparata 0:e7e920b85676 4532 return MEMS_ERROR;
cparata 0:e7e920b85676 4533
cparata 0:e7e920b85676 4534 valueH &= LSM6DSL_ACC_GYRO_FIFO_STATUS4_PATTERN_MASK; //coerce
cparata 0:e7e920b85676 4535 valueH = valueH >> LSM6DSL_ACC_GYRO_FIFO_STATUS4_PATTERN_POSITION; //mask
cparata 0:e7e920b85676 4536
cparata 0:e7e920b85676 4537 *value = ((valueH << 8) & 0xFF00) | valueL;
cparata 0:e7e920b85676 4538
cparata 0:e7e920b85676 4539 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4540 }
cparata 0:e7e920b85676 4541
cparata 0:e7e920b85676 4542 /*******************************************************************************
cparata 0:e7e920b85676 4543 * Function Name : LSM6DSL_ACC_GYRO_R_SENS_HUB_END
cparata 0:e7e920b85676 4544 * Description : Read SENS_HUB_END
cparata 0:e7e920b85676 4545 * Input : Pointer to LSM6DSL_ACC_GYRO_SENS_HUB_END_t
cparata 0:e7e920b85676 4546 * Output : Status of SENS_HUB_END see LSM6DSL_ACC_GYRO_SENS_HUB_END_t
cparata 0:e7e920b85676 4547 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4548 *******************************************************************************/
cparata 0:e7e920b85676 4549 status_t LSM6DSL_ACC_GYRO_R_SENS_HUB_END(void *handle, LSM6DSL_ACC_GYRO_SENS_HUB_END_t *value)
cparata 0:e7e920b85676 4550 {
cparata 0:e7e920b85676 4551 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4552 return MEMS_ERROR;
cparata 0:e7e920b85676 4553
cparata 0:e7e920b85676 4554 *value &= LSM6DSL_ACC_GYRO_SENS_HUB_END_MASK; //mask
cparata 0:e7e920b85676 4555
cparata 0:e7e920b85676 4556 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4557 }
cparata 0:e7e920b85676 4558
cparata 0:e7e920b85676 4559 /*******************************************************************************
cparata 0:e7e920b85676 4560 * Function Name : LSM6DSL_ACC_GYRO_R_SOFT_IRON_END
cparata 0:e7e920b85676 4561 * Description : Read SOFT_IRON_END
cparata 0:e7e920b85676 4562 * Input : Pointer to LSM6DSL_ACC_GYRO_SOFT_IRON_END_t
cparata 0:e7e920b85676 4563 * Output : Status of SOFT_IRON_END see LSM6DSL_ACC_GYRO_SOFT_IRON_END_t
cparata 0:e7e920b85676 4564 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4565 *******************************************************************************/
cparata 0:e7e920b85676 4566 status_t LSM6DSL_ACC_GYRO_R_SOFT_IRON_END(void *handle, LSM6DSL_ACC_GYRO_SOFT_IRON_END_t *value)
cparata 0:e7e920b85676 4567 {
cparata 0:e7e920b85676 4568 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4569 return MEMS_ERROR;
cparata 0:e7e920b85676 4570
cparata 0:e7e920b85676 4571 *value &= LSM6DSL_ACC_GYRO_SOFT_IRON_END_MASK; //mask
cparata 0:e7e920b85676 4572
cparata 0:e7e920b85676 4573 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4574 }
cparata 0:e7e920b85676 4575
cparata 0:e7e920b85676 4576 /*******************************************************************************
cparata 0:e7e920b85676 4577 * Function Name : LSM6DSL_ACC_GYRO_R_HardIron
cparata 0:e7e920b85676 4578 * Description : Read HI_FAIL
cparata 0:e7e920b85676 4579 * Input : Pointer to LSM6DSL_ACC_GYRO_SOFT_HARD_IRON_STAT_t
cparata 0:e7e920b85676 4580 * Output : Status of HI_FAIL see LSM6DSL_ACC_GYRO_SOFT_HARD_IRON_STAT_t
cparata 0:e7e920b85676 4581 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4582 *******************************************************************************/
cparata 0:e7e920b85676 4583 status_t LSM6DSL_ACC_GYRO_R_HardIron(void *handle, LSM6DSL_ACC_GYRO_SOFT_HARD_IRON_STAT_t *value)
cparata 0:e7e920b85676 4584 {
cparata 0:e7e920b85676 4585 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4586 return MEMS_ERROR;
cparata 0:e7e920b85676 4587
cparata 0:e7e920b85676 4588 *value &= LSM6DSL_ACC_GYRO_HARD_IRON_STAT_MASK; //mask
cparata 0:e7e920b85676 4589
cparata 0:e7e920b85676 4590 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4591 }
cparata 0:e7e920b85676 4592
cparata 0:e7e920b85676 4593 /*******************************************************************************
cparata 0:e7e920b85676 4594 * Function Name : LSM6DSL_ACC_GYRO_R_STEP_OVERFLOW
cparata 0:e7e920b85676 4595 * Description : Read STEP_OVERFLOW
cparata 0:e7e920b85676 4596 * Input : Pointer to LSM6DSL_ACC_GYRO_STEP_OVERFLOW_t
cparata 0:e7e920b85676 4597 * Output : Status of STEP_OVERFLOW see LSM6DSL_ACC_GYRO_STEP_OVERFLOW_t
cparata 0:e7e920b85676 4598 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4599 *******************************************************************************/
cparata 0:e7e920b85676 4600 status_t LSM6DSL_ACC_GYRO_R_STEP_OVERFLOW(void *handle, LSM6DSL_ACC_GYRO_STEP_OVERFLOW_t *value)
cparata 0:e7e920b85676 4601 {
cparata 0:e7e920b85676 4602 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4603 return MEMS_ERROR;
cparata 0:e7e920b85676 4604
cparata 0:e7e920b85676 4605 *value &= LSM6DSL_ACC_GYRO_STEP_OVERFLOW_MASK; //mask
cparata 0:e7e920b85676 4606
cparata 0:e7e920b85676 4607 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4608 }
cparata 0:e7e920b85676 4609
cparata 0:e7e920b85676 4610 /*******************************************************************************
cparata 0:e7e920b85676 4611 * Function Name : LSM6DSL_ACC_GYRO_R_STEP_COUNT_DELTA
cparata 0:e7e920b85676 4612 * Description : Read STEP_COUNT_DELTA_IA
cparata 0:e7e920b85676 4613 * Input : Pointer to LSM6DSL_ACC_GYRO_STEP_COUNT_DELTA_t
cparata 0:e7e920b85676 4614 * Output : Status of STEP_COUNT_DELTA_IA see LSM6DSL_ACC_GYRO_STEP_COUNT_DELTA_t
cparata 0:e7e920b85676 4615 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4616 *******************************************************************************/
cparata 0:e7e920b85676 4617 status_t LSM6DSL_ACC_GYRO_R_STEP_COUNT_DELTA(void *handle, LSM6DSL_ACC_GYRO_STEP_COUNT_DELTA_t *value)
cparata 0:e7e920b85676 4618 {
cparata 0:e7e920b85676 4619 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4620 return MEMS_ERROR;
cparata 0:e7e920b85676 4621
cparata 0:e7e920b85676 4622 *value &= LSM6DSL_ACC_GYRO_STEP_COUNT_DELTA_MASK; //mask
cparata 0:e7e920b85676 4623
cparata 0:e7e920b85676 4624 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4625 }
cparata 0:e7e920b85676 4626
cparata 0:e7e920b85676 4627 /*******************************************************************************
cparata 0:e7e920b85676 4628 * Function Name : LSM6DSL_ACC_GYRO_R_PEDO_EV_STATUS
cparata 0:e7e920b85676 4629 * Description : Read PEDO_EV_STATUS
cparata 0:e7e920b85676 4630 * Input : Pointer to LSM6DSL_ACC_GYRO_PEDO_EV_STATUS_t
cparata 0:e7e920b85676 4631 * Output : Status of PEDO_EV_STATUS see LSM6DSL_ACC_GYRO_PEDO_EV_STATUS_t
cparata 0:e7e920b85676 4632 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4633 *******************************************************************************/
cparata 0:e7e920b85676 4634 status_t LSM6DSL_ACC_GYRO_R_PEDO_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_PEDO_EV_STATUS_t *value)
cparata 0:e7e920b85676 4635 {
cparata 0:e7e920b85676 4636 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4637 return MEMS_ERROR;
cparata 0:e7e920b85676 4638
cparata 0:e7e920b85676 4639 *value &= LSM6DSL_ACC_GYRO_PEDO_EV_STATUS_MASK; //mask
cparata 0:e7e920b85676 4640
cparata 0:e7e920b85676 4641 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4642 }
cparata 0:e7e920b85676 4643
cparata 0:e7e920b85676 4644 /*******************************************************************************
cparata 0:e7e920b85676 4645 * Function Name : LSM6DSL_ACC_GYRO_R_TILT_EV_STATUS
cparata 0:e7e920b85676 4646 * Description : Read TILT_EV_STATUS
cparata 0:e7e920b85676 4647 * Input : Pointer to LSM6DSL_ACC_GYRO_TILT_EV_STATUS_t
cparata 0:e7e920b85676 4648 * Output : Status of TILT_EV_STATUS see LSM6DSL_ACC_GYRO_TILT_EV_STATUS_t
cparata 0:e7e920b85676 4649 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4650 *******************************************************************************/
cparata 0:e7e920b85676 4651 status_t LSM6DSL_ACC_GYRO_R_TILT_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_TILT_EV_STATUS_t *value)
cparata 0:e7e920b85676 4652 {
cparata 0:e7e920b85676 4653 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4654 return MEMS_ERROR;
cparata 0:e7e920b85676 4655
cparata 0:e7e920b85676 4656 *value &= LSM6DSL_ACC_GYRO_TILT_EV_STATUS_MASK; //mask
cparata 0:e7e920b85676 4657
cparata 0:e7e920b85676 4658 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4659 }
cparata 0:e7e920b85676 4660
cparata 0:e7e920b85676 4661 /*******************************************************************************
cparata 0:e7e920b85676 4662 * Function Name : LSM6DSL_ACC_GYRO_R_SIGN_MOT_EV_STATUS
cparata 0:e7e920b85676 4663 * Description : Read SIGN_MOT_EV_STATUS
cparata 0:e7e920b85676 4664 * Input : Pointer to LSM6DSL_ACC_GYRO_SIGN_MOT_EV_STATUS_t
cparata 0:e7e920b85676 4665 * Output : Status of SIGN_MOT_EV_STATUS see LSM6DSL_ACC_GYRO_SIGN_MOT_EV_STATUS_t
cparata 0:e7e920b85676 4666 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4667 *******************************************************************************/
cparata 0:e7e920b85676 4668 status_t LSM6DSL_ACC_GYRO_R_SIGN_MOT_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_SIGN_MOT_EV_STATUS_t *value)
cparata 0:e7e920b85676 4669 {
cparata 0:e7e920b85676 4670 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4671 return MEMS_ERROR;
cparata 0:e7e920b85676 4672
cparata 0:e7e920b85676 4673 *value &= LSM6DSL_ACC_GYRO_SIGN_MOT_EV_STATUS_MASK; //mask
cparata 0:e7e920b85676 4674
cparata 0:e7e920b85676 4675 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4676 }
cparata 0:e7e920b85676 4677
cparata 0:e7e920b85676 4678 /*******************************************************************************
cparata 0:e7e920b85676 4679 * Function Name : LSM6DSL_ACC_GYRO_W_LIR
cparata 0:e7e920b85676 4680 * Description : Write LIR
cparata 0:e7e920b85676 4681 * Input : LSM6DSL_ACC_GYRO_LIR_t
cparata 0:e7e920b85676 4682 * Output : None
cparata 0:e7e920b85676 4683 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4684 *******************************************************************************/
cparata 0:e7e920b85676 4685 status_t LSM6DSL_ACC_GYRO_W_LIR(void *handle, LSM6DSL_ACC_GYRO_LIR_t newValue)
cparata 0:e7e920b85676 4686 {
cparata 0:e7e920b85676 4687 u8_t value;
cparata 0:e7e920b85676 4688
cparata 0:e7e920b85676 4689 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:e7e920b85676 4690 return MEMS_ERROR;
cparata 0:e7e920b85676 4691
cparata 0:e7e920b85676 4692 value &= ~LSM6DSL_ACC_GYRO_LIR_MASK;
cparata 0:e7e920b85676 4693 value |= newValue;
cparata 0:e7e920b85676 4694
cparata 0:e7e920b85676 4695 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:e7e920b85676 4696 return MEMS_ERROR;
cparata 0:e7e920b85676 4697
cparata 0:e7e920b85676 4698 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4699 }
cparata 0:e7e920b85676 4700
cparata 0:e7e920b85676 4701 /*******************************************************************************
cparata 0:e7e920b85676 4702 * Function Name : LSM6DSL_ACC_GYRO_R_LIR
cparata 0:e7e920b85676 4703 * Description : Read LIR
cparata 0:e7e920b85676 4704 * Input : Pointer to LSM6DSL_ACC_GYRO_LIR_t
cparata 0:e7e920b85676 4705 * Output : Status of LIR see LSM6DSL_ACC_GYRO_LIR_t
cparata 0:e7e920b85676 4706 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4707 *******************************************************************************/
cparata 0:e7e920b85676 4708 status_t LSM6DSL_ACC_GYRO_R_LIR(void *handle, LSM6DSL_ACC_GYRO_LIR_t *value)
cparata 0:e7e920b85676 4709 {
cparata 0:e7e920b85676 4710 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4711 return MEMS_ERROR;
cparata 0:e7e920b85676 4712
cparata 0:e7e920b85676 4713 *value &= LSM6DSL_ACC_GYRO_LIR_MASK; //mask
cparata 0:e7e920b85676 4714
cparata 0:e7e920b85676 4715 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4716 }
cparata 0:e7e920b85676 4717
cparata 0:e7e920b85676 4718 /*******************************************************************************
cparata 0:e7e920b85676 4719 * Function Name : LSM6DSL_ACC_GYRO_W_TAP_Z_EN
cparata 0:e7e920b85676 4720 * Description : Write TAP_Z_EN
cparata 0:e7e920b85676 4721 * Input : LSM6DSL_ACC_GYRO_TAP_Z_EN_t
cparata 0:e7e920b85676 4722 * Output : None
cparata 0:e7e920b85676 4723 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4724 *******************************************************************************/
cparata 0:e7e920b85676 4725 status_t LSM6DSL_ACC_GYRO_W_TAP_Z_EN(void *handle, LSM6DSL_ACC_GYRO_TAP_Z_EN_t newValue)
cparata 0:e7e920b85676 4726 {
cparata 0:e7e920b85676 4727 u8_t value;
cparata 0:e7e920b85676 4728
cparata 0:e7e920b85676 4729 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:e7e920b85676 4730 return MEMS_ERROR;
cparata 0:e7e920b85676 4731
cparata 0:e7e920b85676 4732 value &= ~LSM6DSL_ACC_GYRO_TAP_Z_EN_MASK;
cparata 0:e7e920b85676 4733 value |= newValue;
cparata 0:e7e920b85676 4734
cparata 0:e7e920b85676 4735 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:e7e920b85676 4736 return MEMS_ERROR;
cparata 0:e7e920b85676 4737
cparata 0:e7e920b85676 4738 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4739 }
cparata 0:e7e920b85676 4740
cparata 0:e7e920b85676 4741 /*******************************************************************************
cparata 0:e7e920b85676 4742 * Function Name : LSM6DSL_ACC_GYRO_R_TAP_Z_EN
cparata 0:e7e920b85676 4743 * Description : Read TAP_Z_EN
cparata 0:e7e920b85676 4744 * Input : Pointer to LSM6DSL_ACC_GYRO_TAP_Z_EN_t
cparata 0:e7e920b85676 4745 * Output : Status of TAP_Z_EN see LSM6DSL_ACC_GYRO_TAP_Z_EN_t
cparata 0:e7e920b85676 4746 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4747 *******************************************************************************/
cparata 0:e7e920b85676 4748 status_t LSM6DSL_ACC_GYRO_R_TAP_Z_EN(void *handle, LSM6DSL_ACC_GYRO_TAP_Z_EN_t *value)
cparata 0:e7e920b85676 4749 {
cparata 0:e7e920b85676 4750 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4751 return MEMS_ERROR;
cparata 0:e7e920b85676 4752
cparata 0:e7e920b85676 4753 *value &= LSM6DSL_ACC_GYRO_TAP_Z_EN_MASK; //mask
cparata 0:e7e920b85676 4754
cparata 0:e7e920b85676 4755 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4756 }
cparata 0:e7e920b85676 4757
cparata 0:e7e920b85676 4758 /*******************************************************************************
cparata 0:e7e920b85676 4759 * Function Name : LSM6DSL_ACC_GYRO_W_TAP_Y_EN
cparata 0:e7e920b85676 4760 * Description : Write TAP_Y_EN
cparata 0:e7e920b85676 4761 * Input : LSM6DSL_ACC_GYRO_TAP_Y_EN_t
cparata 0:e7e920b85676 4762 * Output : None
cparata 0:e7e920b85676 4763 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4764 *******************************************************************************/
cparata 0:e7e920b85676 4765 status_t LSM6DSL_ACC_GYRO_W_TAP_Y_EN(void *handle, LSM6DSL_ACC_GYRO_TAP_Y_EN_t newValue)
cparata 0:e7e920b85676 4766 {
cparata 0:e7e920b85676 4767 u8_t value;
cparata 0:e7e920b85676 4768
cparata 0:e7e920b85676 4769 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:e7e920b85676 4770 return MEMS_ERROR;
cparata 0:e7e920b85676 4771
cparata 0:e7e920b85676 4772 value &= ~LSM6DSL_ACC_GYRO_TAP_Y_EN_MASK;
cparata 0:e7e920b85676 4773 value |= newValue;
cparata 0:e7e920b85676 4774
cparata 0:e7e920b85676 4775 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:e7e920b85676 4776 return MEMS_ERROR;
cparata 0:e7e920b85676 4777
cparata 0:e7e920b85676 4778 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4779 }
cparata 0:e7e920b85676 4780
cparata 0:e7e920b85676 4781 /*******************************************************************************
cparata 0:e7e920b85676 4782 * Function Name : LSM6DSL_ACC_GYRO_R_TAP_Y_EN
cparata 0:e7e920b85676 4783 * Description : Read TAP_Y_EN
cparata 0:e7e920b85676 4784 * Input : Pointer to LSM6DSL_ACC_GYRO_TAP_Y_EN_t
cparata 0:e7e920b85676 4785 * Output : Status of TAP_Y_EN see LSM6DSL_ACC_GYRO_TAP_Y_EN_t
cparata 0:e7e920b85676 4786 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4787 *******************************************************************************/
cparata 0:e7e920b85676 4788 status_t LSM6DSL_ACC_GYRO_R_TAP_Y_EN(void *handle, LSM6DSL_ACC_GYRO_TAP_Y_EN_t *value)
cparata 0:e7e920b85676 4789 {
cparata 0:e7e920b85676 4790 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4791 return MEMS_ERROR;
cparata 0:e7e920b85676 4792
cparata 0:e7e920b85676 4793 *value &= LSM6DSL_ACC_GYRO_TAP_Y_EN_MASK; //mask
cparata 0:e7e920b85676 4794
cparata 0:e7e920b85676 4795 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4796 }
cparata 0:e7e920b85676 4797
cparata 0:e7e920b85676 4798 /*******************************************************************************
cparata 0:e7e920b85676 4799 * Function Name : LSM6DSL_ACC_GYRO_W_TAP_X_EN
cparata 0:e7e920b85676 4800 * Description : Write TAP_X_EN
cparata 0:e7e920b85676 4801 * Input : LSM6DSL_ACC_GYRO_TAP_X_EN_t
cparata 0:e7e920b85676 4802 * Output : None
cparata 0:e7e920b85676 4803 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4804 *******************************************************************************/
cparata 0:e7e920b85676 4805 status_t LSM6DSL_ACC_GYRO_W_TAP_X_EN(void *handle, LSM6DSL_ACC_GYRO_TAP_X_EN_t newValue)
cparata 0:e7e920b85676 4806 {
cparata 0:e7e920b85676 4807 u8_t value;
cparata 0:e7e920b85676 4808
cparata 0:e7e920b85676 4809 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:e7e920b85676 4810 return MEMS_ERROR;
cparata 0:e7e920b85676 4811
cparata 0:e7e920b85676 4812 value &= ~LSM6DSL_ACC_GYRO_TAP_X_EN_MASK;
cparata 0:e7e920b85676 4813 value |= newValue;
cparata 0:e7e920b85676 4814
cparata 0:e7e920b85676 4815 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:e7e920b85676 4816 return MEMS_ERROR;
cparata 0:e7e920b85676 4817
cparata 0:e7e920b85676 4818 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4819 }
cparata 0:e7e920b85676 4820
cparata 0:e7e920b85676 4821 /*******************************************************************************
cparata 0:e7e920b85676 4822 * Function Name : LSM6DSL_ACC_GYRO_R_TAP_X_EN
cparata 0:e7e920b85676 4823 * Description : Read TAP_X_EN
cparata 0:e7e920b85676 4824 * Input : Pointer to LSM6DSL_ACC_GYRO_TAP_X_EN_t
cparata 0:e7e920b85676 4825 * Output : Status of TAP_X_EN see LSM6DSL_ACC_GYRO_TAP_X_EN_t
cparata 0:e7e920b85676 4826 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4827 *******************************************************************************/
cparata 0:e7e920b85676 4828 status_t LSM6DSL_ACC_GYRO_R_TAP_X_EN(void *handle, LSM6DSL_ACC_GYRO_TAP_X_EN_t *value)
cparata 0:e7e920b85676 4829 {
cparata 0:e7e920b85676 4830 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4831 return MEMS_ERROR;
cparata 0:e7e920b85676 4832
cparata 0:e7e920b85676 4833 *value &= LSM6DSL_ACC_GYRO_TAP_X_EN_MASK; //mask
cparata 0:e7e920b85676 4834
cparata 0:e7e920b85676 4835 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4836 }
cparata 0:e7e920b85676 4837
cparata 0:e7e920b85676 4838 /*******************************************************************************
cparata 0:e7e920b85676 4839 * Function Name : LSM6DSL_ACC_GYRO_W_SLOPE_FDS
cparata 0:e7e920b85676 4840 * Description : Write SLOPE_FDS
cparata 0:e7e920b85676 4841 * Input : LSM6DSL_ACC_GYRO_SLOPE_FDS_t
cparata 0:e7e920b85676 4842 * Output : None
cparata 0:e7e920b85676 4843 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4844 *******************************************************************************/
cparata 0:e7e920b85676 4845 status_t LSM6DSL_ACC_GYRO_W_SLOPE_FDS(void *handle, LSM6DSL_ACC_GYRO_SLOPE_FDS_t newValue)
cparata 0:e7e920b85676 4846 {
cparata 0:e7e920b85676 4847 u8_t value;
cparata 0:e7e920b85676 4848
cparata 0:e7e920b85676 4849 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:e7e920b85676 4850 return MEMS_ERROR;
cparata 0:e7e920b85676 4851
cparata 0:e7e920b85676 4852 value &= ~LSM6DSL_ACC_GYRO_SLOPE_FDS_MASK;
cparata 0:e7e920b85676 4853 value |= newValue;
cparata 0:e7e920b85676 4854
cparata 0:e7e920b85676 4855 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:e7e920b85676 4856 return MEMS_ERROR;
cparata 0:e7e920b85676 4857
cparata 0:e7e920b85676 4858 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4859 }
cparata 0:e7e920b85676 4860
cparata 0:e7e920b85676 4861 /*******************************************************************************
cparata 0:e7e920b85676 4862 * Function Name : LSM6DSL_ACC_GYRO_R_SLOPE_FDS
cparata 0:e7e920b85676 4863 * Description : Read SLOPE_FDS
cparata 0:e7e920b85676 4864 * Input : Pointer to LSM6DSL_ACC_GYRO_SLOPE_FDS_t
cparata 0:e7e920b85676 4865 * Output : Status of SLOPE_FDS see LSM6DSL_ACC_GYRO_SLOPE_FDS_t
cparata 0:e7e920b85676 4866 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4867 *******************************************************************************/
cparata 0:e7e920b85676 4868 status_t LSM6DSL_ACC_GYRO_R_SLOPE_FDS(void *handle, LSM6DSL_ACC_GYRO_SLOPE_FDS_t *value)
cparata 0:e7e920b85676 4869 {
cparata 0:e7e920b85676 4870 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4871 return MEMS_ERROR;
cparata 0:e7e920b85676 4872
cparata 0:e7e920b85676 4873 *value &= LSM6DSL_ACC_GYRO_SLOPE_FDS_MASK; //mask
cparata 0:e7e920b85676 4874
cparata 0:e7e920b85676 4875 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4876 }
cparata 0:e7e920b85676 4877
cparata 0:e7e920b85676 4878 /*******************************************************************************
cparata 0:e7e920b85676 4879 * Function Name : LSM6DSL_ACC_GYRO_W_BASIC_INT
cparata 0:e7e920b85676 4880 * Description : Write INTERRUPTS_ENABLE
cparata 0:e7e920b85676 4881 * Input : LSM6DSL_ACC_GYRO_INT_EN_t
cparata 0:e7e920b85676 4882 * Output : None
cparata 0:e7e920b85676 4883 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4884 *******************************************************************************/
cparata 0:e7e920b85676 4885 status_t LSM6DSL_ACC_GYRO_W_BASIC_INT(void *handle, LSM6DSL_ACC_GYRO_INT_EN_t newValue)
cparata 0:e7e920b85676 4886 {
cparata 0:e7e920b85676 4887 u8_t value;
cparata 0:e7e920b85676 4888
cparata 0:e7e920b85676 4889 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:e7e920b85676 4890 return MEMS_ERROR;
cparata 0:e7e920b85676 4891
cparata 0:e7e920b85676 4892 value &= ~LSM6DSL_ACC_GYRO_INT_EN_MASK;
cparata 0:e7e920b85676 4893 value |= newValue;
cparata 0:e7e920b85676 4894
cparata 0:e7e920b85676 4895 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:e7e920b85676 4896 return MEMS_ERROR;
cparata 0:e7e920b85676 4897
cparata 0:e7e920b85676 4898 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4899 }
cparata 0:e7e920b85676 4900
cparata 0:e7e920b85676 4901 /*******************************************************************************
cparata 0:e7e920b85676 4902 * Function Name : LSM6DSL_ACC_GYRO_R_BASIC_INT
cparata 0:e7e920b85676 4903 * Description : Read INTERRUPTS_ENABLE
cparata 0:e7e920b85676 4904 * Input : Pointer to LSM6DSL_ACC_GYRO_INT_EN_t
cparata 0:e7e920b85676 4905 * Output : Status of INTERRUPTS_ENABLE see LSM6DSL_ACC_GYRO_INT_EN_t
cparata 0:e7e920b85676 4906 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4907 *******************************************************************************/
cparata 0:e7e920b85676 4908 status_t LSM6DSL_ACC_GYRO_R_BASIC_INT(void *handle, LSM6DSL_ACC_GYRO_INT_EN_t *value)
cparata 0:e7e920b85676 4909 {
cparata 0:e7e920b85676 4910 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4911 return MEMS_ERROR;
cparata 0:e7e920b85676 4912
cparata 0:e7e920b85676 4913 *value &= LSM6DSL_ACC_GYRO_INT_EN_MASK; //mask
cparata 0:e7e920b85676 4914
cparata 0:e7e920b85676 4915 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4916 }
cparata 0:e7e920b85676 4917
cparata 0:e7e920b85676 4918 /*******************************************************************************
cparata 0:e7e920b85676 4919 * Function Name : LSM6DSL_ACC_GYRO_W_TAP_THS
cparata 0:e7e920b85676 4920 * Description : Write TAP_THS
cparata 0:e7e920b85676 4921 * Input : u8_t
cparata 0:e7e920b85676 4922 * Output : None
cparata 0:e7e920b85676 4923 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4924 *******************************************************************************/
cparata 0:e7e920b85676 4925 status_t LSM6DSL_ACC_GYRO_W_TAP_THS(void *handle, u8_t newValue)
cparata 0:e7e920b85676 4926 {
cparata 0:e7e920b85676 4927 u8_t value;
cparata 0:e7e920b85676 4928
cparata 0:e7e920b85676 4929 newValue = newValue << LSM6DSL_ACC_GYRO_TAP_THS_POSITION; //mask
cparata 0:e7e920b85676 4930 newValue &= LSM6DSL_ACC_GYRO_TAP_THS_MASK; //coerce
cparata 0:e7e920b85676 4931
cparata 0:e7e920b85676 4932 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, &value, 1) )
cparata 0:e7e920b85676 4933 return MEMS_ERROR;
cparata 0:e7e920b85676 4934
cparata 0:e7e920b85676 4935 value &= ~LSM6DSL_ACC_GYRO_TAP_THS_MASK;
cparata 0:e7e920b85676 4936 value |= newValue;
cparata 0:e7e920b85676 4937
cparata 0:e7e920b85676 4938 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, &value, 1) )
cparata 0:e7e920b85676 4939 return MEMS_ERROR;
cparata 0:e7e920b85676 4940
cparata 0:e7e920b85676 4941 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4942 }
cparata 0:e7e920b85676 4943
cparata 0:e7e920b85676 4944 /*******************************************************************************
cparata 0:e7e920b85676 4945 * Function Name : LSM6DSL_ACC_GYRO_R_TAP_THS
cparata 0:e7e920b85676 4946 * Description : Read TAP_THS
cparata 0:e7e920b85676 4947 * Input : Pointer to u8_t
cparata 0:e7e920b85676 4948 * Output : Status of TAP_THS
cparata 0:e7e920b85676 4949 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4950 *******************************************************************************/
cparata 0:e7e920b85676 4951 status_t LSM6DSL_ACC_GYRO_R_TAP_THS(void *handle, u8_t *value)
cparata 0:e7e920b85676 4952 {
cparata 0:e7e920b85676 4953 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4954 return MEMS_ERROR;
cparata 0:e7e920b85676 4955
cparata 0:e7e920b85676 4956 *value &= LSM6DSL_ACC_GYRO_TAP_THS_MASK; //coerce
cparata 0:e7e920b85676 4957 *value = *value >> LSM6DSL_ACC_GYRO_TAP_THS_POSITION; //mask
cparata 0:e7e920b85676 4958
cparata 0:e7e920b85676 4959 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4960 }
cparata 0:e7e920b85676 4961
cparata 0:e7e920b85676 4962 /*******************************************************************************
cparata 0:e7e920b85676 4963 * Function Name : LSM6DSL_ACC_GYRO_W_SIXD_THS
cparata 0:e7e920b85676 4964 * Description : Write SIXD_THS
cparata 0:e7e920b85676 4965 * Input : LSM6DSL_ACC_GYRO_SIXD_THS_t
cparata 0:e7e920b85676 4966 * Output : None
cparata 0:e7e920b85676 4967 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4968 *******************************************************************************/
cparata 0:e7e920b85676 4969 status_t LSM6DSL_ACC_GYRO_W_SIXD_THS(void *handle, LSM6DSL_ACC_GYRO_SIXD_THS_t newValue)
cparata 0:e7e920b85676 4970 {
cparata 0:e7e920b85676 4971 u8_t value;
cparata 0:e7e920b85676 4972
cparata 0:e7e920b85676 4973 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, &value, 1) )
cparata 0:e7e920b85676 4974 return MEMS_ERROR;
cparata 0:e7e920b85676 4975
cparata 0:e7e920b85676 4976 value &= ~LSM6DSL_ACC_GYRO_SIXD_THS_MASK;
cparata 0:e7e920b85676 4977 value |= newValue;
cparata 0:e7e920b85676 4978
cparata 0:e7e920b85676 4979 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, &value, 1) )
cparata 0:e7e920b85676 4980 return MEMS_ERROR;
cparata 0:e7e920b85676 4981
cparata 0:e7e920b85676 4982 return MEMS_SUCCESS;
cparata 0:e7e920b85676 4983 }
cparata 0:e7e920b85676 4984
cparata 0:e7e920b85676 4985 /*******************************************************************************
cparata 0:e7e920b85676 4986 * Function Name : LSM6DSL_ACC_GYRO_R_SIXD_THS
cparata 0:e7e920b85676 4987 * Description : Read SIXD_THS
cparata 0:e7e920b85676 4988 * Input : Pointer to LSM6DSL_ACC_GYRO_SIXD_THS_t
cparata 0:e7e920b85676 4989 * Output : Status of SIXD_THS see LSM6DSL_ACC_GYRO_SIXD_THS_t
cparata 0:e7e920b85676 4990 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 4991 *******************************************************************************/
cparata 0:e7e920b85676 4992 status_t LSM6DSL_ACC_GYRO_R_SIXD_THS(void *handle, LSM6DSL_ACC_GYRO_SIXD_THS_t *value)
cparata 0:e7e920b85676 4993 {
cparata 0:e7e920b85676 4994 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, (u8_t *)value, 1) )
cparata 0:e7e920b85676 4995 return MEMS_ERROR;
cparata 0:e7e920b85676 4996
cparata 0:e7e920b85676 4997 *value &= LSM6DSL_ACC_GYRO_SIXD_THS_MASK; //mask
cparata 0:e7e920b85676 4998
cparata 0:e7e920b85676 4999 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5000 }
cparata 0:e7e920b85676 5001
cparata 0:e7e920b85676 5002 /*******************************************************************************
cparata 0:e7e920b85676 5003 * Function Name : LSM6DSL_ACC_GYRO_W_D4D
cparata 0:e7e920b85676 5004 * Description : Write D4D_EN
cparata 0:e7e920b85676 5005 * Input : LSM6DSL_ACC_GYRO_D4D_t
cparata 0:e7e920b85676 5006 * Output : None
cparata 0:e7e920b85676 5007 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5008 *******************************************************************************/
cparata 0:e7e920b85676 5009 status_t LSM6DSL_ACC_GYRO_W_D4D(void *handle, LSM6DSL_ACC_GYRO_D4D_t newValue)
cparata 0:e7e920b85676 5010 {
cparata 0:e7e920b85676 5011 u8_t value;
cparata 0:e7e920b85676 5012
cparata 0:e7e920b85676 5013 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, &value, 1) )
cparata 0:e7e920b85676 5014 return MEMS_ERROR;
cparata 0:e7e920b85676 5015
cparata 0:e7e920b85676 5016 value &= ~LSM6DSL_ACC_GYRO_D4D_MASK;
cparata 0:e7e920b85676 5017 value |= newValue;
cparata 0:e7e920b85676 5018
cparata 0:e7e920b85676 5019 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, &value, 1) )
cparata 0:e7e920b85676 5020 return MEMS_ERROR;
cparata 0:e7e920b85676 5021
cparata 0:e7e920b85676 5022 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5023 }
cparata 0:e7e920b85676 5024
cparata 0:e7e920b85676 5025 /*******************************************************************************
cparata 0:e7e920b85676 5026 * Function Name : LSM6DSL_ACC_GYRO_R_D4D
cparata 0:e7e920b85676 5027 * Description : Read D4D_EN
cparata 0:e7e920b85676 5028 * Input : Pointer to LSM6DSL_ACC_GYRO_D4D_t
cparata 0:e7e920b85676 5029 * Output : Status of D4D_EN see LSM6DSL_ACC_GYRO_D4D_t
cparata 0:e7e920b85676 5030 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5031 *******************************************************************************/
cparata 0:e7e920b85676 5032 status_t LSM6DSL_ACC_GYRO_R_D4D(void *handle, LSM6DSL_ACC_GYRO_D4D_t *value)
cparata 0:e7e920b85676 5033 {
cparata 0:e7e920b85676 5034 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, (u8_t *)value, 1) )
cparata 0:e7e920b85676 5035 return MEMS_ERROR;
cparata 0:e7e920b85676 5036
cparata 0:e7e920b85676 5037 *value &= LSM6DSL_ACC_GYRO_D4D_MASK; //mask
cparata 0:e7e920b85676 5038
cparata 0:e7e920b85676 5039 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5040 }
cparata 0:e7e920b85676 5041
cparata 0:e7e920b85676 5042 /*******************************************************************************
cparata 0:e7e920b85676 5043 * Function Name : LSM6DSL_ACC_GYRO_W_SHOCK_Duration
cparata 0:e7e920b85676 5044 * Description : Write SHOCK
cparata 0:e7e920b85676 5045 * Input : u8_t
cparata 0:e7e920b85676 5046 * Output : None
cparata 0:e7e920b85676 5047 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5048 *******************************************************************************/
cparata 0:e7e920b85676 5049 status_t LSM6DSL_ACC_GYRO_W_SHOCK_Duration(void *handle, u8_t newValue)
cparata 0:e7e920b85676 5050 {
cparata 0:e7e920b85676 5051 u8_t value;
cparata 0:e7e920b85676 5052
cparata 0:e7e920b85676 5053 newValue = newValue << LSM6DSL_ACC_GYRO_SHOCK_POSITION; //mask
cparata 0:e7e920b85676 5054 newValue &= LSM6DSL_ACC_GYRO_SHOCK_MASK; //coerce
cparata 0:e7e920b85676 5055
cparata 0:e7e920b85676 5056 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, &value, 1) )
cparata 0:e7e920b85676 5057 return MEMS_ERROR;
cparata 0:e7e920b85676 5058
cparata 0:e7e920b85676 5059 value &= ~LSM6DSL_ACC_GYRO_SHOCK_MASK;
cparata 0:e7e920b85676 5060 value |= newValue;
cparata 0:e7e920b85676 5061
cparata 0:e7e920b85676 5062 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, &value, 1) )
cparata 0:e7e920b85676 5063 return MEMS_ERROR;
cparata 0:e7e920b85676 5064
cparata 0:e7e920b85676 5065 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5066 }
cparata 0:e7e920b85676 5067
cparata 0:e7e920b85676 5068 /*******************************************************************************
cparata 0:e7e920b85676 5069 * Function Name : LSM6DSL_ACC_GYRO_R_SHOCK_Duration
cparata 0:e7e920b85676 5070 * Description : Read SHOCK
cparata 0:e7e920b85676 5071 * Input : Pointer to u8_t
cparata 0:e7e920b85676 5072 * Output : Status of SHOCK
cparata 0:e7e920b85676 5073 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5074 *******************************************************************************/
cparata 0:e7e920b85676 5075 status_t LSM6DSL_ACC_GYRO_R_SHOCK_Duration(void *handle, u8_t *value)
cparata 0:e7e920b85676 5076 {
cparata 0:e7e920b85676 5077 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, (u8_t *)value, 1) )
cparata 0:e7e920b85676 5078 return MEMS_ERROR;
cparata 0:e7e920b85676 5079
cparata 0:e7e920b85676 5080 *value &= LSM6DSL_ACC_GYRO_SHOCK_MASK; //coerce
cparata 0:e7e920b85676 5081 *value = *value >> LSM6DSL_ACC_GYRO_SHOCK_POSITION; //mask
cparata 0:e7e920b85676 5082
cparata 0:e7e920b85676 5083 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5084 }
cparata 0:e7e920b85676 5085 /*******************************************************************************
cparata 0:e7e920b85676 5086 * Function Name : LSM6DSL_ACC_GYRO_W_QUIET_Duration
cparata 0:e7e920b85676 5087 * Description : Write QUIET
cparata 0:e7e920b85676 5088 * Input : u8_t
cparata 0:e7e920b85676 5089 * Output : None
cparata 0:e7e920b85676 5090 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5091 *******************************************************************************/
cparata 0:e7e920b85676 5092 status_t LSM6DSL_ACC_GYRO_W_QUIET_Duration(void *handle, u8_t newValue)
cparata 0:e7e920b85676 5093 {
cparata 0:e7e920b85676 5094 u8_t value;
cparata 0:e7e920b85676 5095
cparata 0:e7e920b85676 5096 newValue = newValue << LSM6DSL_ACC_GYRO_QUIET_POSITION; //mask
cparata 0:e7e920b85676 5097 newValue &= LSM6DSL_ACC_GYRO_QUIET_MASK; //coerce
cparata 0:e7e920b85676 5098
cparata 0:e7e920b85676 5099 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, &value, 1) )
cparata 0:e7e920b85676 5100 return MEMS_ERROR;
cparata 0:e7e920b85676 5101
cparata 0:e7e920b85676 5102 value &= ~LSM6DSL_ACC_GYRO_QUIET_MASK;
cparata 0:e7e920b85676 5103 value |= newValue;
cparata 0:e7e920b85676 5104
cparata 0:e7e920b85676 5105 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, &value, 1) )
cparata 0:e7e920b85676 5106 return MEMS_ERROR;
cparata 0:e7e920b85676 5107
cparata 0:e7e920b85676 5108 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5109 }
cparata 0:e7e920b85676 5110
cparata 0:e7e920b85676 5111 /*******************************************************************************
cparata 0:e7e920b85676 5112 * Function Name : LSM6DSL_ACC_GYRO_R_QUIET_Duration
cparata 0:e7e920b85676 5113 * Description : Read QUIET
cparata 0:e7e920b85676 5114 * Input : Pointer to u8_t
cparata 0:e7e920b85676 5115 * Output : Status of QUIET
cparata 0:e7e920b85676 5116 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5117 *******************************************************************************/
cparata 0:e7e920b85676 5118 status_t LSM6DSL_ACC_GYRO_R_QUIET_Duration(void *handle, u8_t *value)
cparata 0:e7e920b85676 5119 {
cparata 0:e7e920b85676 5120 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, (u8_t *)value, 1) )
cparata 0:e7e920b85676 5121 return MEMS_ERROR;
cparata 0:e7e920b85676 5122
cparata 0:e7e920b85676 5123 *value &= LSM6DSL_ACC_GYRO_QUIET_MASK; //coerce
cparata 0:e7e920b85676 5124 *value = *value >> LSM6DSL_ACC_GYRO_QUIET_POSITION; //mask
cparata 0:e7e920b85676 5125
cparata 0:e7e920b85676 5126 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5127 }
cparata 0:e7e920b85676 5128
cparata 0:e7e920b85676 5129 /*******************************************************************************
cparata 0:e7e920b85676 5130 * Function Name : LSM6DSL_ACC_GYRO_W_DUR
cparata 0:e7e920b85676 5131 * Description : Write DUR
cparata 0:e7e920b85676 5132 * Input : u8_t
cparata 0:e7e920b85676 5133 * Output : None
cparata 0:e7e920b85676 5134 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5135 *******************************************************************************/
cparata 0:e7e920b85676 5136 status_t LSM6DSL_ACC_GYRO_W_DUR(void *handle, u8_t newValue)
cparata 0:e7e920b85676 5137 {
cparata 0:e7e920b85676 5138 u8_t value;
cparata 0:e7e920b85676 5139
cparata 0:e7e920b85676 5140 newValue = newValue << LSM6DSL_ACC_GYRO_DUR_POSITION; //mask
cparata 0:e7e920b85676 5141 newValue &= LSM6DSL_ACC_GYRO_DUR_MASK; //coerce
cparata 0:e7e920b85676 5142
cparata 0:e7e920b85676 5143 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, &value, 1) )
cparata 0:e7e920b85676 5144 return MEMS_ERROR;
cparata 0:e7e920b85676 5145
cparata 0:e7e920b85676 5146 value &= ~LSM6DSL_ACC_GYRO_DUR_MASK;
cparata 0:e7e920b85676 5147 value |= newValue;
cparata 0:e7e920b85676 5148
cparata 0:e7e920b85676 5149 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, &value, 1) )
cparata 0:e7e920b85676 5150 return MEMS_ERROR;
cparata 0:e7e920b85676 5151
cparata 0:e7e920b85676 5152 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5153 }
cparata 0:e7e920b85676 5154
cparata 0:e7e920b85676 5155 /*******************************************************************************
cparata 0:e7e920b85676 5156 * Function Name : LSM6DSL_ACC_GYRO_R_DUR
cparata 0:e7e920b85676 5157 * Description : Read DUR
cparata 0:e7e920b85676 5158 * Input : Pointer to u8_t
cparata 0:e7e920b85676 5159 * Output : Status of DUR
cparata 0:e7e920b85676 5160 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5161 *******************************************************************************/
cparata 0:e7e920b85676 5162 status_t LSM6DSL_ACC_GYRO_R_DUR(void *handle, u8_t *value)
cparata 0:e7e920b85676 5163 {
cparata 0:e7e920b85676 5164 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, (u8_t *)value, 1) )
cparata 0:e7e920b85676 5165 return MEMS_ERROR;
cparata 0:e7e920b85676 5166
cparata 0:e7e920b85676 5167 *value &= LSM6DSL_ACC_GYRO_DUR_MASK; //coerce
cparata 0:e7e920b85676 5168 *value = *value >> LSM6DSL_ACC_GYRO_DUR_POSITION; //mask
cparata 0:e7e920b85676 5169
cparata 0:e7e920b85676 5170 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5171 }
cparata 0:e7e920b85676 5172
cparata 0:e7e920b85676 5173 /*******************************************************************************
cparata 0:e7e920b85676 5174 * Function Name : LSM6DSL_ACC_GYRO_W_WK_THS
cparata 0:e7e920b85676 5175 * Description : Write WK_THS
cparata 0:e7e920b85676 5176 * Input : u8_t
cparata 0:e7e920b85676 5177 * Output : None
cparata 0:e7e920b85676 5178 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5179 *******************************************************************************/
cparata 0:e7e920b85676 5180 status_t LSM6DSL_ACC_GYRO_W_WK_THS(void *handle, u8_t newValue)
cparata 0:e7e920b85676 5181 {
cparata 0:e7e920b85676 5182 u8_t value;
cparata 0:e7e920b85676 5183
cparata 0:e7e920b85676 5184 newValue = newValue << LSM6DSL_ACC_GYRO_WK_THS_POSITION; //mask
cparata 0:e7e920b85676 5185 newValue &= LSM6DSL_ACC_GYRO_WK_THS_MASK; //coerce
cparata 0:e7e920b85676 5186
cparata 0:e7e920b85676 5187 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_THS, &value, 1) )
cparata 0:e7e920b85676 5188 return MEMS_ERROR;
cparata 0:e7e920b85676 5189
cparata 0:e7e920b85676 5190 value &= ~LSM6DSL_ACC_GYRO_WK_THS_MASK;
cparata 0:e7e920b85676 5191 value |= newValue;
cparata 0:e7e920b85676 5192
cparata 0:e7e920b85676 5193 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_THS, &value, 1) )
cparata 0:e7e920b85676 5194 return MEMS_ERROR;
cparata 0:e7e920b85676 5195
cparata 0:e7e920b85676 5196 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5197 }
cparata 0:e7e920b85676 5198
cparata 0:e7e920b85676 5199 /*******************************************************************************
cparata 0:e7e920b85676 5200 * Function Name : LSM6DSL_ACC_GYRO_R_WK_THS
cparata 0:e7e920b85676 5201 * Description : Read WK_THS
cparata 0:e7e920b85676 5202 * Input : Pointer to u8_t
cparata 0:e7e920b85676 5203 * Output : Status of WK_THS
cparata 0:e7e920b85676 5204 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5205 *******************************************************************************/
cparata 0:e7e920b85676 5206 status_t LSM6DSL_ACC_GYRO_R_WK_THS(void *handle, u8_t *value)
cparata 0:e7e920b85676 5207 {
cparata 0:e7e920b85676 5208 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_THS, (u8_t *)value, 1) )
cparata 0:e7e920b85676 5209 return MEMS_ERROR;
cparata 0:e7e920b85676 5210
cparata 0:e7e920b85676 5211 *value &= LSM6DSL_ACC_GYRO_WK_THS_MASK; //coerce
cparata 0:e7e920b85676 5212 *value = *value >> LSM6DSL_ACC_GYRO_WK_THS_POSITION; //mask
cparata 0:e7e920b85676 5213
cparata 0:e7e920b85676 5214 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5215 }
cparata 0:e7e920b85676 5216
cparata 0:e7e920b85676 5217 /*******************************************************************************
cparata 0:e7e920b85676 5218 * Function Name : LSM6DSL_ACC_GYRO_W_SINGLE_DOUBLE_TAP_EV
cparata 0:e7e920b85676 5219 * Description : Write SINGLE_DOUBLE_TAP
cparata 0:e7e920b85676 5220 * Input : LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_t
cparata 0:e7e920b85676 5221 * Output : None
cparata 0:e7e920b85676 5222 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5223 *******************************************************************************/
cparata 0:e7e920b85676 5224 status_t LSM6DSL_ACC_GYRO_W_SINGLE_DOUBLE_TAP_EV(void *handle, LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_t newValue)
cparata 0:e7e920b85676 5225 {
cparata 0:e7e920b85676 5226 u8_t value;
cparata 0:e7e920b85676 5227
cparata 0:e7e920b85676 5228 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_THS, &value, 1) )
cparata 0:e7e920b85676 5229 return MEMS_ERROR;
cparata 0:e7e920b85676 5230
cparata 0:e7e920b85676 5231 value &= ~LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_MASK;
cparata 0:e7e920b85676 5232 value |= newValue;
cparata 0:e7e920b85676 5233
cparata 0:e7e920b85676 5234 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_THS, &value, 1) )
cparata 0:e7e920b85676 5235 return MEMS_ERROR;
cparata 0:e7e920b85676 5236
cparata 0:e7e920b85676 5237 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5238 }
cparata 0:e7e920b85676 5239
cparata 0:e7e920b85676 5240 /*******************************************************************************
cparata 0:e7e920b85676 5241 * Function Name : LSM6DSL_ACC_GYRO_R_SINGLE_DOUBLE_TAP_EV
cparata 0:e7e920b85676 5242 * Description : Read SINGLE_DOUBLE_TAP
cparata 0:e7e920b85676 5243 * Input : Pointer to LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_t
cparata 0:e7e920b85676 5244 * Output : Status of SINGLE_DOUBLE_TAP see LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_t
cparata 0:e7e920b85676 5245 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5246 *******************************************************************************/
cparata 0:e7e920b85676 5247 status_t LSM6DSL_ACC_GYRO_R_SINGLE_DOUBLE_TAP_EV(void *handle, LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_t *value)
cparata 0:e7e920b85676 5248 {
cparata 0:e7e920b85676 5249 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_THS, (u8_t *)value, 1) )
cparata 0:e7e920b85676 5250 return MEMS_ERROR;
cparata 0:e7e920b85676 5251
cparata 0:e7e920b85676 5252 *value &= LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_MASK; //mask
cparata 0:e7e920b85676 5253
cparata 0:e7e920b85676 5254 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5255 }
cparata 0:e7e920b85676 5256
cparata 0:e7e920b85676 5257 /*******************************************************************************
cparata 0:e7e920b85676 5258 * Function Name : LSM6DSL_ACC_GYRO_W_SLEEP_DUR
cparata 0:e7e920b85676 5259 * Description : Write SLEEP_DUR
cparata 0:e7e920b85676 5260 * Input : u8_t
cparata 0:e7e920b85676 5261 * Output : None
cparata 0:e7e920b85676 5262 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5263 *******************************************************************************/
cparata 0:e7e920b85676 5264 status_t LSM6DSL_ACC_GYRO_W_SLEEP_DUR(void *handle, u8_t newValue)
cparata 0:e7e920b85676 5265 {
cparata 0:e7e920b85676 5266 u8_t value;
cparata 0:e7e920b85676 5267
cparata 0:e7e920b85676 5268 newValue = newValue << LSM6DSL_ACC_GYRO_SLEEP_DUR_POSITION; //mask
cparata 0:e7e920b85676 5269 newValue &= LSM6DSL_ACC_GYRO_SLEEP_DUR_MASK; //coerce
cparata 0:e7e920b85676 5270
cparata 0:e7e920b85676 5271 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
cparata 0:e7e920b85676 5272 return MEMS_ERROR;
cparata 0:e7e920b85676 5273
cparata 0:e7e920b85676 5274 value &= ~LSM6DSL_ACC_GYRO_SLEEP_DUR_MASK;
cparata 0:e7e920b85676 5275 value |= newValue;
cparata 0:e7e920b85676 5276
cparata 0:e7e920b85676 5277 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
cparata 0:e7e920b85676 5278 return MEMS_ERROR;
cparata 0:e7e920b85676 5279
cparata 0:e7e920b85676 5280 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5281 }
cparata 0:e7e920b85676 5282
cparata 0:e7e920b85676 5283 /*******************************************************************************
cparata 0:e7e920b85676 5284 * Function Name : LSM6DSL_ACC_GYRO_R_SLEEP_DUR
cparata 0:e7e920b85676 5285 * Description : Read SLEEP_DUR
cparata 0:e7e920b85676 5286 * Input : Pointer to u8_t
cparata 0:e7e920b85676 5287 * Output : Status of SLEEP_DUR
cparata 0:e7e920b85676 5288 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5289 *******************************************************************************/
cparata 0:e7e920b85676 5290 status_t LSM6DSL_ACC_GYRO_R_SLEEP_DUR(void *handle, u8_t *value)
cparata 0:e7e920b85676 5291 {
cparata 0:e7e920b85676 5292 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, (u8_t *)value, 1) )
cparata 0:e7e920b85676 5293 return MEMS_ERROR;
cparata 0:e7e920b85676 5294
cparata 0:e7e920b85676 5295 *value &= LSM6DSL_ACC_GYRO_SLEEP_DUR_MASK; //coerce
cparata 0:e7e920b85676 5296 *value = *value >> LSM6DSL_ACC_GYRO_SLEEP_DUR_POSITION; //mask
cparata 0:e7e920b85676 5297
cparata 0:e7e920b85676 5298 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5299 }
cparata 0:e7e920b85676 5300
cparata 0:e7e920b85676 5301 /*******************************************************************************
cparata 0:e7e920b85676 5302 * Function Name : LSM6DSL_ACC_GYRO_W_TIMER_HR
cparata 0:e7e920b85676 5303 * Description : Write TIMER_HR
cparata 0:e7e920b85676 5304 * Input : LSM6DSL_ACC_GYRO_TIMER_HR_t
cparata 0:e7e920b85676 5305 * Output : None
cparata 0:e7e920b85676 5306 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5307 *******************************************************************************/
cparata 0:e7e920b85676 5308 status_t LSM6DSL_ACC_GYRO_W_TIMER_HR(void *handle, LSM6DSL_ACC_GYRO_TIMER_HR_t newValue)
cparata 0:e7e920b85676 5309 {
cparata 0:e7e920b85676 5310 u8_t value;
cparata 0:e7e920b85676 5311
cparata 0:e7e920b85676 5312 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
cparata 0:e7e920b85676 5313 return MEMS_ERROR;
cparata 0:e7e920b85676 5314
cparata 0:e7e920b85676 5315 value &= ~LSM6DSL_ACC_GYRO_TIMER_HR_MASK;
cparata 0:e7e920b85676 5316 value |= newValue;
cparata 0:e7e920b85676 5317
cparata 0:e7e920b85676 5318 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
cparata 0:e7e920b85676 5319 return MEMS_ERROR;
cparata 0:e7e920b85676 5320
cparata 0:e7e920b85676 5321 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5322 }
cparata 0:e7e920b85676 5323
cparata 0:e7e920b85676 5324 /*******************************************************************************
cparata 0:e7e920b85676 5325 * Function Name : LSM6DSL_ACC_GYRO_R_TIMER_HR
cparata 0:e7e920b85676 5326 * Description : Read TIMER_HR
cparata 0:e7e920b85676 5327 * Input : Pointer to LSM6DSL_ACC_GYRO_TIMER_HR_t
cparata 0:e7e920b85676 5328 * Output : Status of TIMER_HR see LSM6DSL_ACC_GYRO_TIMER_HR_t
cparata 0:e7e920b85676 5329 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5330 *******************************************************************************/
cparata 0:e7e920b85676 5331 status_t LSM6DSL_ACC_GYRO_R_TIMER_HR(void *handle, LSM6DSL_ACC_GYRO_TIMER_HR_t *value)
cparata 0:e7e920b85676 5332 {
cparata 0:e7e920b85676 5333 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, (u8_t *)value, 1) )
cparata 0:e7e920b85676 5334 return MEMS_ERROR;
cparata 0:e7e920b85676 5335
cparata 0:e7e920b85676 5336 *value &= LSM6DSL_ACC_GYRO_TIMER_HR_MASK; //mask
cparata 0:e7e920b85676 5337
cparata 0:e7e920b85676 5338 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5339 }
cparata 0:e7e920b85676 5340
cparata 0:e7e920b85676 5341 /*******************************************************************************
cparata 0:e7e920b85676 5342 * Function Name : LSM6DSL_ACC_GYRO_W_WAKE_DUR
cparata 0:e7e920b85676 5343 * Description : Write WAKE_DUR
cparata 0:e7e920b85676 5344 * Input : u8_t
cparata 0:e7e920b85676 5345 * Output : None
cparata 0:e7e920b85676 5346 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5347 *******************************************************************************/
cparata 0:e7e920b85676 5348 status_t LSM6DSL_ACC_GYRO_W_WAKE_DUR(void *handle, u8_t newValue)
cparata 0:e7e920b85676 5349 {
cparata 0:e7e920b85676 5350 u8_t value;
cparata 0:e7e920b85676 5351
cparata 0:e7e920b85676 5352 newValue = newValue << LSM6DSL_ACC_GYRO_WAKE_DUR_POSITION; //mask
cparata 0:e7e920b85676 5353 newValue &= LSM6DSL_ACC_GYRO_WAKE_DUR_MASK; //coerce
cparata 0:e7e920b85676 5354
cparata 0:e7e920b85676 5355 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
cparata 0:e7e920b85676 5356 return MEMS_ERROR;
cparata 0:e7e920b85676 5357
cparata 0:e7e920b85676 5358 value &= ~LSM6DSL_ACC_GYRO_WAKE_DUR_MASK;
cparata 0:e7e920b85676 5359 value |= newValue;
cparata 0:e7e920b85676 5360
cparata 0:e7e920b85676 5361 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
cparata 0:e7e920b85676 5362 return MEMS_ERROR;
cparata 0:e7e920b85676 5363
cparata 0:e7e920b85676 5364 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5365 }
cparata 0:e7e920b85676 5366
cparata 0:e7e920b85676 5367 /*******************************************************************************
cparata 0:e7e920b85676 5368 * Function Name : LSM6DSL_ACC_GYRO_R_WAKE_DUR
cparata 0:e7e920b85676 5369 * Description : Read WAKE_DUR
cparata 0:e7e920b85676 5370 * Input : Pointer to u8_t
cparata 0:e7e920b85676 5371 * Output : Status of WAKE_DUR
cparata 0:e7e920b85676 5372 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5373 *******************************************************************************/
cparata 0:e7e920b85676 5374 status_t LSM6DSL_ACC_GYRO_R_WAKE_DUR(void *handle, u8_t *value)
cparata 0:e7e920b85676 5375 {
cparata 0:e7e920b85676 5376 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, (u8_t *)value, 1) )
cparata 0:e7e920b85676 5377 return MEMS_ERROR;
cparata 0:e7e920b85676 5378
cparata 0:e7e920b85676 5379 *value &= LSM6DSL_ACC_GYRO_WAKE_DUR_MASK; //coerce
cparata 0:e7e920b85676 5380 *value = *value >> LSM6DSL_ACC_GYRO_WAKE_DUR_POSITION; //mask
cparata 0:e7e920b85676 5381
cparata 0:e7e920b85676 5382 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5383 }
cparata 0:e7e920b85676 5384
cparata 0:e7e920b85676 5385 /*******************************************************************************
cparata 0:e7e920b85676 5386 * Function Name : LSM6DSL_ACC_GYRO_W_FF_THS
cparata 0:e7e920b85676 5387 * Description : Write FF_THS
cparata 0:e7e920b85676 5388 * Input : LSM6DSL_ACC_GYRO_FF_THS_t
cparata 0:e7e920b85676 5389 * Output : None
cparata 0:e7e920b85676 5390 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5391 *******************************************************************************/
cparata 0:e7e920b85676 5392 status_t LSM6DSL_ACC_GYRO_W_FF_THS(void *handle, LSM6DSL_ACC_GYRO_FF_THS_t newValue)
cparata 0:e7e920b85676 5393 {
cparata 0:e7e920b85676 5394 u8_t value;
cparata 0:e7e920b85676 5395
cparata 0:e7e920b85676 5396 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FREE_FALL, &value, 1) )
cparata 0:e7e920b85676 5397 return MEMS_ERROR;
cparata 0:e7e920b85676 5398
cparata 0:e7e920b85676 5399 value &= ~LSM6DSL_ACC_GYRO_FF_THS_MASK;
cparata 0:e7e920b85676 5400 value |= newValue;
cparata 0:e7e920b85676 5401
cparata 0:e7e920b85676 5402 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FREE_FALL, &value, 1) )
cparata 0:e7e920b85676 5403 return MEMS_ERROR;
cparata 0:e7e920b85676 5404
cparata 0:e7e920b85676 5405 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5406 }
cparata 0:e7e920b85676 5407
cparata 0:e7e920b85676 5408 /*******************************************************************************
cparata 0:e7e920b85676 5409 * Function Name : LSM6DSL_ACC_GYRO_R_FF_THS
cparata 0:e7e920b85676 5410 * Description : Read FF_THS
cparata 0:e7e920b85676 5411 * Input : Pointer to LSM6DSL_ACC_GYRO_FF_THS_t
cparata 0:e7e920b85676 5412 * Output : Status of FF_THS see LSM6DSL_ACC_GYRO_FF_THS_t
cparata 0:e7e920b85676 5413 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5414 *******************************************************************************/
cparata 0:e7e920b85676 5415 status_t LSM6DSL_ACC_GYRO_R_FF_THS(void *handle, LSM6DSL_ACC_GYRO_FF_THS_t *value)
cparata 0:e7e920b85676 5416 {
cparata 0:e7e920b85676 5417 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FREE_FALL, (u8_t *)value, 1) )
cparata 0:e7e920b85676 5418 return MEMS_ERROR;
cparata 0:e7e920b85676 5419
cparata 0:e7e920b85676 5420 *value &= LSM6DSL_ACC_GYRO_FF_THS_MASK; //mask
cparata 0:e7e920b85676 5421
cparata 0:e7e920b85676 5422 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5423 }
cparata 0:e7e920b85676 5424
cparata 0:e7e920b85676 5425 /*******************************************************************************
cparata 0:e7e920b85676 5426 * Function Name : LSM6DSL_ACC_GYRO_W_FF_Duration
cparata 0:e7e920b85676 5427 * Description : Write FF_DUR
cparata 0:e7e920b85676 5428 * Input : u8_t
cparata 0:e7e920b85676 5429 * Output : None
cparata 0:e7e920b85676 5430 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5431 *******************************************************************************/
cparata 0:e7e920b85676 5432 status_t LSM6DSL_ACC_GYRO_W_FF_Duration(void *handle, u8_t newValue)
cparata 0:e7e920b85676 5433 {
cparata 0:e7e920b85676 5434 u8_t valueH, valueL;
cparata 0:e7e920b85676 5435 u8_t value;
cparata 0:e7e920b85676 5436
cparata 0:e7e920b85676 5437 valueL = newValue & 0x1F;
cparata 0:e7e920b85676 5438 valueH = (newValue >> 5) & 0x1;
cparata 0:e7e920b85676 5439
cparata 0:e7e920b85676 5440 /* Low part in FREE_FALL reg */
cparata 0:e7e920b85676 5441 valueL = valueL << LSM6DSL_ACC_GYRO_FF_FREE_FALL_DUR_POSITION; //mask
cparata 0:e7e920b85676 5442 valueL &= LSM6DSL_ACC_GYRO_FF_FREE_FALL_DUR_MASK; //coerce
cparata 0:e7e920b85676 5443
cparata 0:e7e920b85676 5444 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FREE_FALL, &value, 1) )
cparata 0:e7e920b85676 5445 return MEMS_ERROR;
cparata 0:e7e920b85676 5446
cparata 0:e7e920b85676 5447 value &= ~LSM6DSL_ACC_GYRO_FF_FREE_FALL_DUR_MASK;
cparata 0:e7e920b85676 5448 value |= valueL;
cparata 0:e7e920b85676 5449
cparata 0:e7e920b85676 5450 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FREE_FALL, &value, 1) )
cparata 0:e7e920b85676 5451 return MEMS_ERROR;
cparata 0:e7e920b85676 5452
cparata 0:e7e920b85676 5453 /* High part in WAKE_UP_DUR reg */
cparata 0:e7e920b85676 5454 valueH = valueH << LSM6DSL_ACC_GYRO_FF_WAKE_UP_DUR_POSITION; //mask
cparata 0:e7e920b85676 5455 valueH &= LSM6DSL_ACC_GYRO_FF_WAKE_UP_DUR_MASK; //coerce
cparata 0:e7e920b85676 5456
cparata 0:e7e920b85676 5457 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
cparata 0:e7e920b85676 5458 return MEMS_ERROR;
cparata 0:e7e920b85676 5459
cparata 0:e7e920b85676 5460 value &= ~LSM6DSL_ACC_GYRO_FF_WAKE_UP_DUR_MASK;
cparata 0:e7e920b85676 5461 value |= valueH;
cparata 0:e7e920b85676 5462
cparata 0:e7e920b85676 5463 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
cparata 0:e7e920b85676 5464 return MEMS_ERROR;
cparata 0:e7e920b85676 5465
cparata 0:e7e920b85676 5466 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5467 }
cparata 0:e7e920b85676 5468
cparata 0:e7e920b85676 5469 /*******************************************************************************
cparata 0:e7e920b85676 5470 * Function Name : LSM6DSL_ACC_GYRO_R_FF_Duration
cparata 0:e7e920b85676 5471 * Description : Read FF_DUR
cparata 0:e7e920b85676 5472 * Input : Pointer to u8_t
cparata 0:e7e920b85676 5473 * Output : Status of FF_DUR
cparata 0:e7e920b85676 5474 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5475 *******************************************************************************/
cparata 0:e7e920b85676 5476 status_t LSM6DSL_ACC_GYRO_R_FF_Duration(void *handle, u8_t *value)
cparata 0:e7e920b85676 5477 {
cparata 0:e7e920b85676 5478 u8_t valueH, valueL;
cparata 0:e7e920b85676 5479
cparata 0:e7e920b85676 5480 /* Low part from FREE_FALL reg */
cparata 0:e7e920b85676 5481 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FREE_FALL, (u8_t *)&valueL, 1) )
cparata 0:e7e920b85676 5482 return MEMS_ERROR;
cparata 0:e7e920b85676 5483
cparata 0:e7e920b85676 5484 valueL &= LSM6DSL_ACC_GYRO_FF_FREE_FALL_DUR_MASK; //coerce
cparata 0:e7e920b85676 5485 valueL = valueL >> LSM6DSL_ACC_GYRO_FF_FREE_FALL_DUR_POSITION; //mask
cparata 0:e7e920b85676 5486
cparata 0:e7e920b85676 5487 /* High part from WAKE_UP_DUR reg */
cparata 0:e7e920b85676 5488 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, (u8_t *)&valueH, 1) )
cparata 0:e7e920b85676 5489 return MEMS_ERROR;
cparata 0:e7e920b85676 5490
cparata 0:e7e920b85676 5491 valueH &= LSM6DSL_ACC_GYRO_FF_WAKE_UP_DUR_MASK; //coerce
cparata 0:e7e920b85676 5492 valueH = valueH >> LSM6DSL_ACC_GYRO_FF_WAKE_UP_DUR_POSITION; //mask
cparata 0:e7e920b85676 5493
cparata 0:e7e920b85676 5494 *value = ((valueH << 5) & 0x20) | valueL;
cparata 0:e7e920b85676 5495
cparata 0:e7e920b85676 5496 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5497 }
cparata 0:e7e920b85676 5498
cparata 0:e7e920b85676 5499 /*******************************************************************************
cparata 0:e7e920b85676 5500 * Function Name : LSM6DSL_ACC_GYRO_W_TimerEvRouteInt1
cparata 0:e7e920b85676 5501 * Description : Write INT1_TIMER
cparata 0:e7e920b85676 5502 * Input : LSM6DSL_ACC_GYRO_INT1_TIMER_t
cparata 0:e7e920b85676 5503 * Output : None
cparata 0:e7e920b85676 5504 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5505 *******************************************************************************/
cparata 0:e7e920b85676 5506 status_t LSM6DSL_ACC_GYRO_W_TimerEvRouteInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_TIMER_t newValue)
cparata 0:e7e920b85676 5507 {
cparata 0:e7e920b85676 5508 u8_t value;
cparata 0:e7e920b85676 5509
cparata 0:e7e920b85676 5510 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:e7e920b85676 5511 return MEMS_ERROR;
cparata 0:e7e920b85676 5512
cparata 0:e7e920b85676 5513 value &= ~LSM6DSL_ACC_GYRO_INT1_TIMER_MASK;
cparata 0:e7e920b85676 5514 value |= newValue;
cparata 0:e7e920b85676 5515
cparata 0:e7e920b85676 5516 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:e7e920b85676 5517 return MEMS_ERROR;
cparata 0:e7e920b85676 5518
cparata 0:e7e920b85676 5519 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5520 }
cparata 0:e7e920b85676 5521
cparata 0:e7e920b85676 5522 /*******************************************************************************
cparata 0:e7e920b85676 5523 * Function Name : LSM6DSL_ACC_GYRO_R_TimerEvRouteInt1
cparata 0:e7e920b85676 5524 * Description : Read INT1_TIMER
cparata 0:e7e920b85676 5525 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_TIMER_t
cparata 0:e7e920b85676 5526 * Output : Status of INT1_TIMER see LSM6DSL_ACC_GYRO_INT1_TIMER_t
cparata 0:e7e920b85676 5527 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5528 *******************************************************************************/
cparata 0:e7e920b85676 5529 status_t LSM6DSL_ACC_GYRO_R_TimerEvRouteInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_TIMER_t *value)
cparata 0:e7e920b85676 5530 {
cparata 0:e7e920b85676 5531 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
cparata 0:e7e920b85676 5532 return MEMS_ERROR;
cparata 0:e7e920b85676 5533
cparata 0:e7e920b85676 5534 *value &= LSM6DSL_ACC_GYRO_INT1_TIMER_MASK; //mask
cparata 0:e7e920b85676 5535
cparata 0:e7e920b85676 5536 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5537 }
cparata 0:e7e920b85676 5538
cparata 0:e7e920b85676 5539 /*******************************************************************************
cparata 0:e7e920b85676 5540 * Function Name : LSM6DSL_ACC_GYRO_W_TiltEvOnInt1
cparata 0:e7e920b85676 5541 * Description : Write INT1_TILT
cparata 0:e7e920b85676 5542 * Input : LSM6DSL_ACC_GYRO_INT1_TILT_t
cparata 0:e7e920b85676 5543 * Output : None
cparata 0:e7e920b85676 5544 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5545 *******************************************************************************/
cparata 0:e7e920b85676 5546 status_t LSM6DSL_ACC_GYRO_W_TiltEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_TILT_t newValue)
cparata 0:e7e920b85676 5547 {
cparata 0:e7e920b85676 5548 u8_t value;
cparata 0:e7e920b85676 5549
cparata 0:e7e920b85676 5550 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:e7e920b85676 5551 return MEMS_ERROR;
cparata 0:e7e920b85676 5552
cparata 0:e7e920b85676 5553 value &= ~LSM6DSL_ACC_GYRO_INT1_TILT_MASK;
cparata 0:e7e920b85676 5554 value |= newValue;
cparata 0:e7e920b85676 5555
cparata 0:e7e920b85676 5556 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:e7e920b85676 5557 return MEMS_ERROR;
cparata 0:e7e920b85676 5558
cparata 0:e7e920b85676 5559 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5560 }
cparata 0:e7e920b85676 5561
cparata 0:e7e920b85676 5562 /*******************************************************************************
cparata 0:e7e920b85676 5563 * Function Name : LSM6DSL_ACC_GYRO_R_TiltEvOnInt1
cparata 0:e7e920b85676 5564 * Description : Read INT1_TILT
cparata 0:e7e920b85676 5565 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_TILT_t
cparata 0:e7e920b85676 5566 * Output : Status of INT1_TILT see LSM6DSL_ACC_GYRO_INT1_TILT_t
cparata 0:e7e920b85676 5567 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5568 *******************************************************************************/
cparata 0:e7e920b85676 5569 status_t LSM6DSL_ACC_GYRO_R_TiltEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_TILT_t *value)
cparata 0:e7e920b85676 5570 {
cparata 0:e7e920b85676 5571 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
cparata 0:e7e920b85676 5572 return MEMS_ERROR;
cparata 0:e7e920b85676 5573
cparata 0:e7e920b85676 5574 *value &= LSM6DSL_ACC_GYRO_INT1_TILT_MASK; //mask
cparata 0:e7e920b85676 5575
cparata 0:e7e920b85676 5576 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5577 }
cparata 0:e7e920b85676 5578
cparata 0:e7e920b85676 5579 /*******************************************************************************
cparata 0:e7e920b85676 5580 * Function Name : LSM6DSL_ACC_GYRO_W_6DEvOnInt1
cparata 0:e7e920b85676 5581 * Description : Write INT1_6D
cparata 0:e7e920b85676 5582 * Input : LSM6DSL_ACC_GYRO_INT1_6D_t
cparata 0:e7e920b85676 5583 * Output : None
cparata 0:e7e920b85676 5584 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5585 *******************************************************************************/
cparata 0:e7e920b85676 5586 status_t LSM6DSL_ACC_GYRO_W_6DEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_6D_t newValue)
cparata 0:e7e920b85676 5587 {
cparata 0:e7e920b85676 5588 u8_t value;
cparata 0:e7e920b85676 5589
cparata 0:e7e920b85676 5590 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:e7e920b85676 5591 return MEMS_ERROR;
cparata 0:e7e920b85676 5592
cparata 0:e7e920b85676 5593 value &= ~LSM6DSL_ACC_GYRO_INT1_6D_MASK;
cparata 0:e7e920b85676 5594 value |= newValue;
cparata 0:e7e920b85676 5595
cparata 0:e7e920b85676 5596 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:e7e920b85676 5597 return MEMS_ERROR;
cparata 0:e7e920b85676 5598
cparata 0:e7e920b85676 5599 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5600 }
cparata 0:e7e920b85676 5601
cparata 0:e7e920b85676 5602 /*******************************************************************************
cparata 0:e7e920b85676 5603 * Function Name : LSM6DSL_ACC_GYRO_R_6DEvOnInt1
cparata 0:e7e920b85676 5604 * Description : Read INT1_6D
cparata 0:e7e920b85676 5605 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_6D_t
cparata 0:e7e920b85676 5606 * Output : Status of INT1_6D see LSM6DSL_ACC_GYRO_INT1_6D_t
cparata 0:e7e920b85676 5607 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5608 *******************************************************************************/
cparata 0:e7e920b85676 5609 status_t LSM6DSL_ACC_GYRO_R_6DEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_6D_t *value)
cparata 0:e7e920b85676 5610 {
cparata 0:e7e920b85676 5611 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
cparata 0:e7e920b85676 5612 return MEMS_ERROR;
cparata 0:e7e920b85676 5613
cparata 0:e7e920b85676 5614 *value &= LSM6DSL_ACC_GYRO_INT1_6D_MASK; //mask
cparata 0:e7e920b85676 5615
cparata 0:e7e920b85676 5616 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5617 }
cparata 0:e7e920b85676 5618
cparata 0:e7e920b85676 5619 /*******************************************************************************
cparata 0:e7e920b85676 5620 * Function Name : LSM6DSL_ACC_GYRO_W_TapEvOnInt1
cparata 0:e7e920b85676 5621 * Description : Write INT1_TAP
cparata 0:e7e920b85676 5622 * Input : LSM6DSL_ACC_GYRO_INT1_TAP_t
cparata 0:e7e920b85676 5623 * Output : None
cparata 0:e7e920b85676 5624 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5625 *******************************************************************************/
cparata 0:e7e920b85676 5626 status_t LSM6DSL_ACC_GYRO_W_TapEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_TAP_t newValue)
cparata 0:e7e920b85676 5627 {
cparata 0:e7e920b85676 5628 u8_t value;
cparata 0:e7e920b85676 5629
cparata 0:e7e920b85676 5630 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:e7e920b85676 5631 return MEMS_ERROR;
cparata 0:e7e920b85676 5632
cparata 0:e7e920b85676 5633 value &= ~LSM6DSL_ACC_GYRO_INT1_TAP_MASK;
cparata 0:e7e920b85676 5634 value |= newValue;
cparata 0:e7e920b85676 5635
cparata 0:e7e920b85676 5636 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:e7e920b85676 5637 return MEMS_ERROR;
cparata 0:e7e920b85676 5638
cparata 0:e7e920b85676 5639 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5640 }
cparata 0:e7e920b85676 5641
cparata 0:e7e920b85676 5642 /*******************************************************************************
cparata 0:e7e920b85676 5643 * Function Name : LSM6DSL_ACC_GYRO_R_TapEvOnInt1
cparata 0:e7e920b85676 5644 * Description : Read INT1_TAP
cparata 0:e7e920b85676 5645 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_TAP_t
cparata 0:e7e920b85676 5646 * Output : Status of INT1_TAP see LSM6DSL_ACC_GYRO_INT1_TAP_t
cparata 0:e7e920b85676 5647 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5648 *******************************************************************************/
cparata 0:e7e920b85676 5649 status_t LSM6DSL_ACC_GYRO_R_TapEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_TAP_t *value)
cparata 0:e7e920b85676 5650 {
cparata 0:e7e920b85676 5651 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
cparata 0:e7e920b85676 5652 return MEMS_ERROR;
cparata 0:e7e920b85676 5653
cparata 0:e7e920b85676 5654 *value &= LSM6DSL_ACC_GYRO_INT1_TAP_MASK; //mask
cparata 0:e7e920b85676 5655
cparata 0:e7e920b85676 5656 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5657 }
cparata 0:e7e920b85676 5658
cparata 0:e7e920b85676 5659 /*******************************************************************************
cparata 0:e7e920b85676 5660 * Function Name : LSM6DSL_ACC_GYRO_W_FFEvOnInt1
cparata 0:e7e920b85676 5661 * Description : Write INT1_FF
cparata 0:e7e920b85676 5662 * Input : LSM6DSL_ACC_GYRO_INT1_FF_t
cparata 0:e7e920b85676 5663 * Output : None
cparata 0:e7e920b85676 5664 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5665 *******************************************************************************/
cparata 0:e7e920b85676 5666 status_t LSM6DSL_ACC_GYRO_W_FFEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_FF_t newValue)
cparata 0:e7e920b85676 5667 {
cparata 0:e7e920b85676 5668 u8_t value;
cparata 0:e7e920b85676 5669
cparata 0:e7e920b85676 5670 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:e7e920b85676 5671 return MEMS_ERROR;
cparata 0:e7e920b85676 5672
cparata 0:e7e920b85676 5673 value &= ~LSM6DSL_ACC_GYRO_INT1_FF_MASK;
cparata 0:e7e920b85676 5674 value |= newValue;
cparata 0:e7e920b85676 5675
cparata 0:e7e920b85676 5676 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:e7e920b85676 5677 return MEMS_ERROR;
cparata 0:e7e920b85676 5678
cparata 0:e7e920b85676 5679 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5680 }
cparata 0:e7e920b85676 5681
cparata 0:e7e920b85676 5682 /*******************************************************************************
cparata 0:e7e920b85676 5683 * Function Name : LSM6DSL_ACC_GYRO_R_FFEvOnInt1
cparata 0:e7e920b85676 5684 * Description : Read INT1_FF
cparata 0:e7e920b85676 5685 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_FF_t
cparata 0:e7e920b85676 5686 * Output : Status of INT1_FF see LSM6DSL_ACC_GYRO_INT1_FF_t
cparata 0:e7e920b85676 5687 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5688 *******************************************************************************/
cparata 0:e7e920b85676 5689 status_t LSM6DSL_ACC_GYRO_R_FFEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_FF_t *value)
cparata 0:e7e920b85676 5690 {
cparata 0:e7e920b85676 5691 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
cparata 0:e7e920b85676 5692 return MEMS_ERROR;
cparata 0:e7e920b85676 5693
cparata 0:e7e920b85676 5694 *value &= LSM6DSL_ACC_GYRO_INT1_FF_MASK; //mask
cparata 0:e7e920b85676 5695
cparata 0:e7e920b85676 5696 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5697 }
cparata 0:e7e920b85676 5698
cparata 0:e7e920b85676 5699 /*******************************************************************************
cparata 0:e7e920b85676 5700 * Function Name : LSM6DSL_ACC_GYRO_W_WUEvOnInt1
cparata 0:e7e920b85676 5701 * Description : Write INT1_WU
cparata 0:e7e920b85676 5702 * Input : LSM6DSL_ACC_GYRO_INT1_WU_t
cparata 0:e7e920b85676 5703 * Output : None
cparata 0:e7e920b85676 5704 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5705 *******************************************************************************/
cparata 0:e7e920b85676 5706 status_t LSM6DSL_ACC_GYRO_W_WUEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_WU_t newValue)
cparata 0:e7e920b85676 5707 {
cparata 0:e7e920b85676 5708 u8_t value;
cparata 0:e7e920b85676 5709
cparata 0:e7e920b85676 5710 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:e7e920b85676 5711 return MEMS_ERROR;
cparata 0:e7e920b85676 5712
cparata 0:e7e920b85676 5713 value &= ~LSM6DSL_ACC_GYRO_INT1_WU_MASK;
cparata 0:e7e920b85676 5714 value |= newValue;
cparata 0:e7e920b85676 5715
cparata 0:e7e920b85676 5716 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:e7e920b85676 5717 return MEMS_ERROR;
cparata 0:e7e920b85676 5718
cparata 0:e7e920b85676 5719 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5720 }
cparata 0:e7e920b85676 5721
cparata 0:e7e920b85676 5722 /*******************************************************************************
cparata 0:e7e920b85676 5723 * Function Name : LSM6DSL_ACC_GYRO_R_WUEvOnInt1
cparata 0:e7e920b85676 5724 * Description : Read INT1_WU
cparata 0:e7e920b85676 5725 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_WU_t
cparata 0:e7e920b85676 5726 * Output : Status of INT1_WU see LSM6DSL_ACC_GYRO_INT1_WU_t
cparata 0:e7e920b85676 5727 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5728 *******************************************************************************/
cparata 0:e7e920b85676 5729 status_t LSM6DSL_ACC_GYRO_R_WUEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_WU_t *value)
cparata 0:e7e920b85676 5730 {
cparata 0:e7e920b85676 5731 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
cparata 0:e7e920b85676 5732 return MEMS_ERROR;
cparata 0:e7e920b85676 5733
cparata 0:e7e920b85676 5734 *value &= LSM6DSL_ACC_GYRO_INT1_WU_MASK; //mask
cparata 0:e7e920b85676 5735
cparata 0:e7e920b85676 5736 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5737 }
cparata 0:e7e920b85676 5738
cparata 0:e7e920b85676 5739 /*******************************************************************************
cparata 0:e7e920b85676 5740 * Function Name : LSM6DSL_ACC_GYRO_W_SingleTapOnInt1
cparata 0:e7e920b85676 5741 * Description : Write INT1_SINGLE_TAP
cparata 0:e7e920b85676 5742 * Input : LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_t
cparata 0:e7e920b85676 5743 * Output : None
cparata 0:e7e920b85676 5744 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5745 *******************************************************************************/
cparata 0:e7e920b85676 5746 status_t LSM6DSL_ACC_GYRO_W_SingleTapOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_t newValue)
cparata 0:e7e920b85676 5747 {
cparata 0:e7e920b85676 5748 u8_t value;
cparata 0:e7e920b85676 5749
cparata 0:e7e920b85676 5750 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:e7e920b85676 5751 return MEMS_ERROR;
cparata 0:e7e920b85676 5752
cparata 0:e7e920b85676 5753 value &= ~LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_MASK;
cparata 0:e7e920b85676 5754 value |= newValue;
cparata 0:e7e920b85676 5755
cparata 0:e7e920b85676 5756 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:e7e920b85676 5757 return MEMS_ERROR;
cparata 0:e7e920b85676 5758
cparata 0:e7e920b85676 5759 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5760 }
cparata 0:e7e920b85676 5761
cparata 0:e7e920b85676 5762 /*******************************************************************************
cparata 0:e7e920b85676 5763 * Function Name : LSM6DSL_ACC_GYRO_R_SingleTapOnInt1
cparata 0:e7e920b85676 5764 * Description : Read INT1_SINGLE_TAP
cparata 0:e7e920b85676 5765 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_t
cparata 0:e7e920b85676 5766 * Output : Status of INT1_SINGLE_TAP see LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_t
cparata 0:e7e920b85676 5767 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5768 *******************************************************************************/
cparata 0:e7e920b85676 5769 status_t LSM6DSL_ACC_GYRO_R_SingleTapOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_t *value)
cparata 0:e7e920b85676 5770 {
cparata 0:e7e920b85676 5771 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
cparata 0:e7e920b85676 5772 return MEMS_ERROR;
cparata 0:e7e920b85676 5773
cparata 0:e7e920b85676 5774 *value &= LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_MASK; //mask
cparata 0:e7e920b85676 5775
cparata 0:e7e920b85676 5776 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5777 }
cparata 0:e7e920b85676 5778
cparata 0:e7e920b85676 5779 /*******************************************************************************
cparata 0:e7e920b85676 5780 * Function Name : LSM6DSL_ACC_GYRO_W_SleepEvOnInt1
cparata 0:e7e920b85676 5781 * Description : Write INT1_SLEEP
cparata 0:e7e920b85676 5782 * Input : LSM6DSL_ACC_GYRO_INT1_SLEEP_t
cparata 0:e7e920b85676 5783 * Output : None
cparata 0:e7e920b85676 5784 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5785 *******************************************************************************/
cparata 0:e7e920b85676 5786 status_t LSM6DSL_ACC_GYRO_W_SleepEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_SLEEP_t newValue)
cparata 0:e7e920b85676 5787 {
cparata 0:e7e920b85676 5788 u8_t value;
cparata 0:e7e920b85676 5789
cparata 0:e7e920b85676 5790 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:e7e920b85676 5791 return MEMS_ERROR;
cparata 0:e7e920b85676 5792
cparata 0:e7e920b85676 5793 value &= ~LSM6DSL_ACC_GYRO_INT1_SLEEP_MASK;
cparata 0:e7e920b85676 5794 value |= newValue;
cparata 0:e7e920b85676 5795
cparata 0:e7e920b85676 5796 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:e7e920b85676 5797 return MEMS_ERROR;
cparata 0:e7e920b85676 5798
cparata 0:e7e920b85676 5799 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5800 }
cparata 0:e7e920b85676 5801
cparata 0:e7e920b85676 5802 /*******************************************************************************
cparata 0:e7e920b85676 5803 * Function Name : LSM6DSL_ACC_GYRO_R_SleepEvOnInt1
cparata 0:e7e920b85676 5804 * Description : Read INT1_SLEEP
cparata 0:e7e920b85676 5805 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_SLEEP_t
cparata 0:e7e920b85676 5806 * Output : Status of INT1_SLEEP see LSM6DSL_ACC_GYRO_INT1_SLEEP_t
cparata 0:e7e920b85676 5807 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5808 *******************************************************************************/
cparata 0:e7e920b85676 5809 status_t LSM6DSL_ACC_GYRO_R_SleepEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_SLEEP_t *value)
cparata 0:e7e920b85676 5810 {
cparata 0:e7e920b85676 5811 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
cparata 0:e7e920b85676 5812 return MEMS_ERROR;
cparata 0:e7e920b85676 5813
cparata 0:e7e920b85676 5814 *value &= LSM6DSL_ACC_GYRO_INT1_SLEEP_MASK; //mask
cparata 0:e7e920b85676 5815
cparata 0:e7e920b85676 5816 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5817 }
cparata 0:e7e920b85676 5818
cparata 0:e7e920b85676 5819 /*******************************************************************************
cparata 0:e7e920b85676 5820 * Function Name : LSM6DSL_ACC_GYRO_W_MagCorrection_Int2
cparata 0:e7e920b85676 5821 * Description : Write INT2_IRON
cparata 0:e7e920b85676 5822 * Input : LSM6DSL_ACC_GYRO_INT2_IRON_t
cparata 0:e7e920b85676 5823 * Output : None
cparata 0:e7e920b85676 5824 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5825 *******************************************************************************/
cparata 0:e7e920b85676 5826 status_t LSM6DSL_ACC_GYRO_W_MagCorrection_Int2(void *handle, LSM6DSL_ACC_GYRO_INT2_IRON_t newValue)
cparata 0:e7e920b85676 5827 {
cparata 0:e7e920b85676 5828 u8_t value;
cparata 0:e7e920b85676 5829
cparata 0:e7e920b85676 5830 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:e7e920b85676 5831 return MEMS_ERROR;
cparata 0:e7e920b85676 5832
cparata 0:e7e920b85676 5833 value &= ~LSM6DSL_ACC_GYRO_INT2_IRON_MASK;
cparata 0:e7e920b85676 5834 value |= newValue;
cparata 0:e7e920b85676 5835
cparata 0:e7e920b85676 5836 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:e7e920b85676 5837 return MEMS_ERROR;
cparata 0:e7e920b85676 5838
cparata 0:e7e920b85676 5839 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5840 }
cparata 0:e7e920b85676 5841
cparata 0:e7e920b85676 5842 /*******************************************************************************
cparata 0:e7e920b85676 5843 * Function Name : LSM6DSL_ACC_GYRO_R_MagCorrection_Int2
cparata 0:e7e920b85676 5844 * Description : Read INT2_IRON
cparata 0:e7e920b85676 5845 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_IRON_t
cparata 0:e7e920b85676 5846 * Output : Status of INT2_IRON see LSM6DSL_ACC_GYRO_INT2_IRON_t
cparata 0:e7e920b85676 5847 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5848 *******************************************************************************/
cparata 0:e7e920b85676 5849 status_t LSM6DSL_ACC_GYRO_R_MagCorrection_Int2(void *handle, LSM6DSL_ACC_GYRO_INT2_IRON_t *value)
cparata 0:e7e920b85676 5850 {
cparata 0:e7e920b85676 5851 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
cparata 0:e7e920b85676 5852 return MEMS_ERROR;
cparata 0:e7e920b85676 5853
cparata 0:e7e920b85676 5854 *value &= LSM6DSL_ACC_GYRO_INT2_IRON_MASK; //mask
cparata 0:e7e920b85676 5855
cparata 0:e7e920b85676 5856 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5857 }
cparata 0:e7e920b85676 5858
cparata 0:e7e920b85676 5859 /*******************************************************************************
cparata 0:e7e920b85676 5860 * Function Name : LSM6DSL_ACC_GYRO_W_TiltEvOnInt2
cparata 0:e7e920b85676 5861 * Description : Write INT2_TILT
cparata 0:e7e920b85676 5862 * Input : LSM6DSL_ACC_GYRO_INT2_TILT_t
cparata 0:e7e920b85676 5863 * Output : None
cparata 0:e7e920b85676 5864 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5865 *******************************************************************************/
cparata 0:e7e920b85676 5866 status_t LSM6DSL_ACC_GYRO_W_TiltEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_TILT_t newValue)
cparata 0:e7e920b85676 5867 {
cparata 0:e7e920b85676 5868 u8_t value;
cparata 0:e7e920b85676 5869
cparata 0:e7e920b85676 5870 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:e7e920b85676 5871 return MEMS_ERROR;
cparata 0:e7e920b85676 5872
cparata 0:e7e920b85676 5873 value &= ~LSM6DSL_ACC_GYRO_INT2_TILT_MASK;
cparata 0:e7e920b85676 5874 value |= newValue;
cparata 0:e7e920b85676 5875
cparata 0:e7e920b85676 5876 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:e7e920b85676 5877 return MEMS_ERROR;
cparata 0:e7e920b85676 5878
cparata 0:e7e920b85676 5879 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5880 }
cparata 0:e7e920b85676 5881
cparata 0:e7e920b85676 5882 /*******************************************************************************
cparata 0:e7e920b85676 5883 * Function Name : LSM6DSL_ACC_GYRO_R_TiltEvOnInt2
cparata 0:e7e920b85676 5884 * Description : Read INT2_TILT
cparata 0:e7e920b85676 5885 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_TILT_t
cparata 0:e7e920b85676 5886 * Output : Status of INT2_TILT see LSM6DSL_ACC_GYRO_INT2_TILT_t
cparata 0:e7e920b85676 5887 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5888 *******************************************************************************/
cparata 0:e7e920b85676 5889 status_t LSM6DSL_ACC_GYRO_R_TiltEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_TILT_t *value)
cparata 0:e7e920b85676 5890 {
cparata 0:e7e920b85676 5891 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
cparata 0:e7e920b85676 5892 return MEMS_ERROR;
cparata 0:e7e920b85676 5893
cparata 0:e7e920b85676 5894 *value &= LSM6DSL_ACC_GYRO_INT2_TILT_MASK; //mask
cparata 0:e7e920b85676 5895
cparata 0:e7e920b85676 5896 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5897 }
cparata 0:e7e920b85676 5898
cparata 0:e7e920b85676 5899 /*******************************************************************************
cparata 0:e7e920b85676 5900 * Function Name : LSM6DSL_ACC_GYRO_W_6DEvOnInt2
cparata 0:e7e920b85676 5901 * Description : Write INT2_6D
cparata 0:e7e920b85676 5902 * Input : LSM6DSL_ACC_GYRO_INT2_6D_t
cparata 0:e7e920b85676 5903 * Output : None
cparata 0:e7e920b85676 5904 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5905 *******************************************************************************/
cparata 0:e7e920b85676 5906 status_t LSM6DSL_ACC_GYRO_W_6DEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_6D_t newValue)
cparata 0:e7e920b85676 5907 {
cparata 0:e7e920b85676 5908 u8_t value;
cparata 0:e7e920b85676 5909
cparata 0:e7e920b85676 5910 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:e7e920b85676 5911 return MEMS_ERROR;
cparata 0:e7e920b85676 5912
cparata 0:e7e920b85676 5913 value &= ~LSM6DSL_ACC_GYRO_INT2_6D_MASK;
cparata 0:e7e920b85676 5914 value |= newValue;
cparata 0:e7e920b85676 5915
cparata 0:e7e920b85676 5916 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:e7e920b85676 5917 return MEMS_ERROR;
cparata 0:e7e920b85676 5918
cparata 0:e7e920b85676 5919 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5920 }
cparata 0:e7e920b85676 5921
cparata 0:e7e920b85676 5922 /*******************************************************************************
cparata 0:e7e920b85676 5923 * Function Name : LSM6DSL_ACC_GYRO_R_6DEvOnInt2
cparata 0:e7e920b85676 5924 * Description : Read INT2_6D
cparata 0:e7e920b85676 5925 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_6D_t
cparata 0:e7e920b85676 5926 * Output : Status of INT2_6D see LSM6DSL_ACC_GYRO_INT2_6D_t
cparata 0:e7e920b85676 5927 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5928 *******************************************************************************/
cparata 0:e7e920b85676 5929 status_t LSM6DSL_ACC_GYRO_R_6DEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_6D_t *value)
cparata 0:e7e920b85676 5930 {
cparata 0:e7e920b85676 5931 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
cparata 0:e7e920b85676 5932 return MEMS_ERROR;
cparata 0:e7e920b85676 5933
cparata 0:e7e920b85676 5934 *value &= LSM6DSL_ACC_GYRO_INT2_6D_MASK; //mask
cparata 0:e7e920b85676 5935
cparata 0:e7e920b85676 5936 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5937 }
cparata 0:e7e920b85676 5938
cparata 0:e7e920b85676 5939 /*******************************************************************************
cparata 0:e7e920b85676 5940 * Function Name : LSM6DSL_ACC_GYRO_W_TapEvOnInt2
cparata 0:e7e920b85676 5941 * Description : Write INT2_TAP
cparata 0:e7e920b85676 5942 * Input : LSM6DSL_ACC_GYRO_INT2_TAP_t
cparata 0:e7e920b85676 5943 * Output : None
cparata 0:e7e920b85676 5944 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5945 *******************************************************************************/
cparata 0:e7e920b85676 5946 status_t LSM6DSL_ACC_GYRO_W_TapEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_TAP_t newValue)
cparata 0:e7e920b85676 5947 {
cparata 0:e7e920b85676 5948 u8_t value;
cparata 0:e7e920b85676 5949
cparata 0:e7e920b85676 5950 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:e7e920b85676 5951 return MEMS_ERROR;
cparata 0:e7e920b85676 5952
cparata 0:e7e920b85676 5953 value &= ~LSM6DSL_ACC_GYRO_INT2_TAP_MASK;
cparata 0:e7e920b85676 5954 value |= newValue;
cparata 0:e7e920b85676 5955
cparata 0:e7e920b85676 5956 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:e7e920b85676 5957 return MEMS_ERROR;
cparata 0:e7e920b85676 5958
cparata 0:e7e920b85676 5959 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5960 }
cparata 0:e7e920b85676 5961
cparata 0:e7e920b85676 5962 /*******************************************************************************
cparata 0:e7e920b85676 5963 * Function Name : LSM6DSL_ACC_GYRO_R_TapEvOnInt2
cparata 0:e7e920b85676 5964 * Description : Read INT2_TAP
cparata 0:e7e920b85676 5965 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_TAP_t
cparata 0:e7e920b85676 5966 * Output : Status of INT2_TAP see LSM6DSL_ACC_GYRO_INT2_TAP_t
cparata 0:e7e920b85676 5967 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5968 *******************************************************************************/
cparata 0:e7e920b85676 5969 status_t LSM6DSL_ACC_GYRO_R_TapEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_TAP_t *value)
cparata 0:e7e920b85676 5970 {
cparata 0:e7e920b85676 5971 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
cparata 0:e7e920b85676 5972 return MEMS_ERROR;
cparata 0:e7e920b85676 5973
cparata 0:e7e920b85676 5974 *value &= LSM6DSL_ACC_GYRO_INT2_TAP_MASK; //mask
cparata 0:e7e920b85676 5975
cparata 0:e7e920b85676 5976 return MEMS_SUCCESS;
cparata 0:e7e920b85676 5977 }
cparata 0:e7e920b85676 5978
cparata 0:e7e920b85676 5979 /*******************************************************************************
cparata 0:e7e920b85676 5980 * Function Name : LSM6DSL_ACC_GYRO_W_FFEvOnInt2
cparata 0:e7e920b85676 5981 * Description : Write INT2_FF
cparata 0:e7e920b85676 5982 * Input : LSM6DSL_ACC_GYRO_INT2_FF_t
cparata 0:e7e920b85676 5983 * Output : None
cparata 0:e7e920b85676 5984 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 5985 *******************************************************************************/
cparata 0:e7e920b85676 5986 status_t LSM6DSL_ACC_GYRO_W_FFEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_FF_t newValue)
cparata 0:e7e920b85676 5987 {
cparata 0:e7e920b85676 5988 u8_t value;
cparata 0:e7e920b85676 5989
cparata 0:e7e920b85676 5990 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:e7e920b85676 5991 return MEMS_ERROR;
cparata 0:e7e920b85676 5992
cparata 0:e7e920b85676 5993 value &= ~LSM6DSL_ACC_GYRO_INT2_FF_MASK;
cparata 0:e7e920b85676 5994 value |= newValue;
cparata 0:e7e920b85676 5995
cparata 0:e7e920b85676 5996 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:e7e920b85676 5997 return MEMS_ERROR;
cparata 0:e7e920b85676 5998
cparata 0:e7e920b85676 5999 return MEMS_SUCCESS;
cparata 0:e7e920b85676 6000 }
cparata 0:e7e920b85676 6001
cparata 0:e7e920b85676 6002 /*******************************************************************************
cparata 0:e7e920b85676 6003 * Function Name : LSM6DSL_ACC_GYRO_R_FFEvOnInt2
cparata 0:e7e920b85676 6004 * Description : Read INT2_FF
cparata 0:e7e920b85676 6005 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_FF_t
cparata 0:e7e920b85676 6006 * Output : Status of INT2_FF see LSM6DSL_ACC_GYRO_INT2_FF_t
cparata 0:e7e920b85676 6007 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 6008 *******************************************************************************/
cparata 0:e7e920b85676 6009 status_t LSM6DSL_ACC_GYRO_R_FFEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_FF_t *value)
cparata 0:e7e920b85676 6010 {
cparata 0:e7e920b85676 6011 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
cparata 0:e7e920b85676 6012 return MEMS_ERROR;
cparata 0:e7e920b85676 6013
cparata 0:e7e920b85676 6014 *value &= LSM6DSL_ACC_GYRO_INT2_FF_MASK; //mask
cparata 0:e7e920b85676 6015
cparata 0:e7e920b85676 6016 return MEMS_SUCCESS;
cparata 0:e7e920b85676 6017 }
cparata 0:e7e920b85676 6018
cparata 0:e7e920b85676 6019 /*******************************************************************************
cparata 0:e7e920b85676 6020 * Function Name : LSM6DSL_ACC_GYRO_W_WUEvOnInt2
cparata 0:e7e920b85676 6021 * Description : Write INT2_WU
cparata 0:e7e920b85676 6022 * Input : LSM6DSL_ACC_GYRO_INT2_WU_t
cparata 0:e7e920b85676 6023 * Output : None
cparata 0:e7e920b85676 6024 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 6025 *******************************************************************************/
cparata 0:e7e920b85676 6026 status_t LSM6DSL_ACC_GYRO_W_WUEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_WU_t newValue)
cparata 0:e7e920b85676 6027 {
cparata 0:e7e920b85676 6028 u8_t value;
cparata 0:e7e920b85676 6029
cparata 0:e7e920b85676 6030 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:e7e920b85676 6031 return MEMS_ERROR;
cparata 0:e7e920b85676 6032
cparata 0:e7e920b85676 6033 value &= ~LSM6DSL_ACC_GYRO_INT2_WU_MASK;
cparata 0:e7e920b85676 6034 value |= newValue;
cparata 0:e7e920b85676 6035
cparata 0:e7e920b85676 6036 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:e7e920b85676 6037 return MEMS_ERROR;
cparata 0:e7e920b85676 6038
cparata 0:e7e920b85676 6039 return MEMS_SUCCESS;
cparata 0:e7e920b85676 6040 }
cparata 0:e7e920b85676 6041
cparata 0:e7e920b85676 6042 /*******************************************************************************
cparata 0:e7e920b85676 6043 * Function Name : LSM6DSL_ACC_GYRO_R_WUEvOnInt2
cparata 0:e7e920b85676 6044 * Description : Read INT2_WU
cparata 0:e7e920b85676 6045 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_WU_t
cparata 0:e7e920b85676 6046 * Output : Status of INT2_WU see LSM6DSL_ACC_GYRO_INT2_WU_t
cparata 0:e7e920b85676 6047 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 6048 *******************************************************************************/
cparata 0:e7e920b85676 6049 status_t LSM6DSL_ACC_GYRO_R_WUEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_WU_t *value)
cparata 0:e7e920b85676 6050 {
cparata 0:e7e920b85676 6051 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
cparata 0:e7e920b85676 6052 return MEMS_ERROR;
cparata 0:e7e920b85676 6053
cparata 0:e7e920b85676 6054 *value &= LSM6DSL_ACC_GYRO_INT2_WU_MASK; //mask
cparata 0:e7e920b85676 6055
cparata 0:e7e920b85676 6056 return MEMS_SUCCESS;
cparata 0:e7e920b85676 6057 }
cparata 0:e7e920b85676 6058
cparata 0:e7e920b85676 6059 /*******************************************************************************
cparata 0:e7e920b85676 6060 * Function Name : LSM6DSL_ACC_GYRO_W_SingleTapOnInt2
cparata 0:e7e920b85676 6061 * Description : Write INT2_SINGLE_TAP
cparata 0:e7e920b85676 6062 * Input : LSM6DSL_ACC_GYRO_INT2_SINGLE_TAP_t
cparata 0:e7e920b85676 6063 * Output : None
cparata 0:e7e920b85676 6064 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 6065 *******************************************************************************/
cparata 0:e7e920b85676 6066 status_t LSM6DSL_ACC_GYRO_W_SingleTapOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_SINGLE_TAP_t newValue)
cparata 0:e7e920b85676 6067 {
cparata 0:e7e920b85676 6068 u8_t value;
cparata 0:e7e920b85676 6069
cparata 0:e7e920b85676 6070 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:e7e920b85676 6071 return MEMS_ERROR;
cparata 0:e7e920b85676 6072
cparata 0:e7e920b85676 6073 value &= ~LSM6DSL_ACC_GYRO_INT2_SINGLE_TAP_MASK;
cparata 0:e7e920b85676 6074 value |= newValue;
cparata 0:e7e920b85676 6075
cparata 0:e7e920b85676 6076 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:e7e920b85676 6077 return MEMS_ERROR;
cparata 0:e7e920b85676 6078
cparata 0:e7e920b85676 6079 return MEMS_SUCCESS;
cparata 0:e7e920b85676 6080 }
cparata 0:e7e920b85676 6081
cparata 0:e7e920b85676 6082 /*******************************************************************************
cparata 0:e7e920b85676 6083 * Function Name : LSM6DSL_ACC_GYRO_R_SingleTapOnInt2
cparata 0:e7e920b85676 6084 * Description : Read INT2_SINGLE_TAP
cparata 0:e7e920b85676 6085 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_SINGLE_TAP_t
cparata 0:e7e920b85676 6086 * Output : Status of INT2_SINGLE_TAP see LSM6DSL_ACC_GYRO_INT2_SINGLE_TAP_t
cparata 0:e7e920b85676 6087 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 6088 *******************************************************************************/
cparata 0:e7e920b85676 6089 status_t LSM6DSL_ACC_GYRO_R_SingleTapOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_SINGLE_TAP_t *value)
cparata 0:e7e920b85676 6090 {
cparata 0:e7e920b85676 6091 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
cparata 0:e7e920b85676 6092 return MEMS_ERROR;
cparata 0:e7e920b85676 6093
cparata 0:e7e920b85676 6094 *value &= LSM6DSL_ACC_GYRO_INT2_SINGLE_TAP_MASK; //mask
cparata 0:e7e920b85676 6095
cparata 0:e7e920b85676 6096 return MEMS_SUCCESS;
cparata 0:e7e920b85676 6097 }
cparata 0:e7e920b85676 6098
cparata 0:e7e920b85676 6099 /*******************************************************************************
cparata 0:e7e920b85676 6100 * Function Name : LSM6DSL_ACC_GYRO_W_SleepEvOnInt2
cparata 0:e7e920b85676 6101 * Description : Write INT2_SLEEP
cparata 0:e7e920b85676 6102 * Input : LSM6DSL_ACC_GYRO_INT2_SLEEP_t
cparata 0:e7e920b85676 6103 * Output : None
cparata 0:e7e920b85676 6104 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 6105 *******************************************************************************/
cparata 0:e7e920b85676 6106 status_t LSM6DSL_ACC_GYRO_W_SleepEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_SLEEP_t newValue)
cparata 0:e7e920b85676 6107 {
cparata 0:e7e920b85676 6108 u8_t value;
cparata 0:e7e920b85676 6109
cparata 0:e7e920b85676 6110 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:e7e920b85676 6111 return MEMS_ERROR;
cparata 0:e7e920b85676 6112
cparata 0:e7e920b85676 6113 value &= ~LSM6DSL_ACC_GYRO_INT2_SLEEP_MASK;
cparata 0:e7e920b85676 6114 value |= newValue;
cparata 0:e7e920b85676 6115
cparata 0:e7e920b85676 6116 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:e7e920b85676 6117 return MEMS_ERROR;
cparata 0:e7e920b85676 6118
cparata 0:e7e920b85676 6119 return MEMS_SUCCESS;
cparata 0:e7e920b85676 6120 }
cparata 0:e7e920b85676 6121
cparata 0:e7e920b85676 6122 /*******************************************************************************
cparata 0:e7e920b85676 6123 * Function Name : LSM6DSL_ACC_GYRO_R_SleepEvOnInt2
cparata 0:e7e920b85676 6124 * Description : Read INT2_SLEEP
cparata 0:e7e920b85676 6125 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_SLEEP_t
cparata 0:e7e920b85676 6126 * Output : Status of INT2_SLEEP see LSM6DSL_ACC_GYRO_INT2_SLEEP_t
cparata 0:e7e920b85676 6127 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 6128 *******************************************************************************/
cparata 0:e7e920b85676 6129 status_t LSM6DSL_ACC_GYRO_R_SleepEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_SLEEP_t *value)
cparata 0:e7e920b85676 6130 {
cparata 0:e7e920b85676 6131 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
cparata 0:e7e920b85676 6132 return MEMS_ERROR;
cparata 0:e7e920b85676 6133
cparata 0:e7e920b85676 6134 *value &= LSM6DSL_ACC_GYRO_INT2_SLEEP_MASK; //mask
cparata 0:e7e920b85676 6135
cparata 0:e7e920b85676 6136 return MEMS_SUCCESS;
cparata 0:e7e920b85676 6137 }
cparata 0:e7e920b85676 6138
cparata 0:e7e920b85676 6139 /*******************************************************************************
cparata 0:e7e920b85676 6140 * Function Name : status_t LSM6DSL_ACC_GYRO_Get_GetFIFOData(u8_t *buff)
cparata 0:e7e920b85676 6141 * Description : Read GetFIFOData output register
cparata 0:e7e920b85676 6142 * Input : pointer to [u8_t]
cparata 0:e7e920b85676 6143 * Output : GetFIFOData buffer u8_t
cparata 0:e7e920b85676 6144 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 6145 *******************************************************************************/
cparata 0:e7e920b85676 6146 status_t LSM6DSL_ACC_GYRO_Get_GetFIFOData(void *handle, u8_t *buff)
cparata 0:e7e920b85676 6147 {
cparata 0:e7e920b85676 6148 u8_t i, j, k;
cparata 0:e7e920b85676 6149 u8_t numberOfByteForDimension;
cparata 0:e7e920b85676 6150
cparata 0:e7e920b85676 6151 numberOfByteForDimension=2/1;
cparata 0:e7e920b85676 6152
cparata 0:e7e920b85676 6153 k=0;
cparata 0:e7e920b85676 6154 for (i=0; i<1;i++ )
cparata 0:e7e920b85676 6155 {
cparata 0:e7e920b85676 6156 for (j=0; j<numberOfByteForDimension;j++ )
cparata 0:e7e920b85676 6157 {
cparata 0:e7e920b85676 6158 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_DATA_OUT_L+k, &buff[k], 1))
cparata 0:e7e920b85676 6159 return MEMS_ERROR;
cparata 0:e7e920b85676 6160 k++;
cparata 0:e7e920b85676 6161 }
cparata 0:e7e920b85676 6162 }
cparata 0:e7e920b85676 6163
cparata 0:e7e920b85676 6164 return MEMS_SUCCESS;
cparata 0:e7e920b85676 6165 }
cparata 0:e7e920b85676 6166
cparata 0:e7e920b85676 6167 /*******************************************************************************
cparata 0:e7e920b85676 6168 * Function Name : status_t LSM6DSL_ACC_GYRO_Get_GetTimestamp(u8_t *buff)
cparata 0:e7e920b85676 6169 * Description : Read GetTimestamp output register
cparata 0:e7e920b85676 6170 * Input : pointer to [u8_t]
cparata 0:e7e920b85676 6171 * Output : GetTimestamp buffer u8_t
cparata 0:e7e920b85676 6172 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 6173 *******************************************************************************/
cparata 0:e7e920b85676 6174 status_t LSM6DSL_ACC_GYRO_Get_GetTimestamp(void *handle, u8_t *buff)
cparata 0:e7e920b85676 6175 {
cparata 0:e7e920b85676 6176 u8_t i, j, k;
cparata 0:e7e920b85676 6177 u8_t numberOfByteForDimension;
cparata 0:e7e920b85676 6178
cparata 0:e7e920b85676 6179 numberOfByteForDimension=3/1;
cparata 0:e7e920b85676 6180
cparata 0:e7e920b85676 6181 k=0;
cparata 0:e7e920b85676 6182 for (i=0; i<1;i++ )
cparata 0:e7e920b85676 6183 {
cparata 0:e7e920b85676 6184 for (j=0; j<numberOfByteForDimension;j++ )
cparata 0:e7e920b85676 6185 {
cparata 0:e7e920b85676 6186 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TIMESTAMP0_REG+k, &buff[k], 1))
cparata 0:e7e920b85676 6187 return MEMS_ERROR;
cparata 0:e7e920b85676 6188 k++;
cparata 0:e7e920b85676 6189 }
cparata 0:e7e920b85676 6190 }
cparata 0:e7e920b85676 6191
cparata 0:e7e920b85676 6192 return MEMS_SUCCESS;
cparata 0:e7e920b85676 6193 }
cparata 0:e7e920b85676 6194
cparata 0:e7e920b85676 6195 /*******************************************************************************
cparata 0:e7e920b85676 6196 * Function Name : status_t LSM6DSL_ACC_GYRO_Get_GetStepCounter(u8_t *buff)
cparata 0:e7e920b85676 6197 * Description : Read GetStepCounter output register
cparata 0:e7e920b85676 6198 * Input : pointer to [u8_t]
cparata 0:e7e920b85676 6199 * Output : GetStepCounter buffer u8_t
cparata 0:e7e920b85676 6200 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 6201 *******************************************************************************/
cparata 0:e7e920b85676 6202 status_t LSM6DSL_ACC_GYRO_Get_GetStepCounter(void *handle, u8_t *buff)
cparata 0:e7e920b85676 6203 {
cparata 0:e7e920b85676 6204 u8_t i, j, k;
cparata 0:e7e920b85676 6205 u8_t numberOfByteForDimension;
cparata 0:e7e920b85676 6206
cparata 0:e7e920b85676 6207 numberOfByteForDimension=2/1;
cparata 0:e7e920b85676 6208
cparata 0:e7e920b85676 6209 k=0;
cparata 0:e7e920b85676 6210 for (i=0; i<1;i++ )
cparata 0:e7e920b85676 6211 {
cparata 0:e7e920b85676 6212 for (j=0; j<numberOfByteForDimension;j++ )
cparata 0:e7e920b85676 6213 {
cparata 0:e7e920b85676 6214 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_STEP_COUNTER_L+k, &buff[k], 1))
cparata 0:e7e920b85676 6215 return MEMS_ERROR;
cparata 0:e7e920b85676 6216 k++;
cparata 0:e7e920b85676 6217 }
cparata 0:e7e920b85676 6218 }
cparata 0:e7e920b85676 6219
cparata 0:e7e920b85676 6220 return MEMS_SUCCESS;
cparata 0:e7e920b85676 6221 }
cparata 0:e7e920b85676 6222
cparata 0:e7e920b85676 6223 /*******************************************************************************
cparata 0:e7e920b85676 6224 * Function Name : LSM6DSL_ACC_GYRO_W_PedoThreshold(void *handle, u8_t newValue)
cparata 0:e7e920b85676 6225 * Description : Set accelerometer threshold for pedometer
cparata 0:e7e920b85676 6226 * Input : pointer to [u8_t]
cparata 0:e7e920b85676 6227 * Output : None
cparata 0:e7e920b85676 6228 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:e7e920b85676 6229 *******************************************************************************/
cparata 0:e7e920b85676 6230 status_t LSM6DSL_ACC_GYRO_W_PedoThreshold(void *handle, u8_t newValue)
cparata 0:e7e920b85676 6231 {
cparata 0:e7e920b85676 6232 u8_t value;
cparata 0:e7e920b85676 6233
cparata 0:e7e920b85676 6234 /* Open Embedded Function Register page*/
cparata 0:e7e920b85676 6235 LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_ENABLED);
cparata 0:e7e920b85676 6236
cparata 0:e7e920b85676 6237 /* read current value */
cparata 0:e7e920b85676 6238 LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CONFIG_PEDO_THS_MIN, &value, 1);
cparata 0:e7e920b85676 6239
cparata 0:e7e920b85676 6240 value &= ~0x1F;
cparata 0:e7e920b85676 6241 value |= (newValue & 0x1F);
cparata 0:e7e920b85676 6242
cparata 0:e7e920b85676 6243 /* write new value */
cparata 0:e7e920b85676 6244 LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CONFIG_PEDO_THS_MIN, &value, 1);
cparata 0:e7e920b85676 6245
cparata 0:e7e920b85676 6246 /* Close Embedded Function Register page*/
cparata 0:e7e920b85676 6247 LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_DISABLED);
cparata 0:e7e920b85676 6248
cparata 0:e7e920b85676 6249 return MEMS_SUCCESS;
cparata 0:e7e920b85676 6250 }
cparata 0:e7e920b85676 6251
cparata 0:e7e920b85676 6252 /************** Use Sensor Hub *******************/
cparata 0:e7e920b85676 6253 /*
cparata 0:e7e920b85676 6254 * Program the nine Soft Iron Matrix coefficients.
cparata 0:e7e920b85676 6255 * The SI_Matrix buffer must provide coefficients
cparata 0:e7e920b85676 6256 * in xx, xy, xz, yx, yy, yz, zx, zy, zz order.
cparata 0:e7e920b85676 6257 */
cparata 0:e7e920b85676 6258 status_t LSM6DSL_ACC_GYRO_SH_init_SI_Matrix(void *handle, u8_t *SI_matrix)
cparata 0:e7e920b85676 6259 {
cparata 0:e7e920b85676 6260 /* Open Embedded Function Register page*/
cparata 0:e7e920b85676 6261 LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_ENABLED);
cparata 0:e7e920b85676 6262
cparata 0:e7e920b85676 6263 /* Write the Soft Iron Matrix coefficients */
cparata 0:e7e920b85676 6264 LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MAG_SI_XX, SI_matrix, 9);
cparata 0:e7e920b85676 6265
cparata 0:e7e920b85676 6266 /* Close Embedded Function Register page*/
cparata 0:e7e920b85676 6267 LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_DISABLED);
cparata 0:e7e920b85676 6268
cparata 0:e7e920b85676 6269 return MEMS_SUCCESS;
cparata 0:e7e920b85676 6270 }
cparata 0:e7e920b85676 6271
cparata 0:e7e920b85676 6272 /* Read a remote device through I2C Sensor Hub Slave 0 */
cparata 0:e7e920b85676 6273 status_t LSM6DSL_ACC_GYRO_SH0_Program(void *handle, u8_t SlvAddr, u8_t Reg, u8_t len)
cparata 0:e7e920b85676 6274 {
cparata 0:e7e920b85676 6275 /* Open Embedded Function Register page*/
cparata 0:e7e920b85676 6276 LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_ENABLED);
cparata 0:e7e920b85676 6277
cparata 0:e7e920b85676 6278 /* Write remote device I2C slave address */
cparata 0:e7e920b85676 6279 SlvAddr |= 0x1; /* Raise the read op bit */
cparata 0:e7e920b85676 6280 LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_SLV0_ADD, &SlvAddr, 1);
cparata 0:e7e920b85676 6281
cparata 0:e7e920b85676 6282 /* Write remote device I2C subaddress */
cparata 0:e7e920b85676 6283 LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_SLV0_SUBADD, &Reg, 1);
cparata 0:e7e920b85676 6284
cparata 0:e7e920b85676 6285 /* Write number of bytes to read [SLAVE0_CONFIG - 04h ]*/
cparata 0:e7e920b85676 6286 u8_t sl0_cfg = 0;
cparata 0:e7e920b85676 6287 sl0_cfg |= 0x00; //00 bit [7-6] : no decimation
cparata 0:e7e920b85676 6288 sl0_cfg |= 0x00; //00 bit [5-4] : one sensor
cparata 0:e7e920b85676 6289 sl0_cfg |= 0x00; // 0 bit [3] : source mode read disabled
cparata 0:e7e920b85676 6290 sl0_cfg |= len & 0x07; // bit [2-0] : number of bytes
cparata 0:e7e920b85676 6291
cparata 0:e7e920b85676 6292 LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_SLAVE0_CONFIG, &sl0_cfg, 1);
cparata 0:e7e920b85676 6293
cparata 0:e7e920b85676 6294 /* Close Embedded Function Register page*/
cparata 0:e7e920b85676 6295 LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_DISABLED);
cparata 0:e7e920b85676 6296
cparata 0:e7e920b85676 6297 /* Enable FUNC */
cparata 0:e7e920b85676 6298 LSM6DSL_ACC_GYRO_W_FUNC_EN(handle, LSM6DSL_ACC_GYRO_FUNC_EN_ENABLED);
cparata 0:e7e920b85676 6299
cparata 0:e7e920b85676 6300 /* MASTER_EN */
cparata 0:e7e920b85676 6301 LSM6DSL_ACC_GYRO_W_I2C_MASTER_Enable(handle, LSM6DSL_ACC_GYRO_MASTER_ON_ENABLED);
cparata 0:e7e920b85676 6302
cparata 0:e7e920b85676 6303 return MEMS_SUCCESS;
cparata 0:e7e920b85676 6304 }
cparata 0:e7e920b85676 6305
cparata 0:e7e920b85676 6306 /* Read a remote device through I2C Sensor Hub Slave 0 */
cparata 0:e7e920b85676 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:e7e920b85676 6308 {
cparata 0:e7e920b85676 6309 LSM6DSL_ACC_GYRO_SENS_HUB_END_t op_cmpl = LSM6DSL_ACC_GYRO_SENS_HUB_END_STILL_ONGOING;
cparata 0:e7e920b85676 6310 LSM6DSL_ACC_GYRO_XLDA_t op_update = LSM6DSL_ACC_GYRO_XLDA_NO_DATA_AVAIL;
cparata 0:e7e920b85676 6311 u8_t dummy[6];
cparata 0:e7e920b85676 6312
cparata 0:e7e920b85676 6313 LSM6DSL_ACC_GYRO_W_ODR_XL(handle, LSM6DSL_ACC_GYRO_ODR_XL_POWER_DOWN);
cparata 0:e7e920b85676 6314
cparata 0:e7e920b85676 6315 LSM6DSL_ACC_GYRO_SH0_Program(handle, SlvAddr, Reg, len);
cparata 0:e7e920b85676 6316
cparata 0:e7e920b85676 6317 /* Syncronize the SH with internal trigger (xl) */
cparata 0:e7e920b85676 6318 LSM6DSL_ACC_GYRO_W_ODR_XL(handle, LSM6DSL_ACC_GYRO_ODR_XL_104Hz);
cparata 0:e7e920b85676 6319
cparata 0:e7e920b85676 6320 /* Wait until operation is not completed */
cparata 0:e7e920b85676 6321 LSM6DSL_ACC_GYRO_GetRawAccData(handle, dummy);
cparata 0:e7e920b85676 6322 do {
cparata 0:e7e920b85676 6323 LSM6DSL_ACC_GYRO_R_XLDA(handle, &op_update);
cparata 0:e7e920b85676 6324 } while(op_update != LSM6DSL_ACC_GYRO_XLDA_DATA_AVAIL);
cparata 0:e7e920b85676 6325 do {
cparata 0:e7e920b85676 6326 LSM6DSL_ACC_GYRO_R_SENS_HUB_END(handle, &op_cmpl);
cparata 0:e7e920b85676 6327 } while(op_cmpl != LSM6DSL_ACC_GYRO_SENS_HUB_END_OP_COMPLETED);
cparata 0:e7e920b85676 6328
cparata 0:e7e920b85676 6329
cparata 0:e7e920b85676 6330 /* Read the result */
cparata 0:e7e920b85676 6331 LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_SENSORHUB1_REG, Bufp, len);
cparata 0:e7e920b85676 6332
cparata 0:e7e920b85676 6333 LSM6DSL_ACC_GYRO_W_ODR_XL(handle, LSM6DSL_ACC_GYRO_ODR_XL_POWER_DOWN);
cparata 0:e7e920b85676 6334
cparata 0:e7e920b85676 6335 if (stop) {
cparata 0:e7e920b85676 6336 /* Stop everything */
cparata 0:e7e920b85676 6337 LSM6DSL_ACC_GYRO_W_FUNC_EN(handle, LSM6DSL_ACC_GYRO_FUNC_EN_DISABLED);
cparata 0:e7e920b85676 6338 LSM6DSL_ACC_GYRO_W_I2C_MASTER_Enable(handle, LSM6DSL_ACC_GYRO_MASTER_ON_DISABLED);
cparata 0:e7e920b85676 6339 }
cparata 0:e7e920b85676 6340
cparata 0:e7e920b85676 6341 return MEMS_SUCCESS;
cparata 0:e7e920b85676 6342 }
cparata 0:e7e920b85676 6343
cparata 0:e7e920b85676 6344 /* Write a remote device through I2C Sensor Hub Slave 0 */
cparata 0:e7e920b85676 6345 status_t LSM6DSL_ACC_GYRO_SH0_WriteByte(void *handle, u8_t SlvAddr, u8_t Reg, u8_t Bufp)
cparata 0:e7e920b85676 6346 {
cparata 0:e7e920b85676 6347 LSM6DSL_ACC_GYRO_SENS_HUB_END_t op_cmpl = LSM6DSL_ACC_GYRO_SENS_HUB_END_STILL_ONGOING;
cparata 0:e7e920b85676 6348 LSM6DSL_ACC_GYRO_XLDA_t op_update = LSM6DSL_ACC_GYRO_XLDA_NO_DATA_AVAIL;
cparata 0:e7e920b85676 6349 u8_t dummy[6];
cparata 0:e7e920b85676 6350
cparata 0:e7e920b85676 6351 /* Open Embedded Function Register page*/
cparata 0:e7e920b85676 6352 LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_ENABLED);
cparata 0:e7e920b85676 6353
cparata 0:e7e920b85676 6354 /* Write remote device I2C slave address */
cparata 0:e7e920b85676 6355 LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_SLV0_ADD, &SlvAddr, 1);
cparata 0:e7e920b85676 6356
cparata 0:e7e920b85676 6357 /* Write remote device I2C subaddress */
cparata 0:e7e920b85676 6358 LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_SLV0_SUBADD, &Reg, 1);
cparata 0:e7e920b85676 6359
cparata 0:e7e920b85676 6360 /* Write the data */
cparata 0:e7e920b85676 6361 LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_DATAWRITE_SRC_MODE_SUB_SLV0, &Bufp, 1);
cparata 0:e7e920b85676 6362
cparata 0:e7e920b85676 6363 /* Close Embedded Function Register page*/
cparata 0:e7e920b85676 6364 LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_DISABLED);
cparata 0:e7e920b85676 6365
cparata 0:e7e920b85676 6366 /* Enable FUNC */
cparata 0:e7e920b85676 6367 LSM6DSL_ACC_GYRO_W_FUNC_EN(handle, LSM6DSL_ACC_GYRO_FUNC_EN_ENABLED);
cparata 0:e7e920b85676 6368
cparata 0:e7e920b85676 6369 /* Enable PULL_UP_EN and MASTER_EN */
cparata 0:e7e920b85676 6370 //LSM6DSL_ACC_GYRO_W_PULL_UP_EN(handle, LSM6DSL_ACC_GYRO_PULL_UP_EN_ENABLED);
cparata 0:e7e920b85676 6371 LSM6DSL_ACC_GYRO_W_I2C_MASTER_Enable(handle, LSM6DSL_ACC_GYRO_MASTER_ON_ENABLED);
cparata 0:e7e920b85676 6372
cparata 0:e7e920b85676 6373 /* Syncronize the SH with internal trigger (xl) */
cparata 0:e7e920b85676 6374 LSM6DSL_ACC_GYRO_W_ODR_XL(handle, LSM6DSL_ACC_GYRO_ODR_XL_104Hz);
cparata 0:e7e920b85676 6375
cparata 0:e7e920b85676 6376 /* Wait until operation is not completed */
cparata 0:e7e920b85676 6377 LSM6DSL_ACC_GYRO_GetRawAccData(handle, dummy);
cparata 0:e7e920b85676 6378 do {
cparata 0:e7e920b85676 6379 LSM6DSL_ACC_GYRO_R_XLDA(handle, &op_update);
cparata 0:e7e920b85676 6380 } while(op_update != LSM6DSL_ACC_GYRO_XLDA_DATA_AVAIL);
cparata 0:e7e920b85676 6381 do {
cparata 0:e7e920b85676 6382 LSM6DSL_ACC_GYRO_R_SENS_HUB_END(handle, &op_cmpl);
cparata 0:e7e920b85676 6383 } while(op_cmpl != LSM6DSL_ACC_GYRO_SENS_HUB_END_OP_COMPLETED);
cparata 0:e7e920b85676 6384
cparata 0:e7e920b85676 6385 LSM6DSL_ACC_GYRO_W_ODR_XL(handle, LSM6DSL_ACC_GYRO_ODR_XL_POWER_DOWN);
cparata 0:e7e920b85676 6386
cparata 0:e7e920b85676 6387 /* Stop everything */
cparata 0:e7e920b85676 6388 LSM6DSL_ACC_GYRO_W_FUNC_EN(handle, LSM6DSL_ACC_GYRO_FUNC_EN_DISABLED);
cparata 0:e7e920b85676 6389 LSM6DSL_ACC_GYRO_W_I2C_MASTER_Enable(handle, LSM6DSL_ACC_GYRO_MASTER_ON_DISABLED);
cparata 0:e7e920b85676 6390
cparata 0:e7e920b85676 6391
cparata 0:e7e920b85676 6392 return MEMS_SUCCESS;
cparata 0:e7e920b85676 6393 }