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/
Drivers/BSP/B-L475E-IOT01/stm32l475e_iot01_gyro.c@6:9dfa42666f03, 2018-01-19 (annotated)
- Committer:
- bcostm
- Date:
- Fri Jan 19 14:27:51 2018 +0100
- Revision:
- 6:9dfa42666f03
- Parent:
- 5:0c70bc6d2dc0
- Child:
- 7:bfe8272ced90
Update BSP files with STM32Cube L4 V1.11.0
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
bcostm | 3:c6b5944187d5 | 1 | /** |
bcostm | 3:c6b5944187d5 | 2 | ****************************************************************************** |
bcostm | 3:c6b5944187d5 | 3 | * @file stm32l475e_iot01_gyro.c |
bcostm | 3:c6b5944187d5 | 4 | * @author MCD Application Team |
bcostm | 3:c6b5944187d5 | 5 | * @brief This file provides a set of functions needed to manage the gyroscope sensor |
bcostm | 3:c6b5944187d5 | 6 | ****************************************************************************** |
bcostm | 3:c6b5944187d5 | 7 | * @attention |
bcostm | 3:c6b5944187d5 | 8 | * |
bcostm | 3:c6b5944187d5 | 9 | * <h2><center>© Copyright (c) 2017 STMicroelectronics International N.V. |
bcostm | 3:c6b5944187d5 | 10 | * All rights reserved.</center></h2> |
bcostm | 3:c6b5944187d5 | 11 | * |
bcostm | 3:c6b5944187d5 | 12 | * Redistribution and use in source and binary forms, with or without |
bcostm | 3:c6b5944187d5 | 13 | * modification, are permitted, provided that the following conditions are met: |
bcostm | 3:c6b5944187d5 | 14 | * |
bcostm | 3:c6b5944187d5 | 15 | * 1. Redistribution of source code must retain the above copyright notice, |
bcostm | 3:c6b5944187d5 | 16 | * this list of conditions and the following disclaimer. |
bcostm | 3:c6b5944187d5 | 17 | * 2. Redistributions in binary form must reproduce the above copyright notice, |
bcostm | 3:c6b5944187d5 | 18 | * this list of conditions and the following disclaimer in the documentation |
bcostm | 3:c6b5944187d5 | 19 | * and/or other materials provided with the distribution. |
bcostm | 3:c6b5944187d5 | 20 | * 3. Neither the name of STMicroelectronics nor the names of other |
bcostm | 3:c6b5944187d5 | 21 | * contributors to this software may be used to endorse or promote products |
bcostm | 3:c6b5944187d5 | 22 | * derived from this software without specific written permission. |
bcostm | 3:c6b5944187d5 | 23 | * 4. This software, including modifications and/or derivative works of this |
bcostm | 3:c6b5944187d5 | 24 | * software, must execute solely and exclusively on microcontroller or |
bcostm | 3:c6b5944187d5 | 25 | * microprocessor devices manufactured by or for STMicroelectronics. |
bcostm | 3:c6b5944187d5 | 26 | * 5. Redistribution and use of this software other than as permitted under |
bcostm | 3:c6b5944187d5 | 27 | * this license is void and will automatically terminate your rights under |
bcostm | 3:c6b5944187d5 | 28 | * this license. |
bcostm | 3:c6b5944187d5 | 29 | * |
bcostm | 3:c6b5944187d5 | 30 | * THIS SOFTWARE IS PROVIDED BY STMICROELECTRONICS AND CONTRIBUTORS "AS IS" |
bcostm | 3:c6b5944187d5 | 31 | * AND ANY EXPRESS, IMPLIED OR STATUTORY WARRANTIES, INCLUDING, BUT NOT |
bcostm | 3:c6b5944187d5 | 32 | * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY, FITNESS FOR A |
bcostm | 3:c6b5944187d5 | 33 | * PARTICULAR PURPOSE AND NON-INFRINGEMENT OF THIRD PARTY INTELLECTUAL PROPERTY |
bcostm | 3:c6b5944187d5 | 34 | * RIGHTS ARE DISCLAIMED TO THE FULLEST EXTENT PERMITTED BY LAW. IN NO EVENT |
bcostm | 3:c6b5944187d5 | 35 | * SHALL STMICROELECTRONICS OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, |
bcostm | 3:c6b5944187d5 | 36 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT |
bcostm | 3:c6b5944187d5 | 37 | * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, |
bcostm | 3:c6b5944187d5 | 38 | * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF |
bcostm | 3:c6b5944187d5 | 39 | * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING |
bcostm | 3:c6b5944187d5 | 40 | * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, |
bcostm | 3:c6b5944187d5 | 41 | * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
bcostm | 3:c6b5944187d5 | 42 | * |
bcostm | 3:c6b5944187d5 | 43 | ****************************************************************************** |
bcostm | 3:c6b5944187d5 | 44 | */ |
bcostm | 3:c6b5944187d5 | 45 | |
bcostm | 3:c6b5944187d5 | 46 | /* Includes ------------------------------------------------------------------*/ |
bcostm | 3:c6b5944187d5 | 47 | #include "stm32l475e_iot01_gyro.h" |
bcostm | 3:c6b5944187d5 | 48 | |
bcostm | 3:c6b5944187d5 | 49 | /** @addtogroup BSP |
bcostm | 3:c6b5944187d5 | 50 | * @{ |
bcostm | 3:c6b5944187d5 | 51 | */ |
bcostm | 3:c6b5944187d5 | 52 | |
bcostm | 3:c6b5944187d5 | 53 | /** @addtogroup STM32L475E_IOT01 |
bcostm | 3:c6b5944187d5 | 54 | * @{ |
bcostm | 3:c6b5944187d5 | 55 | */ |
bcostm | 3:c6b5944187d5 | 56 | |
bcostm | 3:c6b5944187d5 | 57 | /** @defgroup STM32L475E_IOT01_GYROSCOPE GYROSCOPE |
bcostm | 3:c6b5944187d5 | 58 | * @{ |
bcostm | 3:c6b5944187d5 | 59 | */ |
bcostm | 3:c6b5944187d5 | 60 | |
bcostm | 3:c6b5944187d5 | 61 | /** @defgroup STM32L475E_IOT01_GYROSCOPE_Private_Variables GYROSCOPE Private Variables |
bcostm | 3:c6b5944187d5 | 62 | * @{ |
bcostm | 3:c6b5944187d5 | 63 | */ |
bcostm | 3:c6b5944187d5 | 64 | static GYRO_DrvTypeDef *GyroscopeDrv; |
bcostm | 3:c6b5944187d5 | 65 | |
bcostm | 3:c6b5944187d5 | 66 | /** |
bcostm | 3:c6b5944187d5 | 67 | * @} |
bcostm | 3:c6b5944187d5 | 68 | */ |
bcostm | 3:c6b5944187d5 | 69 | |
bcostm | 3:c6b5944187d5 | 70 | |
bcostm | 3:c6b5944187d5 | 71 | /** @defgroup STM32L475E_IOT01_GYROSCOPE_Private_Functions GYROSCOPE Private Functions |
bcostm | 3:c6b5944187d5 | 72 | * @{ |
bcostm | 3:c6b5944187d5 | 73 | */ |
bcostm | 3:c6b5944187d5 | 74 | /** |
bcostm | 3:c6b5944187d5 | 75 | * @brief Initialize Gyroscope. |
bcostm | 3:c6b5944187d5 | 76 | * @retval GYRO_OK or GYRO_ERROR |
bcostm | 3:c6b5944187d5 | 77 | */ |
bcostm | 3:c6b5944187d5 | 78 | uint8_t BSP_GYRO_Init(void) |
bcostm | 3:c6b5944187d5 | 79 | { |
bcostm | 3:c6b5944187d5 | 80 | uint8_t ret = GYRO_ERROR; |
bcostm | 3:c6b5944187d5 | 81 | uint16_t ctrl = 0x0000; |
bcostm | 3:c6b5944187d5 | 82 | GYRO_InitTypeDef LSM6DSL_InitStructure; |
bcostm | 3:c6b5944187d5 | 83 | |
bcostm | 3:c6b5944187d5 | 84 | if(Lsm6dslGyroDrv.ReadID() != LSM6DSL_ACC_GYRO_WHO_AM_I) |
bcostm | 3:c6b5944187d5 | 85 | { |
bcostm | 3:c6b5944187d5 | 86 | ret = GYRO_ERROR; |
bcostm | 3:c6b5944187d5 | 87 | } |
bcostm | 3:c6b5944187d5 | 88 | else |
bcostm | 3:c6b5944187d5 | 89 | { |
bcostm | 3:c6b5944187d5 | 90 | /* Initialize the gyroscope driver structure */ |
bcostm | 3:c6b5944187d5 | 91 | GyroscopeDrv = &Lsm6dslGyroDrv; |
bcostm | 3:c6b5944187d5 | 92 | |
bcostm | 3:c6b5944187d5 | 93 | /* Configure Mems : data rate, power mode, full scale and axes */ |
bcostm | 3:c6b5944187d5 | 94 | LSM6DSL_InitStructure.Power_Mode = 0; |
bcostm | 3:c6b5944187d5 | 95 | LSM6DSL_InitStructure.Output_DataRate = LSM6DSL_ODR_52Hz; |
bcostm | 3:c6b5944187d5 | 96 | LSM6DSL_InitStructure.Axes_Enable = 0; |
bcostm | 3:c6b5944187d5 | 97 | LSM6DSL_InitStructure.Band_Width = 0; |
bcostm | 3:c6b5944187d5 | 98 | LSM6DSL_InitStructure.BlockData_Update = LSM6DSL_BDU_BLOCK_UPDATE; |
bcostm | 3:c6b5944187d5 | 99 | LSM6DSL_InitStructure.Endianness = 0; |
bcostm | 3:c6b5944187d5 | 100 | LSM6DSL_InitStructure.Full_Scale = LSM6DSL_GYRO_FS_2000; |
bcostm | 3:c6b5944187d5 | 101 | |
bcostm | 3:c6b5944187d5 | 102 | /* Configure MEMS: data rate, full scale */ |
bcostm | 3:c6b5944187d5 | 103 | ctrl = (LSM6DSL_InitStructure.Full_Scale | LSM6DSL_InitStructure.Output_DataRate); |
bcostm | 3:c6b5944187d5 | 104 | |
bcostm | 3:c6b5944187d5 | 105 | /* Configure MEMS: BDU and Auto-increment for multi read/write */ |
bcostm | 3:c6b5944187d5 | 106 | ctrl |= ((LSM6DSL_InitStructure.BlockData_Update | LSM6DSL_ACC_GYRO_IF_INC_ENABLED) << 8); |
bcostm | 3:c6b5944187d5 | 107 | |
bcostm | 3:c6b5944187d5 | 108 | /* Initialize component */ |
bcostm | 3:c6b5944187d5 | 109 | GyroscopeDrv->Init(ctrl); |
bcostm | 3:c6b5944187d5 | 110 | |
bcostm | 3:c6b5944187d5 | 111 | ret = GYRO_OK; |
bcostm | 3:c6b5944187d5 | 112 | } |
bcostm | 3:c6b5944187d5 | 113 | |
bcostm | 3:c6b5944187d5 | 114 | return ret; |
bcostm | 3:c6b5944187d5 | 115 | } |
bcostm | 3:c6b5944187d5 | 116 | |
bcostm | 3:c6b5944187d5 | 117 | |
bcostm | 3:c6b5944187d5 | 118 | /** |
bcostm | 3:c6b5944187d5 | 119 | * @brief DeInitialize Gyroscope. |
bcostm | 3:c6b5944187d5 | 120 | */ |
bcostm | 3:c6b5944187d5 | 121 | void BSP_GYRO_DeInit(void) |
bcostm | 3:c6b5944187d5 | 122 | { |
bcostm | 3:c6b5944187d5 | 123 | /* DeInitialize the Gyroscope IO interfaces */ |
bcostm | 3:c6b5944187d5 | 124 | if(GyroscopeDrv != NULL) |
bcostm | 3:c6b5944187d5 | 125 | { |
bcostm | 3:c6b5944187d5 | 126 | if(GyroscopeDrv->DeInit!= NULL) |
bcostm | 3:c6b5944187d5 | 127 | { |
bcostm | 3:c6b5944187d5 | 128 | GyroscopeDrv->DeInit(); |
bcostm | 3:c6b5944187d5 | 129 | } |
bcostm | 3:c6b5944187d5 | 130 | } |
bcostm | 3:c6b5944187d5 | 131 | } |
bcostm | 3:c6b5944187d5 | 132 | |
bcostm | 3:c6b5944187d5 | 133 | |
bcostm | 3:c6b5944187d5 | 134 | /** |
bcostm | 3:c6b5944187d5 | 135 | * @brief Set/Unset Gyroscope in low power mode. |
bcostm | 3:c6b5944187d5 | 136 | * @param status 0 means disable Low Power Mode, otherwise Low Power Mode is enabled |
bcostm | 3:c6b5944187d5 | 137 | */ |
bcostm | 3:c6b5944187d5 | 138 | void BSP_GYRO_LowPower(uint16_t status) |
bcostm | 3:c6b5944187d5 | 139 | { |
bcostm | 3:c6b5944187d5 | 140 | /* Set/Unset component in low-power mode */ |
bcostm | 3:c6b5944187d5 | 141 | if(GyroscopeDrv != NULL) |
bcostm | 3:c6b5944187d5 | 142 | { |
bcostm | 3:c6b5944187d5 | 143 | if(GyroscopeDrv->LowPower!= NULL) |
bcostm | 3:c6b5944187d5 | 144 | { |
bcostm | 3:c6b5944187d5 | 145 | GyroscopeDrv->LowPower(status); |
bcostm | 3:c6b5944187d5 | 146 | } |
bcostm | 3:c6b5944187d5 | 147 | } |
bcostm | 3:c6b5944187d5 | 148 | } |
bcostm | 3:c6b5944187d5 | 149 | |
bcostm | 3:c6b5944187d5 | 150 | /** |
bcostm | 3:c6b5944187d5 | 151 | * @brief Get XYZ angular acceleration from the Gyroscope. |
bcostm | 3:c6b5944187d5 | 152 | * @param pfData: pointer on floating array |
bcostm | 3:c6b5944187d5 | 153 | */ |
bcostm | 3:c6b5944187d5 | 154 | void BSP_GYRO_GetXYZ(float* pfData) |
bcostm | 3:c6b5944187d5 | 155 | { |
bcostm | 3:c6b5944187d5 | 156 | if(GyroscopeDrv != NULL) |
bcostm | 3:c6b5944187d5 | 157 | { |
bcostm | 3:c6b5944187d5 | 158 | if(GyroscopeDrv->GetXYZ!= NULL) |
bcostm | 3:c6b5944187d5 | 159 | { |
bcostm | 3:c6b5944187d5 | 160 | GyroscopeDrv->GetXYZ(pfData); |
bcostm | 3:c6b5944187d5 | 161 | } |
bcostm | 3:c6b5944187d5 | 162 | } |
bcostm | 3:c6b5944187d5 | 163 | } |
bcostm | 3:c6b5944187d5 | 164 | |
bcostm | 3:c6b5944187d5 | 165 | /** |
bcostm | 3:c6b5944187d5 | 166 | * @} |
bcostm | 3:c6b5944187d5 | 167 | */ |
bcostm | 3:c6b5944187d5 | 168 | |
bcostm | 3:c6b5944187d5 | 169 | /** |
bcostm | 3:c6b5944187d5 | 170 | * @} |
bcostm | 3:c6b5944187d5 | 171 | */ |
bcostm | 3:c6b5944187d5 | 172 | |
bcostm | 3:c6b5944187d5 | 173 | /** |
bcostm | 3:c6b5944187d5 | 174 | * @} |
bcostm | 3:c6b5944187d5 | 175 | */ |
bcostm | 3:c6b5944187d5 | 176 | |
bcostm | 3:c6b5944187d5 | 177 | /** |
bcostm | 3:c6b5944187d5 | 178 | * @} |
bcostm | 3:c6b5944187d5 | 179 | */ |
bcostm | 3:c6b5944187d5 | 180 | |
bcostm | 3:c6b5944187d5 | 181 | /************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/ |