fix LPC812 PWM
Fork of mbed-dev by
targets/cmsis/TARGET_STM/TARGET_STM32L4/stm32l4xx_hal_opamp_ex.c@0:9b334a45a8ff, 2015-10-01 (annotated)
- Committer:
- bogdanm
- Date:
- Thu Oct 01 15:25:22 2015 +0300
- Revision:
- 0:9b334a45a8ff
Initial commit on mbed-dev
Replaces mbed-src (now inactive)
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
bogdanm | 0:9b334a45a8ff | 1 | /** |
bogdanm | 0:9b334a45a8ff | 2 | ****************************************************************************** |
bogdanm | 0:9b334a45a8ff | 3 | * @file stm32l4xx_hal_opamp_ex.c |
bogdanm | 0:9b334a45a8ff | 4 | * @author MCD Application Team |
bogdanm | 0:9b334a45a8ff | 5 | * @version V1.0.0 |
bogdanm | 0:9b334a45a8ff | 6 | * @date 26-June-2015 |
bogdanm | 0:9b334a45a8ff | 7 | * @brief Extended OPAMP HAL module driver. |
bogdanm | 0:9b334a45a8ff | 8 | * This file provides firmware functions to manage the following |
bogdanm | 0:9b334a45a8ff | 9 | * functionalities of the operational amplifier(s)(OPAMP1, OPAMP2 etc) |
bogdanm | 0:9b334a45a8ff | 10 | * peripheral: |
bogdanm | 0:9b334a45a8ff | 11 | * + Extended Initialization and de-initialization functions |
bogdanm | 0:9b334a45a8ff | 12 | * + Extended Peripheral Control functions |
bogdanm | 0:9b334a45a8ff | 13 | * |
bogdanm | 0:9b334a45a8ff | 14 | @verbatim |
bogdanm | 0:9b334a45a8ff | 15 | ****************************************************************************** |
bogdanm | 0:9b334a45a8ff | 16 | * @attention |
bogdanm | 0:9b334a45a8ff | 17 | * |
bogdanm | 0:9b334a45a8ff | 18 | * <h2><center>© COPYRIGHT(c) 2015 STMicroelectronics</center></h2> |
bogdanm | 0:9b334a45a8ff | 19 | * |
bogdanm | 0:9b334a45a8ff | 20 | * Redistribution and use in source and binary forms, with or without modification, |
bogdanm | 0:9b334a45a8ff | 21 | * are permitted provided that the following conditions are met: |
bogdanm | 0:9b334a45a8ff | 22 | * 1. Redistributions of source code must retain the above copyright notice, |
bogdanm | 0:9b334a45a8ff | 23 | * this list of conditions and the following disclaimer. |
bogdanm | 0:9b334a45a8ff | 24 | * 2. Redistributions in binary form must reproduce the above copyright notice, |
bogdanm | 0:9b334a45a8ff | 25 | * this list of conditions and the following disclaimer in the documentation |
bogdanm | 0:9b334a45a8ff | 26 | * and/or other materials provided with the distribution. |
bogdanm | 0:9b334a45a8ff | 27 | * 3. Neither the name of STMicroelectronics nor the names of its contributors |
bogdanm | 0:9b334a45a8ff | 28 | * may be used to endorse or promote products derived from this software |
bogdanm | 0:9b334a45a8ff | 29 | * without specific prior written permission. |
bogdanm | 0:9b334a45a8ff | 30 | * |
bogdanm | 0:9b334a45a8ff | 31 | * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" |
bogdanm | 0:9b334a45a8ff | 32 | * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
bogdanm | 0:9b334a45a8ff | 33 | * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE |
bogdanm | 0:9b334a45a8ff | 34 | * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE |
bogdanm | 0:9b334a45a8ff | 35 | * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL |
bogdanm | 0:9b334a45a8ff | 36 | * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR |
bogdanm | 0:9b334a45a8ff | 37 | * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER |
bogdanm | 0:9b334a45a8ff | 38 | * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, |
bogdanm | 0:9b334a45a8ff | 39 | * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE |
bogdanm | 0:9b334a45a8ff | 40 | * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
bogdanm | 0:9b334a45a8ff | 41 | * |
bogdanm | 0:9b334a45a8ff | 42 | ****************************************************************************** |
bogdanm | 0:9b334a45a8ff | 43 | */ |
bogdanm | 0:9b334a45a8ff | 44 | |
bogdanm | 0:9b334a45a8ff | 45 | /* Includes ------------------------------------------------------------------*/ |
bogdanm | 0:9b334a45a8ff | 46 | #include "stm32l4xx_hal.h" |
bogdanm | 0:9b334a45a8ff | 47 | |
bogdanm | 0:9b334a45a8ff | 48 | /** @addtogroup STM32L4xx_HAL_Driver |
bogdanm | 0:9b334a45a8ff | 49 | * @{ |
bogdanm | 0:9b334a45a8ff | 50 | */ |
bogdanm | 0:9b334a45a8ff | 51 | |
bogdanm | 0:9b334a45a8ff | 52 | /** @defgroup OPAMPEx OPAMPEx |
bogdanm | 0:9b334a45a8ff | 53 | * @brief OPAMP Extended HAL module driver |
bogdanm | 0:9b334a45a8ff | 54 | * @{ |
bogdanm | 0:9b334a45a8ff | 55 | */ |
bogdanm | 0:9b334a45a8ff | 56 | |
bogdanm | 0:9b334a45a8ff | 57 | #ifdef HAL_OPAMP_MODULE_ENABLED |
bogdanm | 0:9b334a45a8ff | 58 | |
bogdanm | 0:9b334a45a8ff | 59 | /* Private typedef -----------------------------------------------------------*/ |
bogdanm | 0:9b334a45a8ff | 60 | /* Private define ------------------------------------------------------------*/ |
bogdanm | 0:9b334a45a8ff | 61 | /* Private macro -------------------------------------------------------------*/ |
bogdanm | 0:9b334a45a8ff | 62 | /* Private variables ---------------------------------------------------------*/ |
bogdanm | 0:9b334a45a8ff | 63 | /* Private function prototypes -----------------------------------------------*/ |
bogdanm | 0:9b334a45a8ff | 64 | /* Exported functions --------------------------------------------------------*/ |
bogdanm | 0:9b334a45a8ff | 65 | |
bogdanm | 0:9b334a45a8ff | 66 | /** @defgroup OPAMP_Exported_Functions OPAMP Exported Functions |
bogdanm | 0:9b334a45a8ff | 67 | * @{ |
bogdanm | 0:9b334a45a8ff | 68 | */ |
bogdanm | 0:9b334a45a8ff | 69 | |
bogdanm | 0:9b334a45a8ff | 70 | /** @addtogroup OPAMPEx_Exported_Functions_Group1 |
bogdanm | 0:9b334a45a8ff | 71 | * @brief Extended operation functions |
bogdanm | 0:9b334a45a8ff | 72 | * |
bogdanm | 0:9b334a45a8ff | 73 | @verbatim |
bogdanm | 0:9b334a45a8ff | 74 | =============================================================================== |
bogdanm | 0:9b334a45a8ff | 75 | ##### Extended IO operation functions ##### |
bogdanm | 0:9b334a45a8ff | 76 | =============================================================================== |
bogdanm | 0:9b334a45a8ff | 77 | [..] |
bogdanm | 0:9b334a45a8ff | 78 | (+) OPAMP Self calibration. |
bogdanm | 0:9b334a45a8ff | 79 | |
bogdanm | 0:9b334a45a8ff | 80 | @endverbatim |
bogdanm | 0:9b334a45a8ff | 81 | * @{ |
bogdanm | 0:9b334a45a8ff | 82 | */ |
bogdanm | 0:9b334a45a8ff | 83 | |
bogdanm | 0:9b334a45a8ff | 84 | /* 2 OPAMPS available */ |
bogdanm | 0:9b334a45a8ff | 85 | /* 2 OPAMPS can be calibrated in parallel */ |
bogdanm | 0:9b334a45a8ff | 86 | |
bogdanm | 0:9b334a45a8ff | 87 | /** |
bogdanm | 0:9b334a45a8ff | 88 | * @brief Run the self calibration of the 2 OPAMPs in parallel. |
bogdanm | 0:9b334a45a8ff | 89 | * @note Trimming values (PMOS & NMOS) are updated and user trimming is |
bogdanm | 0:9b334a45a8ff | 90 | * enabled is calibration is successful. |
bogdanm | 0:9b334a45a8ff | 91 | * @note Calibration is performed in the mode specified in OPAMP init |
bogdanm | 0:9b334a45a8ff | 92 | * structure (mode normal or low-power). To perform calibration for |
bogdanm | 0:9b334a45a8ff | 93 | * both modes, repeat this function twice after OPAMP init structure |
bogdanm | 0:9b334a45a8ff | 94 | * accordingly updated. |
bogdanm | 0:9b334a45a8ff | 95 | * @note Calibration runs about 10 ms (5 dichotomy steps, repeated for P |
bogdanm | 0:9b334a45a8ff | 96 | * and N transistors: 10 steps with 1 ms for each step). |
bogdanm | 0:9b334a45a8ff | 97 | * @param hopamp1 handle |
bogdanm | 0:9b334a45a8ff | 98 | * @param hopamp2 handle |
bogdanm | 0:9b334a45a8ff | 99 | * @retval HAL status |
bogdanm | 0:9b334a45a8ff | 100 | */ |
bogdanm | 0:9b334a45a8ff | 101 | |
bogdanm | 0:9b334a45a8ff | 102 | HAL_StatusTypeDef HAL_OPAMPEx_SelfCalibrateAll(OPAMP_HandleTypeDef *hopamp1, OPAMP_HandleTypeDef *hopamp2) |
bogdanm | 0:9b334a45a8ff | 103 | { |
bogdanm | 0:9b334a45a8ff | 104 | HAL_StatusTypeDef status = HAL_OK; |
bogdanm | 0:9b334a45a8ff | 105 | |
bogdanm | 0:9b334a45a8ff | 106 | uint32_t trimmingvaluen1 = 0; |
bogdanm | 0:9b334a45a8ff | 107 | uint32_t trimmingvaluep1 = 0; |
bogdanm | 0:9b334a45a8ff | 108 | uint32_t trimmingvaluen2 = 0; |
bogdanm | 0:9b334a45a8ff | 109 | uint32_t trimmingvaluep2 = 0; |
bogdanm | 0:9b334a45a8ff | 110 | |
bogdanm | 0:9b334a45a8ff | 111 | /* Selection of register of trimming depending on power mode: OTR or LPOTR */ |
bogdanm | 0:9b334a45a8ff | 112 | __IO uint32_t* tmp_opamp1_reg_trimming; |
bogdanm | 0:9b334a45a8ff | 113 | __IO uint32_t* tmp_opamp2_reg_trimming; |
bogdanm | 0:9b334a45a8ff | 114 | |
bogdanm | 0:9b334a45a8ff | 115 | uint32_t delta; |
bogdanm | 0:9b334a45a8ff | 116 | |
bogdanm | 0:9b334a45a8ff | 117 | if((hopamp1 == NULL) || (hopamp1->State == HAL_OPAMP_STATE_BUSYLOCKED) || \ |
bogdanm | 0:9b334a45a8ff | 118 | (hopamp2 == NULL) || (hopamp2->State == HAL_OPAMP_STATE_BUSYLOCKED)) |
bogdanm | 0:9b334a45a8ff | 119 | { |
bogdanm | 0:9b334a45a8ff | 120 | status = HAL_ERROR; |
bogdanm | 0:9b334a45a8ff | 121 | } |
bogdanm | 0:9b334a45a8ff | 122 | else |
bogdanm | 0:9b334a45a8ff | 123 | { |
bogdanm | 0:9b334a45a8ff | 124 | /* Check if OPAMP in calibration mode and calibration not yet enable */ |
bogdanm | 0:9b334a45a8ff | 125 | if((hopamp1->State == HAL_OPAMP_STATE_READY) && (hopamp2->State == HAL_OPAMP_STATE_READY)) |
bogdanm | 0:9b334a45a8ff | 126 | { |
bogdanm | 0:9b334a45a8ff | 127 | /* Check the parameter */ |
bogdanm | 0:9b334a45a8ff | 128 | assert_param(IS_OPAMP_ALL_INSTANCE(hopamp1->Instance)); |
bogdanm | 0:9b334a45a8ff | 129 | assert_param(IS_OPAMP_ALL_INSTANCE(hopamp2->Instance)); |
bogdanm | 0:9b334a45a8ff | 130 | |
bogdanm | 0:9b334a45a8ff | 131 | assert_param(IS_OPAMP_POWERMODE(hopamp1->Init.PowerMode)); |
bogdanm | 0:9b334a45a8ff | 132 | assert_param(IS_OPAMP_POWERMODE(hopamp2->Init.PowerMode)); |
bogdanm | 0:9b334a45a8ff | 133 | |
bogdanm | 0:9b334a45a8ff | 134 | /* user trimming values are used for offset calibration */ |
bogdanm | 0:9b334a45a8ff | 135 | SET_BIT(hopamp1->Instance->CSR, OPAMP_CSR_USERTRIM); |
bogdanm | 0:9b334a45a8ff | 136 | SET_BIT(hopamp2->Instance->CSR, OPAMP_CSR_USERTRIM); |
bogdanm | 0:9b334a45a8ff | 137 | |
bogdanm | 0:9b334a45a8ff | 138 | /* Select trimming settings depending on power mode */ |
bogdanm | 0:9b334a45a8ff | 139 | if (hopamp1->Init.PowerMode == OPAMP_POWERMODE_NORMAL) |
bogdanm | 0:9b334a45a8ff | 140 | { |
bogdanm | 0:9b334a45a8ff | 141 | tmp_opamp1_reg_trimming = &OPAMP1->OTR; |
bogdanm | 0:9b334a45a8ff | 142 | } |
bogdanm | 0:9b334a45a8ff | 143 | else |
bogdanm | 0:9b334a45a8ff | 144 | { |
bogdanm | 0:9b334a45a8ff | 145 | tmp_opamp1_reg_trimming = &OPAMP1->LPOTR; |
bogdanm | 0:9b334a45a8ff | 146 | } |
bogdanm | 0:9b334a45a8ff | 147 | |
bogdanm | 0:9b334a45a8ff | 148 | if (hopamp2->Init.PowerMode == OPAMP_POWERMODE_NORMAL) |
bogdanm | 0:9b334a45a8ff | 149 | { |
bogdanm | 0:9b334a45a8ff | 150 | tmp_opamp2_reg_trimming = &OPAMP2->OTR; |
bogdanm | 0:9b334a45a8ff | 151 | } |
bogdanm | 0:9b334a45a8ff | 152 | else |
bogdanm | 0:9b334a45a8ff | 153 | { |
bogdanm | 0:9b334a45a8ff | 154 | tmp_opamp2_reg_trimming = &OPAMP2->LPOTR; |
bogdanm | 0:9b334a45a8ff | 155 | } |
bogdanm | 0:9b334a45a8ff | 156 | |
bogdanm | 0:9b334a45a8ff | 157 | /* Enable calibration */ |
bogdanm | 0:9b334a45a8ff | 158 | SET_BIT (hopamp1->Instance->CSR, OPAMP_CSR_CALON); |
bogdanm | 0:9b334a45a8ff | 159 | SET_BIT (hopamp2->Instance->CSR, OPAMP_CSR_CALON); |
bogdanm | 0:9b334a45a8ff | 160 | |
bogdanm | 0:9b334a45a8ff | 161 | /* 1st calibration - N */ |
bogdanm | 0:9b334a45a8ff | 162 | CLEAR_BIT (hopamp1->Instance->CSR, OPAMP_CSR_CALSEL); |
bogdanm | 0:9b334a45a8ff | 163 | CLEAR_BIT (hopamp2->Instance->CSR, OPAMP_CSR_CALSEL); |
bogdanm | 0:9b334a45a8ff | 164 | |
bogdanm | 0:9b334a45a8ff | 165 | /* Enable the selected opamp */ |
bogdanm | 0:9b334a45a8ff | 166 | SET_BIT (hopamp1->Instance->CSR, OPAMP_CSR_OPAMPxEN); |
bogdanm | 0:9b334a45a8ff | 167 | SET_BIT (hopamp2->Instance->CSR, OPAMP_CSR_OPAMPxEN); |
bogdanm | 0:9b334a45a8ff | 168 | |
bogdanm | 0:9b334a45a8ff | 169 | /* Init trimming counter */ |
bogdanm | 0:9b334a45a8ff | 170 | /* Medium value */ |
bogdanm | 0:9b334a45a8ff | 171 | trimmingvaluen1 = 16; |
bogdanm | 0:9b334a45a8ff | 172 | trimmingvaluen2 = 16; |
bogdanm | 0:9b334a45a8ff | 173 | delta = 8; |
bogdanm | 0:9b334a45a8ff | 174 | |
bogdanm | 0:9b334a45a8ff | 175 | while (delta != 0) |
bogdanm | 0:9b334a45a8ff | 176 | { |
bogdanm | 0:9b334a45a8ff | 177 | /* Set candidate trimming */ |
bogdanm | 0:9b334a45a8ff | 178 | /* OPAMP_POWERMODE_NORMAL */ |
bogdanm | 0:9b334a45a8ff | 179 | MODIFY_REG(*tmp_opamp1_reg_trimming, OPAMP_OTR_TRIMOFFSETN, trimmingvaluen1); |
bogdanm | 0:9b334a45a8ff | 180 | MODIFY_REG(*tmp_opamp2_reg_trimming, OPAMP_OTR_TRIMOFFSETN, trimmingvaluen2); |
bogdanm | 0:9b334a45a8ff | 181 | |
bogdanm | 0:9b334a45a8ff | 182 | /* OFFTRIMmax delay 1 ms as per datasheet (electrical characteristics */ |
bogdanm | 0:9b334a45a8ff | 183 | /* Offset trim time: during calibration, minimum time needed between */ |
bogdanm | 0:9b334a45a8ff | 184 | /* two steps to have 1 mV accuracy */ |
bogdanm | 0:9b334a45a8ff | 185 | HAL_Delay(OPAMP_TRIMMING_DELAY); |
bogdanm | 0:9b334a45a8ff | 186 | |
bogdanm | 0:9b334a45a8ff | 187 | if (READ_BIT(hopamp1->Instance->CSR, OPAMP_CSR_CALOUT) != RESET) |
bogdanm | 0:9b334a45a8ff | 188 | { |
bogdanm | 0:9b334a45a8ff | 189 | /* OPAMP_CSR_CALOUT is HIGH try lower trimming */ |
bogdanm | 0:9b334a45a8ff | 190 | trimmingvaluen1 -= delta; |
bogdanm | 0:9b334a45a8ff | 191 | } |
bogdanm | 0:9b334a45a8ff | 192 | else |
bogdanm | 0:9b334a45a8ff | 193 | { |
bogdanm | 0:9b334a45a8ff | 194 | /* OPAMP_CSR_CALOUT is LOW try higher trimming */ |
bogdanm | 0:9b334a45a8ff | 195 | trimmingvaluen1 += delta; |
bogdanm | 0:9b334a45a8ff | 196 | } |
bogdanm | 0:9b334a45a8ff | 197 | |
bogdanm | 0:9b334a45a8ff | 198 | if (READ_BIT(hopamp2->Instance->CSR, OPAMP_CSR_CALOUT) != RESET) |
bogdanm | 0:9b334a45a8ff | 199 | { |
bogdanm | 0:9b334a45a8ff | 200 | /* OPAMP_CSR_CALOUT is HIGH try lower trimming */ |
bogdanm | 0:9b334a45a8ff | 201 | trimmingvaluen2 -= delta; |
bogdanm | 0:9b334a45a8ff | 202 | } |
bogdanm | 0:9b334a45a8ff | 203 | else |
bogdanm | 0:9b334a45a8ff | 204 | { |
bogdanm | 0:9b334a45a8ff | 205 | /* OPAMP_CSR_CALOUT is LOW try higher trimming */ |
bogdanm | 0:9b334a45a8ff | 206 | trimmingvaluen2 += delta; |
bogdanm | 0:9b334a45a8ff | 207 | } |
bogdanm | 0:9b334a45a8ff | 208 | /* Divide range by 2 to continue dichotomy sweep */ |
bogdanm | 0:9b334a45a8ff | 209 | delta >>= 1; |
bogdanm | 0:9b334a45a8ff | 210 | } |
bogdanm | 0:9b334a45a8ff | 211 | |
bogdanm | 0:9b334a45a8ff | 212 | /* Still need to check if right calibration is current value or one step below */ |
bogdanm | 0:9b334a45a8ff | 213 | /* Indeed the first value that causes the OUTCAL bit to change from 0 to 1 */ |
bogdanm | 0:9b334a45a8ff | 214 | /* Set candidate trimming */ |
bogdanm | 0:9b334a45a8ff | 215 | MODIFY_REG(*tmp_opamp1_reg_trimming, OPAMP_OTR_TRIMOFFSETN, trimmingvaluen1); |
bogdanm | 0:9b334a45a8ff | 216 | MODIFY_REG(*tmp_opamp2_reg_trimming, OPAMP_OTR_TRIMOFFSETN, trimmingvaluen2); |
bogdanm | 0:9b334a45a8ff | 217 | |
bogdanm | 0:9b334a45a8ff | 218 | /* OFFTRIMmax delay 1 ms as per datasheet (electrical characteristics */ |
bogdanm | 0:9b334a45a8ff | 219 | /* Offset trim time: during calibration, minimum time needed between */ |
bogdanm | 0:9b334a45a8ff | 220 | /* two steps to have 1 mV accuracy */ |
bogdanm | 0:9b334a45a8ff | 221 | HAL_Delay(OPAMP_TRIMMING_DELAY); |
bogdanm | 0:9b334a45a8ff | 222 | |
bogdanm | 0:9b334a45a8ff | 223 | if ((READ_BIT(hopamp1->Instance->CSR, OPAMP_CSR_CALOUT)) == 0) |
bogdanm | 0:9b334a45a8ff | 224 | { |
bogdanm | 0:9b334a45a8ff | 225 | /* Trimming value is actually one value more */ |
bogdanm | 0:9b334a45a8ff | 226 | trimmingvaluen1++; |
bogdanm | 0:9b334a45a8ff | 227 | MODIFY_REG(*tmp_opamp1_reg_trimming, OPAMP_OTR_TRIMOFFSETN, trimmingvaluen1); |
bogdanm | 0:9b334a45a8ff | 228 | } |
bogdanm | 0:9b334a45a8ff | 229 | |
bogdanm | 0:9b334a45a8ff | 230 | if ((READ_BIT(hopamp2->Instance->CSR, OPAMP_CSR_CALOUT)) == 0) |
bogdanm | 0:9b334a45a8ff | 231 | { |
bogdanm | 0:9b334a45a8ff | 232 | /* Trimming value is actually one value more */ |
bogdanm | 0:9b334a45a8ff | 233 | trimmingvaluen2++; |
bogdanm | 0:9b334a45a8ff | 234 | MODIFY_REG(*tmp_opamp2_reg_trimming, OPAMP_OTR_TRIMOFFSETN, trimmingvaluen2); |
bogdanm | 0:9b334a45a8ff | 235 | } |
bogdanm | 0:9b334a45a8ff | 236 | |
bogdanm | 0:9b334a45a8ff | 237 | /* 2nd calibration - P */ |
bogdanm | 0:9b334a45a8ff | 238 | SET_BIT (hopamp1->Instance->CSR, OPAMP_CSR_CALSEL); |
bogdanm | 0:9b334a45a8ff | 239 | SET_BIT (hopamp2->Instance->CSR, OPAMP_CSR_CALSEL); |
bogdanm | 0:9b334a45a8ff | 240 | |
bogdanm | 0:9b334a45a8ff | 241 | /* Init trimming counter */ |
bogdanm | 0:9b334a45a8ff | 242 | /* Medium value */ |
bogdanm | 0:9b334a45a8ff | 243 | trimmingvaluep1 = 16; |
bogdanm | 0:9b334a45a8ff | 244 | trimmingvaluep2 = 16; |
bogdanm | 0:9b334a45a8ff | 245 | delta = 8; |
bogdanm | 0:9b334a45a8ff | 246 | |
bogdanm | 0:9b334a45a8ff | 247 | while (delta != 0) |
bogdanm | 0:9b334a45a8ff | 248 | { |
bogdanm | 0:9b334a45a8ff | 249 | /* Set candidate trimming */ |
bogdanm | 0:9b334a45a8ff | 250 | /* OPAMP_POWERMODE_NORMAL */ |
bogdanm | 0:9b334a45a8ff | 251 | MODIFY_REG(*tmp_opamp1_reg_trimming, OPAMP_OTR_TRIMOFFSETP, (trimmingvaluep1<<OPAMP_INPUT_NONINVERTING)); |
bogdanm | 0:9b334a45a8ff | 252 | MODIFY_REG(*tmp_opamp2_reg_trimming, OPAMP_OTR_TRIMOFFSETP, (trimmingvaluep2<<OPAMP_INPUT_NONINVERTING)); |
bogdanm | 0:9b334a45a8ff | 253 | |
bogdanm | 0:9b334a45a8ff | 254 | /* OFFTRIMmax delay 1 ms as per datasheet (electrical characteristics */ |
bogdanm | 0:9b334a45a8ff | 255 | /* Offset trim time: during calibration, minimum time needed between */ |
bogdanm | 0:9b334a45a8ff | 256 | /* two steps to have 1 mV accuracy */ |
bogdanm | 0:9b334a45a8ff | 257 | HAL_Delay(OPAMP_TRIMMING_DELAY); |
bogdanm | 0:9b334a45a8ff | 258 | |
bogdanm | 0:9b334a45a8ff | 259 | if (READ_BIT(hopamp1->Instance->CSR, OPAMP_CSR_CALOUT) != RESET) |
bogdanm | 0:9b334a45a8ff | 260 | { |
bogdanm | 0:9b334a45a8ff | 261 | /* OPAMP_CSR_CALOUT is HIGH try higher trimming */ |
bogdanm | 0:9b334a45a8ff | 262 | trimmingvaluep1 += delta; |
bogdanm | 0:9b334a45a8ff | 263 | } |
bogdanm | 0:9b334a45a8ff | 264 | else |
bogdanm | 0:9b334a45a8ff | 265 | { |
bogdanm | 0:9b334a45a8ff | 266 | /* OPAMP_CSR_CALOUT is HIGH try lower trimming */ |
bogdanm | 0:9b334a45a8ff | 267 | trimmingvaluep1 -= delta; |
bogdanm | 0:9b334a45a8ff | 268 | } |
bogdanm | 0:9b334a45a8ff | 269 | |
bogdanm | 0:9b334a45a8ff | 270 | if (READ_BIT(hopamp2->Instance->CSR, OPAMP_CSR_CALOUT) != RESET) |
bogdanm | 0:9b334a45a8ff | 271 | { |
bogdanm | 0:9b334a45a8ff | 272 | /* OPAMP_CSR_CALOUT is HIGH try higher trimming */ |
bogdanm | 0:9b334a45a8ff | 273 | trimmingvaluep2 += delta; |
bogdanm | 0:9b334a45a8ff | 274 | } |
bogdanm | 0:9b334a45a8ff | 275 | else |
bogdanm | 0:9b334a45a8ff | 276 | { |
bogdanm | 0:9b334a45a8ff | 277 | /* OPAMP_CSR_CALOUT is LOW try lower trimming */ |
bogdanm | 0:9b334a45a8ff | 278 | trimmingvaluep2 -= delta; |
bogdanm | 0:9b334a45a8ff | 279 | } |
bogdanm | 0:9b334a45a8ff | 280 | /* Divide range by 2 to continue dichotomy sweep */ |
bogdanm | 0:9b334a45a8ff | 281 | delta >>= 1; |
bogdanm | 0:9b334a45a8ff | 282 | } |
bogdanm | 0:9b334a45a8ff | 283 | |
bogdanm | 0:9b334a45a8ff | 284 | /* Still need to check if right calibration is current value or one step below */ |
bogdanm | 0:9b334a45a8ff | 285 | /* Indeed the first value that causes the OUTCAL bit to change from 1 to 0 */ |
bogdanm | 0:9b334a45a8ff | 286 | /* Set candidate trimming */ |
bogdanm | 0:9b334a45a8ff | 287 | MODIFY_REG(*tmp_opamp1_reg_trimming, OPAMP_OTR_TRIMOFFSETP, (trimmingvaluep1<<OPAMP_INPUT_NONINVERTING)); |
bogdanm | 0:9b334a45a8ff | 288 | MODIFY_REG(*tmp_opamp2_reg_trimming, OPAMP_OTR_TRIMOFFSETP, (trimmingvaluep2<<OPAMP_INPUT_NONINVERTING)); |
bogdanm | 0:9b334a45a8ff | 289 | |
bogdanm | 0:9b334a45a8ff | 290 | /* OFFTRIMmax delay 1 ms as per datasheet (electrical characteristics */ |
bogdanm | 0:9b334a45a8ff | 291 | /* Offset trim time: during calibration, minimum time needed between */ |
bogdanm | 0:9b334a45a8ff | 292 | /* two steps to have 1 mV accuracy */ |
bogdanm | 0:9b334a45a8ff | 293 | HAL_Delay(OPAMP_TRIMMING_DELAY); |
bogdanm | 0:9b334a45a8ff | 294 | |
bogdanm | 0:9b334a45a8ff | 295 | if (READ_BIT(hopamp1->Instance->CSR, OPAMP_CSR_CALOUT) != RESET) |
bogdanm | 0:9b334a45a8ff | 296 | { |
bogdanm | 0:9b334a45a8ff | 297 | /* Trimming value is actually one value more */ |
bogdanm | 0:9b334a45a8ff | 298 | trimmingvaluep1++; |
bogdanm | 0:9b334a45a8ff | 299 | MODIFY_REG(*tmp_opamp1_reg_trimming, OPAMP_OTR_TRIMOFFSETP, (trimmingvaluep1<<OPAMP_INPUT_NONINVERTING)); |
bogdanm | 0:9b334a45a8ff | 300 | } |
bogdanm | 0:9b334a45a8ff | 301 | |
bogdanm | 0:9b334a45a8ff | 302 | if (READ_BIT(hopamp2->Instance->CSR, OPAMP_CSR_CALOUT) != RESET) |
bogdanm | 0:9b334a45a8ff | 303 | { |
bogdanm | 0:9b334a45a8ff | 304 | /* Trimming value is actually one value more */ |
bogdanm | 0:9b334a45a8ff | 305 | trimmingvaluep2++; |
bogdanm | 0:9b334a45a8ff | 306 | MODIFY_REG(*tmp_opamp2_reg_trimming, OPAMP_OTR_TRIMOFFSETP, (trimmingvaluep2<<OPAMP_INPUT_NONINVERTING)); |
bogdanm | 0:9b334a45a8ff | 307 | } |
bogdanm | 0:9b334a45a8ff | 308 | |
bogdanm | 0:9b334a45a8ff | 309 | /* Disable the OPAMPs */ |
bogdanm | 0:9b334a45a8ff | 310 | CLEAR_BIT (hopamp1->Instance->CSR, OPAMP_CSR_OPAMPxEN); |
bogdanm | 0:9b334a45a8ff | 311 | CLEAR_BIT (hopamp2->Instance->CSR, OPAMP_CSR_OPAMPxEN); |
bogdanm | 0:9b334a45a8ff | 312 | |
bogdanm | 0:9b334a45a8ff | 313 | /* Disable calibration & set normal mode (operating mode) */ |
bogdanm | 0:9b334a45a8ff | 314 | CLEAR_BIT (hopamp1->Instance->CSR, OPAMP_CSR_CALON); |
bogdanm | 0:9b334a45a8ff | 315 | CLEAR_BIT (hopamp2->Instance->CSR, OPAMP_CSR_CALON); |
bogdanm | 0:9b334a45a8ff | 316 | |
bogdanm | 0:9b334a45a8ff | 317 | /* Self calibration is successful */ |
bogdanm | 0:9b334a45a8ff | 318 | /* Store calibration (user trimming) results in init structure. */ |
bogdanm | 0:9b334a45a8ff | 319 | |
bogdanm | 0:9b334a45a8ff | 320 | /* Set user trimming mode */ |
bogdanm | 0:9b334a45a8ff | 321 | hopamp1->Init.UserTrimming = OPAMP_TRIMMING_USER; |
bogdanm | 0:9b334a45a8ff | 322 | hopamp2->Init.UserTrimming = OPAMP_TRIMMING_USER; |
bogdanm | 0:9b334a45a8ff | 323 | |
bogdanm | 0:9b334a45a8ff | 324 | /* Affect calibration parameters depending on mode normal/low power */ |
bogdanm | 0:9b334a45a8ff | 325 | if (hopamp1->Init.PowerMode != OPAMP_POWERMODE_LOWPOWER) |
bogdanm | 0:9b334a45a8ff | 326 | { |
bogdanm | 0:9b334a45a8ff | 327 | /* Write calibration result N */ |
bogdanm | 0:9b334a45a8ff | 328 | hopamp1->Init.TrimmingValueN = trimmingvaluen1; |
bogdanm | 0:9b334a45a8ff | 329 | /* Write calibration result P */ |
bogdanm | 0:9b334a45a8ff | 330 | hopamp1->Init.TrimmingValueP = trimmingvaluep1; |
bogdanm | 0:9b334a45a8ff | 331 | } |
bogdanm | 0:9b334a45a8ff | 332 | else |
bogdanm | 0:9b334a45a8ff | 333 | { |
bogdanm | 0:9b334a45a8ff | 334 | /* Write calibration result N */ |
bogdanm | 0:9b334a45a8ff | 335 | hopamp1->Init.TrimmingValueNLowPower = trimmingvaluen1; |
bogdanm | 0:9b334a45a8ff | 336 | /* Write calibration result P */ |
bogdanm | 0:9b334a45a8ff | 337 | hopamp1->Init.TrimmingValuePLowPower = trimmingvaluep1; |
bogdanm | 0:9b334a45a8ff | 338 | } |
bogdanm | 0:9b334a45a8ff | 339 | |
bogdanm | 0:9b334a45a8ff | 340 | if (hopamp2->Init.PowerMode != OPAMP_POWERMODE_LOWPOWER) |
bogdanm | 0:9b334a45a8ff | 341 | { |
bogdanm | 0:9b334a45a8ff | 342 | /* Write calibration result N */ |
bogdanm | 0:9b334a45a8ff | 343 | hopamp2->Init.TrimmingValueN = trimmingvaluen2; |
bogdanm | 0:9b334a45a8ff | 344 | /* Write calibration result P */ |
bogdanm | 0:9b334a45a8ff | 345 | hopamp2->Init.TrimmingValueP = trimmingvaluep2; |
bogdanm | 0:9b334a45a8ff | 346 | } |
bogdanm | 0:9b334a45a8ff | 347 | else |
bogdanm | 0:9b334a45a8ff | 348 | { |
bogdanm | 0:9b334a45a8ff | 349 | /* Write calibration result N */ |
bogdanm | 0:9b334a45a8ff | 350 | hopamp2->Init.TrimmingValueNLowPower = trimmingvaluen2; |
bogdanm | 0:9b334a45a8ff | 351 | /* Write calibration result P */ |
bogdanm | 0:9b334a45a8ff | 352 | hopamp2->Init.TrimmingValuePLowPower = trimmingvaluep2; |
bogdanm | 0:9b334a45a8ff | 353 | } |
bogdanm | 0:9b334a45a8ff | 354 | |
bogdanm | 0:9b334a45a8ff | 355 | /* Update OPAMP state */ |
bogdanm | 0:9b334a45a8ff | 356 | hopamp1->State = HAL_OPAMP_STATE_READY; |
bogdanm | 0:9b334a45a8ff | 357 | hopamp2->State = HAL_OPAMP_STATE_READY; |
bogdanm | 0:9b334a45a8ff | 358 | |
bogdanm | 0:9b334a45a8ff | 359 | } |
bogdanm | 0:9b334a45a8ff | 360 | |
bogdanm | 0:9b334a45a8ff | 361 | else |
bogdanm | 0:9b334a45a8ff | 362 | { |
bogdanm | 0:9b334a45a8ff | 363 | /* At least one OPAMP can not be calibrated */ |
bogdanm | 0:9b334a45a8ff | 364 | status = HAL_ERROR; |
bogdanm | 0:9b334a45a8ff | 365 | } |
bogdanm | 0:9b334a45a8ff | 366 | } |
bogdanm | 0:9b334a45a8ff | 367 | return status; |
bogdanm | 0:9b334a45a8ff | 368 | } |
bogdanm | 0:9b334a45a8ff | 369 | |
bogdanm | 0:9b334a45a8ff | 370 | /** |
bogdanm | 0:9b334a45a8ff | 371 | * @} |
bogdanm | 0:9b334a45a8ff | 372 | */ |
bogdanm | 0:9b334a45a8ff | 373 | |
bogdanm | 0:9b334a45a8ff | 374 | /** @defgroup OPAMPEx_Exported_Functions_Group2 Peripheral Control functions |
bogdanm | 0:9b334a45a8ff | 375 | * @brief Peripheral Control functions |
bogdanm | 0:9b334a45a8ff | 376 | * |
bogdanm | 0:9b334a45a8ff | 377 | @verbatim |
bogdanm | 0:9b334a45a8ff | 378 | =============================================================================== |
bogdanm | 0:9b334a45a8ff | 379 | ##### Peripheral Control functions ##### |
bogdanm | 0:9b334a45a8ff | 380 | =============================================================================== |
bogdanm | 0:9b334a45a8ff | 381 | [..] |
bogdanm | 0:9b334a45a8ff | 382 | (+) OPAMP unlock. |
bogdanm | 0:9b334a45a8ff | 383 | |
bogdanm | 0:9b334a45a8ff | 384 | @endverbatim |
bogdanm | 0:9b334a45a8ff | 385 | * @{ |
bogdanm | 0:9b334a45a8ff | 386 | */ |
bogdanm | 0:9b334a45a8ff | 387 | |
bogdanm | 0:9b334a45a8ff | 388 | /** |
bogdanm | 0:9b334a45a8ff | 389 | * @brief Unlock the selected OPAMP configuration. |
bogdanm | 0:9b334a45a8ff | 390 | * @note This function must be called only when OPAMP is in state "locked". |
bogdanm | 0:9b334a45a8ff | 391 | * @param hopamp: OPAMP handle |
bogdanm | 0:9b334a45a8ff | 392 | * @retval HAL status |
bogdanm | 0:9b334a45a8ff | 393 | */ |
bogdanm | 0:9b334a45a8ff | 394 | HAL_StatusTypeDef HAL_OPAMPEx_Unlock(OPAMP_HandleTypeDef* hopamp) |
bogdanm | 0:9b334a45a8ff | 395 | { |
bogdanm | 0:9b334a45a8ff | 396 | HAL_StatusTypeDef status = HAL_OK; |
bogdanm | 0:9b334a45a8ff | 397 | |
bogdanm | 0:9b334a45a8ff | 398 | /* Check the OPAMP handle allocation */ |
bogdanm | 0:9b334a45a8ff | 399 | /* Check if OPAMP locked */ |
bogdanm | 0:9b334a45a8ff | 400 | if((hopamp == NULL) || (hopamp->State == HAL_OPAMP_STATE_RESET) |
bogdanm | 0:9b334a45a8ff | 401 | || (hopamp->State == HAL_OPAMP_STATE_READY) |
bogdanm | 0:9b334a45a8ff | 402 | || (hopamp->State == HAL_OPAMP_STATE_CALIBBUSY) |
bogdanm | 0:9b334a45a8ff | 403 | || (hopamp->State == HAL_OPAMP_STATE_BUSY)) |
bogdanm | 0:9b334a45a8ff | 404 | |
bogdanm | 0:9b334a45a8ff | 405 | { |
bogdanm | 0:9b334a45a8ff | 406 | status = HAL_ERROR; |
bogdanm | 0:9b334a45a8ff | 407 | } |
bogdanm | 0:9b334a45a8ff | 408 | else |
bogdanm | 0:9b334a45a8ff | 409 | { |
bogdanm | 0:9b334a45a8ff | 410 | /* Check the parameter */ |
bogdanm | 0:9b334a45a8ff | 411 | assert_param(IS_OPAMP_ALL_INSTANCE(hopamp->Instance)); |
bogdanm | 0:9b334a45a8ff | 412 | |
bogdanm | 0:9b334a45a8ff | 413 | /* OPAMP state changed to locked */ |
bogdanm | 0:9b334a45a8ff | 414 | hopamp->State = HAL_OPAMP_STATE_BUSY; |
bogdanm | 0:9b334a45a8ff | 415 | } |
bogdanm | 0:9b334a45a8ff | 416 | return status; |
bogdanm | 0:9b334a45a8ff | 417 | } |
bogdanm | 0:9b334a45a8ff | 418 | |
bogdanm | 0:9b334a45a8ff | 419 | /** |
bogdanm | 0:9b334a45a8ff | 420 | * @} |
bogdanm | 0:9b334a45a8ff | 421 | */ |
bogdanm | 0:9b334a45a8ff | 422 | |
bogdanm | 0:9b334a45a8ff | 423 | /** |
bogdanm | 0:9b334a45a8ff | 424 | * @} |
bogdanm | 0:9b334a45a8ff | 425 | */ |
bogdanm | 0:9b334a45a8ff | 426 | |
bogdanm | 0:9b334a45a8ff | 427 | #endif /* HAL_OPAMP_MODULE_ENABLED */ |
bogdanm | 0:9b334a45a8ff | 428 | /** |
bogdanm | 0:9b334a45a8ff | 429 | * @} |
bogdanm | 0:9b334a45a8ff | 430 | */ |
bogdanm | 0:9b334a45a8ff | 431 | |
bogdanm | 0:9b334a45a8ff | 432 | /** |
bogdanm | 0:9b334a45a8ff | 433 | * @} |
bogdanm | 0:9b334a45a8ff | 434 | */ |
bogdanm | 0:9b334a45a8ff | 435 | |
bogdanm | 0:9b334a45a8ff | 436 | /************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/ |