Contains the BSP driver for the B-L475E-IOT01 board.
Dependents: mbed-os-example-ble-Thermometer DISCO_L475VG_IOT01-Telegram-BOT DISCO_L475VG_IOT01-sche_cheveux DISCO_L475VG_IOT01-QSPI_FLASH_FILE_SYSTEM ... more
https://os.mbed.com/platforms/ST-Discovery-L475E-IOT01A/
Diff: Drivers/BSP/B-L475E-IOT01/stm32l475e_iot01_gyro.c
- Revision:
- 3:c6b5944187d5
- Child:
- 5:0c70bc6d2dc0
diff -r 87208512ab66 -r c6b5944187d5 Drivers/BSP/B-L475E-IOT01/stm32l475e_iot01_gyro.c --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/Drivers/BSP/B-L475E-IOT01/stm32l475e_iot01_gyro.c Fri Apr 14 11:34:20 2017 +0200 @@ -0,0 +1,183 @@ +/** + ****************************************************************************** + * @file stm32l475e_iot01_gyro.c + * @author MCD Application Team + * @version V1.0.0 + * @date 17-March-2017 + * @brief This file provides a set of functions needed to manage the gyroscope sensor + ****************************************************************************** + * @attention + * + * <h2><center>© Copyright (c) 2017 STMicroelectronics International N.V. + * All rights reserved.</center></h2> + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted, provided that the following conditions are met: + * + * 1. Redistribution of source code must retain the above copyright notice, + * this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright notice, + * this list of conditions and the following disclaimer in the documentation + * and/or other materials provided with the distribution. + * 3. Neither the name of STMicroelectronics nor the names of other + * contributors to this software may be used to endorse or promote products + * derived from this software without specific written permission. + * 4. This software, including modifications and/or derivative works of this + * software, must execute solely and exclusively on microcontroller or + * microprocessor devices manufactured by or for STMicroelectronics. + * 5. Redistribution and use of this software other than as permitted under + * this license is void and will automatically terminate your rights under + * this license. + * + * THIS SOFTWARE IS PROVIDED BY STMICROELECTRONICS AND CONTRIBUTORS "AS IS" + * AND ANY EXPRESS, IMPLIED OR STATUTORY WARRANTIES, INCLUDING, BUT NOT + * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY, FITNESS FOR A + * PARTICULAR PURPOSE AND NON-INFRINGEMENT OF THIRD PARTY INTELLECTUAL PROPERTY + * RIGHTS ARE DISCLAIMED TO THE FULLEST EXTENT PERMITTED BY LAW. IN NO EVENT + * SHALL STMICROELECTRONICS OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, + * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT + * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, + * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF + * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING + * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, + * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. + * + ****************************************************************************** + */ + +/* Includes ------------------------------------------------------------------*/ +#include "stm32l475e_iot01_gyro.h" + +/** @addtogroup BSP + * @{ + */ + +/** @addtogroup STM32L475E_IOT01 + * @{ + */ + +/** @defgroup STM32L475E_IOT01_GYROSCOPE GYROSCOPE + * @{ + */ + +/** @defgroup STM32L475E_IOT01_GYROSCOPE_Private_Variables GYROSCOPE Private Variables + * @{ + */ +static GYRO_DrvTypeDef *GyroscopeDrv; + +/** + * @} + */ + + +/** @defgroup STM32L475E_IOT01_GYROSCOPE_Private_Functions GYROSCOPE Private Functions + * @{ + */ +/** + * @brief Initialize Gyroscope. + * @retval GYRO_OK or GYRO_ERROR + */ +uint8_t BSP_GYRO_Init(void) +{ + uint8_t ret = GYRO_ERROR; + uint16_t ctrl = 0x0000; + GYRO_InitTypeDef LSM6DSL_InitStructure; + + if(Lsm6dslGyroDrv.ReadID() != LSM6DSL_ACC_GYRO_WHO_AM_I) + { + ret = GYRO_ERROR; + } + else + { + /* Initialize the gyroscope driver structure */ + GyroscopeDrv = &Lsm6dslGyroDrv; + + /* Configure Mems : data rate, power mode, full scale and axes */ + LSM6DSL_InitStructure.Power_Mode = 0; + LSM6DSL_InitStructure.Output_DataRate = LSM6DSL_ODR_52Hz; + LSM6DSL_InitStructure.Axes_Enable = 0; + LSM6DSL_InitStructure.Band_Width = 0; + LSM6DSL_InitStructure.BlockData_Update = LSM6DSL_BDU_BLOCK_UPDATE; + LSM6DSL_InitStructure.Endianness = 0; + LSM6DSL_InitStructure.Full_Scale = LSM6DSL_GYRO_FS_2000; + + /* Configure MEMS: data rate, full scale */ + ctrl = (LSM6DSL_InitStructure.Full_Scale | LSM6DSL_InitStructure.Output_DataRate); + + /* Configure MEMS: BDU and Auto-increment for multi read/write */ + ctrl |= ((LSM6DSL_InitStructure.BlockData_Update | LSM6DSL_ACC_GYRO_IF_INC_ENABLED) << 8); + + /* Initialize component */ + GyroscopeDrv->Init(ctrl); + + ret = GYRO_OK; + } + + return ret; +} + + +/** + * @brief DeInitialize Gyroscope. + */ +void BSP_GYRO_DeInit(void) +{ + /* DeInitialize the Gyroscope IO interfaces */ + if(GyroscopeDrv != NULL) + { + if(GyroscopeDrv->DeInit!= NULL) + { + GyroscopeDrv->DeInit(); + } + } +} + + +/** + * @brief Set/Unset Gyroscope in low power mode. + * @param status 0 means disable Low Power Mode, otherwise Low Power Mode is enabled + */ +void BSP_GYRO_LowPower(uint16_t status) +{ + /* Set/Unset component in low-power mode */ + if(GyroscopeDrv != NULL) + { + if(GyroscopeDrv->LowPower!= NULL) + { + GyroscopeDrv->LowPower(status); + } + } +} + +/** + * @brief Get XYZ angular acceleration from the Gyroscope. + * @param pfData: pointer on floating array + */ +void BSP_GYRO_GetXYZ(float* pfData) +{ + if(GyroscopeDrv != NULL) + { + if(GyroscopeDrv->GetXYZ!= NULL) + { + GyroscopeDrv->GetXYZ(pfData); + } + } +} + +/** + * @} + */ + +/** + * @} + */ + +/** + * @} + */ + +/** + * @} + */ + +/************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/