2009-12-13 13:37:06 +00:00
|
|
|
/*
|
2011-03-18 18:38:08 +00:00
|
|
|
ChibiOS/RT - Copyright (C) 2006,2007,2008,2009,2010,
|
2013-02-02 10:58:09 +00:00
|
|
|
2011,2012,2013 Giovanni Di Sirio.
|
2009-12-13 13:37:06 +00:00
|
|
|
|
|
|
|
This file is part of ChibiOS/RT.
|
|
|
|
|
|
|
|
ChibiOS/RT is free software; you can redistribute it and/or modify
|
|
|
|
it under the terms of the GNU General Public License as published by
|
|
|
|
the Free Software Foundation; either version 3 of the License, or
|
|
|
|
(at your option) any later version.
|
|
|
|
|
|
|
|
ChibiOS/RT is distributed in the hope that it will be useful,
|
|
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
|
|
GNU General Public License for more details.
|
|
|
|
|
|
|
|
You should have received a copy of the GNU General Public License
|
|
|
|
along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
|
|
*/
|
|
|
|
|
|
|
|
/**
|
2010-07-27 08:36:01 +00:00
|
|
|
* @file STM32/pwm_lld.c
|
|
|
|
* @brief STM32 PWM subsystem low level driver header.
|
|
|
|
*
|
2010-10-25 18:48:13 +00:00
|
|
|
* @addtogroup PWM
|
2009-12-13 13:37:06 +00:00
|
|
|
* @{
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include "ch.h"
|
|
|
|
#include "hal.h"
|
|
|
|
|
2010-11-01 17:29:56 +00:00
|
|
|
#if HAL_USE_PWM || defined(__DOXYGEN__)
|
2009-12-13 13:37:06 +00:00
|
|
|
|
2012-12-25 08:20:13 +00:00
|
|
|
/*===========================================================================*/
|
|
|
|
/* Driver local definitions. */
|
|
|
|
/*===========================================================================*/
|
|
|
|
|
2009-12-19 09:05:40 +00:00
|
|
|
/*===========================================================================*/
|
2009-12-29 13:15:29 +00:00
|
|
|
/* Driver exported variables. */
|
2009-12-19 09:05:40 +00:00
|
|
|
/*===========================================================================*/
|
|
|
|
|
|
|
|
/**
|
2011-03-29 14:51:08 +00:00
|
|
|
* @brief PWMD1 driver identifier.
|
|
|
|
* @note The driver PWMD1 allocates the complex timer TIM1 when enabled.
|
2009-12-19 09:05:40 +00:00
|
|
|
*/
|
2011-01-06 16:14:40 +00:00
|
|
|
#if STM32_PWM_USE_TIM1 || defined(__DOXYGEN__)
|
2009-12-13 13:37:06 +00:00
|
|
|
PWMDriver PWMD1;
|
|
|
|
#endif
|
|
|
|
|
2009-12-19 09:05:40 +00:00
|
|
|
/**
|
2011-03-29 14:51:08 +00:00
|
|
|
* @brief PWMD2 driver identifier.
|
|
|
|
* @note The driver PWMD2 allocates the timer TIM2 when enabled.
|
2009-12-19 09:05:40 +00:00
|
|
|
*/
|
2011-01-06 16:14:40 +00:00
|
|
|
#if STM32_PWM_USE_TIM2 || defined(__DOXYGEN__)
|
2009-12-19 09:05:40 +00:00
|
|
|
PWMDriver PWMD2;
|
|
|
|
#endif
|
|
|
|
|
|
|
|
/**
|
2011-03-29 14:51:08 +00:00
|
|
|
* @brief PWMD3 driver identifier.
|
|
|
|
* @note The driver PWMD3 allocates the timer TIM3 when enabled.
|
2009-12-19 09:05:40 +00:00
|
|
|
*/
|
2011-01-06 16:14:40 +00:00
|
|
|
#if STM32_PWM_USE_TIM3 || defined(__DOXYGEN__)
|
2009-12-19 09:05:40 +00:00
|
|
|
PWMDriver PWMD3;
|
|
|
|
#endif
|
|
|
|
|
|
|
|
/**
|
2011-03-29 14:51:08 +00:00
|
|
|
* @brief PWMD4 driver identifier.
|
|
|
|
* @note The driver PWMD4 allocates the timer TIM4 when enabled.
|
2009-12-19 09:05:40 +00:00
|
|
|
*/
|
2011-01-06 16:14:40 +00:00
|
|
|
#if STM32_PWM_USE_TIM4 || defined(__DOXYGEN__)
|
2009-12-19 09:05:40 +00:00
|
|
|
PWMDriver PWMD4;
|
|
|
|
#endif
|
2009-12-13 13:37:06 +00:00
|
|
|
|
2010-11-27 19:16:40 +00:00
|
|
|
/**
|
2011-03-29 14:51:08 +00:00
|
|
|
* @brief PWMD5 driver identifier.
|
|
|
|
* @note The driver PWMD5 allocates the timer TIM5 when enabled.
|
2010-11-27 19:16:40 +00:00
|
|
|
*/
|
2011-01-06 16:14:40 +00:00
|
|
|
#if STM32_PWM_USE_TIM5 || defined(__DOXYGEN__)
|
2010-11-27 19:16:40 +00:00
|
|
|
PWMDriver PWMD5;
|
|
|
|
#endif
|
|
|
|
|
2011-06-29 11:59:15 +00:00
|
|
|
/**
|
|
|
|
* @brief PWMD8 driver identifier.
|
|
|
|
* @note The driver PWMD5 allocates the timer TIM5 when enabled.
|
|
|
|
*/
|
|
|
|
#if STM32_PWM_USE_TIM8 || defined(__DOXYGEN__)
|
|
|
|
PWMDriver PWMD8;
|
|
|
|
#endif
|
|
|
|
|
2009-12-13 13:37:06 +00:00
|
|
|
/*===========================================================================*/
|
2013-02-28 16:23:19 +00:00
|
|
|
/* Driver local variables and types. */
|
2009-12-13 13:37:06 +00:00
|
|
|
/*===========================================================================*/
|
|
|
|
|
|
|
|
/*===========================================================================*/
|
2009-12-29 13:15:29 +00:00
|
|
|
/* Driver local functions. */
|
2009-12-13 13:37:06 +00:00
|
|
|
/*===========================================================================*/
|
|
|
|
|
2010-10-04 17:16:18 +00:00
|
|
|
#if STM32_PWM_USE_TIM2 || STM32_PWM_USE_TIM3 || STM32_PWM_USE_TIM4 || \
|
2010-11-28 09:17:53 +00:00
|
|
|
STM32_PWM_USE_TIM5 || defined(__DOXYGEN__)
|
2009-12-19 09:05:40 +00:00
|
|
|
/**
|
2010-11-28 09:17:53 +00:00
|
|
|
* @brief Common TIM2...TIM5 IRQ handler.
|
2010-07-27 08:36:01 +00:00
|
|
|
* @note It is assumed that the various sources are only activated if the
|
|
|
|
* associated callback pointer is not equal to @p NULL in order to not
|
|
|
|
* perform an extra check in a potentially critical interrupt handler.
|
2011-02-28 18:44:46 +00:00
|
|
|
*
|
|
|
|
* @param[in] pwmp pointer to a @p PWMDriver object
|
2009-12-19 09:05:40 +00:00
|
|
|
*/
|
2012-08-10 14:01:13 +00:00
|
|
|
static void pwm_lld_serve_interrupt(PWMDriver *pwmp) {
|
2009-12-19 09:05:40 +00:00
|
|
|
uint16_t sr;
|
|
|
|
|
2012-12-23 09:53:42 +00:00
|
|
|
sr = pwmp->tim->SR;
|
|
|
|
sr &= pwmp->tim->DIER;
|
2012-08-10 14:01:13 +00:00
|
|
|
pwmp->tim->SR = ~sr;
|
2009-12-19 09:05:40 +00:00
|
|
|
if ((sr & TIM_SR_CC1IF) != 0)
|
2011-03-08 10:09:57 +00:00
|
|
|
pwmp->config->channels[0].callback(pwmp);
|
2009-12-19 09:05:40 +00:00
|
|
|
if ((sr & TIM_SR_CC2IF) != 0)
|
2011-03-08 10:09:57 +00:00
|
|
|
pwmp->config->channels[1].callback(pwmp);
|
2009-12-19 09:05:40 +00:00
|
|
|
if ((sr & TIM_SR_CC3IF) != 0)
|
2011-03-08 10:09:57 +00:00
|
|
|
pwmp->config->channels[2].callback(pwmp);
|
2009-12-19 09:05:40 +00:00
|
|
|
if ((sr & TIM_SR_CC4IF) != 0)
|
2011-03-08 10:09:57 +00:00
|
|
|
pwmp->config->channels[3].callback(pwmp);
|
2009-12-19 09:05:40 +00:00
|
|
|
if ((sr & TIM_SR_UIF) != 0)
|
2011-03-08 10:09:57 +00:00
|
|
|
pwmp->config->callback(pwmp);
|
2009-12-19 09:05:40 +00:00
|
|
|
}
|
2010-11-28 09:17:53 +00:00
|
|
|
#endif /* STM32_PWM_USE_TIM2 || ... || STM32_PWM_USE_TIM5 */
|
2009-12-19 09:05:40 +00:00
|
|
|
|
2009-12-13 13:37:06 +00:00
|
|
|
/*===========================================================================*/
|
2009-12-29 13:15:29 +00:00
|
|
|
/* Driver interrupt handlers. */
|
2009-12-13 13:37:06 +00:00
|
|
|
/*===========================================================================*/
|
|
|
|
|
2010-08-08 07:57:28 +00:00
|
|
|
#if STM32_PWM_USE_TIM1
|
2012-06-23 11:49:27 +00:00
|
|
|
#if !defined(STM32_TIM1_UP_HANDLER)
|
|
|
|
#error "STM32_TIM1_UP_HANDLER not defined"
|
|
|
|
#endif
|
2009-12-16 15:48:50 +00:00
|
|
|
/**
|
2010-07-27 08:36:01 +00:00
|
|
|
* @brief TIM1 update interrupt handler.
|
|
|
|
* @note It is assumed that this interrupt is only activated if the callback
|
|
|
|
* pointer is not equal to @p NULL in order to not perform an extra
|
|
|
|
* check in a potentially critical interrupt handler.
|
2010-10-04 17:16:18 +00:00
|
|
|
*
|
|
|
|
* @isr
|
2009-12-16 15:48:50 +00:00
|
|
|
*/
|
2012-06-21 17:24:17 +00:00
|
|
|
CH_IRQ_HANDLER(STM32_TIM1_UP_HANDLER) {
|
2009-12-16 15:48:50 +00:00
|
|
|
|
|
|
|
CH_IRQ_PROLOGUE();
|
|
|
|
|
2011-12-20 18:35:18 +00:00
|
|
|
STM32_TIM1->SR = ~TIM_SR_UIF;
|
2011-03-08 10:09:57 +00:00
|
|
|
PWMD1.config->callback(&PWMD1);
|
2009-12-16 15:48:50 +00:00
|
|
|
|
|
|
|
CH_IRQ_EPILOGUE();
|
|
|
|
}
|
|
|
|
|
2012-06-23 11:49:27 +00:00
|
|
|
#if !defined(STM32_TIM1_CC_HANDLER)
|
|
|
|
#error "STM32_TIM1_CC_HANDLER not defined"
|
|
|
|
#endif
|
2009-12-16 15:48:50 +00:00
|
|
|
/**
|
2010-07-27 08:36:01 +00:00
|
|
|
* @brief TIM1 compare interrupt handler.
|
|
|
|
* @note It is assumed that the various sources are only activated if the
|
|
|
|
* associated callback pointer is not equal to @p NULL in order to not
|
|
|
|
* perform an extra check in a potentially critical interrupt handler.
|
2010-10-04 17:16:18 +00:00
|
|
|
*
|
|
|
|
* @isr
|
2009-12-16 15:48:50 +00:00
|
|
|
*/
|
2012-06-21 17:24:17 +00:00
|
|
|
CH_IRQ_HANDLER(STM32_TIM1_CC_HANDLER) {
|
2009-12-16 15:48:50 +00:00
|
|
|
uint16_t sr;
|
|
|
|
|
|
|
|
CH_IRQ_PROLOGUE();
|
|
|
|
|
2011-12-20 18:35:18 +00:00
|
|
|
sr = STM32_TIM1->SR & STM32_TIM1->DIER;
|
|
|
|
STM32_TIM1->SR = ~(TIM_SR_CC1IF | TIM_SR_CC2IF |
|
|
|
|
TIM_SR_CC3IF | TIM_SR_CC4IF);
|
2009-12-16 15:48:50 +00:00
|
|
|
if ((sr & TIM_SR_CC1IF) != 0)
|
2011-03-08 10:09:57 +00:00
|
|
|
PWMD1.config->channels[0].callback(&PWMD1);
|
2009-12-16 15:48:50 +00:00
|
|
|
if ((sr & TIM_SR_CC2IF) != 0)
|
2011-03-08 10:09:57 +00:00
|
|
|
PWMD1.config->channels[1].callback(&PWMD1);
|
2009-12-16 15:48:50 +00:00
|
|
|
if ((sr & TIM_SR_CC3IF) != 0)
|
2011-03-08 10:09:57 +00:00
|
|
|
PWMD1.config->channels[2].callback(&PWMD1);
|
2009-12-16 15:48:50 +00:00
|
|
|
if ((sr & TIM_SR_CC4IF) != 0)
|
2011-03-08 10:09:57 +00:00
|
|
|
PWMD1.config->channels[3].callback(&PWMD1);
|
2009-12-17 15:40:32 +00:00
|
|
|
|
2009-12-16 15:48:50 +00:00
|
|
|
CH_IRQ_EPILOGUE();
|
|
|
|
}
|
2010-08-08 07:57:28 +00:00
|
|
|
#endif /* STM32_PWM_USE_TIM1 */
|
2009-12-16 15:48:50 +00:00
|
|
|
|
2010-08-08 07:57:28 +00:00
|
|
|
#if STM32_PWM_USE_TIM2
|
2012-06-23 11:49:27 +00:00
|
|
|
#if !defined(STM32_TIM2_HANDLER)
|
|
|
|
#error "STM32_TIM2_HANDLER not defined"
|
|
|
|
#endif
|
2009-12-19 09:05:40 +00:00
|
|
|
/**
|
2010-10-04 17:16:18 +00:00
|
|
|
* @brief TIM2 interrupt handler.
|
|
|
|
*
|
|
|
|
* @isr
|
2009-12-19 09:05:40 +00:00
|
|
|
*/
|
2012-06-21 17:24:17 +00:00
|
|
|
CH_IRQ_HANDLER(STM32_TIM2_HANDLER) {
|
2009-12-19 09:05:40 +00:00
|
|
|
|
|
|
|
CH_IRQ_PROLOGUE();
|
|
|
|
|
2012-08-10 14:01:13 +00:00
|
|
|
pwm_lld_serve_interrupt(&PWMD2);
|
2009-12-19 09:05:40 +00:00
|
|
|
|
|
|
|
CH_IRQ_EPILOGUE();
|
|
|
|
}
|
2010-08-08 07:57:28 +00:00
|
|
|
#endif /* STM32_PWM_USE_TIM2 */
|
2009-12-19 09:05:40 +00:00
|
|
|
|
2010-08-08 07:57:28 +00:00
|
|
|
#if STM32_PWM_USE_TIM3
|
2012-06-23 11:49:27 +00:00
|
|
|
#if !defined(STM32_TIM3_HANDLER)
|
|
|
|
#error "STM32_TIM3_HANDLER not defined"
|
|
|
|
#endif
|
2009-12-19 09:05:40 +00:00
|
|
|
/**
|
2010-10-04 17:16:18 +00:00
|
|
|
* @brief TIM3 interrupt handler.
|
|
|
|
*
|
|
|
|
* @isr
|
2009-12-19 09:05:40 +00:00
|
|
|
*/
|
2012-06-21 17:24:17 +00:00
|
|
|
CH_IRQ_HANDLER(STM32_TIM3_HANDLER) {
|
2009-12-19 09:05:40 +00:00
|
|
|
|
|
|
|
CH_IRQ_PROLOGUE();
|
|
|
|
|
2012-08-10 14:01:13 +00:00
|
|
|
pwm_lld_serve_interrupt(&PWMD3);
|
2009-12-19 09:05:40 +00:00
|
|
|
|
|
|
|
CH_IRQ_EPILOGUE();
|
|
|
|
}
|
2010-08-08 07:57:28 +00:00
|
|
|
#endif /* STM32_PWM_USE_TIM3 */
|
2009-12-19 09:05:40 +00:00
|
|
|
|
2010-10-04 17:16:18 +00:00
|
|
|
#if STM32_PWM_USE_TIM4
|
2012-06-23 11:49:27 +00:00
|
|
|
#if !defined(STM32_TIM4_HANDLER)
|
|
|
|
#error "STM32_TIM4_HANDLER not defined"
|
|
|
|
#endif
|
2009-12-19 09:05:40 +00:00
|
|
|
/**
|
2010-10-04 17:16:18 +00:00
|
|
|
* @brief TIM4 interrupt handler.
|
|
|
|
*
|
|
|
|
* @isr
|
2009-12-19 09:05:40 +00:00
|
|
|
*/
|
2012-06-21 17:24:17 +00:00
|
|
|
CH_IRQ_HANDLER(STM32_TIM4_HANDLER) {
|
2009-12-19 09:05:40 +00:00
|
|
|
|
|
|
|
CH_IRQ_PROLOGUE();
|
|
|
|
|
2012-08-10 14:01:13 +00:00
|
|
|
pwm_lld_serve_interrupt(&PWMD4);
|
2009-12-19 09:05:40 +00:00
|
|
|
|
|
|
|
CH_IRQ_EPILOGUE();
|
|
|
|
}
|
2010-10-04 17:16:18 +00:00
|
|
|
#endif /* STM32_PWM_USE_TIM4 */
|
2009-12-19 09:05:40 +00:00
|
|
|
|
2010-11-27 19:16:40 +00:00
|
|
|
#if STM32_PWM_USE_TIM5
|
2012-06-23 11:49:27 +00:00
|
|
|
#if !defined(STM32_TIM5_HANDLER)
|
|
|
|
#error "STM32_TIM5_HANDLER not defined"
|
|
|
|
#endif
|
2010-11-27 19:16:40 +00:00
|
|
|
/**
|
|
|
|
* @brief TIM5 interrupt handler.
|
|
|
|
*
|
|
|
|
* @isr
|
|
|
|
*/
|
2012-06-21 17:24:17 +00:00
|
|
|
CH_IRQ_HANDLER(STM32_TIM5_HANDLER) {
|
2010-11-27 19:16:40 +00:00
|
|
|
|
|
|
|
CH_IRQ_PROLOGUE();
|
|
|
|
|
2012-08-10 14:01:13 +00:00
|
|
|
pwm_lld_serve_interrupt(&PWMD5);
|
2010-11-27 19:16:40 +00:00
|
|
|
|
|
|
|
CH_IRQ_EPILOGUE();
|
|
|
|
}
|
|
|
|
#endif /* STM32_PWM_USE_TIM5 */
|
|
|
|
|
2011-06-29 11:59:15 +00:00
|
|
|
#if STM32_PWM_USE_TIM8
|
2012-06-23 11:49:27 +00:00
|
|
|
#if !defined(STM32_TIM8_UP_HANDLER)
|
|
|
|
#error "STM32_TIM8_UP_HANDLER not defined"
|
|
|
|
#endif
|
2011-06-29 11:59:15 +00:00
|
|
|
/**
|
|
|
|
* @brief TIM8 update interrupt handler.
|
|
|
|
* @note It is assumed that this interrupt is only activated if the callback
|
|
|
|
* pointer is not equal to @p NULL in order to not perform an extra
|
|
|
|
* check in a potentially critical interrupt handler.
|
|
|
|
*
|
|
|
|
* @isr
|
|
|
|
*/
|
2012-06-21 17:24:17 +00:00
|
|
|
CH_IRQ_HANDLER(STM32_TIM8_UP_HANDLER) {
|
2011-06-29 11:59:15 +00:00
|
|
|
|
|
|
|
CH_IRQ_PROLOGUE();
|
|
|
|
|
2011-12-20 18:35:18 +00:00
|
|
|
STM32_TIM8->SR = ~TIM_SR_UIF;
|
2012-01-22 11:33:58 +00:00
|
|
|
PWMD8.config->callback(&PWMD8);
|
2011-06-29 11:59:15 +00:00
|
|
|
|
|
|
|
CH_IRQ_EPILOGUE();
|
|
|
|
}
|
|
|
|
|
2012-06-23 11:49:27 +00:00
|
|
|
#if !defined(STM32_TIM8_CC_HANDLER)
|
|
|
|
#error "STM32_TIM8_CC_HANDLER not defined"
|
|
|
|
#endif
|
2011-06-29 11:59:15 +00:00
|
|
|
/**
|
2012-01-22 11:51:06 +00:00
|
|
|
* @brief TIM8 compare interrupt handler.
|
2011-06-29 11:59:15 +00:00
|
|
|
* @note It is assumed that the various sources are only activated if the
|
|
|
|
* associated callback pointer is not equal to @p NULL in order to not
|
|
|
|
* perform an extra check in a potentially critical interrupt handler.
|
|
|
|
*
|
|
|
|
* @isr
|
|
|
|
*/
|
2012-06-21 17:24:17 +00:00
|
|
|
CH_IRQ_HANDLER(STM32_TIM8_CC_HANDLER) {
|
2011-06-29 11:59:15 +00:00
|
|
|
uint16_t sr;
|
|
|
|
|
|
|
|
CH_IRQ_PROLOGUE();
|
|
|
|
|
2011-12-20 18:35:18 +00:00
|
|
|
sr = STM32_TIM8->SR & STM32_TIM8->DIER;
|
2012-06-21 17:24:17 +00:00
|
|
|
STM32_TIM8->SR = ~(TIM_SR_CC1IF | TIM_SR_CC2IF |
|
|
|
|
TIM_SR_CC3IF | TIM_SR_CC4IF);
|
2011-06-29 11:59:15 +00:00
|
|
|
if ((sr & TIM_SR_CC1IF) != 0)
|
|
|
|
PWMD8.config->channels[0].callback(&PWMD8);
|
|
|
|
if ((sr & TIM_SR_CC2IF) != 0)
|
|
|
|
PWMD8.config->channels[1].callback(&PWMD8);
|
|
|
|
if ((sr & TIM_SR_CC3IF) != 0)
|
|
|
|
PWMD8.config->channels[2].callback(&PWMD8);
|
|
|
|
if ((sr & TIM_SR_CC4IF) != 0)
|
|
|
|
PWMD8.config->channels[3].callback(&PWMD8);
|
|
|
|
|
|
|
|
CH_IRQ_EPILOGUE();
|
|
|
|
}
|
|
|
|
#endif /* STM32_PWM_USE_TIM8 */
|
|
|
|
|
2009-12-13 13:37:06 +00:00
|
|
|
/*===========================================================================*/
|
2009-12-29 13:15:29 +00:00
|
|
|
/* Driver exported functions. */
|
2009-12-13 13:37:06 +00:00
|
|
|
/*===========================================================================*/
|
|
|
|
|
|
|
|
/**
|
2010-07-27 08:36:01 +00:00
|
|
|
* @brief Low level PWM driver initialization.
|
2010-10-04 17:16:18 +00:00
|
|
|
*
|
|
|
|
* @notapi
|
2009-12-13 13:37:06 +00:00
|
|
|
*/
|
|
|
|
void pwm_lld_init(void) {
|
|
|
|
|
2010-08-08 07:57:28 +00:00
|
|
|
#if STM32_PWM_USE_TIM1
|
2009-12-13 13:37:06 +00:00
|
|
|
/* Driver initialization.*/
|
|
|
|
pwmObjectInit(&PWMD1);
|
2011-11-26 10:30:56 +00:00
|
|
|
PWMD1.tim = STM32_TIM1;
|
2009-12-13 13:37:06 +00:00
|
|
|
#endif
|
|
|
|
|
2010-08-08 07:57:28 +00:00
|
|
|
#if STM32_PWM_USE_TIM2
|
2009-12-19 09:05:40 +00:00
|
|
|
/* Driver initialization.*/
|
|
|
|
pwmObjectInit(&PWMD2);
|
2011-11-26 10:30:56 +00:00
|
|
|
PWMD2.tim = STM32_TIM2;
|
2009-12-19 09:05:40 +00:00
|
|
|
#endif
|
|
|
|
|
2010-08-08 07:57:28 +00:00
|
|
|
#if STM32_PWM_USE_TIM3
|
2009-12-19 09:05:40 +00:00
|
|
|
/* Driver initialization.*/
|
|
|
|
pwmObjectInit(&PWMD3);
|
2011-11-26 10:30:56 +00:00
|
|
|
PWMD3.tim = STM32_TIM3;
|
2009-12-19 09:05:40 +00:00
|
|
|
#endif
|
|
|
|
|
2010-10-04 17:16:18 +00:00
|
|
|
#if STM32_PWM_USE_TIM4
|
2009-12-19 09:05:40 +00:00
|
|
|
/* Driver initialization.*/
|
|
|
|
pwmObjectInit(&PWMD4);
|
2011-11-26 10:30:56 +00:00
|
|
|
PWMD4.tim = STM32_TIM4;
|
2009-12-19 09:05:40 +00:00
|
|
|
#endif
|
2010-11-27 19:16:40 +00:00
|
|
|
|
|
|
|
#if STM32_PWM_USE_TIM5
|
|
|
|
/* Driver initialization.*/
|
|
|
|
pwmObjectInit(&PWMD5);
|
2011-11-26 10:30:56 +00:00
|
|
|
PWMD5.tim = STM32_TIM5;
|
2010-11-27 19:16:40 +00:00
|
|
|
#endif
|
2011-06-29 11:59:15 +00:00
|
|
|
|
|
|
|
#if STM32_PWM_USE_TIM8
|
|
|
|
/* Driver initialization.*/
|
|
|
|
pwmObjectInit(&PWMD8);
|
2011-11-26 10:30:56 +00:00
|
|
|
PWMD8.tim = STM32_TIM8;
|
2011-06-29 11:59:15 +00:00
|
|
|
#endif
|
2009-12-13 13:37:06 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
2010-07-27 08:36:01 +00:00
|
|
|
* @brief Configures and activates the PWM peripheral.
|
2011-03-31 10:21:52 +00:00
|
|
|
* @note Starting a driver that is already in the @p PWM_READY state
|
|
|
|
* disables all the active channels.
|
2009-12-13 13:37:06 +00:00
|
|
|
*
|
2010-07-27 08:36:01 +00:00
|
|
|
* @param[in] pwmp pointer to a @p PWMDriver object
|
2010-10-04 17:16:18 +00:00
|
|
|
*
|
|
|
|
* @notapi
|
2009-12-13 13:37:06 +00:00
|
|
|
*/
|
|
|
|
void pwm_lld_start(PWMDriver *pwmp) {
|
2011-09-24 10:34:03 +00:00
|
|
|
uint32_t psc;
|
2009-12-17 15:40:32 +00:00
|
|
|
uint16_t ccer;
|
2009-12-13 13:37:06 +00:00
|
|
|
|
2011-03-08 10:09:57 +00:00
|
|
|
if (pwmp->state == PWM_STOP) {
|
2010-11-22 17:17:51 +00:00
|
|
|
/* Clock activation and timer reset.*/
|
2010-08-08 07:57:28 +00:00
|
|
|
#if STM32_PWM_USE_TIM1
|
2009-12-13 13:37:06 +00:00
|
|
|
if (&PWMD1 == pwmp) {
|
2011-09-16 17:38:22 +00:00
|
|
|
rccEnableTIM1(FALSE);
|
|
|
|
rccResetTIM1();
|
2012-06-21 17:24:17 +00:00
|
|
|
nvicEnableVector(STM32_TIM1_UP_NUMBER,
|
2010-11-27 19:16:40 +00:00
|
|
|
CORTEX_PRIORITY_MASK(STM32_PWM_TIM1_IRQ_PRIORITY));
|
2012-06-21 17:24:17 +00:00
|
|
|
nvicEnableVector(STM32_TIM1_CC_NUMBER,
|
2010-11-27 19:16:40 +00:00
|
|
|
CORTEX_PRIORITY_MASK(STM32_PWM_TIM1_IRQ_PRIORITY));
|
2011-09-24 10:34:03 +00:00
|
|
|
pwmp->clock = STM32_TIMCLK2;
|
2009-12-13 13:37:06 +00:00
|
|
|
}
|
2009-12-19 09:05:40 +00:00
|
|
|
#endif
|
2010-08-08 07:57:28 +00:00
|
|
|
#if STM32_PWM_USE_TIM2
|
2009-12-19 09:05:40 +00:00
|
|
|
if (&PWMD2 == pwmp) {
|
2011-09-16 17:38:22 +00:00
|
|
|
rccEnableTIM2(FALSE);
|
|
|
|
rccResetTIM2();
|
2012-06-21 17:24:17 +00:00
|
|
|
nvicEnableVector(STM32_TIM2_NUMBER,
|
2010-11-27 19:16:40 +00:00
|
|
|
CORTEX_PRIORITY_MASK(STM32_PWM_TIM2_IRQ_PRIORITY));
|
2011-09-24 10:34:03 +00:00
|
|
|
pwmp->clock = STM32_TIMCLK1;
|
2009-12-19 09:05:40 +00:00
|
|
|
}
|
|
|
|
#endif
|
2010-08-08 07:57:28 +00:00
|
|
|
#if STM32_PWM_USE_TIM3
|
2009-12-19 09:05:40 +00:00
|
|
|
if (&PWMD3 == pwmp) {
|
2011-09-16 17:38:22 +00:00
|
|
|
rccEnableTIM3(FALSE);
|
|
|
|
rccResetTIM3();
|
2012-06-21 17:24:17 +00:00
|
|
|
nvicEnableVector(STM32_TIM3_NUMBER,
|
2010-11-27 19:16:40 +00:00
|
|
|
CORTEX_PRIORITY_MASK(STM32_PWM_TIM3_IRQ_PRIORITY));
|
2011-09-24 10:34:03 +00:00
|
|
|
pwmp->clock = STM32_TIMCLK1;
|
2009-12-19 09:05:40 +00:00
|
|
|
}
|
|
|
|
#endif
|
2010-10-04 17:16:18 +00:00
|
|
|
#if STM32_PWM_USE_TIM4
|
2009-12-19 09:05:40 +00:00
|
|
|
if (&PWMD4 == pwmp) {
|
2011-09-16 17:38:22 +00:00
|
|
|
rccEnableTIM4(FALSE);
|
|
|
|
rccResetTIM4();
|
2012-06-21 17:24:17 +00:00
|
|
|
nvicEnableVector(STM32_TIM4_NUMBER,
|
2010-11-27 19:16:40 +00:00
|
|
|
CORTEX_PRIORITY_MASK(STM32_PWM_TIM4_IRQ_PRIORITY));
|
2011-09-24 10:34:03 +00:00
|
|
|
pwmp->clock = STM32_TIMCLK1;
|
2009-12-19 09:05:40 +00:00
|
|
|
}
|
2009-12-13 13:37:06 +00:00
|
|
|
#endif
|
2010-11-27 19:16:40 +00:00
|
|
|
|
|
|
|
#if STM32_PWM_USE_TIM5
|
|
|
|
if (&PWMD5 == pwmp) {
|
2011-09-16 17:38:22 +00:00
|
|
|
rccEnableTIM5(FALSE);
|
|
|
|
rccResetTIM5();
|
2012-06-21 17:24:17 +00:00
|
|
|
nvicEnableVector(STM32_TIM5_NUMBER,
|
2010-11-27 19:16:40 +00:00
|
|
|
CORTEX_PRIORITY_MASK(STM32_PWM_TIM5_IRQ_PRIORITY));
|
2011-09-24 10:34:03 +00:00
|
|
|
pwmp->clock = STM32_TIMCLK1;
|
2010-11-27 19:16:40 +00:00
|
|
|
}
|
|
|
|
#endif
|
2011-06-29 11:59:15 +00:00
|
|
|
#if STM32_PWM_USE_TIM8
|
|
|
|
if (&PWMD8 == pwmp) {
|
2011-09-16 17:38:22 +00:00
|
|
|
rccEnableTIM8(FALSE);
|
|
|
|
rccResetTIM8();
|
2012-06-21 17:24:17 +00:00
|
|
|
nvicEnableVector(STM32_TIM8_UP_NUMBER,
|
2011-06-29 11:59:15 +00:00
|
|
|
CORTEX_PRIORITY_MASK(STM32_PWM_TIM8_IRQ_PRIORITY));
|
2012-06-21 17:24:17 +00:00
|
|
|
nvicEnableVector(STM32_TIM8_CC_NUMBER,
|
2011-06-29 11:59:15 +00:00
|
|
|
CORTEX_PRIORITY_MASK(STM32_PWM_TIM8_IRQ_PRIORITY));
|
2011-09-24 10:34:03 +00:00
|
|
|
pwmp->clock = STM32_TIMCLK2;
|
2011-06-29 11:59:15 +00:00
|
|
|
}
|
|
|
|
#endif
|
2010-11-27 19:16:40 +00:00
|
|
|
|
2010-11-22 17:17:51 +00:00
|
|
|
/* All channels configured in PWM1 mode with preload enabled and will
|
|
|
|
stay that way until the driver is stopped.*/
|
2011-03-08 10:09:57 +00:00
|
|
|
pwmp->tim->CCMR1 = TIM_CCMR1_OC1M_1 | TIM_CCMR1_OC1M_2 |
|
2011-03-23 13:12:41 +00:00
|
|
|
TIM_CCMR1_OC1PE |
|
|
|
|
TIM_CCMR1_OC2M_1 | TIM_CCMR1_OC2M_2 |
|
|
|
|
TIM_CCMR1_OC2PE;
|
2011-03-08 10:09:57 +00:00
|
|
|
pwmp->tim->CCMR2 = TIM_CCMR2_OC3M_1 | TIM_CCMR2_OC3M_2 |
|
2011-03-23 13:12:41 +00:00
|
|
|
TIM_CCMR2_OC3PE |
|
|
|
|
TIM_CCMR2_OC4M_1 | TIM_CCMR2_OC4M_2 |
|
|
|
|
TIM_CCMR2_OC4PE;
|
2010-11-22 17:17:51 +00:00
|
|
|
}
|
|
|
|
else {
|
|
|
|
/* Driver re-configuration scenario, it must be stopped first.*/
|
2011-11-20 18:04:07 +00:00
|
|
|
pwmp->tim->CR1 = 0; /* Timer disabled. */
|
|
|
|
pwmp->tim->DIER = 0; /* All IRQs disabled. */
|
|
|
|
pwmp->tim->SR = 0; /* Clear eventual pending IRQs. */
|
|
|
|
pwmp->tim->CCR[0] = 0; /* Comparator 1 disabled. */
|
|
|
|
pwmp->tim->CCR[1] = 0; /* Comparator 2 disabled. */
|
|
|
|
pwmp->tim->CCR[2] = 0; /* Comparator 3 disabled. */
|
|
|
|
pwmp->tim->CCR[3] = 0; /* Comparator 4 disabled. */
|
2011-03-31 10:21:52 +00:00
|
|
|
pwmp->tim->CNT = 0; /* Counter reset to zero. */
|
2009-12-13 13:37:06 +00:00
|
|
|
}
|
2009-12-16 15:48:50 +00:00
|
|
|
|
2010-11-22 17:17:51 +00:00
|
|
|
/* Timer configuration.*/
|
2011-09-24 10:34:03 +00:00
|
|
|
psc = (pwmp->clock / pwmp->config->frequency) - 1;
|
2011-03-31 10:21:52 +00:00
|
|
|
chDbgAssert((psc <= 0xFFFF) &&
|
2011-09-24 10:34:03 +00:00
|
|
|
((psc + 1) * pwmp->config->frequency) == pwmp->clock,
|
2011-03-31 10:21:52 +00:00
|
|
|
"pwm_lld_start(), #1", "invalid frequency");
|
|
|
|
pwmp->tim->PSC = (uint16_t)psc;
|
|
|
|
pwmp->tim->ARR = (uint16_t)(pwmp->period - 1);
|
2011-03-08 10:09:57 +00:00
|
|
|
pwmp->tim->CR2 = pwmp->config->cr2;
|
2011-03-31 10:21:52 +00:00
|
|
|
|
2009-12-18 11:42:05 +00:00
|
|
|
/* Output enables and polarities setup.*/
|
|
|
|
ccer = 0;
|
2011-04-01 13:06:44 +00:00
|
|
|
switch (pwmp->config->channels[0].mode & PWM_OUTPUT_MASK) {
|
2009-12-18 11:42:05 +00:00
|
|
|
case PWM_OUTPUT_ACTIVE_LOW:
|
2009-12-17 15:40:32 +00:00
|
|
|
ccer |= TIM_CCER_CC1P;
|
2009-12-18 11:42:05 +00:00
|
|
|
case PWM_OUTPUT_ACTIVE_HIGH:
|
|
|
|
ccer |= TIM_CCER_CC1E;
|
|
|
|
default:
|
|
|
|
;
|
|
|
|
}
|
2011-04-01 13:06:44 +00:00
|
|
|
switch (pwmp->config->channels[1].mode & PWM_OUTPUT_MASK) {
|
2009-12-18 11:42:05 +00:00
|
|
|
case PWM_OUTPUT_ACTIVE_LOW:
|
2009-12-17 15:40:32 +00:00
|
|
|
ccer |= TIM_CCER_CC2P;
|
2009-12-18 11:42:05 +00:00
|
|
|
case PWM_OUTPUT_ACTIVE_HIGH:
|
|
|
|
ccer |= TIM_CCER_CC2E;
|
|
|
|
default:
|
|
|
|
;
|
|
|
|
}
|
2011-04-01 13:06:44 +00:00
|
|
|
switch (pwmp->config->channels[2].mode & PWM_OUTPUT_MASK) {
|
2009-12-18 11:42:05 +00:00
|
|
|
case PWM_OUTPUT_ACTIVE_LOW:
|
2009-12-17 15:40:32 +00:00
|
|
|
ccer |= TIM_CCER_CC3P;
|
2009-12-18 11:42:05 +00:00
|
|
|
case PWM_OUTPUT_ACTIVE_HIGH:
|
|
|
|
ccer |= TIM_CCER_CC3E;
|
|
|
|
default:
|
|
|
|
;
|
|
|
|
}
|
2011-04-01 13:06:44 +00:00
|
|
|
switch (pwmp->config->channels[3].mode & PWM_OUTPUT_MASK) {
|
2009-12-18 11:42:05 +00:00
|
|
|
case PWM_OUTPUT_ACTIVE_LOW:
|
2009-12-17 15:40:32 +00:00
|
|
|
ccer |= TIM_CCER_CC4P;
|
2009-12-18 11:42:05 +00:00
|
|
|
case PWM_OUTPUT_ACTIVE_HIGH:
|
|
|
|
ccer |= TIM_CCER_CC4E;
|
|
|
|
default:
|
|
|
|
;
|
|
|
|
}
|
2011-04-01 13:06:44 +00:00
|
|
|
#if STM32_PWM_USE_ADVANCED
|
2011-06-29 11:59:15 +00:00
|
|
|
#if STM32_PWM_USE_TIM1 && !STM32_PWM_USE_TIM8
|
2011-04-01 13:06:44 +00:00
|
|
|
if (&PWMD1 == pwmp) {
|
2011-06-29 11:59:15 +00:00
|
|
|
#endif
|
|
|
|
#if !STM32_PWM_USE_TIM1 && STM32_PWM_USE_TIM8
|
|
|
|
if (&PWMD8 == pwmp) {
|
|
|
|
#endif
|
|
|
|
#if STM32_PWM_USE_TIM1 && STM32_PWM_USE_TIM8
|
|
|
|
if ((&PWMD1 == pwmp) || (&PWMD8 == pwmp)) {
|
|
|
|
#endif
|
2011-04-01 13:06:44 +00:00
|
|
|
switch (pwmp->config->channels[0].mode & PWM_COMPLEMENTARY_OUTPUT_MASK) {
|
|
|
|
case PWM_COMPLEMENTARY_OUTPUT_ACTIVE_LOW:
|
|
|
|
ccer |= TIM_CCER_CC1NP;
|
|
|
|
case PWM_COMPLEMENTARY_OUTPUT_ACTIVE_HIGH:
|
|
|
|
ccer |= TIM_CCER_CC1NE;
|
|
|
|
default:
|
|
|
|
;
|
|
|
|
}
|
|
|
|
switch (pwmp->config->channels[1].mode & PWM_COMPLEMENTARY_OUTPUT_MASK) {
|
|
|
|
case PWM_COMPLEMENTARY_OUTPUT_ACTIVE_LOW:
|
|
|
|
ccer |= TIM_CCER_CC2NP;
|
|
|
|
case PWM_COMPLEMENTARY_OUTPUT_ACTIVE_HIGH:
|
|
|
|
ccer |= TIM_CCER_CC2NE;
|
|
|
|
default:
|
|
|
|
;
|
|
|
|
}
|
|
|
|
switch (pwmp->config->channels[2].mode & PWM_COMPLEMENTARY_OUTPUT_MASK) {
|
|
|
|
case PWM_COMPLEMENTARY_OUTPUT_ACTIVE_LOW:
|
|
|
|
ccer |= TIM_CCER_CC3NP;
|
|
|
|
case PWM_COMPLEMENTARY_OUTPUT_ACTIVE_HIGH:
|
|
|
|
ccer |= TIM_CCER_CC3NE;
|
|
|
|
default:
|
|
|
|
;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
#endif /* STM32_PWM_USE_ADVANCED*/
|
|
|
|
|
2011-03-08 10:09:57 +00:00
|
|
|
pwmp->tim->CCER = ccer;
|
|
|
|
pwmp->tim->EGR = TIM_EGR_UG; /* Update event. */
|
|
|
|
pwmp->tim->DIER = pwmp->config->callback == NULL ? 0 : TIM_DIER_UIE;
|
2011-04-05 18:21:00 +00:00
|
|
|
pwmp->tim->SR = 0; /* Clear pending IRQs. */
|
2011-07-23 16:32:03 +00:00
|
|
|
#if STM32_PWM_USE_TIM1 || STM32_PWM_USE_TIM8
|
2011-04-01 13:06:44 +00:00
|
|
|
#if STM32_PWM_USE_ADVANCED
|
|
|
|
pwmp->tim->BDTR = pwmp->config->bdtr | TIM_BDTR_MOE;
|
|
|
|
#else
|
2011-03-08 10:09:57 +00:00
|
|
|
pwmp->tim->BDTR = TIM_BDTR_MOE;
|
2011-07-23 16:32:03 +00:00
|
|
|
#endif
|
2011-04-01 13:06:44 +00:00
|
|
|
#endif
|
2010-11-22 17:17:51 +00:00
|
|
|
/* Timer configured and started.*/
|
2011-03-08 10:09:57 +00:00
|
|
|
pwmp->tim->CR1 = TIM_CR1_ARPE | TIM_CR1_URS | TIM_CR1_CEN;
|
2009-12-13 13:37:06 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
2010-07-27 08:36:01 +00:00
|
|
|
* @brief Deactivates the PWM peripheral.
|
2009-12-13 13:37:06 +00:00
|
|
|
*
|
2010-07-27 08:36:01 +00:00
|
|
|
* @param[in] pwmp pointer to a @p PWMDriver object
|
2010-10-04 17:16:18 +00:00
|
|
|
*
|
|
|
|
* @notapi
|
2009-12-13 13:37:06 +00:00
|
|
|
*/
|
|
|
|
void pwm_lld_stop(PWMDriver *pwmp) {
|
2011-02-28 18:44:46 +00:00
|
|
|
|
2009-12-13 13:37:06 +00:00
|
|
|
/* If in ready state then disables the PWM clock.*/
|
2011-03-08 10:09:57 +00:00
|
|
|
if (pwmp->state == PWM_READY) {
|
2011-03-31 10:21:52 +00:00
|
|
|
pwmp->tim->CR1 = 0; /* Timer disabled. */
|
|
|
|
pwmp->tim->DIER = 0; /* All IRQs disabled. */
|
|
|
|
pwmp->tim->SR = 0; /* Clear eventual pending IRQs. */
|
2011-07-23 16:32:03 +00:00
|
|
|
#if STM32_PWM_USE_TIM1 || STM32_PWM_USE_TIM8
|
2011-04-01 13:06:44 +00:00
|
|
|
pwmp->tim->BDTR = 0;
|
2011-07-23 16:32:03 +00:00
|
|
|
#endif
|
2009-12-17 15:40:32 +00:00
|
|
|
|
2010-08-08 07:57:28 +00:00
|
|
|
#if STM32_PWM_USE_TIM1
|
2009-12-13 13:37:06 +00:00
|
|
|
if (&PWMD1 == pwmp) {
|
2012-06-21 17:24:17 +00:00
|
|
|
nvicDisableVector(STM32_TIM1_UP_NUMBER);
|
|
|
|
nvicDisableVector(STM32_TIM1_CC_NUMBER);
|
2011-09-16 17:38:22 +00:00
|
|
|
rccDisableTIM1(FALSE);
|
2009-12-13 13:37:06 +00:00
|
|
|
}
|
2009-12-19 09:05:40 +00:00
|
|
|
#endif
|
2010-08-08 07:57:28 +00:00
|
|
|
#if STM32_PWM_USE_TIM2
|
2009-12-19 09:05:40 +00:00
|
|
|
if (&PWMD2 == pwmp) {
|
2012-06-21 17:24:17 +00:00
|
|
|
nvicDisableVector(STM32_TIM2_NUMBER);
|
2011-09-16 17:38:22 +00:00
|
|
|
rccDisableTIM2(FALSE);
|
2009-12-19 09:05:40 +00:00
|
|
|
}
|
|
|
|
#endif
|
2010-08-08 07:57:28 +00:00
|
|
|
#if STM32_PWM_USE_TIM3
|
2009-12-19 09:05:40 +00:00
|
|
|
if (&PWMD3 == pwmp) {
|
2012-06-21 17:24:17 +00:00
|
|
|
nvicDisableVector(STM32_TIM3_NUMBER);
|
2011-09-16 17:38:22 +00:00
|
|
|
rccDisableTIM3(FALSE);
|
2009-12-19 09:05:40 +00:00
|
|
|
}
|
|
|
|
#endif
|
2010-08-08 07:57:28 +00:00
|
|
|
#if STM32_PWM_USE_TIM4
|
2009-12-19 09:05:40 +00:00
|
|
|
if (&PWMD4 == pwmp) {
|
2012-06-21 17:24:17 +00:00
|
|
|
nvicDisableVector(STM32_TIM4_NUMBER);
|
2011-09-16 17:38:22 +00:00
|
|
|
rccDisableTIM4(FALSE);
|
2009-12-19 09:05:40 +00:00
|
|
|
}
|
2010-11-27 19:16:40 +00:00
|
|
|
#endif
|
|
|
|
#if STM32_PWM_USE_TIM5
|
|
|
|
if (&PWMD5 == pwmp) {
|
2012-06-21 17:24:17 +00:00
|
|
|
nvicDisableVector(STM32_TIM5_NUMBER);
|
2011-09-16 17:38:22 +00:00
|
|
|
rccDisableTIM5(FALSE);
|
2010-11-27 19:16:40 +00:00
|
|
|
}
|
2011-06-29 11:59:15 +00:00
|
|
|
#endif
|
|
|
|
#if STM32_PWM_USE_TIM8
|
|
|
|
if (&PWMD8 == pwmp) {
|
2012-06-21 17:24:17 +00:00
|
|
|
nvicDisableVector(STM32_TIM8_UP_NUMBER);
|
|
|
|
nvicDisableVector(STM32_TIM8_CC_NUMBER);
|
2011-09-16 17:38:22 +00:00
|
|
|
rccDisableTIM8(FALSE);
|
2011-06-29 11:59:15 +00:00
|
|
|
}
|
2009-12-13 13:37:06 +00:00
|
|
|
#endif
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
2010-11-21 21:31:35 +00:00
|
|
|
* @brief Enables a PWM channel.
|
2011-03-31 10:21:52 +00:00
|
|
|
* @pre The PWM unit must have been activated using @p pwmStart().
|
|
|
|
* @post The channel is active using the specified configuration.
|
|
|
|
* @note The function has effect at the next cycle start.
|
2009-12-13 13:37:06 +00:00
|
|
|
*
|
|
|
|
* @param[in] pwmp pointer to a @p PWMDriver object
|
2010-11-21 13:45:22 +00:00
|
|
|
* @param[in] channel PWM channel identifier (0...PWM_CHANNELS-1)
|
2010-11-21 21:31:35 +00:00
|
|
|
* @param[in] width PWM pulse width as clock pulses number
|
2010-10-04 17:16:18 +00:00
|
|
|
*
|
|
|
|
* @notapi
|
2009-12-13 13:37:06 +00:00
|
|
|
*/
|
2010-11-21 21:31:35 +00:00
|
|
|
void pwm_lld_enable_channel(PWMDriver *pwmp,
|
|
|
|
pwmchannel_t channel,
|
|
|
|
pwmcnt_t width) {
|
|
|
|
|
2011-11-20 18:04:07 +00:00
|
|
|
pwmp->tim->CCR[channel] = width; /* New duty cycle. */
|
2011-04-05 18:21:00 +00:00
|
|
|
/* If there is a callback defined for the channel then the associated
|
|
|
|
interrupt must be enabled.*/
|
|
|
|
if (pwmp->config->channels[channel].callback != NULL) {
|
|
|
|
uint32_t dier = pwmp->tim->DIER;
|
|
|
|
/* If the IRQ is not already enabled care must be taken to clear it,
|
|
|
|
it is probably already pending because the timer is running.*/
|
|
|
|
if ((dier & (2 << channel)) == 0) {
|
|
|
|
pwmp->tim->DIER = dier | (2 << channel);
|
|
|
|
pwmp->tim->SR = ~(2 << channel);
|
2010-11-21 13:45:22 +00:00
|
|
|
}
|
2010-11-21 21:31:35 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* @brief Disables a PWM channel.
|
2011-03-31 10:21:52 +00:00
|
|
|
* @pre The PWM unit must have been activated using @p pwmStart().
|
|
|
|
* @post The channel is disabled and its output line returned to the
|
2010-11-21 21:31:35 +00:00
|
|
|
* idle state.
|
2011-03-31 10:21:52 +00:00
|
|
|
* @note The function has effect at the next cycle start.
|
2010-11-21 21:31:35 +00:00
|
|
|
*
|
|
|
|
* @param[in] pwmp pointer to a @p PWMDriver object
|
|
|
|
* @param[in] channel PWM channel identifier (0...PWM_CHANNELS-1)
|
2010-11-28 09:17:53 +00:00
|
|
|
*
|
|
|
|
* @notapi
|
2010-11-21 21:31:35 +00:00
|
|
|
*/
|
|
|
|
void pwm_lld_disable_channel(PWMDriver *pwmp, pwmchannel_t channel) {
|
|
|
|
|
2011-11-20 18:04:07 +00:00
|
|
|
pwmp->tim->CCR[channel] = 0;
|
2011-03-08 10:09:57 +00:00
|
|
|
pwmp->tim->DIER &= ~(2 << channel);
|
2009-12-13 13:37:06 +00:00
|
|
|
}
|
|
|
|
|
2010-11-01 17:29:56 +00:00
|
|
|
#endif /* HAL_USE_PWM */
|
2009-12-13 13:37:06 +00:00
|
|
|
|
|
|
|
/** @} */
|