2021-05-23 20:09:38 -04:00
/*
* SPDX - FileCopyrightText : 2015 - 2021 Espressif Systems ( Shanghai ) CO LTD
*
* SPDX - License - Identifier : Apache - 2.0
*/
2017-03-29 04:39:35 -04:00
# include <stdio.h>
# include "esp_log.h"
# include "esp_err.h"
# include "freertos/FreeRTOS.h"
# include "freertos/semphr.h"
# include "freertos/xtensa_api.h"
# include "freertos/task.h"
2019-05-13 06:02:45 -04:00
# include "soc/gpio_periph.h"
2017-03-29 04:39:35 -04:00
# include "driver/mcpwm.h"
# include "driver/periph_ctrl.h"
2019-06-05 22:57:29 -04:00
# include "sdkconfig.h"
2019-11-17 07:53:29 -05:00
# include "hal/mcpwm_hal.h"
2021-03-15 22:55:05 -04:00
# include "hal/gpio_hal.h"
2020-06-19 00:00:58 -04:00
# include "esp_rom_gpio.h"
2019-11-17 07:53:29 -05:00
typedef struct {
mcpwm_hal_context_t hal ;
portMUX_TYPE spinlock ;
} mcpwm_context_t ;
# define CONTEXT_INITIALIZER() { \
. spinlock = portMUX_INITIALIZER_UNLOCKED , \
. hal = { \
. prescale = MCPWM_CLK_PRESCL , \
} , \
}
2019-06-05 22:57:29 -04:00
2017-03-29 04:39:35 -04:00
static const char * MCPWM_TAG = " MCPWM " ;
2019-11-17 07:53:29 -05:00
2017-03-29 04:39:35 -04:00
# define MCPWM_CHECK(a, str, ret_val) if (!(a)) { \
2020-07-29 08:46:37 -04:00
ESP_LOGE ( MCPWM_TAG , " %s(%d): %s " , __FUNCTION__ , __LINE__ , str ) ; \
return ( ret_val ) ; \
2017-03-29 04:39:35 -04:00
}
2019-11-17 07:53:29 -05:00
# define MCPWM_DRIVER_INIT_ERROR "MCPWM DRIVER NOT INITIALIZED"
2021-01-07 04:34:59 -05:00
# define MCPWM_GROUP_NUM_ERROR "MCPWM GROUP NUM ERROR"
2021-05-10 03:18:29 -04:00
# define MCPWM_PRESCALE_ERROR "MCPWM PRESCALE ERROR"
2017-03-29 04:39:35 -04:00
# define MCPWM_TIMER_ERROR "MCPWM TIMER NUM ERROR"
2021-01-07 04:34:59 -05:00
# define MCPWM_CAPTURE_ERROR "MCPWM CAPTURE NUM ERROR"
2017-03-29 04:39:35 -04:00
# define MCPWM_PARAM_ADDR_ERROR "MCPWM PARAM ADDR ERROR"
# define MCPWM_DUTY_TYPE_ERROR "MCPWM DUTY TYPE ERROR"
# define MCPWM_GPIO_ERROR "MCPWM GPIO NUM ERROR"
2019-11-17 07:53:29 -05:00
# define MCPWM_GEN_ERROR "MCPWM GENERATOR ERROR"
2021-01-07 04:34:59 -05:00
# define MCPWM_DT_ERROR "MCPWM DEADTIME TYPE ERROR"
2017-03-29 04:39:35 -04:00
2019-06-05 22:57:29 -04:00
# define MCPWM_CLK_PRESCL 15 //MCPWM clock prescale
2017-03-29 04:39:35 -04:00
# define TIMER_CLK_PRESCALE 9 //MCPWM timer prescales
# define MCPWM_CLK (MCPWM_BASE_CLK / (MCPWM_CLK_PRESCL +1))
# define MCPWM_PIN_IGNORE (-1)
# define OFFSET_FOR_GPIO_IDX_1 6
# define OFFSET_FOR_GPIO_IDX_2 75
2021-01-07 04:34:59 -05:00
_Static_assert ( SOC_MCPWM_OPERATORS_PER_GROUP > = SOC_MCPWM_TIMERS_PER_GROUP , " This driver assumes the timer num equals to the operator num. " ) ;
_Static_assert ( SOC_MCPWM_COMPARATORS_PER_OPERATOR > = SOC_MCPWM_GENERATORS_PER_OPERATOR , " This driver assumes the generator num equals to the generator num. " ) ;
_Static_assert ( SOC_MCPWM_GENERATORS_PER_OPERATOR = = 2 , " This driver assumes the generator num equals to 2. " ) ;
2019-11-17 07:53:29 -05:00
# define MCPWM_TIMER_ID_CHECK(mcpwm_num, timer_num) do {\
2021-01-07 04:34:59 -05:00
MCPWM_CHECK ( ( mcpwm_num ) < SOC_MCPWM_GROUPS , MCPWM_GROUP_NUM_ERROR , ESP_ERR_INVALID_ARG ) ; \
MCPWM_CHECK ( ( timer_num ) < SOC_MCPWM_TIMERS_PER_GROUP , MCPWM_TIMER_ERROR , ESP_ERR_INVALID_ARG ) ; \
2019-11-17 07:53:29 -05:00
} while ( 0 )
# define MCPWM_TIMER_CHECK(mcpwm_num, timer_num) do{\
MCPWM_TIMER_ID_CHECK ( mcpwm_num , timer_num ) ; \
MCPWM_CHECK ( context [ mcpwm_num ] . hal . dev ! = NULL , MCPWM_DRIVER_INIT_ERROR , ESP_ERR_INVALID_STATE ) ; \
} while ( 0 )
# define MCPWM_GEN_CHECK(mcpwm_num, timer_num, gen) do{ \
MCPWM_TIMER_CHECK ( mcpwm_num , timer_num ) ; \
MCPWM_CHECK ( gen < MCPWM_GEN_MAX , MCPWM_GEN_ERROR , ESP_ERR_INVALID_ARG ) ; \
} while ( 0 )
2021-01-07 04:34:59 -05:00
static mcpwm_context_t context [ SOC_MCPWM_GROUPS ] = {
2019-11-17 07:53:29 -05:00
CONTEXT_INITIALIZER ( ) ,
CONTEXT_INITIALIZER ( ) ,
} ;
static inline void mcpwm_critical_enter ( mcpwm_unit_t mcpwm_num )
{
portENTER_CRITICAL ( & context [ mcpwm_num ] . spinlock ) ;
}
static inline void mcpwm_critical_exit ( mcpwm_unit_t mcpwm_num )
{
portEXIT_CRITICAL ( & context [ mcpwm_num ] . spinlock ) ;
}
2017-03-29 04:39:35 -04:00
esp_err_t mcpwm_gpio_init ( mcpwm_unit_t mcpwm_num , mcpwm_io_signals_t io_signal , int gpio_num )
{
2021-02-25 06:08:22 -05:00
if ( gpio_num < 0 ) { // ignore on minus gpio number
2017-03-29 04:39:35 -04:00
return ESP_OK ;
}
2021-01-07 04:34:59 -05:00
MCPWM_CHECK ( mcpwm_num < SOC_MCPWM_GROUPS , MCPWM_GROUP_NUM_ERROR , ESP_ERR_INVALID_ARG ) ;
2017-03-29 04:39:35 -04:00
MCPWM_CHECK ( ( GPIO_IS_VALID_GPIO ( gpio_num ) ) , MCPWM_GPIO_ERROR , ESP_ERR_INVALID_ARG ) ;
2021-02-25 06:08:22 -05:00
// we enabled both input and output mode for GPIO used here, which can help to simulate trigger source especially in test code
2021-03-15 22:55:05 -04:00
gpio_hal_iomux_func_sel ( GPIO_PIN_MUX_REG [ gpio_num ] , PIN_FUNC_GPIO ) ;
2021-02-25 06:08:22 -05:00
if ( io_signal < = MCPWM2B ) { // Generator output signal
MCPWM_CHECK ( ( GPIO_IS_VALID_OUTPUT_GPIO ( gpio_num ) ) , MCPWM_GPIO_ERROR , ESP_ERR_INVALID_ARG ) ;
gpio_set_direction ( gpio_num , GPIO_MODE_INPUT_OUTPUT ) ;
int operator_id = io_signal / 2 ;
int generator_id = io_signal % 2 ;
esp_rom_gpio_connect_out_signal ( gpio_num , mcpwm_periph_signals . groups [ mcpwm_num ] . operators [ operator_id ] . generators [ generator_id ] . pwm_sig , 0 , 0 ) ;
} else if ( io_signal < = MCPWM_SYNC_2 ) { // External sync input signal
gpio_set_direction ( gpio_num , GPIO_MODE_INPUT_OUTPUT ) ;
int ext_sync_id = io_signal - MCPWM_SYNC_0 ;
esp_rom_gpio_connect_in_signal ( gpio_num , mcpwm_periph_signals . groups [ mcpwm_num ] . ext_syncers [ ext_sync_id ] . sync_sig , 0 ) ;
} else if ( io_signal < = MCPWM_FAULT_2 ) { // Fault input signal
gpio_set_direction ( gpio_num , GPIO_MODE_INPUT_OUTPUT ) ;
int fault_id = io_signal - MCPWM_FAULT_0 ;
esp_rom_gpio_connect_in_signal ( gpio_num , mcpwm_periph_signals . groups [ mcpwm_num ] . detectors [ fault_id ] . fault_sig , 0 ) ;
} else if ( io_signal > = MCPWM_CAP_0 & & io_signal < = MCPWM_CAP_2 ) { // Capture input signal
gpio_set_direction ( gpio_num , GPIO_MODE_INPUT_OUTPUT ) ;
int capture_id = io_signal - MCPWM_CAP_0 ;
esp_rom_gpio_connect_in_signal ( gpio_num , mcpwm_periph_signals . groups [ mcpwm_num ] . captures [ capture_id ] . cap_sig , 0 ) ;
2017-03-29 04:39:35 -04:00
}
return ESP_OK ;
}
esp_err_t mcpwm_set_pin ( mcpwm_unit_t mcpwm_num , const mcpwm_pin_config_t * mcpwm_pin )
{
2021-01-07 04:34:59 -05:00
MCPWM_CHECK ( mcpwm_num < SOC_MCPWM_GROUPS , MCPWM_GROUP_NUM_ERROR , ESP_ERR_INVALID_ARG ) ;
2017-03-29 04:39:35 -04:00
mcpwm_gpio_init ( mcpwm_num , MCPWM0A , mcpwm_pin - > mcpwm0a_out_num ) ; //MCPWM0A
mcpwm_gpio_init ( mcpwm_num , MCPWM0B , mcpwm_pin - > mcpwm0b_out_num ) ; //MCPWM0B
mcpwm_gpio_init ( mcpwm_num , MCPWM1A , mcpwm_pin - > mcpwm1a_out_num ) ; //MCPWM1A
mcpwm_gpio_init ( mcpwm_num , MCPWM1B , mcpwm_pin - > mcpwm1b_out_num ) ; //MCPWM1B
mcpwm_gpio_init ( mcpwm_num , MCPWM2A , mcpwm_pin - > mcpwm2a_out_num ) ; //MCPWM2A
mcpwm_gpio_init ( mcpwm_num , MCPWM2B , mcpwm_pin - > mcpwm2b_out_num ) ; //MCPWM2B
mcpwm_gpio_init ( mcpwm_num , MCPWM_SYNC_0 , mcpwm_pin - > mcpwm_sync0_in_num ) ; //SYNC0
mcpwm_gpio_init ( mcpwm_num , MCPWM_SYNC_1 , mcpwm_pin - > mcpwm_sync1_in_num ) ; //SYNC1
mcpwm_gpio_init ( mcpwm_num , MCPWM_SYNC_2 , mcpwm_pin - > mcpwm_sync2_in_num ) ; //SYNC2
mcpwm_gpio_init ( mcpwm_num , MCPWM_FAULT_0 , mcpwm_pin - > mcpwm_fault0_in_num ) ; //FAULT0
2020-06-23 16:56:50 -04:00
mcpwm_gpio_init ( mcpwm_num , MCPWM_FAULT_1 , mcpwm_pin - > mcpwm_fault1_in_num ) ; //FAULT1
mcpwm_gpio_init ( mcpwm_num , MCPWM_FAULT_2 , mcpwm_pin - > mcpwm_fault2_in_num ) ; //FAULT2
2017-03-29 04:39:35 -04:00
mcpwm_gpio_init ( mcpwm_num , MCPWM_CAP_0 , mcpwm_pin - > mcpwm_cap0_in_num ) ; //CAP0
mcpwm_gpio_init ( mcpwm_num , MCPWM_CAP_1 , mcpwm_pin - > mcpwm_cap1_in_num ) ; //CAP1
mcpwm_gpio_init ( mcpwm_num , MCPWM_CAP_2 , mcpwm_pin - > mcpwm_cap2_in_num ) ; //CAP2
return ESP_OK ;
}
esp_err_t mcpwm_start ( mcpwm_unit_t mcpwm_num , mcpwm_timer_t timer_num )
{
2019-11-17 07:53:29 -05:00
MCPWM_TIMER_CHECK ( mcpwm_num , timer_num ) ;
mcpwm_critical_enter ( mcpwm_num ) ;
mcpwm_hal_timer_start ( & context [ mcpwm_num ] . hal , timer_num ) ;
mcpwm_critical_exit ( mcpwm_num ) ;
2017-03-29 04:39:35 -04:00
return ESP_OK ;
}
esp_err_t mcpwm_stop ( mcpwm_unit_t mcpwm_num , mcpwm_timer_t timer_num )
{
2019-11-17 07:53:29 -05:00
MCPWM_TIMER_CHECK ( mcpwm_num , timer_num ) ;
mcpwm_critical_enter ( mcpwm_num ) ;
mcpwm_hal_timer_stop ( & context [ mcpwm_num ] . hal , timer_num ) ;
mcpwm_critical_exit ( mcpwm_num ) ;
2017-03-29 04:39:35 -04:00
return ESP_OK ;
}
esp_err_t mcpwm_set_frequency ( mcpwm_unit_t mcpwm_num , mcpwm_timer_t timer_num , uint32_t frequency )
{
2019-11-17 07:53:29 -05:00
//the driver currently always use the timer x for operator x
const int op = timer_num ;
MCPWM_TIMER_CHECK ( mcpwm_num , timer_num ) ;
mcpwm_hal_context_t * hal = & context [ mcpwm_num ] . hal ;
mcpwm_critical_enter ( mcpwm_num ) ;
hal - > timer [ timer_num ] . freq = frequency ;
mcpwm_hal_timer_update_basic ( hal , timer_num ) ;
//update the operator to update the duty
mcpwm_hal_operator_update_basic ( hal , op ) ;
mcpwm_critical_exit ( mcpwm_num ) ;
2017-03-29 04:39:35 -04:00
return ESP_OK ;
}
2019-11-17 07:53:29 -05:00
esp_err_t mcpwm_set_duty ( mcpwm_unit_t mcpwm_num , mcpwm_timer_t timer_num , mcpwm_generator_t gen , float duty )
2017-03-29 04:39:35 -04:00
{
2019-11-17 07:53:29 -05:00
//the driver currently always use the timer x for operator x
const int op = timer_num ;
//the driver currently always use the comparator A for PWMxA output, and comparator B for PWMxB output
const int cmp = gen ;
MCPWM_GEN_CHECK ( mcpwm_num , timer_num , gen ) ;
mcpwm_hal_context_t * hal = & context [ mcpwm_num ] . hal ;
mcpwm_critical_enter ( mcpwm_num ) ;
hal - > op [ op ] . duty [ cmp ] = duty ;
mcpwm_hal_operator_update_comparator ( hal , op , gen ) ;
mcpwm_critical_exit ( mcpwm_num ) ;
2017-03-29 04:39:35 -04:00
return ESP_OK ;
}
2019-11-17 07:53:29 -05:00
esp_err_t mcpwm_set_duty_in_us ( mcpwm_unit_t mcpwm_num , mcpwm_timer_t timer_num , mcpwm_generator_t gen , uint32_t duty_in_us )
2017-03-29 04:39:35 -04:00
{
2019-11-17 07:53:29 -05:00
//the driver currently always use the timer x for operator x
const int op = timer_num ;
//the driver currently always use the comparator A for PWMxA output, and comparator B for PWMxB output
const int cmp = gen ;
MCPWM_GEN_CHECK ( mcpwm_num , timer_num , gen ) ;
mcpwm_hal_context_t * hal = & context [ mcpwm_num ] . hal ;
mcpwm_critical_enter ( mcpwm_num ) ;
hal - > op [ op ] . duty [ cmp ] = ( 100 * duty_in_us * hal - > timer [ timer_num ] . freq ) / ( 1000 * 1000. ) ;
mcpwm_hal_operator_update_comparator ( hal , op , gen ) ;
mcpwm_critical_exit ( mcpwm_num ) ;
2017-03-29 04:39:35 -04:00
return ESP_OK ;
}
2019-11-17 07:53:29 -05:00
esp_err_t mcpwm_set_duty_type ( mcpwm_unit_t mcpwm_num , mcpwm_timer_t timer_num , mcpwm_generator_t gen ,
mcpwm_duty_type_t duty_type )
{
//the driver currently always use the timer x for operator x
const int op = timer_num ;
MCPWM_GEN_CHECK ( mcpwm_num , timer_num , gen ) ;
MCPWM_CHECK ( duty_type < MCPWM_DUTY_MODE_MAX , MCPWM_DUTY_TYPE_ERROR , ESP_ERR_INVALID_ARG ) ;
2021-01-22 03:15:06 -05:00
mcpwm_hal_context_t * hal = & context [ mcpwm_num ] . hal ;
2019-11-17 07:53:29 -05:00
mcpwm_critical_enter ( mcpwm_num ) ;
hal - > op [ op ] . gen [ gen ] = ( mcpwm_hal_generator_config_t ) {
. comparator = gen , //the driver currently always use the comparator A for PWMxA output, and comparator B for PWMxB output
. duty_type = duty_type ,
} ;
mcpwm_hal_operator_update_generator ( hal , op , gen ) ;
mcpwm_critical_exit ( mcpwm_num ) ;
2017-03-29 04:39:35 -04:00
return ESP_OK ;
}
2019-11-17 07:53:29 -05:00
2017-03-29 04:39:35 -04:00
esp_err_t mcpwm_init ( mcpwm_unit_t mcpwm_num , mcpwm_timer_t timer_num , const mcpwm_config_t * mcpwm_conf )
{
2019-11-17 07:53:29 -05:00
//the driver currently always use the timer x for operator x
const int op = timer_num ;
MCPWM_TIMER_ID_CHECK ( mcpwm_num , op ) ;
2021-02-25 06:08:22 -05:00
periph_module_enable ( mcpwm_periph_signals . groups [ mcpwm_num ] . module ) ;
2019-11-17 07:53:29 -05:00
mcpwm_hal_context_t * hal = & context [ mcpwm_num ] . hal ;
mcpwm_hal_init_config_t init_config = {
. host_id = mcpwm_num ,
} ;
mcpwm_critical_enter ( mcpwm_num ) ;
mcpwm_hal_init ( hal , & init_config ) ;
mcpwm_hal_hw_init ( hal ) ;
hal - > timer [ timer_num ] . timer_prescale = TIMER_CLK_PRESCALE ;
hal - > timer [ timer_num ] . freq = mcpwm_conf - > frequency ;
hal - > timer [ timer_num ] . count_mode = mcpwm_conf - > counter_mode ;
//the driver currently always use the timer x for operator x
hal - > op [ op ] . timer = timer_num ;
hal - > op [ op ] . duty [ 0 ] = mcpwm_conf - > cmpr_a ;
hal - > op [ op ] . duty [ 1 ] = mcpwm_conf - > cmpr_b ;
mcpwm_hal_timer_update_basic ( hal , timer_num ) ;
//update the comparer to keep the same duty rate
mcpwm_hal_operator_update_basic ( hal , op ) ;
2021-01-07 04:34:59 -05:00
for ( int gen = 0 ; gen < SOC_MCPWM_GENERATORS_PER_OPERATOR ; gen + + ) {
2019-11-17 07:53:29 -05:00
hal - > op [ op ] . gen [ gen ] = ( mcpwm_hal_generator_config_t ) {
. comparator = gen , //the driver currently always use the comparator A for PWMxA output, and comparator B for PWMxB output
. duty_type = mcpwm_conf - > duty_mode ,
} ;
mcpwm_hal_operator_update_generator ( hal , op , gen ) ;
}
mcpwm_hal_timer_start ( hal , timer_num ) ;
mcpwm_critical_exit ( mcpwm_num ) ;
2017-03-29 04:39:35 -04:00
return ESP_OK ;
}
uint32_t mcpwm_get_frequency ( mcpwm_unit_t mcpwm_num , mcpwm_timer_t timer_num )
{
2019-11-17 07:53:29 -05:00
MCPWM_TIMER_CHECK ( mcpwm_num , timer_num ) ;
return context [ mcpwm_num ] . hal . timer [ timer_num ] . freq ;
}
float mcpwm_get_duty ( mcpwm_unit_t mcpwm_num , mcpwm_timer_t timer_num , mcpwm_generator_t gen )
{
//the driver currently always use the timer x for operator x
const int op = timer_num ;
MCPWM_GEN_CHECK ( mcpwm_num , timer_num , gen ) ;
return context [ mcpwm_num ] . hal . op [ op ] . duty [ gen ] ;
}
2017-03-29 04:39:35 -04:00
2019-11-17 07:53:29 -05:00
STATIC_HAL_REG_CHECK ( MCPWM , MCPWM_GEN_A , 0 ) ;
STATIC_HAL_REG_CHECK ( MCPWM , MCPWM_GEN_B , 1 ) ;
esp_err_t mcpwm_set_signal_high ( mcpwm_unit_t mcpwm_num , mcpwm_timer_t timer_num , mcpwm_generator_t gen )
{
//the driver currently always use the timer x for operator x
const int op = timer_num ;
MCPWM_GEN_CHECK ( mcpwm_num , timer_num , gen ) ;
mcpwm_hal_context_t * hal = & context [ mcpwm_num ] . hal ;
mcpwm_critical_enter ( mcpwm_num ) ;
hal - > op [ op ] . gen [ gen ] = ( mcpwm_hal_generator_config_t ) {
. comparator = gen , //the driver currently always use the comparator A for PWMxA output, and comparator B for PWMxB output
. duty_type = MCPWM_HAL_GENERATOR_MODE_FORCE_HIGH ,
} ;
mcpwm_hal_operator_update_generator ( hal , op , gen ) ;
mcpwm_critical_exit ( mcpwm_num ) ;
2017-03-29 04:39:35 -04:00
return ESP_OK ;
}
2019-11-17 07:53:29 -05:00
esp_err_t mcpwm_set_signal_low ( mcpwm_unit_t mcpwm_num , mcpwm_timer_t timer_num , mcpwm_generator_t gen )
{
//the driver currently always use the timer x for operator x
const int op = timer_num ;
MCPWM_GEN_CHECK ( mcpwm_num , timer_num , gen ) ;
mcpwm_hal_context_t * hal = & context [ mcpwm_num ] . hal ;
mcpwm_critical_enter ( mcpwm_num ) ;
hal - > op [ op ] . gen [ gen ] = ( mcpwm_hal_generator_config_t ) {
. comparator = gen , //the driver currently always use the comparator A for PWMxA output, and comparator B for PWMxB output
. duty_type = MCPWM_HAL_GENERATOR_MODE_FORCE_LOW ,
} ;
mcpwm_hal_operator_update_generator ( hal , op , gen ) ;
mcpwm_critical_exit ( mcpwm_num ) ;
2017-03-29 04:39:35 -04:00
return ESP_OK ;
}
esp_err_t mcpwm_carrier_enable ( mcpwm_unit_t mcpwm_num , mcpwm_timer_t timer_num )
{
2019-11-17 07:53:29 -05:00
//the driver currently always use the timer x for operator x
const int op = timer_num ;
MCPWM_TIMER_CHECK ( mcpwm_num , timer_num ) ;
mcpwm_critical_enter ( mcpwm_num ) ;
mcpwm_ll_carrier_enable ( context [ mcpwm_num ] . hal . dev , op , true ) ;
mcpwm_critical_exit ( mcpwm_num ) ;
2017-03-29 04:39:35 -04:00
return ESP_OK ;
}
esp_err_t mcpwm_carrier_disable ( mcpwm_unit_t mcpwm_num , mcpwm_timer_t timer_num )
{
2019-11-17 07:53:29 -05:00
//the driver currently always use the timer x for operator x
const int op = timer_num ;
MCPWM_TIMER_CHECK ( mcpwm_num , timer_num ) ;
mcpwm_critical_enter ( mcpwm_num ) ;
mcpwm_ll_carrier_enable ( context [ mcpwm_num ] . hal . dev , op , false ) ;
mcpwm_critical_exit ( mcpwm_num ) ;
2017-03-29 04:39:35 -04:00
return ESP_OK ;
}
esp_err_t mcpwm_carrier_set_period ( mcpwm_unit_t mcpwm_num , mcpwm_timer_t timer_num , uint8_t carrier_period )
{
2019-11-17 07:53:29 -05:00
//the driver currently always use the timer x for operator x
const int op = timer_num ;
MCPWM_TIMER_CHECK ( mcpwm_num , timer_num ) ;
mcpwm_critical_enter ( mcpwm_num ) ;
mcpwm_ll_carrier_set_prescale ( context [ mcpwm_num ] . hal . dev , op , carrier_period ) ;
mcpwm_critical_exit ( mcpwm_num ) ;
2017-03-29 04:39:35 -04:00
return ESP_OK ;
}
2019-11-17 07:53:29 -05:00
2017-03-29 04:39:35 -04:00
esp_err_t mcpwm_carrier_set_duty_cycle ( mcpwm_unit_t mcpwm_num , mcpwm_timer_t timer_num , uint8_t carrier_duty )
{
2019-11-17 07:53:29 -05:00
//the driver currently always use the timer x for operator x
const int op = timer_num ;
MCPWM_TIMER_CHECK ( mcpwm_num , timer_num ) ;
mcpwm_critical_enter ( mcpwm_num ) ;
mcpwm_ll_carrier_set_duty ( context [ mcpwm_num ] . hal . dev , op , carrier_duty ) ;
mcpwm_critical_exit ( mcpwm_num ) ;
2017-03-29 04:39:35 -04:00
return ESP_OK ;
}
2018-06-05 09:19:57 -04:00
esp_err_t mcpwm_carrier_oneshot_mode_enable ( mcpwm_unit_t mcpwm_num , mcpwm_timer_t timer_num , uint8_t pulse_width )
2017-03-29 04:39:35 -04:00
{
2019-11-17 07:53:29 -05:00
//the driver currently always use the timer x for operator x
const int op = timer_num ;
MCPWM_TIMER_CHECK ( mcpwm_num , timer_num ) ;
mcpwm_critical_enter ( mcpwm_num ) ;
mcpwm_ll_carrier_set_oneshot_width ( context [ mcpwm_num ] . hal . dev , op , pulse_width ) ;
mcpwm_critical_exit ( mcpwm_num ) ;
2017-03-29 04:39:35 -04:00
return ESP_OK ;
}
2018-06-05 09:19:57 -04:00
esp_err_t mcpwm_carrier_oneshot_mode_disable ( mcpwm_unit_t mcpwm_num , mcpwm_timer_t timer_num )
2017-03-29 04:39:35 -04:00
{
2019-11-17 07:53:29 -05:00
return mcpwm_carrier_oneshot_mode_enable ( mcpwm_num , timer_num , 0 ) ;
2017-03-29 04:39:35 -04:00
}
esp_err_t mcpwm_carrier_output_invert ( mcpwm_unit_t mcpwm_num , mcpwm_timer_t timer_num ,
mcpwm_carrier_out_ivt_t carrier_ivt_mode )
{
2019-11-17 07:53:29 -05:00
//the driver currently always use the timer x for operator x
const int op = timer_num ;
MCPWM_TIMER_CHECK ( mcpwm_num , timer_num ) ;
mcpwm_critical_enter ( mcpwm_num ) ;
mcpwm_ll_carrier_out_invert ( context [ mcpwm_num ] . hal . dev , op , carrier_ivt_mode ) ;
mcpwm_critical_exit ( mcpwm_num ) ;
2017-03-29 04:39:35 -04:00
return ESP_OK ;
}
esp_err_t mcpwm_carrier_init ( mcpwm_unit_t mcpwm_num , mcpwm_timer_t timer_num , const mcpwm_carrier_config_t * carrier_conf )
{
2019-11-17 07:53:29 -05:00
//the driver currently always use the timer x for operator x
const int op = timer_num ;
MCPWM_TIMER_CHECK ( mcpwm_num , timer_num ) ;
mcpwm_hal_context_t * hal = & context [ mcpwm_num ] . hal ;
mcpwm_hal_carrier_conf_t carrier = {
. period = carrier_conf - > carrier_period ,
. duty = carrier_conf - > carrier_duty ,
. inverted = carrier_conf - > carrier_ivt_mode ,
} ;
2017-03-29 04:39:35 -04:00
if ( carrier_conf - > carrier_os_mode = = MCPWM_ONESHOT_MODE_EN ) {
2019-11-17 07:53:29 -05:00
carrier . oneshot_pulse_width = carrier_conf - > pulse_width_in_os ;
2017-03-29 04:39:35 -04:00
} else {
2019-11-17 07:53:29 -05:00
carrier . oneshot_pulse_width = 0 ;
2017-03-29 04:39:35 -04:00
}
2019-11-17 07:53:29 -05:00
mcpwm_critical_enter ( mcpwm_num ) ;
mcpwm_hal_operator_enable_carrier ( hal , op , & carrier ) ;
mcpwm_critical_exit ( mcpwm_num ) ;
2017-03-29 04:39:35 -04:00
return ESP_OK ;
}
esp_err_t mcpwm_deadtime_enable ( mcpwm_unit_t mcpwm_num , mcpwm_timer_t timer_num , mcpwm_deadtime_type_t dt_mode ,
uint32_t red , uint32_t fed )
{
2019-11-17 07:53:29 -05:00
//the driver currently always use the timer x for operator x
const int op = timer_num ;
MCPWM_TIMER_CHECK ( mcpwm_num , timer_num ) ;
2021-01-07 04:34:59 -05:00
MCPWM_CHECK ( dt_mode < MCPWM_DEADTIME_TYPE_MAX , MCPWM_DT_ERROR , ESP_ERR_INVALID_ARG ) ;
2019-11-17 07:53:29 -05:00
mcpwm_hal_context_t * hal = & context [ mcpwm_num ] . hal ;
mcpwm_hal_deadzone_conf_t deadzone = {
. red = red ,
. fed = fed ,
. mode = dt_mode ,
} ;
mcpwm_critical_enter ( mcpwm_num ) ;
mcpwm_hal_operator_update_deadzone ( hal , op , & deadzone ) ;
mcpwm_critical_exit ( mcpwm_num ) ;
2017-03-29 04:39:35 -04:00
return ESP_OK ;
}
esp_err_t mcpwm_deadtime_disable ( mcpwm_unit_t mcpwm_num , mcpwm_timer_t timer_num )
{
2019-11-17 07:53:29 -05:00
//the driver currently always use the timer x for operator x
const int op = timer_num ;
MCPWM_TIMER_CHECK ( mcpwm_num , timer_num ) ;
mcpwm_hal_context_t * hal = & context [ mcpwm_num ] . hal ;
mcpwm_hal_deadzone_conf_t deadzone = { . mode = MCPWM_DEADTIME_BYPASS } ;
mcpwm_critical_enter ( mcpwm_num ) ;
mcpwm_hal_operator_update_deadzone ( hal , op , & deadzone ) ;
mcpwm_critical_exit ( mcpwm_num ) ;
2017-03-29 04:39:35 -04:00
return ESP_OK ;
}
esp_err_t mcpwm_fault_init ( mcpwm_unit_t mcpwm_num , mcpwm_fault_input_level_t intput_level , mcpwm_fault_signal_t fault_sig )
{
2021-01-07 04:34:59 -05:00
MCPWM_CHECK ( mcpwm_num < SOC_MCPWM_GROUPS , MCPWM_GROUP_NUM_ERROR , ESP_ERR_INVALID_ARG ) ;
2019-11-17 07:53:29 -05:00
mcpwm_critical_enter ( mcpwm_num ) ;
mcpwm_hal_fault_init ( & context [ mcpwm_num ] . hal , fault_sig , intput_level ) ;
mcpwm_critical_exit ( mcpwm_num ) ;
2017-03-29 04:39:35 -04:00
return ESP_OK ;
}
esp_err_t mcpwm_fault_deinit ( mcpwm_unit_t mcpwm_num , mcpwm_fault_signal_t fault_sig )
{
2021-01-07 04:34:59 -05:00
MCPWM_CHECK ( mcpwm_num < SOC_MCPWM_GROUPS , MCPWM_GROUP_NUM_ERROR , ESP_ERR_INVALID_ARG ) ;
2019-11-17 07:53:29 -05:00
mcpwm_critical_enter ( mcpwm_num ) ;
mcpwm_hal_fault_disable ( & context [ mcpwm_num ] . hal , fault_sig ) ;
mcpwm_critical_exit ( mcpwm_num ) ;
2017-03-29 04:39:35 -04:00
return ESP_OK ;
}
esp_err_t mcpwm_fault_set_cyc_mode ( mcpwm_unit_t mcpwm_num , mcpwm_timer_t timer_num , mcpwm_fault_signal_t fault_sig ,
2019-11-17 07:53:29 -05:00
mcpwm_output_action_t action_on_pwmxa , mcpwm_output_action_t action_on_pwmxb )
{
//the driver currently always use the timer x for operator x
const int op = timer_num ;
MCPWM_TIMER_CHECK ( mcpwm_num , op ) ;
mcpwm_hal_context_t * hal = & context [ mcpwm_num ] . hal ;
mcpwm_critical_enter ( mcpwm_num ) ;
2021-01-22 03:15:06 -05:00
mcpwm_ll_fault_cbc_enable_signal ( hal - > dev , op , fault_sig , true ) ;
mcpwm_ll_fault_oneshot_enable_signal ( hal - > dev , op , fault_sig , false ) ;
mcpwm_ll_fault_set_cyc_action ( hal - > dev , op , 0 , action_on_pwmxa , action_on_pwmxa ) ;
mcpwm_ll_fault_set_cyc_action ( hal - > dev , op , 1 , action_on_pwmxb , action_on_pwmxb ) ;
2019-11-17 07:53:29 -05:00
mcpwm_critical_exit ( mcpwm_num ) ;
2017-03-29 04:39:35 -04:00
return ESP_OK ;
}
esp_err_t mcpwm_fault_set_oneshot_mode ( mcpwm_unit_t mcpwm_num , mcpwm_timer_t timer_num , mcpwm_fault_signal_t fault_sig ,
mcpwm_action_on_pwmxa_t action_on_pwmxa , mcpwm_action_on_pwmxb_t action_on_pwmxb )
{
2019-11-17 07:53:29 -05:00
//the driver currently always use the timer x for operator x
const int op = timer_num ;
MCPWM_TIMER_CHECK ( mcpwm_num , op ) ;
mcpwm_hal_context_t * hal = & context [ mcpwm_num ] . hal ;
mcpwm_critical_enter ( mcpwm_num ) ;
mcpwm_hal_fault_oneshot_clear ( hal , op ) ;
2021-01-22 03:15:06 -05:00
mcpwm_ll_fault_cbc_enable_signal ( hal - > dev , op , fault_sig , false ) ;
mcpwm_ll_fault_oneshot_enable_signal ( hal - > dev , op , fault_sig , true ) ;
mcpwm_ll_fault_set_oneshot_action ( hal - > dev , op , 0 , action_on_pwmxa , action_on_pwmxa ) ;
mcpwm_ll_fault_set_oneshot_action ( hal - > dev , op , 1 , action_on_pwmxb , action_on_pwmxb ) ;
2019-11-17 07:53:29 -05:00
mcpwm_critical_exit ( mcpwm_num ) ;
2017-03-29 04:39:35 -04:00
return ESP_OK ;
}
esp_err_t mcpwm_capture_enable ( mcpwm_unit_t mcpwm_num , mcpwm_capture_signal_t cap_sig , mcpwm_capture_on_edge_t cap_edge ,
uint32_t num_of_pulse )
{
2021-01-07 04:34:59 -05:00
MCPWM_CHECK ( mcpwm_num < SOC_MCPWM_GROUPS , MCPWM_GROUP_NUM_ERROR , ESP_ERR_INVALID_ARG ) ;
2021-05-10 03:18:29 -04:00
MCPWM_CHECK ( num_of_pulse < = MCPWM_LL_MAX_PRESCALE , MCPWM_PRESCALE_ERROR , ESP_ERR_INVALID_ARG ) ;
2021-02-25 06:08:22 -05:00
// enable MCPWM module incase user don't use `mcpwm_init` at all
periph_module_enable ( mcpwm_periph_signals . groups [ mcpwm_num ] . module ) ;
2019-11-17 07:53:29 -05:00
mcpwm_hal_init_config_t init_config = {
. host_id = mcpwm_num ,
} ;
mcpwm_hal_capture_config_t cap_conf = {
. cap_edge = cap_edge ,
. prescale = num_of_pulse ,
} ;
2021-01-22 03:15:06 -05:00
mcpwm_hal_context_t * hal = & context [ mcpwm_num ] . hal ;
2019-11-17 07:53:29 -05:00
mcpwm_critical_enter ( mcpwm_num ) ;
2019-11-17 07:52:33 -05:00
//We have to do this here, since there is no standalone init function
//without enabling any PWM channels.
2019-11-17 07:53:29 -05:00
mcpwm_hal_init ( hal , & init_config ) ;
mcpwm_hal_hw_init ( hal ) ;
mcpwm_hal_capture_enable ( hal , cap_sig , & cap_conf ) ;
mcpwm_critical_exit ( mcpwm_num ) ;
2017-03-29 04:39:35 -04:00
return ESP_OK ;
}
esp_err_t mcpwm_capture_disable ( mcpwm_unit_t mcpwm_num , mcpwm_capture_signal_t cap_sig )
{
2021-01-07 04:34:59 -05:00
MCPWM_CHECK ( mcpwm_num < SOC_MCPWM_GROUPS , MCPWM_GROUP_NUM_ERROR , ESP_ERR_INVALID_ARG ) ;
2019-11-17 07:53:29 -05:00
mcpwm_critical_enter ( mcpwm_num ) ;
mcpwm_hal_capture_disable ( & context [ mcpwm_num ] . hal , cap_sig ) ;
mcpwm_critical_exit ( mcpwm_num ) ;
2021-02-25 06:08:22 -05:00
periph_module_disable ( mcpwm_periph_signals . groups [ mcpwm_num ] . module ) ;
2017-03-29 04:39:35 -04:00
return ESP_OK ;
}
uint32_t mcpwm_capture_signal_get_value ( mcpwm_unit_t mcpwm_num , mcpwm_capture_signal_t cap_sig )
{
2021-01-07 04:34:59 -05:00
MCPWM_CHECK ( mcpwm_num < SOC_MCPWM_GROUPS , MCPWM_GROUP_NUM_ERROR , ESP_ERR_INVALID_ARG ) ;
2019-11-17 07:53:29 -05:00
uint32_t captured_value ;
mcpwm_hal_capture_get_result ( & context [ mcpwm_num ] . hal , cap_sig , & captured_value , NULL ) ;
return captured_value ;
2017-03-29 04:39:35 -04:00
}
uint32_t mcpwm_capture_signal_get_edge ( mcpwm_unit_t mcpwm_num , mcpwm_capture_signal_t cap_sig )
{
2021-01-07 04:34:59 -05:00
MCPWM_CHECK ( mcpwm_num < SOC_MCPWM_GROUPS , MCPWM_GROUP_NUM_ERROR , ESP_ERR_INVALID_ARG ) ;
2019-11-17 07:53:29 -05:00
mcpwm_capture_on_edge_t edge ;
mcpwm_hal_capture_get_result ( & context [ mcpwm_num ] . hal , cap_sig , NULL , & edge ) ;
2021-01-22 03:15:06 -05:00
return ( edge = = MCPWM_NEG_EDGE ? 2 : 1 ) ;
2017-03-29 04:39:35 -04:00
}
esp_err_t mcpwm_sync_enable ( mcpwm_unit_t mcpwm_num , mcpwm_timer_t timer_num , mcpwm_sync_signal_t sync_sig ,
uint32_t phase_val )
{
2019-11-17 07:53:29 -05:00
MCPWM_TIMER_CHECK ( mcpwm_num , timer_num ) ;
mcpwm_hal_context_t * hal = & context [ mcpwm_num ] . hal ;
mcpwm_hal_sync_config_t sync_config = {
. reload_permillage = phase_val ,
. sync_sig = sync_sig ,
} ;
mcpwm_critical_enter ( mcpwm_num ) ;
mcpwm_hal_timer_enable_sync ( hal , timer_num , & sync_config ) ;
mcpwm_critical_exit ( mcpwm_num ) ;
2017-03-29 04:39:35 -04:00
return ESP_OK ;
}
esp_err_t mcpwm_sync_disable ( mcpwm_unit_t mcpwm_num , mcpwm_timer_t timer_num )
{
2019-11-17 07:53:29 -05:00
MCPWM_TIMER_CHECK ( mcpwm_num , timer_num ) ;
mcpwm_critical_enter ( mcpwm_num ) ;
mcpwm_hal_timer_disable_sync ( & context [ mcpwm_num ] . hal , timer_num ) ;
mcpwm_critical_exit ( mcpwm_num ) ;
2017-03-29 04:39:35 -04:00
return ESP_OK ;
}
2019-11-17 07:53:29 -05:00
2017-03-29 04:39:35 -04:00
esp_err_t mcpwm_isr_register ( mcpwm_unit_t mcpwm_num , void ( * fn ) ( void * ) , void * arg , int intr_alloc_flags , intr_handle_t * handle )
{
esp_err_t ret ;
2021-01-07 04:34:59 -05:00
MCPWM_CHECK ( mcpwm_num < SOC_MCPWM_GROUPS , MCPWM_GROUP_NUM_ERROR , ESP_ERR_INVALID_ARG ) ;
2017-03-29 04:39:35 -04:00
MCPWM_CHECK ( fn ! = NULL , MCPWM_PARAM_ADDR_ERROR , ESP_ERR_INVALID_ARG ) ;
2021-02-25 06:08:22 -05:00
ret = esp_intr_alloc ( mcpwm_periph_signals . groups [ mcpwm_num ] . irq_id , intr_alloc_flags , fn , arg , handle ) ;
2017-03-29 04:39:35 -04:00
return ret ;
}