mcpwm.c 24 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616
  1. // Copyright 2015-2016 Espressif Systems (Shanghai) PTE LTD
  2. //
  3. // Licensed under the Apache License, Version 2.0 (the "License");
  4. // you may not use this file except in compliance with the License.
  5. // You may obtain a copy of the License at
  6. // http://www.apache.org/licenses/LICENSE-2.0
  7. //
  8. // Unless required by applicable law or agreed to in writing, software
  9. // distributed under the License is distributed on an "AS IS" BASIS,
  10. // WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
  11. // See the License for the specific language governing permissions and
  12. // limitations under the License.
  13. #include <stdio.h>
  14. #include "esp_log.h"
  15. #include "esp_err.h"
  16. #include "freertos/FreeRTOS.h"
  17. #include "freertos/semphr.h"
  18. #include "freertos/xtensa_api.h"
  19. #include "freertos/task.h"
  20. #include "soc/gpio_periph.h"
  21. #include "driver/mcpwm.h"
  22. #include "driver/periph_ctrl.h"
  23. #include "sdkconfig.h"
  24. #include "hal/mcpwm_hal.h"
  25. typedef struct {
  26. mcpwm_hal_context_t hal;
  27. portMUX_TYPE spinlock;
  28. } mcpwm_context_t;
  29. #define CONTEXT_INITIALIZER() { \
  30. .spinlock = portMUX_INITIALIZER_UNLOCKED, \
  31. .hal = { \
  32. .prescale = MCPWM_CLK_PRESCL, \
  33. }, \
  34. }
  35. static const char *MCPWM_TAG = "MCPWM";
  36. #define MCPWM_CHECK(a, str, ret_val) if (!(a)) { \
  37. ESP_LOGE(MCPWM_TAG,"%s:%d (%s):%s", __FILE__, __LINE__, __FUNCTION__, str); \
  38. return (ret_val); \
  39. }
  40. #define MCPWM_DRIVER_INIT_ERROR "MCPWM DRIVER NOT INITIALIZED"
  41. #define MCPWM_UNIT_NUM_ERROR "MCPWM UNIT NUM ERROR"
  42. #define MCPWM_TIMER_ERROR "MCPWM TIMER NUM ERROR"
  43. #define MCPWM_PARAM_ADDR_ERROR "MCPWM PARAM ADDR ERROR"
  44. #define MCPWM_DUTY_TYPE_ERROR "MCPWM DUTY TYPE ERROR"
  45. #define MCPWM_GPIO_ERROR "MCPWM GPIO NUM ERROR"
  46. #define MCPWM_GEN_ERROR "MCPWM GENERATOR ERROR"
  47. #define MCPWM_DB_ERROR "MCPWM DEADTIME TYPE ERROR"
  48. #define MCPWM_CLK_PRESCL 15 //MCPWM clock prescale
  49. #define TIMER_CLK_PRESCALE 9 //MCPWM timer prescales
  50. #define MCPWM_CLK (MCPWM_BASE_CLK/(MCPWM_CLK_PRESCL +1))
  51. #define MCPWM_PIN_IGNORE (-1)
  52. #define OFFSET_FOR_GPIO_IDX_1 6
  53. #define OFFSET_FOR_GPIO_IDX_2 75
  54. _Static_assert(SOC_MCPWM_OP_NUM >= SOC_MCPWM_TIMER_NUM, "This driver assumes the timer num equals to the operator num.");
  55. _Static_assert(SOC_MCPWM_COMPARATOR_NUM >= SOC_MCPWM_GENERATOR_NUM, "This driver assumes the generator num equals to the generator num.");
  56. _Static_assert(SOC_MCPWM_GENERATOR_NUM == 2, "This driver assumes the generator num equals to 2.");
  57. #define MCPWM_TIMER_ID_CHECK(mcpwm_num, timer_num) do {\
  58. MCPWM_CHECK((mcpwm_num) < SOC_MCPWM_PERIPH_NUM, MCPWM_UNIT_NUM_ERROR, ESP_ERR_INVALID_ARG); \
  59. MCPWM_CHECK((timer_num) < SOC_MCPWM_TIMER_NUM, MCPWM_TIMER_ERROR, ESP_ERR_INVALID_ARG); \
  60. } while(0)
  61. #define MCPWM_TIMER_CHECK(mcpwm_num, timer_num) do{\
  62. MCPWM_TIMER_ID_CHECK(mcpwm_num, timer_num); \
  63. MCPWM_CHECK(context[mcpwm_num].hal.dev != NULL, MCPWM_DRIVER_INIT_ERROR, ESP_ERR_INVALID_STATE); \
  64. } while(0)
  65. #define MCPWM_GEN_CHECK(mcpwm_num, timer_num, gen) do{ \
  66. MCPWM_TIMER_CHECK(mcpwm_num, timer_num); \
  67. MCPWM_CHECK(gen < MCPWM_GEN_MAX, MCPWM_GEN_ERROR, ESP_ERR_INVALID_ARG); \
  68. } while(0)
  69. static mcpwm_context_t context[SOC_MCPWM_PERIPH_NUM] = {
  70. CONTEXT_INITIALIZER(),
  71. CONTEXT_INITIALIZER(),
  72. };
  73. static inline void mcpwm_critical_enter(mcpwm_unit_t mcpwm_num)
  74. {
  75. portENTER_CRITICAL(&context[mcpwm_num].spinlock);
  76. }
  77. static inline void mcpwm_critical_exit(mcpwm_unit_t mcpwm_num)
  78. {
  79. portEXIT_CRITICAL(&context[mcpwm_num].spinlock);
  80. }
  81. esp_err_t mcpwm_gpio_init(mcpwm_unit_t mcpwm_num, mcpwm_io_signals_t io_signal, int gpio_num)
  82. {
  83. if (gpio_num == MCPWM_PIN_IGNORE) {
  84. //IGNORE
  85. return ESP_OK;
  86. }
  87. MCPWM_CHECK(mcpwm_num < SOC_MCPWM_PERIPH_NUM, MCPWM_UNIT_NUM_ERROR, ESP_ERR_INVALID_ARG);
  88. MCPWM_CHECK((GPIO_IS_VALID_GPIO(gpio_num)), MCPWM_GPIO_ERROR, ESP_ERR_INVALID_ARG);
  89. periph_module_enable(PERIPH_PWM0_MODULE + mcpwm_num);
  90. PIN_FUNC_SELECT(GPIO_PIN_MUX_REG[gpio_num], PIN_FUNC_GPIO);
  91. bool mcpwm_gpio_sig = (io_signal <= MCPWM2B);
  92. if (mcpwm_num == MCPWM_UNIT_0) {
  93. if (mcpwm_gpio_sig) {
  94. MCPWM_CHECK((GPIO_IS_VALID_OUTPUT_GPIO(gpio_num)), MCPWM_GPIO_ERROR, ESP_ERR_INVALID_ARG);
  95. gpio_set_direction(gpio_num, GPIO_MODE_OUTPUT);
  96. gpio_matrix_out(gpio_num, PWM0_OUT0A_IDX + io_signal, 0, 0);
  97. } else {
  98. gpio_set_direction(gpio_num, GPIO_MODE_INPUT);
  99. gpio_matrix_in(gpio_num, PWM0_SYNC0_IN_IDX + io_signal - OFFSET_FOR_GPIO_IDX_1, 0);
  100. }
  101. } else { //MCPWM_UNIT_1
  102. if (mcpwm_gpio_sig) {
  103. MCPWM_CHECK((GPIO_IS_VALID_OUTPUT_GPIO(gpio_num)), MCPWM_GPIO_ERROR, ESP_ERR_INVALID_ARG);
  104. gpio_set_direction(gpio_num, GPIO_MODE_OUTPUT);
  105. gpio_matrix_out(gpio_num, PWM1_OUT0A_IDX + io_signal, 0, 0);
  106. } else if (io_signal >= MCPWM_SYNC_0 && io_signal <= MCPWM_FAULT_2) {
  107. gpio_set_direction(gpio_num, GPIO_MODE_INPUT);
  108. gpio_matrix_in(gpio_num, PWM1_SYNC0_IN_IDX + io_signal - OFFSET_FOR_GPIO_IDX_1, 0);
  109. } else {
  110. gpio_set_direction(gpio_num, GPIO_MODE_INPUT);
  111. gpio_matrix_in(gpio_num, PWM1_SYNC0_IN_IDX + io_signal - OFFSET_FOR_GPIO_IDX_2, 0);
  112. }
  113. }
  114. return ESP_OK;
  115. }
  116. esp_err_t mcpwm_set_pin(mcpwm_unit_t mcpwm_num, const mcpwm_pin_config_t *mcpwm_pin)
  117. {
  118. MCPWM_CHECK(mcpwm_num < SOC_MCPWM_PERIPH_NUM, MCPWM_UNIT_NUM_ERROR, ESP_ERR_INVALID_ARG);
  119. mcpwm_gpio_init(mcpwm_num, MCPWM0A, mcpwm_pin->mcpwm0a_out_num); //MCPWM0A
  120. mcpwm_gpio_init(mcpwm_num, MCPWM0B, mcpwm_pin->mcpwm0b_out_num); //MCPWM0B
  121. mcpwm_gpio_init(mcpwm_num, MCPWM1A, mcpwm_pin->mcpwm1a_out_num); //MCPWM1A
  122. mcpwm_gpio_init(mcpwm_num, MCPWM1B, mcpwm_pin->mcpwm1b_out_num); //MCPWM1B
  123. mcpwm_gpio_init(mcpwm_num, MCPWM2A, mcpwm_pin->mcpwm2a_out_num); //MCPWM2A
  124. mcpwm_gpio_init(mcpwm_num, MCPWM2B, mcpwm_pin->mcpwm2b_out_num); //MCPWM2B
  125. mcpwm_gpio_init(mcpwm_num, MCPWM_SYNC_0, mcpwm_pin->mcpwm_sync0_in_num); //SYNC0
  126. mcpwm_gpio_init(mcpwm_num, MCPWM_SYNC_1, mcpwm_pin->mcpwm_sync1_in_num); //SYNC1
  127. mcpwm_gpio_init(mcpwm_num, MCPWM_SYNC_2, mcpwm_pin->mcpwm_sync2_in_num); //SYNC2
  128. mcpwm_gpio_init(mcpwm_num, MCPWM_FAULT_0, mcpwm_pin->mcpwm_fault0_in_num); //FAULT0
  129. mcpwm_gpio_init(mcpwm_num, MCPWM_FAULT_1, mcpwm_pin->mcpwm_fault1_in_num); //FAULT1
  130. mcpwm_gpio_init(mcpwm_num, MCPWM_FAULT_2, mcpwm_pin->mcpwm_fault2_in_num); //FAULT2
  131. mcpwm_gpio_init(mcpwm_num, MCPWM_CAP_0, mcpwm_pin->mcpwm_cap0_in_num); //CAP0
  132. mcpwm_gpio_init(mcpwm_num, MCPWM_CAP_1, mcpwm_pin->mcpwm_cap1_in_num); //CAP1
  133. mcpwm_gpio_init(mcpwm_num, MCPWM_CAP_2, mcpwm_pin->mcpwm_cap2_in_num); //CAP2
  134. return ESP_OK;
  135. }
  136. esp_err_t mcpwm_start(mcpwm_unit_t mcpwm_num, mcpwm_timer_t timer_num)
  137. {
  138. MCPWM_TIMER_CHECK(mcpwm_num, timer_num);
  139. mcpwm_critical_enter(mcpwm_num);
  140. mcpwm_hal_timer_start(&context[mcpwm_num].hal, timer_num);
  141. mcpwm_critical_exit(mcpwm_num);
  142. return ESP_OK;
  143. }
  144. esp_err_t mcpwm_stop(mcpwm_unit_t mcpwm_num, mcpwm_timer_t timer_num)
  145. {
  146. MCPWM_TIMER_CHECK(mcpwm_num, timer_num);
  147. mcpwm_critical_enter(mcpwm_num);
  148. mcpwm_hal_timer_stop(&context[mcpwm_num].hal, timer_num);
  149. mcpwm_critical_exit(mcpwm_num);
  150. return ESP_OK;
  151. }
  152. esp_err_t mcpwm_set_frequency(mcpwm_unit_t mcpwm_num, mcpwm_timer_t timer_num, uint32_t frequency)
  153. {
  154. //the driver currently always use the timer x for operator x
  155. const int op = timer_num;
  156. MCPWM_TIMER_CHECK(mcpwm_num, timer_num);
  157. mcpwm_hal_context_t *hal = &context[mcpwm_num].hal;
  158. mcpwm_critical_enter(mcpwm_num);
  159. hal->timer[timer_num].freq = frequency;
  160. mcpwm_hal_timer_update_basic(hal, timer_num);
  161. //update the operator to update the duty
  162. mcpwm_hal_operator_update_basic(hal, op);
  163. mcpwm_critical_exit(mcpwm_num);
  164. return ESP_OK;
  165. }
  166. esp_err_t mcpwm_set_duty(mcpwm_unit_t mcpwm_num, mcpwm_timer_t timer_num, mcpwm_generator_t gen, float duty)
  167. {
  168. //the driver currently always use the timer x for operator x
  169. const int op = timer_num;
  170. //the driver currently always use the comparator A for PWMxA output, and comparator B for PWMxB output
  171. const int cmp = gen;
  172. MCPWM_GEN_CHECK(mcpwm_num, timer_num, gen);
  173. mcpwm_hal_context_t *hal = &context[mcpwm_num].hal;
  174. mcpwm_critical_enter(mcpwm_num);
  175. hal->op[op].duty[cmp] = duty;
  176. mcpwm_hal_operator_update_comparator(hal, op, gen);
  177. mcpwm_critical_exit(mcpwm_num);
  178. return ESP_OK;
  179. }
  180. 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)
  181. {
  182. //the driver currently always use the timer x for operator x
  183. const int op = timer_num;
  184. //the driver currently always use the comparator A for PWMxA output, and comparator B for PWMxB output
  185. const int cmp = gen;
  186. MCPWM_GEN_CHECK(mcpwm_num, timer_num, gen);
  187. mcpwm_hal_context_t *hal = &context[mcpwm_num].hal;
  188. mcpwm_critical_enter(mcpwm_num);
  189. hal->op[op].duty[cmp] = (100 * duty_in_us * hal->timer[timer_num].freq) / (1000 * 1000.);
  190. mcpwm_hal_operator_update_comparator(hal, op, gen);
  191. mcpwm_critical_exit(mcpwm_num);
  192. return ESP_OK;
  193. }
  194. esp_err_t mcpwm_set_duty_type(mcpwm_unit_t mcpwm_num, mcpwm_timer_t timer_num, mcpwm_generator_t gen,
  195. mcpwm_duty_type_t duty_type)
  196. {
  197. //the driver currently always use the timer x for operator x
  198. const int op = timer_num;
  199. MCPWM_GEN_CHECK(mcpwm_num, timer_num, gen);
  200. MCPWM_CHECK(duty_type < MCPWM_DUTY_MODE_MAX, MCPWM_DUTY_TYPE_ERROR, ESP_ERR_INVALID_ARG);
  201. mcpwm_hal_context_t *hal = &context[mcpwm_num].hal;
  202. mcpwm_critical_enter(mcpwm_num);
  203. hal->op[op].gen[gen] = (mcpwm_hal_generator_config_t) {
  204. .comparator = gen, //the driver currently always use the comparator A for PWMxA output, and comparator B for PWMxB output
  205. .duty_type = duty_type,
  206. };
  207. mcpwm_hal_operator_update_generator(hal, op, gen);
  208. mcpwm_critical_exit(mcpwm_num);
  209. return ESP_OK;
  210. }
  211. esp_err_t mcpwm_init(mcpwm_unit_t mcpwm_num, mcpwm_timer_t timer_num, const mcpwm_config_t *mcpwm_conf)
  212. {
  213. //the driver currently always use the timer x for operator x
  214. const int op = timer_num;
  215. MCPWM_TIMER_ID_CHECK(mcpwm_num, op);
  216. periph_module_enable(PERIPH_PWM0_MODULE + mcpwm_num);
  217. mcpwm_hal_context_t *hal = &context[mcpwm_num].hal;
  218. mcpwm_hal_init_config_t init_config = {
  219. .host_id = mcpwm_num,
  220. };
  221. mcpwm_critical_enter(mcpwm_num);
  222. mcpwm_hal_init(hal, &init_config);
  223. mcpwm_hal_hw_init(hal);
  224. hal->timer[timer_num].timer_prescale = TIMER_CLK_PRESCALE;
  225. hal->timer[timer_num].freq = mcpwm_conf->frequency;
  226. hal->timer[timer_num].count_mode = mcpwm_conf->counter_mode;
  227. //the driver currently always use the timer x for operator x
  228. hal->op[op].timer = timer_num;
  229. hal->op[op].duty[0] = mcpwm_conf->cmpr_a;
  230. hal->op[op].duty[1] = mcpwm_conf->cmpr_b;
  231. mcpwm_hal_timer_update_basic(hal, timer_num);
  232. //update the comparer to keep the same duty rate
  233. mcpwm_hal_operator_update_basic(hal, op);
  234. for (int gen = 0; gen < SOC_MCPWM_GENERATOR_NUM; gen++) {
  235. hal->op[op].gen[gen] = (mcpwm_hal_generator_config_t) {
  236. .comparator = gen, //the driver currently always use the comparator A for PWMxA output, and comparator B for PWMxB output
  237. .duty_type = mcpwm_conf->duty_mode,
  238. };
  239. mcpwm_hal_operator_update_generator(hal, op, gen);
  240. }
  241. mcpwm_hal_timer_start(hal, timer_num);
  242. mcpwm_critical_exit(mcpwm_num);
  243. return ESP_OK;
  244. }
  245. uint32_t mcpwm_get_frequency(mcpwm_unit_t mcpwm_num, mcpwm_timer_t timer_num)
  246. {
  247. MCPWM_TIMER_CHECK(mcpwm_num, timer_num);
  248. return context[mcpwm_num].hal.timer[timer_num].freq;
  249. }
  250. float mcpwm_get_duty(mcpwm_unit_t mcpwm_num, mcpwm_timer_t timer_num, mcpwm_generator_t gen)
  251. {
  252. //the driver currently always use the timer x for operator x
  253. const int op = timer_num;
  254. MCPWM_GEN_CHECK(mcpwm_num, timer_num, gen);
  255. return context[mcpwm_num].hal.op[op].duty[gen];
  256. }
  257. STATIC_HAL_REG_CHECK(MCPWM, MCPWM_GEN_A, 0);
  258. STATIC_HAL_REG_CHECK(MCPWM, MCPWM_GEN_B, 1);
  259. esp_err_t mcpwm_set_signal_high(mcpwm_unit_t mcpwm_num, mcpwm_timer_t timer_num, mcpwm_generator_t gen)
  260. {
  261. //the driver currently always use the timer x for operator x
  262. const int op = timer_num;
  263. MCPWM_GEN_CHECK(mcpwm_num, timer_num, gen);
  264. mcpwm_hal_context_t *hal = &context[mcpwm_num].hal;
  265. mcpwm_critical_enter(mcpwm_num);
  266. hal->op[op].gen[gen] = (mcpwm_hal_generator_config_t) {
  267. .comparator = gen, //the driver currently always use the comparator A for PWMxA output, and comparator B for PWMxB output
  268. .duty_type = MCPWM_HAL_GENERATOR_MODE_FORCE_HIGH,
  269. };
  270. mcpwm_hal_operator_update_generator(hal, op, gen);
  271. mcpwm_critical_exit(mcpwm_num);
  272. return ESP_OK;
  273. }
  274. esp_err_t mcpwm_set_signal_low(mcpwm_unit_t mcpwm_num, mcpwm_timer_t timer_num, mcpwm_generator_t gen)
  275. {
  276. //the driver currently always use the timer x for operator x
  277. const int op = timer_num;
  278. MCPWM_GEN_CHECK(mcpwm_num, timer_num, gen);
  279. mcpwm_hal_context_t *hal = &context[mcpwm_num].hal;
  280. mcpwm_critical_enter(mcpwm_num);
  281. hal->op[op].gen[gen] = (mcpwm_hal_generator_config_t) {
  282. .comparator = gen, //the driver currently always use the comparator A for PWMxA output, and comparator B for PWMxB output
  283. .duty_type = MCPWM_HAL_GENERATOR_MODE_FORCE_LOW,
  284. };
  285. mcpwm_hal_operator_update_generator(hal, op, gen);
  286. mcpwm_critical_exit(mcpwm_num);
  287. return ESP_OK;
  288. }
  289. esp_err_t mcpwm_carrier_enable(mcpwm_unit_t mcpwm_num, mcpwm_timer_t timer_num)
  290. {
  291. //the driver currently always use the timer x for operator x
  292. const int op = timer_num;
  293. MCPWM_TIMER_CHECK(mcpwm_num, timer_num);
  294. mcpwm_critical_enter(mcpwm_num);
  295. mcpwm_ll_carrier_enable(context[mcpwm_num].hal.dev, op, true);
  296. mcpwm_critical_exit(mcpwm_num);
  297. return ESP_OK;
  298. }
  299. esp_err_t mcpwm_carrier_disable(mcpwm_unit_t mcpwm_num, mcpwm_timer_t timer_num)
  300. {
  301. //the driver currently always use the timer x for operator x
  302. const int op = timer_num;
  303. MCPWM_TIMER_CHECK(mcpwm_num, timer_num);
  304. mcpwm_critical_enter(mcpwm_num);
  305. mcpwm_ll_carrier_enable(context[mcpwm_num].hal.dev, op, false);
  306. mcpwm_critical_exit(mcpwm_num);
  307. return ESP_OK;
  308. }
  309. esp_err_t mcpwm_carrier_set_period(mcpwm_unit_t mcpwm_num, mcpwm_timer_t timer_num, uint8_t carrier_period)
  310. {
  311. //the driver currently always use the timer x for operator x
  312. const int op = timer_num;
  313. MCPWM_TIMER_CHECK(mcpwm_num, timer_num);
  314. mcpwm_critical_enter(mcpwm_num);
  315. mcpwm_ll_carrier_set_prescale(context[mcpwm_num].hal.dev, op, carrier_period);
  316. mcpwm_critical_exit(mcpwm_num);
  317. return ESP_OK;
  318. }
  319. esp_err_t mcpwm_carrier_set_duty_cycle(mcpwm_unit_t mcpwm_num, mcpwm_timer_t timer_num, uint8_t carrier_duty)
  320. {
  321. //the driver currently always use the timer x for operator x
  322. const int op = timer_num;
  323. MCPWM_TIMER_CHECK(mcpwm_num, timer_num);
  324. mcpwm_critical_enter(mcpwm_num);
  325. mcpwm_ll_carrier_set_duty(context[mcpwm_num].hal.dev, op, carrier_duty);
  326. mcpwm_critical_exit(mcpwm_num);
  327. return ESP_OK;
  328. }
  329. esp_err_t mcpwm_carrier_oneshot_mode_enable(mcpwm_unit_t mcpwm_num, mcpwm_timer_t timer_num, uint8_t pulse_width)
  330. {
  331. //the driver currently always use the timer x for operator x
  332. const int op = timer_num;
  333. MCPWM_TIMER_CHECK(mcpwm_num, timer_num);
  334. mcpwm_critical_enter(mcpwm_num);
  335. mcpwm_ll_carrier_set_oneshot_width(context[mcpwm_num].hal.dev, op, pulse_width);
  336. mcpwm_critical_exit(mcpwm_num);
  337. return ESP_OK;
  338. }
  339. esp_err_t mcpwm_carrier_oneshot_mode_disable(mcpwm_unit_t mcpwm_num, mcpwm_timer_t timer_num)
  340. {
  341. return mcpwm_carrier_oneshot_mode_enable(mcpwm_num, timer_num, 0);
  342. }
  343. esp_err_t mcpwm_carrier_output_invert(mcpwm_unit_t mcpwm_num, mcpwm_timer_t timer_num,
  344. mcpwm_carrier_out_ivt_t carrier_ivt_mode)
  345. {
  346. //the driver currently always use the timer x for operator x
  347. const int op = timer_num;
  348. MCPWM_TIMER_CHECK(mcpwm_num, timer_num);
  349. mcpwm_critical_enter(mcpwm_num);
  350. mcpwm_ll_carrier_out_invert(context[mcpwm_num].hal.dev, op, carrier_ivt_mode);
  351. mcpwm_critical_exit(mcpwm_num);
  352. return ESP_OK;
  353. }
  354. esp_err_t mcpwm_carrier_init(mcpwm_unit_t mcpwm_num, mcpwm_timer_t timer_num, const mcpwm_carrier_config_t *carrier_conf)
  355. {
  356. //the driver currently always use the timer x for operator x
  357. const int op = timer_num;
  358. MCPWM_TIMER_CHECK(mcpwm_num, timer_num);
  359. mcpwm_hal_context_t *hal = &context[mcpwm_num].hal;
  360. mcpwm_hal_carrier_conf_t carrier = {
  361. .period = carrier_conf->carrier_period,
  362. .duty = carrier_conf->carrier_duty,
  363. .inverted = carrier_conf->carrier_ivt_mode,
  364. };
  365. if (carrier_conf->carrier_os_mode == MCPWM_ONESHOT_MODE_EN) {
  366. carrier.oneshot_pulse_width = carrier_conf->pulse_width_in_os;
  367. } else {
  368. carrier.oneshot_pulse_width = 0;
  369. }
  370. mcpwm_critical_enter(mcpwm_num);
  371. mcpwm_hal_operator_enable_carrier(hal, op, &carrier);
  372. mcpwm_critical_exit(mcpwm_num);
  373. return ESP_OK;
  374. }
  375. esp_err_t mcpwm_deadtime_enable(mcpwm_unit_t mcpwm_num, mcpwm_timer_t timer_num, mcpwm_deadtime_type_t dt_mode,
  376. uint32_t red, uint32_t fed)
  377. {
  378. //the driver currently always use the timer x for operator x
  379. const int op = timer_num;
  380. MCPWM_TIMER_CHECK(mcpwm_num, timer_num);
  381. MCPWM_CHECK(dt_mode < MCPWM_DEADTIME_TYPE_MAX, MCPWM_DB_ERROR, ESP_ERR_INVALID_ARG);
  382. mcpwm_hal_context_t *hal = &context[mcpwm_num].hal;
  383. mcpwm_hal_deadzone_conf_t deadzone = {
  384. .red = red,
  385. .fed = fed,
  386. .mode = dt_mode,
  387. };
  388. mcpwm_critical_enter(mcpwm_num);
  389. mcpwm_hal_operator_update_deadzone(hal, op, &deadzone);
  390. mcpwm_critical_exit(mcpwm_num);
  391. return ESP_OK;
  392. }
  393. esp_err_t mcpwm_deadtime_disable(mcpwm_unit_t mcpwm_num, mcpwm_timer_t timer_num)
  394. {
  395. //the driver currently always use the timer x for operator x
  396. const int op = timer_num;
  397. MCPWM_TIMER_CHECK(mcpwm_num, timer_num);
  398. mcpwm_hal_context_t *hal = &context[mcpwm_num].hal;
  399. mcpwm_hal_deadzone_conf_t deadzone = { .mode = MCPWM_DEADTIME_BYPASS };
  400. mcpwm_critical_enter(mcpwm_num);
  401. mcpwm_hal_operator_update_deadzone(hal, op, &deadzone);
  402. mcpwm_critical_exit(mcpwm_num);
  403. return ESP_OK;
  404. }
  405. esp_err_t mcpwm_fault_init(mcpwm_unit_t mcpwm_num, mcpwm_fault_input_level_t intput_level, mcpwm_fault_signal_t fault_sig)
  406. {
  407. MCPWM_CHECK(mcpwm_num < SOC_MCPWM_PERIPH_NUM, MCPWM_UNIT_NUM_ERROR, ESP_ERR_INVALID_ARG);
  408. mcpwm_critical_enter(mcpwm_num);
  409. mcpwm_hal_fault_init(&context[mcpwm_num].hal, fault_sig, intput_level);
  410. mcpwm_critical_exit(mcpwm_num);
  411. return ESP_OK;
  412. }
  413. esp_err_t mcpwm_fault_deinit(mcpwm_unit_t mcpwm_num, mcpwm_fault_signal_t fault_sig)
  414. {
  415. MCPWM_CHECK(mcpwm_num < SOC_MCPWM_PERIPH_NUM, MCPWM_UNIT_NUM_ERROR, ESP_ERR_INVALID_ARG);
  416. mcpwm_critical_enter(mcpwm_num);
  417. mcpwm_hal_fault_disable(&context[mcpwm_num].hal, fault_sig);
  418. mcpwm_critical_exit(mcpwm_num);
  419. return ESP_OK;
  420. }
  421. esp_err_t mcpwm_fault_set_cyc_mode(mcpwm_unit_t mcpwm_num, mcpwm_timer_t timer_num, mcpwm_fault_signal_t fault_sig,
  422. mcpwm_output_action_t action_on_pwmxa, mcpwm_output_action_t action_on_pwmxb)
  423. {
  424. //the driver currently always use the timer x for operator x
  425. const int op = timer_num;
  426. MCPWM_TIMER_CHECK(mcpwm_num, op);
  427. mcpwm_hal_context_t *hal = &context[mcpwm_num].hal;
  428. mcpwm_critical_enter(mcpwm_num);
  429. mcpwm_ll_fault_cbc_enable_signal(hal->dev, op, fault_sig, true);
  430. mcpwm_ll_fault_oneshot_enable_signal(hal->dev, op, fault_sig, false);
  431. mcpwm_ll_fault_set_cyc_action(hal->dev, op, 0, action_on_pwmxa, action_on_pwmxa);
  432. mcpwm_ll_fault_set_cyc_action(hal->dev, op, 1, action_on_pwmxb, action_on_pwmxb);
  433. mcpwm_critical_exit(mcpwm_num);
  434. return ESP_OK;
  435. }
  436. esp_err_t mcpwm_fault_set_oneshot_mode(mcpwm_unit_t mcpwm_num, mcpwm_timer_t timer_num, mcpwm_fault_signal_t fault_sig,
  437. mcpwm_action_on_pwmxa_t action_on_pwmxa, mcpwm_action_on_pwmxb_t action_on_pwmxb)
  438. {
  439. //the driver currently always use the timer x for operator x
  440. const int op = timer_num;
  441. MCPWM_TIMER_CHECK(mcpwm_num, op);
  442. mcpwm_hal_context_t *hal = &context[mcpwm_num].hal;
  443. mcpwm_critical_enter(mcpwm_num);
  444. mcpwm_hal_fault_oneshot_clear(hal, op);
  445. mcpwm_ll_fault_cbc_enable_signal(hal->dev, op, fault_sig, false);
  446. mcpwm_ll_fault_oneshot_enable_signal(hal->dev, op, fault_sig, true);
  447. mcpwm_ll_fault_set_oneshot_action(hal->dev, op, 0, action_on_pwmxa, action_on_pwmxa);
  448. mcpwm_ll_fault_set_oneshot_action(hal->dev, op, 1, action_on_pwmxb, action_on_pwmxb);
  449. mcpwm_critical_exit(mcpwm_num);
  450. return ESP_OK;
  451. }
  452. esp_err_t mcpwm_capture_enable(mcpwm_unit_t mcpwm_num, mcpwm_capture_signal_t cap_sig, mcpwm_capture_on_edge_t cap_edge,
  453. uint32_t num_of_pulse)
  454. {
  455. MCPWM_CHECK(mcpwm_num < SOC_MCPWM_PERIPH_NUM, MCPWM_UNIT_NUM_ERROR, ESP_ERR_INVALID_ARG);
  456. mcpwm_hal_init_config_t init_config = {
  457. .host_id = mcpwm_num,
  458. };
  459. mcpwm_hal_capture_config_t cap_conf = {
  460. .cap_edge = cap_edge,
  461. .prescale = num_of_pulse,
  462. };
  463. mcpwm_hal_context_t *hal = &context[mcpwm_num].hal;
  464. mcpwm_critical_enter(mcpwm_num);
  465. //We have to do this here, since there is no standalone init function
  466. //without enabling any PWM channels.
  467. mcpwm_hal_init(hal, &init_config);
  468. mcpwm_hal_hw_init(hal);
  469. mcpwm_hal_capture_enable(hal, cap_sig, &cap_conf);
  470. mcpwm_critical_exit(mcpwm_num);
  471. return ESP_OK;
  472. }
  473. esp_err_t mcpwm_capture_disable(mcpwm_unit_t mcpwm_num, mcpwm_capture_signal_t cap_sig)
  474. {
  475. MCPWM_CHECK(mcpwm_num < SOC_MCPWM_PERIPH_NUM, MCPWM_UNIT_NUM_ERROR, ESP_ERR_INVALID_ARG);
  476. mcpwm_critical_enter(mcpwm_num);
  477. mcpwm_hal_capture_disable(&context[mcpwm_num].hal, cap_sig);
  478. mcpwm_critical_exit(mcpwm_num);
  479. return ESP_OK;
  480. }
  481. uint32_t mcpwm_capture_signal_get_value(mcpwm_unit_t mcpwm_num, mcpwm_capture_signal_t cap_sig)
  482. {
  483. MCPWM_CHECK(mcpwm_num < SOC_MCPWM_PERIPH_NUM, MCPWM_UNIT_NUM_ERROR, ESP_ERR_INVALID_ARG);
  484. uint32_t captured_value;
  485. mcpwm_hal_capture_get_result(&context[mcpwm_num].hal, cap_sig, &captured_value, NULL);
  486. return captured_value;
  487. }
  488. uint32_t mcpwm_capture_signal_get_edge(mcpwm_unit_t mcpwm_num, mcpwm_capture_signal_t cap_sig)
  489. {
  490. MCPWM_CHECK(mcpwm_num < SOC_MCPWM_PERIPH_NUM, MCPWM_UNIT_NUM_ERROR, ESP_ERR_INVALID_ARG);
  491. mcpwm_capture_on_edge_t edge;
  492. mcpwm_hal_capture_get_result(&context[mcpwm_num].hal, cap_sig, NULL, &edge);
  493. return (edge == MCPWM_NEG_EDGE ? 2 : 1);
  494. }
  495. esp_err_t mcpwm_sync_enable(mcpwm_unit_t mcpwm_num, mcpwm_timer_t timer_num, mcpwm_sync_signal_t sync_sig,
  496. uint32_t phase_val)
  497. {
  498. MCPWM_TIMER_CHECK(mcpwm_num, timer_num);
  499. mcpwm_hal_context_t *hal = &context[mcpwm_num].hal;
  500. mcpwm_hal_sync_config_t sync_config = {
  501. .reload_permillage = phase_val,
  502. .sync_sig = sync_sig,
  503. };
  504. mcpwm_critical_enter(mcpwm_num);
  505. mcpwm_hal_timer_enable_sync(hal, timer_num, &sync_config);
  506. mcpwm_critical_exit(mcpwm_num);
  507. return ESP_OK;
  508. }
  509. esp_err_t mcpwm_sync_disable(mcpwm_unit_t mcpwm_num, mcpwm_timer_t timer_num)
  510. {
  511. MCPWM_TIMER_CHECK(mcpwm_num, timer_num);
  512. mcpwm_critical_enter(mcpwm_num);
  513. mcpwm_hal_timer_disable_sync(&context[mcpwm_num].hal, timer_num);
  514. mcpwm_critical_exit(mcpwm_num);
  515. return ESP_OK;
  516. }
  517. esp_err_t mcpwm_isr_register(mcpwm_unit_t mcpwm_num, void (*fn)(void *), void *arg, int intr_alloc_flags, intr_handle_t *handle)
  518. {
  519. esp_err_t ret;
  520. MCPWM_CHECK(mcpwm_num < SOC_MCPWM_PERIPH_NUM, MCPWM_UNIT_NUM_ERROR, ESP_ERR_INVALID_ARG);
  521. MCPWM_CHECK(fn != NULL, MCPWM_PARAM_ADDR_ERROR, ESP_ERR_INVALID_ARG);
  522. ret = esp_intr_alloc((ETS_PWM0_INTR_SOURCE + mcpwm_num), intr_alloc_flags, fn, arg, handle);
  523. return ret;
  524. }