mirror of
https://github.com/oliverschmidt/contiki.git
synced 2024-07-16 21:29:32 +00:00
758 lines
31 KiB
C
758 lines
31 KiB
C
/**
|
|
******************************************************************************
|
|
* @file stm32l1xx_hal_opamp_ex.c
|
|
* @author MCD Application Team
|
|
* @version V1.0.0
|
|
* @date 5-September-2014
|
|
* @brief Extended OPAMP HAL module driver.
|
|
*
|
|
* This file provides firmware functions to manage the following
|
|
* functionalities of the Power Controller (OPAMP) peripheral:
|
|
* + Extended Initialization and de-initialization functions
|
|
* + Extended Peripheral Control functions
|
|
*
|
|
@verbatim
|
|
******************************************************************************
|
|
* @attention
|
|
*
|
|
* <h2><center>© COPYRIGHT(c) 2014 STMicroelectronics</center></h2>
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without modification,
|
|
* are permitted provided that the following conditions are met:
|
|
* 1. Redistributions 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 its contributors
|
|
* may be used to endorse or promote products derived from this software
|
|
* without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
|
|
* AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
|
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
|
|
* DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER 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 "stm32l1xx_hal.h"
|
|
|
|
/** @addtogroup STM32L1xx_HAL_Driver
|
|
* @{
|
|
*/
|
|
|
|
/** @defgroup OPAMPEx OPAMPEx
|
|
* @brief OPAMP Extended HAL module driver.
|
|
* @{
|
|
*/
|
|
|
|
#ifdef HAL_OPAMP_MODULE_ENABLED
|
|
|
|
#if defined (STM32L151xCA) || defined (STM32L151xD) || defined (STM32L152xCA) || defined (STM32L152xD) || defined (STM32L162xCA) || defined (STM32L162xD) || defined (STM32L151xE) || defined (STM32L152xE) || defined (STM32L162xE) || defined (STM32L162xC) || defined (STM32L152xC) || defined (STM32L151xC)
|
|
|
|
/* Private typedef -----------------------------------------------------------*/
|
|
/* Private define ------------------------------------------------------------*/
|
|
/* Private macro -------------------------------------------------------------*/
|
|
/* Private variables ---------------------------------------------------------*/
|
|
/* Private function prototypes -----------------------------------------------*/
|
|
/* Private functions ---------------------------------------------------------*/
|
|
|
|
/** @addtogroup OPAMPEx_Exported_Functions OPAMPEx Exported Functions
|
|
* @{
|
|
*/
|
|
|
|
/** @addtogroup OPAMPEx_Exported_Functions_Group1
|
|
* @brief Extended operation functions
|
|
*
|
|
@verbatim
|
|
===============================================================================
|
|
##### Extended IO operation functions #####
|
|
===============================================================================
|
|
[..]
|
|
(+) OPAMP Self calibration.
|
|
|
|
@endverbatim
|
|
* @{
|
|
*/
|
|
|
|
#if defined (STM32L151xD) || defined (STM32L152xD) || defined (STM32L162xD)
|
|
|
|
/* 3 OPAMPS available */
|
|
/* 3 OPAMPS can be calibrated in parallel */
|
|
|
|
/**
|
|
* @brief Run the self calibration of the 3 OPAMPs in parallel.
|
|
* @note Trimming values (PMOS & NMOS) are updated and user trimming is
|
|
* enabled is calibration is succesful.
|
|
* @note Calibration is performed in the mode specified in OPAMP init
|
|
* structure (mode normal or low-power). To perform calibration for
|
|
* both modes, repeat this function twice after OPAMP init structure
|
|
* accordingly updated.
|
|
* @note Calibration runs about 10 ms (5 dichotmy steps, repeated for P
|
|
* and N transistors: 10 steps with 1 ms for each step).
|
|
* @param hopamp1 handle
|
|
* @param hopamp2 handle
|
|
* @param hopamp3 handle
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_OPAMPEx_SelfCalibrateAll(OPAMP_HandleTypeDef *hopamp1, OPAMP_HandleTypeDef *hopamp2, OPAMP_HandleTypeDef *hopamp3)
|
|
{
|
|
HAL_StatusTypeDef status = HAL_OK;
|
|
|
|
uint32_t* opamp1_trimmingvalue = 0;
|
|
uint32_t opamp1_trimmingvaluen = 0;
|
|
uint32_t opamp1_trimmingvaluep = 0;
|
|
|
|
uint32_t* opamp2_trimmingvalue = 0;
|
|
uint32_t opamp2_trimmingvaluen = 0;
|
|
uint32_t opamp2_trimmingvaluep = 0;
|
|
|
|
uint32_t* opamp3_trimmingvalue = 0;
|
|
uint32_t opamp3_trimmingvaluen = 0;
|
|
uint32_t opamp3_trimmingvaluep = 0;
|
|
|
|
uint32_t trimming_diff_pair = 0; /* Selection of differential transistors pair high or low */
|
|
|
|
__IO uint32_t* tmp_opamp1_reg_trimming; /* Selection of register of trimming depending on power mode: OTR or LPOTR */
|
|
__IO uint32_t* tmp_opamp2_reg_trimming;
|
|
__IO uint32_t* tmp_opamp3_reg_trimming;
|
|
uint32_t tmp_opamp1_otr_otuser = 0; /* Selection of bit OPAMP_OTR_OT_USER depending on trimming register pointed: OTR or LPOTR */
|
|
uint32_t tmp_opamp2_otr_otuser = 0;
|
|
uint32_t tmp_opamp3_otr_otuser = 0;
|
|
|
|
uint32_t tmp_Opa1calout_DefaultSate = 0; /* Bit OPAMP_CSR_OPA1CALOUT default state when trimming value is 00000b. Used to detect the bit toggling */
|
|
uint32_t tmp_Opa2calout_DefaultSate = 0; /* Bit OPAMP_CSR_OPA2CALOUT default state when trimming value is 00000b. Used to detect the bit toggling */
|
|
uint32_t tmp_Opa3calout_DefaultSate = 0; /* Bit OPAMP_CSR_OPA3CALOUT default state when trimming value is 00000b. Used to detect the bit toggling */
|
|
|
|
uint32_t tmp_OpaxSwitchesContextBackup = 0;
|
|
|
|
uint8_t trimming_diff_pair_iteration_count = 0;
|
|
uint8_t delta = 0;
|
|
|
|
|
|
/* Check the OPAMP handle allocation */
|
|
/* Check if OPAMP locked */
|
|
if((hopamp1 == NULL) || (hopamp1->State == HAL_OPAMP_STATE_BUSYLOCKED) ||
|
|
(hopamp2 == NULL) || (hopamp2->State == HAL_OPAMP_STATE_BUSYLOCKED) ||
|
|
(hopamp3 == NULL) || (hopamp3->State == HAL_OPAMP_STATE_BUSYLOCKED) )
|
|
{
|
|
status = HAL_ERROR;
|
|
}
|
|
else
|
|
{
|
|
|
|
/* Check if OPAMP in calibration mode and calibration not yet enable */
|
|
if((hopamp1->State == HAL_OPAMP_STATE_READY) &&
|
|
(hopamp2->State == HAL_OPAMP_STATE_READY) &&
|
|
(hopamp3->State == HAL_OPAMP_STATE_READY) )
|
|
{
|
|
/* Check the parameter */
|
|
assert_param(IS_OPAMP_ALL_INSTANCE(hopamp1->Instance));
|
|
assert_param(IS_OPAMP_ALL_INSTANCE(hopamp2->Instance));
|
|
assert_param(IS_OPAMP_ALL_INSTANCE(hopamp3->Instance));
|
|
assert_param(IS_OPAMP_POWERMODE(hopamp1->Init.PowerMode));
|
|
assert_param(IS_OPAMP_POWERMODE(hopamp2->Init.PowerMode));
|
|
assert_param(IS_OPAMP_POWERMODE(hopamp3->Init.PowerMode));
|
|
|
|
/* Update OPAMP state */
|
|
hopamp1->State = HAL_OPAMP_STATE_CALIBBUSY;
|
|
hopamp2->State = HAL_OPAMP_STATE_CALIBBUSY;
|
|
hopamp3->State = HAL_OPAMP_STATE_CALIBBUSY;
|
|
|
|
/* Backup of switches configuration to restore it at the end of the */
|
|
/* calibration. */
|
|
tmp_OpaxSwitchesContextBackup = READ_BIT(OPAMP->CSR, OPAMP_CSR_ALL_SWITCHES_ALL_OPAMPS);
|
|
|
|
/* Open all switches on non-inverting input, inverting input and output */
|
|
/* feedback. */
|
|
CLEAR_BIT(OPAMP->CSR, OPAMP_CSR_ALL_SWITCHES_ALL_OPAMPS);
|
|
|
|
/* Set calibration mode to user programmed trimming values */
|
|
SET_BIT(OPAMP->OTR, OPAMP_OTR_OT_USER);
|
|
|
|
/* Select trimming settings depending on power mode */
|
|
if (hopamp1->Init.PowerMode == OPAMP_POWERMODE_NORMAL)
|
|
{
|
|
tmp_opamp1_otr_otuser = OPAMP_OTR_OT_USER;
|
|
tmp_opamp1_reg_trimming = &OPAMP->OTR;
|
|
}
|
|
else
|
|
{
|
|
tmp_opamp1_otr_otuser = 0x00000000;
|
|
tmp_opamp1_reg_trimming = &OPAMP->LPOTR;
|
|
}
|
|
|
|
if (hopamp2->Init.PowerMode == OPAMP_POWERMODE_NORMAL)
|
|
{
|
|
tmp_opamp2_otr_otuser = OPAMP_OTR_OT_USER;
|
|
tmp_opamp2_reg_trimming = &OPAMP->OTR;
|
|
}
|
|
else
|
|
{
|
|
tmp_opamp2_otr_otuser = 0x00000000;
|
|
tmp_opamp2_reg_trimming = &OPAMP->LPOTR;
|
|
}
|
|
|
|
if (hopamp3->Init.PowerMode == OPAMP_POWERMODE_NORMAL)
|
|
{
|
|
tmp_opamp3_otr_otuser = OPAMP_OTR_OT_USER;
|
|
tmp_opamp3_reg_trimming = &OPAMP->OTR;
|
|
}
|
|
else
|
|
{
|
|
tmp_opamp3_otr_otuser = 0x00000000;
|
|
tmp_opamp3_reg_trimming = &OPAMP->LPOTR;
|
|
}
|
|
|
|
/* Enable the selected opamp */
|
|
CLEAR_BIT (OPAMP->CSR, OPAMP_CSR_OPAXPD_ALL);
|
|
|
|
/* Perform trimming for both differential transistors pair high and low */
|
|
for (trimming_diff_pair_iteration_count = 0; trimming_diff_pair_iteration_count <=1; trimming_diff_pair_iteration_count++)
|
|
{
|
|
if (trimming_diff_pair_iteration_count == 0)
|
|
{
|
|
/* Calibration of transistors differential pair high (NMOS) */
|
|
trimming_diff_pair = OPAMP_FACTORYTRIMMING_N;
|
|
opamp1_trimmingvalue = &opamp1_trimmingvaluen;
|
|
opamp2_trimmingvalue = &opamp2_trimmingvaluen;
|
|
opamp3_trimmingvalue = &opamp3_trimmingvaluen;
|
|
|
|
/* Set bit OPAMP_CSR_OPAXCALOUT default state when trimming value */
|
|
/* is 00000b. Used to detect the bit toggling during trimming. */
|
|
tmp_Opa1calout_DefaultSate = RESET;
|
|
tmp_Opa2calout_DefaultSate = RESET;
|
|
tmp_Opa3calout_DefaultSate = RESET;
|
|
|
|
/* Enable calibration for N differential pair */
|
|
MODIFY_REG(OPAMP->CSR, OPAMP_CSR_OPAXCAL_L_ALL,
|
|
OPAMP_CSR_OPAXCAL_H_ALL);
|
|
}
|
|
else /* (trimming_diff_pair_iteration_count == 1) */
|
|
{
|
|
/* Calibration of transistors differential pair low (PMOS) */
|
|
trimming_diff_pair = OPAMP_FACTORYTRIMMING_P;
|
|
opamp1_trimmingvalue = &opamp1_trimmingvaluep;
|
|
opamp2_trimmingvalue = &opamp2_trimmingvaluep;
|
|
opamp3_trimmingvalue = &opamp3_trimmingvaluep;
|
|
|
|
/* Set bit OPAMP_CSR_OPAXCALOUT default state when trimming value */
|
|
/* is 00000b. Used to detect the bit toggling during trimming. */
|
|
tmp_Opa1calout_DefaultSate = __OPAMP_CSR_OPAXCALOUT(hopamp1);
|
|
tmp_Opa2calout_DefaultSate = __OPAMP_CSR_OPAXCALOUT(hopamp2);
|
|
tmp_Opa3calout_DefaultSate = __OPAMP_CSR_OPAXCALOUT(hopamp3);
|
|
|
|
/* Enable calibration for P differential pair */
|
|
MODIFY_REG(OPAMP->CSR, OPAMP_CSR_OPAXCAL_H_ALL,
|
|
OPAMP_CSR_OPAXCAL_L_ALL);
|
|
}
|
|
|
|
|
|
/* Perform calibration parameter search by dichotomy sweep */
|
|
/* - Delta initial value 16: for 5 dichotomy steps: 16 for the */
|
|
/* initial range, then successive delta sweeps (8, 4, 2, 1). */
|
|
/* can extend the search range to +/- 15 units. */
|
|
/* - Trimming initial value 15: search range will go from 0 to 30 */
|
|
/* (Trimming value 31 is forbidden). */
|
|
*opamp1_trimmingvalue = 15;
|
|
*opamp2_trimmingvalue = 15;
|
|
*opamp3_trimmingvalue = 15;
|
|
delta = 16;
|
|
|
|
while (delta != 0)
|
|
{
|
|
/* Set candidate trimming */
|
|
|
|
MODIFY_REG(*tmp_opamp1_reg_trimming, __OPAMP_OFFSET_TRIM_SET(hopamp1, trimming_diff_pair, OPAMP_TRIM_VALUE_MASK) ,
|
|
__OPAMP_OFFSET_TRIM_SET(hopamp1, trimming_diff_pair, *opamp1_trimmingvalue) | tmp_opamp1_otr_otuser);
|
|
|
|
MODIFY_REG(*tmp_opamp2_reg_trimming, __OPAMP_OFFSET_TRIM_SET(hopamp2, trimming_diff_pair, OPAMP_TRIM_VALUE_MASK) ,
|
|
__OPAMP_OFFSET_TRIM_SET(hopamp2, trimming_diff_pair, *opamp2_trimmingvalue) | tmp_opamp2_otr_otuser);
|
|
|
|
MODIFY_REG(*tmp_opamp3_reg_trimming, __OPAMP_OFFSET_TRIM_SET(hopamp3, trimming_diff_pair, OPAMP_TRIM_VALUE_MASK) ,
|
|
__OPAMP_OFFSET_TRIM_SET(hopamp3, trimming_diff_pair, *opamp3_trimmingvalue) | tmp_opamp3_otr_otuser);
|
|
|
|
|
|
/* Offset trimming time: during calibration, minimum time needed */
|
|
/* between two steps to have 1 mV accuracy. */
|
|
HAL_Delay(OPAMP_TRIMMING_DELAY);
|
|
|
|
/* Divide range by 2 to continue dichotomy sweep */
|
|
delta >>= 1;
|
|
|
|
/* Set trimming values for next iteration in function of trimming */
|
|
/* result toggle (versus initial state). */
|
|
/* Trimming values update with dichotomy delta of previous */
|
|
/* iteration. */
|
|
if (READ_BIT(OPAMP->CSR, __OPAMP_CSR_OPAXCALOUT(hopamp1)) != tmp_Opa1calout_DefaultSate)
|
|
{
|
|
/* If calibration output is has toggled, try lower trimming */
|
|
*opamp1_trimmingvalue -= delta;
|
|
}
|
|
else
|
|
{
|
|
/* If calibration output is has not toggled, try higher trimming */
|
|
*opamp1_trimmingvalue += delta;
|
|
}
|
|
|
|
/* Set trimming values for next iteration in function of trimming */
|
|
/* result toggle (versus initial state). */
|
|
/* Trimming values update with dichotomy delta of previous */
|
|
/* iteration. */
|
|
if (READ_BIT(OPAMP->CSR, __OPAMP_CSR_OPAXCALOUT(hopamp2)) != tmp_Opa2calout_DefaultSate)
|
|
{
|
|
/* If calibration output is has toggled, try lower trimming */
|
|
*opamp2_trimmingvalue -= delta;
|
|
}
|
|
else
|
|
{
|
|
/* If calibration output is has not toggled, try higher trimming */
|
|
*opamp2_trimmingvalue += delta;
|
|
}
|
|
|
|
/* Set trimming values for next iteration in function of trimming */
|
|
/* result toggle (versus initial state). */
|
|
/* Trimming values update with dichotomy delta of previous */
|
|
/* iteration. */
|
|
if (READ_BIT(OPAMP->CSR, __OPAMP_CSR_OPAXCALOUT(hopamp3)) != tmp_Opa3calout_DefaultSate)
|
|
{
|
|
/* If calibration output is has toggled, try lower trimming */
|
|
*opamp3_trimmingvalue -= delta;
|
|
}
|
|
else
|
|
{
|
|
/* If calibration output is has not toggled, try higher trimming */
|
|
*opamp3_trimmingvalue += delta;
|
|
}
|
|
|
|
}
|
|
}
|
|
|
|
|
|
/* Disable calibration for P and N differential pairs */
|
|
/* Disable the selected opamp */
|
|
CLEAR_BIT (OPAMP->CSR, (OPAMP_CSR_OPAXCAL_H_ALL |
|
|
OPAMP_CSR_OPAXCAL_L_ALL |
|
|
OPAMP_CSR_OPAXPD_ALL ));
|
|
|
|
/* Backup of switches configuration to restore it at the end of the */
|
|
/* calibration. */
|
|
SET_BIT(OPAMP->CSR, tmp_OpaxSwitchesContextBackup);
|
|
|
|
/* Self calibration is successful */
|
|
/* Store calibration (user trimming) results in init structure. */
|
|
|
|
/* Set user trimming mode */
|
|
hopamp1->Init.UserTrimming = OPAMP_TRIMMING_USER;
|
|
hopamp2->Init.UserTrimming = OPAMP_TRIMMING_USER;
|
|
hopamp3->Init.UserTrimming = OPAMP_TRIMMING_USER;
|
|
|
|
/* Affect calibration parameters depending on mode normal/low power */
|
|
if (hopamp1->Init.PowerMode != OPAMP_POWERMODE_LOWPOWER)
|
|
{
|
|
/* Write calibration result N */
|
|
hopamp1->Init.TrimmingValueN = opamp1_trimmingvaluen;
|
|
/* Write calibration result P */
|
|
hopamp1->Init.TrimmingValueP = opamp1_trimmingvaluep;
|
|
}
|
|
else
|
|
{
|
|
/* Write calibration result N */
|
|
hopamp1->Init.TrimmingValueNLowPower = opamp1_trimmingvaluen;
|
|
/* Write calibration result P */
|
|
hopamp1->Init.TrimmingValuePLowPower = opamp1_trimmingvaluep;
|
|
}
|
|
|
|
if (hopamp2->Init.PowerMode != OPAMP_POWERMODE_LOWPOWER)
|
|
{
|
|
/* Write calibration result N */
|
|
hopamp2->Init.TrimmingValueN = opamp2_trimmingvaluen;
|
|
/* Write calibration result P */
|
|
hopamp2->Init.TrimmingValueP = opamp2_trimmingvaluep;
|
|
}
|
|
else
|
|
{
|
|
/* Write calibration result N */
|
|
hopamp2->Init.TrimmingValueNLowPower = opamp2_trimmingvaluen;
|
|
/* Write calibration result P */
|
|
hopamp2->Init.TrimmingValuePLowPower = opamp2_trimmingvaluep;
|
|
}
|
|
|
|
if (hopamp3->Init.PowerMode != OPAMP_POWERMODE_LOWPOWER)
|
|
{
|
|
/* Write calibration result N */
|
|
hopamp3->Init.TrimmingValueN = opamp3_trimmingvaluen;
|
|
/* Write calibration result P */
|
|
hopamp3->Init.TrimmingValueP = opamp3_trimmingvaluep;
|
|
}
|
|
else
|
|
{
|
|
/* Write calibration result N */
|
|
hopamp3->Init.TrimmingValueNLowPower = opamp3_trimmingvaluen;
|
|
/* Write calibration result P */
|
|
hopamp3->Init.TrimmingValuePLowPower = opamp3_trimmingvaluep;
|
|
}
|
|
|
|
/* Update OPAMP state */
|
|
hopamp1->State = HAL_OPAMP_STATE_READY;
|
|
hopamp2->State = HAL_OPAMP_STATE_READY;
|
|
hopamp3->State = HAL_OPAMP_STATE_READY;
|
|
|
|
}
|
|
else
|
|
{
|
|
/* OPAMP can not be calibrated from this mode */
|
|
status = HAL_ERROR;
|
|
}
|
|
}
|
|
|
|
return status;
|
|
}
|
|
|
|
#else
|
|
|
|
/* 2 OPAMPS available */
|
|
/* 2 OPAMPS can be calibrated in parallel */
|
|
|
|
/**
|
|
* @brief Run the self calibration of the 2 OPAMPs in parallel.
|
|
* @note Trimming values (PMOS & NMOS) are updated and user trimming is
|
|
* enabled is calibration is succesful.
|
|
* @note Calibration is performed in the mode specified in OPAMP init
|
|
* structure (mode normal or low-power). To perform calibration for
|
|
* both modes, repeat this function twice after OPAMP init structure
|
|
* accordingly updated.
|
|
* @note Calibration runs about 10 ms (5 dichotmy steps, repeated for P
|
|
* and N transistors: 10 steps with 1 ms for each step).
|
|
* @param hopamp1 handle
|
|
* @param hopamp2 handle
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_OPAMPEx_SelfCalibrateAll(OPAMP_HandleTypeDef *hopamp1, OPAMP_HandleTypeDef *hopamp2)
|
|
{
|
|
HAL_StatusTypeDef status = HAL_OK;
|
|
|
|
uint32_t* opamp1_trimmingvalue = 0;
|
|
uint32_t opamp1_trimmingvaluen = 0;
|
|
uint32_t opamp1_trimmingvaluep = 0;
|
|
|
|
uint32_t* opamp2_trimmingvalue = 0;
|
|
uint32_t opamp2_trimmingvaluen = 0;
|
|
uint32_t opamp2_trimmingvaluep = 0;
|
|
|
|
uint32_t trimming_diff_pair = 0; /* Selection of differential transistors pair high or low */
|
|
|
|
__IO uint32_t* tmp_opamp1_reg_trimming; /* Selection of register of trimming depending on power mode: OTR or LPOTR */
|
|
__IO uint32_t* tmp_opamp2_reg_trimming;
|
|
uint32_t tmp_opamp1_otr_otuser = 0; /* Selection of bit OPAMP_OTR_OT_USER depending on trimming register pointed: OTR or LPOTR */
|
|
uint32_t tmp_opamp2_otr_otuser = 0;
|
|
|
|
uint32_t tmp_Opa1calout_DefaultSate = 0; /* Bit OPAMP_CSR_OPA1CALOUT default state when trimming value is 00000b. Used to detect the bit toggling */
|
|
uint32_t tmp_Opa2calout_DefaultSate = 0; /* Bit OPAMP_CSR_OPA2CALOUT default state when trimming value is 00000b. Used to detect the bit toggling */
|
|
|
|
uint32_t tmp_OpaxSwitchesContextBackup = 0;
|
|
|
|
uint8_t trimming_diff_pair_iteration_count = 0;
|
|
uint8_t delta = 0;
|
|
|
|
|
|
/* Check the OPAMP handle allocation */
|
|
/* Check if OPAMP locked */
|
|
if((hopamp1 == NULL) || (hopamp1->State == HAL_OPAMP_STATE_BUSYLOCKED) ||
|
|
(hopamp2 == NULL) || (hopamp2->State == HAL_OPAMP_STATE_BUSYLOCKED) )
|
|
{
|
|
status = HAL_ERROR;
|
|
}
|
|
else
|
|
{
|
|
|
|
/* Check if OPAMP in calibration mode and calibration not yet enable */
|
|
if((hopamp1->State == HAL_OPAMP_STATE_READY) &&
|
|
(hopamp2->State == HAL_OPAMP_STATE_READY) )
|
|
{
|
|
/* Check the parameter */
|
|
assert_param(IS_OPAMP_ALL_INSTANCE(hopamp1->Instance));
|
|
assert_param(IS_OPAMP_ALL_INSTANCE(hopamp2->Instance));
|
|
assert_param(IS_OPAMP_POWERMODE(hopamp1->Init.PowerMode));
|
|
assert_param(IS_OPAMP_POWERMODE(hopamp2->Init.PowerMode));
|
|
|
|
/* Update OPAMP state */
|
|
hopamp1->State = HAL_OPAMP_STATE_CALIBBUSY;
|
|
hopamp2->State = HAL_OPAMP_STATE_CALIBBUSY;
|
|
|
|
/* Backup of switches configuration to restore it at the end of the */
|
|
/* calibration. */
|
|
tmp_OpaxSwitchesContextBackup = READ_BIT(OPAMP->CSR, OPAMP_CSR_ALL_SWITCHES_ALL_OPAMPS);
|
|
|
|
/* Open all switches on non-inverting input, inverting input and output */
|
|
/* feedback. */
|
|
CLEAR_BIT(OPAMP->CSR, OPAMP_CSR_ALL_SWITCHES_ALL_OPAMPS);
|
|
|
|
/* Set calibration mode to user programmed trimming values */
|
|
SET_BIT(OPAMP->OTR, OPAMP_OTR_OT_USER);
|
|
|
|
/* Select trimming settings depending on power mode */
|
|
if (hopamp1->Init.PowerMode == OPAMP_POWERMODE_NORMAL)
|
|
{
|
|
tmp_opamp1_otr_otuser = OPAMP_OTR_OT_USER;
|
|
tmp_opamp1_reg_trimming = &OPAMP->OTR;
|
|
}
|
|
else
|
|
{
|
|
tmp_opamp1_otr_otuser = 0x00000000;
|
|
tmp_opamp1_reg_trimming = &OPAMP->LPOTR;
|
|
}
|
|
|
|
if (hopamp2->Init.PowerMode == OPAMP_POWERMODE_NORMAL)
|
|
{
|
|
tmp_opamp2_otr_otuser = OPAMP_OTR_OT_USER;
|
|
tmp_opamp2_reg_trimming = &OPAMP->OTR;
|
|
}
|
|
else
|
|
{
|
|
tmp_opamp2_otr_otuser = 0x00000000;
|
|
tmp_opamp2_reg_trimming = &OPAMP->LPOTR;
|
|
}
|
|
|
|
/* Enable the selected opamp */
|
|
CLEAR_BIT (OPAMP->CSR, OPAMP_CSR_OPAXPD_ALL);
|
|
|
|
/* Perform trimming for both differential transistors pair high and low */
|
|
for (trimming_diff_pair_iteration_count = 0; trimming_diff_pair_iteration_count <=1; trimming_diff_pair_iteration_count++)
|
|
{
|
|
if (trimming_diff_pair_iteration_count == 0)
|
|
{
|
|
/* Calibration of transistors differential pair high (NMOS) */
|
|
trimming_diff_pair = OPAMP_FACTORYTRIMMING_N;
|
|
opamp1_trimmingvalue = &opamp1_trimmingvaluen;
|
|
opamp2_trimmingvalue = &opamp2_trimmingvaluen;
|
|
|
|
/* Set bit OPAMP_CSR_OPAXCALOUT default state when trimming value */
|
|
/* is 00000b. Used to detect the bit toggling during trimming. */
|
|
tmp_Opa1calout_DefaultSate = RESET;
|
|
tmp_Opa2calout_DefaultSate = RESET;
|
|
|
|
/* Enable calibration for N differential pair */
|
|
MODIFY_REG(OPAMP->CSR, OPAMP_CSR_OPAXCAL_L_ALL,
|
|
OPAMP_CSR_OPAXCAL_H_ALL);
|
|
}
|
|
else /* (trimming_diff_pair_iteration_count == 1) */
|
|
{
|
|
/* Calibration of transistors differential pair low (PMOS) */
|
|
trimming_diff_pair = OPAMP_FACTORYTRIMMING_P;
|
|
opamp1_trimmingvalue = &opamp1_trimmingvaluep;
|
|
opamp2_trimmingvalue = &opamp2_trimmingvaluep;
|
|
|
|
/* Set bit OPAMP_CSR_OPAXCALOUT default state when trimming value */
|
|
/* is 00000b. Used to detect the bit toggling during trimming. */
|
|
tmp_Opa1calout_DefaultSate = __OPAMP_CSR_OPAXCALOUT(hopamp1);
|
|
tmp_Opa2calout_DefaultSate = __OPAMP_CSR_OPAXCALOUT(hopamp2);
|
|
|
|
/* Enable calibration for P differential pair */
|
|
MODIFY_REG(OPAMP->CSR, OPAMP_CSR_OPAXCAL_H_ALL,
|
|
OPAMP_CSR_OPAXCAL_L_ALL);
|
|
}
|
|
|
|
|
|
/* Perform calibration parameter search by dichotomy sweep */
|
|
/* - Delta initial value 16: for 5 dichotomy steps: 16 for the */
|
|
/* initial range, then successive delta sweeps (8, 4, 2, 1). */
|
|
/* can extend the search range to +/- 15 units. */
|
|
/* - Trimming initial value 15: search range will go from 0 to 30 */
|
|
/* (Trimming value 31 is forbidden). */
|
|
*opamp1_trimmingvalue = 15;
|
|
*opamp2_trimmingvalue = 15;
|
|
delta = 16;
|
|
|
|
while (delta != 0)
|
|
{
|
|
/* Set candidate trimming */
|
|
|
|
MODIFY_REG(*tmp_opamp1_reg_trimming, __OPAMP_OFFSET_TRIM_SET(hopamp1, trimming_diff_pair, OPAMP_TRIM_VALUE_MASK) ,
|
|
__OPAMP_OFFSET_TRIM_SET(hopamp1, trimming_diff_pair, *opamp1_trimmingvalue) | tmp_opamp1_otr_otuser);
|
|
|
|
MODIFY_REG(*tmp_opamp2_reg_trimming, __OPAMP_OFFSET_TRIM_SET(hopamp2, trimming_diff_pair, OPAMP_TRIM_VALUE_MASK) ,
|
|
__OPAMP_OFFSET_TRIM_SET(hopamp2, trimming_diff_pair, *opamp2_trimmingvalue) | tmp_opamp2_otr_otuser);
|
|
|
|
|
|
/* Offset trimming time: during calibration, minimum time needed */
|
|
/* between two steps to have 1 mV accuracy. */
|
|
HAL_Delay(OPAMP_TRIMMING_DELAY);
|
|
|
|
/* Divide range by 2 to continue dichotomy sweep */
|
|
delta >>= 1;
|
|
|
|
/* Set trimming values for next iteration in function of trimming */
|
|
/* result toggle (versus initial state). */
|
|
if (READ_BIT(OPAMP->CSR, __OPAMP_CSR_OPAXCALOUT(hopamp1)) != tmp_Opa1calout_DefaultSate)
|
|
{
|
|
/* If calibration output is has toggled, try lower trimming */
|
|
*opamp1_trimmingvalue -= delta;
|
|
}
|
|
else
|
|
{
|
|
/* If calibration output is has not toggled, try higher trimming */
|
|
*opamp1_trimmingvalue += delta;
|
|
}
|
|
|
|
/* Set trimming values for next iteration in function of trimming */
|
|
/* result toggle (versus initial state). */
|
|
if (READ_BIT(OPAMP->CSR, __OPAMP_CSR_OPAXCALOUT(hopamp2)) != tmp_Opa2calout_DefaultSate)
|
|
{
|
|
/* If calibration output is has toggled, try lower trimming */
|
|
*opamp2_trimmingvalue -= delta;
|
|
}
|
|
else
|
|
{
|
|
/* If calibration output is has not toggled, try higher trimming */
|
|
*opamp2_trimmingvalue += delta;
|
|
}
|
|
|
|
}
|
|
}
|
|
|
|
|
|
/* Disable calibration for P and N differential pairs */
|
|
/* Disable the selected opamp */
|
|
CLEAR_BIT (OPAMP->CSR, (OPAMP_CSR_OPAXCAL_H_ALL |
|
|
OPAMP_CSR_OPAXCAL_L_ALL |
|
|
OPAMP_CSR_OPAXPD_ALL ));
|
|
|
|
/* Backup of switches configuration to restore it at the end of the */
|
|
/* calibration. */
|
|
SET_BIT(OPAMP->CSR, tmp_OpaxSwitchesContextBackup);
|
|
|
|
/* Self calibration is successful */
|
|
/* Store calibration (user trimming) results in init structure. */
|
|
|
|
/* Set user trimming mode */
|
|
hopamp1->Init.UserTrimming = OPAMP_TRIMMING_USER;
|
|
hopamp2->Init.UserTrimming = OPAMP_TRIMMING_USER;
|
|
|
|
/* Affect calibration parameters depending on mode normal/low power */
|
|
if (hopamp1->Init.PowerMode != OPAMP_POWERMODE_LOWPOWER)
|
|
{
|
|
/* Write calibration result N */
|
|
hopamp1->Init.TrimmingValueN = opamp1_trimmingvaluen;
|
|
/* Write calibration result P */
|
|
hopamp1->Init.TrimmingValueP = opamp1_trimmingvaluep;
|
|
}
|
|
else
|
|
{
|
|
/* Write calibration result N */
|
|
hopamp1->Init.TrimmingValueNLowPower = opamp1_trimmingvaluen;
|
|
/* Write calibration result P */
|
|
hopamp1->Init.TrimmingValuePLowPower = opamp1_trimmingvaluep;
|
|
}
|
|
|
|
if (hopamp2->Init.PowerMode != OPAMP_POWERMODE_LOWPOWER)
|
|
{
|
|
/* Write calibration result N */
|
|
hopamp2->Init.TrimmingValueN = opamp2_trimmingvaluen;
|
|
/* Write calibration result P */
|
|
hopamp2->Init.TrimmingValueP = opamp2_trimmingvaluep;
|
|
}
|
|
else
|
|
{
|
|
/* Write calibration result N */
|
|
hopamp2->Init.TrimmingValueNLowPower = opamp2_trimmingvaluen;
|
|
/* Write calibration result P */
|
|
hopamp2->Init.TrimmingValuePLowPower = opamp2_trimmingvaluep;
|
|
}
|
|
|
|
/* Update OPAMP state */
|
|
hopamp1->State = HAL_OPAMP_STATE_READY;
|
|
hopamp2->State = HAL_OPAMP_STATE_READY;
|
|
|
|
}
|
|
else
|
|
{
|
|
/* OPAMP can not be calibrated from this mode */
|
|
status = HAL_ERROR;
|
|
}
|
|
}
|
|
|
|
return status;
|
|
}
|
|
|
|
#endif /* STM32L151xD || STM32L152xD || STM32L162xD */
|
|
|
|
/**
|
|
* @}
|
|
*/
|
|
|
|
/** @defgroup OPAMPEx_Exported_Functions_Group2 Extended Peripheral Control functions
|
|
* @brief Extended control functions
|
|
*
|
|
@verbatim
|
|
===============================================================================
|
|
##### Peripheral Control functions #####
|
|
===============================================================================
|
|
[..]
|
|
(+) OPAMP unlock.
|
|
|
|
@endverbatim
|
|
* @{
|
|
*/
|
|
|
|
/**
|
|
* @brief Unlock the selected opamp configuration.
|
|
* This function must be called only when OPAMP is in state "locked".
|
|
* @param hopamp: OPAMP handle
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_OPAMPEx_Unlock(OPAMP_HandleTypeDef* hopamp)
|
|
{
|
|
HAL_StatusTypeDef status = HAL_OK;
|
|
|
|
/* Check the OPAMP handle allocation */
|
|
/* Check if OPAMP locked */
|
|
if((hopamp == NULL) || (hopamp->State == HAL_OPAMP_STATE_RESET)
|
|
|| (hopamp->State == HAL_OPAMP_STATE_READY)
|
|
|| (hopamp->State == HAL_OPAMP_STATE_CALIBBUSY)
|
|
|| (hopamp->State == HAL_OPAMP_STATE_BUSY))
|
|
|
|
{
|
|
status = HAL_ERROR;
|
|
}
|
|
else
|
|
{
|
|
/* Check the parameter */
|
|
assert_param(IS_OPAMP_ALL_INSTANCE(hopamp->Instance));
|
|
|
|
/* OPAMP state changed to locked */
|
|
hopamp->State = HAL_OPAMP_STATE_BUSY;
|
|
}
|
|
return status;
|
|
}
|
|
|
|
/**
|
|
* @}
|
|
*/
|
|
|
|
|
|
/**
|
|
* @}
|
|
*/
|
|
|
|
#endif /* STM32L151xCA || STM32L151xD || STM32L152xCA || STM32L152xD || STM32L162xCA || STM32L162xD || STM32L151xE || STM32L152xE || STM32L162xE || STM32L162xC || STM32L152xC || STM32L151xC */
|
|
|
|
#endif /* HAL_OPAMP_MODULE_ENABLED */
|
|
/**
|
|
* @}
|
|
*/
|
|
|
|
/**
|
|
* @}
|
|
*/
|
|
|
|
/************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/
|