Example of multiple event detection for LSM6DSL in X-NUCLEO-IKS01A2

Dependencies:   X_NUCLEO_IKS01A2 mbed

Fork of MultiEvent_IKS01A2 by ST Expansion SW Team

Multi Event Demo Application based on sensor expansion board X-NUCLEO-IKS01A2

Main function is to show how to detect the free fall, tap, double tap, tilt, wake up, 6D Orientation and step events 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 simulate all the events and then view the notification using an hyper terminal.
- the user button can be used to enable/disable all hardware features.

Committer:
cparata
Date:
Thu Nov 24 15:42:24 2016 +0000
Revision:
0:763b80993db4
Add multi event example

Who changed what in which revision?

UserRevisionLine numberNew contents of line
cparata 0:763b80993db4 1 /**
cparata 0:763b80993db4 2 ******************************************************************************
cparata 0:763b80993db4 3 * @file LSM6DSL_ACC_GYRO_driver.c
cparata 0:763b80993db4 4 * @author MEMS Application Team
cparata 0:763b80993db4 5 * @version V1.5
cparata 0:763b80993db4 6 * @date 17-May-2016
cparata 0:763b80993db4 7 * @brief LSM6DSL driver file
cparata 0:763b80993db4 8 ******************************************************************************
cparata 0:763b80993db4 9 * @attention
cparata 0:763b80993db4 10 *
cparata 0:763b80993db4 11 * <h2><center>&copy; COPYRIGHT(c) 2016 STMicroelectronics</center></h2>
cparata 0:763b80993db4 12 *
cparata 0:763b80993db4 13 * Redistribution and use in source and binary forms, with or without modification,
cparata 0:763b80993db4 14 * are permitted provided that the following conditions are met:
cparata 0:763b80993db4 15 * 1. Redistributions of source code must retain the above copyright notice,
cparata 0:763b80993db4 16 * this list of conditions and the following disclaimer.
cparata 0:763b80993db4 17 * 2. Redistributions in binary form must reproduce the above copyright notice,
cparata 0:763b80993db4 18 * this list of conditions and the following disclaimer in the documentation
cparata 0:763b80993db4 19 * and/or other materials provided with the distribution.
cparata 0:763b80993db4 20 * 3. Neither the name of STMicroelectronics nor the names of its contributors
cparata 0:763b80993db4 21 * may be used to endorse or promote products derived from this software
cparata 0:763b80993db4 22 * without specific prior written permission.
cparata 0:763b80993db4 23 *
cparata 0:763b80993db4 24 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
cparata 0:763b80993db4 25 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
cparata 0:763b80993db4 26 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
cparata 0:763b80993db4 27 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
cparata 0:763b80993db4 28 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
cparata 0:763b80993db4 29 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
cparata 0:763b80993db4 30 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
cparata 0:763b80993db4 31 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
cparata 0:763b80993db4 32 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
cparata 0:763b80993db4 33 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
cparata 0:763b80993db4 34 *
cparata 0:763b80993db4 35 ******************************************************************************
cparata 0:763b80993db4 36 */
cparata 0:763b80993db4 37
cparata 0:763b80993db4 38 /* Includes ------------------------------------------------------------------*/
cparata 0:763b80993db4 39 #include "LSM6DSL_ACC_GYRO_driver.h"
cparata 0:763b80993db4 40
cparata 0:763b80993db4 41 /* Imported function prototypes ----------------------------------------------*/
cparata 0:763b80993db4 42 extern uint8_t LSM6DSL_IO_Write(void *handle, uint8_t WriteAddr, uint8_t *pBuffer, uint16_t nBytesToWrite);
cparata 0:763b80993db4 43 extern uint8_t LSM6DSL_IO_Read(void *handle, uint8_t ReadAddr, uint8_t *pBuffer, uint16_t nBytesToRead);
cparata 0:763b80993db4 44
cparata 0:763b80993db4 45 /* Private typedef -----------------------------------------------------------*/
cparata 0:763b80993db4 46
cparata 0:763b80993db4 47 /* Private define ------------------------------------------------------------*/
cparata 0:763b80993db4 48
cparata 0:763b80993db4 49 /* Private macro -------------------------------------------------------------*/
cparata 0:763b80993db4 50
cparata 0:763b80993db4 51 /* Private variables ---------------------------------------------------------*/
cparata 0:763b80993db4 52
cparata 0:763b80993db4 53 /* Private functions ---------------------------------------------------------*/
cparata 0:763b80993db4 54
cparata 0:763b80993db4 55 /* Exported functions ---------------------------------------------------------*/
cparata 0:763b80993db4 56
cparata 0:763b80993db4 57 /************** Generic Function *******************/
cparata 0:763b80993db4 58
cparata 0:763b80993db4 59 /*******************************************************************************
cparata 0:763b80993db4 60 * Function Name : LSM6DSL_ACC_GYRO_ReadReg
cparata 0:763b80993db4 61 * Description : Generic Reading function. It must be fullfilled with either
cparata 0:763b80993db4 62 * : I2C or SPI reading functions
cparata 0:763b80993db4 63 * Input : Register Address, length of buffer
cparata 0:763b80993db4 64 * Output : Data REad
cparata 0:763b80993db4 65 * Return : None
cparata 0:763b80993db4 66 *******************************************************************************/
cparata 0:763b80993db4 67 status_t LSM6DSL_ACC_GYRO_ReadReg(void *handle, u8_t Reg, u8_t* Data, u16_t len)
cparata 0:763b80993db4 68 {
cparata 0:763b80993db4 69 if (LSM6DSL_IO_Read(handle, Reg, Data, len))
cparata 0:763b80993db4 70 {
cparata 0:763b80993db4 71 return MEMS_ERROR;
cparata 0:763b80993db4 72 }
cparata 0:763b80993db4 73 else
cparata 0:763b80993db4 74 {
cparata 0:763b80993db4 75 return MEMS_SUCCESS;
cparata 0:763b80993db4 76 }
cparata 0:763b80993db4 77 }
cparata 0:763b80993db4 78
cparata 0:763b80993db4 79 /*******************************************************************************
cparata 0:763b80993db4 80 * Function Name : LSM6DSL_ACC_GYRO_WriteReg
cparata 0:763b80993db4 81 * Description : Generic Writing function. It must be fullfilled with either
cparata 0:763b80993db4 82 * : I2C or SPI writing function
cparata 0:763b80993db4 83 * Input : Register Address, Data to be written, length of buffer
cparata 0:763b80993db4 84 * Output : None
cparata 0:763b80993db4 85 * Return : None
cparata 0:763b80993db4 86 *******************************************************************************/
cparata 0:763b80993db4 87 status_t LSM6DSL_ACC_GYRO_WriteReg(void *handle, u8_t Reg, u8_t *Data, u16_t len)
cparata 0:763b80993db4 88 {
cparata 0:763b80993db4 89 if (LSM6DSL_IO_Write(handle, Reg, Data, len))
cparata 0:763b80993db4 90 {
cparata 0:763b80993db4 91 return MEMS_ERROR;
cparata 0:763b80993db4 92 }
cparata 0:763b80993db4 93 else
cparata 0:763b80993db4 94 {
cparata 0:763b80993db4 95 return MEMS_SUCCESS;
cparata 0:763b80993db4 96 }
cparata 0:763b80993db4 97 }
cparata 0:763b80993db4 98
cparata 0:763b80993db4 99 /**************** Base Function *******************/
cparata 0:763b80993db4 100
cparata 0:763b80993db4 101 /*******************************************************************************
cparata 0:763b80993db4 102 * Function Name : LSM6DSL_ACC_GYRO_R_WHO_AM_I
cparata 0:763b80993db4 103 * Description : Read WHO_AM_I_BIT
cparata 0:763b80993db4 104 * Input : Pointer to u8_t
cparata 0:763b80993db4 105 * Output : Status of WHO_AM_I_BIT
cparata 0:763b80993db4 106 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 107 *******************************************************************************/
cparata 0:763b80993db4 108 status_t LSM6DSL_ACC_GYRO_R_WHO_AM_I(void *handle, u8_t *value)
cparata 0:763b80993db4 109 {
cparata 0:763b80993db4 110 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WHO_AM_I_REG, (u8_t *)value, 1))
cparata 0:763b80993db4 111 return MEMS_ERROR;
cparata 0:763b80993db4 112
cparata 0:763b80993db4 113 *value &= LSM6DSL_ACC_GYRO_WHO_AM_I_BIT_MASK; //coerce
cparata 0:763b80993db4 114 *value = *value >> LSM6DSL_ACC_GYRO_WHO_AM_I_BIT_POSITION; //mask
cparata 0:763b80993db4 115
cparata 0:763b80993db4 116 return MEMS_SUCCESS;
cparata 0:763b80993db4 117 }
cparata 0:763b80993db4 118
cparata 0:763b80993db4 119 /*******************************************************************************
cparata 0:763b80993db4 120 * Function Name : LSM6DSL_ACC_GYRO_W_BDU
cparata 0:763b80993db4 121 * Description : Write BDU
cparata 0:763b80993db4 122 * Input : LSM6DSL_ACC_GYRO_BDU_t
cparata 0:763b80993db4 123 * Output : None
cparata 0:763b80993db4 124 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 125 *******************************************************************************/
cparata 0:763b80993db4 126 status_t LSM6DSL_ACC_GYRO_W_BDU(void *handle, LSM6DSL_ACC_GYRO_BDU_t newValue)
cparata 0:763b80993db4 127 {
cparata 0:763b80993db4 128 u8_t value;
cparata 0:763b80993db4 129
cparata 0:763b80993db4 130 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
cparata 0:763b80993db4 131 return MEMS_ERROR;
cparata 0:763b80993db4 132
cparata 0:763b80993db4 133 value &= ~LSM6DSL_ACC_GYRO_BDU_MASK;
cparata 0:763b80993db4 134 value |= newValue;
cparata 0:763b80993db4 135
cparata 0:763b80993db4 136 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
cparata 0:763b80993db4 137 return MEMS_ERROR;
cparata 0:763b80993db4 138
cparata 0:763b80993db4 139 return MEMS_SUCCESS;
cparata 0:763b80993db4 140 }
cparata 0:763b80993db4 141
cparata 0:763b80993db4 142 /*******************************************************************************
cparata 0:763b80993db4 143 * Function Name : LSM6DSL_ACC_GYRO_R_BDU
cparata 0:763b80993db4 144 * Description : Read BDU
cparata 0:763b80993db4 145 * Input : Pointer to LSM6DSL_ACC_GYRO_BDU_t
cparata 0:763b80993db4 146 * Output : Status of BDU see LSM6DSL_ACC_GYRO_BDU_t
cparata 0:763b80993db4 147 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 148 *******************************************************************************/
cparata 0:763b80993db4 149 status_t LSM6DSL_ACC_GYRO_R_BDU(void *handle, LSM6DSL_ACC_GYRO_BDU_t *value)
cparata 0:763b80993db4 150 {
cparata 0:763b80993db4 151 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1))
cparata 0:763b80993db4 152 return MEMS_ERROR;
cparata 0:763b80993db4 153
cparata 0:763b80993db4 154 *value &= LSM6DSL_ACC_GYRO_BDU_MASK; //mask
cparata 0:763b80993db4 155
cparata 0:763b80993db4 156 return MEMS_SUCCESS;
cparata 0:763b80993db4 157 }
cparata 0:763b80993db4 158
cparata 0:763b80993db4 159 /*******************************************************************************
cparata 0:763b80993db4 160 * Function Name : LSM6DSL_ACC_GYRO_W_FS_XL
cparata 0:763b80993db4 161 * Description : Write FS_XL
cparata 0:763b80993db4 162 * Input : LSM6DSL_ACC_GYRO_FS_XL_t
cparata 0:763b80993db4 163 * Output : None
cparata 0:763b80993db4 164 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 165 *******************************************************************************/
cparata 0:763b80993db4 166 status_t LSM6DSL_ACC_GYRO_W_FS_XL(void *handle, LSM6DSL_ACC_GYRO_FS_XL_t newValue)
cparata 0:763b80993db4 167 {
cparata 0:763b80993db4 168 u8_t value;
cparata 0:763b80993db4 169
cparata 0:763b80993db4 170 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, &value, 1))
cparata 0:763b80993db4 171 return MEMS_ERROR;
cparata 0:763b80993db4 172
cparata 0:763b80993db4 173 value &= ~LSM6DSL_ACC_GYRO_FS_XL_MASK;
cparata 0:763b80993db4 174 value |= newValue;
cparata 0:763b80993db4 175
cparata 0:763b80993db4 176 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, &value, 1) )
cparata 0:763b80993db4 177 return MEMS_ERROR;
cparata 0:763b80993db4 178
cparata 0:763b80993db4 179 return MEMS_SUCCESS;
cparata 0:763b80993db4 180 }
cparata 0:763b80993db4 181
cparata 0:763b80993db4 182 /*******************************************************************************
cparata 0:763b80993db4 183 * Function Name : LSM6DSL_ACC_GYRO_R_FS_XL
cparata 0:763b80993db4 184 * Description : Read FS_XL
cparata 0:763b80993db4 185 * Input : Pointer to LSM6DSL_ACC_GYRO_FS_XL_t
cparata 0:763b80993db4 186 * Output : Status of FS_XL see LSM6DSL_ACC_GYRO_FS_XL_t
cparata 0:763b80993db4 187 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 188 *******************************************************************************/
cparata 0:763b80993db4 189 status_t LSM6DSL_ACC_GYRO_R_FS_XL(void *handle, LSM6DSL_ACC_GYRO_FS_XL_t *value)
cparata 0:763b80993db4 190 {
cparata 0:763b80993db4 191 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, (u8_t *)value, 1))
cparata 0:763b80993db4 192 return MEMS_ERROR;
cparata 0:763b80993db4 193
cparata 0:763b80993db4 194 *value &= LSM6DSL_ACC_GYRO_FS_XL_MASK; //mask
cparata 0:763b80993db4 195
cparata 0:763b80993db4 196 return MEMS_SUCCESS;
cparata 0:763b80993db4 197 }
cparata 0:763b80993db4 198
cparata 0:763b80993db4 199 /*******************************************************************************
cparata 0:763b80993db4 200 * Function Name : status_t LSM6DSL_ACC_GYRO_GetRawAccData(u8_t *buff)
cparata 0:763b80993db4 201 * Description : Read GetAccData output register
cparata 0:763b80993db4 202 * Input : pointer to [u8_t]
cparata 0:763b80993db4 203 * Output : GetAccData buffer u8_t
cparata 0:763b80993db4 204 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 205 *******************************************************************************/
cparata 0:763b80993db4 206 status_t LSM6DSL_ACC_GYRO_GetRawAccData(void *handle, u8_t *buff)
cparata 0:763b80993db4 207 {
cparata 0:763b80993db4 208 u8_t i, j, k;
cparata 0:763b80993db4 209 u8_t numberOfByteForDimension;
cparata 0:763b80993db4 210
cparata 0:763b80993db4 211 numberOfByteForDimension=6/3;
cparata 0:763b80993db4 212
cparata 0:763b80993db4 213 k=0;
cparata 0:763b80993db4 214 for (i=0; i<3;i++ )
cparata 0:763b80993db4 215 {
cparata 0:763b80993db4 216 for (j=0; j<numberOfByteForDimension;j++ )
cparata 0:763b80993db4 217 {
cparata 0:763b80993db4 218 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_OUTX_L_XL+k, &buff[k], 1))
cparata 0:763b80993db4 219 return MEMS_ERROR;
cparata 0:763b80993db4 220 k++;
cparata 0:763b80993db4 221 }
cparata 0:763b80993db4 222 }
cparata 0:763b80993db4 223
cparata 0:763b80993db4 224 return MEMS_SUCCESS;
cparata 0:763b80993db4 225 }
cparata 0:763b80993db4 226
cparata 0:763b80993db4 227 /*******************************************************************************
cparata 0:763b80993db4 228 * Function Name : status_t LSM6DSL_ACC_Get_Acceleration(void *handle, int *buff, u8_t from_fifo)
cparata 0:763b80993db4 229 * Description : Read GetAccData output register
cparata 0:763b80993db4 230 * Input : pointer to [u8_t]
cparata 0:763b80993db4 231 * Output : values are expressed in mg
cparata 0:763b80993db4 232 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 233 *******************************************************************************/
cparata 0:763b80993db4 234 /*
cparata 0:763b80993db4 235 * Following is the table of sensitivity values for each case.
cparata 0:763b80993db4 236 * Values are expressed in ug/digit.
cparata 0:763b80993db4 237 */
cparata 0:763b80993db4 238 static const long long LSM6DSL_ACC_Sensitivity_List[4] = {
cparata 0:763b80993db4 239 61, /* FS @2g */
cparata 0:763b80993db4 240 122, /* FS @4g */
cparata 0:763b80993db4 241 244, /* FS @8g */
cparata 0:763b80993db4 242 488, /* FS @16g */
cparata 0:763b80993db4 243 };
cparata 0:763b80993db4 244 status_t LSM6DSL_ACC_Get_Acceleration(void *handle, int *buff, u8_t from_fifo)
cparata 0:763b80993db4 245 {
cparata 0:763b80993db4 246 LSM6DSL_ACC_GYRO_FS_XL_t fs;
cparata 0:763b80993db4 247 long long sensitivity = 0;
cparata 0:763b80993db4 248 Type3Axis16bit_U raw_data_tmp;
cparata 0:763b80993db4 249
cparata 0:763b80993db4 250 /* Read out current odr, fs, hf setting */
cparata 0:763b80993db4 251 LSM6DSL_ACC_GYRO_R_FS_XL(handle, &fs);
cparata 0:763b80993db4 252
cparata 0:763b80993db4 253 /* Determine the sensitivity according to fs */
cparata 0:763b80993db4 254 switch(fs) {
cparata 0:763b80993db4 255 case LSM6DSL_ACC_GYRO_FS_XL_2g:
cparata 0:763b80993db4 256 sensitivity = LSM6DSL_ACC_Sensitivity_List[0];
cparata 0:763b80993db4 257 break;
cparata 0:763b80993db4 258
cparata 0:763b80993db4 259 case LSM6DSL_ACC_GYRO_FS_XL_4g:
cparata 0:763b80993db4 260 sensitivity = LSM6DSL_ACC_Sensitivity_List[1];
cparata 0:763b80993db4 261 break;
cparata 0:763b80993db4 262
cparata 0:763b80993db4 263 case LSM6DSL_ACC_GYRO_FS_XL_8g:
cparata 0:763b80993db4 264 sensitivity = LSM6DSL_ACC_Sensitivity_List[2];
cparata 0:763b80993db4 265 break;
cparata 0:763b80993db4 266
cparata 0:763b80993db4 267 case LSM6DSL_ACC_GYRO_FS_XL_16g:
cparata 0:763b80993db4 268 sensitivity = LSM6DSL_ACC_Sensitivity_List[3];
cparata 0:763b80993db4 269 break;
cparata 0:763b80993db4 270 }
cparata 0:763b80993db4 271
cparata 0:763b80993db4 272 /* Read out raw accelerometer samples */
cparata 0:763b80993db4 273 if (from_fifo) {
cparata 0:763b80993db4 274 u8_t i;
cparata 0:763b80993db4 275
cparata 0:763b80993db4 276 /* read all 3 axis from FIFO */
cparata 0:763b80993db4 277 for(i = 0; i < 3; i++)
cparata 0:763b80993db4 278 LSM6DSL_ACC_GYRO_Get_GetFIFOData(handle, raw_data_tmp.u8bit + 2*i);
cparata 0:763b80993db4 279 } else
cparata 0:763b80993db4 280 LSM6DSL_ACC_GYRO_GetRawAccData(handle, raw_data_tmp.u8bit);
cparata 0:763b80993db4 281
cparata 0:763b80993db4 282 /* Apply proper shift and sensitivity */
cparata 0:763b80993db4 283 buff[0] = (raw_data_tmp.i16bit[0] * sensitivity + 500)/1000;
cparata 0:763b80993db4 284 buff[1] = (raw_data_tmp.i16bit[1] * sensitivity + 500)/1000;
cparata 0:763b80993db4 285 buff[2] = (raw_data_tmp.i16bit[2] * sensitivity + 500)/1000;
cparata 0:763b80993db4 286
cparata 0:763b80993db4 287 return MEMS_SUCCESS;
cparata 0:763b80993db4 288 }
cparata 0:763b80993db4 289
cparata 0:763b80993db4 290 /*******************************************************************************
cparata 0:763b80993db4 291 * Function Name : LSM6DSL_ACC_GYRO_W_ODR_XL
cparata 0:763b80993db4 292 * Description : Write ODR_XL
cparata 0:763b80993db4 293 * Input : LSM6DSL_ACC_GYRO_ODR_XL_t
cparata 0:763b80993db4 294 * Output : None
cparata 0:763b80993db4 295 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 296 *******************************************************************************/
cparata 0:763b80993db4 297 status_t LSM6DSL_ACC_GYRO_W_ODR_XL(void *handle, LSM6DSL_ACC_GYRO_ODR_XL_t newValue)
cparata 0:763b80993db4 298 {
cparata 0:763b80993db4 299 u8_t value;
cparata 0:763b80993db4 300
cparata 0:763b80993db4 301 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, &value, 1))
cparata 0:763b80993db4 302 return MEMS_ERROR;
cparata 0:763b80993db4 303
cparata 0:763b80993db4 304 value &= ~LSM6DSL_ACC_GYRO_ODR_XL_MASK;
cparata 0:763b80993db4 305 value |= newValue;
cparata 0:763b80993db4 306
cparata 0:763b80993db4 307 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, &value, 1) )
cparata 0:763b80993db4 308 return MEMS_ERROR;
cparata 0:763b80993db4 309
cparata 0:763b80993db4 310 return MEMS_SUCCESS;
cparata 0:763b80993db4 311 }
cparata 0:763b80993db4 312
cparata 0:763b80993db4 313 /*******************************************************************************
cparata 0:763b80993db4 314 * Function Name : LSM6DSL_ACC_GYRO_R_ODR_XL
cparata 0:763b80993db4 315 * Description : Read ODR_XL
cparata 0:763b80993db4 316 * Input : Pointer to LSM6DSL_ACC_GYRO_ODR_XL_t
cparata 0:763b80993db4 317 * Output : Status of ODR_XL see LSM6DSL_ACC_GYRO_ODR_XL_t
cparata 0:763b80993db4 318 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 319 *******************************************************************************/
cparata 0:763b80993db4 320 status_t LSM6DSL_ACC_GYRO_R_ODR_XL(void *handle, LSM6DSL_ACC_GYRO_ODR_XL_t *value)
cparata 0:763b80993db4 321 {
cparata 0:763b80993db4 322 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, (u8_t *)value, 1))
cparata 0:763b80993db4 323 return MEMS_ERROR;
cparata 0:763b80993db4 324
cparata 0:763b80993db4 325 *value &= LSM6DSL_ACC_GYRO_ODR_XL_MASK; //mask
cparata 0:763b80993db4 326
cparata 0:763b80993db4 327 return MEMS_SUCCESS;
cparata 0:763b80993db4 328 }
cparata 0:763b80993db4 329
cparata 0:763b80993db4 330 /*******************************************************************************
cparata 0:763b80993db4 331 * Function Name : LSM6DSL_ACC_GYRO_translate_ODR_XL
cparata 0:763b80993db4 332 * Description : Read ODR_XL
cparata 0:763b80993db4 333 * Input : LSM6DSL_ACC_GYRO_ODR_XL_t
cparata 0:763b80993db4 334 * Output : The ODR value in Hz
cparata 0:763b80993db4 335 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 336 *******************************************************************************/
cparata 0:763b80993db4 337 status_t LSM6DSL_ACC_GYRO_translate_ODR_XL(LSM6DSL_ACC_GYRO_ODR_XL_t value, u16_t *odr_hz_val)
cparata 0:763b80993db4 338 {
cparata 0:763b80993db4 339 switch(value) {
cparata 0:763b80993db4 340 case LSM6DSL_ACC_GYRO_ODR_XL_POWER_DOWN:
cparata 0:763b80993db4 341 *odr_hz_val = 0;
cparata 0:763b80993db4 342 break;
cparata 0:763b80993db4 343
cparata 0:763b80993db4 344 case LSM6DSL_ACC_GYRO_ODR_XL_13Hz:
cparata 0:763b80993db4 345 *odr_hz_val = 13;
cparata 0:763b80993db4 346 break;
cparata 0:763b80993db4 347
cparata 0:763b80993db4 348 case LSM6DSL_ACC_GYRO_ODR_XL_26Hz:
cparata 0:763b80993db4 349 *odr_hz_val = 26;
cparata 0:763b80993db4 350 break;
cparata 0:763b80993db4 351
cparata 0:763b80993db4 352 case LSM6DSL_ACC_GYRO_ODR_XL_52Hz:
cparata 0:763b80993db4 353 *odr_hz_val = 52;
cparata 0:763b80993db4 354 break;
cparata 0:763b80993db4 355
cparata 0:763b80993db4 356 case LSM6DSL_ACC_GYRO_ODR_XL_104Hz:
cparata 0:763b80993db4 357 *odr_hz_val = 104;
cparata 0:763b80993db4 358 break;
cparata 0:763b80993db4 359
cparata 0:763b80993db4 360 case LSM6DSL_ACC_GYRO_ODR_XL_208Hz:
cparata 0:763b80993db4 361 *odr_hz_val = 208;
cparata 0:763b80993db4 362 break;
cparata 0:763b80993db4 363
cparata 0:763b80993db4 364 case LSM6DSL_ACC_GYRO_ODR_XL_416Hz:
cparata 0:763b80993db4 365 *odr_hz_val = 416;
cparata 0:763b80993db4 366 break;
cparata 0:763b80993db4 367
cparata 0:763b80993db4 368 case LSM6DSL_ACC_GYRO_ODR_XL_833Hz:
cparata 0:763b80993db4 369 *odr_hz_val = 833;
cparata 0:763b80993db4 370 break;
cparata 0:763b80993db4 371
cparata 0:763b80993db4 372 case LSM6DSL_ACC_GYRO_ODR_XL_1660Hz:
cparata 0:763b80993db4 373 *odr_hz_val = 1660;
cparata 0:763b80993db4 374 break;
cparata 0:763b80993db4 375
cparata 0:763b80993db4 376 default:
cparata 0:763b80993db4 377 return MEMS_ERROR;
cparata 0:763b80993db4 378 }
cparata 0:763b80993db4 379
cparata 0:763b80993db4 380 return MEMS_SUCCESS;
cparata 0:763b80993db4 381 }
cparata 0:763b80993db4 382
cparata 0:763b80993db4 383 /*******************************************************************************
cparata 0:763b80993db4 384 * Function Name : LSM6DSL_ACC_GYRO_W_FS_G
cparata 0:763b80993db4 385 * Description : Write FS_G
cparata 0:763b80993db4 386 * Input : LSM6DSL_ACC_GYRO_FS_G_t
cparata 0:763b80993db4 387 * Output : None
cparata 0:763b80993db4 388 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 389 *******************************************************************************/
cparata 0:763b80993db4 390 status_t LSM6DSL_ACC_GYRO_W_FS_G(void *handle, LSM6DSL_ACC_GYRO_FS_G_t newValue)
cparata 0:763b80993db4 391 {
cparata 0:763b80993db4 392 u8_t value;
cparata 0:763b80993db4 393
cparata 0:763b80993db4 394 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, &value, 1))
cparata 0:763b80993db4 395 return MEMS_ERROR;
cparata 0:763b80993db4 396
cparata 0:763b80993db4 397 value &= ~LSM6DSL_ACC_GYRO_FS_G_MASK;
cparata 0:763b80993db4 398 value |= newValue;
cparata 0:763b80993db4 399
cparata 0:763b80993db4 400 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, &value, 1) )
cparata 0:763b80993db4 401 return MEMS_ERROR;
cparata 0:763b80993db4 402
cparata 0:763b80993db4 403 return MEMS_SUCCESS;
cparata 0:763b80993db4 404 }
cparata 0:763b80993db4 405
cparata 0:763b80993db4 406 /*******************************************************************************
cparata 0:763b80993db4 407 * Function Name : LSM6DSL_ACC_GYRO_R_FS_G
cparata 0:763b80993db4 408 * Description : Read FS_G
cparata 0:763b80993db4 409 * Input : Pointer to LSM6DSL_ACC_GYRO_FS_G_t
cparata 0:763b80993db4 410 * Output : Status of FS_G see LSM6DSL_ACC_GYRO_FS_G_t
cparata 0:763b80993db4 411 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 412 *******************************************************************************/
cparata 0:763b80993db4 413 status_t LSM6DSL_ACC_GYRO_R_FS_G(void *handle, LSM6DSL_ACC_GYRO_FS_G_t *value)
cparata 0:763b80993db4 414 {
cparata 0:763b80993db4 415 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, (u8_t *)value, 1))
cparata 0:763b80993db4 416 return MEMS_ERROR;
cparata 0:763b80993db4 417
cparata 0:763b80993db4 418 *value &= LSM6DSL_ACC_GYRO_FS_G_MASK; //mask
cparata 0:763b80993db4 419
cparata 0:763b80993db4 420 return MEMS_SUCCESS;
cparata 0:763b80993db4 421 }
cparata 0:763b80993db4 422
cparata 0:763b80993db4 423 /*******************************************************************************
cparata 0:763b80993db4 424 * Function Name : status_t LSM6DSL_ACC_GYRO_GetRawGyroData(u8_t *buff)
cparata 0:763b80993db4 425 * Description : Read GetGyroData output register
cparata 0:763b80993db4 426 * Input : pointer to [u8_t]
cparata 0:763b80993db4 427 * Output : GetGyroData buffer u8_t
cparata 0:763b80993db4 428 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 429 *******************************************************************************/
cparata 0:763b80993db4 430 status_t LSM6DSL_ACC_GYRO_GetRawGyroData(void *handle, u8_t *buff)
cparata 0:763b80993db4 431 {
cparata 0:763b80993db4 432 u8_t i, j, k;
cparata 0:763b80993db4 433 u8_t numberOfByteForDimension;
cparata 0:763b80993db4 434
cparata 0:763b80993db4 435 numberOfByteForDimension=6/3;
cparata 0:763b80993db4 436
cparata 0:763b80993db4 437 k=0;
cparata 0:763b80993db4 438 for (i=0; i<3;i++ )
cparata 0:763b80993db4 439 {
cparata 0:763b80993db4 440 for (j=0; j<numberOfByteForDimension;j++ )
cparata 0:763b80993db4 441 {
cparata 0:763b80993db4 442 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_OUTX_L_G+k, &buff[k], 1))
cparata 0:763b80993db4 443 return MEMS_ERROR;
cparata 0:763b80993db4 444 k++;
cparata 0:763b80993db4 445 }
cparata 0:763b80993db4 446 }
cparata 0:763b80993db4 447
cparata 0:763b80993db4 448 return MEMS_SUCCESS;
cparata 0:763b80993db4 449 }
cparata 0:763b80993db4 450
cparata 0:763b80993db4 451 /*******************************************************************************
cparata 0:763b80993db4 452 * Function Name : status_t LSM6DSL_ACC_Get_AngularRate(u8_t *buff)
cparata 0:763b80993db4 453 * Description : Read GetGyroData output register
cparata 0:763b80993db4 454 * Input : pointer to [u8_t]
cparata 0:763b80993db4 455 * Output : Returned values are espressed in mdps
cparata 0:763b80993db4 456 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 457 *******************************************************************************/
cparata 0:763b80993db4 458 /*
cparata 0:763b80993db4 459 * Following is the table of sensitivity values for each case.
cparata 0:763b80993db4 460 * Values are espressed in udps/digit.
cparata 0:763b80993db4 461 */
cparata 0:763b80993db4 462 static const long long LSM6DSL_GYRO_Sensitivity_List[5] = {
cparata 0:763b80993db4 463 4375, /* FS @125 */
cparata 0:763b80993db4 464 8750, /* FS @245 */
cparata 0:763b80993db4 465 17500, /* FS @500 */
cparata 0:763b80993db4 466 35000, /* FS @1000 */
cparata 0:763b80993db4 467 70000, /* FS @2000 */
cparata 0:763b80993db4 468 };
cparata 0:763b80993db4 469 status_t LSM6DSL_ACC_Get_AngularRate(void *handle, int *buff, u8_t from_fifo)
cparata 0:763b80993db4 470 {
cparata 0:763b80993db4 471 LSM6DSL_ACC_GYRO_FS_125_t fs_125;
cparata 0:763b80993db4 472 LSM6DSL_ACC_GYRO_FS_G_t fs;
cparata 0:763b80993db4 473 long long sensitivity = 0;
cparata 0:763b80993db4 474 Type3Axis16bit_U raw_data_tmp;
cparata 0:763b80993db4 475
cparata 0:763b80993db4 476 /* Read out current odr, fs, hf setting */
cparata 0:763b80993db4 477 LSM6DSL_ACC_GYRO_R_FS_125(handle, &fs_125);
cparata 0:763b80993db4 478 if (fs_125 == LSM6DSL_ACC_GYRO_FS_125_ENABLED) {
cparata 0:763b80993db4 479 sensitivity = LSM6DSL_GYRO_Sensitivity_List[0];
cparata 0:763b80993db4 480 } else {
cparata 0:763b80993db4 481 LSM6DSL_ACC_GYRO_R_FS_G(handle, &fs);
cparata 0:763b80993db4 482
cparata 0:763b80993db4 483 /* Determine the sensitivity according to fs */
cparata 0:763b80993db4 484 switch(fs) {
cparata 0:763b80993db4 485 case LSM6DSL_ACC_GYRO_FS_G_245dps:
cparata 0:763b80993db4 486 sensitivity = LSM6DSL_GYRO_Sensitivity_List[1];
cparata 0:763b80993db4 487 break;
cparata 0:763b80993db4 488
cparata 0:763b80993db4 489 case LSM6DSL_ACC_GYRO_FS_G_500dps:
cparata 0:763b80993db4 490 sensitivity = LSM6DSL_GYRO_Sensitivity_List[2];
cparata 0:763b80993db4 491 break;
cparata 0:763b80993db4 492
cparata 0:763b80993db4 493 case LSM6DSL_ACC_GYRO_FS_G_1000dps:
cparata 0:763b80993db4 494 sensitivity = LSM6DSL_GYRO_Sensitivity_List[3];
cparata 0:763b80993db4 495 break;
cparata 0:763b80993db4 496
cparata 0:763b80993db4 497 case LSM6DSL_ACC_GYRO_FS_G_2000dps:
cparata 0:763b80993db4 498 sensitivity = LSM6DSL_GYRO_Sensitivity_List[4];
cparata 0:763b80993db4 499 break;
cparata 0:763b80993db4 500 }
cparata 0:763b80993db4 501 }
cparata 0:763b80993db4 502
cparata 0:763b80993db4 503 /* Read out raw accelerometer samples */
cparata 0:763b80993db4 504 if (from_fifo) {
cparata 0:763b80993db4 505 u8_t i;
cparata 0:763b80993db4 506
cparata 0:763b80993db4 507 /* read all 3 axis from FIFO */
cparata 0:763b80993db4 508 for(i = 0; i < 3; i++)
cparata 0:763b80993db4 509 LSM6DSL_ACC_GYRO_Get_GetFIFOData(handle, raw_data_tmp.u8bit + 2*i);
cparata 0:763b80993db4 510 } else
cparata 0:763b80993db4 511 LSM6DSL_ACC_GYRO_GetRawGyroData(handle, raw_data_tmp.u8bit);
cparata 0:763b80993db4 512
cparata 0:763b80993db4 513 /* Apply proper shift and sensitivity */
cparata 0:763b80993db4 514 buff[0] = (raw_data_tmp.i16bit[0] * sensitivity + 500)/1000;
cparata 0:763b80993db4 515 buff[1] = (raw_data_tmp.i16bit[1] * sensitivity + 500)/1000;
cparata 0:763b80993db4 516 buff[2] = (raw_data_tmp.i16bit[2] * sensitivity + 500)/1000;
cparata 0:763b80993db4 517
cparata 0:763b80993db4 518 return MEMS_SUCCESS;
cparata 0:763b80993db4 519 }
cparata 0:763b80993db4 520
cparata 0:763b80993db4 521 /*******************************************************************************
cparata 0:763b80993db4 522 * Function Name : LSM6DSL_ACC_GYRO_W_ODR_G
cparata 0:763b80993db4 523 * Description : Write ODR_G
cparata 0:763b80993db4 524 * Input : LSM6DSL_ACC_GYRO_ODR_G_t
cparata 0:763b80993db4 525 * Output : None
cparata 0:763b80993db4 526 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 527 *******************************************************************************/
cparata 0:763b80993db4 528 status_t LSM6DSL_ACC_GYRO_W_ODR_G(void *handle, LSM6DSL_ACC_GYRO_ODR_G_t newValue)
cparata 0:763b80993db4 529 {
cparata 0:763b80993db4 530 u8_t value;
cparata 0:763b80993db4 531
cparata 0:763b80993db4 532 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, &value, 1))
cparata 0:763b80993db4 533 return MEMS_ERROR;
cparata 0:763b80993db4 534
cparata 0:763b80993db4 535 value &= ~LSM6DSL_ACC_GYRO_ODR_G_MASK;
cparata 0:763b80993db4 536 value |= newValue;
cparata 0:763b80993db4 537
cparata 0:763b80993db4 538 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, &value, 1) )
cparata 0:763b80993db4 539 return MEMS_ERROR;
cparata 0:763b80993db4 540
cparata 0:763b80993db4 541 return MEMS_SUCCESS;
cparata 0:763b80993db4 542 }
cparata 0:763b80993db4 543
cparata 0:763b80993db4 544 /*******************************************************************************
cparata 0:763b80993db4 545 * Function Name : LSM6DSL_ACC_GYRO_R_ODR_G
cparata 0:763b80993db4 546 * Description : Read ODR_G
cparata 0:763b80993db4 547 * Input : Pointer to LSM6DSL_ACC_GYRO_ODR_G_t
cparata 0:763b80993db4 548 * Output : Status of ODR_G see LSM6DSL_ACC_GYRO_ODR_G_t
cparata 0:763b80993db4 549 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 550 *******************************************************************************/
cparata 0:763b80993db4 551 status_t LSM6DSL_ACC_GYRO_R_ODR_G(void *handle, LSM6DSL_ACC_GYRO_ODR_G_t *value)
cparata 0:763b80993db4 552 {
cparata 0:763b80993db4 553 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, (u8_t *)value, 1))
cparata 0:763b80993db4 554 return MEMS_ERROR;
cparata 0:763b80993db4 555
cparata 0:763b80993db4 556 *value &= LSM6DSL_ACC_GYRO_ODR_G_MASK; //mask
cparata 0:763b80993db4 557
cparata 0:763b80993db4 558 return MEMS_SUCCESS;
cparata 0:763b80993db4 559 }
cparata 0:763b80993db4 560
cparata 0:763b80993db4 561 /*******************************************************************************
cparata 0:763b80993db4 562 * Function Name : LSM6DSL_ACC_GYRO_translate_ODR_G
cparata 0:763b80993db4 563 * Description : Read ODR_G
cparata 0:763b80993db4 564 * Input : LSM6DSL_ACC_GYRO_ODR_G_t
cparata 0:763b80993db4 565 * Output : The ODR value in Hz
cparata 0:763b80993db4 566 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 567 *******************************************************************************/
cparata 0:763b80993db4 568 status_t LSM6DSL_ACC_GYRO_translate_ODR_G(LSM6DSL_ACC_GYRO_ODR_G_t value, u16_t *odr_hz_val)
cparata 0:763b80993db4 569 {
cparata 0:763b80993db4 570 switch(value) {
cparata 0:763b80993db4 571 case LSM6DSL_ACC_GYRO_ODR_G_POWER_DOWN:
cparata 0:763b80993db4 572 *odr_hz_val = 0;
cparata 0:763b80993db4 573 break;
cparata 0:763b80993db4 574
cparata 0:763b80993db4 575 case LSM6DSL_ACC_GYRO_ODR_G_13Hz:
cparata 0:763b80993db4 576 *odr_hz_val = 13;
cparata 0:763b80993db4 577 break;
cparata 0:763b80993db4 578
cparata 0:763b80993db4 579 case LSM6DSL_ACC_GYRO_ODR_G_26Hz:
cparata 0:763b80993db4 580 *odr_hz_val = 26;
cparata 0:763b80993db4 581 break;
cparata 0:763b80993db4 582
cparata 0:763b80993db4 583 case LSM6DSL_ACC_GYRO_ODR_G_52Hz:
cparata 0:763b80993db4 584 *odr_hz_val = 52;
cparata 0:763b80993db4 585 break;
cparata 0:763b80993db4 586
cparata 0:763b80993db4 587 case LSM6DSL_ACC_GYRO_ODR_G_104Hz:
cparata 0:763b80993db4 588 *odr_hz_val = 104;
cparata 0:763b80993db4 589 break;
cparata 0:763b80993db4 590
cparata 0:763b80993db4 591 case LSM6DSL_ACC_GYRO_ODR_G_208Hz:
cparata 0:763b80993db4 592 *odr_hz_val = 208;
cparata 0:763b80993db4 593 break;
cparata 0:763b80993db4 594
cparata 0:763b80993db4 595 case LSM6DSL_ACC_GYRO_ODR_G_416Hz:
cparata 0:763b80993db4 596 *odr_hz_val = 416;
cparata 0:763b80993db4 597 break;
cparata 0:763b80993db4 598
cparata 0:763b80993db4 599 case LSM6DSL_ACC_GYRO_ODR_G_833Hz:
cparata 0:763b80993db4 600 *odr_hz_val = 833;
cparata 0:763b80993db4 601 break;
cparata 0:763b80993db4 602
cparata 0:763b80993db4 603 case LSM6DSL_ACC_GYRO_ODR_G_1660Hz:
cparata 0:763b80993db4 604 *odr_hz_val = 1660;
cparata 0:763b80993db4 605 break;
cparata 0:763b80993db4 606
cparata 0:763b80993db4 607 default:
cparata 0:763b80993db4 608 return MEMS_ERROR;
cparata 0:763b80993db4 609 }
cparata 0:763b80993db4 610
cparata 0:763b80993db4 611 return MEMS_SUCCESS;
cparata 0:763b80993db4 612 }
cparata 0:763b80993db4 613
cparata 0:763b80993db4 614 /*******************************************************************************
cparata 0:763b80993db4 615 * Function Name : LSM6DSL_ACC_GYRO_W_FS_125
cparata 0:763b80993db4 616 * Description : Write FS_125
cparata 0:763b80993db4 617 * Input : LSM6DSL_ACC_GYRO_FS_125_t
cparata 0:763b80993db4 618 * Output : None
cparata 0:763b80993db4 619 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 620 *******************************************************************************/
cparata 0:763b80993db4 621 status_t LSM6DSL_ACC_GYRO_W_FS_125(void *handle, LSM6DSL_ACC_GYRO_FS_125_t newValue)
cparata 0:763b80993db4 622 {
cparata 0:763b80993db4 623 u8_t value;
cparata 0:763b80993db4 624
cparata 0:763b80993db4 625 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, &value, 1))
cparata 0:763b80993db4 626 return MEMS_ERROR;
cparata 0:763b80993db4 627
cparata 0:763b80993db4 628 value &= ~LSM6DSL_ACC_GYRO_FS_125_MASK;
cparata 0:763b80993db4 629 value |= newValue;
cparata 0:763b80993db4 630
cparata 0:763b80993db4 631 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, &value, 1) )
cparata 0:763b80993db4 632 return MEMS_ERROR;
cparata 0:763b80993db4 633
cparata 0:763b80993db4 634 return MEMS_SUCCESS;
cparata 0:763b80993db4 635 }
cparata 0:763b80993db4 636
cparata 0:763b80993db4 637 /*******************************************************************************
cparata 0:763b80993db4 638 * Function Name : LSM6DSL_ACC_GYRO_R_FS_125
cparata 0:763b80993db4 639 * Description : Read FS_125
cparata 0:763b80993db4 640 * Input : Pointer to LSM6DSL_ACC_GYRO_FS_125_t
cparata 0:763b80993db4 641 * Output : Status of FS_125 see LSM6DSL_ACC_GYRO_FS_125_t
cparata 0:763b80993db4 642 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 643 *******************************************************************************/
cparata 0:763b80993db4 644 status_t LSM6DSL_ACC_GYRO_R_FS_125(void *handle, LSM6DSL_ACC_GYRO_FS_125_t *value)
cparata 0:763b80993db4 645 {
cparata 0:763b80993db4 646 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL2_G, (u8_t *)value, 1))
cparata 0:763b80993db4 647 return MEMS_ERROR;
cparata 0:763b80993db4 648
cparata 0:763b80993db4 649 *value &= LSM6DSL_ACC_GYRO_FS_125_MASK; //mask
cparata 0:763b80993db4 650
cparata 0:763b80993db4 651 return MEMS_SUCCESS;
cparata 0:763b80993db4 652 }
cparata 0:763b80993db4 653
cparata 0:763b80993db4 654 /**************** Advanced Function *******************/
cparata 0:763b80993db4 655
cparata 0:763b80993db4 656 /*******************************************************************************
cparata 0:763b80993db4 657 * Function Name : LSM6DSL_ACC_GYRO_W_BW_SEL
cparata 0:763b80993db4 658 * Description : Write BW_SEL
cparata 0:763b80993db4 659 * Input : LSM6DSL_ACC_GYRO_BW_SEL_t
cparata 0:763b80993db4 660 * Output : None
cparata 0:763b80993db4 661 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 662 *******************************************************************************/
cparata 0:763b80993db4 663 status_t LSM6DSL_ACC_GYRO_W_BW_SEL(void *handle, LSM6DSL_ACC_GYRO_BW_SEL_t newValue)
cparata 0:763b80993db4 664 {
cparata 0:763b80993db4 665 u8_t value;
cparata 0:763b80993db4 666
cparata 0:763b80993db4 667 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, &value, 1))
cparata 0:763b80993db4 668 return MEMS_ERROR;
cparata 0:763b80993db4 669
cparata 0:763b80993db4 670 value &= ~LSM6DSL_ACC_GYRO_BW_SEL_MASK;
cparata 0:763b80993db4 671 value |= newValue;
cparata 0:763b80993db4 672
cparata 0:763b80993db4 673 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, &value, 1) )
cparata 0:763b80993db4 674 return MEMS_ERROR;
cparata 0:763b80993db4 675
cparata 0:763b80993db4 676 return MEMS_SUCCESS;
cparata 0:763b80993db4 677 }
cparata 0:763b80993db4 678
cparata 0:763b80993db4 679 /*******************************************************************************
cparata 0:763b80993db4 680 * Function Name : LSM6DSL_ACC_GYRO_R_BW_SEL
cparata 0:763b80993db4 681 * Description : Read BW_SEL
cparata 0:763b80993db4 682 * Input : Pointer to LSM6DSL_ACC_GYRO_BW_SEL_t
cparata 0:763b80993db4 683 * Output : Status of BW_SEL see LSM6DSL_ACC_GYRO_BW_SEL_t
cparata 0:763b80993db4 684 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 685 *******************************************************************************/
cparata 0:763b80993db4 686 status_t LSM6DSL_ACC_GYRO_R_BW_SEL(void *handle, LSM6DSL_ACC_GYRO_BW_SEL_t *value)
cparata 0:763b80993db4 687 {
cparata 0:763b80993db4 688 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL1_XL, (u8_t *)value, 1))
cparata 0:763b80993db4 689 return MEMS_ERROR;
cparata 0:763b80993db4 690
cparata 0:763b80993db4 691 *value &= LSM6DSL_ACC_GYRO_BW_SEL_MASK; //mask
cparata 0:763b80993db4 692
cparata 0:763b80993db4 693 return MEMS_SUCCESS;
cparata 0:763b80993db4 694 }
cparata 0:763b80993db4 695
cparata 0:763b80993db4 696 /*******************************************************************************
cparata 0:763b80993db4 697 * Function Name : LSM6DSL_ACC_GYRO_W_BLE
cparata 0:763b80993db4 698 * Description : Write BLE
cparata 0:763b80993db4 699 * Input : LSM6DSL_ACC_GYRO_BLE_t
cparata 0:763b80993db4 700 * Output : None
cparata 0:763b80993db4 701 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 702 *******************************************************************************/
cparata 0:763b80993db4 703 status_t LSM6DSL_ACC_GYRO_W_BLE(void *handle, LSM6DSL_ACC_GYRO_BLE_t newValue)
cparata 0:763b80993db4 704 {
cparata 0:763b80993db4 705 u8_t value;
cparata 0:763b80993db4 706
cparata 0:763b80993db4 707 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
cparata 0:763b80993db4 708 return MEMS_ERROR;
cparata 0:763b80993db4 709
cparata 0:763b80993db4 710 value &= ~LSM6DSL_ACC_GYRO_BLE_MASK;
cparata 0:763b80993db4 711 value |= newValue;
cparata 0:763b80993db4 712
cparata 0:763b80993db4 713 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
cparata 0:763b80993db4 714 return MEMS_ERROR;
cparata 0:763b80993db4 715
cparata 0:763b80993db4 716 return MEMS_SUCCESS;
cparata 0:763b80993db4 717 }
cparata 0:763b80993db4 718
cparata 0:763b80993db4 719 /*******************************************************************************
cparata 0:763b80993db4 720 * Function Name : LSM6DSL_ACC_GYRO_R_BLE
cparata 0:763b80993db4 721 * Description : Read BLE
cparata 0:763b80993db4 722 * Input : Pointer to LSM6DSL_ACC_GYRO_BLE_t
cparata 0:763b80993db4 723 * Output : Status of BLE see LSM6DSL_ACC_GYRO_BLE_t
cparata 0:763b80993db4 724 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 725 *******************************************************************************/
cparata 0:763b80993db4 726 status_t LSM6DSL_ACC_GYRO_R_BLE(void *handle, LSM6DSL_ACC_GYRO_BLE_t *value)
cparata 0:763b80993db4 727 {
cparata 0:763b80993db4 728 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1))
cparata 0:763b80993db4 729 return MEMS_ERROR;
cparata 0:763b80993db4 730
cparata 0:763b80993db4 731 *value &= LSM6DSL_ACC_GYRO_BLE_MASK; //mask
cparata 0:763b80993db4 732
cparata 0:763b80993db4 733 return MEMS_SUCCESS;
cparata 0:763b80993db4 734 }
cparata 0:763b80993db4 735
cparata 0:763b80993db4 736 /*******************************************************************************
cparata 0:763b80993db4 737 * Function Name : LSM6DSL_ACC_GYRO_W_EmbeddedAccess
cparata 0:763b80993db4 738 * Description : Write EMB_ACC
cparata 0:763b80993db4 739 * Input : LSM6DSL_ACC_GYRO_EMB_ACC_t
cparata 0:763b80993db4 740 * Output : None
cparata 0:763b80993db4 741 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 742 *******************************************************************************/
cparata 0:763b80993db4 743 status_t LSM6DSL_ACC_GYRO_W_EmbeddedAccess(void *handle, LSM6DSL_ACC_GYRO_EMB_ACC_t newValue)
cparata 0:763b80993db4 744 {
cparata 0:763b80993db4 745 u8_t value;
cparata 0:763b80993db4 746
cparata 0:763b80993db4 747 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_CFG_ACCESS, &value, 1) )
cparata 0:763b80993db4 748 return MEMS_ERROR;
cparata 0:763b80993db4 749
cparata 0:763b80993db4 750 value &= ~LSM6DSL_ACC_GYRO_EMB_ACC_MASK;
cparata 0:763b80993db4 751 value |= newValue;
cparata 0:763b80993db4 752
cparata 0:763b80993db4 753 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FUNC_CFG_ACCESS, &value, 1) )
cparata 0:763b80993db4 754 return MEMS_ERROR;
cparata 0:763b80993db4 755
cparata 0:763b80993db4 756 return MEMS_SUCCESS;
cparata 0:763b80993db4 757 }
cparata 0:763b80993db4 758
cparata 0:763b80993db4 759 /*******************************************************************************
cparata 0:763b80993db4 760 * Function Name : LSM6DSL_ACC_GYRO_R_EmbeddedAccess
cparata 0:763b80993db4 761 * Description : Read EMB_ACC
cparata 0:763b80993db4 762 * Input : Pointer to LSM6DSL_ACC_GYRO_EMB_ACC_t
cparata 0:763b80993db4 763 * Output : Status of EMB_ACC see LSM6DSL_ACC_GYRO_EMB_ACC_t
cparata 0:763b80993db4 764 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 765 *******************************************************************************/
cparata 0:763b80993db4 766 status_t LSM6DSL_ACC_GYRO_R_EmbeddedAccess(void *handle, LSM6DSL_ACC_GYRO_EMB_ACC_t *value)
cparata 0:763b80993db4 767 {
cparata 0:763b80993db4 768 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_CFG_ACCESS, (u8_t *)value, 1) )
cparata 0:763b80993db4 769 return MEMS_ERROR;
cparata 0:763b80993db4 770
cparata 0:763b80993db4 771 *value &= LSM6DSL_ACC_GYRO_EMB_ACC_MASK; //mask
cparata 0:763b80993db4 772
cparata 0:763b80993db4 773 return MEMS_SUCCESS;
cparata 0:763b80993db4 774 }
cparata 0:763b80993db4 775
cparata 0:763b80993db4 776 /*******************************************************************************
cparata 0:763b80993db4 777 * Function Name : LSM6DSL_ACC_GYRO_W_SYNC_RES_RATIO
cparata 0:763b80993db4 778 * Description : Write RR
cparata 0:763b80993db4 779 * Input : LSM6DSL_ACC_GYRO_SYNC_RES_RATIO_t
cparata 0:763b80993db4 780 * Output : None
cparata 0:763b80993db4 781 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 782 *******************************************************************************/
cparata 0:763b80993db4 783 status_t LSM6DSL_ACC_GYRO_W_SYNC_RES_RATIO(void *handle, LSM6DSL_ACC_GYRO_SYNC_RES_RATIO_t newValue)
cparata 0:763b80993db4 784 {
cparata 0:763b80993db4 785 u8_t value;
cparata 0:763b80993db4 786
cparata 0:763b80993db4 787 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_SENSOR_RES_RATIO, &value, 1) )
cparata 0:763b80993db4 788 return MEMS_ERROR;
cparata 0:763b80993db4 789
cparata 0:763b80993db4 790 value &= ~LSM6DSL_ACC_GYRO_SYNC_RES_RATIO_MASK;
cparata 0:763b80993db4 791 value |= newValue;
cparata 0:763b80993db4 792
cparata 0:763b80993db4 793 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_SENSOR_RES_RATIO, &value, 1) )
cparata 0:763b80993db4 794 return MEMS_ERROR;
cparata 0:763b80993db4 795
cparata 0:763b80993db4 796 return MEMS_SUCCESS;
cparata 0:763b80993db4 797 }
cparata 0:763b80993db4 798
cparata 0:763b80993db4 799 /*******************************************************************************
cparata 0:763b80993db4 800 * Function Name : LSM6DSL_ACC_GYRO_R_SYNC_RES_RATIO
cparata 0:763b80993db4 801 * Description : Read RR
cparata 0:763b80993db4 802 * Input : Pointer to LSM6DSL_ACC_GYRO_SYNC_RES_RATIO_t
cparata 0:763b80993db4 803 * Output : Status of RR see LSM6DSL_ACC_GYRO_SYNC_RES_RATIO_t
cparata 0:763b80993db4 804 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 805 *******************************************************************************/
cparata 0:763b80993db4 806 status_t LSM6DSL_ACC_GYRO_R_SYNC_RES_RATIO(void *handle, LSM6DSL_ACC_GYRO_SYNC_RES_RATIO_t *value)
cparata 0:763b80993db4 807 {
cparata 0:763b80993db4 808 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_SENSOR_RES_RATIO, (u8_t *)value, 1) )
cparata 0:763b80993db4 809 return MEMS_ERROR;
cparata 0:763b80993db4 810
cparata 0:763b80993db4 811 *value &= LSM6DSL_ACC_GYRO_SYNC_RES_RATIO_MASK; //mask
cparata 0:763b80993db4 812
cparata 0:763b80993db4 813 return MEMS_SUCCESS;
cparata 0:763b80993db4 814 }
cparata 0:763b80993db4 815
cparata 0:763b80993db4 816 /*******************************************************************************
cparata 0:763b80993db4 817 * Function Name : LSM6DSL_ACC_GYRO_W_Stamping_Time_Frame
cparata 0:763b80993db4 818 * Description : Write TPH
cparata 0:763b80993db4 819 * Input : u8_t
cparata 0:763b80993db4 820 * Output : None
cparata 0:763b80993db4 821 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 822 *******************************************************************************/
cparata 0:763b80993db4 823 status_t LSM6DSL_ACC_GYRO_W_Stamping_Time_Frame(void *handle, u8_t newValue)
cparata 0:763b80993db4 824 {
cparata 0:763b80993db4 825 u8_t value;
cparata 0:763b80993db4 826
cparata 0:763b80993db4 827 newValue = newValue << LSM6DSL_ACC_GYRO_TPH_POSITION; //mask
cparata 0:763b80993db4 828 newValue &= LSM6DSL_ACC_GYRO_TPH_MASK; //coerce
cparata 0:763b80993db4 829
cparata 0:763b80993db4 830 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_SENSOR_SYNC_TIME, &value, 1) )
cparata 0:763b80993db4 831 return MEMS_ERROR;
cparata 0:763b80993db4 832
cparata 0:763b80993db4 833 value &= (u8_t)~LSM6DSL_ACC_GYRO_TPH_MASK;
cparata 0:763b80993db4 834 value |= newValue;
cparata 0:763b80993db4 835
cparata 0:763b80993db4 836 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_SENSOR_SYNC_TIME, &value, 1) )
cparata 0:763b80993db4 837 return MEMS_ERROR;
cparata 0:763b80993db4 838
cparata 0:763b80993db4 839 return MEMS_SUCCESS;
cparata 0:763b80993db4 840 }
cparata 0:763b80993db4 841
cparata 0:763b80993db4 842 /*******************************************************************************
cparata 0:763b80993db4 843 * Function Name : LSM6DSL_ACC_GYRO_R_Stamping_Time_Frame
cparata 0:763b80993db4 844 * Description : Read TPH
cparata 0:763b80993db4 845 * Input : Pointer to u8_t
cparata 0:763b80993db4 846 * Output : Status of TPH
cparata 0:763b80993db4 847 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 848 *******************************************************************************/
cparata 0:763b80993db4 849 status_t LSM6DSL_ACC_GYRO_R_Stamping_Time_Frame(void *handle, u8_t *value)
cparata 0:763b80993db4 850 {
cparata 0:763b80993db4 851 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_SENSOR_SYNC_TIME, (u8_t *)value, 1) )
cparata 0:763b80993db4 852 return MEMS_ERROR;
cparata 0:763b80993db4 853
cparata 0:763b80993db4 854 *value &= LSM6DSL_ACC_GYRO_TPH_MASK; //coerce
cparata 0:763b80993db4 855 *value = *value >> LSM6DSL_ACC_GYRO_TPH_POSITION; //mask
cparata 0:763b80993db4 856
cparata 0:763b80993db4 857 return MEMS_SUCCESS;
cparata 0:763b80993db4 858 }
cparata 0:763b80993db4 859
cparata 0:763b80993db4 860 /*******************************************************************************
cparata 0:763b80993db4 861 * Function Name : LSM6DSL_ACC_GYRO_W_FIFO_Watermark
cparata 0:763b80993db4 862 * Description : Write WTM_FIFO
cparata 0:763b80993db4 863 * Input : u16_t
cparata 0:763b80993db4 864 * Output : None
cparata 0:763b80993db4 865 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 866 *******************************************************************************/
cparata 0:763b80993db4 867 status_t LSM6DSL_ACC_GYRO_W_FIFO_Watermark(void *handle, u16_t newValue)
cparata 0:763b80993db4 868 {
cparata 0:763b80993db4 869 u8_t valueH, valueL;
cparata 0:763b80993db4 870 u8_t value;
cparata 0:763b80993db4 871
cparata 0:763b80993db4 872 valueL = newValue & 0xFF;
cparata 0:763b80993db4 873 valueH = (newValue >> 8) & 0xFF;
cparata 0:763b80993db4 874
cparata 0:763b80993db4 875 /* Low part goes in FIFO_CTRL1 */
cparata 0:763b80993db4 876 valueL = valueL << LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL1_POSITION; //mask
cparata 0:763b80993db4 877 valueL &= LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL1_MASK; //coerce
cparata 0:763b80993db4 878
cparata 0:763b80993db4 879 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL1, &value, 1) )
cparata 0:763b80993db4 880 return MEMS_ERROR;
cparata 0:763b80993db4 881
cparata 0:763b80993db4 882 value &= (u8_t)~LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL1_MASK;
cparata 0:763b80993db4 883 value |= valueL;
cparata 0:763b80993db4 884
cparata 0:763b80993db4 885 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL1, &value, 1) )
cparata 0:763b80993db4 886 return MEMS_ERROR;
cparata 0:763b80993db4 887
cparata 0:763b80993db4 888 /* High part goes in FIFO_CTRL2 */
cparata 0:763b80993db4 889 valueH = valueH << LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL2_POSITION; //mask
cparata 0:763b80993db4 890 valueH &= LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL2_MASK; //coerce
cparata 0:763b80993db4 891
cparata 0:763b80993db4 892 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
cparata 0:763b80993db4 893 return MEMS_ERROR;
cparata 0:763b80993db4 894
cparata 0:763b80993db4 895 value &= ~LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL2_MASK;
cparata 0:763b80993db4 896 value |= valueH;
cparata 0:763b80993db4 897
cparata 0:763b80993db4 898 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
cparata 0:763b80993db4 899 return MEMS_ERROR;
cparata 0:763b80993db4 900
cparata 0:763b80993db4 901 return MEMS_SUCCESS;
cparata 0:763b80993db4 902 }
cparata 0:763b80993db4 903
cparata 0:763b80993db4 904 /*******************************************************************************
cparata 0:763b80993db4 905 * Function Name : LSM6DSL_ACC_GYRO_R_FIFO_Watermark
cparata 0:763b80993db4 906 * Description : Read WTM_FIFO
cparata 0:763b80993db4 907 * Input : Pointer to u16_t
cparata 0:763b80993db4 908 * Output : Status of WTM_FIFO
cparata 0:763b80993db4 909 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 910 *******************************************************************************/
cparata 0:763b80993db4 911 status_t LSM6DSL_ACC_GYRO_R_FIFO_Watermark(void *handle, u16_t *value)
cparata 0:763b80993db4 912 {
cparata 0:763b80993db4 913 u8_t valueH, valueL;
cparata 0:763b80993db4 914
cparata 0:763b80993db4 915 /* Low part from FIFO_CTRL1 */
cparata 0:763b80993db4 916 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL1, (u8_t *)&valueL, 1) )
cparata 0:763b80993db4 917 return MEMS_ERROR;
cparata 0:763b80993db4 918
cparata 0:763b80993db4 919 valueL &= LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL1_MASK; //coerce
cparata 0:763b80993db4 920 valueL = valueL >> LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL1_POSITION; //mask
cparata 0:763b80993db4 921
cparata 0:763b80993db4 922 /* High part from FIFO_CTRL2 */
cparata 0:763b80993db4 923 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, (u8_t *)&valueH, 1) )
cparata 0:763b80993db4 924 return MEMS_ERROR;
cparata 0:763b80993db4 925
cparata 0:763b80993db4 926 valueH &= LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL2_MASK; //coerce
cparata 0:763b80993db4 927 valueH = valueH >> LSM6DSL_ACC_GYRO_WTM_FIFO_CTRL2_POSITION; //mask
cparata 0:763b80993db4 928
cparata 0:763b80993db4 929 *value = ((valueH << 8) & 0xFF00) | valueL;
cparata 0:763b80993db4 930
cparata 0:763b80993db4 931 return MEMS_SUCCESS;
cparata 0:763b80993db4 932 }
cparata 0:763b80993db4 933
cparata 0:763b80993db4 934 /*******************************************************************************
cparata 0:763b80993db4 935 * Function Name : LSM6DSL_ACC_GYRO_W_FIFO_TEMP
cparata 0:763b80993db4 936 * Description : Write FIFO_TEMP_EN
cparata 0:763b80993db4 937 * Input : LSM6DSL_ACC_GYRO_FIFO_TEMP_t
cparata 0:763b80993db4 938 * Output : None
cparata 0:763b80993db4 939 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 940 *******************************************************************************/
cparata 0:763b80993db4 941 status_t LSM6DSL_ACC_GYRO_W_FIFO_TEMP(void *handle, LSM6DSL_ACC_GYRO_FIFO_TEMP_t newValue)
cparata 0:763b80993db4 942 {
cparata 0:763b80993db4 943 u8_t value;
cparata 0:763b80993db4 944
cparata 0:763b80993db4 945 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
cparata 0:763b80993db4 946 return MEMS_ERROR;
cparata 0:763b80993db4 947
cparata 0:763b80993db4 948 value &= ~LSM6DSL_ACC_GYRO_FIFO_TEMP_MASK;
cparata 0:763b80993db4 949 value |= newValue;
cparata 0:763b80993db4 950
cparata 0:763b80993db4 951 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
cparata 0:763b80993db4 952 return MEMS_ERROR;
cparata 0:763b80993db4 953
cparata 0:763b80993db4 954 return MEMS_SUCCESS;
cparata 0:763b80993db4 955 }
cparata 0:763b80993db4 956
cparata 0:763b80993db4 957 /*******************************************************************************
cparata 0:763b80993db4 958 * Function Name : LSM6DSL_ACC_GYRO_R_FIFO_TEMP
cparata 0:763b80993db4 959 * Description : Read FIFO_TEMP_EN
cparata 0:763b80993db4 960 * Input : Pointer to LSM6DSL_ACC_GYRO_FIFO_TEMP_t
cparata 0:763b80993db4 961 * Output : Status of FIFO_TEMP_EN see LSM6DSL_ACC_GYRO_FIFO_TEMP_t
cparata 0:763b80993db4 962 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 963 *******************************************************************************/
cparata 0:763b80993db4 964 status_t LSM6DSL_ACC_GYRO_R_FIFO_TEMP(void *handle, LSM6DSL_ACC_GYRO_FIFO_TEMP_t *value)
cparata 0:763b80993db4 965 {
cparata 0:763b80993db4 966 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, (u8_t *)value, 1) )
cparata 0:763b80993db4 967 return MEMS_ERROR;
cparata 0:763b80993db4 968
cparata 0:763b80993db4 969 *value &= LSM6DSL_ACC_GYRO_FIFO_TEMP_MASK; //mask
cparata 0:763b80993db4 970
cparata 0:763b80993db4 971 return MEMS_SUCCESS;
cparata 0:763b80993db4 972 }
cparata 0:763b80993db4 973
cparata 0:763b80993db4 974 /*******************************************************************************
cparata 0:763b80993db4 975 * Function Name : LSM6DSL_ACC_GYRO_W_TIM_PEDO_FIFO_Write_En
cparata 0:763b80993db4 976 * Description : Write TIM_PEDO_FIFO_DRDY
cparata 0:763b80993db4 977 * Input : LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_DRDY_t
cparata 0:763b80993db4 978 * Output : None
cparata 0:763b80993db4 979 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 980 *******************************************************************************/
cparata 0:763b80993db4 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:763b80993db4 982 {
cparata 0:763b80993db4 983 u8_t value;
cparata 0:763b80993db4 984
cparata 0:763b80993db4 985 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
cparata 0:763b80993db4 986 return MEMS_ERROR;
cparata 0:763b80993db4 987
cparata 0:763b80993db4 988 value &= ~LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_DRDY_MASK;
cparata 0:763b80993db4 989 value |= newValue;
cparata 0:763b80993db4 990
cparata 0:763b80993db4 991 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
cparata 0:763b80993db4 992 return MEMS_ERROR;
cparata 0:763b80993db4 993
cparata 0:763b80993db4 994 return MEMS_SUCCESS;
cparata 0:763b80993db4 995 }
cparata 0:763b80993db4 996
cparata 0:763b80993db4 997 /*******************************************************************************
cparata 0:763b80993db4 998 * Function Name : LSM6DSL_ACC_GYRO_R_TIM_PEDO_FIFO_Write_En
cparata 0:763b80993db4 999 * Description : Read TIM_PEDO_FIFO_DRDY
cparata 0:763b80993db4 1000 * Input : Pointer to LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_DRDY_t
cparata 0:763b80993db4 1001 * Output : Status of TIM_PEDO_FIFO_DRDY see LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_DRDY_t
cparata 0:763b80993db4 1002 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1003 *******************************************************************************/
cparata 0:763b80993db4 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:763b80993db4 1005 {
cparata 0:763b80993db4 1006 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, (u8_t *)value, 1) )
cparata 0:763b80993db4 1007 return MEMS_ERROR;
cparata 0:763b80993db4 1008
cparata 0:763b80993db4 1009 *value &= LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_DRDY_MASK; //mask
cparata 0:763b80993db4 1010
cparata 0:763b80993db4 1011 return MEMS_SUCCESS;
cparata 0:763b80993db4 1012 }
cparata 0:763b80993db4 1013
cparata 0:763b80993db4 1014 /*******************************************************************************
cparata 0:763b80993db4 1015 * Function Name : LSM6DSL_ACC_GYRO_W_TIM_PEDO_FIFO_En
cparata 0:763b80993db4 1016 * Description : Write TIM_PEDO_FIFO_EN
cparata 0:763b80993db4 1017 * Input : LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_EN_t
cparata 0:763b80993db4 1018 * Output : None
cparata 0:763b80993db4 1019 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1020 *******************************************************************************/
cparata 0:763b80993db4 1021 status_t LSM6DSL_ACC_GYRO_W_TIM_PEDO_FIFO_En(void *handle, LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_EN_t newValue)
cparata 0:763b80993db4 1022 {
cparata 0:763b80993db4 1023 u8_t value;
cparata 0:763b80993db4 1024
cparata 0:763b80993db4 1025 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
cparata 0:763b80993db4 1026 return MEMS_ERROR;
cparata 0:763b80993db4 1027
cparata 0:763b80993db4 1028 value &= ~LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_EN_MASK;
cparata 0:763b80993db4 1029 value |= newValue;
cparata 0:763b80993db4 1030
cparata 0:763b80993db4 1031 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, &value, 1) )
cparata 0:763b80993db4 1032 return MEMS_ERROR;
cparata 0:763b80993db4 1033
cparata 0:763b80993db4 1034 return MEMS_SUCCESS;
cparata 0:763b80993db4 1035 }
cparata 0:763b80993db4 1036
cparata 0:763b80993db4 1037 /*******************************************************************************
cparata 0:763b80993db4 1038 * Function Name : LSM6DSL_ACC_GYRO_R_TIM_PEDO_FIFO_En
cparata 0:763b80993db4 1039 * Description : Read TIM_PEDO_FIFO_EN
cparata 0:763b80993db4 1040 * Input : Pointer to LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_EN_t
cparata 0:763b80993db4 1041 * Output : Status of TIM_PEDO_FIFO_EN see LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_EN_t
cparata 0:763b80993db4 1042 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1043 *******************************************************************************/
cparata 0:763b80993db4 1044 status_t LSM6DSL_ACC_GYRO_R_TIM_PEDO_FIFO_En(void *handle, LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_EN_t *value)
cparata 0:763b80993db4 1045 {
cparata 0:763b80993db4 1046 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL2, (u8_t *)value, 1) )
cparata 0:763b80993db4 1047 return MEMS_ERROR;
cparata 0:763b80993db4 1048
cparata 0:763b80993db4 1049 *value &= LSM6DSL_ACC_GYRO_TIM_PEDO_FIFO_EN_MASK; //mask
cparata 0:763b80993db4 1050
cparata 0:763b80993db4 1051 return MEMS_SUCCESS;
cparata 0:763b80993db4 1052 }
cparata 0:763b80993db4 1053 /*******************************************************************************
cparata 0:763b80993db4 1054 * Function Name : LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL
cparata 0:763b80993db4 1055 * Description : Write DEC_FIFO_XL
cparata 0:763b80993db4 1056 * Input : LSM6DSL_ACC_GYRO_DEC_FIFO_XL_t
cparata 0:763b80993db4 1057 * Output : None
cparata 0:763b80993db4 1058 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1059 *******************************************************************************/
cparata 0:763b80993db4 1060 status_t LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_t newValue)
cparata 0:763b80993db4 1061 {
cparata 0:763b80993db4 1062 u8_t value;
cparata 0:763b80993db4 1063
cparata 0:763b80993db4 1064 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL3, &value, 1) )
cparata 0:763b80993db4 1065 return MEMS_ERROR;
cparata 0:763b80993db4 1066
cparata 0:763b80993db4 1067 value &= ~LSM6DSL_ACC_GYRO_DEC_FIFO_XL_MASK;
cparata 0:763b80993db4 1068 value |= newValue;
cparata 0:763b80993db4 1069
cparata 0:763b80993db4 1070 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL3, &value, 1) )
cparata 0:763b80993db4 1071 return MEMS_ERROR;
cparata 0:763b80993db4 1072
cparata 0:763b80993db4 1073 return MEMS_SUCCESS;
cparata 0:763b80993db4 1074 }
cparata 0:763b80993db4 1075
cparata 0:763b80993db4 1076 /*******************************************************************************
cparata 0:763b80993db4 1077 * Function Name : LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL_val
cparata 0:763b80993db4 1078 * Description : Write DEC_FIFO_XL
cparata 0:763b80993db4 1079 * Input : u16_t
cparata 0:763b80993db4 1080 * Output : Program XL decimation value from unsigned short
cparata 0:763b80993db4 1081 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1082 *******************************************************************************/
cparata 0:763b80993db4 1083 status_t LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL_val(void *handle, u16_t newValue)
cparata 0:763b80993db4 1084 {
cparata 0:763b80993db4 1085 switch(newValue) {
cparata 0:763b80993db4 1086 case 0:
cparata 0:763b80993db4 1087 LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_DATA_NOT_IN_FIFO);
cparata 0:763b80993db4 1088 break;
cparata 0:763b80993db4 1089
cparata 0:763b80993db4 1090 case 1:
cparata 0:763b80993db4 1091 LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_NO_DECIMATION);
cparata 0:763b80993db4 1092 break;
cparata 0:763b80993db4 1093
cparata 0:763b80993db4 1094 case 2:
cparata 0:763b80993db4 1095 LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_2);
cparata 0:763b80993db4 1096 break;
cparata 0:763b80993db4 1097
cparata 0:763b80993db4 1098 case 3:
cparata 0:763b80993db4 1099 LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_3);
cparata 0:763b80993db4 1100 break;
cparata 0:763b80993db4 1101
cparata 0:763b80993db4 1102 case 4:
cparata 0:763b80993db4 1103 LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_4);
cparata 0:763b80993db4 1104 break;
cparata 0:763b80993db4 1105
cparata 0:763b80993db4 1106 case 8:
cparata 0:763b80993db4 1107 LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_8);
cparata 0:763b80993db4 1108 break;
cparata 0:763b80993db4 1109
cparata 0:763b80993db4 1110 case 16:
cparata 0:763b80993db4 1111 LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_16);
cparata 0:763b80993db4 1112 break;
cparata 0:763b80993db4 1113
cparata 0:763b80993db4 1114 case 32:
cparata 0:763b80993db4 1115 LSM6DSL_ACC_GYRO_W_DEC_FIFO_XL(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_DECIMATION_BY_32);
cparata 0:763b80993db4 1116 break;
cparata 0:763b80993db4 1117
cparata 0:763b80993db4 1118 default:
cparata 0:763b80993db4 1119 return MEMS_ERROR;
cparata 0:763b80993db4 1120 }
cparata 0:763b80993db4 1121
cparata 0:763b80993db4 1122 return MEMS_SUCCESS;
cparata 0:763b80993db4 1123 }
cparata 0:763b80993db4 1124
cparata 0:763b80993db4 1125 /*******************************************************************************
cparata 0:763b80993db4 1126 * Function Name : LSM6DSL_ACC_GYRO_R_DEC_FIFO_XL
cparata 0:763b80993db4 1127 * Description : Read DEC_FIFO_XL
cparata 0:763b80993db4 1128 * Input : Pointer to LSM6DSL_ACC_GYRO_DEC_FIFO_XL_t
cparata 0:763b80993db4 1129 * Output : Status of DEC_FIFO_XL see LSM6DSL_ACC_GYRO_DEC_FIFO_XL_t
cparata 0:763b80993db4 1130 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1131 *******************************************************************************/
cparata 0:763b80993db4 1132 status_t LSM6DSL_ACC_GYRO_R_DEC_FIFO_XL(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_XL_t *value)
cparata 0:763b80993db4 1133 {
cparata 0:763b80993db4 1134 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL3, (u8_t *)value, 1) )
cparata 0:763b80993db4 1135 return MEMS_ERROR;
cparata 0:763b80993db4 1136
cparata 0:763b80993db4 1137 *value &= LSM6DSL_ACC_GYRO_DEC_FIFO_XL_MASK; //mask
cparata 0:763b80993db4 1138
cparata 0:763b80993db4 1139 return MEMS_SUCCESS;
cparata 0:763b80993db4 1140 }
cparata 0:763b80993db4 1141
cparata 0:763b80993db4 1142 /*******************************************************************************
cparata 0:763b80993db4 1143 * Function Name : LSM6DSL_ACC_GYRO_W_DEC_FIFO_G
cparata 0:763b80993db4 1144 * Description : Write DEC_FIFO_G
cparata 0:763b80993db4 1145 * Input : LSM6DSL_ACC_GYRO_DEC_FIFO_G_t
cparata 0:763b80993db4 1146 * Output : None
cparata 0:763b80993db4 1147 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1148 *******************************************************************************/
cparata 0:763b80993db4 1149 status_t LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_t newValue)
cparata 0:763b80993db4 1150 {
cparata 0:763b80993db4 1151 u8_t value;
cparata 0:763b80993db4 1152
cparata 0:763b80993db4 1153 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL3, &value, 1))
cparata 0:763b80993db4 1154 return MEMS_ERROR;
cparata 0:763b80993db4 1155
cparata 0:763b80993db4 1156 value &= ~LSM6DSL_ACC_GYRO_DEC_FIFO_G_MASK;
cparata 0:763b80993db4 1157 value |= newValue;
cparata 0:763b80993db4 1158
cparata 0:763b80993db4 1159 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL3, &value, 1) )
cparata 0:763b80993db4 1160 return MEMS_ERROR;
cparata 0:763b80993db4 1161
cparata 0:763b80993db4 1162 return MEMS_SUCCESS;
cparata 0:763b80993db4 1163 }
cparata 0:763b80993db4 1164
cparata 0:763b80993db4 1165 /*******************************************************************************
cparata 0:763b80993db4 1166 * Function Name : LSM6DSL_ACC_GYRO_W_DEC_FIFO_G_val
cparata 0:763b80993db4 1167 * Description : Write DEC_FIFO_G
cparata 0:763b80993db4 1168 * Input : u16_t
cparata 0:763b80993db4 1169 * Output : Program G decimation value from unsigned short
cparata 0:763b80993db4 1170 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1171 *******************************************************************************/
cparata 0:763b80993db4 1172 status_t LSM6DSL_ACC_GYRO_W_DEC_FIFO_G_val(void *handle, u16_t newValue)
cparata 0:763b80993db4 1173 {
cparata 0:763b80993db4 1174 switch(newValue) {
cparata 0:763b80993db4 1175 case 0:
cparata 0:763b80993db4 1176 LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_DATA_NOT_IN_FIFO);
cparata 0:763b80993db4 1177 break;
cparata 0:763b80993db4 1178
cparata 0:763b80993db4 1179 case 1:
cparata 0:763b80993db4 1180 LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_NO_DECIMATION);
cparata 0:763b80993db4 1181 break;
cparata 0:763b80993db4 1182
cparata 0:763b80993db4 1183 case 2:
cparata 0:763b80993db4 1184 LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_2);
cparata 0:763b80993db4 1185 break;
cparata 0:763b80993db4 1186
cparata 0:763b80993db4 1187 case 3:
cparata 0:763b80993db4 1188 LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_3);
cparata 0:763b80993db4 1189 break;
cparata 0:763b80993db4 1190
cparata 0:763b80993db4 1191 case 4:
cparata 0:763b80993db4 1192 LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_4);
cparata 0:763b80993db4 1193 break;
cparata 0:763b80993db4 1194
cparata 0:763b80993db4 1195 case 8:
cparata 0:763b80993db4 1196 LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_8);
cparata 0:763b80993db4 1197 break;
cparata 0:763b80993db4 1198
cparata 0:763b80993db4 1199 case 16:
cparata 0:763b80993db4 1200 LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_16);
cparata 0:763b80993db4 1201 break;
cparata 0:763b80993db4 1202
cparata 0:763b80993db4 1203 case 32:
cparata 0:763b80993db4 1204 LSM6DSL_ACC_GYRO_W_DEC_FIFO_G(handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_DECIMATION_BY_32);
cparata 0:763b80993db4 1205 break;
cparata 0:763b80993db4 1206
cparata 0:763b80993db4 1207 default:
cparata 0:763b80993db4 1208 return MEMS_ERROR;
cparata 0:763b80993db4 1209 }
cparata 0:763b80993db4 1210
cparata 0:763b80993db4 1211 return MEMS_SUCCESS;
cparata 0:763b80993db4 1212 }
cparata 0:763b80993db4 1213
cparata 0:763b80993db4 1214 /*******************************************************************************
cparata 0:763b80993db4 1215 * Function Name : LSM6DSL_ACC_GYRO_R_DEC_FIFO_G
cparata 0:763b80993db4 1216 * Description : Read DEC_FIFO_G
cparata 0:763b80993db4 1217 * Input : Pointer to LSM6DSL_ACC_GYRO_DEC_FIFO_G_t
cparata 0:763b80993db4 1218 * Output : Status of DEC_FIFO_G see LSM6DSL_ACC_GYRO_DEC_FIFO_G_t
cparata 0:763b80993db4 1219 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1220 *******************************************************************************/
cparata 0:763b80993db4 1221 status_t LSM6DSL_ACC_GYRO_R_DEC_FIFO_G(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_G_t *value)
cparata 0:763b80993db4 1222 {
cparata 0:763b80993db4 1223 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL3, (u8_t *)value, 1))
cparata 0:763b80993db4 1224 return MEMS_ERROR;
cparata 0:763b80993db4 1225
cparata 0:763b80993db4 1226 *value &= LSM6DSL_ACC_GYRO_DEC_FIFO_G_MASK; //mask
cparata 0:763b80993db4 1227
cparata 0:763b80993db4 1228 return MEMS_SUCCESS;
cparata 0:763b80993db4 1229 }
cparata 0:763b80993db4 1230
cparata 0:763b80993db4 1231 /*******************************************************************************
cparata 0:763b80993db4 1232 * Function Name : LSM6DSL_ACC_GYRO_W_DEC_FIFO_DS3
cparata 0:763b80993db4 1233 * Description : Write DEC_DS3_FIFO
cparata 0:763b80993db4 1234 * Input : LSM6DSL_ACC_GYRO_DEC_FIFO_DS3_t
cparata 0:763b80993db4 1235 * Output : None
cparata 0:763b80993db4 1236 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1237 *******************************************************************************/
cparata 0:763b80993db4 1238 status_t LSM6DSL_ACC_GYRO_W_DEC_FIFO_DS3(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_DS3_t newValue)
cparata 0:763b80993db4 1239 {
cparata 0:763b80993db4 1240 u8_t value;
cparata 0:763b80993db4 1241
cparata 0:763b80993db4 1242 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1))
cparata 0:763b80993db4 1243 return MEMS_ERROR;
cparata 0:763b80993db4 1244
cparata 0:763b80993db4 1245 value &= ~LSM6DSL_ACC_GYRO_DEC_FIFO_DS3_MASK;
cparata 0:763b80993db4 1246 value |= newValue;
cparata 0:763b80993db4 1247
cparata 0:763b80993db4 1248 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1) )
cparata 0:763b80993db4 1249 return MEMS_ERROR;
cparata 0:763b80993db4 1250
cparata 0:763b80993db4 1251 return MEMS_SUCCESS;
cparata 0:763b80993db4 1252 }
cparata 0:763b80993db4 1253
cparata 0:763b80993db4 1254 /*******************************************************************************
cparata 0:763b80993db4 1255 * Function Name : LSM6DSL_ACC_GYRO_R_DEC_FIFO_DS3
cparata 0:763b80993db4 1256 * Description : Read DEC_DS3_FIFO
cparata 0:763b80993db4 1257 * Input : Pointer to LSM6DSL_ACC_GYRO_DEC_FIFO_DS3_t
cparata 0:763b80993db4 1258 * Output : Status of DEC_DS3_FIFO see LSM6DSL_ACC_GYRO_DEC_FIFO_DS3_t
cparata 0:763b80993db4 1259 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1260 *******************************************************************************/
cparata 0:763b80993db4 1261 status_t LSM6DSL_ACC_GYRO_R_DEC_FIFO_DS3(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_DS3_t *value)
cparata 0:763b80993db4 1262 {
cparata 0:763b80993db4 1263 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, (u8_t *)value, 1))
cparata 0:763b80993db4 1264 return MEMS_ERROR;
cparata 0:763b80993db4 1265
cparata 0:763b80993db4 1266 *value &= LSM6DSL_ACC_GYRO_DEC_FIFO_DS3_MASK; //mask
cparata 0:763b80993db4 1267
cparata 0:763b80993db4 1268 return MEMS_SUCCESS;
cparata 0:763b80993db4 1269 }
cparata 0:763b80993db4 1270
cparata 0:763b80993db4 1271 /*******************************************************************************
cparata 0:763b80993db4 1272 * Function Name : LSM6DSL_ACC_GYRO_W_DEC_FIFO_DS4
cparata 0:763b80993db4 1273 * Description : Write DEC_DS4_FIFO
cparata 0:763b80993db4 1274 * Input : LSM6DSL_ACC_GYRO_DEC_FIFO_DS4_t
cparata 0:763b80993db4 1275 * Output : None
cparata 0:763b80993db4 1276 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1277 *******************************************************************************/
cparata 0:763b80993db4 1278 status_t LSM6DSL_ACC_GYRO_W_DEC_FIFO_DS4(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_DS4_t newValue)
cparata 0:763b80993db4 1279 {
cparata 0:763b80993db4 1280 u8_t value;
cparata 0:763b80993db4 1281
cparata 0:763b80993db4 1282 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1))
cparata 0:763b80993db4 1283 return MEMS_ERROR;
cparata 0:763b80993db4 1284
cparata 0:763b80993db4 1285 value &= ~LSM6DSL_ACC_GYRO_DEC_FIFO_DS4_MASK;
cparata 0:763b80993db4 1286 value |= newValue;
cparata 0:763b80993db4 1287
cparata 0:763b80993db4 1288 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1) )
cparata 0:763b80993db4 1289 return MEMS_ERROR;
cparata 0:763b80993db4 1290
cparata 0:763b80993db4 1291 return MEMS_SUCCESS;
cparata 0:763b80993db4 1292 }
cparata 0:763b80993db4 1293
cparata 0:763b80993db4 1294 /*******************************************************************************
cparata 0:763b80993db4 1295 * Function Name : LSM6DSL_ACC_GYRO_R_DEC_FIFO_DS4
cparata 0:763b80993db4 1296 * Description : Read DEC_DS4_FIFO
cparata 0:763b80993db4 1297 * Input : Pointer to LSM6DSL_ACC_GYRO_DEC_FIFO_DS4_t
cparata 0:763b80993db4 1298 * Output : Status of DEC_DS4_FIFO see LSM6DSL_ACC_GYRO_DEC_FIFO_DS4_t
cparata 0:763b80993db4 1299 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1300 *******************************************************************************/
cparata 0:763b80993db4 1301 status_t LSM6DSL_ACC_GYRO_R_DEC_FIFO_DS4(void *handle, LSM6DSL_ACC_GYRO_DEC_FIFO_DS4_t *value)
cparata 0:763b80993db4 1302 {
cparata 0:763b80993db4 1303 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, (u8_t *)value, 1))
cparata 0:763b80993db4 1304 return MEMS_ERROR;
cparata 0:763b80993db4 1305
cparata 0:763b80993db4 1306 *value &= LSM6DSL_ACC_GYRO_DEC_FIFO_DS4_MASK; //mask
cparata 0:763b80993db4 1307
cparata 0:763b80993db4 1308 return MEMS_SUCCESS;
cparata 0:763b80993db4 1309 }
cparata 0:763b80993db4 1310
cparata 0:763b80993db4 1311 /*******************************************************************************
cparata 0:763b80993db4 1312 * Function Name : LSM6DSL_ACC_GYRO_W_HI_DATA_ONLY
cparata 0:763b80993db4 1313 * Description : Write HI_DATA_ONLY
cparata 0:763b80993db4 1314 * Input : LSM6DSL_ACC_GYRO_HI_DATA_ONLY_t
cparata 0:763b80993db4 1315 * Output : None
cparata 0:763b80993db4 1316 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1317 *******************************************************************************/
cparata 0:763b80993db4 1318 status_t LSM6DSL_ACC_GYRO_W_HI_DATA_ONLY(void *handle, LSM6DSL_ACC_GYRO_HI_DATA_ONLY_t newValue)
cparata 0:763b80993db4 1319 {
cparata 0:763b80993db4 1320 u8_t value;
cparata 0:763b80993db4 1321
cparata 0:763b80993db4 1322 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1))
cparata 0:763b80993db4 1323 return MEMS_ERROR;
cparata 0:763b80993db4 1324
cparata 0:763b80993db4 1325 value &= ~LSM6DSL_ACC_GYRO_HI_DATA_ONLY_MASK;
cparata 0:763b80993db4 1326 value |= newValue;
cparata 0:763b80993db4 1327
cparata 0:763b80993db4 1328 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1) )
cparata 0:763b80993db4 1329 return MEMS_ERROR;
cparata 0:763b80993db4 1330
cparata 0:763b80993db4 1331 return MEMS_SUCCESS;
cparata 0:763b80993db4 1332 }
cparata 0:763b80993db4 1333
cparata 0:763b80993db4 1334 /*******************************************************************************
cparata 0:763b80993db4 1335 * Function Name : LSM6DSL_ACC_GYRO_R_HI_DATA_ONLY
cparata 0:763b80993db4 1336 * Description : Read HI_DATA_ONLY
cparata 0:763b80993db4 1337 * Input : Pointer to LSM6DSL_ACC_GYRO_HI_DATA_ONLY_t
cparata 0:763b80993db4 1338 * Output : Status of HI_DATA_ONLY see LSM6DSL_ACC_GYRO_HI_DATA_ONLY_t
cparata 0:763b80993db4 1339 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1340 *******************************************************************************/
cparata 0:763b80993db4 1341 status_t LSM6DSL_ACC_GYRO_R_HI_DATA_ONLY(void *handle, LSM6DSL_ACC_GYRO_HI_DATA_ONLY_t *value)
cparata 0:763b80993db4 1342 {
cparata 0:763b80993db4 1343 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, (u8_t *)value, 1))
cparata 0:763b80993db4 1344 return MEMS_ERROR;
cparata 0:763b80993db4 1345
cparata 0:763b80993db4 1346 *value &= LSM6DSL_ACC_GYRO_HI_DATA_ONLY_MASK; //mask
cparata 0:763b80993db4 1347
cparata 0:763b80993db4 1348 return MEMS_SUCCESS;
cparata 0:763b80993db4 1349 }
cparata 0:763b80993db4 1350
cparata 0:763b80993db4 1351 /*******************************************************************************
cparata 0:763b80993db4 1352 * Function Name : LSM6DSL_ACC_GYRO_W_STOP_ON_FTH
cparata 0:763b80993db4 1353 * Description : Write STOP_ON_FTH
cparata 0:763b80993db4 1354 * Input : LSM6DSL_ACC_GYRO_STOP_ON_FTH_t
cparata 0:763b80993db4 1355 * Output : None
cparata 0:763b80993db4 1356 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1357 *******************************************************************************/
cparata 0:763b80993db4 1358 status_t LSM6DSL_ACC_GYRO_W_STOP_ON_FTH(void *handle, LSM6DSL_ACC_GYRO_STOP_ON_FTH_t newValue)
cparata 0:763b80993db4 1359 {
cparata 0:763b80993db4 1360 u8_t value;
cparata 0:763b80993db4 1361
cparata 0:763b80993db4 1362 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1))
cparata 0:763b80993db4 1363 return MEMS_ERROR;
cparata 0:763b80993db4 1364
cparata 0:763b80993db4 1365 value &= ~LSM6DSL_ACC_GYRO_STOP_ON_FTH_MASK;
cparata 0:763b80993db4 1366 value |= newValue;
cparata 0:763b80993db4 1367
cparata 0:763b80993db4 1368 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, &value, 1) )
cparata 0:763b80993db4 1369 return MEMS_ERROR;
cparata 0:763b80993db4 1370
cparata 0:763b80993db4 1371 return MEMS_SUCCESS;
cparata 0:763b80993db4 1372 }
cparata 0:763b80993db4 1373
cparata 0:763b80993db4 1374 /*******************************************************************************
cparata 0:763b80993db4 1375 * Function Name : LSM6DSL_ACC_GYRO_R_STOP_ON_FTH
cparata 0:763b80993db4 1376 * Description : Read STOP_ON_FTH
cparata 0:763b80993db4 1377 * Input : Pointer to LSM6DSL_ACC_GYRO_STOP_ON_FTH_t
cparata 0:763b80993db4 1378 * Output : Status of STOP_ON_FTH see LSM6DSL_ACC_GYRO_STOP_ON_FTH_t
cparata 0:763b80993db4 1379 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1380 *******************************************************************************/
cparata 0:763b80993db4 1381 status_t LSM6DSL_ACC_GYRO_R_STOP_ON_FTH(void *handle, LSM6DSL_ACC_GYRO_STOP_ON_FTH_t *value)
cparata 0:763b80993db4 1382 {
cparata 0:763b80993db4 1383 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL4, (u8_t *)value, 1))
cparata 0:763b80993db4 1384 return MEMS_ERROR;
cparata 0:763b80993db4 1385
cparata 0:763b80993db4 1386 *value &= LSM6DSL_ACC_GYRO_STOP_ON_FTH_MASK; //mask
cparata 0:763b80993db4 1387
cparata 0:763b80993db4 1388 return MEMS_SUCCESS;
cparata 0:763b80993db4 1389 }
cparata 0:763b80993db4 1390
cparata 0:763b80993db4 1391 /*******************************************************************************
cparata 0:763b80993db4 1392 * Function Name : LSM6DSL_ACC_GYRO_W_FIFO_MODE
cparata 0:763b80993db4 1393 * Description : Write FIFO_MODE
cparata 0:763b80993db4 1394 * Input : LSM6DSL_ACC_GYRO_FIFO_MODE_t
cparata 0:763b80993db4 1395 * Output : None
cparata 0:763b80993db4 1396 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1397 *******************************************************************************/
cparata 0:763b80993db4 1398 status_t LSM6DSL_ACC_GYRO_W_FIFO_MODE(void *handle, LSM6DSL_ACC_GYRO_FIFO_MODE_t newValue)
cparata 0:763b80993db4 1399 {
cparata 0:763b80993db4 1400 u8_t value;
cparata 0:763b80993db4 1401
cparata 0:763b80993db4 1402 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL5, &value, 1))
cparata 0:763b80993db4 1403 return MEMS_ERROR;
cparata 0:763b80993db4 1404
cparata 0:763b80993db4 1405 value &= ~LSM6DSL_ACC_GYRO_FIFO_MODE_MASK;
cparata 0:763b80993db4 1406 value |= newValue;
cparata 0:763b80993db4 1407
cparata 0:763b80993db4 1408 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL5, &value, 1) )
cparata 0:763b80993db4 1409 return MEMS_ERROR;
cparata 0:763b80993db4 1410
cparata 0:763b80993db4 1411 return MEMS_SUCCESS;
cparata 0:763b80993db4 1412 }
cparata 0:763b80993db4 1413
cparata 0:763b80993db4 1414 /*******************************************************************************
cparata 0:763b80993db4 1415 * Function Name : LSM6DSL_ACC_GYRO_R_FIFO_MODE
cparata 0:763b80993db4 1416 * Description : Read FIFO_MODE
cparata 0:763b80993db4 1417 * Input : Pointer to LSM6DSL_ACC_GYRO_FIFO_MODE_t
cparata 0:763b80993db4 1418 * Output : Status of FIFO_MODE see LSM6DSL_ACC_GYRO_FIFO_MODE_t
cparata 0:763b80993db4 1419 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1420 *******************************************************************************/
cparata 0:763b80993db4 1421 status_t LSM6DSL_ACC_GYRO_R_FIFO_MODE(void *handle, LSM6DSL_ACC_GYRO_FIFO_MODE_t *value)
cparata 0:763b80993db4 1422 {
cparata 0:763b80993db4 1423 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL5, (u8_t *)value, 1))
cparata 0:763b80993db4 1424 return MEMS_ERROR;
cparata 0:763b80993db4 1425
cparata 0:763b80993db4 1426 *value &= LSM6DSL_ACC_GYRO_FIFO_MODE_MASK; //mask
cparata 0:763b80993db4 1427
cparata 0:763b80993db4 1428 return MEMS_SUCCESS;
cparata 0:763b80993db4 1429 }
cparata 0:763b80993db4 1430
cparata 0:763b80993db4 1431 /*******************************************************************************
cparata 0:763b80993db4 1432 * Function Name : LSM6DSL_ACC_GYRO_W_ODR_FIFO
cparata 0:763b80993db4 1433 * Description : Write ODR_FIFO
cparata 0:763b80993db4 1434 * Input : LSM6DSL_ACC_GYRO_ODR_FIFO_t
cparata 0:763b80993db4 1435 * Output : None
cparata 0:763b80993db4 1436 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1437 *******************************************************************************/
cparata 0:763b80993db4 1438 status_t LSM6DSL_ACC_GYRO_W_ODR_FIFO(void *handle, LSM6DSL_ACC_GYRO_ODR_FIFO_t newValue)
cparata 0:763b80993db4 1439 {
cparata 0:763b80993db4 1440 u8_t value;
cparata 0:763b80993db4 1441
cparata 0:763b80993db4 1442 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL5, &value, 1))
cparata 0:763b80993db4 1443 return MEMS_ERROR;
cparata 0:763b80993db4 1444
cparata 0:763b80993db4 1445 value &= ~LSM6DSL_ACC_GYRO_ODR_FIFO_MASK;
cparata 0:763b80993db4 1446 value |= newValue;
cparata 0:763b80993db4 1447
cparata 0:763b80993db4 1448 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL5, &value, 1) )
cparata 0:763b80993db4 1449 return MEMS_ERROR;
cparata 0:763b80993db4 1450
cparata 0:763b80993db4 1451 return MEMS_SUCCESS;
cparata 0:763b80993db4 1452 }
cparata 0:763b80993db4 1453
cparata 0:763b80993db4 1454 /*******************************************************************************
cparata 0:763b80993db4 1455 * Function Name : LSM6DSL_ACC_GYRO_R_ODR_FIFO
cparata 0:763b80993db4 1456 * Description : Read ODR_FIFO
cparata 0:763b80993db4 1457 * Input : Pointer to LSM6DSL_ACC_GYRO_ODR_FIFO_t
cparata 0:763b80993db4 1458 * Output : Status of ODR_FIFO see LSM6DSL_ACC_GYRO_ODR_FIFO_t
cparata 0:763b80993db4 1459 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1460 *******************************************************************************/
cparata 0:763b80993db4 1461 status_t LSM6DSL_ACC_GYRO_R_ODR_FIFO(void *handle, LSM6DSL_ACC_GYRO_ODR_FIFO_t *value)
cparata 0:763b80993db4 1462 {
cparata 0:763b80993db4 1463 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_CTRL5, (u8_t *)value, 1))
cparata 0:763b80993db4 1464 return MEMS_ERROR;
cparata 0:763b80993db4 1465
cparata 0:763b80993db4 1466 *value &= LSM6DSL_ACC_GYRO_ODR_FIFO_MASK; //mask
cparata 0:763b80993db4 1467
cparata 0:763b80993db4 1468 return MEMS_SUCCESS;
cparata 0:763b80993db4 1469 }
cparata 0:763b80993db4 1470
cparata 0:763b80993db4 1471 /*******************************************************************************
cparata 0:763b80993db4 1472 * Function Name : LSM6DSL_ACC_GYRO_W_DRDY_PULSE
cparata 0:763b80993db4 1473 * Description : Write DRDY_PULSE
cparata 0:763b80993db4 1474 * Input : LSM6DSL_ACC_GYRO_DRDY_PULSE_t
cparata 0:763b80993db4 1475 * Output : None
cparata 0:763b80993db4 1476 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1477 *******************************************************************************/
cparata 0:763b80993db4 1478 status_t LSM6DSL_ACC_GYRO_W_DRDY_PULSE(void *handle, LSM6DSL_ACC_GYRO_DRDY_PULSE_t newValue)
cparata 0:763b80993db4 1479 {
cparata 0:763b80993db4 1480 u8_t value;
cparata 0:763b80993db4 1481
cparata 0:763b80993db4 1482 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_DRDY_PULSE_CFG_G, &value, 1))
cparata 0:763b80993db4 1483 return MEMS_ERROR;
cparata 0:763b80993db4 1484
cparata 0:763b80993db4 1485 value &= ~LSM6DSL_ACC_GYRO_DRDY_PULSE_MASK;
cparata 0:763b80993db4 1486 value |= newValue;
cparata 0:763b80993db4 1487
cparata 0:763b80993db4 1488 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_DRDY_PULSE_CFG_G, &value, 1) )
cparata 0:763b80993db4 1489 return MEMS_ERROR;
cparata 0:763b80993db4 1490
cparata 0:763b80993db4 1491 return MEMS_SUCCESS;
cparata 0:763b80993db4 1492 }
cparata 0:763b80993db4 1493
cparata 0:763b80993db4 1494 /*******************************************************************************
cparata 0:763b80993db4 1495 * Function Name : LSM6DSL_ACC_GYRO_R_DRDY_PULSE
cparata 0:763b80993db4 1496 * Description : Read DRDY_PULSE
cparata 0:763b80993db4 1497 * Input : Pointer to LSM6DSL_ACC_GYRO_DRDY_PULSE_t
cparata 0:763b80993db4 1498 * Output : Status of DRDY_PULSE see LSM6DSL_ACC_GYRO_DRDY_PULSE_t
cparata 0:763b80993db4 1499 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1500 *******************************************************************************/
cparata 0:763b80993db4 1501 status_t LSM6DSL_ACC_GYRO_R_DRDY_PULSE(void *handle, LSM6DSL_ACC_GYRO_DRDY_PULSE_t *value)
cparata 0:763b80993db4 1502 {
cparata 0:763b80993db4 1503 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_DRDY_PULSE_CFG_G, (u8_t *)value, 1))
cparata 0:763b80993db4 1504 return MEMS_ERROR;
cparata 0:763b80993db4 1505
cparata 0:763b80993db4 1506 *value &= LSM6DSL_ACC_GYRO_DRDY_PULSE_MASK; //mask
cparata 0:763b80993db4 1507
cparata 0:763b80993db4 1508 return MEMS_SUCCESS;
cparata 0:763b80993db4 1509 }
cparata 0:763b80993db4 1510
cparata 0:763b80993db4 1511 /*******************************************************************************
cparata 0:763b80993db4 1512 * Function Name : LSM6DSL_ACC_GYRO_W_DRDY_XL_on_INT1
cparata 0:763b80993db4 1513 * Description : Write INT1_DRDY_XL
cparata 0:763b80993db4 1514 * Input : LSM6DSL_ACC_GYRO_INT1_DRDY_XL_t
cparata 0:763b80993db4 1515 * Output : None
cparata 0:763b80993db4 1516 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1517 *******************************************************************************/
cparata 0:763b80993db4 1518 status_t LSM6DSL_ACC_GYRO_W_DRDY_XL_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_DRDY_XL_t newValue)
cparata 0:763b80993db4 1519 {
cparata 0:763b80993db4 1520 u8_t value;
cparata 0:763b80993db4 1521
cparata 0:763b80993db4 1522 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
cparata 0:763b80993db4 1523 return MEMS_ERROR;
cparata 0:763b80993db4 1524
cparata 0:763b80993db4 1525 value &= ~LSM6DSL_ACC_GYRO_INT1_DRDY_XL_MASK;
cparata 0:763b80993db4 1526 value |= newValue;
cparata 0:763b80993db4 1527
cparata 0:763b80993db4 1528 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
cparata 0:763b80993db4 1529 return MEMS_ERROR;
cparata 0:763b80993db4 1530
cparata 0:763b80993db4 1531 return MEMS_SUCCESS;
cparata 0:763b80993db4 1532 }
cparata 0:763b80993db4 1533
cparata 0:763b80993db4 1534 /*******************************************************************************
cparata 0:763b80993db4 1535 * Function Name : LSM6DSL_ACC_GYRO_R_DRDY_XL_on_INT1
cparata 0:763b80993db4 1536 * Description : Read INT1_DRDY_XL
cparata 0:763b80993db4 1537 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_DRDY_XL_t
cparata 0:763b80993db4 1538 * Output : Status of INT1_DRDY_XL see LSM6DSL_ACC_GYRO_INT1_DRDY_XL_t
cparata 0:763b80993db4 1539 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1540 *******************************************************************************/
cparata 0:763b80993db4 1541 status_t LSM6DSL_ACC_GYRO_R_DRDY_XL_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_DRDY_XL_t *value)
cparata 0:763b80993db4 1542 {
cparata 0:763b80993db4 1543 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
cparata 0:763b80993db4 1544 return MEMS_ERROR;
cparata 0:763b80993db4 1545
cparata 0:763b80993db4 1546 *value &= LSM6DSL_ACC_GYRO_INT1_DRDY_XL_MASK; //mask
cparata 0:763b80993db4 1547
cparata 0:763b80993db4 1548 return MEMS_SUCCESS;
cparata 0:763b80993db4 1549 }
cparata 0:763b80993db4 1550
cparata 0:763b80993db4 1551 /*******************************************************************************
cparata 0:763b80993db4 1552 * Function Name : LSM6DSL_ACC_GYRO_W_DRDY_G_on_INT1
cparata 0:763b80993db4 1553 * Description : Write INT1_DRDY_G
cparata 0:763b80993db4 1554 * Input : LSM6DSL_ACC_GYRO_INT1_DRDY_G_t
cparata 0:763b80993db4 1555 * Output : None
cparata 0:763b80993db4 1556 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1557 *******************************************************************************/
cparata 0:763b80993db4 1558 status_t LSM6DSL_ACC_GYRO_W_DRDY_G_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_DRDY_G_t newValue)
cparata 0:763b80993db4 1559 {
cparata 0:763b80993db4 1560 u8_t value;
cparata 0:763b80993db4 1561
cparata 0:763b80993db4 1562 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
cparata 0:763b80993db4 1563 return MEMS_ERROR;
cparata 0:763b80993db4 1564
cparata 0:763b80993db4 1565 value &= ~LSM6DSL_ACC_GYRO_INT1_DRDY_G_MASK;
cparata 0:763b80993db4 1566 value |= newValue;
cparata 0:763b80993db4 1567
cparata 0:763b80993db4 1568 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
cparata 0:763b80993db4 1569 return MEMS_ERROR;
cparata 0:763b80993db4 1570
cparata 0:763b80993db4 1571 return MEMS_SUCCESS;
cparata 0:763b80993db4 1572 }
cparata 0:763b80993db4 1573
cparata 0:763b80993db4 1574 /*******************************************************************************
cparata 0:763b80993db4 1575 * Function Name : LSM6DSL_ACC_GYRO_R_DRDY_G_on_INT1
cparata 0:763b80993db4 1576 * Description : Read INT1_DRDY_G
cparata 0:763b80993db4 1577 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_DRDY_G_t
cparata 0:763b80993db4 1578 * Output : Status of INT1_DRDY_G see LSM6DSL_ACC_GYRO_INT1_DRDY_G_t
cparata 0:763b80993db4 1579 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1580 *******************************************************************************/
cparata 0:763b80993db4 1581 status_t LSM6DSL_ACC_GYRO_R_DRDY_G_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_DRDY_G_t *value)
cparata 0:763b80993db4 1582 {
cparata 0:763b80993db4 1583 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
cparata 0:763b80993db4 1584 return MEMS_ERROR;
cparata 0:763b80993db4 1585
cparata 0:763b80993db4 1586 *value &= LSM6DSL_ACC_GYRO_INT1_DRDY_G_MASK; //mask
cparata 0:763b80993db4 1587
cparata 0:763b80993db4 1588 return MEMS_SUCCESS;
cparata 0:763b80993db4 1589 }
cparata 0:763b80993db4 1590
cparata 0:763b80993db4 1591 /*******************************************************************************
cparata 0:763b80993db4 1592 * Function Name : LSM6DSL_ACC_GYRO_W_BOOT_on_INT1
cparata 0:763b80993db4 1593 * Description : Write INT1_BOOT
cparata 0:763b80993db4 1594 * Input : LSM6DSL_ACC_GYRO_INT1_BOOT_t
cparata 0:763b80993db4 1595 * Output : None
cparata 0:763b80993db4 1596 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1597 *******************************************************************************/
cparata 0:763b80993db4 1598 status_t LSM6DSL_ACC_GYRO_W_BOOT_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_BOOT_t newValue)
cparata 0:763b80993db4 1599 {
cparata 0:763b80993db4 1600 u8_t value;
cparata 0:763b80993db4 1601
cparata 0:763b80993db4 1602 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
cparata 0:763b80993db4 1603 return MEMS_ERROR;
cparata 0:763b80993db4 1604
cparata 0:763b80993db4 1605 value &= ~LSM6DSL_ACC_GYRO_INT1_BOOT_MASK;
cparata 0:763b80993db4 1606 value |= newValue;
cparata 0:763b80993db4 1607
cparata 0:763b80993db4 1608 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
cparata 0:763b80993db4 1609 return MEMS_ERROR;
cparata 0:763b80993db4 1610
cparata 0:763b80993db4 1611 return MEMS_SUCCESS;
cparata 0:763b80993db4 1612 }
cparata 0:763b80993db4 1613
cparata 0:763b80993db4 1614 /*******************************************************************************
cparata 0:763b80993db4 1615 * Function Name : LSM6DSL_ACC_GYRO_R_BOOT_on_INT1
cparata 0:763b80993db4 1616 * Description : Read INT1_BOOT
cparata 0:763b80993db4 1617 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_BOOT_t
cparata 0:763b80993db4 1618 * Output : Status of INT1_BOOT see LSM6DSL_ACC_GYRO_INT1_BOOT_t
cparata 0:763b80993db4 1619 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1620 *******************************************************************************/
cparata 0:763b80993db4 1621 status_t LSM6DSL_ACC_GYRO_R_BOOT_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_BOOT_t *value)
cparata 0:763b80993db4 1622 {
cparata 0:763b80993db4 1623 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
cparata 0:763b80993db4 1624 return MEMS_ERROR;
cparata 0:763b80993db4 1625
cparata 0:763b80993db4 1626 *value &= LSM6DSL_ACC_GYRO_INT1_BOOT_MASK; //mask
cparata 0:763b80993db4 1627
cparata 0:763b80993db4 1628 return MEMS_SUCCESS;
cparata 0:763b80993db4 1629 }
cparata 0:763b80993db4 1630
cparata 0:763b80993db4 1631 /*******************************************************************************
cparata 0:763b80993db4 1632 * Function Name : LSM6DSL_ACC_GYRO_W_FIFO_TSHLD_on_INT1
cparata 0:763b80993db4 1633 * Description : Write INT1_FTH
cparata 0:763b80993db4 1634 * Input : LSM6DSL_ACC_GYRO_INT1_FTH_t
cparata 0:763b80993db4 1635 * Output : None
cparata 0:763b80993db4 1636 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1637 *******************************************************************************/
cparata 0:763b80993db4 1638 status_t LSM6DSL_ACC_GYRO_W_FIFO_TSHLD_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_FTH_t newValue)
cparata 0:763b80993db4 1639 {
cparata 0:763b80993db4 1640 u8_t value;
cparata 0:763b80993db4 1641
cparata 0:763b80993db4 1642 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
cparata 0:763b80993db4 1643 return MEMS_ERROR;
cparata 0:763b80993db4 1644
cparata 0:763b80993db4 1645 value &= ~LSM6DSL_ACC_GYRO_INT1_FTH_MASK;
cparata 0:763b80993db4 1646 value |= newValue;
cparata 0:763b80993db4 1647
cparata 0:763b80993db4 1648 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
cparata 0:763b80993db4 1649 return MEMS_ERROR;
cparata 0:763b80993db4 1650
cparata 0:763b80993db4 1651 return MEMS_SUCCESS;
cparata 0:763b80993db4 1652 }
cparata 0:763b80993db4 1653
cparata 0:763b80993db4 1654 /*******************************************************************************
cparata 0:763b80993db4 1655 * Function Name : LSM6DSL_ACC_GYRO_R_FIFO_TSHLD_on_INT1
cparata 0:763b80993db4 1656 * Description : Read INT1_FTH
cparata 0:763b80993db4 1657 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_FTH_t
cparata 0:763b80993db4 1658 * Output : Status of INT1_FTH see LSM6DSL_ACC_GYRO_INT1_FTH_t
cparata 0:763b80993db4 1659 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1660 *******************************************************************************/
cparata 0:763b80993db4 1661 status_t LSM6DSL_ACC_GYRO_R_FIFO_TSHLD_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_FTH_t *value)
cparata 0:763b80993db4 1662 {
cparata 0:763b80993db4 1663 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
cparata 0:763b80993db4 1664 return MEMS_ERROR;
cparata 0:763b80993db4 1665
cparata 0:763b80993db4 1666 *value &= LSM6DSL_ACC_GYRO_INT1_FTH_MASK; //mask
cparata 0:763b80993db4 1667
cparata 0:763b80993db4 1668 return MEMS_SUCCESS;
cparata 0:763b80993db4 1669 }
cparata 0:763b80993db4 1670
cparata 0:763b80993db4 1671 /*******************************************************************************
cparata 0:763b80993db4 1672 * Function Name : LSM6DSL_ACC_GYRO_W_OVERRUN_on_INT1
cparata 0:763b80993db4 1673 * Description : Write INT1_OVR
cparata 0:763b80993db4 1674 * Input : LSM6DSL_ACC_GYRO_INT1_OVR_t
cparata 0:763b80993db4 1675 * Output : None
cparata 0:763b80993db4 1676 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1677 *******************************************************************************/
cparata 0:763b80993db4 1678 status_t LSM6DSL_ACC_GYRO_W_OVERRUN_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_OVR_t newValue)
cparata 0:763b80993db4 1679 {
cparata 0:763b80993db4 1680 u8_t value;
cparata 0:763b80993db4 1681
cparata 0:763b80993db4 1682 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
cparata 0:763b80993db4 1683 return MEMS_ERROR;
cparata 0:763b80993db4 1684
cparata 0:763b80993db4 1685 value &= ~LSM6DSL_ACC_GYRO_INT1_OVR_MASK;
cparata 0:763b80993db4 1686 value |= newValue;
cparata 0:763b80993db4 1687
cparata 0:763b80993db4 1688 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
cparata 0:763b80993db4 1689 return MEMS_ERROR;
cparata 0:763b80993db4 1690
cparata 0:763b80993db4 1691 return MEMS_SUCCESS;
cparata 0:763b80993db4 1692 }
cparata 0:763b80993db4 1693
cparata 0:763b80993db4 1694 /*******************************************************************************
cparata 0:763b80993db4 1695 * Function Name : LSM6DSL_ACC_GYRO_R_OVERRUN_on_INT1
cparata 0:763b80993db4 1696 * Description : Read INT1_OVR
cparata 0:763b80993db4 1697 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_OVR_t
cparata 0:763b80993db4 1698 * Output : Status of INT1_OVR see LSM6DSL_ACC_GYRO_INT1_OVR_t
cparata 0:763b80993db4 1699 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1700 *******************************************************************************/
cparata 0:763b80993db4 1701 status_t LSM6DSL_ACC_GYRO_R_OVERRUN_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_OVR_t *value)
cparata 0:763b80993db4 1702 {
cparata 0:763b80993db4 1703 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
cparata 0:763b80993db4 1704 return MEMS_ERROR;
cparata 0:763b80993db4 1705
cparata 0:763b80993db4 1706 *value &= LSM6DSL_ACC_GYRO_INT1_OVR_MASK; //mask
cparata 0:763b80993db4 1707
cparata 0:763b80993db4 1708 return MEMS_SUCCESS;
cparata 0:763b80993db4 1709 }
cparata 0:763b80993db4 1710
cparata 0:763b80993db4 1711 /*******************************************************************************
cparata 0:763b80993db4 1712 * Function Name : LSM6DSL_ACC_GYRO_W_FULL_FLAG_on_INT1
cparata 0:763b80993db4 1713 * Description : Write INT1_FULL_FLAG
cparata 0:763b80993db4 1714 * Input : LSM6DSL_ACC_GYRO_INT1_FULL_FLAG_t
cparata 0:763b80993db4 1715 * Output : None
cparata 0:763b80993db4 1716 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1717 *******************************************************************************/
cparata 0:763b80993db4 1718 status_t LSM6DSL_ACC_GYRO_W_FULL_FLAG_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_FULL_FLAG_t newValue)
cparata 0:763b80993db4 1719 {
cparata 0:763b80993db4 1720 u8_t value;
cparata 0:763b80993db4 1721
cparata 0:763b80993db4 1722 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
cparata 0:763b80993db4 1723 return MEMS_ERROR;
cparata 0:763b80993db4 1724
cparata 0:763b80993db4 1725 value &= ~LSM6DSL_ACC_GYRO_INT1_FULL_FLAG_MASK;
cparata 0:763b80993db4 1726 value |= newValue;
cparata 0:763b80993db4 1727
cparata 0:763b80993db4 1728 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
cparata 0:763b80993db4 1729 return MEMS_ERROR;
cparata 0:763b80993db4 1730
cparata 0:763b80993db4 1731 return MEMS_SUCCESS;
cparata 0:763b80993db4 1732 }
cparata 0:763b80993db4 1733
cparata 0:763b80993db4 1734 /*******************************************************************************
cparata 0:763b80993db4 1735 * Function Name : LSM6DSL_ACC_GYRO_R_FULL_FLAG_on_INT1
cparata 0:763b80993db4 1736 * Description : Read INT1_FULL_FLAG
cparata 0:763b80993db4 1737 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_FULL_FLAG_t
cparata 0:763b80993db4 1738 * Output : Status of INT1_FULL_FLAG see LSM6DSL_ACC_GYRO_INT1_FULL_FLAG_t
cparata 0:763b80993db4 1739 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1740 *******************************************************************************/
cparata 0:763b80993db4 1741 status_t LSM6DSL_ACC_GYRO_R_FULL_FLAG_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_FULL_FLAG_t *value)
cparata 0:763b80993db4 1742 {
cparata 0:763b80993db4 1743 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
cparata 0:763b80993db4 1744 return MEMS_ERROR;
cparata 0:763b80993db4 1745
cparata 0:763b80993db4 1746 *value &= LSM6DSL_ACC_GYRO_INT1_FULL_FLAG_MASK; //mask
cparata 0:763b80993db4 1747
cparata 0:763b80993db4 1748 return MEMS_SUCCESS;
cparata 0:763b80993db4 1749 }
cparata 0:763b80993db4 1750
cparata 0:763b80993db4 1751 /*******************************************************************************
cparata 0:763b80993db4 1752 * Function Name : LSM6DSL_ACC_GYRO_W_SIGN_MOT_on_INT1
cparata 0:763b80993db4 1753 * Description : Write INT1_SIGN_MOT
cparata 0:763b80993db4 1754 * Input : LSM6DSL_ACC_GYRO_INT1_SIGN_MOT_t
cparata 0:763b80993db4 1755 * Output : None
cparata 0:763b80993db4 1756 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1757 *******************************************************************************/
cparata 0:763b80993db4 1758 status_t LSM6DSL_ACC_GYRO_W_SIGN_MOT_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_SIGN_MOT_t newValue)
cparata 0:763b80993db4 1759 {
cparata 0:763b80993db4 1760 u8_t value;
cparata 0:763b80993db4 1761
cparata 0:763b80993db4 1762 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
cparata 0:763b80993db4 1763 return MEMS_ERROR;
cparata 0:763b80993db4 1764
cparata 0:763b80993db4 1765 value &= ~LSM6DSL_ACC_GYRO_INT1_SIGN_MOT_MASK;
cparata 0:763b80993db4 1766 value |= newValue;
cparata 0:763b80993db4 1767
cparata 0:763b80993db4 1768 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
cparata 0:763b80993db4 1769 return MEMS_ERROR;
cparata 0:763b80993db4 1770
cparata 0:763b80993db4 1771 return MEMS_SUCCESS;
cparata 0:763b80993db4 1772 }
cparata 0:763b80993db4 1773
cparata 0:763b80993db4 1774 /*******************************************************************************
cparata 0:763b80993db4 1775 * Function Name : LSM6DSL_ACC_GYRO_R_SIGN_MOT_on_INT1
cparata 0:763b80993db4 1776 * Description : Read INT1_SIGN_MOT
cparata 0:763b80993db4 1777 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_SIGN_MOT_t
cparata 0:763b80993db4 1778 * Output : Status of INT1_SIGN_MOT see LSM6DSL_ACC_GYRO_INT1_SIGN_MOT_t
cparata 0:763b80993db4 1779 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1780 *******************************************************************************/
cparata 0:763b80993db4 1781 status_t LSM6DSL_ACC_GYRO_R_SIGN_MOT_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_SIGN_MOT_t *value)
cparata 0:763b80993db4 1782 {
cparata 0:763b80993db4 1783 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
cparata 0:763b80993db4 1784 return MEMS_ERROR;
cparata 0:763b80993db4 1785
cparata 0:763b80993db4 1786 *value &= LSM6DSL_ACC_GYRO_INT1_SIGN_MOT_MASK; //mask
cparata 0:763b80993db4 1787
cparata 0:763b80993db4 1788 return MEMS_SUCCESS;
cparata 0:763b80993db4 1789 }
cparata 0:763b80993db4 1790
cparata 0:763b80993db4 1791 /*******************************************************************************
cparata 0:763b80993db4 1792 * Function Name : LSM6DSL_ACC_GYRO_W_STEP_DET_on_INT1
cparata 0:763b80993db4 1793 * Description : Write INT1_PEDO
cparata 0:763b80993db4 1794 * Input : LSM6DSL_ACC_GYRO_INT1_PEDO_t
cparata 0:763b80993db4 1795 * Output : None
cparata 0:763b80993db4 1796 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1797 *******************************************************************************/
cparata 0:763b80993db4 1798 status_t LSM6DSL_ACC_GYRO_W_STEP_DET_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_PEDO_t newValue)
cparata 0:763b80993db4 1799 {
cparata 0:763b80993db4 1800 u8_t value;
cparata 0:763b80993db4 1801
cparata 0:763b80993db4 1802 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1))
cparata 0:763b80993db4 1803 return MEMS_ERROR;
cparata 0:763b80993db4 1804
cparata 0:763b80993db4 1805 value &= ~LSM6DSL_ACC_GYRO_INT1_PEDO_MASK;
cparata 0:763b80993db4 1806 value |= newValue;
cparata 0:763b80993db4 1807
cparata 0:763b80993db4 1808 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, &value, 1) )
cparata 0:763b80993db4 1809 return MEMS_ERROR;
cparata 0:763b80993db4 1810
cparata 0:763b80993db4 1811 return MEMS_SUCCESS;
cparata 0:763b80993db4 1812 }
cparata 0:763b80993db4 1813
cparata 0:763b80993db4 1814 /*******************************************************************************
cparata 0:763b80993db4 1815 * Function Name : LSM6DSL_ACC_GYRO_R_STEP_DET_on_INT1
cparata 0:763b80993db4 1816 * Description : Read INT1_PEDO
cparata 0:763b80993db4 1817 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_PEDO_t
cparata 0:763b80993db4 1818 * Output : Status of INT1_PEDO see LSM6DSL_ACC_GYRO_INT1_PEDO_t
cparata 0:763b80993db4 1819 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1820 *******************************************************************************/
cparata 0:763b80993db4 1821 status_t LSM6DSL_ACC_GYRO_R_STEP_DET_on_INT1(void *handle, LSM6DSL_ACC_GYRO_INT1_PEDO_t *value)
cparata 0:763b80993db4 1822 {
cparata 0:763b80993db4 1823 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT1_CTRL, (u8_t *)value, 1))
cparata 0:763b80993db4 1824 return MEMS_ERROR;
cparata 0:763b80993db4 1825
cparata 0:763b80993db4 1826 *value &= LSM6DSL_ACC_GYRO_INT1_PEDO_MASK; //mask
cparata 0:763b80993db4 1827
cparata 0:763b80993db4 1828 return MEMS_SUCCESS;
cparata 0:763b80993db4 1829 }
cparata 0:763b80993db4 1830
cparata 0:763b80993db4 1831 /*******************************************************************************
cparata 0:763b80993db4 1832 * Function Name : LSM6DSL_ACC_GYRO_W_DRDY_XL_on_INT2
cparata 0:763b80993db4 1833 * Description : Write INT2_DRDY_XL
cparata 0:763b80993db4 1834 * Input : LSM6DSL_ACC_GYRO_INT2_DRDY_XL_t
cparata 0:763b80993db4 1835 * Output : None
cparata 0:763b80993db4 1836 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1837 *******************************************************************************/
cparata 0:763b80993db4 1838 status_t LSM6DSL_ACC_GYRO_W_DRDY_XL_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_DRDY_XL_t newValue)
cparata 0:763b80993db4 1839 {
cparata 0:763b80993db4 1840 u8_t value;
cparata 0:763b80993db4 1841
cparata 0:763b80993db4 1842 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
cparata 0:763b80993db4 1843 return MEMS_ERROR;
cparata 0:763b80993db4 1844
cparata 0:763b80993db4 1845 value &= ~LSM6DSL_ACC_GYRO_INT2_DRDY_XL_MASK;
cparata 0:763b80993db4 1846 value |= newValue;
cparata 0:763b80993db4 1847
cparata 0:763b80993db4 1848 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
cparata 0:763b80993db4 1849 return MEMS_ERROR;
cparata 0:763b80993db4 1850
cparata 0:763b80993db4 1851 return MEMS_SUCCESS;
cparata 0:763b80993db4 1852 }
cparata 0:763b80993db4 1853
cparata 0:763b80993db4 1854 /*******************************************************************************
cparata 0:763b80993db4 1855 * Function Name : LSM6DSL_ACC_GYRO_R_DRDY_XL_on_INT2
cparata 0:763b80993db4 1856 * Description : Read INT2_DRDY_XL
cparata 0:763b80993db4 1857 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_DRDY_XL_t
cparata 0:763b80993db4 1858 * Output : Status of INT2_DRDY_XL see LSM6DSL_ACC_GYRO_INT2_DRDY_XL_t
cparata 0:763b80993db4 1859 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1860 *******************************************************************************/
cparata 0:763b80993db4 1861 status_t LSM6DSL_ACC_GYRO_R_DRDY_XL_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_DRDY_XL_t *value)
cparata 0:763b80993db4 1862 {
cparata 0:763b80993db4 1863 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
cparata 0:763b80993db4 1864 return MEMS_ERROR;
cparata 0:763b80993db4 1865
cparata 0:763b80993db4 1866 *value &= LSM6DSL_ACC_GYRO_INT2_DRDY_XL_MASK; //mask
cparata 0:763b80993db4 1867
cparata 0:763b80993db4 1868 return MEMS_SUCCESS;
cparata 0:763b80993db4 1869 }
cparata 0:763b80993db4 1870
cparata 0:763b80993db4 1871 /*******************************************************************************
cparata 0:763b80993db4 1872 * Function Name : LSM6DSL_ACC_GYRO_W_DRDY_G_on_INT2
cparata 0:763b80993db4 1873 * Description : Write INT2_DRDY_G
cparata 0:763b80993db4 1874 * Input : LSM6DSL_ACC_GYRO_INT2_DRDY_G_t
cparata 0:763b80993db4 1875 * Output : None
cparata 0:763b80993db4 1876 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1877 *******************************************************************************/
cparata 0:763b80993db4 1878 status_t LSM6DSL_ACC_GYRO_W_DRDY_G_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_DRDY_G_t newValue)
cparata 0:763b80993db4 1879 {
cparata 0:763b80993db4 1880 u8_t value;
cparata 0:763b80993db4 1881
cparata 0:763b80993db4 1882 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
cparata 0:763b80993db4 1883 return MEMS_ERROR;
cparata 0:763b80993db4 1884
cparata 0:763b80993db4 1885 value &= ~LSM6DSL_ACC_GYRO_INT2_DRDY_G_MASK;
cparata 0:763b80993db4 1886 value |= newValue;
cparata 0:763b80993db4 1887
cparata 0:763b80993db4 1888 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
cparata 0:763b80993db4 1889 return MEMS_ERROR;
cparata 0:763b80993db4 1890
cparata 0:763b80993db4 1891 return MEMS_SUCCESS;
cparata 0:763b80993db4 1892 }
cparata 0:763b80993db4 1893
cparata 0:763b80993db4 1894 /*******************************************************************************
cparata 0:763b80993db4 1895 * Function Name : LSM6DSL_ACC_GYRO_R_DRDY_G_on_INT2
cparata 0:763b80993db4 1896 * Description : Read INT2_DRDY_G
cparata 0:763b80993db4 1897 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_DRDY_G_t
cparata 0:763b80993db4 1898 * Output : Status of INT2_DRDY_G see LSM6DSL_ACC_GYRO_INT2_DRDY_G_t
cparata 0:763b80993db4 1899 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1900 *******************************************************************************/
cparata 0:763b80993db4 1901 status_t LSM6DSL_ACC_GYRO_R_DRDY_G_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_DRDY_G_t *value)
cparata 0:763b80993db4 1902 {
cparata 0:763b80993db4 1903 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
cparata 0:763b80993db4 1904 return MEMS_ERROR;
cparata 0:763b80993db4 1905
cparata 0:763b80993db4 1906 *value &= LSM6DSL_ACC_GYRO_INT2_DRDY_G_MASK; //mask
cparata 0:763b80993db4 1907
cparata 0:763b80993db4 1908 return MEMS_SUCCESS;
cparata 0:763b80993db4 1909 }
cparata 0:763b80993db4 1910
cparata 0:763b80993db4 1911 /*******************************************************************************
cparata 0:763b80993db4 1912 * Function Name : LSM6DSL_ACC_GYRO_W_DRDY_TEMP_on_INT2
cparata 0:763b80993db4 1913 * Description : Write INT2_DRDY_TEMP
cparata 0:763b80993db4 1914 * Input : LSM6DSL_ACC_GYRO_INT2_DRDY_TEMP_t
cparata 0:763b80993db4 1915 * Output : None
cparata 0:763b80993db4 1916 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1917 *******************************************************************************/
cparata 0:763b80993db4 1918 status_t LSM6DSL_ACC_GYRO_W_DRDY_TEMP_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_DRDY_TEMP_t newValue)
cparata 0:763b80993db4 1919 {
cparata 0:763b80993db4 1920 u8_t value;
cparata 0:763b80993db4 1921
cparata 0:763b80993db4 1922 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
cparata 0:763b80993db4 1923 return MEMS_ERROR;
cparata 0:763b80993db4 1924
cparata 0:763b80993db4 1925 value &= ~LSM6DSL_ACC_GYRO_INT2_DRDY_TEMP_MASK;
cparata 0:763b80993db4 1926 value |= newValue;
cparata 0:763b80993db4 1927
cparata 0:763b80993db4 1928 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
cparata 0:763b80993db4 1929 return MEMS_ERROR;
cparata 0:763b80993db4 1930
cparata 0:763b80993db4 1931 return MEMS_SUCCESS;
cparata 0:763b80993db4 1932 }
cparata 0:763b80993db4 1933
cparata 0:763b80993db4 1934 /*******************************************************************************
cparata 0:763b80993db4 1935 * Function Name : LSM6DSL_ACC_GYRO_R_DRDY_TEMP_on_INT2
cparata 0:763b80993db4 1936 * Description : Read INT2_DRDY_TEMP
cparata 0:763b80993db4 1937 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_DRDY_TEMP_t
cparata 0:763b80993db4 1938 * Output : Status of INT2_DRDY_TEMP see LSM6DSL_ACC_GYRO_INT2_DRDY_TEMP_t
cparata 0:763b80993db4 1939 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1940 *******************************************************************************/
cparata 0:763b80993db4 1941 status_t LSM6DSL_ACC_GYRO_R_DRDY_TEMP_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_DRDY_TEMP_t *value)
cparata 0:763b80993db4 1942 {
cparata 0:763b80993db4 1943 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
cparata 0:763b80993db4 1944 return MEMS_ERROR;
cparata 0:763b80993db4 1945
cparata 0:763b80993db4 1946 *value &= LSM6DSL_ACC_GYRO_INT2_DRDY_TEMP_MASK; //mask
cparata 0:763b80993db4 1947
cparata 0:763b80993db4 1948 return MEMS_SUCCESS;
cparata 0:763b80993db4 1949 }
cparata 0:763b80993db4 1950
cparata 0:763b80993db4 1951 /*******************************************************************************
cparata 0:763b80993db4 1952 * Function Name : LSM6DSL_ACC_GYRO_W_FIFO_TSHLD_on_INT2
cparata 0:763b80993db4 1953 * Description : Write INT2_FTH
cparata 0:763b80993db4 1954 * Input : LSM6DSL_ACC_GYRO_INT2_FTH_t
cparata 0:763b80993db4 1955 * Output : None
cparata 0:763b80993db4 1956 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1957 *******************************************************************************/
cparata 0:763b80993db4 1958 status_t LSM6DSL_ACC_GYRO_W_FIFO_TSHLD_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_FTH_t newValue)
cparata 0:763b80993db4 1959 {
cparata 0:763b80993db4 1960 u8_t value;
cparata 0:763b80993db4 1961
cparata 0:763b80993db4 1962 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
cparata 0:763b80993db4 1963 return MEMS_ERROR;
cparata 0:763b80993db4 1964
cparata 0:763b80993db4 1965 value &= ~LSM6DSL_ACC_GYRO_INT2_FTH_MASK;
cparata 0:763b80993db4 1966 value |= newValue;
cparata 0:763b80993db4 1967
cparata 0:763b80993db4 1968 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
cparata 0:763b80993db4 1969 return MEMS_ERROR;
cparata 0:763b80993db4 1970
cparata 0:763b80993db4 1971 return MEMS_SUCCESS;
cparata 0:763b80993db4 1972 }
cparata 0:763b80993db4 1973
cparata 0:763b80993db4 1974 /*******************************************************************************
cparata 0:763b80993db4 1975 * Function Name : LSM6DSL_ACC_GYRO_R_FIFO_TSHLD_on_INT2
cparata 0:763b80993db4 1976 * Description : Read INT2_FTH
cparata 0:763b80993db4 1977 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_FTH_t
cparata 0:763b80993db4 1978 * Output : Status of INT2_FTH see LSM6DSL_ACC_GYRO_INT2_FTH_t
cparata 0:763b80993db4 1979 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1980 *******************************************************************************/
cparata 0:763b80993db4 1981 status_t LSM6DSL_ACC_GYRO_R_FIFO_TSHLD_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_FTH_t *value)
cparata 0:763b80993db4 1982 {
cparata 0:763b80993db4 1983 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
cparata 0:763b80993db4 1984 return MEMS_ERROR;
cparata 0:763b80993db4 1985
cparata 0:763b80993db4 1986 *value &= LSM6DSL_ACC_GYRO_INT2_FTH_MASK; //mask
cparata 0:763b80993db4 1987
cparata 0:763b80993db4 1988 return MEMS_SUCCESS;
cparata 0:763b80993db4 1989 }
cparata 0:763b80993db4 1990
cparata 0:763b80993db4 1991 /*******************************************************************************
cparata 0:763b80993db4 1992 * Function Name : LSM6DSL_ACC_GYRO_W_OVERRUN_on_INT2
cparata 0:763b80993db4 1993 * Description : Write INT2_OVR
cparata 0:763b80993db4 1994 * Input : LSM6DSL_ACC_GYRO_INT2_OVR_t
cparata 0:763b80993db4 1995 * Output : None
cparata 0:763b80993db4 1996 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 1997 *******************************************************************************/
cparata 0:763b80993db4 1998 status_t LSM6DSL_ACC_GYRO_W_OVERRUN_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_OVR_t newValue)
cparata 0:763b80993db4 1999 {
cparata 0:763b80993db4 2000 u8_t value;
cparata 0:763b80993db4 2001
cparata 0:763b80993db4 2002 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
cparata 0:763b80993db4 2003 return MEMS_ERROR;
cparata 0:763b80993db4 2004
cparata 0:763b80993db4 2005 value &= ~LSM6DSL_ACC_GYRO_INT2_OVR_MASK;
cparata 0:763b80993db4 2006 value |= newValue;
cparata 0:763b80993db4 2007
cparata 0:763b80993db4 2008 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
cparata 0:763b80993db4 2009 return MEMS_ERROR;
cparata 0:763b80993db4 2010
cparata 0:763b80993db4 2011 return MEMS_SUCCESS;
cparata 0:763b80993db4 2012 }
cparata 0:763b80993db4 2013
cparata 0:763b80993db4 2014 /*******************************************************************************
cparata 0:763b80993db4 2015 * Function Name : LSM6DSL_ACC_GYRO_R_OVERRUN_on_INT2
cparata 0:763b80993db4 2016 * Description : Read INT2_OVR
cparata 0:763b80993db4 2017 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_OVR_t
cparata 0:763b80993db4 2018 * Output : Status of INT2_OVR see LSM6DSL_ACC_GYRO_INT2_OVR_t
cparata 0:763b80993db4 2019 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2020 *******************************************************************************/
cparata 0:763b80993db4 2021 status_t LSM6DSL_ACC_GYRO_R_OVERRUN_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_OVR_t *value)
cparata 0:763b80993db4 2022 {
cparata 0:763b80993db4 2023 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
cparata 0:763b80993db4 2024 return MEMS_ERROR;
cparata 0:763b80993db4 2025
cparata 0:763b80993db4 2026 *value &= LSM6DSL_ACC_GYRO_INT2_OVR_MASK; //mask
cparata 0:763b80993db4 2027
cparata 0:763b80993db4 2028 return MEMS_SUCCESS;
cparata 0:763b80993db4 2029 }
cparata 0:763b80993db4 2030
cparata 0:763b80993db4 2031 /*******************************************************************************
cparata 0:763b80993db4 2032 * Function Name : LSM6DSL_ACC_GYRO_W_FULL_FLAG_on_INT2
cparata 0:763b80993db4 2033 * Description : Write INT2_FULL_FLAG
cparata 0:763b80993db4 2034 * Input : LSM6DSL_ACC_GYRO_INT2_FULL_FLAG_t
cparata 0:763b80993db4 2035 * Output : None
cparata 0:763b80993db4 2036 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2037 *******************************************************************************/
cparata 0:763b80993db4 2038 status_t LSM6DSL_ACC_GYRO_W_FULL_FLAG_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_FULL_FLAG_t newValue)
cparata 0:763b80993db4 2039 {
cparata 0:763b80993db4 2040 u8_t value;
cparata 0:763b80993db4 2041
cparata 0:763b80993db4 2042 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
cparata 0:763b80993db4 2043 return MEMS_ERROR;
cparata 0:763b80993db4 2044
cparata 0:763b80993db4 2045 value &= ~LSM6DSL_ACC_GYRO_INT2_FULL_FLAG_MASK;
cparata 0:763b80993db4 2046 value |= newValue;
cparata 0:763b80993db4 2047
cparata 0:763b80993db4 2048 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
cparata 0:763b80993db4 2049 return MEMS_ERROR;
cparata 0:763b80993db4 2050
cparata 0:763b80993db4 2051 return MEMS_SUCCESS;
cparata 0:763b80993db4 2052 }
cparata 0:763b80993db4 2053
cparata 0:763b80993db4 2054 /*******************************************************************************
cparata 0:763b80993db4 2055 * Function Name : LSM6DSL_ACC_GYRO_R_FULL_FLAG_on_INT2
cparata 0:763b80993db4 2056 * Description : Read INT2_FULL_FLAG
cparata 0:763b80993db4 2057 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_FULL_FLAG_t
cparata 0:763b80993db4 2058 * Output : Status of INT2_FULL_FLAG see LSM6DSL_ACC_GYRO_INT2_FULL_FLAG_t
cparata 0:763b80993db4 2059 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2060 *******************************************************************************/
cparata 0:763b80993db4 2061 status_t LSM6DSL_ACC_GYRO_R_FULL_FLAG_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_FULL_FLAG_t *value)
cparata 0:763b80993db4 2062 {
cparata 0:763b80993db4 2063 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
cparata 0:763b80993db4 2064 return MEMS_ERROR;
cparata 0:763b80993db4 2065
cparata 0:763b80993db4 2066 *value &= LSM6DSL_ACC_GYRO_INT2_FULL_FLAG_MASK; //mask
cparata 0:763b80993db4 2067
cparata 0:763b80993db4 2068 return MEMS_SUCCESS;
cparata 0:763b80993db4 2069 }
cparata 0:763b80993db4 2070
cparata 0:763b80993db4 2071 /*******************************************************************************
cparata 0:763b80993db4 2072 * Function Name : LSM6DSL_ACC_GYRO_W_STEP_COUNT_OV_on_INT2
cparata 0:763b80993db4 2073 * Description : Write INT2_STEP_COUNT_OV
cparata 0:763b80993db4 2074 * Input : LSM6DSL_ACC_GYRO_INT2_STEP_COUNT_OV_t
cparata 0:763b80993db4 2075 * Output : None
cparata 0:763b80993db4 2076 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2077 *******************************************************************************/
cparata 0:763b80993db4 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:763b80993db4 2079 {
cparata 0:763b80993db4 2080 u8_t value;
cparata 0:763b80993db4 2081
cparata 0:763b80993db4 2082 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
cparata 0:763b80993db4 2083 return MEMS_ERROR;
cparata 0:763b80993db4 2084
cparata 0:763b80993db4 2085 value &= ~LSM6DSL_ACC_GYRO_INT2_STEP_COUNT_OV_MASK;
cparata 0:763b80993db4 2086 value |= newValue;
cparata 0:763b80993db4 2087
cparata 0:763b80993db4 2088 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
cparata 0:763b80993db4 2089 return MEMS_ERROR;
cparata 0:763b80993db4 2090
cparata 0:763b80993db4 2091 return MEMS_SUCCESS;
cparata 0:763b80993db4 2092 }
cparata 0:763b80993db4 2093
cparata 0:763b80993db4 2094 /*******************************************************************************
cparata 0:763b80993db4 2095 * Function Name : LSM6DSL_ACC_GYRO_R_STEP_COUNT_OV_on_INT2
cparata 0:763b80993db4 2096 * Description : Read INT2_STEP_COUNT_OV
cparata 0:763b80993db4 2097 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_STEP_COUNT_OV_t
cparata 0:763b80993db4 2098 * Output : Status of INT2_STEP_COUNT_OV see LSM6DSL_ACC_GYRO_INT2_STEP_COUNT_OV_t
cparata 0:763b80993db4 2099 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2100 *******************************************************************************/
cparata 0:763b80993db4 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:763b80993db4 2102 {
cparata 0:763b80993db4 2103 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
cparata 0:763b80993db4 2104 return MEMS_ERROR;
cparata 0:763b80993db4 2105
cparata 0:763b80993db4 2106 *value &= LSM6DSL_ACC_GYRO_INT2_STEP_COUNT_OV_MASK; //mask
cparata 0:763b80993db4 2107
cparata 0:763b80993db4 2108 return MEMS_SUCCESS;
cparata 0:763b80993db4 2109 }
cparata 0:763b80993db4 2110
cparata 0:763b80993db4 2111 /*******************************************************************************
cparata 0:763b80993db4 2112 * Function Name : LSM6DSL_ACC_GYRO_W_STEP_DELTA_on_INT2
cparata 0:763b80993db4 2113 * Description : Write INT2_STEP_DELTA
cparata 0:763b80993db4 2114 * Input : LSM6DSL_ACC_GYRO_INT2_STEP_DELTA_t
cparata 0:763b80993db4 2115 * Output : None
cparata 0:763b80993db4 2116 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2117 *******************************************************************************/
cparata 0:763b80993db4 2118 status_t LSM6DSL_ACC_GYRO_W_STEP_DELTA_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_STEP_DELTA_t newValue)
cparata 0:763b80993db4 2119 {
cparata 0:763b80993db4 2120 u8_t value;
cparata 0:763b80993db4 2121
cparata 0:763b80993db4 2122 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1))
cparata 0:763b80993db4 2123 return MEMS_ERROR;
cparata 0:763b80993db4 2124
cparata 0:763b80993db4 2125 value &= ~LSM6DSL_ACC_GYRO_INT2_STEP_DELTA_MASK;
cparata 0:763b80993db4 2126 value |= newValue;
cparata 0:763b80993db4 2127
cparata 0:763b80993db4 2128 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, &value, 1) )
cparata 0:763b80993db4 2129 return MEMS_ERROR;
cparata 0:763b80993db4 2130
cparata 0:763b80993db4 2131 return MEMS_SUCCESS;
cparata 0:763b80993db4 2132 }
cparata 0:763b80993db4 2133
cparata 0:763b80993db4 2134 /*******************************************************************************
cparata 0:763b80993db4 2135 * Function Name : LSM6DSL_ACC_GYRO_R_STEP_DELTA_on_INT2
cparata 0:763b80993db4 2136 * Description : Read INT2_STEP_DELTA
cparata 0:763b80993db4 2137 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_STEP_DELTA_t
cparata 0:763b80993db4 2138 * Output : Status of INT2_STEP_DELTA see LSM6DSL_ACC_GYRO_INT2_STEP_DELTA_t
cparata 0:763b80993db4 2139 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2140 *******************************************************************************/
cparata 0:763b80993db4 2141 status_t LSM6DSL_ACC_GYRO_R_STEP_DELTA_on_INT2(void *handle, LSM6DSL_ACC_GYRO_INT2_STEP_DELTA_t *value)
cparata 0:763b80993db4 2142 {
cparata 0:763b80993db4 2143 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT2_CTRL, (u8_t *)value, 1))
cparata 0:763b80993db4 2144 return MEMS_ERROR;
cparata 0:763b80993db4 2145
cparata 0:763b80993db4 2146 *value &= LSM6DSL_ACC_GYRO_INT2_STEP_DELTA_MASK; //mask
cparata 0:763b80993db4 2147
cparata 0:763b80993db4 2148 return MEMS_SUCCESS;
cparata 0:763b80993db4 2149 }
cparata 0:763b80993db4 2150
cparata 0:763b80993db4 2151 /*******************************************************************************
cparata 0:763b80993db4 2152 * Function Name : LSM6DSL_ACC_GYRO_W_SW_RESET
cparata 0:763b80993db4 2153 * Description : Write SW_RESET
cparata 0:763b80993db4 2154 * Input : LSM6DSL_ACC_GYRO_SW_RESET_t
cparata 0:763b80993db4 2155 * Output : None
cparata 0:763b80993db4 2156 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2157 *******************************************************************************/
cparata 0:763b80993db4 2158 status_t LSM6DSL_ACC_GYRO_W_SW_RESET(void *handle, LSM6DSL_ACC_GYRO_SW_RESET_t newValue)
cparata 0:763b80993db4 2159 {
cparata 0:763b80993db4 2160 u8_t value;
cparata 0:763b80993db4 2161
cparata 0:763b80993db4 2162 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
cparata 0:763b80993db4 2163 return MEMS_ERROR;
cparata 0:763b80993db4 2164
cparata 0:763b80993db4 2165 value &= ~LSM6DSL_ACC_GYRO_SW_RESET_MASK;
cparata 0:763b80993db4 2166 value |= newValue;
cparata 0:763b80993db4 2167
cparata 0:763b80993db4 2168 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
cparata 0:763b80993db4 2169 return MEMS_ERROR;
cparata 0:763b80993db4 2170
cparata 0:763b80993db4 2171 return MEMS_SUCCESS;
cparata 0:763b80993db4 2172 }
cparata 0:763b80993db4 2173
cparata 0:763b80993db4 2174 /*******************************************************************************
cparata 0:763b80993db4 2175 * Function Name : LSM6DSL_ACC_GYRO_R_SW_RESET
cparata 0:763b80993db4 2176 * Description : Read SW_RESET
cparata 0:763b80993db4 2177 * Input : Pointer to LSM6DSL_ACC_GYRO_SW_RESET_t
cparata 0:763b80993db4 2178 * Output : Status of SW_RESET see LSM6DSL_ACC_GYRO_SW_RESET_t
cparata 0:763b80993db4 2179 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2180 *******************************************************************************/
cparata 0:763b80993db4 2181 status_t LSM6DSL_ACC_GYRO_R_SW_RESET(void *handle, LSM6DSL_ACC_GYRO_SW_RESET_t *value)
cparata 0:763b80993db4 2182 {
cparata 0:763b80993db4 2183 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1))
cparata 0:763b80993db4 2184 return MEMS_ERROR;
cparata 0:763b80993db4 2185
cparata 0:763b80993db4 2186 *value &= LSM6DSL_ACC_GYRO_SW_RESET_MASK; //mask
cparata 0:763b80993db4 2187
cparata 0:763b80993db4 2188 return MEMS_SUCCESS;
cparata 0:763b80993db4 2189 }
cparata 0:763b80993db4 2190
cparata 0:763b80993db4 2191 /*******************************************************************************
cparata 0:763b80993db4 2192 * Function Name : LSM6DSL_ACC_GYRO_W_IF_Addr_Incr
cparata 0:763b80993db4 2193 * Description : Write IF_INC
cparata 0:763b80993db4 2194 * Input : LSM6DSL_ACC_GYRO_IF_INC_t
cparata 0:763b80993db4 2195 * Output : None
cparata 0:763b80993db4 2196 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2197 *******************************************************************************/
cparata 0:763b80993db4 2198 status_t LSM6DSL_ACC_GYRO_W_IF_Addr_Incr(void *handle, LSM6DSL_ACC_GYRO_IF_INC_t newValue)
cparata 0:763b80993db4 2199 {
cparata 0:763b80993db4 2200 u8_t value;
cparata 0:763b80993db4 2201
cparata 0:763b80993db4 2202 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
cparata 0:763b80993db4 2203 return MEMS_ERROR;
cparata 0:763b80993db4 2204
cparata 0:763b80993db4 2205 value &= ~LSM6DSL_ACC_GYRO_IF_INC_MASK;
cparata 0:763b80993db4 2206 value |= newValue;
cparata 0:763b80993db4 2207
cparata 0:763b80993db4 2208 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
cparata 0:763b80993db4 2209 return MEMS_ERROR;
cparata 0:763b80993db4 2210
cparata 0:763b80993db4 2211 return MEMS_SUCCESS;
cparata 0:763b80993db4 2212 }
cparata 0:763b80993db4 2213
cparata 0:763b80993db4 2214 /*******************************************************************************
cparata 0:763b80993db4 2215 * Function Name : LSM6DSL_ACC_GYRO_R_IF_Addr_Incr
cparata 0:763b80993db4 2216 * Description : Read IF_INC
cparata 0:763b80993db4 2217 * Input : Pointer to LSM6DSL_ACC_GYRO_IF_INC_t
cparata 0:763b80993db4 2218 * Output : Status of IF_INC see LSM6DSL_ACC_GYRO_IF_INC_t
cparata 0:763b80993db4 2219 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2220 *******************************************************************************/
cparata 0:763b80993db4 2221 status_t LSM6DSL_ACC_GYRO_R_IF_Addr_Incr(void *handle, LSM6DSL_ACC_GYRO_IF_INC_t *value)
cparata 0:763b80993db4 2222 {
cparata 0:763b80993db4 2223 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1) )
cparata 0:763b80993db4 2224 return MEMS_ERROR;
cparata 0:763b80993db4 2225
cparata 0:763b80993db4 2226 *value &= LSM6DSL_ACC_GYRO_IF_INC_MASK; //mask
cparata 0:763b80993db4 2227
cparata 0:763b80993db4 2228 return MEMS_SUCCESS;
cparata 0:763b80993db4 2229 }
cparata 0:763b80993db4 2230
cparata 0:763b80993db4 2231 /*******************************************************************************
cparata 0:763b80993db4 2232 * Function Name : LSM6DSL_ACC_GYRO_W_SPI_Mode
cparata 0:763b80993db4 2233 * Description : Write SIM
cparata 0:763b80993db4 2234 * Input : LSM6DSL_ACC_GYRO_SIM_t
cparata 0:763b80993db4 2235 * Output : None
cparata 0:763b80993db4 2236 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2237 *******************************************************************************/
cparata 0:763b80993db4 2238 status_t LSM6DSL_ACC_GYRO_W_SPI_Mode(void *handle, LSM6DSL_ACC_GYRO_SIM_t newValue)
cparata 0:763b80993db4 2239 {
cparata 0:763b80993db4 2240 u8_t value;
cparata 0:763b80993db4 2241
cparata 0:763b80993db4 2242 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
cparata 0:763b80993db4 2243 return MEMS_ERROR;
cparata 0:763b80993db4 2244
cparata 0:763b80993db4 2245 value &= ~LSM6DSL_ACC_GYRO_SIM_MASK;
cparata 0:763b80993db4 2246 value |= newValue;
cparata 0:763b80993db4 2247
cparata 0:763b80993db4 2248 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
cparata 0:763b80993db4 2249 return MEMS_ERROR;
cparata 0:763b80993db4 2250
cparata 0:763b80993db4 2251 return MEMS_SUCCESS;
cparata 0:763b80993db4 2252 }
cparata 0:763b80993db4 2253
cparata 0:763b80993db4 2254 /*******************************************************************************
cparata 0:763b80993db4 2255 * Function Name : LSM6DSL_ACC_GYRO_R_SPI_Mode
cparata 0:763b80993db4 2256 * Description : Read SIM
cparata 0:763b80993db4 2257 * Input : Pointer to LSM6DSL_ACC_GYRO_SIM_t
cparata 0:763b80993db4 2258 * Output : Status of SIM see LSM6DSL_ACC_GYRO_SIM_t
cparata 0:763b80993db4 2259 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2260 *******************************************************************************/
cparata 0:763b80993db4 2261 status_t LSM6DSL_ACC_GYRO_R_SPI_Mode(void *handle, LSM6DSL_ACC_GYRO_SIM_t *value)
cparata 0:763b80993db4 2262 {
cparata 0:763b80993db4 2263 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1))
cparata 0:763b80993db4 2264 return MEMS_ERROR;
cparata 0:763b80993db4 2265
cparata 0:763b80993db4 2266 *value &= LSM6DSL_ACC_GYRO_SIM_MASK; //mask
cparata 0:763b80993db4 2267
cparata 0:763b80993db4 2268 return MEMS_SUCCESS;
cparata 0:763b80993db4 2269 }
cparata 0:763b80993db4 2270
cparata 0:763b80993db4 2271 /*******************************************************************************
cparata 0:763b80993db4 2272 * Function Name : LSM6DSL_ACC_GYRO_W_PadSel
cparata 0:763b80993db4 2273 * Description : Write PP_OD
cparata 0:763b80993db4 2274 * Input : LSM6DSL_ACC_GYRO_PP_OD_t
cparata 0:763b80993db4 2275 * Output : None
cparata 0:763b80993db4 2276 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2277 *******************************************************************************/
cparata 0:763b80993db4 2278 status_t LSM6DSL_ACC_GYRO_W_PadSel(void *handle, LSM6DSL_ACC_GYRO_PP_OD_t newValue)
cparata 0:763b80993db4 2279 {
cparata 0:763b80993db4 2280 u8_t value;
cparata 0:763b80993db4 2281
cparata 0:763b80993db4 2282 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
cparata 0:763b80993db4 2283 return MEMS_ERROR;
cparata 0:763b80993db4 2284
cparata 0:763b80993db4 2285 value &= ~LSM6DSL_ACC_GYRO_PP_OD_MASK;
cparata 0:763b80993db4 2286 value |= newValue;
cparata 0:763b80993db4 2287
cparata 0:763b80993db4 2288 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
cparata 0:763b80993db4 2289 return MEMS_ERROR;
cparata 0:763b80993db4 2290
cparata 0:763b80993db4 2291 return MEMS_SUCCESS;
cparata 0:763b80993db4 2292 }
cparata 0:763b80993db4 2293
cparata 0:763b80993db4 2294 /*******************************************************************************
cparata 0:763b80993db4 2295 * Function Name : LSM6DSL_ACC_GYRO_R_PadSel
cparata 0:763b80993db4 2296 * Description : Read PP_OD
cparata 0:763b80993db4 2297 * Input : Pointer to LSM6DSL_ACC_GYRO_PP_OD_t
cparata 0:763b80993db4 2298 * Output : Status of PP_OD see LSM6DSL_ACC_GYRO_PP_OD_t
cparata 0:763b80993db4 2299 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2300 *******************************************************************************/
cparata 0:763b80993db4 2301 status_t LSM6DSL_ACC_GYRO_R_PadSel(void *handle, LSM6DSL_ACC_GYRO_PP_OD_t *value)
cparata 0:763b80993db4 2302 {
cparata 0:763b80993db4 2303 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1) )
cparata 0:763b80993db4 2304 return MEMS_ERROR;
cparata 0:763b80993db4 2305
cparata 0:763b80993db4 2306 *value &= LSM6DSL_ACC_GYRO_PP_OD_MASK; //mask
cparata 0:763b80993db4 2307
cparata 0:763b80993db4 2308 return MEMS_SUCCESS;
cparata 0:763b80993db4 2309 }
cparata 0:763b80993db4 2310
cparata 0:763b80993db4 2311 /*******************************************************************************
cparata 0:763b80993db4 2312 * Function Name : LSM6DSL_ACC_GYRO_W_INT_ACT_LEVEL
cparata 0:763b80993db4 2313 * Description : Write INT_ACT_LEVEL
cparata 0:763b80993db4 2314 * Input : LSM6DSL_ACC_GYRO_INT_ACT_LEVEL_t
cparata 0:763b80993db4 2315 * Output : None
cparata 0:763b80993db4 2316 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2317 *******************************************************************************/
cparata 0:763b80993db4 2318 status_t LSM6DSL_ACC_GYRO_W_INT_ACT_LEVEL(void *handle, LSM6DSL_ACC_GYRO_INT_ACT_LEVEL_t newValue)
cparata 0:763b80993db4 2319 {
cparata 0:763b80993db4 2320 u8_t value;
cparata 0:763b80993db4 2321
cparata 0:763b80993db4 2322 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
cparata 0:763b80993db4 2323 return MEMS_ERROR;
cparata 0:763b80993db4 2324
cparata 0:763b80993db4 2325 value &= ~LSM6DSL_ACC_GYRO_INT_ACT_LEVEL_MASK;
cparata 0:763b80993db4 2326 value |= newValue;
cparata 0:763b80993db4 2327
cparata 0:763b80993db4 2328 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
cparata 0:763b80993db4 2329 return MEMS_ERROR;
cparata 0:763b80993db4 2330
cparata 0:763b80993db4 2331 return MEMS_SUCCESS;
cparata 0:763b80993db4 2332 }
cparata 0:763b80993db4 2333
cparata 0:763b80993db4 2334 /*******************************************************************************
cparata 0:763b80993db4 2335 * Function Name : LSM6DSL_ACC_GYRO_R_INT_ACT_LEVEL
cparata 0:763b80993db4 2336 * Description : Read INT_ACT_LEVEL
cparata 0:763b80993db4 2337 * Input : Pointer to LSM6DSL_ACC_GYRO_INT_ACT_LEVEL_t
cparata 0:763b80993db4 2338 * Output : Status of INT_ACT_LEVEL see LSM6DSL_ACC_GYRO_INT_ACT_LEVEL_t
cparata 0:763b80993db4 2339 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2340 *******************************************************************************/
cparata 0:763b80993db4 2341 status_t LSM6DSL_ACC_GYRO_R_INT_ACT_LEVEL(void *handle, LSM6DSL_ACC_GYRO_INT_ACT_LEVEL_t *value)
cparata 0:763b80993db4 2342 {
cparata 0:763b80993db4 2343 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1))
cparata 0:763b80993db4 2344 return MEMS_ERROR;
cparata 0:763b80993db4 2345
cparata 0:763b80993db4 2346 *value &= LSM6DSL_ACC_GYRO_INT_ACT_LEVEL_MASK; //mask
cparata 0:763b80993db4 2347
cparata 0:763b80993db4 2348 return MEMS_SUCCESS;
cparata 0:763b80993db4 2349 }
cparata 0:763b80993db4 2350
cparata 0:763b80993db4 2351 /*******************************************************************************
cparata 0:763b80993db4 2352 * Function Name : LSM6DSL_ACC_GYRO_W_BOOT
cparata 0:763b80993db4 2353 * Description : Write BOOT
cparata 0:763b80993db4 2354 * Input : LSM6DSL_ACC_GYRO_BOOT_t
cparata 0:763b80993db4 2355 * Output : None
cparata 0:763b80993db4 2356 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2357 *******************************************************************************/
cparata 0:763b80993db4 2358 status_t LSM6DSL_ACC_GYRO_W_BOOT(void *handle, LSM6DSL_ACC_GYRO_BOOT_t newValue)
cparata 0:763b80993db4 2359 {
cparata 0:763b80993db4 2360 u8_t value;
cparata 0:763b80993db4 2361
cparata 0:763b80993db4 2362 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1))
cparata 0:763b80993db4 2363 return MEMS_ERROR;
cparata 0:763b80993db4 2364
cparata 0:763b80993db4 2365 value &= ~LSM6DSL_ACC_GYRO_BOOT_MASK;
cparata 0:763b80993db4 2366 value |= newValue;
cparata 0:763b80993db4 2367
cparata 0:763b80993db4 2368 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, &value, 1) )
cparata 0:763b80993db4 2369 return MEMS_ERROR;
cparata 0:763b80993db4 2370
cparata 0:763b80993db4 2371 return MEMS_SUCCESS;
cparata 0:763b80993db4 2372 }
cparata 0:763b80993db4 2373
cparata 0:763b80993db4 2374 /*******************************************************************************
cparata 0:763b80993db4 2375 * Function Name : LSM6DSL_ACC_GYRO_R_BOOT
cparata 0:763b80993db4 2376 * Description : Read BOOT
cparata 0:763b80993db4 2377 * Input : Pointer to LSM6DSL_ACC_GYRO_BOOT_t
cparata 0:763b80993db4 2378 * Output : Status of BOOT see LSM6DSL_ACC_GYRO_BOOT_t
cparata 0:763b80993db4 2379 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2380 *******************************************************************************/
cparata 0:763b80993db4 2381 status_t LSM6DSL_ACC_GYRO_R_BOOT(void *handle, LSM6DSL_ACC_GYRO_BOOT_t *value)
cparata 0:763b80993db4 2382 {
cparata 0:763b80993db4 2383 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL3_C, (u8_t *)value, 1) )
cparata 0:763b80993db4 2384 return MEMS_ERROR;
cparata 0:763b80993db4 2385
cparata 0:763b80993db4 2386 *value &= LSM6DSL_ACC_GYRO_BOOT_MASK; //mask
cparata 0:763b80993db4 2387
cparata 0:763b80993db4 2388 return MEMS_SUCCESS;
cparata 0:763b80993db4 2389 }
cparata 0:763b80993db4 2390
cparata 0:763b80993db4 2391 /*******************************************************************************
cparata 0:763b80993db4 2392 * Function Name : LSM6DSL_ACC_GYRO_LPF1_SEL_G
cparata 0:763b80993db4 2393 * Description : Write LPF1_SEL_G
cparata 0:763b80993db4 2394 * Input : LSM6DSL_ACC_GYRO_LPF1_SEL_G_t
cparata 0:763b80993db4 2395 * Output : None
cparata 0:763b80993db4 2396 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2397 *******************************************************************************/
cparata 0:763b80993db4 2398 status_t LSM6DSL_ACC_GYRO_W_LPF1_SEL_G(void *handle, LSM6DSL_ACC_GYRO_LPF1_SEL_G_t newValue)
cparata 0:763b80993db4 2399 {
cparata 0:763b80993db4 2400 u8_t value;
cparata 0:763b80993db4 2401
cparata 0:763b80993db4 2402 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1))
cparata 0:763b80993db4 2403 return MEMS_ERROR;
cparata 0:763b80993db4 2404
cparata 0:763b80993db4 2405 value &= ~LSM6DSL_ACC_GYRO_LPF1_SEL_G_MASK;
cparata 0:763b80993db4 2406 value |= newValue;
cparata 0:763b80993db4 2407
cparata 0:763b80993db4 2408 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1) )
cparata 0:763b80993db4 2409 return MEMS_ERROR;
cparata 0:763b80993db4 2410
cparata 0:763b80993db4 2411 return MEMS_SUCCESS;
cparata 0:763b80993db4 2412 }
cparata 0:763b80993db4 2413
cparata 0:763b80993db4 2414 /*******************************************************************************
cparata 0:763b80993db4 2415 * Function Name : LSM6DSL_ACC_GYRO_LPF1_SEL_G
cparata 0:763b80993db4 2416 * Description : Read LPF1_SEL_G
cparata 0:763b80993db4 2417 * Input : Pointer to LSM6DSL_ACC_GYRO_LPF1_SEL_G_t
cparata 0:763b80993db4 2418 * Output : Status of LPF1_SEL_G see LSM6DSL_ACC_GYRO_LPF1_SEL_G_t
cparata 0:763b80993db4 2419 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2420 *******************************************************************************/
cparata 0:763b80993db4 2421 status_t LSM6DSL_ACC_GYRO_R_LPF1_SEL_G(void *handle, LSM6DSL_ACC_GYRO_LPF1_SEL_G_t *value)
cparata 0:763b80993db4 2422 {
cparata 0:763b80993db4 2423 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, (u8_t *)value, 1) )
cparata 0:763b80993db4 2424 return MEMS_ERROR;
cparata 0:763b80993db4 2425
cparata 0:763b80993db4 2426 *value &= LSM6DSL_ACC_GYRO_LPF1_SEL_G_MASK; //mask
cparata 0:763b80993db4 2427
cparata 0:763b80993db4 2428 return MEMS_SUCCESS;
cparata 0:763b80993db4 2429 }
cparata 0:763b80993db4 2430
cparata 0:763b80993db4 2431 /*******************************************************************************
cparata 0:763b80993db4 2432 * Function Name : LSM6DSL_ACC_GYRO_W_I2C_DISABLE
cparata 0:763b80993db4 2433 * Description : Write I2C_DISABLE
cparata 0:763b80993db4 2434 * Input : LSM6DSL_ACC_GYRO_I2C_DISABLE_t
cparata 0:763b80993db4 2435 * Output : None
cparata 0:763b80993db4 2436 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2437 *******************************************************************************/
cparata 0:763b80993db4 2438 status_t LSM6DSL_ACC_GYRO_W_I2C_DISABLE(void *handle, LSM6DSL_ACC_GYRO_I2C_DISABLE_t newValue)
cparata 0:763b80993db4 2439 {
cparata 0:763b80993db4 2440 u8_t value;
cparata 0:763b80993db4 2441
cparata 0:763b80993db4 2442 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1))
cparata 0:763b80993db4 2443 return MEMS_ERROR;
cparata 0:763b80993db4 2444
cparata 0:763b80993db4 2445 value &= ~LSM6DSL_ACC_GYRO_I2C_DISABLE_MASK;
cparata 0:763b80993db4 2446 value |= newValue;
cparata 0:763b80993db4 2447
cparata 0:763b80993db4 2448 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1) )
cparata 0:763b80993db4 2449 return MEMS_ERROR;
cparata 0:763b80993db4 2450
cparata 0:763b80993db4 2451 return MEMS_SUCCESS;
cparata 0:763b80993db4 2452 }
cparata 0:763b80993db4 2453
cparata 0:763b80993db4 2454 /*******************************************************************************
cparata 0:763b80993db4 2455 * Function Name : LSM6DSL_ACC_GYRO_R_I2C_DISABLE
cparata 0:763b80993db4 2456 * Description : Read I2C_DISABLE
cparata 0:763b80993db4 2457 * Input : Pointer to LSM6DSL_ACC_GYRO_I2C_DISABLE_t
cparata 0:763b80993db4 2458 * Output : Status of I2C_DISABLE see LSM6DSL_ACC_GYRO_I2C_DISABLE_t
cparata 0:763b80993db4 2459 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2460 *******************************************************************************/
cparata 0:763b80993db4 2461 status_t LSM6DSL_ACC_GYRO_R_I2C_DISABLE(void *handle, LSM6DSL_ACC_GYRO_I2C_DISABLE_t *value)
cparata 0:763b80993db4 2462 {
cparata 0:763b80993db4 2463 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, (u8_t *)value, 1) )
cparata 0:763b80993db4 2464 return MEMS_ERROR;
cparata 0:763b80993db4 2465
cparata 0:763b80993db4 2466 *value &= LSM6DSL_ACC_GYRO_I2C_DISABLE_MASK; //mask
cparata 0:763b80993db4 2467
cparata 0:763b80993db4 2468 return MEMS_SUCCESS;
cparata 0:763b80993db4 2469 }
cparata 0:763b80993db4 2470
cparata 0:763b80993db4 2471 /*******************************************************************************
cparata 0:763b80993db4 2472 * Function Name : LSM6DSL_ACC_GYRO_W_DRDY_MSK
cparata 0:763b80993db4 2473 * Description : Write DRDY_MSK
cparata 0:763b80993db4 2474 * Input : LSM6DSL_ACC_GYRO_DRDY_MSK_t
cparata 0:763b80993db4 2475 * Output : None
cparata 0:763b80993db4 2476 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2477 *******************************************************************************/
cparata 0:763b80993db4 2478 status_t LSM6DSL_ACC_GYRO_W_DRDY_MSK(void *handle, LSM6DSL_ACC_GYRO_DRDY_MSK_t newValue)
cparata 0:763b80993db4 2479 {
cparata 0:763b80993db4 2480 u8_t value;
cparata 0:763b80993db4 2481
cparata 0:763b80993db4 2482 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1))
cparata 0:763b80993db4 2483 return MEMS_ERROR;
cparata 0:763b80993db4 2484
cparata 0:763b80993db4 2485 value &= ~LSM6DSL_ACC_GYRO_DRDY_MSK_MASK;
cparata 0:763b80993db4 2486 value |= newValue;
cparata 0:763b80993db4 2487
cparata 0:763b80993db4 2488 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1) )
cparata 0:763b80993db4 2489 return MEMS_ERROR;
cparata 0:763b80993db4 2490
cparata 0:763b80993db4 2491 return MEMS_SUCCESS;
cparata 0:763b80993db4 2492 }
cparata 0:763b80993db4 2493
cparata 0:763b80993db4 2494 /*******************************************************************************
cparata 0:763b80993db4 2495 * Function Name : LSM6DSL_ACC_GYRO_R_DRDY_MSK
cparata 0:763b80993db4 2496 * Description : Read DRDY_MSK
cparata 0:763b80993db4 2497 * Input : Pointer to LSM6DSL_ACC_GYRO_DRDY_MSK_t
cparata 0:763b80993db4 2498 * Output : Status of DRDY_MSK see LSM6DSL_ACC_GYRO_DRDY_MSK_t
cparata 0:763b80993db4 2499 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2500 *******************************************************************************/
cparata 0:763b80993db4 2501 status_t LSM6DSL_ACC_GYRO_R_DRDY_MSK(void *handle, LSM6DSL_ACC_GYRO_DRDY_MSK_t *value)
cparata 0:763b80993db4 2502 {
cparata 0:763b80993db4 2503 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, (u8_t *)value, 1))
cparata 0:763b80993db4 2504 return MEMS_ERROR;
cparata 0:763b80993db4 2505
cparata 0:763b80993db4 2506 *value &= LSM6DSL_ACC_GYRO_DRDY_MSK_MASK; //mask
cparata 0:763b80993db4 2507
cparata 0:763b80993db4 2508 return MEMS_SUCCESS;
cparata 0:763b80993db4 2509 }
cparata 0:763b80993db4 2510
cparata 0:763b80993db4 2511 /*******************************************************************************
cparata 0:763b80993db4 2512 * Function Name : LSM6DSL_ACC_GYRO_W_INT2_ON_INT1
cparata 0:763b80993db4 2513 * Description : Write INT2_ON_INT1
cparata 0:763b80993db4 2514 * Input : LSM6DSL_ACC_GYRO_INT2_ON_INT1_t
cparata 0:763b80993db4 2515 * Output : None
cparata 0:763b80993db4 2516 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2517 *******************************************************************************/
cparata 0:763b80993db4 2518 status_t LSM6DSL_ACC_GYRO_W_INT2_ON_INT1(void *handle, LSM6DSL_ACC_GYRO_INT2_ON_INT1_t newValue)
cparata 0:763b80993db4 2519 {
cparata 0:763b80993db4 2520 u8_t value;
cparata 0:763b80993db4 2521
cparata 0:763b80993db4 2522 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1))
cparata 0:763b80993db4 2523 return MEMS_ERROR;
cparata 0:763b80993db4 2524
cparata 0:763b80993db4 2525 value &= ~LSM6DSL_ACC_GYRO_INT2_ON_INT1_MASK;
cparata 0:763b80993db4 2526 value |= newValue;
cparata 0:763b80993db4 2527
cparata 0:763b80993db4 2528 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1) )
cparata 0:763b80993db4 2529 return MEMS_ERROR;
cparata 0:763b80993db4 2530
cparata 0:763b80993db4 2531 return MEMS_SUCCESS;
cparata 0:763b80993db4 2532 }
cparata 0:763b80993db4 2533
cparata 0:763b80993db4 2534 /*******************************************************************************
cparata 0:763b80993db4 2535 * Function Name : LSM6DSL_ACC_GYRO_R_INT2_ON_INT1
cparata 0:763b80993db4 2536 * Description : Read INT2_ON_INT1
cparata 0:763b80993db4 2537 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_ON_INT1_t
cparata 0:763b80993db4 2538 * Output : Status of INT2_ON_INT1 see LSM6DSL_ACC_GYRO_INT2_ON_INT1_t
cparata 0:763b80993db4 2539 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2540 *******************************************************************************/
cparata 0:763b80993db4 2541 status_t LSM6DSL_ACC_GYRO_R_INT2_ON_INT1(void *handle, LSM6DSL_ACC_GYRO_INT2_ON_INT1_t *value)
cparata 0:763b80993db4 2542 {
cparata 0:763b80993db4 2543 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, (u8_t *)value, 1))
cparata 0:763b80993db4 2544 return MEMS_ERROR;
cparata 0:763b80993db4 2545
cparata 0:763b80993db4 2546 *value &= LSM6DSL_ACC_GYRO_INT2_ON_INT1_MASK; //mask
cparata 0:763b80993db4 2547
cparata 0:763b80993db4 2548 return MEMS_SUCCESS;
cparata 0:763b80993db4 2549 }
cparata 0:763b80993db4 2550
cparata 0:763b80993db4 2551 /*******************************************************************************
cparata 0:763b80993db4 2552 * Function Name : LSM6DSL_ACC_GYRO_W_SleepMode_G
cparata 0:763b80993db4 2553 * Description : Write SLEEP_G
cparata 0:763b80993db4 2554 * Input : LSM6DSL_ACC_GYRO_SLEEP_G_t
cparata 0:763b80993db4 2555 * Output : None
cparata 0:763b80993db4 2556 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2557 *******************************************************************************/
cparata 0:763b80993db4 2558 status_t LSM6DSL_ACC_GYRO_W_SleepMode_G(void *handle, LSM6DSL_ACC_GYRO_SLEEP_G_t newValue)
cparata 0:763b80993db4 2559 {
cparata 0:763b80993db4 2560 u8_t value;
cparata 0:763b80993db4 2561
cparata 0:763b80993db4 2562 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1))
cparata 0:763b80993db4 2563 return MEMS_ERROR;
cparata 0:763b80993db4 2564
cparata 0:763b80993db4 2565 value &= ~LSM6DSL_ACC_GYRO_SLEEP_G_MASK;
cparata 0:763b80993db4 2566 value |= newValue;
cparata 0:763b80993db4 2567
cparata 0:763b80993db4 2568 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, &value, 1) )
cparata 0:763b80993db4 2569 return MEMS_ERROR;
cparata 0:763b80993db4 2570
cparata 0:763b80993db4 2571 return MEMS_SUCCESS;
cparata 0:763b80993db4 2572 }
cparata 0:763b80993db4 2573
cparata 0:763b80993db4 2574 /*******************************************************************************
cparata 0:763b80993db4 2575 * Function Name : LSM6DSL_ACC_GYRO_R_SleepMode_G
cparata 0:763b80993db4 2576 * Description : Read SLEEP_G
cparata 0:763b80993db4 2577 * Input : Pointer to LSM6DSL_ACC_GYRO_SLEEP_G_t
cparata 0:763b80993db4 2578 * Output : Status of SLEEP_G see LSM6DSL_ACC_GYRO_SLEEP_G_t
cparata 0:763b80993db4 2579 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2580 *******************************************************************************/
cparata 0:763b80993db4 2581 status_t LSM6DSL_ACC_GYRO_R_SleepMode_G(void *handle, LSM6DSL_ACC_GYRO_SLEEP_G_t *value)
cparata 0:763b80993db4 2582 {
cparata 0:763b80993db4 2583 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL4_C, (u8_t *)value, 1))
cparata 0:763b80993db4 2584 return MEMS_ERROR;
cparata 0:763b80993db4 2585
cparata 0:763b80993db4 2586 *value &= LSM6DSL_ACC_GYRO_SLEEP_G_MASK; //mask
cparata 0:763b80993db4 2587
cparata 0:763b80993db4 2588 return MEMS_SUCCESS;
cparata 0:763b80993db4 2589 }
cparata 0:763b80993db4 2590
cparata 0:763b80993db4 2591 /*******************************************************************************
cparata 0:763b80993db4 2592 * Function Name : LSM6DSL_ACC_GYRO_W_SelfTest_XL
cparata 0:763b80993db4 2593 * Description : Write ST_XL
cparata 0:763b80993db4 2594 * Input : LSM6DSL_ACC_GYRO_ST_XL_t
cparata 0:763b80993db4 2595 * Output : None
cparata 0:763b80993db4 2596 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2597 *******************************************************************************/
cparata 0:763b80993db4 2598 status_t LSM6DSL_ACC_GYRO_W_SelfTest_XL(void *handle, LSM6DSL_ACC_GYRO_ST_XL_t newValue)
cparata 0:763b80993db4 2599 {
cparata 0:763b80993db4 2600 u8_t value;
cparata 0:763b80993db4 2601
cparata 0:763b80993db4 2602 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1))
cparata 0:763b80993db4 2603 return MEMS_ERROR;
cparata 0:763b80993db4 2604
cparata 0:763b80993db4 2605 value &= ~LSM6DSL_ACC_GYRO_ST_XL_MASK;
cparata 0:763b80993db4 2606 value |= newValue;
cparata 0:763b80993db4 2607
cparata 0:763b80993db4 2608 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1) )
cparata 0:763b80993db4 2609 return MEMS_ERROR;
cparata 0:763b80993db4 2610
cparata 0:763b80993db4 2611 return MEMS_SUCCESS;
cparata 0:763b80993db4 2612 }
cparata 0:763b80993db4 2613
cparata 0:763b80993db4 2614 /*******************************************************************************
cparata 0:763b80993db4 2615 * Function Name : LSM6DSL_ACC_GYRO_R_SelfTest_XL
cparata 0:763b80993db4 2616 * Description : Read ST_XL
cparata 0:763b80993db4 2617 * Input : Pointer to LSM6DSL_ACC_GYRO_ST_XL_t
cparata 0:763b80993db4 2618 * Output : Status of ST_XL see LSM6DSL_ACC_GYRO_ST_XL_t
cparata 0:763b80993db4 2619 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2620 *******************************************************************************/
cparata 0:763b80993db4 2621 status_t LSM6DSL_ACC_GYRO_R_SelfTest_XL(void *handle, LSM6DSL_ACC_GYRO_ST_XL_t *value)
cparata 0:763b80993db4 2622 {
cparata 0:763b80993db4 2623 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, (u8_t *)value, 1))
cparata 0:763b80993db4 2624 return MEMS_ERROR;
cparata 0:763b80993db4 2625
cparata 0:763b80993db4 2626 *value &= LSM6DSL_ACC_GYRO_ST_XL_MASK; //mask
cparata 0:763b80993db4 2627
cparata 0:763b80993db4 2628 return MEMS_SUCCESS;
cparata 0:763b80993db4 2629 }
cparata 0:763b80993db4 2630
cparata 0:763b80993db4 2631 /*******************************************************************************
cparata 0:763b80993db4 2632 * Function Name : LSM6DSL_ACC_GYRO_W_SelfTest_G
cparata 0:763b80993db4 2633 * Description : Write ST_G
cparata 0:763b80993db4 2634 * Input : LSM6DSL_ACC_GYRO_ST_G_t
cparata 0:763b80993db4 2635 * Output : None
cparata 0:763b80993db4 2636 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2637 *******************************************************************************/
cparata 0:763b80993db4 2638 status_t LSM6DSL_ACC_GYRO_W_SelfTest_G(void *handle, LSM6DSL_ACC_GYRO_ST_G_t newValue)
cparata 0:763b80993db4 2639 {
cparata 0:763b80993db4 2640 u8_t value;
cparata 0:763b80993db4 2641
cparata 0:763b80993db4 2642 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1))
cparata 0:763b80993db4 2643 return MEMS_ERROR;
cparata 0:763b80993db4 2644
cparata 0:763b80993db4 2645 value &= ~LSM6DSL_ACC_GYRO_ST_G_MASK;
cparata 0:763b80993db4 2646 value |= newValue;
cparata 0:763b80993db4 2647
cparata 0:763b80993db4 2648 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1) )
cparata 0:763b80993db4 2649 return MEMS_ERROR;
cparata 0:763b80993db4 2650
cparata 0:763b80993db4 2651 return MEMS_SUCCESS;
cparata 0:763b80993db4 2652 }
cparata 0:763b80993db4 2653
cparata 0:763b80993db4 2654 /*******************************************************************************
cparata 0:763b80993db4 2655 * Function Name : LSM6DSL_ACC_GYRO_R_SelfTest_G
cparata 0:763b80993db4 2656 * Description : Read ST_G
cparata 0:763b80993db4 2657 * Input : Pointer to LSM6DSL_ACC_GYRO_ST_G_t
cparata 0:763b80993db4 2658 * Output : Status of ST_G see LSM6DSL_ACC_GYRO_ST_G_t
cparata 0:763b80993db4 2659 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2660 *******************************************************************************/
cparata 0:763b80993db4 2661 status_t LSM6DSL_ACC_GYRO_R_SelfTest_G(void *handle, LSM6DSL_ACC_GYRO_ST_G_t *value)
cparata 0:763b80993db4 2662 {
cparata 0:763b80993db4 2663 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, (u8_t *)value, 1))
cparata 0:763b80993db4 2664 return MEMS_ERROR;
cparata 0:763b80993db4 2665
cparata 0:763b80993db4 2666 *value &= LSM6DSL_ACC_GYRO_ST_G_MASK; //mask
cparata 0:763b80993db4 2667
cparata 0:763b80993db4 2668 return MEMS_SUCCESS;
cparata 0:763b80993db4 2669 }
cparata 0:763b80993db4 2670
cparata 0:763b80993db4 2671 /*******************************************************************************
cparata 0:763b80993db4 2672 * Function Name : LSM6DSL_ACC_GYRO_W_DEN_Polarity
cparata 0:763b80993db4 2673 * Description : Write DEN_LH
cparata 0:763b80993db4 2674 * Input : LSM6DSL_ACC_GYRO_DEN_LH_t
cparata 0:763b80993db4 2675 * Output : None
cparata 0:763b80993db4 2676 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2677 *******************************************************************************/
cparata 0:763b80993db4 2678 status_t LSM6DSL_ACC_GYRO_W_DEN_Polarity(void *handle, LSM6DSL_ACC_GYRO_DEN_LH_t newValue)
cparata 0:763b80993db4 2679 {
cparata 0:763b80993db4 2680 u8_t value;
cparata 0:763b80993db4 2681
cparata 0:763b80993db4 2682 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1))
cparata 0:763b80993db4 2683 return MEMS_ERROR;
cparata 0:763b80993db4 2684
cparata 0:763b80993db4 2685 value &= ~LSM6DSL_ACC_GYRO_DEN_LH_MASK;
cparata 0:763b80993db4 2686 value |= newValue;
cparata 0:763b80993db4 2687
cparata 0:763b80993db4 2688 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1) )
cparata 0:763b80993db4 2689 return MEMS_ERROR;
cparata 0:763b80993db4 2690
cparata 0:763b80993db4 2691 return MEMS_SUCCESS;
cparata 0:763b80993db4 2692 }
cparata 0:763b80993db4 2693
cparata 0:763b80993db4 2694 /*******************************************************************************
cparata 0:763b80993db4 2695 * Function Name : LSM6DSL_ACC_GYRO_R_DEN_Polarity
cparata 0:763b80993db4 2696 * Description : Read DEN_LH
cparata 0:763b80993db4 2697 * Input : Pointer to LSM6DSL_ACC_GYRO_DEN_LH_t
cparata 0:763b80993db4 2698 * Output : Status of DEN_LH see LSM6DSL_ACC_GYRO_DEN_LH_t
cparata 0:763b80993db4 2699 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2700 *******************************************************************************/
cparata 0:763b80993db4 2701 status_t LSM6DSL_ACC_GYRO_R_DEN_Polarity(void *handle, LSM6DSL_ACC_GYRO_DEN_LH_t *value)
cparata 0:763b80993db4 2702 {
cparata 0:763b80993db4 2703 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, (u8_t *)value, 1))
cparata 0:763b80993db4 2704 return MEMS_ERROR;
cparata 0:763b80993db4 2705
cparata 0:763b80993db4 2706 *value &= LSM6DSL_ACC_GYRO_DEN_LH_MASK; //mask
cparata 0:763b80993db4 2707
cparata 0:763b80993db4 2708 return MEMS_SUCCESS;
cparata 0:763b80993db4 2709 }
cparata 0:763b80993db4 2710
cparata 0:763b80993db4 2711 /*******************************************************************************
cparata 0:763b80993db4 2712 * Function Name : LSM6DSL_ACC_GYRO_W_CircularBurstMode
cparata 0:763b80993db4 2713 * Description : Write ST_ROUNDING
cparata 0:763b80993db4 2714 * Input : LSM6DSL_ACC_GYRO_ROUNDING_t
cparata 0:763b80993db4 2715 * Output : None
cparata 0:763b80993db4 2716 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2717 *******************************************************************************/
cparata 0:763b80993db4 2718 status_t LSM6DSL_ACC_GYRO_W_CircularBurstMode(void *handle, LSM6DSL_ACC_GYRO_ROUNDING_t newValue)
cparata 0:763b80993db4 2719 {
cparata 0:763b80993db4 2720 u8_t value;
cparata 0:763b80993db4 2721
cparata 0:763b80993db4 2722 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1))
cparata 0:763b80993db4 2723 return MEMS_ERROR;
cparata 0:763b80993db4 2724
cparata 0:763b80993db4 2725 value &= ~LSM6DSL_ACC_GYRO_LSM6DSL_ACC_GYRO_ROUNDING_t_MASK;
cparata 0:763b80993db4 2726 value |= newValue;
cparata 0:763b80993db4 2727
cparata 0:763b80993db4 2728 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, &value, 1) )
cparata 0:763b80993db4 2729 return MEMS_ERROR;
cparata 0:763b80993db4 2730
cparata 0:763b80993db4 2731 return MEMS_SUCCESS;
cparata 0:763b80993db4 2732 }
cparata 0:763b80993db4 2733
cparata 0:763b80993db4 2734 /*******************************************************************************
cparata 0:763b80993db4 2735 * Function Name : LSM6DSL_ACC_GYRO_R_CircularBurstMode
cparata 0:763b80993db4 2736 * Description : Read ST_ROUNDING
cparata 0:763b80993db4 2737 * Input : Pointer to LSM6DSL_ACC_GYRO_ROUNDING_t
cparata 0:763b80993db4 2738 * Output : Status of ST_ROUNDING see LSM6DSL_ACC_GYRO_ROUNDING_t
cparata 0:763b80993db4 2739 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2740 *******************************************************************************/
cparata 0:763b80993db4 2741 status_t LSM6DSL_ACC_GYRO_R_CircularBurstMode(void *handle, LSM6DSL_ACC_GYRO_ROUNDING_t *value)
cparata 0:763b80993db4 2742 {
cparata 0:763b80993db4 2743 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL5_C, (u8_t *)value, 1))
cparata 0:763b80993db4 2744 return MEMS_ERROR;
cparata 0:763b80993db4 2745
cparata 0:763b80993db4 2746 *value &= LSM6DSL_ACC_GYRO_LSM6DSL_ACC_GYRO_ROUNDING_t_MASK; //mask
cparata 0:763b80993db4 2747
cparata 0:763b80993db4 2748 return MEMS_SUCCESS;
cparata 0:763b80993db4 2749 }
cparata 0:763b80993db4 2750
cparata 0:763b80993db4 2751 /*******************************************************************************
cparata 0:763b80993db4 2752 * Function Name : LSM6DSL_ACC_GYRO_W_LP_BW_G
cparata 0:763b80993db4 2753 * Description : Write FTYPE
cparata 0:763b80993db4 2754 * Input : LSM6DSL_ACC_GYRO_FTYPE_t
cparata 0:763b80993db4 2755 * Output : None
cparata 0:763b80993db4 2756 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2757 *******************************************************************************/
cparata 0:763b80993db4 2758 status_t LSM6DSL_ACC_GYRO_W_LP_BW_G(void *handle, LSM6DSL_ACC_GYRO_FTYPE_t newValue)
cparata 0:763b80993db4 2759 {
cparata 0:763b80993db4 2760 u8_t value;
cparata 0:763b80993db4 2761
cparata 0:763b80993db4 2762 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1))
cparata 0:763b80993db4 2763 return MEMS_ERROR;
cparata 0:763b80993db4 2764
cparata 0:763b80993db4 2765 value &= ~LSM6DSL_ACC_GYRO_FTYPE_MASK;
cparata 0:763b80993db4 2766 value |= newValue;
cparata 0:763b80993db4 2767
cparata 0:763b80993db4 2768 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1) )
cparata 0:763b80993db4 2769 return MEMS_ERROR;
cparata 0:763b80993db4 2770
cparata 0:763b80993db4 2771 return MEMS_SUCCESS;
cparata 0:763b80993db4 2772 }
cparata 0:763b80993db4 2773
cparata 0:763b80993db4 2774 /*******************************************************************************
cparata 0:763b80993db4 2775 * Function Name : LSM6DSL_ACC_GYRO_R_LP_BW_G
cparata 0:763b80993db4 2776 * Description : Read FTYPE
cparata 0:763b80993db4 2777 * Input : Pointer to LSM6DSL_ACC_GYRO_FTYPE_t
cparata 0:763b80993db4 2778 * Output : Status of FTYPE see LSM6DSL_ACC_GYRO_FTYPE_t
cparata 0:763b80993db4 2779 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2780 *******************************************************************************/
cparata 0:763b80993db4 2781 status_t LSM6DSL_ACC_GYRO_R_LP_BW_G(void *handle, LSM6DSL_ACC_GYRO_FTYPE_t *value)
cparata 0:763b80993db4 2782 {
cparata 0:763b80993db4 2783 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, (u8_t *)value, 1))
cparata 0:763b80993db4 2784 return MEMS_ERROR;
cparata 0:763b80993db4 2785
cparata 0:763b80993db4 2786 *value &= LSM6DSL_ACC_GYRO_FTYPE_MASK; //mask
cparata 0:763b80993db4 2787
cparata 0:763b80993db4 2788 return MEMS_SUCCESS;
cparata 0:763b80993db4 2789 }
cparata 0:763b80993db4 2790
cparata 0:763b80993db4 2791 /*******************************************************************************
cparata 0:763b80993db4 2792 * Function Name : LSM6DSL_ACC_GYRO_W_UserOffsetWeight
cparata 0:763b80993db4 2793 * Description : Write USR_OFF_W
cparata 0:763b80993db4 2794 * Input : LSM6DSL_ACC_GYRO_USR_OFF_W_t
cparata 0:763b80993db4 2795 * Output : None
cparata 0:763b80993db4 2796 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2797 *******************************************************************************/
cparata 0:763b80993db4 2798 status_t LSM6DSL_ACC_GYRO_W_UserOffsetWeight(void *handle, LSM6DSL_ACC_GYRO_USR_OFF_W_t newValue)
cparata 0:763b80993db4 2799 {
cparata 0:763b80993db4 2800 u8_t value;
cparata 0:763b80993db4 2801
cparata 0:763b80993db4 2802 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1))
cparata 0:763b80993db4 2803 return MEMS_ERROR;
cparata 0:763b80993db4 2804
cparata 0:763b80993db4 2805 value &= ~LSM6DSL_ACC_GYRO_USR_OFF_W_MASK;
cparata 0:763b80993db4 2806 value |= newValue;
cparata 0:763b80993db4 2807
cparata 0:763b80993db4 2808 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1) )
cparata 0:763b80993db4 2809 return MEMS_ERROR;
cparata 0:763b80993db4 2810
cparata 0:763b80993db4 2811 return MEMS_SUCCESS;
cparata 0:763b80993db4 2812 }
cparata 0:763b80993db4 2813
cparata 0:763b80993db4 2814 /*******************************************************************************
cparata 0:763b80993db4 2815 * Function Name : LSM6DSL_ACC_GYRO_R_UserOffsetWeight
cparata 0:763b80993db4 2816 * Description : Read USR_OFF_W
cparata 0:763b80993db4 2817 * Input : Pointer to LSM6DSL_ACC_GYRO_USR_OFF_W_t
cparata 0:763b80993db4 2818 * Output : Status of USR_OFF_W see LSM6DSL_ACC_GYRO_USR_OFF_W_t
cparata 0:763b80993db4 2819 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2820 *******************************************************************************/
cparata 0:763b80993db4 2821 status_t LSM6DSL_ACC_GYRO_R_UserOffsetWeight(void *handle, LSM6DSL_ACC_GYRO_USR_OFF_W_t *value)
cparata 0:763b80993db4 2822 {
cparata 0:763b80993db4 2823 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, (u8_t *)value, 1))
cparata 0:763b80993db4 2824 return MEMS_ERROR;
cparata 0:763b80993db4 2825
cparata 0:763b80993db4 2826 *value &= LSM6DSL_ACC_GYRO_USR_OFF_W_MASK; //mask
cparata 0:763b80993db4 2827
cparata 0:763b80993db4 2828 return MEMS_SUCCESS;
cparata 0:763b80993db4 2829 }
cparata 0:763b80993db4 2830
cparata 0:763b80993db4 2831 /*******************************************************************************
cparata 0:763b80993db4 2832 * Function Name : LSM6DSL_ACC_GYRO_W_LowPower_XL
cparata 0:763b80993db4 2833 * Description : Write LP_XL
cparata 0:763b80993db4 2834 * Input : LSM6DSL_ACC_GYRO_LP_XL_t
cparata 0:763b80993db4 2835 * Output : None
cparata 0:763b80993db4 2836 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2837 *******************************************************************************/
cparata 0:763b80993db4 2838 status_t LSM6DSL_ACC_GYRO_W_LowPower_XL(void *handle, LSM6DSL_ACC_GYRO_LP_XL_t newValue)
cparata 0:763b80993db4 2839 {
cparata 0:763b80993db4 2840 u8_t value;
cparata 0:763b80993db4 2841
cparata 0:763b80993db4 2842 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1))
cparata 0:763b80993db4 2843 return MEMS_ERROR;
cparata 0:763b80993db4 2844
cparata 0:763b80993db4 2845 value &= ~LSM6DSL_ACC_GYRO_LP_XL_MASK;
cparata 0:763b80993db4 2846 value |= newValue;
cparata 0:763b80993db4 2847
cparata 0:763b80993db4 2848 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1) )
cparata 0:763b80993db4 2849 return MEMS_ERROR;
cparata 0:763b80993db4 2850
cparata 0:763b80993db4 2851 return MEMS_SUCCESS;
cparata 0:763b80993db4 2852 }
cparata 0:763b80993db4 2853
cparata 0:763b80993db4 2854 /*******************************************************************************
cparata 0:763b80993db4 2855 * Function Name : LSM6DSL_ACC_GYRO_R_LowPower_XL
cparata 0:763b80993db4 2856 * Description : Read LP_XL
cparata 0:763b80993db4 2857 * Input : Pointer to LSM6DSL_ACC_GYRO_LP_XL_t
cparata 0:763b80993db4 2858 * Output : Status of LP_XL see LSM6DSL_ACC_GYRO_LP_XL_t
cparata 0:763b80993db4 2859 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2860 *******************************************************************************/
cparata 0:763b80993db4 2861 status_t LSM6DSL_ACC_GYRO_R_LowPower_XL(void *handle, LSM6DSL_ACC_GYRO_LP_XL_t *value)
cparata 0:763b80993db4 2862 {
cparata 0:763b80993db4 2863 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, (u8_t *)value, 1))
cparata 0:763b80993db4 2864 return MEMS_ERROR;
cparata 0:763b80993db4 2865
cparata 0:763b80993db4 2866 *value &= LSM6DSL_ACC_GYRO_LP_XL_MASK; //mask
cparata 0:763b80993db4 2867
cparata 0:763b80993db4 2868 return MEMS_SUCCESS;
cparata 0:763b80993db4 2869 }
cparata 0:763b80993db4 2870 /*******************************************************************************
cparata 0:763b80993db4 2871 * Function Name : LSM6DSL_ACC_GYRO_W_DEN_LVL2_EN
cparata 0:763b80993db4 2872 * Description : Write DEN_LVL2_EN
cparata 0:763b80993db4 2873 * Input : LSM6DSL_ACC_GYRO_DEN_LVL2_EN_t
cparata 0:763b80993db4 2874 * Output : None
cparata 0:763b80993db4 2875 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2876 *******************************************************************************/
cparata 0:763b80993db4 2877 status_t LSM6DSL_ACC_GYRO_W_DEN_LVL2_EN(void *handle, LSM6DSL_ACC_GYRO_DEN_LVL2_EN_t newValue)
cparata 0:763b80993db4 2878 {
cparata 0:763b80993db4 2879 u8_t value;
cparata 0:763b80993db4 2880
cparata 0:763b80993db4 2881 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1))
cparata 0:763b80993db4 2882 return MEMS_ERROR;
cparata 0:763b80993db4 2883
cparata 0:763b80993db4 2884 value &= ~LSM6DSL_ACC_GYRO_DEN_LVL2_EN_MASK;
cparata 0:763b80993db4 2885 value |= newValue;
cparata 0:763b80993db4 2886
cparata 0:763b80993db4 2887 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1) )
cparata 0:763b80993db4 2888 return MEMS_ERROR;
cparata 0:763b80993db4 2889
cparata 0:763b80993db4 2890 return MEMS_SUCCESS;
cparata 0:763b80993db4 2891 }
cparata 0:763b80993db4 2892
cparata 0:763b80993db4 2893 /*******************************************************************************
cparata 0:763b80993db4 2894 * Function Name : LSM6DSL_ACC_GYRO_R_DEN_LVL2_EN
cparata 0:763b80993db4 2895 * Description : Read DEN_LVL2_EN
cparata 0:763b80993db4 2896 * Input : Pointer to LSM6DSL_ACC_GYRO_DEN_LVL2_EN_t
cparata 0:763b80993db4 2897 * Output : Status of DEN_LVL2_EN see LSM6DSL_ACC_GYRO_DEN_LVL2_EN_t
cparata 0:763b80993db4 2898 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2899 *******************************************************************************/
cparata 0:763b80993db4 2900 status_t LSM6DSL_ACC_GYRO_R_DEN_LVL2_EN(void *handle, LSM6DSL_ACC_GYRO_DEN_LVL2_EN_t *value)
cparata 0:763b80993db4 2901 {
cparata 0:763b80993db4 2902 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, (u8_t *)value, 1))
cparata 0:763b80993db4 2903 return MEMS_ERROR;
cparata 0:763b80993db4 2904
cparata 0:763b80993db4 2905 *value &= LSM6DSL_ACC_GYRO_DEN_LVL2_EN_MASK; //mask
cparata 0:763b80993db4 2906
cparata 0:763b80993db4 2907 return MEMS_SUCCESS;
cparata 0:763b80993db4 2908 }
cparata 0:763b80993db4 2909 /*******************************************************************************
cparata 0:763b80993db4 2910 * Function Name : LSM6DSL_ACC_GYRO_W_DEN_LVL_EN
cparata 0:763b80993db4 2911 * Description : Write DEN_LVL_EN
cparata 0:763b80993db4 2912 * Input : LSM6DSL_ACC_GYRO_DEN_LVL_EN_t
cparata 0:763b80993db4 2913 * Output : None
cparata 0:763b80993db4 2914 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2915 *******************************************************************************/
cparata 0:763b80993db4 2916 status_t LSM6DSL_ACC_GYRO_W_DEN_LVL_EN(void *handle, LSM6DSL_ACC_GYRO_DEN_LVL_EN_t newValue)
cparata 0:763b80993db4 2917 {
cparata 0:763b80993db4 2918 u8_t value;
cparata 0:763b80993db4 2919
cparata 0:763b80993db4 2920 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1))
cparata 0:763b80993db4 2921 return MEMS_ERROR;
cparata 0:763b80993db4 2922
cparata 0:763b80993db4 2923 value &= ~LSM6DSL_ACC_GYRO_DEN_LVL_EN_MASK;
cparata 0:763b80993db4 2924 value |= newValue;
cparata 0:763b80993db4 2925
cparata 0:763b80993db4 2926 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1) )
cparata 0:763b80993db4 2927 return MEMS_ERROR;
cparata 0:763b80993db4 2928
cparata 0:763b80993db4 2929 return MEMS_SUCCESS;
cparata 0:763b80993db4 2930 }
cparata 0:763b80993db4 2931
cparata 0:763b80993db4 2932 /*******************************************************************************
cparata 0:763b80993db4 2933 * Function Name : LSM6DSL_ACC_GYRO_R_DEN_LVL_EN
cparata 0:763b80993db4 2934 * Description : Read DEN_LVL_EN
cparata 0:763b80993db4 2935 * Input : Pointer to LSM6DSL_ACC_GYRO_DEN_LVL_EN_t
cparata 0:763b80993db4 2936 * Output : Status of DEN_LVL_EN see LSM6DSL_ACC_GYRO_DEN_LVL_EN_t
cparata 0:763b80993db4 2937 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2938 *******************************************************************************/
cparata 0:763b80993db4 2939 status_t LSM6DSL_ACC_GYRO_R_DEN_LVL_EN(void *handle, LSM6DSL_ACC_GYRO_DEN_LVL_EN_t *value)
cparata 0:763b80993db4 2940 {
cparata 0:763b80993db4 2941 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, (u8_t *)value, 1) )
cparata 0:763b80993db4 2942 return MEMS_ERROR;
cparata 0:763b80993db4 2943
cparata 0:763b80993db4 2944 *value &= LSM6DSL_ACC_GYRO_DEN_LVL_EN_MASK; //mask
cparata 0:763b80993db4 2945
cparata 0:763b80993db4 2946 return MEMS_SUCCESS;
cparata 0:763b80993db4 2947 }
cparata 0:763b80993db4 2948 /*******************************************************************************
cparata 0:763b80993db4 2949 * Function Name : LSM6DSL_ACC_GYRO_W_ExternalTrigger
cparata 0:763b80993db4 2950 * Description : Write DEN_EDGE_EN
cparata 0:763b80993db4 2951 * Input : LSM6DSL_ACC_GYRO_DEN_EDGE_EN_t
cparata 0:763b80993db4 2952 * Output : None
cparata 0:763b80993db4 2953 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2954 *******************************************************************************/
cparata 0:763b80993db4 2955 status_t LSM6DSL_ACC_GYRO_W_ExternalTrigger(void *handle, LSM6DSL_ACC_GYRO_DEN_EDGE_EN_t newValue)
cparata 0:763b80993db4 2956 {
cparata 0:763b80993db4 2957 u8_t value;
cparata 0:763b80993db4 2958
cparata 0:763b80993db4 2959 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1) )
cparata 0:763b80993db4 2960 return MEMS_ERROR;
cparata 0:763b80993db4 2961
cparata 0:763b80993db4 2962 value &= ~LSM6DSL_ACC_GYRO_DEN_EDGE_EN_MASK;
cparata 0:763b80993db4 2963 value |= newValue;
cparata 0:763b80993db4 2964
cparata 0:763b80993db4 2965 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, &value, 1) )
cparata 0:763b80993db4 2966 return MEMS_ERROR;
cparata 0:763b80993db4 2967
cparata 0:763b80993db4 2968 return MEMS_SUCCESS;
cparata 0:763b80993db4 2969 }
cparata 0:763b80993db4 2970
cparata 0:763b80993db4 2971 /*******************************************************************************
cparata 0:763b80993db4 2972 * Function Name : LSM6DSL_ACC_GYRO_R_ExternalTrigger
cparata 0:763b80993db4 2973 * Description : Read DEN_EDGE_EN
cparata 0:763b80993db4 2974 * Input : Pointer to LSM6DSL_ACC_GYRO_DEN_EDGE_EN_t
cparata 0:763b80993db4 2975 * Output : Status of DEN_EDGE_EN see LSM6DSL_ACC_GYRO_DEN_EDGE_EN_t
cparata 0:763b80993db4 2976 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2977 *******************************************************************************/
cparata 0:763b80993db4 2978 status_t LSM6DSL_ACC_GYRO_R_ExternalTrigger(void *handle, LSM6DSL_ACC_GYRO_DEN_EDGE_EN_t *value)
cparata 0:763b80993db4 2979 {
cparata 0:763b80993db4 2980 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL6_G, (u8_t *)value, 1) )
cparata 0:763b80993db4 2981 return MEMS_ERROR;
cparata 0:763b80993db4 2982
cparata 0:763b80993db4 2983 *value &= LSM6DSL_ACC_GYRO_DEN_EDGE_EN_MASK; //mask
cparata 0:763b80993db4 2984
cparata 0:763b80993db4 2985 return MEMS_SUCCESS;
cparata 0:763b80993db4 2986 }
cparata 0:763b80993db4 2987
cparata 0:763b80993db4 2988 /*******************************************************************************
cparata 0:763b80993db4 2989 * Function Name : LSM6DSL_ACC_GYRO_W_HPM_G
cparata 0:763b80993db4 2990 * Description : Write HPM_G
cparata 0:763b80993db4 2991 * Input : LSM6DSL_ACC_GYRO_HPM_G_t
cparata 0:763b80993db4 2992 * Output : None
cparata 0:763b80993db4 2993 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 2994 *******************************************************************************/
cparata 0:763b80993db4 2995 status_t LSM6DSL_ACC_GYRO_W_HPM_G(void *handle, LSM6DSL_ACC_GYRO_HPM_G_t newValue)
cparata 0:763b80993db4 2996 {
cparata 0:763b80993db4 2997 u8_t value;
cparata 0:763b80993db4 2998
cparata 0:763b80993db4 2999 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:763b80993db4 3000 return MEMS_ERROR;
cparata 0:763b80993db4 3001
cparata 0:763b80993db4 3002 value &= ~LSM6DSL_ACC_GYRO_HPM_G_MASK;
cparata 0:763b80993db4 3003 value |= newValue;
cparata 0:763b80993db4 3004
cparata 0:763b80993db4 3005 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:763b80993db4 3006 return MEMS_ERROR;
cparata 0:763b80993db4 3007
cparata 0:763b80993db4 3008 return MEMS_SUCCESS;
cparata 0:763b80993db4 3009 }
cparata 0:763b80993db4 3010
cparata 0:763b80993db4 3011 /*******************************************************************************
cparata 0:763b80993db4 3012 * Function Name : LSM6DSL_ACC_GYRO_R_HPM_G
cparata 0:763b80993db4 3013 * Description : Read HPM_G
cparata 0:763b80993db4 3014 * Input : Pointer to LSM6DSL_ACC_GYRO_HPM_G_t
cparata 0:763b80993db4 3015 * Output : Status of HPM_G see LSM6DSL_ACC_GYRO_HPM_G_t
cparata 0:763b80993db4 3016 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3017 *******************************************************************************/
cparata 0:763b80993db4 3018 status_t LSM6DSL_ACC_GYRO_R_HPM_G(void *handle, LSM6DSL_ACC_GYRO_HPM_G_t *value)
cparata 0:763b80993db4 3019 {
cparata 0:763b80993db4 3020 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, (u8_t *)value, 1) )
cparata 0:763b80993db4 3021 return MEMS_ERROR;
cparata 0:763b80993db4 3022
cparata 0:763b80993db4 3023 *value &= LSM6DSL_ACC_GYRO_HPM_G_MASK; //mask
cparata 0:763b80993db4 3024
cparata 0:763b80993db4 3025 return MEMS_SUCCESS;
cparata 0:763b80993db4 3026 }
cparata 0:763b80993db4 3027
cparata 0:763b80993db4 3028 /*******************************************************************************
cparata 0:763b80993db4 3029 * Function Name : LSM6DSL_ACC_GYRO_W_RoundingOnStatusRegisters
cparata 0:763b80993db4 3030 * Description : Write HPM_G
cparata 0:763b80993db4 3031 * Input : LSM6DSL_ACC_GYRO_RND_STATUS_t
cparata 0:763b80993db4 3032 * Output : None
cparata 0:763b80993db4 3033 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3034 *******************************************************************************/
cparata 0:763b80993db4 3035 status_t LSM6DSL_ACC_GYRO_W_RoundingOnStatusRegisters(void *handle, LSM6DSL_ACC_GYRO_RND_STATUS_t newValue)
cparata 0:763b80993db4 3036 {
cparata 0:763b80993db4 3037 u8_t value;
cparata 0:763b80993db4 3038
cparata 0:763b80993db4 3039 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:763b80993db4 3040 return MEMS_ERROR;
cparata 0:763b80993db4 3041
cparata 0:763b80993db4 3042 value &= ~LSM6DSL_ACC_GYRO_RND_STATUS_MASK;
cparata 0:763b80993db4 3043 value |= newValue;
cparata 0:763b80993db4 3044
cparata 0:763b80993db4 3045 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:763b80993db4 3046 return MEMS_ERROR;
cparata 0:763b80993db4 3047
cparata 0:763b80993db4 3048 return MEMS_SUCCESS;
cparata 0:763b80993db4 3049 }
cparata 0:763b80993db4 3050
cparata 0:763b80993db4 3051 /*******************************************************************************
cparata 0:763b80993db4 3052 * Function Name : LSM6DSL_ACC_GYRO_R_RoundingOnStatusRegisters
cparata 0:763b80993db4 3053 * Description : Read HPM_G
cparata 0:763b80993db4 3054 * Input : Pointer to LSM6DSL_ACC_GYRO_RND_STATUS_t
cparata 0:763b80993db4 3055 * Output : Status of HPM_G see LSM6DSL_ACC_GYRO_RND_STATUS_t
cparata 0:763b80993db4 3056 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3057 *******************************************************************************/
cparata 0:763b80993db4 3058 status_t LSM6DSL_ACC_GYRO_R_RoundingOnStatusRegisters(void *handle, LSM6DSL_ACC_GYRO_RND_STATUS_t *value)
cparata 0:763b80993db4 3059 {
cparata 0:763b80993db4 3060 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, (u8_t *)value, 1))
cparata 0:763b80993db4 3061 return MEMS_ERROR;
cparata 0:763b80993db4 3062
cparata 0:763b80993db4 3063 *value &= LSM6DSL_ACC_GYRO_RND_STATUS_MASK; //mask
cparata 0:763b80993db4 3064
cparata 0:763b80993db4 3065 return MEMS_SUCCESS;
cparata 0:763b80993db4 3066 }
cparata 0:763b80993db4 3067
cparata 0:763b80993db4 3068 /*******************************************************************************
cparata 0:763b80993db4 3069 * Function Name : LSM6DSL_ACC_GYRO_W_HPFilter_En
cparata 0:763b80993db4 3070 * Description : Write HP_EN
cparata 0:763b80993db4 3071 * Input : LSM6DSL_ACC_GYRO_HP_EN_t
cparata 0:763b80993db4 3072 * Output : None
cparata 0:763b80993db4 3073 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3074 *******************************************************************************/
cparata 0:763b80993db4 3075 status_t LSM6DSL_ACC_GYRO_W_HPFilter_En(void *handle, LSM6DSL_ACC_GYRO_HP_EN_t newValue)
cparata 0:763b80993db4 3076 {
cparata 0:763b80993db4 3077 u8_t value;
cparata 0:763b80993db4 3078
cparata 0:763b80993db4 3079 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:763b80993db4 3080 return MEMS_ERROR;
cparata 0:763b80993db4 3081
cparata 0:763b80993db4 3082 value &= ~LSM6DSL_ACC_GYRO_HP_EN_MASK;
cparata 0:763b80993db4 3083 value |= newValue;
cparata 0:763b80993db4 3084
cparata 0:763b80993db4 3085 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:763b80993db4 3086 return MEMS_ERROR;
cparata 0:763b80993db4 3087
cparata 0:763b80993db4 3088 return MEMS_SUCCESS;
cparata 0:763b80993db4 3089 }
cparata 0:763b80993db4 3090
cparata 0:763b80993db4 3091 /*******************************************************************************
cparata 0:763b80993db4 3092 * Function Name : LSM6DSL_ACC_GYRO_R_HPFilter_En
cparata 0:763b80993db4 3093 * Description : Read HP_EN
cparata 0:763b80993db4 3094 * Input : Pointer to LSM6DSL_ACC_GYRO_HP_EN_t
cparata 0:763b80993db4 3095 * Output : Status of HP_EN see LSM6DSL_ACC_GYRO_HP_EN_t
cparata 0:763b80993db4 3096 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3097 *******************************************************************************/
cparata 0:763b80993db4 3098 status_t LSM6DSL_ACC_GYRO_R_HPFilter_En(void *handle, LSM6DSL_ACC_GYRO_HP_EN_t *value)
cparata 0:763b80993db4 3099 {
cparata 0:763b80993db4 3100 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, (u8_t *)value, 1) )
cparata 0:763b80993db4 3101 return MEMS_ERROR;
cparata 0:763b80993db4 3102
cparata 0:763b80993db4 3103 *value &= LSM6DSL_ACC_GYRO_HP_EN_MASK; //mask
cparata 0:763b80993db4 3104
cparata 0:763b80993db4 3105 return MEMS_SUCCESS;
cparata 0:763b80993db4 3106 }
cparata 0:763b80993db4 3107 /*******************************************************************************
cparata 0:763b80993db4 3108 * Function Name : LSM6DSL_ACC_GYRO_W_LP_Mode
cparata 0:763b80993db4 3109 * Description : Write LP_EN
cparata 0:763b80993db4 3110 * Input : LSM6DSL_ACC_GYRO_LP_EN_t
cparata 0:763b80993db4 3111 * Output : None
cparata 0:763b80993db4 3112 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3113 *******************************************************************************/
cparata 0:763b80993db4 3114 status_t LSM6DSL_ACC_GYRO_W_LP_Mode(void *handle, LSM6DSL_ACC_GYRO_LP_EN_t newValue)
cparata 0:763b80993db4 3115 {
cparata 0:763b80993db4 3116 u8_t value;
cparata 0:763b80993db4 3117
cparata 0:763b80993db4 3118 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:763b80993db4 3119 return MEMS_ERROR;
cparata 0:763b80993db4 3120
cparata 0:763b80993db4 3121 value &= ~LSM6DSL_ACC_GYRO_LP_EN_MASK;
cparata 0:763b80993db4 3122 value |= newValue;
cparata 0:763b80993db4 3123
cparata 0:763b80993db4 3124 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:763b80993db4 3125 return MEMS_ERROR;
cparata 0:763b80993db4 3126
cparata 0:763b80993db4 3127 return MEMS_SUCCESS;
cparata 0:763b80993db4 3128 }
cparata 0:763b80993db4 3129
cparata 0:763b80993db4 3130 /*******************************************************************************
cparata 0:763b80993db4 3131 * Function Name : LSM6DSL_ACC_GYRO_R_LP_Mode
cparata 0:763b80993db4 3132 * Description : Read LP_EN
cparata 0:763b80993db4 3133 * Input : Pointer to LSM6DSL_ACC_GYRO_LP_EN_t
cparata 0:763b80993db4 3134 * Output : Status of LP_EN see LSM6DSL_ACC_GYRO_LP_EN_t
cparata 0:763b80993db4 3135 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3136 *******************************************************************************/
cparata 0:763b80993db4 3137 status_t LSM6DSL_ACC_GYRO_R_LP_Mode(void *handle, LSM6DSL_ACC_GYRO_LP_EN_t *value)
cparata 0:763b80993db4 3138 {
cparata 0:763b80993db4 3139 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, (u8_t *)value, 1) )
cparata 0:763b80993db4 3140 return MEMS_ERROR;
cparata 0:763b80993db4 3141
cparata 0:763b80993db4 3142 *value &= LSM6DSL_ACC_GYRO_LP_EN_MASK; //mask
cparata 0:763b80993db4 3143
cparata 0:763b80993db4 3144 return MEMS_SUCCESS;
cparata 0:763b80993db4 3145 }
cparata 0:763b80993db4 3146
cparata 0:763b80993db4 3147 /*******************************************************************************
cparata 0:763b80993db4 3148 * Function Name : LSM6DSL_ACC_GYRO_W_ROUNDING_STATUS
cparata 0:763b80993db4 3149 * Description : Write ROUNDING_STATUS
cparata 0:763b80993db4 3150 * Input : LSM6DSL_ACC_GYRO_ROUNDING_STATUS_t
cparata 0:763b80993db4 3151 * Output : None
cparata 0:763b80993db4 3152 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3153 *******************************************************************************/
cparata 0:763b80993db4 3154 status_t LSM6DSL_ACC_GYRO_W_ROUNDING_STATUS(void *handle, LSM6DSL_ACC_GYRO_ROUNDING_STATUS_t newValue)
cparata 0:763b80993db4 3155 {
cparata 0:763b80993db4 3156 u8_t value;
cparata 0:763b80993db4 3157
cparata 0:763b80993db4 3158 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:763b80993db4 3159 return MEMS_ERROR;
cparata 0:763b80993db4 3160
cparata 0:763b80993db4 3161 value &= ~LSM6DSL_ACC_GYRO_ROUNDING_STATUS_MASK;
cparata 0:763b80993db4 3162 value |= newValue;
cparata 0:763b80993db4 3163
cparata 0:763b80993db4 3164 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:763b80993db4 3165 return MEMS_ERROR;
cparata 0:763b80993db4 3166
cparata 0:763b80993db4 3167 return MEMS_SUCCESS;
cparata 0:763b80993db4 3168 }
cparata 0:763b80993db4 3169
cparata 0:763b80993db4 3170 /*******************************************************************************
cparata 0:763b80993db4 3171 * Function Name : LSM6DSL_ACC_GYRO_R_ROUNDING_STATUS
cparata 0:763b80993db4 3172 * Description : Read ROUNDING_STATUS
cparata 0:763b80993db4 3173 * Input : Pointer to LSM6DSL_ACC_GYRO_ROUNDING_STATUS_t
cparata 0:763b80993db4 3174 * Output : Status of ROUNDING_STATUS see LSM6DSL_ACC_GYRO_ROUNDING_STATUS_t
cparata 0:763b80993db4 3175 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3176 *******************************************************************************/
cparata 0:763b80993db4 3177 status_t LSM6DSL_ACC_GYRO_R_ROUNDING_STATUS(void *handle, LSM6DSL_ACC_GYRO_ROUNDING_STATUS_t *value)
cparata 0:763b80993db4 3178 {
cparata 0:763b80993db4 3179 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, (u8_t *)value, 1) )
cparata 0:763b80993db4 3180 return MEMS_ERROR;
cparata 0:763b80993db4 3181
cparata 0:763b80993db4 3182 *value &= LSM6DSL_ACC_GYRO_ROUNDING_STATUS_MASK; //mask
cparata 0:763b80993db4 3183
cparata 0:763b80993db4 3184 return MEMS_SUCCESS;
cparata 0:763b80993db4 3185 }
cparata 0:763b80993db4 3186
cparata 0:763b80993db4 3187 /*******************************************************************************
cparata 0:763b80993db4 3188 * Function Name : LSM6DSL_ACC_GYRO_W_HP_G_RST
cparata 0:763b80993db4 3189 * Description : Write HP_G_RST
cparata 0:763b80993db4 3190 * Input : LSM6DSL_ACC_GYRO_HP_G_RST_t
cparata 0:763b80993db4 3191 * Output : None
cparata 0:763b80993db4 3192 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3193 *******************************************************************************/
cparata 0:763b80993db4 3194 status_t LSM6DSL_ACC_GYRO_W_HP_G_RST(void *handle, LSM6DSL_ACC_GYRO_HP_G_RST_t newValue)
cparata 0:763b80993db4 3195 {
cparata 0:763b80993db4 3196 u8_t value;
cparata 0:763b80993db4 3197
cparata 0:763b80993db4 3198 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:763b80993db4 3199 return MEMS_ERROR;
cparata 0:763b80993db4 3200
cparata 0:763b80993db4 3201 value &= ~LSM6DSL_ACC_GYRO_HP_G_RST_MASK;
cparata 0:763b80993db4 3202 value |= newValue;
cparata 0:763b80993db4 3203
cparata 0:763b80993db4 3204 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, &value, 1) )
cparata 0:763b80993db4 3205 return MEMS_ERROR;
cparata 0:763b80993db4 3206
cparata 0:763b80993db4 3207 return MEMS_SUCCESS;
cparata 0:763b80993db4 3208 }
cparata 0:763b80993db4 3209
cparata 0:763b80993db4 3210 /*******************************************************************************
cparata 0:763b80993db4 3211 * Function Name : LSM6DSL_ACC_GYRO_R_HP_G_RST
cparata 0:763b80993db4 3212 * Description : Read HP_G_RST
cparata 0:763b80993db4 3213 * Input : Pointer to LSM6DSL_ACC_GYRO_HP_G_RST_t
cparata 0:763b80993db4 3214 * Output : Status of HP_G_RST see LSM6DSL_ACC_GYRO_HP_G_RST_t
cparata 0:763b80993db4 3215 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3216 *******************************************************************************/
cparata 0:763b80993db4 3217 status_t LSM6DSL_ACC_GYRO_R_HP_G_RST(void *handle, LSM6DSL_ACC_GYRO_HP_G_RST_t *value)
cparata 0:763b80993db4 3218 {
cparata 0:763b80993db4 3219 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL7_G, (u8_t *)value, 1) )
cparata 0:763b80993db4 3220 return MEMS_ERROR;
cparata 0:763b80993db4 3221
cparata 0:763b80993db4 3222 *value &= LSM6DSL_ACC_GYRO_HP_G_RST_MASK; //mask
cparata 0:763b80993db4 3223
cparata 0:763b80993db4 3224 return MEMS_SUCCESS;
cparata 0:763b80993db4 3225 }
cparata 0:763b80993db4 3226
cparata 0:763b80993db4 3227 /*******************************************************************************
cparata 0:763b80993db4 3228 * Function Name : LSM6DSL_ACC_GYRO_W_InComposit
cparata 0:763b80993db4 3229 * Description : Write INPUT_COMPOSITE
cparata 0:763b80993db4 3230 * Input : LSM6DSL_ACC_GYRO_IN_COMP_t
cparata 0:763b80993db4 3231 * Output : None
cparata 0:763b80993db4 3232 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3233 *******************************************************************************/
cparata 0:763b80993db4 3234 status_t LSM6DSL_ACC_GYRO_W_InComposit(void *handle, LSM6DSL_ACC_GYRO_IN_COMP_t newValue)
cparata 0:763b80993db4 3235 {
cparata 0:763b80993db4 3236 u8_t value;
cparata 0:763b80993db4 3237
cparata 0:763b80993db4 3238 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:763b80993db4 3239 return MEMS_ERROR;
cparata 0:763b80993db4 3240
cparata 0:763b80993db4 3241 value &= ~LSM6DSL_ACC_GYRO_IN_COMP_MASK;
cparata 0:763b80993db4 3242 value |= newValue;
cparata 0:763b80993db4 3243
cparata 0:763b80993db4 3244 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:763b80993db4 3245 return MEMS_ERROR;
cparata 0:763b80993db4 3246
cparata 0:763b80993db4 3247 return MEMS_SUCCESS;
cparata 0:763b80993db4 3248 }
cparata 0:763b80993db4 3249
cparata 0:763b80993db4 3250 /*******************************************************************************
cparata 0:763b80993db4 3251 * Function Name : LSM6DSL_ACC_GYRO_R_InComposit
cparata 0:763b80993db4 3252 * Description : Read INPUT_COMPOSITE
cparata 0:763b80993db4 3253 * Input : Pointer to LSM6DSL_ACC_GYRO_IN_COMP_t
cparata 0:763b80993db4 3254 * Output : Status of INPUT_COMPOSITE see LSM6DSL_ACC_GYRO_IN_COMP_t
cparata 0:763b80993db4 3255 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3256 *******************************************************************************/
cparata 0:763b80993db4 3257 status_t LSM6DSL_ACC_GYRO_R_InComposit(void *handle, LSM6DSL_ACC_GYRO_IN_COMP_t *value)
cparata 0:763b80993db4 3258 {
cparata 0:763b80993db4 3259 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, (u8_t *)value, 1) )
cparata 0:763b80993db4 3260 return MEMS_ERROR;
cparata 0:763b80993db4 3261
cparata 0:763b80993db4 3262 *value &= LSM6DSL_ACC_GYRO_IN_COMP_MASK; //mask
cparata 0:763b80993db4 3263
cparata 0:763b80993db4 3264 return MEMS_SUCCESS;
cparata 0:763b80993db4 3265 }
cparata 0:763b80993db4 3266
cparata 0:763b80993db4 3267 /*******************************************************************************
cparata 0:763b80993db4 3268 * Function Name : LSM6DSL_ACC_GYRO_W_HPfilterReference
cparata 0:763b80993db4 3269 * Description : Write HP_REF_MODE
cparata 0:763b80993db4 3270 * Input : LSM6DSL_ACC_GYRO_HP_REF_MODE_t
cparata 0:763b80993db4 3271 * Output : None
cparata 0:763b80993db4 3272 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3273 *******************************************************************************/
cparata 0:763b80993db4 3274 status_t LSM6DSL_ACC_GYRO_W_HPfilterReference(void *handle, LSM6DSL_ACC_GYRO_HP_REF_MODE_t newValue)
cparata 0:763b80993db4 3275 {
cparata 0:763b80993db4 3276 u8_t value;
cparata 0:763b80993db4 3277
cparata 0:763b80993db4 3278 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:763b80993db4 3279 return MEMS_ERROR;
cparata 0:763b80993db4 3280
cparata 0:763b80993db4 3281 value &= ~LSM6DSL_ACC_GYRO_HP_REF_MODE_MASK;
cparata 0:763b80993db4 3282 value |= newValue;
cparata 0:763b80993db4 3283
cparata 0:763b80993db4 3284 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:763b80993db4 3285 return MEMS_ERROR;
cparata 0:763b80993db4 3286
cparata 0:763b80993db4 3287 return MEMS_SUCCESS;
cparata 0:763b80993db4 3288 }
cparata 0:763b80993db4 3289
cparata 0:763b80993db4 3290 /*******************************************************************************
cparata 0:763b80993db4 3291 * Function Name : LSM6DSL_ACC_GYRO_R_HPfilterReference
cparata 0:763b80993db4 3292 * Description : Read HP_REF_MODE
cparata 0:763b80993db4 3293 * Input : Pointer to LSM6DSL_ACC_GYRO_HP_REF_MODE_t
cparata 0:763b80993db4 3294 * Output : Status of HP_REF_MODE see LSM6DSL_ACC_GYRO_HP_REF_MODE_t
cparata 0:763b80993db4 3295 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3296 *******************************************************************************/
cparata 0:763b80993db4 3297 status_t LSM6DSL_ACC_GYRO_R_HPfilterReference(void *handle, LSM6DSL_ACC_GYRO_HP_REF_MODE_t *value)
cparata 0:763b80993db4 3298 {
cparata 0:763b80993db4 3299 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, (u8_t *)value, 1) )
cparata 0:763b80993db4 3300 return MEMS_ERROR;
cparata 0:763b80993db4 3301
cparata 0:763b80993db4 3302 *value &= LSM6DSL_ACC_GYRO_HP_REF_MODE_MASK; //mask
cparata 0:763b80993db4 3303
cparata 0:763b80993db4 3304 return MEMS_SUCCESS;
cparata 0:763b80993db4 3305 }
cparata 0:763b80993db4 3306
cparata 0:763b80993db4 3307 /*******************************************************************************
cparata 0:763b80993db4 3308 * Function Name : LSM6DSL_ACC_GYRO_W_HPCF_XL
cparata 0:763b80993db4 3309 * Description : Write HPCF_XL
cparata 0:763b80993db4 3310 * Input : LSM6DSL_ACC_GYRO_HPCF_XL_t
cparata 0:763b80993db4 3311 * Output : None
cparata 0:763b80993db4 3312 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3313 *******************************************************************************/
cparata 0:763b80993db4 3314 status_t LSM6DSL_ACC_GYRO_W_HPCF_XL(void *handle, LSM6DSL_ACC_GYRO_HPCF_XL_t newValue)
cparata 0:763b80993db4 3315 {
cparata 0:763b80993db4 3316 u8_t value;
cparata 0:763b80993db4 3317
cparata 0:763b80993db4 3318 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:763b80993db4 3319 return MEMS_ERROR;
cparata 0:763b80993db4 3320
cparata 0:763b80993db4 3321 value &= ~LSM6DSL_ACC_GYRO_HPCF_XL_MASK;
cparata 0:763b80993db4 3322 value |= newValue;
cparata 0:763b80993db4 3323
cparata 0:763b80993db4 3324 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:763b80993db4 3325 return MEMS_ERROR;
cparata 0:763b80993db4 3326
cparata 0:763b80993db4 3327 return MEMS_SUCCESS;
cparata 0:763b80993db4 3328 }
cparata 0:763b80993db4 3329
cparata 0:763b80993db4 3330 /*******************************************************************************
cparata 0:763b80993db4 3331 * Function Name : LSM6DSL_ACC_GYRO_R_HPCF_XL
cparata 0:763b80993db4 3332 * Description : Read HPCF_XL
cparata 0:763b80993db4 3333 * Input : Pointer to LSM6DSL_ACC_GYRO_HPCF_XL_t
cparata 0:763b80993db4 3334 * Output : Status of HPCF_XL see LSM6DSL_ACC_GYRO_HPCF_XL_t
cparata 0:763b80993db4 3335 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3336 *******************************************************************************/
cparata 0:763b80993db4 3337 status_t LSM6DSL_ACC_GYRO_R_HPCF_XL(void *handle, LSM6DSL_ACC_GYRO_HPCF_XL_t *value)
cparata 0:763b80993db4 3338 {
cparata 0:763b80993db4 3339 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, (u8_t *)value, 1) )
cparata 0:763b80993db4 3340 return MEMS_ERROR;
cparata 0:763b80993db4 3341
cparata 0:763b80993db4 3342 *value &= LSM6DSL_ACC_GYRO_HPCF_XL_MASK; //mask
cparata 0:763b80993db4 3343
cparata 0:763b80993db4 3344 return MEMS_SUCCESS;
cparata 0:763b80993db4 3345 }
cparata 0:763b80993db4 3346
cparata 0:763b80993db4 3347 /*******************************************************************************
cparata 0:763b80993db4 3348 * Function Name : LSM6DSL_ACC_GYRO_W_LowPassFiltSel_XL
cparata 0:763b80993db4 3349 * Description : Write LPF2_XL_EN
cparata 0:763b80993db4 3350 * Input : LSM6DSL_ACC_GYRO_LPF2_XL_t
cparata 0:763b80993db4 3351 * Output : None
cparata 0:763b80993db4 3352 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3353 *******************************************************************************/
cparata 0:763b80993db4 3354 status_t LSM6DSL_ACC_GYRO_W_LowPassFiltSel_XL(void *handle, LSM6DSL_ACC_GYRO_LPF2_XL_t newValue)
cparata 0:763b80993db4 3355 {
cparata 0:763b80993db4 3356 u8_t value;
cparata 0:763b80993db4 3357
cparata 0:763b80993db4 3358 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:763b80993db4 3359 return MEMS_ERROR;
cparata 0:763b80993db4 3360
cparata 0:763b80993db4 3361 value &= ~LSM6DSL_ACC_GYRO_LPF2_XL_MASK;
cparata 0:763b80993db4 3362 value |= newValue;
cparata 0:763b80993db4 3363
cparata 0:763b80993db4 3364 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:763b80993db4 3365 return MEMS_ERROR;
cparata 0:763b80993db4 3366
cparata 0:763b80993db4 3367 return MEMS_SUCCESS;
cparata 0:763b80993db4 3368 }
cparata 0:763b80993db4 3369
cparata 0:763b80993db4 3370 /*******************************************************************************
cparata 0:763b80993db4 3371 * Function Name : LSM6DSL_ACC_GYRO_R_LowPassFiltSel_XL
cparata 0:763b80993db4 3372 * Description : Read LPF2_XL_EN
cparata 0:763b80993db4 3373 * Input : Pointer to LSM6DSL_ACC_GYRO_LPF2_XL_t
cparata 0:763b80993db4 3374 * Output : Status of LPF2_XL_EN see LSM6DSL_ACC_GYRO_LPF2_XL_t
cparata 0:763b80993db4 3375 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3376 *******************************************************************************/
cparata 0:763b80993db4 3377 status_t LSM6DSL_ACC_GYRO_R_LowPassFiltSel_XL(void *handle, LSM6DSL_ACC_GYRO_LPF2_XL_t *value)
cparata 0:763b80993db4 3378 {
cparata 0:763b80993db4 3379 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, (u8_t *)value, 1) )
cparata 0:763b80993db4 3380 return MEMS_ERROR;
cparata 0:763b80993db4 3381
cparata 0:763b80993db4 3382 *value &= LSM6DSL_ACC_GYRO_LPF2_XL_MASK; //mask
cparata 0:763b80993db4 3383
cparata 0:763b80993db4 3384 return MEMS_SUCCESS;
cparata 0:763b80993db4 3385 }
cparata 0:763b80993db4 3386
cparata 0:763b80993db4 3387 /*******************************************************************************
cparata 0:763b80993db4 3388 * Function Name : LSM6DSL_ACC_GYRO_W_LOW_PASS_ON_6D
cparata 0:763b80993db4 3389 * Description : Write LOW_PASS_ON_6D
cparata 0:763b80993db4 3390 * Input : LSM6DSL_ACC_GYRO_LOW_PASS_ON_6D_t
cparata 0:763b80993db4 3391 * Output : None
cparata 0:763b80993db4 3392 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3393 *******************************************************************************/
cparata 0:763b80993db4 3394 status_t LSM6DSL_ACC_GYRO_W_LOW_PASS_ON_6D(void *handle, LSM6DSL_ACC_GYRO_LOW_PASS_ON_6D_t newValue)
cparata 0:763b80993db4 3395 {
cparata 0:763b80993db4 3396 u8_t value;
cparata 0:763b80993db4 3397
cparata 0:763b80993db4 3398 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:763b80993db4 3399 return MEMS_ERROR;
cparata 0:763b80993db4 3400
cparata 0:763b80993db4 3401 value &= ~LSM6DSL_ACC_GYRO_LOW_PASS_ON_6D_MASK;
cparata 0:763b80993db4 3402 value |= newValue;
cparata 0:763b80993db4 3403
cparata 0:763b80993db4 3404 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:763b80993db4 3405 return MEMS_ERROR;
cparata 0:763b80993db4 3406
cparata 0:763b80993db4 3407 return MEMS_SUCCESS;
cparata 0:763b80993db4 3408 }
cparata 0:763b80993db4 3409
cparata 0:763b80993db4 3410 /*******************************************************************************
cparata 0:763b80993db4 3411 * Function Name : LSM6DSL_ACC_GYRO_R_LOW_PASS_ON_6D
cparata 0:763b80993db4 3412 * Description : Read LOW_PASS_ON_6D
cparata 0:763b80993db4 3413 * Input : Pointer to LSM6DSL_ACC_GYRO_LOW_PASS_ON_6D_t
cparata 0:763b80993db4 3414 * Output : Status of LOW_PASS_ON_6D see LSM6DSL_ACC_GYRO_LOW_PASS_ON_6D_t
cparata 0:763b80993db4 3415 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3416 *******************************************************************************/
cparata 0:763b80993db4 3417 status_t LSM6DSL_ACC_GYRO_R_LOW_PASS_ON_6D(void *handle, LSM6DSL_ACC_GYRO_LOW_PASS_ON_6D_t *value)
cparata 0:763b80993db4 3418 {
cparata 0:763b80993db4 3419 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, (u8_t *)value, 1) )
cparata 0:763b80993db4 3420 return MEMS_ERROR;
cparata 0:763b80993db4 3421
cparata 0:763b80993db4 3422 *value &= LSM6DSL_ACC_GYRO_LOW_PASS_ON_6D_MASK; //mask
cparata 0:763b80993db4 3423
cparata 0:763b80993db4 3424 return MEMS_SUCCESS;
cparata 0:763b80993db4 3425 }
cparata 0:763b80993db4 3426
cparata 0:763b80993db4 3427 /*******************************************************************************
cparata 0:763b80993db4 3428 * Function Name : LSM6DSL_ACC_GYRO_W_HP_SLOPE_XL
cparata 0:763b80993db4 3429 * Description : Write HP_SLOPE_XL_EN
cparata 0:763b80993db4 3430 * Input : LSM6DSL_ACC_GYRO_HP_SLOPE_XL_t
cparata 0:763b80993db4 3431 * Output : None
cparata 0:763b80993db4 3432 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3433 *******************************************************************************/
cparata 0:763b80993db4 3434 status_t LSM6DSL_ACC_GYRO_W_HP_SLOPE_XL(void *handle, LSM6DSL_ACC_GYRO_HP_SLOPE_XL_t newValue)
cparata 0:763b80993db4 3435 {
cparata 0:763b80993db4 3436 u8_t value;
cparata 0:763b80993db4 3437
cparata 0:763b80993db4 3438 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:763b80993db4 3439 return MEMS_ERROR;
cparata 0:763b80993db4 3440
cparata 0:763b80993db4 3441 value &= ~LSM6DSL_ACC_GYRO_HP_SLOPE_XL_MASK;
cparata 0:763b80993db4 3442 value |= newValue;
cparata 0:763b80993db4 3443
cparata 0:763b80993db4 3444 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, &value, 1) )
cparata 0:763b80993db4 3445 return MEMS_ERROR;
cparata 0:763b80993db4 3446
cparata 0:763b80993db4 3447 return MEMS_SUCCESS;
cparata 0:763b80993db4 3448 }
cparata 0:763b80993db4 3449
cparata 0:763b80993db4 3450 /*******************************************************************************
cparata 0:763b80993db4 3451 * Function Name : LSM6DSL_ACC_GYRO_R_HP_SLOPE_XL
cparata 0:763b80993db4 3452 * Description : Read HP_SLOPE_XL_EN
cparata 0:763b80993db4 3453 * Input : Pointer to LSM6DSL_ACC_GYRO_HP_SLOPE_XL_t
cparata 0:763b80993db4 3454 * Output : Status of HP_SLOPE_XL_EN see LSM6DSL_ACC_GYRO_HP_SLOPE_XL_t
cparata 0:763b80993db4 3455 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3456 *******************************************************************************/
cparata 0:763b80993db4 3457 status_t LSM6DSL_ACC_GYRO_R_HP_SLOPE_XL(void *handle, LSM6DSL_ACC_GYRO_HP_SLOPE_XL_t *value)
cparata 0:763b80993db4 3458 {
cparata 0:763b80993db4 3459 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL8_XL, (u8_t *)value, 1) )
cparata 0:763b80993db4 3460 return MEMS_ERROR;
cparata 0:763b80993db4 3461
cparata 0:763b80993db4 3462 *value &= LSM6DSL_ACC_GYRO_HP_SLOPE_XL_MASK; //mask
cparata 0:763b80993db4 3463
cparata 0:763b80993db4 3464 return MEMS_SUCCESS;
cparata 0:763b80993db4 3465 }
cparata 0:763b80993db4 3466
cparata 0:763b80993db4 3467 /*******************************************************************************
cparata 0:763b80993db4 3468 * Function Name : LSM6DSL_ACC_GYRO_W_SOFT
cparata 0:763b80993db4 3469 * Description : Write SOFT_EN
cparata 0:763b80993db4 3470 * Input : LSM6DSL_ACC_GYRO_SOFT_t
cparata 0:763b80993db4 3471 * Output : None
cparata 0:763b80993db4 3472 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3473 *******************************************************************************/
cparata 0:763b80993db4 3474 status_t LSM6DSL_ACC_GYRO_W_SOFT(void *handle, LSM6DSL_ACC_GYRO_SOFT_t newValue)
cparata 0:763b80993db4 3475 {
cparata 0:763b80993db4 3476 u8_t value;
cparata 0:763b80993db4 3477
cparata 0:763b80993db4 3478 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL9_XL, &value, 1) )
cparata 0:763b80993db4 3479 return MEMS_ERROR;
cparata 0:763b80993db4 3480
cparata 0:763b80993db4 3481 value &= ~LSM6DSL_ACC_GYRO_SOFT_MASK;
cparata 0:763b80993db4 3482 value |= newValue;
cparata 0:763b80993db4 3483
cparata 0:763b80993db4 3484 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL9_XL, &value, 1) )
cparata 0:763b80993db4 3485 return MEMS_ERROR;
cparata 0:763b80993db4 3486
cparata 0:763b80993db4 3487 return MEMS_SUCCESS;
cparata 0:763b80993db4 3488 }
cparata 0:763b80993db4 3489
cparata 0:763b80993db4 3490 /*******************************************************************************
cparata 0:763b80993db4 3491 * Function Name : LSM6DSL_ACC_GYRO_R_SOFT
cparata 0:763b80993db4 3492 * Description : Read SOFT_EN
cparata 0:763b80993db4 3493 * Input : Pointer to LSM6DSL_ACC_GYRO_SOFT_t
cparata 0:763b80993db4 3494 * Output : Status of SOFT_EN see LSM6DSL_ACC_GYRO_SOFT_t
cparata 0:763b80993db4 3495 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3496 *******************************************************************************/
cparata 0:763b80993db4 3497 status_t LSM6DSL_ACC_GYRO_R_SOFT(void *handle, LSM6DSL_ACC_GYRO_SOFT_t *value)
cparata 0:763b80993db4 3498 {
cparata 0:763b80993db4 3499 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL9_XL, (u8_t *)value, 1) )
cparata 0:763b80993db4 3500 return MEMS_ERROR;
cparata 0:763b80993db4 3501
cparata 0:763b80993db4 3502 *value &= LSM6DSL_ACC_GYRO_SOFT_MASK; //mask
cparata 0:763b80993db4 3503
cparata 0:763b80993db4 3504 return MEMS_SUCCESS;
cparata 0:763b80993db4 3505 }
cparata 0:763b80993db4 3506
cparata 0:763b80993db4 3507 /*******************************************************************************
cparata 0:763b80993db4 3508 * Function Name : LSM6DSL_ACC_GYRO_W_SignifcantMotion
cparata 0:763b80993db4 3509 * Description : Write SIGN_MOTION_EN
cparata 0:763b80993db4 3510 * Input : LSM6DSL_ACC_GYRO_SIGN_MOTION_EN_t
cparata 0:763b80993db4 3511 * Output : None
cparata 0:763b80993db4 3512 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3513 *******************************************************************************/
cparata 0:763b80993db4 3514 status_t LSM6DSL_ACC_GYRO_W_SignifcantMotion(void *handle, LSM6DSL_ACC_GYRO_SIGN_MOTION_EN_t newValue)
cparata 0:763b80993db4 3515 {
cparata 0:763b80993db4 3516 u8_t value;
cparata 0:763b80993db4 3517
cparata 0:763b80993db4 3518 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:763b80993db4 3519 return MEMS_ERROR;
cparata 0:763b80993db4 3520
cparata 0:763b80993db4 3521 value &= ~LSM6DSL_ACC_GYRO_SIGN_MOTION_EN_MASK;
cparata 0:763b80993db4 3522 value |= newValue;
cparata 0:763b80993db4 3523
cparata 0:763b80993db4 3524 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:763b80993db4 3525 return MEMS_ERROR;
cparata 0:763b80993db4 3526
cparata 0:763b80993db4 3527 return MEMS_SUCCESS;
cparata 0:763b80993db4 3528 }
cparata 0:763b80993db4 3529
cparata 0:763b80993db4 3530 /*******************************************************************************
cparata 0:763b80993db4 3531 * Function Name : LSM6DSL_ACC_GYRO_R_SignifcantMotion
cparata 0:763b80993db4 3532 * Description : Read SIGN_MOTION_EN
cparata 0:763b80993db4 3533 * Input : Pointer to LSM6DSL_ACC_GYRO_SIGN_MOTION_EN_t
cparata 0:763b80993db4 3534 * Output : Status of SIGN_MOTION_EN see LSM6DSL_ACC_GYRO_SIGN_MOTION_EN_t
cparata 0:763b80993db4 3535 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3536 *******************************************************************************/
cparata 0:763b80993db4 3537 status_t LSM6DSL_ACC_GYRO_R_SignifcantMotion(void *handle, LSM6DSL_ACC_GYRO_SIGN_MOTION_EN_t *value)
cparata 0:763b80993db4 3538 {
cparata 0:763b80993db4 3539 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, (u8_t *)value, 1) )
cparata 0:763b80993db4 3540 return MEMS_ERROR;
cparata 0:763b80993db4 3541
cparata 0:763b80993db4 3542 *value &= LSM6DSL_ACC_GYRO_SIGN_MOTION_EN_MASK; //mask
cparata 0:763b80993db4 3543
cparata 0:763b80993db4 3544 return MEMS_SUCCESS;
cparata 0:763b80993db4 3545 }
cparata 0:763b80993db4 3546 /*******************************************************************************
cparata 0:763b80993db4 3547 * Function Name : LSM6DSL_ACC_GYRO_W_PedoStepReset
cparata 0:763b80993db4 3548 * Description : Write PEDO_RST_STEP
cparata 0:763b80993db4 3549 * Input : LSM6DSL_ACC_GYRO_PEDO_RST_STEP_t
cparata 0:763b80993db4 3550 * Output : None
cparata 0:763b80993db4 3551 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3552 *******************************************************************************/
cparata 0:763b80993db4 3553 status_t LSM6DSL_ACC_GYRO_W_PedoStepReset(void *handle, LSM6DSL_ACC_GYRO_PEDO_RST_STEP_t newValue)
cparata 0:763b80993db4 3554 {
cparata 0:763b80993db4 3555 u8_t value;
cparata 0:763b80993db4 3556
cparata 0:763b80993db4 3557 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:763b80993db4 3558 return MEMS_ERROR;
cparata 0:763b80993db4 3559
cparata 0:763b80993db4 3560 value &= ~LSM6DSL_ACC_GYRO_PEDO_RST_STEP_MASK;
cparata 0:763b80993db4 3561 value |= newValue;
cparata 0:763b80993db4 3562
cparata 0:763b80993db4 3563 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:763b80993db4 3564 return MEMS_ERROR;
cparata 0:763b80993db4 3565
cparata 0:763b80993db4 3566 return MEMS_SUCCESS;
cparata 0:763b80993db4 3567 }
cparata 0:763b80993db4 3568
cparata 0:763b80993db4 3569 /*******************************************************************************
cparata 0:763b80993db4 3570 * Function Name : LSM6DSL_ACC_GYRO_R_PedoStepReset
cparata 0:763b80993db4 3571 * Description : Read PEDO_RST_STEP
cparata 0:763b80993db4 3572 * Input : Pointer to LSM6DSL_ACC_GYRO_PEDO_RST_STEP_t
cparata 0:763b80993db4 3573 * Output : Status of PEDO_RST_STEP see LSM6DSL_ACC_GYRO_PEDO_RST_STEP_t
cparata 0:763b80993db4 3574 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3575 *******************************************************************************/
cparata 0:763b80993db4 3576 status_t LSM6DSL_ACC_GYRO_R_PedoStepReset(void *handle, LSM6DSL_ACC_GYRO_PEDO_RST_STEP_t *value)
cparata 0:763b80993db4 3577 {
cparata 0:763b80993db4 3578 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, (u8_t *)value, 1) )
cparata 0:763b80993db4 3579 return MEMS_ERROR;
cparata 0:763b80993db4 3580
cparata 0:763b80993db4 3581 *value &= LSM6DSL_ACC_GYRO_PEDO_RST_STEP_MASK; //mask
cparata 0:763b80993db4 3582
cparata 0:763b80993db4 3583 return MEMS_SUCCESS;
cparata 0:763b80993db4 3584 }
cparata 0:763b80993db4 3585 /*******************************************************************************
cparata 0:763b80993db4 3586 * Function Name : LSM6DSL_ACC_GYRO_W_TILT
cparata 0:763b80993db4 3587 * Description : Write XEN_G
cparata 0:763b80993db4 3588 * Input : LSM6DSL_ACC_GYRO_TILT_G_t
cparata 0:763b80993db4 3589 * Output : None
cparata 0:763b80993db4 3590 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3591 *******************************************************************************/
cparata 0:763b80993db4 3592 status_t LSM6DSL_ACC_GYRO_W_TILT(void *handle, LSM6DSL_ACC_GYRO_TILT_G_t newValue)
cparata 0:763b80993db4 3593 {
cparata 0:763b80993db4 3594 u8_t value;
cparata 0:763b80993db4 3595
cparata 0:763b80993db4 3596 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:763b80993db4 3597 return MEMS_ERROR;
cparata 0:763b80993db4 3598
cparata 0:763b80993db4 3599 value &= ~LSM6DSL_ACC_GYRO_TILT_MASK;
cparata 0:763b80993db4 3600 value |= newValue;
cparata 0:763b80993db4 3601
cparata 0:763b80993db4 3602 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:763b80993db4 3603 return MEMS_ERROR;
cparata 0:763b80993db4 3604
cparata 0:763b80993db4 3605 return MEMS_SUCCESS;
cparata 0:763b80993db4 3606 }
cparata 0:763b80993db4 3607
cparata 0:763b80993db4 3608 /*******************************************************************************
cparata 0:763b80993db4 3609 * Function Name : LSM6DSL_ACC_GYRO_R_TILT
cparata 0:763b80993db4 3610 * Description : Read XEN_G
cparata 0:763b80993db4 3611 * Input : Pointer to LSM6DSL_ACC_GYRO_TILT_G_t
cparata 0:763b80993db4 3612 * Output : Status of XEN_G see LSM6DSL_ACC_GYRO_TILT_G_t
cparata 0:763b80993db4 3613 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3614 *******************************************************************************/
cparata 0:763b80993db4 3615 status_t LSM6DSL_ACC_GYRO_R_TILT(void *handle, LSM6DSL_ACC_GYRO_TILT_G_t *value)
cparata 0:763b80993db4 3616 {
cparata 0:763b80993db4 3617 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, (u8_t *)value, 1) )
cparata 0:763b80993db4 3618 return MEMS_ERROR;
cparata 0:763b80993db4 3619
cparata 0:763b80993db4 3620 *value &= LSM6DSL_ACC_GYRO_TILT_MASK; //mask
cparata 0:763b80993db4 3621
cparata 0:763b80993db4 3622 return MEMS_SUCCESS;
cparata 0:763b80993db4 3623 }
cparata 0:763b80993db4 3624 /*******************************************************************************
cparata 0:763b80993db4 3625 * Function Name : LSM6DSL_ACC_GYRO_W_PEDO
cparata 0:763b80993db4 3626 * Description : Write PEDO_EN
cparata 0:763b80993db4 3627 * Input : LSM6DSL_ACC_GYRO_PEDO_t
cparata 0:763b80993db4 3628 * Output : None
cparata 0:763b80993db4 3629 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3630 *******************************************************************************/
cparata 0:763b80993db4 3631 status_t LSM6DSL_ACC_GYRO_W_PEDO(void *handle, LSM6DSL_ACC_GYRO_PEDO_t newValue)
cparata 0:763b80993db4 3632 {
cparata 0:763b80993db4 3633 u8_t value;
cparata 0:763b80993db4 3634
cparata 0:763b80993db4 3635 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:763b80993db4 3636 return MEMS_ERROR;
cparata 0:763b80993db4 3637
cparata 0:763b80993db4 3638 value &= ~LSM6DSL_ACC_GYRO_PEDO_MASK;
cparata 0:763b80993db4 3639 value |= newValue;
cparata 0:763b80993db4 3640
cparata 0:763b80993db4 3641 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:763b80993db4 3642 return MEMS_ERROR;
cparata 0:763b80993db4 3643
cparata 0:763b80993db4 3644 return MEMS_SUCCESS;
cparata 0:763b80993db4 3645 }
cparata 0:763b80993db4 3646
cparata 0:763b80993db4 3647 /*******************************************************************************
cparata 0:763b80993db4 3648 * Function Name : LSM6DSL_ACC_GYRO_R_PEDO
cparata 0:763b80993db4 3649 * Description : Read PEDO_EN
cparata 0:763b80993db4 3650 * Input : Pointer to LSM6DSL_ACC_GYRO_PEDO_t
cparata 0:763b80993db4 3651 * Output : Status of PEDO_EN see LSM6DSL_ACC_GYRO_PEDO_t
cparata 0:763b80993db4 3652 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3653 *******************************************************************************/
cparata 0:763b80993db4 3654 status_t LSM6DSL_ACC_GYRO_R_PEDO(void *handle, LSM6DSL_ACC_GYRO_PEDO_t *value)
cparata 0:763b80993db4 3655 {
cparata 0:763b80993db4 3656 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, (u8_t *)value, 1) )
cparata 0:763b80993db4 3657 return MEMS_ERROR;
cparata 0:763b80993db4 3658
cparata 0:763b80993db4 3659 *value &= LSM6DSL_ACC_GYRO_PEDO_MASK; //mask
cparata 0:763b80993db4 3660
cparata 0:763b80993db4 3661 return MEMS_SUCCESS;
cparata 0:763b80993db4 3662 }
cparata 0:763b80993db4 3663
cparata 0:763b80993db4 3664 /*******************************************************************************
cparata 0:763b80993db4 3665 * Function Name : LSM6DSL_ACC_GYRO_W_TIMER
cparata 0:763b80993db4 3666 * Description : Write TIMER_EN
cparata 0:763b80993db4 3667 * Input : LSM6DSL_ACC_GYRO_TIMER_t
cparata 0:763b80993db4 3668 * Output : None
cparata 0:763b80993db4 3669 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3670 *******************************************************************************/
cparata 0:763b80993db4 3671 status_t LSM6DSL_ACC_GYRO_W_TIMER(void *handle, LSM6DSL_ACC_GYRO_TIMER_t newValue)
cparata 0:763b80993db4 3672 {
cparata 0:763b80993db4 3673 u8_t value;
cparata 0:763b80993db4 3674
cparata 0:763b80993db4 3675 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:763b80993db4 3676 return MEMS_ERROR;
cparata 0:763b80993db4 3677
cparata 0:763b80993db4 3678 value &= ~LSM6DSL_ACC_GYRO_TIMER_MASK;
cparata 0:763b80993db4 3679 value |= newValue;
cparata 0:763b80993db4 3680
cparata 0:763b80993db4 3681 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:763b80993db4 3682 return MEMS_ERROR;
cparata 0:763b80993db4 3683
cparata 0:763b80993db4 3684 return MEMS_SUCCESS;
cparata 0:763b80993db4 3685 }
cparata 0:763b80993db4 3686
cparata 0:763b80993db4 3687 /*******************************************************************************
cparata 0:763b80993db4 3688 * Function Name : LSM6DSL_ACC_GYRO_R_TIMER
cparata 0:763b80993db4 3689 * Description : Read TIMER_EN
cparata 0:763b80993db4 3690 * Input : Pointer to LSM6DSL_ACC_GYRO_TIMER_t
cparata 0:763b80993db4 3691 * Output : Status of TIMER_EN see LSM6DSL_ACC_GYRO_TIMER_t
cparata 0:763b80993db4 3692 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3693 *******************************************************************************/
cparata 0:763b80993db4 3694 status_t LSM6DSL_ACC_GYRO_R_TIMER(void *handle, LSM6DSL_ACC_GYRO_TIMER_t *value)
cparata 0:763b80993db4 3695 {
cparata 0:763b80993db4 3696 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, (u8_t *)value, 1) )
cparata 0:763b80993db4 3697 return MEMS_ERROR;
cparata 0:763b80993db4 3698
cparata 0:763b80993db4 3699 *value &= LSM6DSL_ACC_GYRO_TIMER_MASK; //mask
cparata 0:763b80993db4 3700
cparata 0:763b80993db4 3701 return MEMS_SUCCESS;
cparata 0:763b80993db4 3702 }
cparata 0:763b80993db4 3703
cparata 0:763b80993db4 3704 /*******************************************************************************
cparata 0:763b80993db4 3705 * Function Name : LSM6DSL_ACC_GYRO_W_FUNC_EN
cparata 0:763b80993db4 3706 * Description : Write FUNC_EN
cparata 0:763b80993db4 3707 * Input : LSM6DSL_ACC_GYRO_FUNC_EN_t
cparata 0:763b80993db4 3708 * Output : None
cparata 0:763b80993db4 3709 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3710 *******************************************************************************/
cparata 0:763b80993db4 3711 status_t LSM6DSL_ACC_GYRO_W_FUNC_EN(void *handle, LSM6DSL_ACC_GYRO_FUNC_EN_t newValue)
cparata 0:763b80993db4 3712 {
cparata 0:763b80993db4 3713 u8_t value;
cparata 0:763b80993db4 3714
cparata 0:763b80993db4 3715 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:763b80993db4 3716 return MEMS_ERROR;
cparata 0:763b80993db4 3717
cparata 0:763b80993db4 3718 value &= ~LSM6DSL_ACC_GYRO_FUNC_EN_MASK;
cparata 0:763b80993db4 3719 value |= newValue;
cparata 0:763b80993db4 3720
cparata 0:763b80993db4 3721 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, &value, 1) )
cparata 0:763b80993db4 3722 return MEMS_ERROR;
cparata 0:763b80993db4 3723
cparata 0:763b80993db4 3724 return MEMS_SUCCESS;
cparata 0:763b80993db4 3725 }
cparata 0:763b80993db4 3726
cparata 0:763b80993db4 3727 /*******************************************************************************
cparata 0:763b80993db4 3728 * Function Name : LSM6DSL_ACC_GYRO_R_FUNC_EN
cparata 0:763b80993db4 3729 * Description : Read FUNC_EN
cparata 0:763b80993db4 3730 * Input : Pointer to LSM6DSL_ACC_GYRO_FUNC_EN_t
cparata 0:763b80993db4 3731 * Output : Status of FUNC_EN see LSM6DSL_ACC_GYRO_FUNC_EN_t
cparata 0:763b80993db4 3732 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3733 *******************************************************************************/
cparata 0:763b80993db4 3734 status_t LSM6DSL_ACC_GYRO_R_FUNC_EN(void *handle, LSM6DSL_ACC_GYRO_FUNC_EN_t *value)
cparata 0:763b80993db4 3735 {
cparata 0:763b80993db4 3736 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CTRL10_C, (u8_t *)value, 1) )
cparata 0:763b80993db4 3737 return MEMS_ERROR;
cparata 0:763b80993db4 3738
cparata 0:763b80993db4 3739 *value &= LSM6DSL_ACC_GYRO_FUNC_EN_MASK; //mask
cparata 0:763b80993db4 3740
cparata 0:763b80993db4 3741 return MEMS_SUCCESS;
cparata 0:763b80993db4 3742 }
cparata 0:763b80993db4 3743
cparata 0:763b80993db4 3744 /*******************************************************************************
cparata 0:763b80993db4 3745 * Function Name : LSM6DSL_ACC_GYRO_W_I2C_MASTER_Enable
cparata 0:763b80993db4 3746 * Description : Write MASTER_ON
cparata 0:763b80993db4 3747 * Input : LSM6DSL_ACC_GYRO_MASTER_ON_t
cparata 0:763b80993db4 3748 * Output : None
cparata 0:763b80993db4 3749 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3750 *******************************************************************************/
cparata 0:763b80993db4 3751 status_t LSM6DSL_ACC_GYRO_W_I2C_MASTER_Enable(void *handle, LSM6DSL_ACC_GYRO_MASTER_ON_t newValue)
cparata 0:763b80993db4 3752 {
cparata 0:763b80993db4 3753 u8_t value;
cparata 0:763b80993db4 3754
cparata 0:763b80993db4 3755 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:763b80993db4 3756 return MEMS_ERROR;
cparata 0:763b80993db4 3757
cparata 0:763b80993db4 3758 value &= ~LSM6DSL_ACC_GYRO_MASTER_ON_MASK;
cparata 0:763b80993db4 3759 value |= newValue;
cparata 0:763b80993db4 3760
cparata 0:763b80993db4 3761 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:763b80993db4 3762 return MEMS_ERROR;
cparata 0:763b80993db4 3763
cparata 0:763b80993db4 3764 return MEMS_SUCCESS;
cparata 0:763b80993db4 3765 }
cparata 0:763b80993db4 3766
cparata 0:763b80993db4 3767 /*******************************************************************************
cparata 0:763b80993db4 3768 * Function Name : LSM6DSL_ACC_GYRO_R_I2C_MASTER_Enable
cparata 0:763b80993db4 3769 * Description : Read MASTER_ON
cparata 0:763b80993db4 3770 * Input : Pointer to LSM6DSL_ACC_GYRO_MASTER_ON_t
cparata 0:763b80993db4 3771 * Output : Status of MASTER_ON see LSM6DSL_ACC_GYRO_MASTER_ON_t
cparata 0:763b80993db4 3772 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3773 *******************************************************************************/
cparata 0:763b80993db4 3774 status_t LSM6DSL_ACC_GYRO_R_I2C_MASTER_Enable(void *handle, LSM6DSL_ACC_GYRO_MASTER_ON_t *value)
cparata 0:763b80993db4 3775 {
cparata 0:763b80993db4 3776 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, (u8_t *)value, 1) )
cparata 0:763b80993db4 3777 return MEMS_ERROR;
cparata 0:763b80993db4 3778
cparata 0:763b80993db4 3779 *value &= LSM6DSL_ACC_GYRO_MASTER_ON_MASK; //mask
cparata 0:763b80993db4 3780
cparata 0:763b80993db4 3781 return MEMS_SUCCESS;
cparata 0:763b80993db4 3782 }
cparata 0:763b80993db4 3783
cparata 0:763b80993db4 3784 /*******************************************************************************
cparata 0:763b80993db4 3785 * Function Name : LSM6DSL_ACC_GYRO_W_IronCorrection_EN
cparata 0:763b80993db4 3786 * Description : Write IRON_EN
cparata 0:763b80993db4 3787 * Input : LSM6DSL_ACC_GYRO_IRON_EN_t
cparata 0:763b80993db4 3788 * Output : None
cparata 0:763b80993db4 3789 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3790 *******************************************************************************/
cparata 0:763b80993db4 3791 status_t LSM6DSL_ACC_GYRO_W_IronCorrection_EN(void *handle, LSM6DSL_ACC_GYRO_IRON_EN_t newValue)
cparata 0:763b80993db4 3792 {
cparata 0:763b80993db4 3793 u8_t value;
cparata 0:763b80993db4 3794
cparata 0:763b80993db4 3795 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:763b80993db4 3796 return MEMS_ERROR;
cparata 0:763b80993db4 3797
cparata 0:763b80993db4 3798 value &= ~LSM6DSL_ACC_GYRO_IRON_EN_MASK;
cparata 0:763b80993db4 3799 value |= newValue;
cparata 0:763b80993db4 3800
cparata 0:763b80993db4 3801 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:763b80993db4 3802 return MEMS_ERROR;
cparata 0:763b80993db4 3803
cparata 0:763b80993db4 3804 return MEMS_SUCCESS;
cparata 0:763b80993db4 3805 }
cparata 0:763b80993db4 3806
cparata 0:763b80993db4 3807 /*******************************************************************************
cparata 0:763b80993db4 3808 * Function Name : LSM6DSL_ACC_GYRO_R_IronCorrection_EN
cparata 0:763b80993db4 3809 * Description : Read IRON_EN
cparata 0:763b80993db4 3810 * Input : Pointer to LSM6DSL_ACC_GYRO_IRON_EN_t
cparata 0:763b80993db4 3811 * Output : Status of IRON_EN see LSM6DSL_ACC_GYRO_IRON_EN_t
cparata 0:763b80993db4 3812 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3813 *******************************************************************************/
cparata 0:763b80993db4 3814 status_t LSM6DSL_ACC_GYRO_R_IronCorrection_EN(void *handle, LSM6DSL_ACC_GYRO_IRON_EN_t *value)
cparata 0:763b80993db4 3815 {
cparata 0:763b80993db4 3816 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, (u8_t *)value, 1) )
cparata 0:763b80993db4 3817 return MEMS_ERROR;
cparata 0:763b80993db4 3818
cparata 0:763b80993db4 3819 *value &= LSM6DSL_ACC_GYRO_IRON_EN_MASK; //mask
cparata 0:763b80993db4 3820
cparata 0:763b80993db4 3821 return MEMS_SUCCESS;
cparata 0:763b80993db4 3822 }
cparata 0:763b80993db4 3823
cparata 0:763b80993db4 3824 /*******************************************************************************
cparata 0:763b80993db4 3825 * Function Name : LSM6DSL_ACC_GYRO_W_PASS_THRU_MODE
cparata 0:763b80993db4 3826 * Description : Write PASS_THRU_MODE
cparata 0:763b80993db4 3827 * Input : LSM6DSL_ACC_GYRO_PASS_THRU_MODE_t
cparata 0:763b80993db4 3828 * Output : None
cparata 0:763b80993db4 3829 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3830 *******************************************************************************/
cparata 0:763b80993db4 3831 status_t LSM6DSL_ACC_GYRO_W_PASS_THRU_MODE(void *handle, LSM6DSL_ACC_GYRO_PASS_THRU_MODE_t newValue)
cparata 0:763b80993db4 3832 {
cparata 0:763b80993db4 3833 u8_t value;
cparata 0:763b80993db4 3834
cparata 0:763b80993db4 3835 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:763b80993db4 3836 return MEMS_ERROR;
cparata 0:763b80993db4 3837
cparata 0:763b80993db4 3838 value &= ~LSM6DSL_ACC_GYRO_PASS_THRU_MODE_MASK;
cparata 0:763b80993db4 3839 value |= newValue;
cparata 0:763b80993db4 3840
cparata 0:763b80993db4 3841 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:763b80993db4 3842 return MEMS_ERROR;
cparata 0:763b80993db4 3843
cparata 0:763b80993db4 3844 return MEMS_SUCCESS;
cparata 0:763b80993db4 3845 }
cparata 0:763b80993db4 3846
cparata 0:763b80993db4 3847 /*******************************************************************************
cparata 0:763b80993db4 3848 * Function Name : LSM6DSL_ACC_GYRO_R_PASS_THRU_MODE
cparata 0:763b80993db4 3849 * Description : Read PASS_THRU_MODE
cparata 0:763b80993db4 3850 * Input : Pointer to LSM6DSL_ACC_GYRO_PASS_THRU_MODE_t
cparata 0:763b80993db4 3851 * Output : Status of PASS_THRU_MODE see LSM6DSL_ACC_GYRO_PASS_THRU_MODE_t
cparata 0:763b80993db4 3852 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3853 *******************************************************************************/
cparata 0:763b80993db4 3854 status_t LSM6DSL_ACC_GYRO_R_PASS_THRU_MODE(void *handle, LSM6DSL_ACC_GYRO_PASS_THRU_MODE_t *value)
cparata 0:763b80993db4 3855 {
cparata 0:763b80993db4 3856 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, (u8_t *)value, 1) )
cparata 0:763b80993db4 3857 return MEMS_ERROR;
cparata 0:763b80993db4 3858
cparata 0:763b80993db4 3859 *value &= LSM6DSL_ACC_GYRO_PASS_THRU_MODE_MASK; //mask
cparata 0:763b80993db4 3860
cparata 0:763b80993db4 3861 return MEMS_SUCCESS;
cparata 0:763b80993db4 3862 }
cparata 0:763b80993db4 3863
cparata 0:763b80993db4 3864 /*******************************************************************************
cparata 0:763b80993db4 3865 * Function Name : LSM6DSL_ACC_GYRO_W_PULL_UP_EN
cparata 0:763b80993db4 3866 * Description : Write PULL_UP_EN
cparata 0:763b80993db4 3867 * Input : LSM6DSL_ACC_GYRO_PULL_UP_EN_t
cparata 0:763b80993db4 3868 * Output : None
cparata 0:763b80993db4 3869 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3870 *******************************************************************************/
cparata 0:763b80993db4 3871 status_t LSM6DSL_ACC_GYRO_W_PULL_UP_EN(void *handle, LSM6DSL_ACC_GYRO_PULL_UP_EN_t newValue)
cparata 0:763b80993db4 3872 {
cparata 0:763b80993db4 3873 u8_t value;
cparata 0:763b80993db4 3874
cparata 0:763b80993db4 3875 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:763b80993db4 3876 return MEMS_ERROR;
cparata 0:763b80993db4 3877
cparata 0:763b80993db4 3878 value &= ~LSM6DSL_ACC_GYRO_PULL_UP_EN_MASK;
cparata 0:763b80993db4 3879 value |= newValue;
cparata 0:763b80993db4 3880
cparata 0:763b80993db4 3881 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:763b80993db4 3882 return MEMS_ERROR;
cparata 0:763b80993db4 3883
cparata 0:763b80993db4 3884 return MEMS_SUCCESS;
cparata 0:763b80993db4 3885 }
cparata 0:763b80993db4 3886
cparata 0:763b80993db4 3887 /*******************************************************************************
cparata 0:763b80993db4 3888 * Function Name : LSM6DSL_ACC_GYRO_R_PULL_UP_EN
cparata 0:763b80993db4 3889 * Description : Read PULL_UP_EN
cparata 0:763b80993db4 3890 * Input : Pointer to LSM6DSL_ACC_GYRO_PULL_UP_EN_t
cparata 0:763b80993db4 3891 * Output : Status of PULL_UP_EN see LSM6DSL_ACC_GYRO_PULL_UP_EN_t
cparata 0:763b80993db4 3892 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3893 *******************************************************************************/
cparata 0:763b80993db4 3894 status_t LSM6DSL_ACC_GYRO_R_PULL_UP_EN(void *handle, LSM6DSL_ACC_GYRO_PULL_UP_EN_t *value)
cparata 0:763b80993db4 3895 {
cparata 0:763b80993db4 3896 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, (u8_t *)value, 1) )
cparata 0:763b80993db4 3897 return MEMS_ERROR;
cparata 0:763b80993db4 3898
cparata 0:763b80993db4 3899 *value &= LSM6DSL_ACC_GYRO_PULL_UP_EN_MASK; //mask
cparata 0:763b80993db4 3900
cparata 0:763b80993db4 3901 return MEMS_SUCCESS;
cparata 0:763b80993db4 3902 }
cparata 0:763b80993db4 3903
cparata 0:763b80993db4 3904 /*******************************************************************************
cparata 0:763b80993db4 3905 * Function Name : LSM6DSL_ACC_GYRO_W_SensorHUB_Trigger_Sel
cparata 0:763b80993db4 3906 * Description : Write START_CONFIG
cparata 0:763b80993db4 3907 * Input : LSM6DSL_ACC_GYRO_START_CONFIG_t
cparata 0:763b80993db4 3908 * Output : None
cparata 0:763b80993db4 3909 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3910 *******************************************************************************/
cparata 0:763b80993db4 3911 status_t LSM6DSL_ACC_GYRO_W_SensorHUB_Trigger_Sel(void *handle, LSM6DSL_ACC_GYRO_START_CONFIG_t newValue)
cparata 0:763b80993db4 3912 {
cparata 0:763b80993db4 3913 u8_t value;
cparata 0:763b80993db4 3914
cparata 0:763b80993db4 3915 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:763b80993db4 3916 return MEMS_ERROR;
cparata 0:763b80993db4 3917
cparata 0:763b80993db4 3918 value &= ~LSM6DSL_ACC_GYRO_START_CONFIG_MASK;
cparata 0:763b80993db4 3919 value |= newValue;
cparata 0:763b80993db4 3920
cparata 0:763b80993db4 3921 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:763b80993db4 3922 return MEMS_ERROR;
cparata 0:763b80993db4 3923
cparata 0:763b80993db4 3924 return MEMS_SUCCESS;
cparata 0:763b80993db4 3925 }
cparata 0:763b80993db4 3926
cparata 0:763b80993db4 3927 /*******************************************************************************
cparata 0:763b80993db4 3928 * Function Name : LSM6DSL_ACC_GYRO_R_SensorHUB_Trigger_Sel
cparata 0:763b80993db4 3929 * Description : Read START_CONFIG
cparata 0:763b80993db4 3930 * Input : Pointer to LSM6DSL_ACC_GYRO_START_CONFIG_t
cparata 0:763b80993db4 3931 * Output : Status of START_CONFIG see LSM6DSL_ACC_GYRO_START_CONFIG_t
cparata 0:763b80993db4 3932 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3933 *******************************************************************************/
cparata 0:763b80993db4 3934 status_t LSM6DSL_ACC_GYRO_R_SensorHUB_Trigger_Sel(void *handle, LSM6DSL_ACC_GYRO_START_CONFIG_t *value)
cparata 0:763b80993db4 3935 {
cparata 0:763b80993db4 3936 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, (u8_t *)value, 1) )
cparata 0:763b80993db4 3937 return MEMS_ERROR;
cparata 0:763b80993db4 3938
cparata 0:763b80993db4 3939 *value &= LSM6DSL_ACC_GYRO_START_CONFIG_MASK; //mask
cparata 0:763b80993db4 3940
cparata 0:763b80993db4 3941 return MEMS_SUCCESS;
cparata 0:763b80993db4 3942 }
cparata 0:763b80993db4 3943
cparata 0:763b80993db4 3944 /*******************************************************************************
cparata 0:763b80993db4 3945 * Function Name : LSM6DSL_ACC_GYRO_W_DATA_VAL_SEL_FIFO
cparata 0:763b80993db4 3946 * Description : Write DATA_VAL_SEL_FIFO
cparata 0:763b80993db4 3947 * Input : LSM6DSL_ACC_GYRO_DATA_VAL_SEL_FIFO_t
cparata 0:763b80993db4 3948 * Output : None
cparata 0:763b80993db4 3949 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3950 *******************************************************************************/
cparata 0:763b80993db4 3951 status_t LSM6DSL_ACC_GYRO_W_DATA_VAL_SEL_FIFO(void *handle, LSM6DSL_ACC_GYRO_DATA_VAL_SEL_FIFO_t newValue)
cparata 0:763b80993db4 3952 {
cparata 0:763b80993db4 3953 u8_t value;
cparata 0:763b80993db4 3954
cparata 0:763b80993db4 3955 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:763b80993db4 3956 return MEMS_ERROR;
cparata 0:763b80993db4 3957
cparata 0:763b80993db4 3958 value &= ~LSM6DSL_ACC_GYRO_DATA_VAL_SEL_FIFO_MASK;
cparata 0:763b80993db4 3959 value |= newValue;
cparata 0:763b80993db4 3960
cparata 0:763b80993db4 3961 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:763b80993db4 3962 return MEMS_ERROR;
cparata 0:763b80993db4 3963
cparata 0:763b80993db4 3964 return MEMS_SUCCESS;
cparata 0:763b80993db4 3965 }
cparata 0:763b80993db4 3966
cparata 0:763b80993db4 3967 /*******************************************************************************
cparata 0:763b80993db4 3968 * Function Name : LSM6DSL_ACC_GYRO_R_DATA_VAL_SEL_FIFO
cparata 0:763b80993db4 3969 * Description : Read DATA_VAL_SEL_FIFO
cparata 0:763b80993db4 3970 * Input : Pointer to LSM6DSL_ACC_GYRO_DATA_VAL_SEL_FIFO_t
cparata 0:763b80993db4 3971 * Output : Status of DATA_VAL_SEL_FIFO see LSM6DSL_ACC_GYRO_DATA_VAL_SEL_FIFO_t
cparata 0:763b80993db4 3972 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3973 *******************************************************************************/
cparata 0:763b80993db4 3974 status_t LSM6DSL_ACC_GYRO_R_DATA_VAL_SEL_FIFO(void *handle, LSM6DSL_ACC_GYRO_DATA_VAL_SEL_FIFO_t *value)
cparata 0:763b80993db4 3975 {
cparata 0:763b80993db4 3976 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, (u8_t *)value, 1) )
cparata 0:763b80993db4 3977 return MEMS_ERROR;
cparata 0:763b80993db4 3978
cparata 0:763b80993db4 3979 *value &= LSM6DSL_ACC_GYRO_DATA_VAL_SEL_FIFO_MASK; //mask
cparata 0:763b80993db4 3980
cparata 0:763b80993db4 3981 return MEMS_SUCCESS;
cparata 0:763b80993db4 3982 }
cparata 0:763b80993db4 3983
cparata 0:763b80993db4 3984 /*******************************************************************************
cparata 0:763b80993db4 3985 * Function Name : LSM6DSL_ACC_GYRO_W_DRDY_ON_INT1
cparata 0:763b80993db4 3986 * Description : Write DRDY_ON_INT1
cparata 0:763b80993db4 3987 * Input : LSM6DSL_ACC_GYRO_DRDY_ON_INT1_t
cparata 0:763b80993db4 3988 * Output : None
cparata 0:763b80993db4 3989 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 3990 *******************************************************************************/
cparata 0:763b80993db4 3991 status_t LSM6DSL_ACC_GYRO_W_DRDY_ON_INT1(void *handle, LSM6DSL_ACC_GYRO_DRDY_ON_INT1_t newValue)
cparata 0:763b80993db4 3992 {
cparata 0:763b80993db4 3993 u8_t value;
cparata 0:763b80993db4 3994
cparata 0:763b80993db4 3995 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:763b80993db4 3996 return MEMS_ERROR;
cparata 0:763b80993db4 3997
cparata 0:763b80993db4 3998 value &= ~LSM6DSL_ACC_GYRO_DRDY_ON_INT1_MASK;
cparata 0:763b80993db4 3999 value |= newValue;
cparata 0:763b80993db4 4000
cparata 0:763b80993db4 4001 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, &value, 1) )
cparata 0:763b80993db4 4002 return MEMS_ERROR;
cparata 0:763b80993db4 4003
cparata 0:763b80993db4 4004 return MEMS_SUCCESS;
cparata 0:763b80993db4 4005 }
cparata 0:763b80993db4 4006 /*******************************************************************************
cparata 0:763b80993db4 4007 * Function Name : LSM6DSL_ACC_GYRO_R_DRDY_ON_INT1
cparata 0:763b80993db4 4008 * Description : Read DRDY_ON_INT1
cparata 0:763b80993db4 4009 * Input : Pointer to LSM6DSL_ACC_GYRO_DRDY_ON_INT1_t
cparata 0:763b80993db4 4010 * Output : Status of DRDY_ON_INT1 see LSM6DSL_ACC_GYRO_DRDY_ON_INT1_t
cparata 0:763b80993db4 4011 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4012 *******************************************************************************/
cparata 0:763b80993db4 4013 status_t LSM6DSL_ACC_GYRO_R_DRDY_ON_INT1(void *handle, LSM6DSL_ACC_GYRO_DRDY_ON_INT1_t *value)
cparata 0:763b80993db4 4014 {
cparata 0:763b80993db4 4015 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MASTER_CONFIG, (u8_t *)value, 1) )
cparata 0:763b80993db4 4016 return MEMS_ERROR;
cparata 0:763b80993db4 4017
cparata 0:763b80993db4 4018 *value &= LSM6DSL_ACC_GYRO_DRDY_ON_INT1_MASK; //mask
cparata 0:763b80993db4 4019
cparata 0:763b80993db4 4020 return MEMS_SUCCESS;
cparata 0:763b80993db4 4021 }
cparata 0:763b80993db4 4022
cparata 0:763b80993db4 4023 /*******************************************************************************
cparata 0:763b80993db4 4024 * Function Name : LSM6DSL_ACC_GYRO_R_Z_WU
cparata 0:763b80993db4 4025 * Description : Read Z_WU
cparata 0:763b80993db4 4026 * Input : Pointer to LSM6DSL_ACC_GYRO_Z_WU_t
cparata 0:763b80993db4 4027 * Output : Status of Z_WU see LSM6DSL_ACC_GYRO_Z_WU_t
cparata 0:763b80993db4 4028 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4029 *******************************************************************************/
cparata 0:763b80993db4 4030 status_t LSM6DSL_ACC_GYRO_R_Z_WU(void *handle, LSM6DSL_ACC_GYRO_Z_WU_t *value)
cparata 0:763b80993db4 4031 {
cparata 0:763b80993db4 4032 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value, 1) )
cparata 0:763b80993db4 4033 return MEMS_ERROR;
cparata 0:763b80993db4 4034
cparata 0:763b80993db4 4035 *value &= LSM6DSL_ACC_GYRO_Z_WU_MASK; //mask
cparata 0:763b80993db4 4036
cparata 0:763b80993db4 4037 return MEMS_SUCCESS;
cparata 0:763b80993db4 4038 }
cparata 0:763b80993db4 4039
cparata 0:763b80993db4 4040 /*******************************************************************************
cparata 0:763b80993db4 4041 * Function Name : LSM6DSL_ACC_GYRO_R_Y_WU
cparata 0:763b80993db4 4042 * Description : Read Y_WU
cparata 0:763b80993db4 4043 * Input : Pointer to LSM6DSL_ACC_GYRO_Y_WU_t
cparata 0:763b80993db4 4044 * Output : Status of Y_WU see LSM6DSL_ACC_GYRO_Y_WU_t
cparata 0:763b80993db4 4045 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4046 *******************************************************************************/
cparata 0:763b80993db4 4047 status_t LSM6DSL_ACC_GYRO_R_Y_WU(void *handle, LSM6DSL_ACC_GYRO_Y_WU_t *value)
cparata 0:763b80993db4 4048 {
cparata 0:763b80993db4 4049 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value, 1) )
cparata 0:763b80993db4 4050 return MEMS_ERROR;
cparata 0:763b80993db4 4051
cparata 0:763b80993db4 4052 *value &= LSM6DSL_ACC_GYRO_Y_WU_MASK; //mask
cparata 0:763b80993db4 4053
cparata 0:763b80993db4 4054 return MEMS_SUCCESS;
cparata 0:763b80993db4 4055 }
cparata 0:763b80993db4 4056
cparata 0:763b80993db4 4057 /*******************************************************************************
cparata 0:763b80993db4 4058 * Function Name : LSM6DSL_ACC_GYRO_R_X_WU
cparata 0:763b80993db4 4059 * Description : Read X_WU
cparata 0:763b80993db4 4060 * Input : Pointer to LSM6DSL_ACC_GYRO_X_WU_t
cparata 0:763b80993db4 4061 * Output : Status of X_WU see LSM6DSL_ACC_GYRO_X_WU_t
cparata 0:763b80993db4 4062 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4063 *******************************************************************************/
cparata 0:763b80993db4 4064 status_t LSM6DSL_ACC_GYRO_R_X_WU(void *handle, LSM6DSL_ACC_GYRO_X_WU_t *value)
cparata 0:763b80993db4 4065 {
cparata 0:763b80993db4 4066 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value, 1) )
cparata 0:763b80993db4 4067 return MEMS_ERROR;
cparata 0:763b80993db4 4068
cparata 0:763b80993db4 4069 *value &= LSM6DSL_ACC_GYRO_X_WU_MASK; //mask
cparata 0:763b80993db4 4070
cparata 0:763b80993db4 4071 return MEMS_SUCCESS;
cparata 0:763b80993db4 4072 }
cparata 0:763b80993db4 4073
cparata 0:763b80993db4 4074 /*******************************************************************************
cparata 0:763b80993db4 4075 * Function Name : LSM6DSL_ACC_GYRO_R_WU_EV_STATUS
cparata 0:763b80993db4 4076 * Description : Read WU_EV_STATUS
cparata 0:763b80993db4 4077 * Input : Pointer to LSM6DSL_ACC_GYRO_WU_EV_STATUS_t
cparata 0:763b80993db4 4078 * Output : Status of WU_EV_STATUS see LSM6DSL_ACC_GYRO_WU_EV_STATUS_t
cparata 0:763b80993db4 4079 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4080 *******************************************************************************/
cparata 0:763b80993db4 4081 status_t LSM6DSL_ACC_GYRO_R_WU_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_WU_EV_STATUS_t *value)
cparata 0:763b80993db4 4082 {
cparata 0:763b80993db4 4083 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value, 1) )
cparata 0:763b80993db4 4084 return MEMS_ERROR;
cparata 0:763b80993db4 4085
cparata 0:763b80993db4 4086 *value &= LSM6DSL_ACC_GYRO_WU_EV_STATUS_MASK; //mask
cparata 0:763b80993db4 4087
cparata 0:763b80993db4 4088 return MEMS_SUCCESS;
cparata 0:763b80993db4 4089 }
cparata 0:763b80993db4 4090
cparata 0:763b80993db4 4091 /*******************************************************************************
cparata 0:763b80993db4 4092 * Function Name : LSM6DSL_ACC_GYRO_R_SLEEP_EV_STATUS
cparata 0:763b80993db4 4093 * Description : Read SLEEP_EV_STATUS
cparata 0:763b80993db4 4094 * Input : Pointer to LSM6DSL_ACC_GYRO_SLEEP_EV_STATUS_t
cparata 0:763b80993db4 4095 * Output : Status of SLEEP_EV_STATUS see LSM6DSL_ACC_GYRO_SLEEP_EV_STATUS_t
cparata 0:763b80993db4 4096 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4097 *******************************************************************************/
cparata 0:763b80993db4 4098 status_t LSM6DSL_ACC_GYRO_R_SLEEP_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_SLEEP_EV_STATUS_t *value)
cparata 0:763b80993db4 4099 {
cparata 0:763b80993db4 4100 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value, 1) )
cparata 0:763b80993db4 4101 return MEMS_ERROR;
cparata 0:763b80993db4 4102
cparata 0:763b80993db4 4103 *value &= LSM6DSL_ACC_GYRO_SLEEP_EV_STATUS_MASK; //mask
cparata 0:763b80993db4 4104
cparata 0:763b80993db4 4105 return MEMS_SUCCESS;
cparata 0:763b80993db4 4106 }
cparata 0:763b80993db4 4107
cparata 0:763b80993db4 4108 /*******************************************************************************
cparata 0:763b80993db4 4109 * Function Name : LSM6DSL_ACC_GYRO_R_FF_EV_STATUS
cparata 0:763b80993db4 4110 * Description : Read FF_EV_STATUS
cparata 0:763b80993db4 4111 * Input : Pointer to LSM6DSL_ACC_GYRO_FF_EV_STATUS_t
cparata 0:763b80993db4 4112 * Output : Status of FF_EV_STATUS see LSM6DSL_ACC_GYRO_FF_EV_STATUS_t
cparata 0:763b80993db4 4113 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4114 *******************************************************************************/
cparata 0:763b80993db4 4115 status_t LSM6DSL_ACC_GYRO_R_FF_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_FF_EV_STATUS_t *value)
cparata 0:763b80993db4 4116 {
cparata 0:763b80993db4 4117 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_SRC, (u8_t *)value, 1) )
cparata 0:763b80993db4 4118 return MEMS_ERROR;
cparata 0:763b80993db4 4119
cparata 0:763b80993db4 4120 *value &= LSM6DSL_ACC_GYRO_FF_EV_STATUS_MASK; //mask
cparata 0:763b80993db4 4121
cparata 0:763b80993db4 4122 return MEMS_SUCCESS;
cparata 0:763b80993db4 4123 }
cparata 0:763b80993db4 4124
cparata 0:763b80993db4 4125 /*******************************************************************************
cparata 0:763b80993db4 4126 * Function Name : LSM6DSL_ACC_GYRO_R_Z_TAP
cparata 0:763b80993db4 4127 * Description : Read Z_TAP
cparata 0:763b80993db4 4128 * Input : Pointer to LSM6DSL_ACC_GYRO_Z_TAP_t
cparata 0:763b80993db4 4129 * Output : Status of Z_TAP see LSM6DSL_ACC_GYRO_Z_TAP_t
cparata 0:763b80993db4 4130 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4131 *******************************************************************************/
cparata 0:763b80993db4 4132 status_t LSM6DSL_ACC_GYRO_R_Z_TAP(void *handle, LSM6DSL_ACC_GYRO_Z_TAP_t *value)
cparata 0:763b80993db4 4133 {
cparata 0:763b80993db4 4134 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_SRC, (u8_t *)value, 1) )
cparata 0:763b80993db4 4135 return MEMS_ERROR;
cparata 0:763b80993db4 4136
cparata 0:763b80993db4 4137 *value &= LSM6DSL_ACC_GYRO_Z_TAP_MASK; //mask
cparata 0:763b80993db4 4138
cparata 0:763b80993db4 4139 return MEMS_SUCCESS;
cparata 0:763b80993db4 4140 }
cparata 0:763b80993db4 4141
cparata 0:763b80993db4 4142 /*******************************************************************************
cparata 0:763b80993db4 4143 * Function Name : LSM6DSL_ACC_GYRO_R_Y_TAP
cparata 0:763b80993db4 4144 * Description : Read Y_TAP
cparata 0:763b80993db4 4145 * Input : Pointer to LSM6DSL_ACC_GYRO_Y_TAP_t
cparata 0:763b80993db4 4146 * Output : Status of Y_TAP see LSM6DSL_ACC_GYRO_Y_TAP_t
cparata 0:763b80993db4 4147 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4148 *******************************************************************************/
cparata 0:763b80993db4 4149 status_t LSM6DSL_ACC_GYRO_R_Y_TAP(void *handle, LSM6DSL_ACC_GYRO_Y_TAP_t *value)
cparata 0:763b80993db4 4150 {
cparata 0:763b80993db4 4151 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_SRC, (u8_t *)value, 1) )
cparata 0:763b80993db4 4152 return MEMS_ERROR;
cparata 0:763b80993db4 4153
cparata 0:763b80993db4 4154 *value &= LSM6DSL_ACC_GYRO_Y_TAP_MASK; //mask
cparata 0:763b80993db4 4155
cparata 0:763b80993db4 4156 return MEMS_SUCCESS;
cparata 0:763b80993db4 4157 }
cparata 0:763b80993db4 4158
cparata 0:763b80993db4 4159 /*******************************************************************************
cparata 0:763b80993db4 4160 * Function Name : LSM6DSL_ACC_GYRO_R_X_TAP
cparata 0:763b80993db4 4161 * Description : Read X_TAP
cparata 0:763b80993db4 4162 * Input : Pointer to LSM6DSL_ACC_GYRO_X_TAP_t
cparata 0:763b80993db4 4163 * Output : Status of X_TAP see LSM6DSL_ACC_GYRO_X_TAP_t
cparata 0:763b80993db4 4164 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4165 *******************************************************************************/
cparata 0:763b80993db4 4166 status_t LSM6DSL_ACC_GYRO_R_X_TAP(void *handle, LSM6DSL_ACC_GYRO_X_TAP_t *value)
cparata 0:763b80993db4 4167 {
cparata 0:763b80993db4 4168 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_SRC, (u8_t *)value, 1) )
cparata 0:763b80993db4 4169 return MEMS_ERROR;
cparata 0:763b80993db4 4170
cparata 0:763b80993db4 4171 *value &= LSM6DSL_ACC_GYRO_X_TAP_MASK; //mask
cparata 0:763b80993db4 4172
cparata 0:763b80993db4 4173 return MEMS_SUCCESS;
cparata 0:763b80993db4 4174 }
cparata 0:763b80993db4 4175
cparata 0:763b80993db4 4176 /*******************************************************************************
cparata 0:763b80993db4 4177 * Function Name : LSM6DSL_ACC_GYRO_R_TAP_SIGN
cparata 0:763b80993db4 4178 * Description : Read TAP_SIGN
cparata 0:763b80993db4 4179 * Input : Pointer to LSM6DSL_ACC_GYRO_TAP_SIGN_t
cparata 0:763b80993db4 4180 * Output : Status of TAP_SIGN see LSM6DSL_ACC_GYRO_TAP_SIGN_t
cparata 0:763b80993db4 4181 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4182 *******************************************************************************/
cparata 0:763b80993db4 4183 status_t LSM6DSL_ACC_GYRO_R_TAP_SIGN(void *handle, LSM6DSL_ACC_GYRO_TAP_SIGN_t *value)
cparata 0:763b80993db4 4184 {
cparata 0:763b80993db4 4185 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_SRC, (u8_t *)value, 1) )
cparata 0:763b80993db4 4186 return MEMS_ERROR;
cparata 0:763b80993db4 4187
cparata 0:763b80993db4 4188 *value &= LSM6DSL_ACC_GYRO_TAP_SIGN_MASK; //mask
cparata 0:763b80993db4 4189
cparata 0:763b80993db4 4190 return MEMS_SUCCESS;
cparata 0:763b80993db4 4191 }
cparata 0:763b80993db4 4192
cparata 0:763b80993db4 4193 /*******************************************************************************
cparata 0:763b80993db4 4194 * Function Name : LSM6DSL_ACC_GYRO_R_DOUBLE_TAP_EV_STATUS
cparata 0:763b80993db4 4195 * Description : Read DOUBLE_TAP_EV_STATUS
cparata 0:763b80993db4 4196 * Input : Pointer to LSM6DSL_ACC_GYRO_DOUBLE_TAP_EV_STATUS_t
cparata 0:763b80993db4 4197 * Output : Status of DOUBLE_TAP_EV_STATUS see LSM6DSL_ACC_GYRO_DOUBLE_TAP_EV_STATUS_t
cparata 0:763b80993db4 4198 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4199 *******************************************************************************/
cparata 0:763b80993db4 4200 status_t LSM6DSL_ACC_GYRO_R_DOUBLE_TAP_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_DOUBLE_TAP_EV_STATUS_t *value)
cparata 0:763b80993db4 4201 {
cparata 0:763b80993db4 4202 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_SRC, (u8_t *)value, 1) )
cparata 0:763b80993db4 4203 return MEMS_ERROR;
cparata 0:763b80993db4 4204
cparata 0:763b80993db4 4205 *value &= LSM6DSL_ACC_GYRO_DOUBLE_TAP_EV_STATUS_MASK; //mask
cparata 0:763b80993db4 4206
cparata 0:763b80993db4 4207 return MEMS_SUCCESS;
cparata 0:763b80993db4 4208 }
cparata 0:763b80993db4 4209
cparata 0:763b80993db4 4210 /*******************************************************************************
cparata 0:763b80993db4 4211 * Function Name : LSM6DSL_ACC_GYRO_R_SINGLE_TAP_EV_STATUS
cparata 0:763b80993db4 4212 * Description : Read SINGLE_TAP_EV_STATUS
cparata 0:763b80993db4 4213 * Input : Pointer to LSM6DSL_ACC_GYRO_SINGLE_TAP_EV_STATUS_t
cparata 0:763b80993db4 4214 * Output : Status of SINGLE_TAP_EV_STATUS see LSM6DSL_ACC_GYRO_SINGLE_TAP_EV_STATUS_t
cparata 0:763b80993db4 4215 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4216 *******************************************************************************/
cparata 0:763b80993db4 4217 status_t LSM6DSL_ACC_GYRO_R_SINGLE_TAP_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_SINGLE_TAP_EV_STATUS_t *value)
cparata 0:763b80993db4 4218 {
cparata 0:763b80993db4 4219 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_SRC, (u8_t *)value, 1) )
cparata 0:763b80993db4 4220 return MEMS_ERROR;
cparata 0:763b80993db4 4221
cparata 0:763b80993db4 4222 *value &= LSM6DSL_ACC_GYRO_SINGLE_TAP_EV_STATUS_MASK; //mask
cparata 0:763b80993db4 4223
cparata 0:763b80993db4 4224 return MEMS_SUCCESS;
cparata 0:763b80993db4 4225 }
cparata 0:763b80993db4 4226
cparata 0:763b80993db4 4227 /*******************************************************************************
cparata 0:763b80993db4 4228 * Function Name : LSM6DSL_ACC_GYRO_R_TAP_EV_STATUS
cparata 0:763b80993db4 4229 * Description : Read TAP_EV_STATUS
cparata 0:763b80993db4 4230 * Input : Pointer to LSM6DSL_ACC_GYRO_TAP_EV_STATUS_t
cparata 0:763b80993db4 4231 * Output : Status of TAP_EV_STATUS see LSM6DSL_ACC_GYRO_TAP_EV_STATUS_t
cparata 0:763b80993db4 4232 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4233 *******************************************************************************/
cparata 0:763b80993db4 4234 status_t LSM6DSL_ACC_GYRO_R_TAP_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_TAP_EV_STATUS_t *value)
cparata 0:763b80993db4 4235 {
cparata 0:763b80993db4 4236 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_SRC, (u8_t *)value, 1) )
cparata 0:763b80993db4 4237 return MEMS_ERROR;
cparata 0:763b80993db4 4238
cparata 0:763b80993db4 4239 *value &= LSM6DSL_ACC_GYRO_TAP_EV_STATUS_MASK; //mask
cparata 0:763b80993db4 4240
cparata 0:763b80993db4 4241 return MEMS_SUCCESS;
cparata 0:763b80993db4 4242 }
cparata 0:763b80993db4 4243
cparata 0:763b80993db4 4244 /*******************************************************************************
cparata 0:763b80993db4 4245 * Function Name : LSM6DSL_ACC_GYRO_R_DSD_XL
cparata 0:763b80993db4 4246 * Description : Read DSD_XL
cparata 0:763b80993db4 4247 * Input : Pointer to LSM6DSL_ACC_GYRO_DSD_XL_t
cparata 0:763b80993db4 4248 * Output : Status of DSD_XL see LSM6DSL_ACC_GYRO_DSD_XL_t
cparata 0:763b80993db4 4249 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4250 *******************************************************************************/
cparata 0:763b80993db4 4251 status_t LSM6DSL_ACC_GYRO_R_DSD_XL(void *handle, LSM6DSL_ACC_GYRO_DSD_XL_t *value)
cparata 0:763b80993db4 4252 {
cparata 0:763b80993db4 4253 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_D6D_SRC, (u8_t *)value, 1) )
cparata 0:763b80993db4 4254 return MEMS_ERROR;
cparata 0:763b80993db4 4255
cparata 0:763b80993db4 4256 *value &= LSM6DSL_ACC_GYRO_DSD_XL_MASK; //mask
cparata 0:763b80993db4 4257
cparata 0:763b80993db4 4258 return MEMS_SUCCESS;
cparata 0:763b80993db4 4259 }
cparata 0:763b80993db4 4260
cparata 0:763b80993db4 4261 /*******************************************************************************
cparata 0:763b80993db4 4262 * Function Name : LSM6DSL_ACC_GYRO_R_DSD_XH
cparata 0:763b80993db4 4263 * Description : Read DSD_XH
cparata 0:763b80993db4 4264 * Input : Pointer to LSM6DSL_ACC_GYRO_DSD_XH_t
cparata 0:763b80993db4 4265 * Output : Status of DSD_XH see LSM6DSL_ACC_GYRO_DSD_XH_t
cparata 0:763b80993db4 4266 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4267 *******************************************************************************/
cparata 0:763b80993db4 4268 status_t LSM6DSL_ACC_GYRO_R_DSD_XH(void *handle, LSM6DSL_ACC_GYRO_DSD_XH_t *value)
cparata 0:763b80993db4 4269 {
cparata 0:763b80993db4 4270 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_D6D_SRC, (u8_t *)value, 1) )
cparata 0:763b80993db4 4271 return MEMS_ERROR;
cparata 0:763b80993db4 4272
cparata 0:763b80993db4 4273 *value &= LSM6DSL_ACC_GYRO_DSD_XH_MASK; //mask
cparata 0:763b80993db4 4274
cparata 0:763b80993db4 4275 return MEMS_SUCCESS;
cparata 0:763b80993db4 4276 }
cparata 0:763b80993db4 4277
cparata 0:763b80993db4 4278 /*******************************************************************************
cparata 0:763b80993db4 4279 * Function Name : LSM6DSL_ACC_GYRO_R_DSD_YL
cparata 0:763b80993db4 4280 * Description : Read DSD_YL
cparata 0:763b80993db4 4281 * Input : Pointer to LSM6DSL_ACC_GYRO_DSD_YL_t
cparata 0:763b80993db4 4282 * Output : Status of DSD_YL see LSM6DSL_ACC_GYRO_DSD_YL_t
cparata 0:763b80993db4 4283 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4284 *******************************************************************************/
cparata 0:763b80993db4 4285 status_t LSM6DSL_ACC_GYRO_R_DSD_YL(void *handle, LSM6DSL_ACC_GYRO_DSD_YL_t *value)
cparata 0:763b80993db4 4286 {
cparata 0:763b80993db4 4287 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_D6D_SRC, (u8_t *)value, 1) )
cparata 0:763b80993db4 4288 return MEMS_ERROR;
cparata 0:763b80993db4 4289
cparata 0:763b80993db4 4290 *value &= LSM6DSL_ACC_GYRO_DSD_YL_MASK; //mask
cparata 0:763b80993db4 4291
cparata 0:763b80993db4 4292 return MEMS_SUCCESS;
cparata 0:763b80993db4 4293 }
cparata 0:763b80993db4 4294
cparata 0:763b80993db4 4295 /*******************************************************************************
cparata 0:763b80993db4 4296 * Function Name : LSM6DSL_ACC_GYRO_R_DSD_YH
cparata 0:763b80993db4 4297 * Description : Read DSD_YH
cparata 0:763b80993db4 4298 * Input : Pointer to LSM6DSL_ACC_GYRO_DSD_YH_t
cparata 0:763b80993db4 4299 * Output : Status of DSD_YH see LSM6DSL_ACC_GYRO_DSD_YH_t
cparata 0:763b80993db4 4300 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4301 *******************************************************************************/
cparata 0:763b80993db4 4302 status_t LSM6DSL_ACC_GYRO_R_DSD_YH(void *handle, LSM6DSL_ACC_GYRO_DSD_YH_t *value)
cparata 0:763b80993db4 4303 {
cparata 0:763b80993db4 4304 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_D6D_SRC, (u8_t *)value, 1) )
cparata 0:763b80993db4 4305 return MEMS_ERROR;
cparata 0:763b80993db4 4306
cparata 0:763b80993db4 4307 *value &= LSM6DSL_ACC_GYRO_DSD_YH_MASK; //mask
cparata 0:763b80993db4 4308
cparata 0:763b80993db4 4309 return MEMS_SUCCESS;
cparata 0:763b80993db4 4310 }
cparata 0:763b80993db4 4311
cparata 0:763b80993db4 4312 /*******************************************************************************
cparata 0:763b80993db4 4313 * Function Name : LSM6DSL_ACC_GYRO_R_DSD_ZL
cparata 0:763b80993db4 4314 * Description : Read DSD_ZL
cparata 0:763b80993db4 4315 * Input : Pointer to LSM6DSL_ACC_GYRO_DSD_ZL_t
cparata 0:763b80993db4 4316 * Output : Status of DSD_ZL see LSM6DSL_ACC_GYRO_DSD_ZL_t
cparata 0:763b80993db4 4317 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4318 *******************************************************************************/
cparata 0:763b80993db4 4319 status_t LSM6DSL_ACC_GYRO_R_DSD_ZL(void *handle, LSM6DSL_ACC_GYRO_DSD_ZL_t *value)
cparata 0:763b80993db4 4320 {
cparata 0:763b80993db4 4321 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_D6D_SRC, (u8_t *)value, 1) )
cparata 0:763b80993db4 4322 return MEMS_ERROR;
cparata 0:763b80993db4 4323
cparata 0:763b80993db4 4324 *value &= LSM6DSL_ACC_GYRO_DSD_ZL_MASK; //mask
cparata 0:763b80993db4 4325
cparata 0:763b80993db4 4326 return MEMS_SUCCESS;
cparata 0:763b80993db4 4327 }
cparata 0:763b80993db4 4328
cparata 0:763b80993db4 4329 /*******************************************************************************
cparata 0:763b80993db4 4330 * Function Name : LSM6DSL_ACC_GYRO_R_DSD_ZH
cparata 0:763b80993db4 4331 * Description : Read DSD_ZH
cparata 0:763b80993db4 4332 * Input : Pointer to LSM6DSL_ACC_GYRO_DSD_ZH_t
cparata 0:763b80993db4 4333 * Output : Status of DSD_ZH see LSM6DSL_ACC_GYRO_DSD_ZH_t
cparata 0:763b80993db4 4334 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4335 *******************************************************************************/
cparata 0:763b80993db4 4336 status_t LSM6DSL_ACC_GYRO_R_DSD_ZH(void *handle, LSM6DSL_ACC_GYRO_DSD_ZH_t *value)
cparata 0:763b80993db4 4337 {
cparata 0:763b80993db4 4338 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_D6D_SRC, (u8_t *)value, 1) )
cparata 0:763b80993db4 4339 return MEMS_ERROR;
cparata 0:763b80993db4 4340
cparata 0:763b80993db4 4341 *value &= LSM6DSL_ACC_GYRO_DSD_ZH_MASK; //mask
cparata 0:763b80993db4 4342
cparata 0:763b80993db4 4343 return MEMS_SUCCESS;
cparata 0:763b80993db4 4344 }
cparata 0:763b80993db4 4345
cparata 0:763b80993db4 4346 /*******************************************************************************
cparata 0:763b80993db4 4347 * Function Name : LSM6DSL_ACC_GYRO_R_D6D_EV_STATUS
cparata 0:763b80993db4 4348 * Description : Read D6D_EV_STATUS
cparata 0:763b80993db4 4349 * Input : Pointer to LSM6DSL_ACC_GYRO_D6D_EV_STATUS_t
cparata 0:763b80993db4 4350 * Output : Status of D6D_EV_STATUS see LSM6DSL_ACC_GYRO_D6D_EV_STATUS_t
cparata 0:763b80993db4 4351 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4352 *******************************************************************************/
cparata 0:763b80993db4 4353 status_t LSM6DSL_ACC_GYRO_R_D6D_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_D6D_EV_STATUS_t *value)
cparata 0:763b80993db4 4354 {
cparata 0:763b80993db4 4355 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_D6D_SRC, (u8_t *)value, 1) )
cparata 0:763b80993db4 4356 return MEMS_ERROR;
cparata 0:763b80993db4 4357
cparata 0:763b80993db4 4358 *value &= LSM6DSL_ACC_GYRO_D6D_EV_STATUS_MASK; //mask
cparata 0:763b80993db4 4359
cparata 0:763b80993db4 4360 return MEMS_SUCCESS;
cparata 0:763b80993db4 4361 }
cparata 0:763b80993db4 4362
cparata 0:763b80993db4 4363 /*******************************************************************************
cparata 0:763b80993db4 4364 * Function Name : LSM6DSL_ACC_GYRO_R_XLDA
cparata 0:763b80993db4 4365 * Description : Read XLDA
cparata 0:763b80993db4 4366 * Input : Pointer to LSM6DSL_ACC_GYRO_XLDA_t
cparata 0:763b80993db4 4367 * Output : Status of XLDA see LSM6DSL_ACC_GYRO_XLDA_t
cparata 0:763b80993db4 4368 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4369 *******************************************************************************/
cparata 0:763b80993db4 4370 status_t LSM6DSL_ACC_GYRO_R_XLDA(void *handle, LSM6DSL_ACC_GYRO_XLDA_t *value)
cparata 0:763b80993db4 4371 {
cparata 0:763b80993db4 4372 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_STATUS_REG, (u8_t *)value, 1) )
cparata 0:763b80993db4 4373 return MEMS_ERROR;
cparata 0:763b80993db4 4374
cparata 0:763b80993db4 4375 *value &= LSM6DSL_ACC_GYRO_XLDA_MASK; //mask
cparata 0:763b80993db4 4376
cparata 0:763b80993db4 4377 return MEMS_SUCCESS;
cparata 0:763b80993db4 4378 }
cparata 0:763b80993db4 4379
cparata 0:763b80993db4 4380 /*******************************************************************************
cparata 0:763b80993db4 4381 * Function Name : LSM6DSL_ACC_GYRO_R_GDA
cparata 0:763b80993db4 4382 * Description : Read GDA
cparata 0:763b80993db4 4383 * Input : Pointer to LSM6DSL_ACC_GYRO_GDA_t
cparata 0:763b80993db4 4384 * Output : Status of GDA see LSM6DSL_ACC_GYRO_GDA_t
cparata 0:763b80993db4 4385 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4386 *******************************************************************************/
cparata 0:763b80993db4 4387 status_t LSM6DSL_ACC_GYRO_R_GDA(void *handle, LSM6DSL_ACC_GYRO_GDA_t *value)
cparata 0:763b80993db4 4388 {
cparata 0:763b80993db4 4389 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_STATUS_REG, (u8_t *)value, 1) )
cparata 0:763b80993db4 4390 return MEMS_ERROR;
cparata 0:763b80993db4 4391
cparata 0:763b80993db4 4392 *value &= LSM6DSL_ACC_GYRO_GDA_MASK; //mask
cparata 0:763b80993db4 4393
cparata 0:763b80993db4 4394 return MEMS_SUCCESS;
cparata 0:763b80993db4 4395 }
cparata 0:763b80993db4 4396
cparata 0:763b80993db4 4397 /*******************************************************************************
cparata 0:763b80993db4 4398 * Function Name : LSM6DSL_ACC_GYRO_R_TDA
cparata 0:763b80993db4 4399 * Description : Read GDA
cparata 0:763b80993db4 4400 * Input : Pointer to LSM6DSL_ACC_GYRO_TDA_t
cparata 0:763b80993db4 4401 * Output : Status of GDA see LSM6DSL_ACC_GYRO_TDA_t
cparata 0:763b80993db4 4402 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4403 *******************************************************************************/
cparata 0:763b80993db4 4404 status_t LSM6DSL_ACC_GYRO_R_TDA(void *handle, LSM6DSL_ACC_GYRO_TDA_t *value)
cparata 0:763b80993db4 4405 {
cparata 0:763b80993db4 4406 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_STATUS_REG, (u8_t *)value, 1) )
cparata 0:763b80993db4 4407 return MEMS_ERROR;
cparata 0:763b80993db4 4408
cparata 0:763b80993db4 4409 *value &= LSM6DSL_ACC_GYRO_TDA_MASK; //mask
cparata 0:763b80993db4 4410
cparata 0:763b80993db4 4411 return MEMS_SUCCESS;
cparata 0:763b80993db4 4412 }
cparata 0:763b80993db4 4413
cparata 0:763b80993db4 4414 /*******************************************************************************
cparata 0:763b80993db4 4415 * Function Name : LSM6DSL_ACC_GYRO_R_FIFONumOfEntries
cparata 0:763b80993db4 4416 * Description : Read DIFF_FIFO
cparata 0:763b80993db4 4417 * Input : Pointer to u16_t
cparata 0:763b80993db4 4418 * Output : Status of DIFF_FIFO
cparata 0:763b80993db4 4419 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4420 *******************************************************************************/
cparata 0:763b80993db4 4421 status_t LSM6DSL_ACC_GYRO_R_FIFONumOfEntries(void *handle, u16_t *value)
cparata 0:763b80993db4 4422 {
cparata 0:763b80993db4 4423 u8_t valueH, valueL;
cparata 0:763b80993db4 4424
cparata 0:763b80993db4 4425 /* Low part from FIFO_STATUS1 */
cparata 0:763b80993db4 4426 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS1, (u8_t *)&valueL, 1) )
cparata 0:763b80993db4 4427 return MEMS_ERROR;
cparata 0:763b80993db4 4428
cparata 0:763b80993db4 4429 valueL &= LSM6DSL_ACC_GYRO_DIFF_FIFO_STATUS1_MASK; //coerce
cparata 0:763b80993db4 4430 valueL = valueL >> LSM6DSL_ACC_GYRO_DIFF_FIFO_STATUS1_POSITION; //mask
cparata 0:763b80993db4 4431
cparata 0:763b80993db4 4432 /* High part from FIFO_STATUS2 */
cparata 0:763b80993db4 4433 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS2, (u8_t *)&valueH, 1) )
cparata 0:763b80993db4 4434 return MEMS_ERROR;
cparata 0:763b80993db4 4435
cparata 0:763b80993db4 4436 valueH &= LSM6DSL_ACC_GYRO_DIFF_FIFO_STATUS2_MASK; //coerce
cparata 0:763b80993db4 4437 valueH = valueH >> LSM6DSL_ACC_GYRO_DIFF_FIFO_STATUS2_POSITION; //mask
cparata 0:763b80993db4 4438
cparata 0:763b80993db4 4439 *value = ((valueH << 8) & 0xFF00) | valueL;
cparata 0:763b80993db4 4440
cparata 0:763b80993db4 4441 return MEMS_SUCCESS;
cparata 0:763b80993db4 4442 }
cparata 0:763b80993db4 4443
cparata 0:763b80993db4 4444 /*******************************************************************************
cparata 0:763b80993db4 4445 * Function Name : LSM6DSL_ACC_GYRO_R_FIFOEmpty
cparata 0:763b80993db4 4446 * Description : Read FIFO_EMPTY
cparata 0:763b80993db4 4447 * Input : Pointer to LSM6DSL_ACC_GYRO_FIFO_EMPTY_t
cparata 0:763b80993db4 4448 * Output : Status of FIFO_EMPTY see LSM6DSL_ACC_GYRO_FIFO_EMPTY_t
cparata 0:763b80993db4 4449 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4450 *******************************************************************************/
cparata 0:763b80993db4 4451 status_t LSM6DSL_ACC_GYRO_R_FIFOEmpty(void *handle, LSM6DSL_ACC_GYRO_FIFO_EMPTY_t *value)
cparata 0:763b80993db4 4452 {
cparata 0:763b80993db4 4453 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS2, (u8_t *)value, 1) )
cparata 0:763b80993db4 4454 return MEMS_ERROR;
cparata 0:763b80993db4 4455
cparata 0:763b80993db4 4456 *value &= LSM6DSL_ACC_GYRO_FIFO_EMPTY_MASK; //mask
cparata 0:763b80993db4 4457
cparata 0:763b80993db4 4458 return MEMS_SUCCESS;
cparata 0:763b80993db4 4459 }
cparata 0:763b80993db4 4460
cparata 0:763b80993db4 4461 /*******************************************************************************
cparata 0:763b80993db4 4462 * Function Name : LSM6DSL_ACC_GYRO_R_FIFOFull
cparata 0:763b80993db4 4463 * Description : Read FIFO_FULL
cparata 0:763b80993db4 4464 * Input : Pointer to LSM6DSL_ACC_GYRO_FIFO_FULL_t
cparata 0:763b80993db4 4465 * Output : Status of FIFO_FULL see LSM6DSL_ACC_GYRO_FIFO_FULL_t
cparata 0:763b80993db4 4466 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4467 *******************************************************************************/
cparata 0:763b80993db4 4468 status_t LSM6DSL_ACC_GYRO_R_FIFOFull(void *handle, LSM6DSL_ACC_GYRO_FIFO_FULL_t *value)
cparata 0:763b80993db4 4469 {
cparata 0:763b80993db4 4470 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS2, (u8_t *)value, 1) )
cparata 0:763b80993db4 4471 return MEMS_ERROR;
cparata 0:763b80993db4 4472
cparata 0:763b80993db4 4473 *value &= LSM6DSL_ACC_GYRO_FIFO_FULL_MASK; //mask
cparata 0:763b80993db4 4474
cparata 0:763b80993db4 4475 return MEMS_SUCCESS;
cparata 0:763b80993db4 4476 }
cparata 0:763b80993db4 4477
cparata 0:763b80993db4 4478 /*******************************************************************************
cparata 0:763b80993db4 4479 * Function Name : LSM6DSL_ACC_GYRO_R_OVERRUN
cparata 0:763b80993db4 4480 * Description : Read OVERRUN
cparata 0:763b80993db4 4481 * Input : Pointer to LSM6DSL_ACC_GYRO_OVERRUN_t
cparata 0:763b80993db4 4482 * Output : Status of OVERRUN see LSM6DSL_ACC_GYRO_OVERRUN_t
cparata 0:763b80993db4 4483 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4484 *******************************************************************************/
cparata 0:763b80993db4 4485 status_t LSM6DSL_ACC_GYRO_R_OVERRUN(void *handle, LSM6DSL_ACC_GYRO_OVERRUN_t *value)
cparata 0:763b80993db4 4486 {
cparata 0:763b80993db4 4487 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS2, (u8_t *)value, 1) )
cparata 0:763b80993db4 4488 return MEMS_ERROR;
cparata 0:763b80993db4 4489
cparata 0:763b80993db4 4490 *value &= LSM6DSL_ACC_GYRO_OVERRUN_MASK; //mask
cparata 0:763b80993db4 4491
cparata 0:763b80993db4 4492 return MEMS_SUCCESS;
cparata 0:763b80993db4 4493 }
cparata 0:763b80993db4 4494
cparata 0:763b80993db4 4495 /*******************************************************************************
cparata 0:763b80993db4 4496 * Function Name : LSM6DSL_ACC_GYRO_R_WaterMark
cparata 0:763b80993db4 4497 * Description : Read WTM
cparata 0:763b80993db4 4498 * Input : Pointer to LSM6DSL_ACC_GYRO_WTM_t
cparata 0:763b80993db4 4499 * Output : Status of WTM see LSM6DSL_ACC_GYRO_WTM_t
cparata 0:763b80993db4 4500 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4501 *******************************************************************************/
cparata 0:763b80993db4 4502 status_t LSM6DSL_ACC_GYRO_R_WaterMark(void *handle, LSM6DSL_ACC_GYRO_WTM_t *value)
cparata 0:763b80993db4 4503 {
cparata 0:763b80993db4 4504 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS2, (u8_t *)value, 1) )
cparata 0:763b80993db4 4505 return MEMS_ERROR;
cparata 0:763b80993db4 4506
cparata 0:763b80993db4 4507 *value &= LSM6DSL_ACC_GYRO_WTM_MASK; //mask
cparata 0:763b80993db4 4508
cparata 0:763b80993db4 4509 return MEMS_SUCCESS;
cparata 0:763b80993db4 4510 }
cparata 0:763b80993db4 4511
cparata 0:763b80993db4 4512 /*******************************************************************************
cparata 0:763b80993db4 4513 * Function Name : LSM6DSL_ACC_GYRO_R_FIFOPattern
cparata 0:763b80993db4 4514 * Description : Read FIFO_PATTERN
cparata 0:763b80993db4 4515 * Input : Pointer to u16_t
cparata 0:763b80993db4 4516 * Output : Status of FIFO_PATTERN
cparata 0:763b80993db4 4517 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4518 *******************************************************************************/
cparata 0:763b80993db4 4519 status_t LSM6DSL_ACC_GYRO_R_FIFOPattern(void *handle, u16_t *value)
cparata 0:763b80993db4 4520 {
cparata 0:763b80993db4 4521 u8_t valueH, valueL;
cparata 0:763b80993db4 4522
cparata 0:763b80993db4 4523 /* Low part from FIFO_STATUS3 */
cparata 0:763b80993db4 4524 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS3, (u8_t *)&valueL, 1) )
cparata 0:763b80993db4 4525 return MEMS_ERROR;
cparata 0:763b80993db4 4526
cparata 0:763b80993db4 4527 valueL &= LSM6DSL_ACC_GYRO_FIFO_STATUS3_PATTERN_MASK; //coerce
cparata 0:763b80993db4 4528 valueL = valueL >> LSM6DSL_ACC_GYRO_FIFO_STATUS3_PATTERN_POSITION; //mask
cparata 0:763b80993db4 4529
cparata 0:763b80993db4 4530 /* High part from FIFO_STATUS4 */
cparata 0:763b80993db4 4531 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_STATUS4, (u8_t *)&valueH, 1) )
cparata 0:763b80993db4 4532 return MEMS_ERROR;
cparata 0:763b80993db4 4533
cparata 0:763b80993db4 4534 valueH &= LSM6DSL_ACC_GYRO_FIFO_STATUS4_PATTERN_MASK; //coerce
cparata 0:763b80993db4 4535 valueH = valueH >> LSM6DSL_ACC_GYRO_FIFO_STATUS4_PATTERN_POSITION; //mask
cparata 0:763b80993db4 4536
cparata 0:763b80993db4 4537 *value = ((valueH << 8) & 0xFF00) | valueL;
cparata 0:763b80993db4 4538
cparata 0:763b80993db4 4539 return MEMS_SUCCESS;
cparata 0:763b80993db4 4540 }
cparata 0:763b80993db4 4541
cparata 0:763b80993db4 4542 /*******************************************************************************
cparata 0:763b80993db4 4543 * Function Name : LSM6DSL_ACC_GYRO_R_SENS_HUB_END
cparata 0:763b80993db4 4544 * Description : Read SENS_HUB_END
cparata 0:763b80993db4 4545 * Input : Pointer to LSM6DSL_ACC_GYRO_SENS_HUB_END_t
cparata 0:763b80993db4 4546 * Output : Status of SENS_HUB_END see LSM6DSL_ACC_GYRO_SENS_HUB_END_t
cparata 0:763b80993db4 4547 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4548 *******************************************************************************/
cparata 0:763b80993db4 4549 status_t LSM6DSL_ACC_GYRO_R_SENS_HUB_END(void *handle, LSM6DSL_ACC_GYRO_SENS_HUB_END_t *value)
cparata 0:763b80993db4 4550 {
cparata 0:763b80993db4 4551 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
cparata 0:763b80993db4 4552 return MEMS_ERROR;
cparata 0:763b80993db4 4553
cparata 0:763b80993db4 4554 *value &= LSM6DSL_ACC_GYRO_SENS_HUB_END_MASK; //mask
cparata 0:763b80993db4 4555
cparata 0:763b80993db4 4556 return MEMS_SUCCESS;
cparata 0:763b80993db4 4557 }
cparata 0:763b80993db4 4558
cparata 0:763b80993db4 4559 /*******************************************************************************
cparata 0:763b80993db4 4560 * Function Name : LSM6DSL_ACC_GYRO_R_SOFT_IRON_END
cparata 0:763b80993db4 4561 * Description : Read SOFT_IRON_END
cparata 0:763b80993db4 4562 * Input : Pointer to LSM6DSL_ACC_GYRO_SOFT_IRON_END_t
cparata 0:763b80993db4 4563 * Output : Status of SOFT_IRON_END see LSM6DSL_ACC_GYRO_SOFT_IRON_END_t
cparata 0:763b80993db4 4564 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4565 *******************************************************************************/
cparata 0:763b80993db4 4566 status_t LSM6DSL_ACC_GYRO_R_SOFT_IRON_END(void *handle, LSM6DSL_ACC_GYRO_SOFT_IRON_END_t *value)
cparata 0:763b80993db4 4567 {
cparata 0:763b80993db4 4568 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
cparata 0:763b80993db4 4569 return MEMS_ERROR;
cparata 0:763b80993db4 4570
cparata 0:763b80993db4 4571 *value &= LSM6DSL_ACC_GYRO_SOFT_IRON_END_MASK; //mask
cparata 0:763b80993db4 4572
cparata 0:763b80993db4 4573 return MEMS_SUCCESS;
cparata 0:763b80993db4 4574 }
cparata 0:763b80993db4 4575
cparata 0:763b80993db4 4576 /*******************************************************************************
cparata 0:763b80993db4 4577 * Function Name : LSM6DSL_ACC_GYRO_R_HardIron
cparata 0:763b80993db4 4578 * Description : Read HI_FAIL
cparata 0:763b80993db4 4579 * Input : Pointer to LSM6DSL_ACC_GYRO_SOFT_HARD_IRON_STAT_t
cparata 0:763b80993db4 4580 * Output : Status of HI_FAIL see LSM6DSL_ACC_GYRO_SOFT_HARD_IRON_STAT_t
cparata 0:763b80993db4 4581 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4582 *******************************************************************************/
cparata 0:763b80993db4 4583 status_t LSM6DSL_ACC_GYRO_R_HardIron(void *handle, LSM6DSL_ACC_GYRO_SOFT_HARD_IRON_STAT_t *value)
cparata 0:763b80993db4 4584 {
cparata 0:763b80993db4 4585 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
cparata 0:763b80993db4 4586 return MEMS_ERROR;
cparata 0:763b80993db4 4587
cparata 0:763b80993db4 4588 *value &= LSM6DSL_ACC_GYRO_HARD_IRON_STAT_MASK; //mask
cparata 0:763b80993db4 4589
cparata 0:763b80993db4 4590 return MEMS_SUCCESS;
cparata 0:763b80993db4 4591 }
cparata 0:763b80993db4 4592
cparata 0:763b80993db4 4593 /*******************************************************************************
cparata 0:763b80993db4 4594 * Function Name : LSM6DSL_ACC_GYRO_R_STEP_OVERFLOW
cparata 0:763b80993db4 4595 * Description : Read STEP_OVERFLOW
cparata 0:763b80993db4 4596 * Input : Pointer to LSM6DSL_ACC_GYRO_STEP_OVERFLOW_t
cparata 0:763b80993db4 4597 * Output : Status of STEP_OVERFLOW see LSM6DSL_ACC_GYRO_STEP_OVERFLOW_t
cparata 0:763b80993db4 4598 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4599 *******************************************************************************/
cparata 0:763b80993db4 4600 status_t LSM6DSL_ACC_GYRO_R_STEP_OVERFLOW(void *handle, LSM6DSL_ACC_GYRO_STEP_OVERFLOW_t *value)
cparata 0:763b80993db4 4601 {
cparata 0:763b80993db4 4602 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
cparata 0:763b80993db4 4603 return MEMS_ERROR;
cparata 0:763b80993db4 4604
cparata 0:763b80993db4 4605 *value &= LSM6DSL_ACC_GYRO_STEP_OVERFLOW_MASK; //mask
cparata 0:763b80993db4 4606
cparata 0:763b80993db4 4607 return MEMS_SUCCESS;
cparata 0:763b80993db4 4608 }
cparata 0:763b80993db4 4609
cparata 0:763b80993db4 4610 /*******************************************************************************
cparata 0:763b80993db4 4611 * Function Name : LSM6DSL_ACC_GYRO_R_STEP_COUNT_DELTA
cparata 0:763b80993db4 4612 * Description : Read STEP_COUNT_DELTA_IA
cparata 0:763b80993db4 4613 * Input : Pointer to LSM6DSL_ACC_GYRO_STEP_COUNT_DELTA_t
cparata 0:763b80993db4 4614 * Output : Status of STEP_COUNT_DELTA_IA see LSM6DSL_ACC_GYRO_STEP_COUNT_DELTA_t
cparata 0:763b80993db4 4615 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4616 *******************************************************************************/
cparata 0:763b80993db4 4617 status_t LSM6DSL_ACC_GYRO_R_STEP_COUNT_DELTA(void *handle, LSM6DSL_ACC_GYRO_STEP_COUNT_DELTA_t *value)
cparata 0:763b80993db4 4618 {
cparata 0:763b80993db4 4619 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
cparata 0:763b80993db4 4620 return MEMS_ERROR;
cparata 0:763b80993db4 4621
cparata 0:763b80993db4 4622 *value &= LSM6DSL_ACC_GYRO_STEP_COUNT_DELTA_MASK; //mask
cparata 0:763b80993db4 4623
cparata 0:763b80993db4 4624 return MEMS_SUCCESS;
cparata 0:763b80993db4 4625 }
cparata 0:763b80993db4 4626
cparata 0:763b80993db4 4627 /*******************************************************************************
cparata 0:763b80993db4 4628 * Function Name : LSM6DSL_ACC_GYRO_R_PEDO_EV_STATUS
cparata 0:763b80993db4 4629 * Description : Read PEDO_EV_STATUS
cparata 0:763b80993db4 4630 * Input : Pointer to LSM6DSL_ACC_GYRO_PEDO_EV_STATUS_t
cparata 0:763b80993db4 4631 * Output : Status of PEDO_EV_STATUS see LSM6DSL_ACC_GYRO_PEDO_EV_STATUS_t
cparata 0:763b80993db4 4632 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4633 *******************************************************************************/
cparata 0:763b80993db4 4634 status_t LSM6DSL_ACC_GYRO_R_PEDO_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_PEDO_EV_STATUS_t *value)
cparata 0:763b80993db4 4635 {
cparata 0:763b80993db4 4636 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
cparata 0:763b80993db4 4637 return MEMS_ERROR;
cparata 0:763b80993db4 4638
cparata 0:763b80993db4 4639 *value &= LSM6DSL_ACC_GYRO_PEDO_EV_STATUS_MASK; //mask
cparata 0:763b80993db4 4640
cparata 0:763b80993db4 4641 return MEMS_SUCCESS;
cparata 0:763b80993db4 4642 }
cparata 0:763b80993db4 4643
cparata 0:763b80993db4 4644 /*******************************************************************************
cparata 0:763b80993db4 4645 * Function Name : LSM6DSL_ACC_GYRO_R_TILT_EV_STATUS
cparata 0:763b80993db4 4646 * Description : Read TILT_EV_STATUS
cparata 0:763b80993db4 4647 * Input : Pointer to LSM6DSL_ACC_GYRO_TILT_EV_STATUS_t
cparata 0:763b80993db4 4648 * Output : Status of TILT_EV_STATUS see LSM6DSL_ACC_GYRO_TILT_EV_STATUS_t
cparata 0:763b80993db4 4649 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4650 *******************************************************************************/
cparata 0:763b80993db4 4651 status_t LSM6DSL_ACC_GYRO_R_TILT_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_TILT_EV_STATUS_t *value)
cparata 0:763b80993db4 4652 {
cparata 0:763b80993db4 4653 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
cparata 0:763b80993db4 4654 return MEMS_ERROR;
cparata 0:763b80993db4 4655
cparata 0:763b80993db4 4656 *value &= LSM6DSL_ACC_GYRO_TILT_EV_STATUS_MASK; //mask
cparata 0:763b80993db4 4657
cparata 0:763b80993db4 4658 return MEMS_SUCCESS;
cparata 0:763b80993db4 4659 }
cparata 0:763b80993db4 4660
cparata 0:763b80993db4 4661 /*******************************************************************************
cparata 0:763b80993db4 4662 * Function Name : LSM6DSL_ACC_GYRO_R_SIGN_MOT_EV_STATUS
cparata 0:763b80993db4 4663 * Description : Read SIGN_MOT_EV_STATUS
cparata 0:763b80993db4 4664 * Input : Pointer to LSM6DSL_ACC_GYRO_SIGN_MOT_EV_STATUS_t
cparata 0:763b80993db4 4665 * Output : Status of SIGN_MOT_EV_STATUS see LSM6DSL_ACC_GYRO_SIGN_MOT_EV_STATUS_t
cparata 0:763b80993db4 4666 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4667 *******************************************************************************/
cparata 0:763b80993db4 4668 status_t LSM6DSL_ACC_GYRO_R_SIGN_MOT_EV_STATUS(void *handle, LSM6DSL_ACC_GYRO_SIGN_MOT_EV_STATUS_t *value)
cparata 0:763b80993db4 4669 {
cparata 0:763b80993db4 4670 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FUNC_SRC, (u8_t *)value, 1) )
cparata 0:763b80993db4 4671 return MEMS_ERROR;
cparata 0:763b80993db4 4672
cparata 0:763b80993db4 4673 *value &= LSM6DSL_ACC_GYRO_SIGN_MOT_EV_STATUS_MASK; //mask
cparata 0:763b80993db4 4674
cparata 0:763b80993db4 4675 return MEMS_SUCCESS;
cparata 0:763b80993db4 4676 }
cparata 0:763b80993db4 4677
cparata 0:763b80993db4 4678 /*******************************************************************************
cparata 0:763b80993db4 4679 * Function Name : LSM6DSL_ACC_GYRO_W_LIR
cparata 0:763b80993db4 4680 * Description : Write LIR
cparata 0:763b80993db4 4681 * Input : LSM6DSL_ACC_GYRO_LIR_t
cparata 0:763b80993db4 4682 * Output : None
cparata 0:763b80993db4 4683 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4684 *******************************************************************************/
cparata 0:763b80993db4 4685 status_t LSM6DSL_ACC_GYRO_W_LIR(void *handle, LSM6DSL_ACC_GYRO_LIR_t newValue)
cparata 0:763b80993db4 4686 {
cparata 0:763b80993db4 4687 u8_t value;
cparata 0:763b80993db4 4688
cparata 0:763b80993db4 4689 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:763b80993db4 4690 return MEMS_ERROR;
cparata 0:763b80993db4 4691
cparata 0:763b80993db4 4692 value &= ~LSM6DSL_ACC_GYRO_LIR_MASK;
cparata 0:763b80993db4 4693 value |= newValue;
cparata 0:763b80993db4 4694
cparata 0:763b80993db4 4695 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:763b80993db4 4696 return MEMS_ERROR;
cparata 0:763b80993db4 4697
cparata 0:763b80993db4 4698 return MEMS_SUCCESS;
cparata 0:763b80993db4 4699 }
cparata 0:763b80993db4 4700
cparata 0:763b80993db4 4701 /*******************************************************************************
cparata 0:763b80993db4 4702 * Function Name : LSM6DSL_ACC_GYRO_R_LIR
cparata 0:763b80993db4 4703 * Description : Read LIR
cparata 0:763b80993db4 4704 * Input : Pointer to LSM6DSL_ACC_GYRO_LIR_t
cparata 0:763b80993db4 4705 * Output : Status of LIR see LSM6DSL_ACC_GYRO_LIR_t
cparata 0:763b80993db4 4706 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4707 *******************************************************************************/
cparata 0:763b80993db4 4708 status_t LSM6DSL_ACC_GYRO_R_LIR(void *handle, LSM6DSL_ACC_GYRO_LIR_t *value)
cparata 0:763b80993db4 4709 {
cparata 0:763b80993db4 4710 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, (u8_t *)value, 1) )
cparata 0:763b80993db4 4711 return MEMS_ERROR;
cparata 0:763b80993db4 4712
cparata 0:763b80993db4 4713 *value &= LSM6DSL_ACC_GYRO_LIR_MASK; //mask
cparata 0:763b80993db4 4714
cparata 0:763b80993db4 4715 return MEMS_SUCCESS;
cparata 0:763b80993db4 4716 }
cparata 0:763b80993db4 4717
cparata 0:763b80993db4 4718 /*******************************************************************************
cparata 0:763b80993db4 4719 * Function Name : LSM6DSL_ACC_GYRO_W_TAP_Z_EN
cparata 0:763b80993db4 4720 * Description : Write TAP_Z_EN
cparata 0:763b80993db4 4721 * Input : LSM6DSL_ACC_GYRO_TAP_Z_EN_t
cparata 0:763b80993db4 4722 * Output : None
cparata 0:763b80993db4 4723 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4724 *******************************************************************************/
cparata 0:763b80993db4 4725 status_t LSM6DSL_ACC_GYRO_W_TAP_Z_EN(void *handle, LSM6DSL_ACC_GYRO_TAP_Z_EN_t newValue)
cparata 0:763b80993db4 4726 {
cparata 0:763b80993db4 4727 u8_t value;
cparata 0:763b80993db4 4728
cparata 0:763b80993db4 4729 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:763b80993db4 4730 return MEMS_ERROR;
cparata 0:763b80993db4 4731
cparata 0:763b80993db4 4732 value &= ~LSM6DSL_ACC_GYRO_TAP_Z_EN_MASK;
cparata 0:763b80993db4 4733 value |= newValue;
cparata 0:763b80993db4 4734
cparata 0:763b80993db4 4735 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:763b80993db4 4736 return MEMS_ERROR;
cparata 0:763b80993db4 4737
cparata 0:763b80993db4 4738 return MEMS_SUCCESS;
cparata 0:763b80993db4 4739 }
cparata 0:763b80993db4 4740
cparata 0:763b80993db4 4741 /*******************************************************************************
cparata 0:763b80993db4 4742 * Function Name : LSM6DSL_ACC_GYRO_R_TAP_Z_EN
cparata 0:763b80993db4 4743 * Description : Read TAP_Z_EN
cparata 0:763b80993db4 4744 * Input : Pointer to LSM6DSL_ACC_GYRO_TAP_Z_EN_t
cparata 0:763b80993db4 4745 * Output : Status of TAP_Z_EN see LSM6DSL_ACC_GYRO_TAP_Z_EN_t
cparata 0:763b80993db4 4746 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4747 *******************************************************************************/
cparata 0:763b80993db4 4748 status_t LSM6DSL_ACC_GYRO_R_TAP_Z_EN(void *handle, LSM6DSL_ACC_GYRO_TAP_Z_EN_t *value)
cparata 0:763b80993db4 4749 {
cparata 0:763b80993db4 4750 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, (u8_t *)value, 1) )
cparata 0:763b80993db4 4751 return MEMS_ERROR;
cparata 0:763b80993db4 4752
cparata 0:763b80993db4 4753 *value &= LSM6DSL_ACC_GYRO_TAP_Z_EN_MASK; //mask
cparata 0:763b80993db4 4754
cparata 0:763b80993db4 4755 return MEMS_SUCCESS;
cparata 0:763b80993db4 4756 }
cparata 0:763b80993db4 4757
cparata 0:763b80993db4 4758 /*******************************************************************************
cparata 0:763b80993db4 4759 * Function Name : LSM6DSL_ACC_GYRO_W_TAP_Y_EN
cparata 0:763b80993db4 4760 * Description : Write TAP_Y_EN
cparata 0:763b80993db4 4761 * Input : LSM6DSL_ACC_GYRO_TAP_Y_EN_t
cparata 0:763b80993db4 4762 * Output : None
cparata 0:763b80993db4 4763 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4764 *******************************************************************************/
cparata 0:763b80993db4 4765 status_t LSM6DSL_ACC_GYRO_W_TAP_Y_EN(void *handle, LSM6DSL_ACC_GYRO_TAP_Y_EN_t newValue)
cparata 0:763b80993db4 4766 {
cparata 0:763b80993db4 4767 u8_t value;
cparata 0:763b80993db4 4768
cparata 0:763b80993db4 4769 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:763b80993db4 4770 return MEMS_ERROR;
cparata 0:763b80993db4 4771
cparata 0:763b80993db4 4772 value &= ~LSM6DSL_ACC_GYRO_TAP_Y_EN_MASK;
cparata 0:763b80993db4 4773 value |= newValue;
cparata 0:763b80993db4 4774
cparata 0:763b80993db4 4775 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:763b80993db4 4776 return MEMS_ERROR;
cparata 0:763b80993db4 4777
cparata 0:763b80993db4 4778 return MEMS_SUCCESS;
cparata 0:763b80993db4 4779 }
cparata 0:763b80993db4 4780
cparata 0:763b80993db4 4781 /*******************************************************************************
cparata 0:763b80993db4 4782 * Function Name : LSM6DSL_ACC_GYRO_R_TAP_Y_EN
cparata 0:763b80993db4 4783 * Description : Read TAP_Y_EN
cparata 0:763b80993db4 4784 * Input : Pointer to LSM6DSL_ACC_GYRO_TAP_Y_EN_t
cparata 0:763b80993db4 4785 * Output : Status of TAP_Y_EN see LSM6DSL_ACC_GYRO_TAP_Y_EN_t
cparata 0:763b80993db4 4786 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4787 *******************************************************************************/
cparata 0:763b80993db4 4788 status_t LSM6DSL_ACC_GYRO_R_TAP_Y_EN(void *handle, LSM6DSL_ACC_GYRO_TAP_Y_EN_t *value)
cparata 0:763b80993db4 4789 {
cparata 0:763b80993db4 4790 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, (u8_t *)value, 1) )
cparata 0:763b80993db4 4791 return MEMS_ERROR;
cparata 0:763b80993db4 4792
cparata 0:763b80993db4 4793 *value &= LSM6DSL_ACC_GYRO_TAP_Y_EN_MASK; //mask
cparata 0:763b80993db4 4794
cparata 0:763b80993db4 4795 return MEMS_SUCCESS;
cparata 0:763b80993db4 4796 }
cparata 0:763b80993db4 4797
cparata 0:763b80993db4 4798 /*******************************************************************************
cparata 0:763b80993db4 4799 * Function Name : LSM6DSL_ACC_GYRO_W_TAP_X_EN
cparata 0:763b80993db4 4800 * Description : Write TAP_X_EN
cparata 0:763b80993db4 4801 * Input : LSM6DSL_ACC_GYRO_TAP_X_EN_t
cparata 0:763b80993db4 4802 * Output : None
cparata 0:763b80993db4 4803 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4804 *******************************************************************************/
cparata 0:763b80993db4 4805 status_t LSM6DSL_ACC_GYRO_W_TAP_X_EN(void *handle, LSM6DSL_ACC_GYRO_TAP_X_EN_t newValue)
cparata 0:763b80993db4 4806 {
cparata 0:763b80993db4 4807 u8_t value;
cparata 0:763b80993db4 4808
cparata 0:763b80993db4 4809 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:763b80993db4 4810 return MEMS_ERROR;
cparata 0:763b80993db4 4811
cparata 0:763b80993db4 4812 value &= ~LSM6DSL_ACC_GYRO_TAP_X_EN_MASK;
cparata 0:763b80993db4 4813 value |= newValue;
cparata 0:763b80993db4 4814
cparata 0:763b80993db4 4815 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:763b80993db4 4816 return MEMS_ERROR;
cparata 0:763b80993db4 4817
cparata 0:763b80993db4 4818 return MEMS_SUCCESS;
cparata 0:763b80993db4 4819 }
cparata 0:763b80993db4 4820
cparata 0:763b80993db4 4821 /*******************************************************************************
cparata 0:763b80993db4 4822 * Function Name : LSM6DSL_ACC_GYRO_R_TAP_X_EN
cparata 0:763b80993db4 4823 * Description : Read TAP_X_EN
cparata 0:763b80993db4 4824 * Input : Pointer to LSM6DSL_ACC_GYRO_TAP_X_EN_t
cparata 0:763b80993db4 4825 * Output : Status of TAP_X_EN see LSM6DSL_ACC_GYRO_TAP_X_EN_t
cparata 0:763b80993db4 4826 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4827 *******************************************************************************/
cparata 0:763b80993db4 4828 status_t LSM6DSL_ACC_GYRO_R_TAP_X_EN(void *handle, LSM6DSL_ACC_GYRO_TAP_X_EN_t *value)
cparata 0:763b80993db4 4829 {
cparata 0:763b80993db4 4830 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, (u8_t *)value, 1) )
cparata 0:763b80993db4 4831 return MEMS_ERROR;
cparata 0:763b80993db4 4832
cparata 0:763b80993db4 4833 *value &= LSM6DSL_ACC_GYRO_TAP_X_EN_MASK; //mask
cparata 0:763b80993db4 4834
cparata 0:763b80993db4 4835 return MEMS_SUCCESS;
cparata 0:763b80993db4 4836 }
cparata 0:763b80993db4 4837
cparata 0:763b80993db4 4838 /*******************************************************************************
cparata 0:763b80993db4 4839 * Function Name : LSM6DSL_ACC_GYRO_W_SLOPE_FDS
cparata 0:763b80993db4 4840 * Description : Write SLOPE_FDS
cparata 0:763b80993db4 4841 * Input : LSM6DSL_ACC_GYRO_SLOPE_FDS_t
cparata 0:763b80993db4 4842 * Output : None
cparata 0:763b80993db4 4843 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4844 *******************************************************************************/
cparata 0:763b80993db4 4845 status_t LSM6DSL_ACC_GYRO_W_SLOPE_FDS(void *handle, LSM6DSL_ACC_GYRO_SLOPE_FDS_t newValue)
cparata 0:763b80993db4 4846 {
cparata 0:763b80993db4 4847 u8_t value;
cparata 0:763b80993db4 4848
cparata 0:763b80993db4 4849 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:763b80993db4 4850 return MEMS_ERROR;
cparata 0:763b80993db4 4851
cparata 0:763b80993db4 4852 value &= ~LSM6DSL_ACC_GYRO_SLOPE_FDS_MASK;
cparata 0:763b80993db4 4853 value |= newValue;
cparata 0:763b80993db4 4854
cparata 0:763b80993db4 4855 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:763b80993db4 4856 return MEMS_ERROR;
cparata 0:763b80993db4 4857
cparata 0:763b80993db4 4858 return MEMS_SUCCESS;
cparata 0:763b80993db4 4859 }
cparata 0:763b80993db4 4860
cparata 0:763b80993db4 4861 /*******************************************************************************
cparata 0:763b80993db4 4862 * Function Name : LSM6DSL_ACC_GYRO_R_SLOPE_FDS
cparata 0:763b80993db4 4863 * Description : Read SLOPE_FDS
cparata 0:763b80993db4 4864 * Input : Pointer to LSM6DSL_ACC_GYRO_SLOPE_FDS_t
cparata 0:763b80993db4 4865 * Output : Status of SLOPE_FDS see LSM6DSL_ACC_GYRO_SLOPE_FDS_t
cparata 0:763b80993db4 4866 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4867 *******************************************************************************/
cparata 0:763b80993db4 4868 status_t LSM6DSL_ACC_GYRO_R_SLOPE_FDS(void *handle, LSM6DSL_ACC_GYRO_SLOPE_FDS_t *value)
cparata 0:763b80993db4 4869 {
cparata 0:763b80993db4 4870 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, (u8_t *)value, 1) )
cparata 0:763b80993db4 4871 return MEMS_ERROR;
cparata 0:763b80993db4 4872
cparata 0:763b80993db4 4873 *value &= LSM6DSL_ACC_GYRO_SLOPE_FDS_MASK; //mask
cparata 0:763b80993db4 4874
cparata 0:763b80993db4 4875 return MEMS_SUCCESS;
cparata 0:763b80993db4 4876 }
cparata 0:763b80993db4 4877
cparata 0:763b80993db4 4878 /*******************************************************************************
cparata 0:763b80993db4 4879 * Function Name : LSM6DSL_ACC_GYRO_W_BASIC_INT
cparata 0:763b80993db4 4880 * Description : Write INTERRUPTS_ENABLE
cparata 0:763b80993db4 4881 * Input : LSM6DSL_ACC_GYRO_INT_EN_t
cparata 0:763b80993db4 4882 * Output : None
cparata 0:763b80993db4 4883 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4884 *******************************************************************************/
cparata 0:763b80993db4 4885 status_t LSM6DSL_ACC_GYRO_W_BASIC_INT(void *handle, LSM6DSL_ACC_GYRO_INT_EN_t newValue)
cparata 0:763b80993db4 4886 {
cparata 0:763b80993db4 4887 u8_t value;
cparata 0:763b80993db4 4888
cparata 0:763b80993db4 4889 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:763b80993db4 4890 return MEMS_ERROR;
cparata 0:763b80993db4 4891
cparata 0:763b80993db4 4892 value &= ~LSM6DSL_ACC_GYRO_INT_EN_MASK;
cparata 0:763b80993db4 4893 value |= newValue;
cparata 0:763b80993db4 4894
cparata 0:763b80993db4 4895 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, &value, 1) )
cparata 0:763b80993db4 4896 return MEMS_ERROR;
cparata 0:763b80993db4 4897
cparata 0:763b80993db4 4898 return MEMS_SUCCESS;
cparata 0:763b80993db4 4899 }
cparata 0:763b80993db4 4900
cparata 0:763b80993db4 4901 /*******************************************************************************
cparata 0:763b80993db4 4902 * Function Name : LSM6DSL_ACC_GYRO_R_BASIC_INT
cparata 0:763b80993db4 4903 * Description : Read INTERRUPTS_ENABLE
cparata 0:763b80993db4 4904 * Input : Pointer to LSM6DSL_ACC_GYRO_INT_EN_t
cparata 0:763b80993db4 4905 * Output : Status of INTERRUPTS_ENABLE see LSM6DSL_ACC_GYRO_INT_EN_t
cparata 0:763b80993db4 4906 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4907 *******************************************************************************/
cparata 0:763b80993db4 4908 status_t LSM6DSL_ACC_GYRO_R_BASIC_INT(void *handle, LSM6DSL_ACC_GYRO_INT_EN_t *value)
cparata 0:763b80993db4 4909 {
cparata 0:763b80993db4 4910 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_CFG1, (u8_t *)value, 1) )
cparata 0:763b80993db4 4911 return MEMS_ERROR;
cparata 0:763b80993db4 4912
cparata 0:763b80993db4 4913 *value &= LSM6DSL_ACC_GYRO_INT_EN_MASK; //mask
cparata 0:763b80993db4 4914
cparata 0:763b80993db4 4915 return MEMS_SUCCESS;
cparata 0:763b80993db4 4916 }
cparata 0:763b80993db4 4917
cparata 0:763b80993db4 4918 /*******************************************************************************
cparata 0:763b80993db4 4919 * Function Name : LSM6DSL_ACC_GYRO_W_TAP_THS
cparata 0:763b80993db4 4920 * Description : Write TAP_THS
cparata 0:763b80993db4 4921 * Input : u8_t
cparata 0:763b80993db4 4922 * Output : None
cparata 0:763b80993db4 4923 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4924 *******************************************************************************/
cparata 0:763b80993db4 4925 status_t LSM6DSL_ACC_GYRO_W_TAP_THS(void *handle, u8_t newValue)
cparata 0:763b80993db4 4926 {
cparata 0:763b80993db4 4927 u8_t value;
cparata 0:763b80993db4 4928
cparata 0:763b80993db4 4929 newValue = newValue << LSM6DSL_ACC_GYRO_TAP_THS_POSITION; //mask
cparata 0:763b80993db4 4930 newValue &= LSM6DSL_ACC_GYRO_TAP_THS_MASK; //coerce
cparata 0:763b80993db4 4931
cparata 0:763b80993db4 4932 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, &value, 1) )
cparata 0:763b80993db4 4933 return MEMS_ERROR;
cparata 0:763b80993db4 4934
cparata 0:763b80993db4 4935 value &= ~LSM6DSL_ACC_GYRO_TAP_THS_MASK;
cparata 0:763b80993db4 4936 value |= newValue;
cparata 0:763b80993db4 4937
cparata 0:763b80993db4 4938 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, &value, 1) )
cparata 0:763b80993db4 4939 return MEMS_ERROR;
cparata 0:763b80993db4 4940
cparata 0:763b80993db4 4941 return MEMS_SUCCESS;
cparata 0:763b80993db4 4942 }
cparata 0:763b80993db4 4943
cparata 0:763b80993db4 4944 /*******************************************************************************
cparata 0:763b80993db4 4945 * Function Name : LSM6DSL_ACC_GYRO_R_TAP_THS
cparata 0:763b80993db4 4946 * Description : Read TAP_THS
cparata 0:763b80993db4 4947 * Input : Pointer to u8_t
cparata 0:763b80993db4 4948 * Output : Status of TAP_THS
cparata 0:763b80993db4 4949 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4950 *******************************************************************************/
cparata 0:763b80993db4 4951 status_t LSM6DSL_ACC_GYRO_R_TAP_THS(void *handle, u8_t *value)
cparata 0:763b80993db4 4952 {
cparata 0:763b80993db4 4953 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, (u8_t *)value, 1) )
cparata 0:763b80993db4 4954 return MEMS_ERROR;
cparata 0:763b80993db4 4955
cparata 0:763b80993db4 4956 *value &= LSM6DSL_ACC_GYRO_TAP_THS_MASK; //coerce
cparata 0:763b80993db4 4957 *value = *value >> LSM6DSL_ACC_GYRO_TAP_THS_POSITION; //mask
cparata 0:763b80993db4 4958
cparata 0:763b80993db4 4959 return MEMS_SUCCESS;
cparata 0:763b80993db4 4960 }
cparata 0:763b80993db4 4961
cparata 0:763b80993db4 4962 /*******************************************************************************
cparata 0:763b80993db4 4963 * Function Name : LSM6DSL_ACC_GYRO_W_SIXD_THS
cparata 0:763b80993db4 4964 * Description : Write SIXD_THS
cparata 0:763b80993db4 4965 * Input : LSM6DSL_ACC_GYRO_SIXD_THS_t
cparata 0:763b80993db4 4966 * Output : None
cparata 0:763b80993db4 4967 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4968 *******************************************************************************/
cparata 0:763b80993db4 4969 status_t LSM6DSL_ACC_GYRO_W_SIXD_THS(void *handle, LSM6DSL_ACC_GYRO_SIXD_THS_t newValue)
cparata 0:763b80993db4 4970 {
cparata 0:763b80993db4 4971 u8_t value;
cparata 0:763b80993db4 4972
cparata 0:763b80993db4 4973 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, &value, 1) )
cparata 0:763b80993db4 4974 return MEMS_ERROR;
cparata 0:763b80993db4 4975
cparata 0:763b80993db4 4976 value &= ~LSM6DSL_ACC_GYRO_SIXD_THS_MASK;
cparata 0:763b80993db4 4977 value |= newValue;
cparata 0:763b80993db4 4978
cparata 0:763b80993db4 4979 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, &value, 1) )
cparata 0:763b80993db4 4980 return MEMS_ERROR;
cparata 0:763b80993db4 4981
cparata 0:763b80993db4 4982 return MEMS_SUCCESS;
cparata 0:763b80993db4 4983 }
cparata 0:763b80993db4 4984
cparata 0:763b80993db4 4985 /*******************************************************************************
cparata 0:763b80993db4 4986 * Function Name : LSM6DSL_ACC_GYRO_R_SIXD_THS
cparata 0:763b80993db4 4987 * Description : Read SIXD_THS
cparata 0:763b80993db4 4988 * Input : Pointer to LSM6DSL_ACC_GYRO_SIXD_THS_t
cparata 0:763b80993db4 4989 * Output : Status of SIXD_THS see LSM6DSL_ACC_GYRO_SIXD_THS_t
cparata 0:763b80993db4 4990 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 4991 *******************************************************************************/
cparata 0:763b80993db4 4992 status_t LSM6DSL_ACC_GYRO_R_SIXD_THS(void *handle, LSM6DSL_ACC_GYRO_SIXD_THS_t *value)
cparata 0:763b80993db4 4993 {
cparata 0:763b80993db4 4994 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, (u8_t *)value, 1) )
cparata 0:763b80993db4 4995 return MEMS_ERROR;
cparata 0:763b80993db4 4996
cparata 0:763b80993db4 4997 *value &= LSM6DSL_ACC_GYRO_SIXD_THS_MASK; //mask
cparata 0:763b80993db4 4998
cparata 0:763b80993db4 4999 return MEMS_SUCCESS;
cparata 0:763b80993db4 5000 }
cparata 0:763b80993db4 5001
cparata 0:763b80993db4 5002 /*******************************************************************************
cparata 0:763b80993db4 5003 * Function Name : LSM6DSL_ACC_GYRO_W_D4D
cparata 0:763b80993db4 5004 * Description : Write D4D_EN
cparata 0:763b80993db4 5005 * Input : LSM6DSL_ACC_GYRO_D4D_t
cparata 0:763b80993db4 5006 * Output : None
cparata 0:763b80993db4 5007 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5008 *******************************************************************************/
cparata 0:763b80993db4 5009 status_t LSM6DSL_ACC_GYRO_W_D4D(void *handle, LSM6DSL_ACC_GYRO_D4D_t newValue)
cparata 0:763b80993db4 5010 {
cparata 0:763b80993db4 5011 u8_t value;
cparata 0:763b80993db4 5012
cparata 0:763b80993db4 5013 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, &value, 1) )
cparata 0:763b80993db4 5014 return MEMS_ERROR;
cparata 0:763b80993db4 5015
cparata 0:763b80993db4 5016 value &= ~LSM6DSL_ACC_GYRO_D4D_MASK;
cparata 0:763b80993db4 5017 value |= newValue;
cparata 0:763b80993db4 5018
cparata 0:763b80993db4 5019 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, &value, 1) )
cparata 0:763b80993db4 5020 return MEMS_ERROR;
cparata 0:763b80993db4 5021
cparata 0:763b80993db4 5022 return MEMS_SUCCESS;
cparata 0:763b80993db4 5023 }
cparata 0:763b80993db4 5024
cparata 0:763b80993db4 5025 /*******************************************************************************
cparata 0:763b80993db4 5026 * Function Name : LSM6DSL_ACC_GYRO_R_D4D
cparata 0:763b80993db4 5027 * Description : Read D4D_EN
cparata 0:763b80993db4 5028 * Input : Pointer to LSM6DSL_ACC_GYRO_D4D_t
cparata 0:763b80993db4 5029 * Output : Status of D4D_EN see LSM6DSL_ACC_GYRO_D4D_t
cparata 0:763b80993db4 5030 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5031 *******************************************************************************/
cparata 0:763b80993db4 5032 status_t LSM6DSL_ACC_GYRO_R_D4D(void *handle, LSM6DSL_ACC_GYRO_D4D_t *value)
cparata 0:763b80993db4 5033 {
cparata 0:763b80993db4 5034 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TAP_THS_6D, (u8_t *)value, 1) )
cparata 0:763b80993db4 5035 return MEMS_ERROR;
cparata 0:763b80993db4 5036
cparata 0:763b80993db4 5037 *value &= LSM6DSL_ACC_GYRO_D4D_MASK; //mask
cparata 0:763b80993db4 5038
cparata 0:763b80993db4 5039 return MEMS_SUCCESS;
cparata 0:763b80993db4 5040 }
cparata 0:763b80993db4 5041
cparata 0:763b80993db4 5042 /*******************************************************************************
cparata 0:763b80993db4 5043 * Function Name : LSM6DSL_ACC_GYRO_W_SHOCK_Duration
cparata 0:763b80993db4 5044 * Description : Write SHOCK
cparata 0:763b80993db4 5045 * Input : u8_t
cparata 0:763b80993db4 5046 * Output : None
cparata 0:763b80993db4 5047 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5048 *******************************************************************************/
cparata 0:763b80993db4 5049 status_t LSM6DSL_ACC_GYRO_W_SHOCK_Duration(void *handle, u8_t newValue)
cparata 0:763b80993db4 5050 {
cparata 0:763b80993db4 5051 u8_t value;
cparata 0:763b80993db4 5052
cparata 0:763b80993db4 5053 newValue = newValue << LSM6DSL_ACC_GYRO_SHOCK_POSITION; //mask
cparata 0:763b80993db4 5054 newValue &= LSM6DSL_ACC_GYRO_SHOCK_MASK; //coerce
cparata 0:763b80993db4 5055
cparata 0:763b80993db4 5056 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, &value, 1) )
cparata 0:763b80993db4 5057 return MEMS_ERROR;
cparata 0:763b80993db4 5058
cparata 0:763b80993db4 5059 value &= ~LSM6DSL_ACC_GYRO_SHOCK_MASK;
cparata 0:763b80993db4 5060 value |= newValue;
cparata 0:763b80993db4 5061
cparata 0:763b80993db4 5062 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, &value, 1) )
cparata 0:763b80993db4 5063 return MEMS_ERROR;
cparata 0:763b80993db4 5064
cparata 0:763b80993db4 5065 return MEMS_SUCCESS;
cparata 0:763b80993db4 5066 }
cparata 0:763b80993db4 5067
cparata 0:763b80993db4 5068 /*******************************************************************************
cparata 0:763b80993db4 5069 * Function Name : LSM6DSL_ACC_GYRO_R_SHOCK_Duration
cparata 0:763b80993db4 5070 * Description : Read SHOCK
cparata 0:763b80993db4 5071 * Input : Pointer to u8_t
cparata 0:763b80993db4 5072 * Output : Status of SHOCK
cparata 0:763b80993db4 5073 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5074 *******************************************************************************/
cparata 0:763b80993db4 5075 status_t LSM6DSL_ACC_GYRO_R_SHOCK_Duration(void *handle, u8_t *value)
cparata 0:763b80993db4 5076 {
cparata 0:763b80993db4 5077 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, (u8_t *)value, 1) )
cparata 0:763b80993db4 5078 return MEMS_ERROR;
cparata 0:763b80993db4 5079
cparata 0:763b80993db4 5080 *value &= LSM6DSL_ACC_GYRO_SHOCK_MASK; //coerce
cparata 0:763b80993db4 5081 *value = *value >> LSM6DSL_ACC_GYRO_SHOCK_POSITION; //mask
cparata 0:763b80993db4 5082
cparata 0:763b80993db4 5083 return MEMS_SUCCESS;
cparata 0:763b80993db4 5084 }
cparata 0:763b80993db4 5085 /*******************************************************************************
cparata 0:763b80993db4 5086 * Function Name : LSM6DSL_ACC_GYRO_W_QUIET_Duration
cparata 0:763b80993db4 5087 * Description : Write QUIET
cparata 0:763b80993db4 5088 * Input : u8_t
cparata 0:763b80993db4 5089 * Output : None
cparata 0:763b80993db4 5090 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5091 *******************************************************************************/
cparata 0:763b80993db4 5092 status_t LSM6DSL_ACC_GYRO_W_QUIET_Duration(void *handle, u8_t newValue)
cparata 0:763b80993db4 5093 {
cparata 0:763b80993db4 5094 u8_t value;
cparata 0:763b80993db4 5095
cparata 0:763b80993db4 5096 newValue = newValue << LSM6DSL_ACC_GYRO_QUIET_POSITION; //mask
cparata 0:763b80993db4 5097 newValue &= LSM6DSL_ACC_GYRO_QUIET_MASK; //coerce
cparata 0:763b80993db4 5098
cparata 0:763b80993db4 5099 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, &value, 1) )
cparata 0:763b80993db4 5100 return MEMS_ERROR;
cparata 0:763b80993db4 5101
cparata 0:763b80993db4 5102 value &= ~LSM6DSL_ACC_GYRO_QUIET_MASK;
cparata 0:763b80993db4 5103 value |= newValue;
cparata 0:763b80993db4 5104
cparata 0:763b80993db4 5105 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, &value, 1) )
cparata 0:763b80993db4 5106 return MEMS_ERROR;
cparata 0:763b80993db4 5107
cparata 0:763b80993db4 5108 return MEMS_SUCCESS;
cparata 0:763b80993db4 5109 }
cparata 0:763b80993db4 5110
cparata 0:763b80993db4 5111 /*******************************************************************************
cparata 0:763b80993db4 5112 * Function Name : LSM6DSL_ACC_GYRO_R_QUIET_Duration
cparata 0:763b80993db4 5113 * Description : Read QUIET
cparata 0:763b80993db4 5114 * Input : Pointer to u8_t
cparata 0:763b80993db4 5115 * Output : Status of QUIET
cparata 0:763b80993db4 5116 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5117 *******************************************************************************/
cparata 0:763b80993db4 5118 status_t LSM6DSL_ACC_GYRO_R_QUIET_Duration(void *handle, u8_t *value)
cparata 0:763b80993db4 5119 {
cparata 0:763b80993db4 5120 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, (u8_t *)value, 1) )
cparata 0:763b80993db4 5121 return MEMS_ERROR;
cparata 0:763b80993db4 5122
cparata 0:763b80993db4 5123 *value &= LSM6DSL_ACC_GYRO_QUIET_MASK; //coerce
cparata 0:763b80993db4 5124 *value = *value >> LSM6DSL_ACC_GYRO_QUIET_POSITION; //mask
cparata 0:763b80993db4 5125
cparata 0:763b80993db4 5126 return MEMS_SUCCESS;
cparata 0:763b80993db4 5127 }
cparata 0:763b80993db4 5128
cparata 0:763b80993db4 5129 /*******************************************************************************
cparata 0:763b80993db4 5130 * Function Name : LSM6DSL_ACC_GYRO_W_DUR
cparata 0:763b80993db4 5131 * Description : Write DUR
cparata 0:763b80993db4 5132 * Input : u8_t
cparata 0:763b80993db4 5133 * Output : None
cparata 0:763b80993db4 5134 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5135 *******************************************************************************/
cparata 0:763b80993db4 5136 status_t LSM6DSL_ACC_GYRO_W_DUR(void *handle, u8_t newValue)
cparata 0:763b80993db4 5137 {
cparata 0:763b80993db4 5138 u8_t value;
cparata 0:763b80993db4 5139
cparata 0:763b80993db4 5140 newValue = newValue << LSM6DSL_ACC_GYRO_DUR_POSITION; //mask
cparata 0:763b80993db4 5141 newValue &= LSM6DSL_ACC_GYRO_DUR_MASK; //coerce
cparata 0:763b80993db4 5142
cparata 0:763b80993db4 5143 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, &value, 1) )
cparata 0:763b80993db4 5144 return MEMS_ERROR;
cparata 0:763b80993db4 5145
cparata 0:763b80993db4 5146 value &= ~LSM6DSL_ACC_GYRO_DUR_MASK;
cparata 0:763b80993db4 5147 value |= newValue;
cparata 0:763b80993db4 5148
cparata 0:763b80993db4 5149 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, &value, 1) )
cparata 0:763b80993db4 5150 return MEMS_ERROR;
cparata 0:763b80993db4 5151
cparata 0:763b80993db4 5152 return MEMS_SUCCESS;
cparata 0:763b80993db4 5153 }
cparata 0:763b80993db4 5154
cparata 0:763b80993db4 5155 /*******************************************************************************
cparata 0:763b80993db4 5156 * Function Name : LSM6DSL_ACC_GYRO_R_DUR
cparata 0:763b80993db4 5157 * Description : Read DUR
cparata 0:763b80993db4 5158 * Input : Pointer to u8_t
cparata 0:763b80993db4 5159 * Output : Status of DUR
cparata 0:763b80993db4 5160 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5161 *******************************************************************************/
cparata 0:763b80993db4 5162 status_t LSM6DSL_ACC_GYRO_R_DUR(void *handle, u8_t *value)
cparata 0:763b80993db4 5163 {
cparata 0:763b80993db4 5164 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_INT_DUR2, (u8_t *)value, 1) )
cparata 0:763b80993db4 5165 return MEMS_ERROR;
cparata 0:763b80993db4 5166
cparata 0:763b80993db4 5167 *value &= LSM6DSL_ACC_GYRO_DUR_MASK; //coerce
cparata 0:763b80993db4 5168 *value = *value >> LSM6DSL_ACC_GYRO_DUR_POSITION; //mask
cparata 0:763b80993db4 5169
cparata 0:763b80993db4 5170 return MEMS_SUCCESS;
cparata 0:763b80993db4 5171 }
cparata 0:763b80993db4 5172
cparata 0:763b80993db4 5173 /*******************************************************************************
cparata 0:763b80993db4 5174 * Function Name : LSM6DSL_ACC_GYRO_W_WK_THS
cparata 0:763b80993db4 5175 * Description : Write WK_THS
cparata 0:763b80993db4 5176 * Input : u8_t
cparata 0:763b80993db4 5177 * Output : None
cparata 0:763b80993db4 5178 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5179 *******************************************************************************/
cparata 0:763b80993db4 5180 status_t LSM6DSL_ACC_GYRO_W_WK_THS(void *handle, u8_t newValue)
cparata 0:763b80993db4 5181 {
cparata 0:763b80993db4 5182 u8_t value;
cparata 0:763b80993db4 5183
cparata 0:763b80993db4 5184 newValue = newValue << LSM6DSL_ACC_GYRO_WK_THS_POSITION; //mask
cparata 0:763b80993db4 5185 newValue &= LSM6DSL_ACC_GYRO_WK_THS_MASK; //coerce
cparata 0:763b80993db4 5186
cparata 0:763b80993db4 5187 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_THS, &value, 1) )
cparata 0:763b80993db4 5188 return MEMS_ERROR;
cparata 0:763b80993db4 5189
cparata 0:763b80993db4 5190 value &= ~LSM6DSL_ACC_GYRO_WK_THS_MASK;
cparata 0:763b80993db4 5191 value |= newValue;
cparata 0:763b80993db4 5192
cparata 0:763b80993db4 5193 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_THS, &value, 1) )
cparata 0:763b80993db4 5194 return MEMS_ERROR;
cparata 0:763b80993db4 5195
cparata 0:763b80993db4 5196 return MEMS_SUCCESS;
cparata 0:763b80993db4 5197 }
cparata 0:763b80993db4 5198
cparata 0:763b80993db4 5199 /*******************************************************************************
cparata 0:763b80993db4 5200 * Function Name : LSM6DSL_ACC_GYRO_R_WK_THS
cparata 0:763b80993db4 5201 * Description : Read WK_THS
cparata 0:763b80993db4 5202 * Input : Pointer to u8_t
cparata 0:763b80993db4 5203 * Output : Status of WK_THS
cparata 0:763b80993db4 5204 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5205 *******************************************************************************/
cparata 0:763b80993db4 5206 status_t LSM6DSL_ACC_GYRO_R_WK_THS(void *handle, u8_t *value)
cparata 0:763b80993db4 5207 {
cparata 0:763b80993db4 5208 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_THS, (u8_t *)value, 1) )
cparata 0:763b80993db4 5209 return MEMS_ERROR;
cparata 0:763b80993db4 5210
cparata 0:763b80993db4 5211 *value &= LSM6DSL_ACC_GYRO_WK_THS_MASK; //coerce
cparata 0:763b80993db4 5212 *value = *value >> LSM6DSL_ACC_GYRO_WK_THS_POSITION; //mask
cparata 0:763b80993db4 5213
cparata 0:763b80993db4 5214 return MEMS_SUCCESS;
cparata 0:763b80993db4 5215 }
cparata 0:763b80993db4 5216
cparata 0:763b80993db4 5217 /*******************************************************************************
cparata 0:763b80993db4 5218 * Function Name : LSM6DSL_ACC_GYRO_W_SINGLE_DOUBLE_TAP_EV
cparata 0:763b80993db4 5219 * Description : Write SINGLE_DOUBLE_TAP
cparata 0:763b80993db4 5220 * Input : LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_t
cparata 0:763b80993db4 5221 * Output : None
cparata 0:763b80993db4 5222 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5223 *******************************************************************************/
cparata 0:763b80993db4 5224 status_t LSM6DSL_ACC_GYRO_W_SINGLE_DOUBLE_TAP_EV(void *handle, LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_t newValue)
cparata 0:763b80993db4 5225 {
cparata 0:763b80993db4 5226 u8_t value;
cparata 0:763b80993db4 5227
cparata 0:763b80993db4 5228 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_THS, &value, 1) )
cparata 0:763b80993db4 5229 return MEMS_ERROR;
cparata 0:763b80993db4 5230
cparata 0:763b80993db4 5231 value &= ~LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_MASK;
cparata 0:763b80993db4 5232 value |= newValue;
cparata 0:763b80993db4 5233
cparata 0:763b80993db4 5234 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_THS, &value, 1) )
cparata 0:763b80993db4 5235 return MEMS_ERROR;
cparata 0:763b80993db4 5236
cparata 0:763b80993db4 5237 return MEMS_SUCCESS;
cparata 0:763b80993db4 5238 }
cparata 0:763b80993db4 5239
cparata 0:763b80993db4 5240 /*******************************************************************************
cparata 0:763b80993db4 5241 * Function Name : LSM6DSL_ACC_GYRO_R_SINGLE_DOUBLE_TAP_EV
cparata 0:763b80993db4 5242 * Description : Read SINGLE_DOUBLE_TAP
cparata 0:763b80993db4 5243 * Input : Pointer to LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_t
cparata 0:763b80993db4 5244 * Output : Status of SINGLE_DOUBLE_TAP see LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_t
cparata 0:763b80993db4 5245 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5246 *******************************************************************************/
cparata 0:763b80993db4 5247 status_t LSM6DSL_ACC_GYRO_R_SINGLE_DOUBLE_TAP_EV(void *handle, LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_t *value)
cparata 0:763b80993db4 5248 {
cparata 0:763b80993db4 5249 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_THS, (u8_t *)value, 1) )
cparata 0:763b80993db4 5250 return MEMS_ERROR;
cparata 0:763b80993db4 5251
cparata 0:763b80993db4 5252 *value &= LSM6DSL_ACC_GYRO_SINGLE_DOUBLE_TAP_MASK; //mask
cparata 0:763b80993db4 5253
cparata 0:763b80993db4 5254 return MEMS_SUCCESS;
cparata 0:763b80993db4 5255 }
cparata 0:763b80993db4 5256
cparata 0:763b80993db4 5257 /*******************************************************************************
cparata 0:763b80993db4 5258 * Function Name : LSM6DSL_ACC_GYRO_W_SLEEP_DUR
cparata 0:763b80993db4 5259 * Description : Write SLEEP_DUR
cparata 0:763b80993db4 5260 * Input : u8_t
cparata 0:763b80993db4 5261 * Output : None
cparata 0:763b80993db4 5262 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5263 *******************************************************************************/
cparata 0:763b80993db4 5264 status_t LSM6DSL_ACC_GYRO_W_SLEEP_DUR(void *handle, u8_t newValue)
cparata 0:763b80993db4 5265 {
cparata 0:763b80993db4 5266 u8_t value;
cparata 0:763b80993db4 5267
cparata 0:763b80993db4 5268 newValue = newValue << LSM6DSL_ACC_GYRO_SLEEP_DUR_POSITION; //mask
cparata 0:763b80993db4 5269 newValue &= LSM6DSL_ACC_GYRO_SLEEP_DUR_MASK; //coerce
cparata 0:763b80993db4 5270
cparata 0:763b80993db4 5271 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
cparata 0:763b80993db4 5272 return MEMS_ERROR;
cparata 0:763b80993db4 5273
cparata 0:763b80993db4 5274 value &= ~LSM6DSL_ACC_GYRO_SLEEP_DUR_MASK;
cparata 0:763b80993db4 5275 value |= newValue;
cparata 0:763b80993db4 5276
cparata 0:763b80993db4 5277 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
cparata 0:763b80993db4 5278 return MEMS_ERROR;
cparata 0:763b80993db4 5279
cparata 0:763b80993db4 5280 return MEMS_SUCCESS;
cparata 0:763b80993db4 5281 }
cparata 0:763b80993db4 5282
cparata 0:763b80993db4 5283 /*******************************************************************************
cparata 0:763b80993db4 5284 * Function Name : LSM6DSL_ACC_GYRO_R_SLEEP_DUR
cparata 0:763b80993db4 5285 * Description : Read SLEEP_DUR
cparata 0:763b80993db4 5286 * Input : Pointer to u8_t
cparata 0:763b80993db4 5287 * Output : Status of SLEEP_DUR
cparata 0:763b80993db4 5288 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5289 *******************************************************************************/
cparata 0:763b80993db4 5290 status_t LSM6DSL_ACC_GYRO_R_SLEEP_DUR(void *handle, u8_t *value)
cparata 0:763b80993db4 5291 {
cparata 0:763b80993db4 5292 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, (u8_t *)value, 1) )
cparata 0:763b80993db4 5293 return MEMS_ERROR;
cparata 0:763b80993db4 5294
cparata 0:763b80993db4 5295 *value &= LSM6DSL_ACC_GYRO_SLEEP_DUR_MASK; //coerce
cparata 0:763b80993db4 5296 *value = *value >> LSM6DSL_ACC_GYRO_SLEEP_DUR_POSITION; //mask
cparata 0:763b80993db4 5297
cparata 0:763b80993db4 5298 return MEMS_SUCCESS;
cparata 0:763b80993db4 5299 }
cparata 0:763b80993db4 5300
cparata 0:763b80993db4 5301 /*******************************************************************************
cparata 0:763b80993db4 5302 * Function Name : LSM6DSL_ACC_GYRO_W_TIMER_HR
cparata 0:763b80993db4 5303 * Description : Write TIMER_HR
cparata 0:763b80993db4 5304 * Input : LSM6DSL_ACC_GYRO_TIMER_HR_t
cparata 0:763b80993db4 5305 * Output : None
cparata 0:763b80993db4 5306 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5307 *******************************************************************************/
cparata 0:763b80993db4 5308 status_t LSM6DSL_ACC_GYRO_W_TIMER_HR(void *handle, LSM6DSL_ACC_GYRO_TIMER_HR_t newValue)
cparata 0:763b80993db4 5309 {
cparata 0:763b80993db4 5310 u8_t value;
cparata 0:763b80993db4 5311
cparata 0:763b80993db4 5312 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
cparata 0:763b80993db4 5313 return MEMS_ERROR;
cparata 0:763b80993db4 5314
cparata 0:763b80993db4 5315 value &= ~LSM6DSL_ACC_GYRO_TIMER_HR_MASK;
cparata 0:763b80993db4 5316 value |= newValue;
cparata 0:763b80993db4 5317
cparata 0:763b80993db4 5318 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
cparata 0:763b80993db4 5319 return MEMS_ERROR;
cparata 0:763b80993db4 5320
cparata 0:763b80993db4 5321 return MEMS_SUCCESS;
cparata 0:763b80993db4 5322 }
cparata 0:763b80993db4 5323
cparata 0:763b80993db4 5324 /*******************************************************************************
cparata 0:763b80993db4 5325 * Function Name : LSM6DSL_ACC_GYRO_R_TIMER_HR
cparata 0:763b80993db4 5326 * Description : Read TIMER_HR
cparata 0:763b80993db4 5327 * Input : Pointer to LSM6DSL_ACC_GYRO_TIMER_HR_t
cparata 0:763b80993db4 5328 * Output : Status of TIMER_HR see LSM6DSL_ACC_GYRO_TIMER_HR_t
cparata 0:763b80993db4 5329 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5330 *******************************************************************************/
cparata 0:763b80993db4 5331 status_t LSM6DSL_ACC_GYRO_R_TIMER_HR(void *handle, LSM6DSL_ACC_GYRO_TIMER_HR_t *value)
cparata 0:763b80993db4 5332 {
cparata 0:763b80993db4 5333 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, (u8_t *)value, 1) )
cparata 0:763b80993db4 5334 return MEMS_ERROR;
cparata 0:763b80993db4 5335
cparata 0:763b80993db4 5336 *value &= LSM6DSL_ACC_GYRO_TIMER_HR_MASK; //mask
cparata 0:763b80993db4 5337
cparata 0:763b80993db4 5338 return MEMS_SUCCESS;
cparata 0:763b80993db4 5339 }
cparata 0:763b80993db4 5340
cparata 0:763b80993db4 5341 /*******************************************************************************
cparata 0:763b80993db4 5342 * Function Name : LSM6DSL_ACC_GYRO_W_WAKE_DUR
cparata 0:763b80993db4 5343 * Description : Write WAKE_DUR
cparata 0:763b80993db4 5344 * Input : u8_t
cparata 0:763b80993db4 5345 * Output : None
cparata 0:763b80993db4 5346 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5347 *******************************************************************************/
cparata 0:763b80993db4 5348 status_t LSM6DSL_ACC_GYRO_W_WAKE_DUR(void *handle, u8_t newValue)
cparata 0:763b80993db4 5349 {
cparata 0:763b80993db4 5350 u8_t value;
cparata 0:763b80993db4 5351
cparata 0:763b80993db4 5352 newValue = newValue << LSM6DSL_ACC_GYRO_WAKE_DUR_POSITION; //mask
cparata 0:763b80993db4 5353 newValue &= LSM6DSL_ACC_GYRO_WAKE_DUR_MASK; //coerce
cparata 0:763b80993db4 5354
cparata 0:763b80993db4 5355 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
cparata 0:763b80993db4 5356 return MEMS_ERROR;
cparata 0:763b80993db4 5357
cparata 0:763b80993db4 5358 value &= ~LSM6DSL_ACC_GYRO_WAKE_DUR_MASK;
cparata 0:763b80993db4 5359 value |= newValue;
cparata 0:763b80993db4 5360
cparata 0:763b80993db4 5361 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
cparata 0:763b80993db4 5362 return MEMS_ERROR;
cparata 0:763b80993db4 5363
cparata 0:763b80993db4 5364 return MEMS_SUCCESS;
cparata 0:763b80993db4 5365 }
cparata 0:763b80993db4 5366
cparata 0:763b80993db4 5367 /*******************************************************************************
cparata 0:763b80993db4 5368 * Function Name : LSM6DSL_ACC_GYRO_R_WAKE_DUR
cparata 0:763b80993db4 5369 * Description : Read WAKE_DUR
cparata 0:763b80993db4 5370 * Input : Pointer to u8_t
cparata 0:763b80993db4 5371 * Output : Status of WAKE_DUR
cparata 0:763b80993db4 5372 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5373 *******************************************************************************/
cparata 0:763b80993db4 5374 status_t LSM6DSL_ACC_GYRO_R_WAKE_DUR(void *handle, u8_t *value)
cparata 0:763b80993db4 5375 {
cparata 0:763b80993db4 5376 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, (u8_t *)value, 1) )
cparata 0:763b80993db4 5377 return MEMS_ERROR;
cparata 0:763b80993db4 5378
cparata 0:763b80993db4 5379 *value &= LSM6DSL_ACC_GYRO_WAKE_DUR_MASK; //coerce
cparata 0:763b80993db4 5380 *value = *value >> LSM6DSL_ACC_GYRO_WAKE_DUR_POSITION; //mask
cparata 0:763b80993db4 5381
cparata 0:763b80993db4 5382 return MEMS_SUCCESS;
cparata 0:763b80993db4 5383 }
cparata 0:763b80993db4 5384
cparata 0:763b80993db4 5385 /*******************************************************************************
cparata 0:763b80993db4 5386 * Function Name : LSM6DSL_ACC_GYRO_W_FF_THS
cparata 0:763b80993db4 5387 * Description : Write FF_THS
cparata 0:763b80993db4 5388 * Input : LSM6DSL_ACC_GYRO_FF_THS_t
cparata 0:763b80993db4 5389 * Output : None
cparata 0:763b80993db4 5390 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5391 *******************************************************************************/
cparata 0:763b80993db4 5392 status_t LSM6DSL_ACC_GYRO_W_FF_THS(void *handle, LSM6DSL_ACC_GYRO_FF_THS_t newValue)
cparata 0:763b80993db4 5393 {
cparata 0:763b80993db4 5394 u8_t value;
cparata 0:763b80993db4 5395
cparata 0:763b80993db4 5396 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FREE_FALL, &value, 1) )
cparata 0:763b80993db4 5397 return MEMS_ERROR;
cparata 0:763b80993db4 5398
cparata 0:763b80993db4 5399 value &= ~LSM6DSL_ACC_GYRO_FF_THS_MASK;
cparata 0:763b80993db4 5400 value |= newValue;
cparata 0:763b80993db4 5401
cparata 0:763b80993db4 5402 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FREE_FALL, &value, 1) )
cparata 0:763b80993db4 5403 return MEMS_ERROR;
cparata 0:763b80993db4 5404
cparata 0:763b80993db4 5405 return MEMS_SUCCESS;
cparata 0:763b80993db4 5406 }
cparata 0:763b80993db4 5407
cparata 0:763b80993db4 5408 /*******************************************************************************
cparata 0:763b80993db4 5409 * Function Name : LSM6DSL_ACC_GYRO_R_FF_THS
cparata 0:763b80993db4 5410 * Description : Read FF_THS
cparata 0:763b80993db4 5411 * Input : Pointer to LSM6DSL_ACC_GYRO_FF_THS_t
cparata 0:763b80993db4 5412 * Output : Status of FF_THS see LSM6DSL_ACC_GYRO_FF_THS_t
cparata 0:763b80993db4 5413 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5414 *******************************************************************************/
cparata 0:763b80993db4 5415 status_t LSM6DSL_ACC_GYRO_R_FF_THS(void *handle, LSM6DSL_ACC_GYRO_FF_THS_t *value)
cparata 0:763b80993db4 5416 {
cparata 0:763b80993db4 5417 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FREE_FALL, (u8_t *)value, 1) )
cparata 0:763b80993db4 5418 return MEMS_ERROR;
cparata 0:763b80993db4 5419
cparata 0:763b80993db4 5420 *value &= LSM6DSL_ACC_GYRO_FF_THS_MASK; //mask
cparata 0:763b80993db4 5421
cparata 0:763b80993db4 5422 return MEMS_SUCCESS;
cparata 0:763b80993db4 5423 }
cparata 0:763b80993db4 5424
cparata 0:763b80993db4 5425 /*******************************************************************************
cparata 0:763b80993db4 5426 * Function Name : LSM6DSL_ACC_GYRO_W_FF_Duration
cparata 0:763b80993db4 5427 * Description : Write FF_DUR
cparata 0:763b80993db4 5428 * Input : u8_t
cparata 0:763b80993db4 5429 * Output : None
cparata 0:763b80993db4 5430 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5431 *******************************************************************************/
cparata 0:763b80993db4 5432 status_t LSM6DSL_ACC_GYRO_W_FF_Duration(void *handle, u8_t newValue)
cparata 0:763b80993db4 5433 {
cparata 0:763b80993db4 5434 u8_t valueH, valueL;
cparata 0:763b80993db4 5435 u8_t value;
cparata 0:763b80993db4 5436
cparata 0:763b80993db4 5437 valueL = newValue & 0x1F;
cparata 0:763b80993db4 5438 valueH = (newValue >> 5) & 0x1;
cparata 0:763b80993db4 5439
cparata 0:763b80993db4 5440 /* Low part in FREE_FALL reg */
cparata 0:763b80993db4 5441 valueL = valueL << LSM6DSL_ACC_GYRO_FF_FREE_FALL_DUR_POSITION; //mask
cparata 0:763b80993db4 5442 valueL &= LSM6DSL_ACC_GYRO_FF_FREE_FALL_DUR_MASK; //coerce
cparata 0:763b80993db4 5443
cparata 0:763b80993db4 5444 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FREE_FALL, &value, 1) )
cparata 0:763b80993db4 5445 return MEMS_ERROR;
cparata 0:763b80993db4 5446
cparata 0:763b80993db4 5447 value &= ~LSM6DSL_ACC_GYRO_FF_FREE_FALL_DUR_MASK;
cparata 0:763b80993db4 5448 value |= valueL;
cparata 0:763b80993db4 5449
cparata 0:763b80993db4 5450 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_FREE_FALL, &value, 1) )
cparata 0:763b80993db4 5451 return MEMS_ERROR;
cparata 0:763b80993db4 5452
cparata 0:763b80993db4 5453 /* High part in WAKE_UP_DUR reg */
cparata 0:763b80993db4 5454 valueH = valueH << LSM6DSL_ACC_GYRO_FF_WAKE_UP_DUR_POSITION; //mask
cparata 0:763b80993db4 5455 valueH &= LSM6DSL_ACC_GYRO_FF_WAKE_UP_DUR_MASK; //coerce
cparata 0:763b80993db4 5456
cparata 0:763b80993db4 5457 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
cparata 0:763b80993db4 5458 return MEMS_ERROR;
cparata 0:763b80993db4 5459
cparata 0:763b80993db4 5460 value &= ~LSM6DSL_ACC_GYRO_FF_WAKE_UP_DUR_MASK;
cparata 0:763b80993db4 5461 value |= valueH;
cparata 0:763b80993db4 5462
cparata 0:763b80993db4 5463 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, &value, 1) )
cparata 0:763b80993db4 5464 return MEMS_ERROR;
cparata 0:763b80993db4 5465
cparata 0:763b80993db4 5466 return MEMS_SUCCESS;
cparata 0:763b80993db4 5467 }
cparata 0:763b80993db4 5468
cparata 0:763b80993db4 5469 /*******************************************************************************
cparata 0:763b80993db4 5470 * Function Name : LSM6DSL_ACC_GYRO_R_FF_Duration
cparata 0:763b80993db4 5471 * Description : Read FF_DUR
cparata 0:763b80993db4 5472 * Input : Pointer to u8_t
cparata 0:763b80993db4 5473 * Output : Status of FF_DUR
cparata 0:763b80993db4 5474 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5475 *******************************************************************************/
cparata 0:763b80993db4 5476 status_t LSM6DSL_ACC_GYRO_R_FF_Duration(void *handle, u8_t *value)
cparata 0:763b80993db4 5477 {
cparata 0:763b80993db4 5478 u8_t valueH, valueL;
cparata 0:763b80993db4 5479
cparata 0:763b80993db4 5480 /* Low part from FREE_FALL reg */
cparata 0:763b80993db4 5481 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FREE_FALL, (u8_t *)&valueL, 1) )
cparata 0:763b80993db4 5482 return MEMS_ERROR;
cparata 0:763b80993db4 5483
cparata 0:763b80993db4 5484 valueL &= LSM6DSL_ACC_GYRO_FF_FREE_FALL_DUR_MASK; //coerce
cparata 0:763b80993db4 5485 valueL = valueL >> LSM6DSL_ACC_GYRO_FF_FREE_FALL_DUR_POSITION; //mask
cparata 0:763b80993db4 5486
cparata 0:763b80993db4 5487 /* High part from WAKE_UP_DUR reg */
cparata 0:763b80993db4 5488 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_WAKE_UP_DUR, (u8_t *)&valueH, 1) )
cparata 0:763b80993db4 5489 return MEMS_ERROR;
cparata 0:763b80993db4 5490
cparata 0:763b80993db4 5491 valueH &= LSM6DSL_ACC_GYRO_FF_WAKE_UP_DUR_MASK; //coerce
cparata 0:763b80993db4 5492 valueH = valueH >> LSM6DSL_ACC_GYRO_FF_WAKE_UP_DUR_POSITION; //mask
cparata 0:763b80993db4 5493
cparata 0:763b80993db4 5494 *value = ((valueH << 5) & 0x20) | valueL;
cparata 0:763b80993db4 5495
cparata 0:763b80993db4 5496 return MEMS_SUCCESS;
cparata 0:763b80993db4 5497 }
cparata 0:763b80993db4 5498
cparata 0:763b80993db4 5499 /*******************************************************************************
cparata 0:763b80993db4 5500 * Function Name : LSM6DSL_ACC_GYRO_W_TimerEvRouteInt1
cparata 0:763b80993db4 5501 * Description : Write INT1_TIMER
cparata 0:763b80993db4 5502 * Input : LSM6DSL_ACC_GYRO_INT1_TIMER_t
cparata 0:763b80993db4 5503 * Output : None
cparata 0:763b80993db4 5504 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5505 *******************************************************************************/
cparata 0:763b80993db4 5506 status_t LSM6DSL_ACC_GYRO_W_TimerEvRouteInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_TIMER_t newValue)
cparata 0:763b80993db4 5507 {
cparata 0:763b80993db4 5508 u8_t value;
cparata 0:763b80993db4 5509
cparata 0:763b80993db4 5510 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:763b80993db4 5511 return MEMS_ERROR;
cparata 0:763b80993db4 5512
cparata 0:763b80993db4 5513 value &= ~LSM6DSL_ACC_GYRO_INT1_TIMER_MASK;
cparata 0:763b80993db4 5514 value |= newValue;
cparata 0:763b80993db4 5515
cparata 0:763b80993db4 5516 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:763b80993db4 5517 return MEMS_ERROR;
cparata 0:763b80993db4 5518
cparata 0:763b80993db4 5519 return MEMS_SUCCESS;
cparata 0:763b80993db4 5520 }
cparata 0:763b80993db4 5521
cparata 0:763b80993db4 5522 /*******************************************************************************
cparata 0:763b80993db4 5523 * Function Name : LSM6DSL_ACC_GYRO_R_TimerEvRouteInt1
cparata 0:763b80993db4 5524 * Description : Read INT1_TIMER
cparata 0:763b80993db4 5525 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_TIMER_t
cparata 0:763b80993db4 5526 * Output : Status of INT1_TIMER see LSM6DSL_ACC_GYRO_INT1_TIMER_t
cparata 0:763b80993db4 5527 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5528 *******************************************************************************/
cparata 0:763b80993db4 5529 status_t LSM6DSL_ACC_GYRO_R_TimerEvRouteInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_TIMER_t *value)
cparata 0:763b80993db4 5530 {
cparata 0:763b80993db4 5531 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
cparata 0:763b80993db4 5532 return MEMS_ERROR;
cparata 0:763b80993db4 5533
cparata 0:763b80993db4 5534 *value &= LSM6DSL_ACC_GYRO_INT1_TIMER_MASK; //mask
cparata 0:763b80993db4 5535
cparata 0:763b80993db4 5536 return MEMS_SUCCESS;
cparata 0:763b80993db4 5537 }
cparata 0:763b80993db4 5538
cparata 0:763b80993db4 5539 /*******************************************************************************
cparata 0:763b80993db4 5540 * Function Name : LSM6DSL_ACC_GYRO_W_TiltEvOnInt1
cparata 0:763b80993db4 5541 * Description : Write INT1_TILT
cparata 0:763b80993db4 5542 * Input : LSM6DSL_ACC_GYRO_INT1_TILT_t
cparata 0:763b80993db4 5543 * Output : None
cparata 0:763b80993db4 5544 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5545 *******************************************************************************/
cparata 0:763b80993db4 5546 status_t LSM6DSL_ACC_GYRO_W_TiltEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_TILT_t newValue)
cparata 0:763b80993db4 5547 {
cparata 0:763b80993db4 5548 u8_t value;
cparata 0:763b80993db4 5549
cparata 0:763b80993db4 5550 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:763b80993db4 5551 return MEMS_ERROR;
cparata 0:763b80993db4 5552
cparata 0:763b80993db4 5553 value &= ~LSM6DSL_ACC_GYRO_INT1_TILT_MASK;
cparata 0:763b80993db4 5554 value |= newValue;
cparata 0:763b80993db4 5555
cparata 0:763b80993db4 5556 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:763b80993db4 5557 return MEMS_ERROR;
cparata 0:763b80993db4 5558
cparata 0:763b80993db4 5559 return MEMS_SUCCESS;
cparata 0:763b80993db4 5560 }
cparata 0:763b80993db4 5561
cparata 0:763b80993db4 5562 /*******************************************************************************
cparata 0:763b80993db4 5563 * Function Name : LSM6DSL_ACC_GYRO_R_TiltEvOnInt1
cparata 0:763b80993db4 5564 * Description : Read INT1_TILT
cparata 0:763b80993db4 5565 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_TILT_t
cparata 0:763b80993db4 5566 * Output : Status of INT1_TILT see LSM6DSL_ACC_GYRO_INT1_TILT_t
cparata 0:763b80993db4 5567 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5568 *******************************************************************************/
cparata 0:763b80993db4 5569 status_t LSM6DSL_ACC_GYRO_R_TiltEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_TILT_t *value)
cparata 0:763b80993db4 5570 {
cparata 0:763b80993db4 5571 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
cparata 0:763b80993db4 5572 return MEMS_ERROR;
cparata 0:763b80993db4 5573
cparata 0:763b80993db4 5574 *value &= LSM6DSL_ACC_GYRO_INT1_TILT_MASK; //mask
cparata 0:763b80993db4 5575
cparata 0:763b80993db4 5576 return MEMS_SUCCESS;
cparata 0:763b80993db4 5577 }
cparata 0:763b80993db4 5578
cparata 0:763b80993db4 5579 /*******************************************************************************
cparata 0:763b80993db4 5580 * Function Name : LSM6DSL_ACC_GYRO_W_6DEvOnInt1
cparata 0:763b80993db4 5581 * Description : Write INT1_6D
cparata 0:763b80993db4 5582 * Input : LSM6DSL_ACC_GYRO_INT1_6D_t
cparata 0:763b80993db4 5583 * Output : None
cparata 0:763b80993db4 5584 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5585 *******************************************************************************/
cparata 0:763b80993db4 5586 status_t LSM6DSL_ACC_GYRO_W_6DEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_6D_t newValue)
cparata 0:763b80993db4 5587 {
cparata 0:763b80993db4 5588 u8_t value;
cparata 0:763b80993db4 5589
cparata 0:763b80993db4 5590 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:763b80993db4 5591 return MEMS_ERROR;
cparata 0:763b80993db4 5592
cparata 0:763b80993db4 5593 value &= ~LSM6DSL_ACC_GYRO_INT1_6D_MASK;
cparata 0:763b80993db4 5594 value |= newValue;
cparata 0:763b80993db4 5595
cparata 0:763b80993db4 5596 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:763b80993db4 5597 return MEMS_ERROR;
cparata 0:763b80993db4 5598
cparata 0:763b80993db4 5599 return MEMS_SUCCESS;
cparata 0:763b80993db4 5600 }
cparata 0:763b80993db4 5601
cparata 0:763b80993db4 5602 /*******************************************************************************
cparata 0:763b80993db4 5603 * Function Name : LSM6DSL_ACC_GYRO_R_6DEvOnInt1
cparata 0:763b80993db4 5604 * Description : Read INT1_6D
cparata 0:763b80993db4 5605 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_6D_t
cparata 0:763b80993db4 5606 * Output : Status of INT1_6D see LSM6DSL_ACC_GYRO_INT1_6D_t
cparata 0:763b80993db4 5607 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5608 *******************************************************************************/
cparata 0:763b80993db4 5609 status_t LSM6DSL_ACC_GYRO_R_6DEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_6D_t *value)
cparata 0:763b80993db4 5610 {
cparata 0:763b80993db4 5611 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
cparata 0:763b80993db4 5612 return MEMS_ERROR;
cparata 0:763b80993db4 5613
cparata 0:763b80993db4 5614 *value &= LSM6DSL_ACC_GYRO_INT1_6D_MASK; //mask
cparata 0:763b80993db4 5615
cparata 0:763b80993db4 5616 return MEMS_SUCCESS;
cparata 0:763b80993db4 5617 }
cparata 0:763b80993db4 5618
cparata 0:763b80993db4 5619 /*******************************************************************************
cparata 0:763b80993db4 5620 * Function Name : LSM6DSL_ACC_GYRO_W_TapEvOnInt1
cparata 0:763b80993db4 5621 * Description : Write INT1_TAP
cparata 0:763b80993db4 5622 * Input : LSM6DSL_ACC_GYRO_INT1_TAP_t
cparata 0:763b80993db4 5623 * Output : None
cparata 0:763b80993db4 5624 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5625 *******************************************************************************/
cparata 0:763b80993db4 5626 status_t LSM6DSL_ACC_GYRO_W_TapEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_TAP_t newValue)
cparata 0:763b80993db4 5627 {
cparata 0:763b80993db4 5628 u8_t value;
cparata 0:763b80993db4 5629
cparata 0:763b80993db4 5630 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:763b80993db4 5631 return MEMS_ERROR;
cparata 0:763b80993db4 5632
cparata 0:763b80993db4 5633 value &= ~LSM6DSL_ACC_GYRO_INT1_TAP_MASK;
cparata 0:763b80993db4 5634 value |= newValue;
cparata 0:763b80993db4 5635
cparata 0:763b80993db4 5636 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:763b80993db4 5637 return MEMS_ERROR;
cparata 0:763b80993db4 5638
cparata 0:763b80993db4 5639 return MEMS_SUCCESS;
cparata 0:763b80993db4 5640 }
cparata 0:763b80993db4 5641
cparata 0:763b80993db4 5642 /*******************************************************************************
cparata 0:763b80993db4 5643 * Function Name : LSM6DSL_ACC_GYRO_R_TapEvOnInt1
cparata 0:763b80993db4 5644 * Description : Read INT1_TAP
cparata 0:763b80993db4 5645 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_TAP_t
cparata 0:763b80993db4 5646 * Output : Status of INT1_TAP see LSM6DSL_ACC_GYRO_INT1_TAP_t
cparata 0:763b80993db4 5647 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5648 *******************************************************************************/
cparata 0:763b80993db4 5649 status_t LSM6DSL_ACC_GYRO_R_TapEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_TAP_t *value)
cparata 0:763b80993db4 5650 {
cparata 0:763b80993db4 5651 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
cparata 0:763b80993db4 5652 return MEMS_ERROR;
cparata 0:763b80993db4 5653
cparata 0:763b80993db4 5654 *value &= LSM6DSL_ACC_GYRO_INT1_TAP_MASK; //mask
cparata 0:763b80993db4 5655
cparata 0:763b80993db4 5656 return MEMS_SUCCESS;
cparata 0:763b80993db4 5657 }
cparata 0:763b80993db4 5658
cparata 0:763b80993db4 5659 /*******************************************************************************
cparata 0:763b80993db4 5660 * Function Name : LSM6DSL_ACC_GYRO_W_FFEvOnInt1
cparata 0:763b80993db4 5661 * Description : Write INT1_FF
cparata 0:763b80993db4 5662 * Input : LSM6DSL_ACC_GYRO_INT1_FF_t
cparata 0:763b80993db4 5663 * Output : None
cparata 0:763b80993db4 5664 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5665 *******************************************************************************/
cparata 0:763b80993db4 5666 status_t LSM6DSL_ACC_GYRO_W_FFEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_FF_t newValue)
cparata 0:763b80993db4 5667 {
cparata 0:763b80993db4 5668 u8_t value;
cparata 0:763b80993db4 5669
cparata 0:763b80993db4 5670 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:763b80993db4 5671 return MEMS_ERROR;
cparata 0:763b80993db4 5672
cparata 0:763b80993db4 5673 value &= ~LSM6DSL_ACC_GYRO_INT1_FF_MASK;
cparata 0:763b80993db4 5674 value |= newValue;
cparata 0:763b80993db4 5675
cparata 0:763b80993db4 5676 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:763b80993db4 5677 return MEMS_ERROR;
cparata 0:763b80993db4 5678
cparata 0:763b80993db4 5679 return MEMS_SUCCESS;
cparata 0:763b80993db4 5680 }
cparata 0:763b80993db4 5681
cparata 0:763b80993db4 5682 /*******************************************************************************
cparata 0:763b80993db4 5683 * Function Name : LSM6DSL_ACC_GYRO_R_FFEvOnInt1
cparata 0:763b80993db4 5684 * Description : Read INT1_FF
cparata 0:763b80993db4 5685 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_FF_t
cparata 0:763b80993db4 5686 * Output : Status of INT1_FF see LSM6DSL_ACC_GYRO_INT1_FF_t
cparata 0:763b80993db4 5687 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5688 *******************************************************************************/
cparata 0:763b80993db4 5689 status_t LSM6DSL_ACC_GYRO_R_FFEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_FF_t *value)
cparata 0:763b80993db4 5690 {
cparata 0:763b80993db4 5691 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
cparata 0:763b80993db4 5692 return MEMS_ERROR;
cparata 0:763b80993db4 5693
cparata 0:763b80993db4 5694 *value &= LSM6DSL_ACC_GYRO_INT1_FF_MASK; //mask
cparata 0:763b80993db4 5695
cparata 0:763b80993db4 5696 return MEMS_SUCCESS;
cparata 0:763b80993db4 5697 }
cparata 0:763b80993db4 5698
cparata 0:763b80993db4 5699 /*******************************************************************************
cparata 0:763b80993db4 5700 * Function Name : LSM6DSL_ACC_GYRO_W_WUEvOnInt1
cparata 0:763b80993db4 5701 * Description : Write INT1_WU
cparata 0:763b80993db4 5702 * Input : LSM6DSL_ACC_GYRO_INT1_WU_t
cparata 0:763b80993db4 5703 * Output : None
cparata 0:763b80993db4 5704 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5705 *******************************************************************************/
cparata 0:763b80993db4 5706 status_t LSM6DSL_ACC_GYRO_W_WUEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_WU_t newValue)
cparata 0:763b80993db4 5707 {
cparata 0:763b80993db4 5708 u8_t value;
cparata 0:763b80993db4 5709
cparata 0:763b80993db4 5710 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:763b80993db4 5711 return MEMS_ERROR;
cparata 0:763b80993db4 5712
cparata 0:763b80993db4 5713 value &= ~LSM6DSL_ACC_GYRO_INT1_WU_MASK;
cparata 0:763b80993db4 5714 value |= newValue;
cparata 0:763b80993db4 5715
cparata 0:763b80993db4 5716 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:763b80993db4 5717 return MEMS_ERROR;
cparata 0:763b80993db4 5718
cparata 0:763b80993db4 5719 return MEMS_SUCCESS;
cparata 0:763b80993db4 5720 }
cparata 0:763b80993db4 5721
cparata 0:763b80993db4 5722 /*******************************************************************************
cparata 0:763b80993db4 5723 * Function Name : LSM6DSL_ACC_GYRO_R_WUEvOnInt1
cparata 0:763b80993db4 5724 * Description : Read INT1_WU
cparata 0:763b80993db4 5725 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_WU_t
cparata 0:763b80993db4 5726 * Output : Status of INT1_WU see LSM6DSL_ACC_GYRO_INT1_WU_t
cparata 0:763b80993db4 5727 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5728 *******************************************************************************/
cparata 0:763b80993db4 5729 status_t LSM6DSL_ACC_GYRO_R_WUEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_WU_t *value)
cparata 0:763b80993db4 5730 {
cparata 0:763b80993db4 5731 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
cparata 0:763b80993db4 5732 return MEMS_ERROR;
cparata 0:763b80993db4 5733
cparata 0:763b80993db4 5734 *value &= LSM6DSL_ACC_GYRO_INT1_WU_MASK; //mask
cparata 0:763b80993db4 5735
cparata 0:763b80993db4 5736 return MEMS_SUCCESS;
cparata 0:763b80993db4 5737 }
cparata 0:763b80993db4 5738
cparata 0:763b80993db4 5739 /*******************************************************************************
cparata 0:763b80993db4 5740 * Function Name : LSM6DSL_ACC_GYRO_W_SingleTapOnInt1
cparata 0:763b80993db4 5741 * Description : Write INT1_SINGLE_TAP
cparata 0:763b80993db4 5742 * Input : LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_t
cparata 0:763b80993db4 5743 * Output : None
cparata 0:763b80993db4 5744 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5745 *******************************************************************************/
cparata 0:763b80993db4 5746 status_t LSM6DSL_ACC_GYRO_W_SingleTapOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_t newValue)
cparata 0:763b80993db4 5747 {
cparata 0:763b80993db4 5748 u8_t value;
cparata 0:763b80993db4 5749
cparata 0:763b80993db4 5750 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:763b80993db4 5751 return MEMS_ERROR;
cparata 0:763b80993db4 5752
cparata 0:763b80993db4 5753 value &= ~LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_MASK;
cparata 0:763b80993db4 5754 value |= newValue;
cparata 0:763b80993db4 5755
cparata 0:763b80993db4 5756 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:763b80993db4 5757 return MEMS_ERROR;
cparata 0:763b80993db4 5758
cparata 0:763b80993db4 5759 return MEMS_SUCCESS;
cparata 0:763b80993db4 5760 }
cparata 0:763b80993db4 5761
cparata 0:763b80993db4 5762 /*******************************************************************************
cparata 0:763b80993db4 5763 * Function Name : LSM6DSL_ACC_GYRO_R_SingleTapOnInt1
cparata 0:763b80993db4 5764 * Description : Read INT1_SINGLE_TAP
cparata 0:763b80993db4 5765 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_t
cparata 0:763b80993db4 5766 * Output : Status of INT1_SINGLE_TAP see LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_t
cparata 0:763b80993db4 5767 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5768 *******************************************************************************/
cparata 0:763b80993db4 5769 status_t LSM6DSL_ACC_GYRO_R_SingleTapOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_t *value)
cparata 0:763b80993db4 5770 {
cparata 0:763b80993db4 5771 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
cparata 0:763b80993db4 5772 return MEMS_ERROR;
cparata 0:763b80993db4 5773
cparata 0:763b80993db4 5774 *value &= LSM6DSL_ACC_GYRO_INT1_SINGLE_TAP_MASK; //mask
cparata 0:763b80993db4 5775
cparata 0:763b80993db4 5776 return MEMS_SUCCESS;
cparata 0:763b80993db4 5777 }
cparata 0:763b80993db4 5778
cparata 0:763b80993db4 5779 /*******************************************************************************
cparata 0:763b80993db4 5780 * Function Name : LSM6DSL_ACC_GYRO_W_SleepEvOnInt1
cparata 0:763b80993db4 5781 * Description : Write INT1_SLEEP
cparata 0:763b80993db4 5782 * Input : LSM6DSL_ACC_GYRO_INT1_SLEEP_t
cparata 0:763b80993db4 5783 * Output : None
cparata 0:763b80993db4 5784 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5785 *******************************************************************************/
cparata 0:763b80993db4 5786 status_t LSM6DSL_ACC_GYRO_W_SleepEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_SLEEP_t newValue)
cparata 0:763b80993db4 5787 {
cparata 0:763b80993db4 5788 u8_t value;
cparata 0:763b80993db4 5789
cparata 0:763b80993db4 5790 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:763b80993db4 5791 return MEMS_ERROR;
cparata 0:763b80993db4 5792
cparata 0:763b80993db4 5793 value &= ~LSM6DSL_ACC_GYRO_INT1_SLEEP_MASK;
cparata 0:763b80993db4 5794 value |= newValue;
cparata 0:763b80993db4 5795
cparata 0:763b80993db4 5796 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, &value, 1) )
cparata 0:763b80993db4 5797 return MEMS_ERROR;
cparata 0:763b80993db4 5798
cparata 0:763b80993db4 5799 return MEMS_SUCCESS;
cparata 0:763b80993db4 5800 }
cparata 0:763b80993db4 5801
cparata 0:763b80993db4 5802 /*******************************************************************************
cparata 0:763b80993db4 5803 * Function Name : LSM6DSL_ACC_GYRO_R_SleepEvOnInt1
cparata 0:763b80993db4 5804 * Description : Read INT1_SLEEP
cparata 0:763b80993db4 5805 * Input : Pointer to LSM6DSL_ACC_GYRO_INT1_SLEEP_t
cparata 0:763b80993db4 5806 * Output : Status of INT1_SLEEP see LSM6DSL_ACC_GYRO_INT1_SLEEP_t
cparata 0:763b80993db4 5807 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5808 *******************************************************************************/
cparata 0:763b80993db4 5809 status_t LSM6DSL_ACC_GYRO_R_SleepEvOnInt1(void *handle, LSM6DSL_ACC_GYRO_INT1_SLEEP_t *value)
cparata 0:763b80993db4 5810 {
cparata 0:763b80993db4 5811 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD1_CFG, (u8_t *)value, 1) )
cparata 0:763b80993db4 5812 return MEMS_ERROR;
cparata 0:763b80993db4 5813
cparata 0:763b80993db4 5814 *value &= LSM6DSL_ACC_GYRO_INT1_SLEEP_MASK; //mask
cparata 0:763b80993db4 5815
cparata 0:763b80993db4 5816 return MEMS_SUCCESS;
cparata 0:763b80993db4 5817 }
cparata 0:763b80993db4 5818
cparata 0:763b80993db4 5819 /*******************************************************************************
cparata 0:763b80993db4 5820 * Function Name : LSM6DSL_ACC_GYRO_W_MagCorrection_Int2
cparata 0:763b80993db4 5821 * Description : Write INT2_IRON
cparata 0:763b80993db4 5822 * Input : LSM6DSL_ACC_GYRO_INT2_IRON_t
cparata 0:763b80993db4 5823 * Output : None
cparata 0:763b80993db4 5824 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5825 *******************************************************************************/
cparata 0:763b80993db4 5826 status_t LSM6DSL_ACC_GYRO_W_MagCorrection_Int2(void *handle, LSM6DSL_ACC_GYRO_INT2_IRON_t newValue)
cparata 0:763b80993db4 5827 {
cparata 0:763b80993db4 5828 u8_t value;
cparata 0:763b80993db4 5829
cparata 0:763b80993db4 5830 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:763b80993db4 5831 return MEMS_ERROR;
cparata 0:763b80993db4 5832
cparata 0:763b80993db4 5833 value &= ~LSM6DSL_ACC_GYRO_INT2_IRON_MASK;
cparata 0:763b80993db4 5834 value |= newValue;
cparata 0:763b80993db4 5835
cparata 0:763b80993db4 5836 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:763b80993db4 5837 return MEMS_ERROR;
cparata 0:763b80993db4 5838
cparata 0:763b80993db4 5839 return MEMS_SUCCESS;
cparata 0:763b80993db4 5840 }
cparata 0:763b80993db4 5841
cparata 0:763b80993db4 5842 /*******************************************************************************
cparata 0:763b80993db4 5843 * Function Name : LSM6DSL_ACC_GYRO_R_MagCorrection_Int2
cparata 0:763b80993db4 5844 * Description : Read INT2_IRON
cparata 0:763b80993db4 5845 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_IRON_t
cparata 0:763b80993db4 5846 * Output : Status of INT2_IRON see LSM6DSL_ACC_GYRO_INT2_IRON_t
cparata 0:763b80993db4 5847 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5848 *******************************************************************************/
cparata 0:763b80993db4 5849 status_t LSM6DSL_ACC_GYRO_R_MagCorrection_Int2(void *handle, LSM6DSL_ACC_GYRO_INT2_IRON_t *value)
cparata 0:763b80993db4 5850 {
cparata 0:763b80993db4 5851 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
cparata 0:763b80993db4 5852 return MEMS_ERROR;
cparata 0:763b80993db4 5853
cparata 0:763b80993db4 5854 *value &= LSM6DSL_ACC_GYRO_INT2_IRON_MASK; //mask
cparata 0:763b80993db4 5855
cparata 0:763b80993db4 5856 return MEMS_SUCCESS;
cparata 0:763b80993db4 5857 }
cparata 0:763b80993db4 5858
cparata 0:763b80993db4 5859 /*******************************************************************************
cparata 0:763b80993db4 5860 * Function Name : LSM6DSL_ACC_GYRO_W_TiltEvOnInt2
cparata 0:763b80993db4 5861 * Description : Write INT2_TILT
cparata 0:763b80993db4 5862 * Input : LSM6DSL_ACC_GYRO_INT2_TILT_t
cparata 0:763b80993db4 5863 * Output : None
cparata 0:763b80993db4 5864 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5865 *******************************************************************************/
cparata 0:763b80993db4 5866 status_t LSM6DSL_ACC_GYRO_W_TiltEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_TILT_t newValue)
cparata 0:763b80993db4 5867 {
cparata 0:763b80993db4 5868 u8_t value;
cparata 0:763b80993db4 5869
cparata 0:763b80993db4 5870 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:763b80993db4 5871 return MEMS_ERROR;
cparata 0:763b80993db4 5872
cparata 0:763b80993db4 5873 value &= ~LSM6DSL_ACC_GYRO_INT2_TILT_MASK;
cparata 0:763b80993db4 5874 value |= newValue;
cparata 0:763b80993db4 5875
cparata 0:763b80993db4 5876 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:763b80993db4 5877 return MEMS_ERROR;
cparata 0:763b80993db4 5878
cparata 0:763b80993db4 5879 return MEMS_SUCCESS;
cparata 0:763b80993db4 5880 }
cparata 0:763b80993db4 5881
cparata 0:763b80993db4 5882 /*******************************************************************************
cparata 0:763b80993db4 5883 * Function Name : LSM6DSL_ACC_GYRO_R_TiltEvOnInt2
cparata 0:763b80993db4 5884 * Description : Read INT2_TILT
cparata 0:763b80993db4 5885 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_TILT_t
cparata 0:763b80993db4 5886 * Output : Status of INT2_TILT see LSM6DSL_ACC_GYRO_INT2_TILT_t
cparata 0:763b80993db4 5887 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5888 *******************************************************************************/
cparata 0:763b80993db4 5889 status_t LSM6DSL_ACC_GYRO_R_TiltEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_TILT_t *value)
cparata 0:763b80993db4 5890 {
cparata 0:763b80993db4 5891 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
cparata 0:763b80993db4 5892 return MEMS_ERROR;
cparata 0:763b80993db4 5893
cparata 0:763b80993db4 5894 *value &= LSM6DSL_ACC_GYRO_INT2_TILT_MASK; //mask
cparata 0:763b80993db4 5895
cparata 0:763b80993db4 5896 return MEMS_SUCCESS;
cparata 0:763b80993db4 5897 }
cparata 0:763b80993db4 5898
cparata 0:763b80993db4 5899 /*******************************************************************************
cparata 0:763b80993db4 5900 * Function Name : LSM6DSL_ACC_GYRO_W_6DEvOnInt2
cparata 0:763b80993db4 5901 * Description : Write INT2_6D
cparata 0:763b80993db4 5902 * Input : LSM6DSL_ACC_GYRO_INT2_6D_t
cparata 0:763b80993db4 5903 * Output : None
cparata 0:763b80993db4 5904 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5905 *******************************************************************************/
cparata 0:763b80993db4 5906 status_t LSM6DSL_ACC_GYRO_W_6DEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_6D_t newValue)
cparata 0:763b80993db4 5907 {
cparata 0:763b80993db4 5908 u8_t value;
cparata 0:763b80993db4 5909
cparata 0:763b80993db4 5910 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:763b80993db4 5911 return MEMS_ERROR;
cparata 0:763b80993db4 5912
cparata 0:763b80993db4 5913 value &= ~LSM6DSL_ACC_GYRO_INT2_6D_MASK;
cparata 0:763b80993db4 5914 value |= newValue;
cparata 0:763b80993db4 5915
cparata 0:763b80993db4 5916 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:763b80993db4 5917 return MEMS_ERROR;
cparata 0:763b80993db4 5918
cparata 0:763b80993db4 5919 return MEMS_SUCCESS;
cparata 0:763b80993db4 5920 }
cparata 0:763b80993db4 5921
cparata 0:763b80993db4 5922 /*******************************************************************************
cparata 0:763b80993db4 5923 * Function Name : LSM6DSL_ACC_GYRO_R_6DEvOnInt2
cparata 0:763b80993db4 5924 * Description : Read INT2_6D
cparata 0:763b80993db4 5925 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_6D_t
cparata 0:763b80993db4 5926 * Output : Status of INT2_6D see LSM6DSL_ACC_GYRO_INT2_6D_t
cparata 0:763b80993db4 5927 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5928 *******************************************************************************/
cparata 0:763b80993db4 5929 status_t LSM6DSL_ACC_GYRO_R_6DEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_6D_t *value)
cparata 0:763b80993db4 5930 {
cparata 0:763b80993db4 5931 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
cparata 0:763b80993db4 5932 return MEMS_ERROR;
cparata 0:763b80993db4 5933
cparata 0:763b80993db4 5934 *value &= LSM6DSL_ACC_GYRO_INT2_6D_MASK; //mask
cparata 0:763b80993db4 5935
cparata 0:763b80993db4 5936 return MEMS_SUCCESS;
cparata 0:763b80993db4 5937 }
cparata 0:763b80993db4 5938
cparata 0:763b80993db4 5939 /*******************************************************************************
cparata 0:763b80993db4 5940 * Function Name : LSM6DSL_ACC_GYRO_W_TapEvOnInt2
cparata 0:763b80993db4 5941 * Description : Write INT2_TAP
cparata 0:763b80993db4 5942 * Input : LSM6DSL_ACC_GYRO_INT2_TAP_t
cparata 0:763b80993db4 5943 * Output : None
cparata 0:763b80993db4 5944 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5945 *******************************************************************************/
cparata 0:763b80993db4 5946 status_t LSM6DSL_ACC_GYRO_W_TapEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_TAP_t newValue)
cparata 0:763b80993db4 5947 {
cparata 0:763b80993db4 5948 u8_t value;
cparata 0:763b80993db4 5949
cparata 0:763b80993db4 5950 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:763b80993db4 5951 return MEMS_ERROR;
cparata 0:763b80993db4 5952
cparata 0:763b80993db4 5953 value &= ~LSM6DSL_ACC_GYRO_INT2_TAP_MASK;
cparata 0:763b80993db4 5954 value |= newValue;
cparata 0:763b80993db4 5955
cparata 0:763b80993db4 5956 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:763b80993db4 5957 return MEMS_ERROR;
cparata 0:763b80993db4 5958
cparata 0:763b80993db4 5959 return MEMS_SUCCESS;
cparata 0:763b80993db4 5960 }
cparata 0:763b80993db4 5961
cparata 0:763b80993db4 5962 /*******************************************************************************
cparata 0:763b80993db4 5963 * Function Name : LSM6DSL_ACC_GYRO_R_TapEvOnInt2
cparata 0:763b80993db4 5964 * Description : Read INT2_TAP
cparata 0:763b80993db4 5965 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_TAP_t
cparata 0:763b80993db4 5966 * Output : Status of INT2_TAP see LSM6DSL_ACC_GYRO_INT2_TAP_t
cparata 0:763b80993db4 5967 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5968 *******************************************************************************/
cparata 0:763b80993db4 5969 status_t LSM6DSL_ACC_GYRO_R_TapEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_TAP_t *value)
cparata 0:763b80993db4 5970 {
cparata 0:763b80993db4 5971 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
cparata 0:763b80993db4 5972 return MEMS_ERROR;
cparata 0:763b80993db4 5973
cparata 0:763b80993db4 5974 *value &= LSM6DSL_ACC_GYRO_INT2_TAP_MASK; //mask
cparata 0:763b80993db4 5975
cparata 0:763b80993db4 5976 return MEMS_SUCCESS;
cparata 0:763b80993db4 5977 }
cparata 0:763b80993db4 5978
cparata 0:763b80993db4 5979 /*******************************************************************************
cparata 0:763b80993db4 5980 * Function Name : LSM6DSL_ACC_GYRO_W_FFEvOnInt2
cparata 0:763b80993db4 5981 * Description : Write INT2_FF
cparata 0:763b80993db4 5982 * Input : LSM6DSL_ACC_GYRO_INT2_FF_t
cparata 0:763b80993db4 5983 * Output : None
cparata 0:763b80993db4 5984 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 5985 *******************************************************************************/
cparata 0:763b80993db4 5986 status_t LSM6DSL_ACC_GYRO_W_FFEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_FF_t newValue)
cparata 0:763b80993db4 5987 {
cparata 0:763b80993db4 5988 u8_t value;
cparata 0:763b80993db4 5989
cparata 0:763b80993db4 5990 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:763b80993db4 5991 return MEMS_ERROR;
cparata 0:763b80993db4 5992
cparata 0:763b80993db4 5993 value &= ~LSM6DSL_ACC_GYRO_INT2_FF_MASK;
cparata 0:763b80993db4 5994 value |= newValue;
cparata 0:763b80993db4 5995
cparata 0:763b80993db4 5996 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:763b80993db4 5997 return MEMS_ERROR;
cparata 0:763b80993db4 5998
cparata 0:763b80993db4 5999 return MEMS_SUCCESS;
cparata 0:763b80993db4 6000 }
cparata 0:763b80993db4 6001
cparata 0:763b80993db4 6002 /*******************************************************************************
cparata 0:763b80993db4 6003 * Function Name : LSM6DSL_ACC_GYRO_R_FFEvOnInt2
cparata 0:763b80993db4 6004 * Description : Read INT2_FF
cparata 0:763b80993db4 6005 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_FF_t
cparata 0:763b80993db4 6006 * Output : Status of INT2_FF see LSM6DSL_ACC_GYRO_INT2_FF_t
cparata 0:763b80993db4 6007 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 6008 *******************************************************************************/
cparata 0:763b80993db4 6009 status_t LSM6DSL_ACC_GYRO_R_FFEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_FF_t *value)
cparata 0:763b80993db4 6010 {
cparata 0:763b80993db4 6011 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
cparata 0:763b80993db4 6012 return MEMS_ERROR;
cparata 0:763b80993db4 6013
cparata 0:763b80993db4 6014 *value &= LSM6DSL_ACC_GYRO_INT2_FF_MASK; //mask
cparata 0:763b80993db4 6015
cparata 0:763b80993db4 6016 return MEMS_SUCCESS;
cparata 0:763b80993db4 6017 }
cparata 0:763b80993db4 6018
cparata 0:763b80993db4 6019 /*******************************************************************************
cparata 0:763b80993db4 6020 * Function Name : LSM6DSL_ACC_GYRO_W_WUEvOnInt2
cparata 0:763b80993db4 6021 * Description : Write INT2_WU
cparata 0:763b80993db4 6022 * Input : LSM6DSL_ACC_GYRO_INT2_WU_t
cparata 0:763b80993db4 6023 * Output : None
cparata 0:763b80993db4 6024 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 6025 *******************************************************************************/
cparata 0:763b80993db4 6026 status_t LSM6DSL_ACC_GYRO_W_WUEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_WU_t newValue)
cparata 0:763b80993db4 6027 {
cparata 0:763b80993db4 6028 u8_t value;
cparata 0:763b80993db4 6029
cparata 0:763b80993db4 6030 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:763b80993db4 6031 return MEMS_ERROR;
cparata 0:763b80993db4 6032
cparata 0:763b80993db4 6033 value &= ~LSM6DSL_ACC_GYRO_INT2_WU_MASK;
cparata 0:763b80993db4 6034 value |= newValue;
cparata 0:763b80993db4 6035
cparata 0:763b80993db4 6036 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:763b80993db4 6037 return MEMS_ERROR;
cparata 0:763b80993db4 6038
cparata 0:763b80993db4 6039 return MEMS_SUCCESS;
cparata 0:763b80993db4 6040 }
cparata 0:763b80993db4 6041
cparata 0:763b80993db4 6042 /*******************************************************************************
cparata 0:763b80993db4 6043 * Function Name : LSM6DSL_ACC_GYRO_R_WUEvOnInt2
cparata 0:763b80993db4 6044 * Description : Read INT2_WU
cparata 0:763b80993db4 6045 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_WU_t
cparata 0:763b80993db4 6046 * Output : Status of INT2_WU see LSM6DSL_ACC_GYRO_INT2_WU_t
cparata 0:763b80993db4 6047 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 6048 *******************************************************************************/
cparata 0:763b80993db4 6049 status_t LSM6DSL_ACC_GYRO_R_WUEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_WU_t *value)
cparata 0:763b80993db4 6050 {
cparata 0:763b80993db4 6051 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
cparata 0:763b80993db4 6052 return MEMS_ERROR;
cparata 0:763b80993db4 6053
cparata 0:763b80993db4 6054 *value &= LSM6DSL_ACC_GYRO_INT2_WU_MASK; //mask
cparata 0:763b80993db4 6055
cparata 0:763b80993db4 6056 return MEMS_SUCCESS;
cparata 0:763b80993db4 6057 }
cparata 0:763b80993db4 6058
cparata 0:763b80993db4 6059 /*******************************************************************************
cparata 0:763b80993db4 6060 * Function Name : LSM6DSL_ACC_GYRO_W_SingleTapOnInt2
cparata 0:763b80993db4 6061 * Description : Write INT2_SINGLE_TAP
cparata 0:763b80993db4 6062 * Input : LSM6DSL_ACC_GYRO_INT2_SINGLE_TAP_t
cparata 0:763b80993db4 6063 * Output : None
cparata 0:763b80993db4 6064 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 6065 *******************************************************************************/
cparata 0:763b80993db4 6066 status_t LSM6DSL_ACC_GYRO_W_SingleTapOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_SINGLE_TAP_t newValue)
cparata 0:763b80993db4 6067 {
cparata 0:763b80993db4 6068 u8_t value;
cparata 0:763b80993db4 6069
cparata 0:763b80993db4 6070 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:763b80993db4 6071 return MEMS_ERROR;
cparata 0:763b80993db4 6072
cparata 0:763b80993db4 6073 value &= ~LSM6DSL_ACC_GYRO_INT2_SINGLE_TAP_MASK;
cparata 0:763b80993db4 6074 value |= newValue;
cparata 0:763b80993db4 6075
cparata 0:763b80993db4 6076 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:763b80993db4 6077 return MEMS_ERROR;
cparata 0:763b80993db4 6078
cparata 0:763b80993db4 6079 return MEMS_SUCCESS;
cparata 0:763b80993db4 6080 }
cparata 0:763b80993db4 6081
cparata 0:763b80993db4 6082 /*******************************************************************************
cparata 0:763b80993db4 6083 * Function Name : LSM6DSL_ACC_GYRO_R_SingleTapOnInt2
cparata 0:763b80993db4 6084 * Description : Read INT2_SINGLE_TAP
cparata 0:763b80993db4 6085 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_SINGLE_TAP_t
cparata 0:763b80993db4 6086 * Output : Status of INT2_SINGLE_TAP see LSM6DSL_ACC_GYRO_INT2_SINGLE_TAP_t
cparata 0:763b80993db4 6087 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 6088 *******************************************************************************/
cparata 0:763b80993db4 6089 status_t LSM6DSL_ACC_GYRO_R_SingleTapOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_SINGLE_TAP_t *value)
cparata 0:763b80993db4 6090 {
cparata 0:763b80993db4 6091 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
cparata 0:763b80993db4 6092 return MEMS_ERROR;
cparata 0:763b80993db4 6093
cparata 0:763b80993db4 6094 *value &= LSM6DSL_ACC_GYRO_INT2_SINGLE_TAP_MASK; //mask
cparata 0:763b80993db4 6095
cparata 0:763b80993db4 6096 return MEMS_SUCCESS;
cparata 0:763b80993db4 6097 }
cparata 0:763b80993db4 6098
cparata 0:763b80993db4 6099 /*******************************************************************************
cparata 0:763b80993db4 6100 * Function Name : LSM6DSL_ACC_GYRO_W_SleepEvOnInt2
cparata 0:763b80993db4 6101 * Description : Write INT2_SLEEP
cparata 0:763b80993db4 6102 * Input : LSM6DSL_ACC_GYRO_INT2_SLEEP_t
cparata 0:763b80993db4 6103 * Output : None
cparata 0:763b80993db4 6104 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 6105 *******************************************************************************/
cparata 0:763b80993db4 6106 status_t LSM6DSL_ACC_GYRO_W_SleepEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_SLEEP_t newValue)
cparata 0:763b80993db4 6107 {
cparata 0:763b80993db4 6108 u8_t value;
cparata 0:763b80993db4 6109
cparata 0:763b80993db4 6110 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:763b80993db4 6111 return MEMS_ERROR;
cparata 0:763b80993db4 6112
cparata 0:763b80993db4 6113 value &= ~LSM6DSL_ACC_GYRO_INT2_SLEEP_MASK;
cparata 0:763b80993db4 6114 value |= newValue;
cparata 0:763b80993db4 6115
cparata 0:763b80993db4 6116 if( !LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, &value, 1) )
cparata 0:763b80993db4 6117 return MEMS_ERROR;
cparata 0:763b80993db4 6118
cparata 0:763b80993db4 6119 return MEMS_SUCCESS;
cparata 0:763b80993db4 6120 }
cparata 0:763b80993db4 6121
cparata 0:763b80993db4 6122 /*******************************************************************************
cparata 0:763b80993db4 6123 * Function Name : LSM6DSL_ACC_GYRO_R_SleepEvOnInt2
cparata 0:763b80993db4 6124 * Description : Read INT2_SLEEP
cparata 0:763b80993db4 6125 * Input : Pointer to LSM6DSL_ACC_GYRO_INT2_SLEEP_t
cparata 0:763b80993db4 6126 * Output : Status of INT2_SLEEP see LSM6DSL_ACC_GYRO_INT2_SLEEP_t
cparata 0:763b80993db4 6127 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 6128 *******************************************************************************/
cparata 0:763b80993db4 6129 status_t LSM6DSL_ACC_GYRO_R_SleepEvOnInt2(void *handle, LSM6DSL_ACC_GYRO_INT2_SLEEP_t *value)
cparata 0:763b80993db4 6130 {
cparata 0:763b80993db4 6131 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_MD2_CFG, (u8_t *)value, 1) )
cparata 0:763b80993db4 6132 return MEMS_ERROR;
cparata 0:763b80993db4 6133
cparata 0:763b80993db4 6134 *value &= LSM6DSL_ACC_GYRO_INT2_SLEEP_MASK; //mask
cparata 0:763b80993db4 6135
cparata 0:763b80993db4 6136 return MEMS_SUCCESS;
cparata 0:763b80993db4 6137 }
cparata 0:763b80993db4 6138
cparata 0:763b80993db4 6139 /*******************************************************************************
cparata 0:763b80993db4 6140 * Function Name : status_t LSM6DSL_ACC_GYRO_Get_GetFIFOData(u8_t *buff)
cparata 0:763b80993db4 6141 * Description : Read GetFIFOData output register
cparata 0:763b80993db4 6142 * Input : pointer to [u8_t]
cparata 0:763b80993db4 6143 * Output : GetFIFOData buffer u8_t
cparata 0:763b80993db4 6144 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 6145 *******************************************************************************/
cparata 0:763b80993db4 6146 status_t LSM6DSL_ACC_GYRO_Get_GetFIFOData(void *handle, u8_t *buff)
cparata 0:763b80993db4 6147 {
cparata 0:763b80993db4 6148 u8_t i, j, k;
cparata 0:763b80993db4 6149 u8_t numberOfByteForDimension;
cparata 0:763b80993db4 6150
cparata 0:763b80993db4 6151 numberOfByteForDimension=2/1;
cparata 0:763b80993db4 6152
cparata 0:763b80993db4 6153 k=0;
cparata 0:763b80993db4 6154 for (i=0; i<1;i++ )
cparata 0:763b80993db4 6155 {
cparata 0:763b80993db4 6156 for (j=0; j<numberOfByteForDimension;j++ )
cparata 0:763b80993db4 6157 {
cparata 0:763b80993db4 6158 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_FIFO_DATA_OUT_L+k, &buff[k], 1))
cparata 0:763b80993db4 6159 return MEMS_ERROR;
cparata 0:763b80993db4 6160 k++;
cparata 0:763b80993db4 6161 }
cparata 0:763b80993db4 6162 }
cparata 0:763b80993db4 6163
cparata 0:763b80993db4 6164 return MEMS_SUCCESS;
cparata 0:763b80993db4 6165 }
cparata 0:763b80993db4 6166
cparata 0:763b80993db4 6167 /*******************************************************************************
cparata 0:763b80993db4 6168 * Function Name : status_t LSM6DSL_ACC_GYRO_Get_GetTimestamp(u8_t *buff)
cparata 0:763b80993db4 6169 * Description : Read GetTimestamp output register
cparata 0:763b80993db4 6170 * Input : pointer to [u8_t]
cparata 0:763b80993db4 6171 * Output : GetTimestamp buffer u8_t
cparata 0:763b80993db4 6172 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 6173 *******************************************************************************/
cparata 0:763b80993db4 6174 status_t LSM6DSL_ACC_GYRO_Get_GetTimestamp(void *handle, u8_t *buff)
cparata 0:763b80993db4 6175 {
cparata 0:763b80993db4 6176 u8_t i, j, k;
cparata 0:763b80993db4 6177 u8_t numberOfByteForDimension;
cparata 0:763b80993db4 6178
cparata 0:763b80993db4 6179 numberOfByteForDimension=3/1;
cparata 0:763b80993db4 6180
cparata 0:763b80993db4 6181 k=0;
cparata 0:763b80993db4 6182 for (i=0; i<1;i++ )
cparata 0:763b80993db4 6183 {
cparata 0:763b80993db4 6184 for (j=0; j<numberOfByteForDimension;j++ )
cparata 0:763b80993db4 6185 {
cparata 0:763b80993db4 6186 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_TIMESTAMP0_REG+k, &buff[k], 1))
cparata 0:763b80993db4 6187 return MEMS_ERROR;
cparata 0:763b80993db4 6188 k++;
cparata 0:763b80993db4 6189 }
cparata 0:763b80993db4 6190 }
cparata 0:763b80993db4 6191
cparata 0:763b80993db4 6192 return MEMS_SUCCESS;
cparata 0:763b80993db4 6193 }
cparata 0:763b80993db4 6194
cparata 0:763b80993db4 6195 /*******************************************************************************
cparata 0:763b80993db4 6196 * Function Name : status_t LSM6DSL_ACC_GYRO_Get_GetStepCounter(u8_t *buff)
cparata 0:763b80993db4 6197 * Description : Read GetStepCounter output register
cparata 0:763b80993db4 6198 * Input : pointer to [u8_t]
cparata 0:763b80993db4 6199 * Output : GetStepCounter buffer u8_t
cparata 0:763b80993db4 6200 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 6201 *******************************************************************************/
cparata 0:763b80993db4 6202 status_t LSM6DSL_ACC_GYRO_Get_GetStepCounter(void *handle, u8_t *buff)
cparata 0:763b80993db4 6203 {
cparata 0:763b80993db4 6204 u8_t i, j, k;
cparata 0:763b80993db4 6205 u8_t numberOfByteForDimension;
cparata 0:763b80993db4 6206
cparata 0:763b80993db4 6207 numberOfByteForDimension=2/1;
cparata 0:763b80993db4 6208
cparata 0:763b80993db4 6209 k=0;
cparata 0:763b80993db4 6210 for (i=0; i<1;i++ )
cparata 0:763b80993db4 6211 {
cparata 0:763b80993db4 6212 for (j=0; j<numberOfByteForDimension;j++ )
cparata 0:763b80993db4 6213 {
cparata 0:763b80993db4 6214 if( !LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_STEP_COUNTER_L+k, &buff[k], 1))
cparata 0:763b80993db4 6215 return MEMS_ERROR;
cparata 0:763b80993db4 6216 k++;
cparata 0:763b80993db4 6217 }
cparata 0:763b80993db4 6218 }
cparata 0:763b80993db4 6219
cparata 0:763b80993db4 6220 return MEMS_SUCCESS;
cparata 0:763b80993db4 6221 }
cparata 0:763b80993db4 6222
cparata 0:763b80993db4 6223 /*******************************************************************************
cparata 0:763b80993db4 6224 * Function Name : LSM6DSL_ACC_GYRO_W_PedoThreshold(void *handle, u8_t newValue)
cparata 0:763b80993db4 6225 * Description : Set accelerometer threshold for pedometer
cparata 0:763b80993db4 6226 * Input : pointer to [u8_t]
cparata 0:763b80993db4 6227 * Output : None
cparata 0:763b80993db4 6228 * Return : Status [MEMS_ERROR, MEMS_SUCCESS]
cparata 0:763b80993db4 6229 *******************************************************************************/
cparata 0:763b80993db4 6230 status_t LSM6DSL_ACC_GYRO_W_PedoThreshold(void *handle, u8_t newValue)
cparata 0:763b80993db4 6231 {
cparata 0:763b80993db4 6232 u8_t value;
cparata 0:763b80993db4 6233
cparata 0:763b80993db4 6234 /* Open Embedded Function Register page*/
cparata 0:763b80993db4 6235 LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_ENABLED);
cparata 0:763b80993db4 6236
cparata 0:763b80993db4 6237 /* read current value */
cparata 0:763b80993db4 6238 LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_CONFIG_PEDO_THS_MIN, &value, 1);
cparata 0:763b80993db4 6239
cparata 0:763b80993db4 6240 value &= ~0x1F;
cparata 0:763b80993db4 6241 value |= (newValue & 0x1F);
cparata 0:763b80993db4 6242
cparata 0:763b80993db4 6243 /* write new value */
cparata 0:763b80993db4 6244 LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_CONFIG_PEDO_THS_MIN, &value, 1);
cparata 0:763b80993db4 6245
cparata 0:763b80993db4 6246 /* Close Embedded Function Register page*/
cparata 0:763b80993db4 6247 LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_DISABLED);
cparata 0:763b80993db4 6248
cparata 0:763b80993db4 6249 return MEMS_SUCCESS;
cparata 0:763b80993db4 6250 }
cparata 0:763b80993db4 6251
cparata 0:763b80993db4 6252 /************** Use Sensor Hub *******************/
cparata 0:763b80993db4 6253 /*
cparata 0:763b80993db4 6254 * Program the nine Soft Iron Matrix coefficients.
cparata 0:763b80993db4 6255 * The SI_Matrix buffer must provide coefficients
cparata 0:763b80993db4 6256 * in xx, xy, xz, yx, yy, yz, zx, zy, zz order.
cparata 0:763b80993db4 6257 */
cparata 0:763b80993db4 6258 status_t LSM6DSL_ACC_GYRO_SH_init_SI_Matrix(void *handle, u8_t *SI_matrix)
cparata 0:763b80993db4 6259 {
cparata 0:763b80993db4 6260 /* Open Embedded Function Register page*/
cparata 0:763b80993db4 6261 LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_ENABLED);
cparata 0:763b80993db4 6262
cparata 0:763b80993db4 6263 /* Write the Soft Iron Matrix coefficients */
cparata 0:763b80993db4 6264 LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_MAG_SI_XX, SI_matrix, 9);
cparata 0:763b80993db4 6265
cparata 0:763b80993db4 6266 /* Close Embedded Function Register page*/
cparata 0:763b80993db4 6267 LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_DISABLED);
cparata 0:763b80993db4 6268
cparata 0:763b80993db4 6269 return MEMS_SUCCESS;
cparata 0:763b80993db4 6270 }
cparata 0:763b80993db4 6271
cparata 0:763b80993db4 6272 /* Read a remote device through I2C Sensor Hub Slave 0 */
cparata 0:763b80993db4 6273 status_t LSM6DSL_ACC_GYRO_SH0_Program(void *handle, u8_t SlvAddr, u8_t Reg, u8_t len)
cparata 0:763b80993db4 6274 {
cparata 0:763b80993db4 6275 /* Open Embedded Function Register page*/
cparata 0:763b80993db4 6276 LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_ENABLED);
cparata 0:763b80993db4 6277
cparata 0:763b80993db4 6278 /* Write remote device I2C slave address */
cparata 0:763b80993db4 6279 SlvAddr |= 0x1; /* Raise the read op bit */
cparata 0:763b80993db4 6280 LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_SLV0_ADD, &SlvAddr, 1);
cparata 0:763b80993db4 6281
cparata 0:763b80993db4 6282 /* Write remote device I2C subaddress */
cparata 0:763b80993db4 6283 LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_SLV0_SUBADD, &Reg, 1);
cparata 0:763b80993db4 6284
cparata 0:763b80993db4 6285 /* Write number of bytes to read [SLAVE0_CONFIG - 04h ]*/
cparata 0:763b80993db4 6286 u8_t sl0_cfg = 0;
cparata 0:763b80993db4 6287 sl0_cfg |= 0x00; //00 bit [7-6] : no decimation
cparata 0:763b80993db4 6288 sl0_cfg |= 0x00; //00 bit [5-4] : one sensor
cparata 0:763b80993db4 6289 sl0_cfg |= 0x00; // 0 bit [3] : source mode read disabled
cparata 0:763b80993db4 6290 sl0_cfg |= len & 0x07; // bit [2-0] : number of bytes
cparata 0:763b80993db4 6291
cparata 0:763b80993db4 6292 LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_SLAVE0_CONFIG, &sl0_cfg, 1);
cparata 0:763b80993db4 6293
cparata 0:763b80993db4 6294 /* Close Embedded Function Register page*/
cparata 0:763b80993db4 6295 LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_DISABLED);
cparata 0:763b80993db4 6296
cparata 0:763b80993db4 6297 /* Enable FUNC */
cparata 0:763b80993db4 6298 LSM6DSL_ACC_GYRO_W_FUNC_EN(handle, LSM6DSL_ACC_GYRO_FUNC_EN_ENABLED);
cparata 0:763b80993db4 6299
cparata 0:763b80993db4 6300 /* MASTER_EN */
cparata 0:763b80993db4 6301 LSM6DSL_ACC_GYRO_W_I2C_MASTER_Enable(handle, LSM6DSL_ACC_GYRO_MASTER_ON_ENABLED);
cparata 0:763b80993db4 6302
cparata 0:763b80993db4 6303 return MEMS_SUCCESS;
cparata 0:763b80993db4 6304 }
cparata 0:763b80993db4 6305
cparata 0:763b80993db4 6306 /* Read a remote device through I2C Sensor Hub Slave 0 */
cparata 0:763b80993db4 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:763b80993db4 6308 {
cparata 0:763b80993db4 6309 LSM6DSL_ACC_GYRO_SENS_HUB_END_t op_cmpl = LSM6DSL_ACC_GYRO_SENS_HUB_END_STILL_ONGOING;
cparata 0:763b80993db4 6310 LSM6DSL_ACC_GYRO_XLDA_t op_update = LSM6DSL_ACC_GYRO_XLDA_NO_DATA_AVAIL;
cparata 0:763b80993db4 6311 u8_t dummy[6];
cparata 0:763b80993db4 6312
cparata 0:763b80993db4 6313 LSM6DSL_ACC_GYRO_W_ODR_XL(handle, LSM6DSL_ACC_GYRO_ODR_XL_POWER_DOWN);
cparata 0:763b80993db4 6314
cparata 0:763b80993db4 6315 LSM6DSL_ACC_GYRO_SH0_Program(handle, SlvAddr, Reg, len);
cparata 0:763b80993db4 6316
cparata 0:763b80993db4 6317 /* Syncronize the SH with internal trigger (xl) */
cparata 0:763b80993db4 6318 LSM6DSL_ACC_GYRO_W_ODR_XL(handle, LSM6DSL_ACC_GYRO_ODR_XL_104Hz);
cparata 0:763b80993db4 6319
cparata 0:763b80993db4 6320 /* Wait until operation is not completed */
cparata 0:763b80993db4 6321 LSM6DSL_ACC_GYRO_GetRawAccData(handle, dummy);
cparata 0:763b80993db4 6322 do {
cparata 0:763b80993db4 6323 LSM6DSL_ACC_GYRO_R_XLDA(handle, &op_update);
cparata 0:763b80993db4 6324 } while(op_update != LSM6DSL_ACC_GYRO_XLDA_DATA_AVAIL);
cparata 0:763b80993db4 6325 do {
cparata 0:763b80993db4 6326 LSM6DSL_ACC_GYRO_R_SENS_HUB_END(handle, &op_cmpl);
cparata 0:763b80993db4 6327 } while(op_cmpl != LSM6DSL_ACC_GYRO_SENS_HUB_END_OP_COMPLETED);
cparata 0:763b80993db4 6328
cparata 0:763b80993db4 6329
cparata 0:763b80993db4 6330 /* Read the result */
cparata 0:763b80993db4 6331 LSM6DSL_ACC_GYRO_ReadReg(handle, LSM6DSL_ACC_GYRO_SENSORHUB1_REG, Bufp, len);
cparata 0:763b80993db4 6332
cparata 0:763b80993db4 6333 LSM6DSL_ACC_GYRO_W_ODR_XL(handle, LSM6DSL_ACC_GYRO_ODR_XL_POWER_DOWN);
cparata 0:763b80993db4 6334
cparata 0:763b80993db4 6335 if (stop) {
cparata 0:763b80993db4 6336 /* Stop everything */
cparata 0:763b80993db4 6337 LSM6DSL_ACC_GYRO_W_FUNC_EN(handle, LSM6DSL_ACC_GYRO_FUNC_EN_DISABLED);
cparata 0:763b80993db4 6338 LSM6DSL_ACC_GYRO_W_I2C_MASTER_Enable(handle, LSM6DSL_ACC_GYRO_MASTER_ON_DISABLED);
cparata 0:763b80993db4 6339 }
cparata 0:763b80993db4 6340
cparata 0:763b80993db4 6341 return MEMS_SUCCESS;
cparata 0:763b80993db4 6342 }
cparata 0:763b80993db4 6343
cparata 0:763b80993db4 6344 /* Write a remote device through I2C Sensor Hub Slave 0 */
cparata 0:763b80993db4 6345 status_t LSM6DSL_ACC_GYRO_SH0_WriteByte(void *handle, u8_t SlvAddr, u8_t Reg, u8_t Bufp)
cparata 0:763b80993db4 6346 {
cparata 0:763b80993db4 6347 LSM6DSL_ACC_GYRO_SENS_HUB_END_t op_cmpl = LSM6DSL_ACC_GYRO_SENS_HUB_END_STILL_ONGOING;
cparata 0:763b80993db4 6348 LSM6DSL_ACC_GYRO_XLDA_t op_update = LSM6DSL_ACC_GYRO_XLDA_NO_DATA_AVAIL;
cparata 0:763b80993db4 6349 u8_t dummy[6];
cparata 0:763b80993db4 6350
cparata 0:763b80993db4 6351 /* Open Embedded Function Register page*/
cparata 0:763b80993db4 6352 LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_ENABLED);
cparata 0:763b80993db4 6353
cparata 0:763b80993db4 6354 /* Write remote device I2C slave address */
cparata 0:763b80993db4 6355 LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_SLV0_ADD, &SlvAddr, 1);
cparata 0:763b80993db4 6356
cparata 0:763b80993db4 6357 /* Write remote device I2C subaddress */
cparata 0:763b80993db4 6358 LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_SLV0_SUBADD, &Reg, 1);
cparata 0:763b80993db4 6359
cparata 0:763b80993db4 6360 /* Write the data */
cparata 0:763b80993db4 6361 LSM6DSL_ACC_GYRO_WriteReg(handle, LSM6DSL_ACC_GYRO_DATAWRITE_SRC_MODE_SUB_SLV0, &Bufp, 1);
cparata 0:763b80993db4 6362
cparata 0:763b80993db4 6363 /* Close Embedded Function Register page*/
cparata 0:763b80993db4 6364 LSM6DSL_ACC_GYRO_W_EmbeddedAccess(handle, LSM6DSL_ACC_GYRO_EMBEDDED_ACCESS_DISABLED);
cparata 0:763b80993db4 6365
cparata 0:763b80993db4 6366 /* Enable FUNC */
cparata 0:763b80993db4 6367 LSM6DSL_ACC_GYRO_W_FUNC_EN(handle, LSM6DSL_ACC_GYRO_FUNC_EN_ENABLED);
cparata 0:763b80993db4 6368
cparata 0:763b80993db4 6369 /* Enable PULL_UP_EN and MASTER_EN */
cparata 0:763b80993db4 6370 //LSM6DSL_ACC_GYRO_W_PULL_UP_EN(handle, LSM6DSL_ACC_GYRO_PULL_UP_EN_ENABLED);
cparata 0:763b80993db4 6371 LSM6DSL_ACC_GYRO_W_I2C_MASTER_Enable(handle, LSM6DSL_ACC_GYRO_MASTER_ON_ENABLED);
cparata 0:763b80993db4 6372
cparata 0:763b80993db4 6373 /* Syncronize the SH with internal trigger (xl) */
cparata 0:763b80993db4 6374 LSM6DSL_ACC_GYRO_W_ODR_XL(handle, LSM6DSL_ACC_GYRO_ODR_XL_104Hz);
cparata 0:763b80993db4 6375
cparata 0:763b80993db4 6376 /* Wait until operation is not completed */
cparata 0:763b80993db4 6377 LSM6DSL_ACC_GYRO_GetRawAccData(handle, dummy);
cparata 0:763b80993db4 6378 do {
cparata 0:763b80993db4 6379 LSM6DSL_ACC_GYRO_R_XLDA(handle, &op_update);
cparata 0:763b80993db4 6380 } while(op_update != LSM6DSL_ACC_GYRO_XLDA_DATA_AVAIL);
cparata 0:763b80993db4 6381 do {
cparata 0:763b80993db4 6382 LSM6DSL_ACC_GYRO_R_SENS_HUB_END(handle, &op_cmpl);
cparata 0:763b80993db4 6383 } while(op_cmpl != LSM6DSL_ACC_GYRO_SENS_HUB_END_OP_COMPLETED);
cparata 0:763b80993db4 6384
cparata 0:763b80993db4 6385 LSM6DSL_ACC_GYRO_W_ODR_XL(handle, LSM6DSL_ACC_GYRO_ODR_XL_POWER_DOWN);
cparata 0:763b80993db4 6386
cparata 0:763b80993db4 6387 /* Stop everything */
cparata 0:763b80993db4 6388 LSM6DSL_ACC_GYRO_W_FUNC_EN(handle, LSM6DSL_ACC_GYRO_FUNC_EN_DISABLED);
cparata 0:763b80993db4 6389 LSM6DSL_ACC_GYRO_W_I2C_MASTER_Enable(handle, LSM6DSL_ACC_GYRO_MASTER_ON_DISABLED);
cparata 0:763b80993db4 6390
cparata 0:763b80993db4 6391
cparata 0:763b80993db4 6392 return MEMS_SUCCESS;
cparata 0:763b80993db4 6393 }