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