ledc.c 28 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631
  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 <esp_types.h>
  14. #include "esp_intr.h"
  15. #include "esp_intr_alloc.h"
  16. #include "freertos/FreeRTOS.h"
  17. #include "freertos/semphr.h"
  18. #include "freertos/xtensa_api.h"
  19. #include "soc/gpio_sig_map.h"
  20. #include "driver/ledc.h"
  21. #include "soc/ledc_reg.h"
  22. #include "soc/ledc_struct.h"
  23. #include "esp_log.h"
  24. static const char* LEDC_TAG = "ledc";
  25. static portMUX_TYPE ledc_spinlock = portMUX_INITIALIZER_UNLOCKED;
  26. #define LEDC_CHECK(a, str, ret_val) \
  27. if (!(a)) { \
  28. ESP_LOGE(LEDC_TAG,"%s(%d): %s", __FUNCTION__, __LINE__, str); \
  29. return (ret_val); \
  30. }
  31. typedef struct {
  32. uint16_t speed_mode;
  33. uint16_t direction;
  34. uint32_t target_duty;
  35. int cycle_num;
  36. int scale;
  37. ledc_fade_mode_t mode;
  38. xSemaphoreHandle ledc_fade_sem;
  39. xSemaphoreHandle ledc_fade_mux;
  40. } ledc_fade_t;
  41. static ledc_fade_t *s_ledc_fade_rec[LEDC_SPEED_MODE_MAX][LEDC_CHANNEL_MAX];
  42. static ledc_isr_handle_t s_ledc_fade_isr_handle = NULL;
  43. #define LEDC_VAL_NO_CHANGE (-1)
  44. #define LEDC_STEP_NUM_MAX (1023)
  45. #define LEDC_DUTY_DECIMAL_BIT_NUM (4)
  46. #define LEDC_MODE_ERR_STR "LEDC mode error"
  47. #define LEDC_TIMER_ERR_STR "LEDC timer error"
  48. #define LEDC_CHANNEL_ERR_STR "LEDC channel error"
  49. #define LEDC_SCALE_ERR_STR "LEDC scale error"
  50. #define LEDC_CYCLE_ERR_STR "LEDC cycle num error"
  51. #define LEDC_GPIO_OUT_ERR_STR "LEDC GPIO output number error"
  52. #define LEDC_FADE_DIR_ERR_STR "LEDC fade direction error"
  53. #define LEDC_FADE_SERVICE_ERR_STR "LEDC fade service not installed"
  54. #define LEDC_FADE_TARGET_ERR_STR "LEDC fade target duty error"
  55. #define LEDC_FADE_INSTALLED_ERR_STR "LEDC fade service already installed"
  56. #define LEDC_FADE_MODE_ERR_STR "LEDC fade mode error"
  57. #define LEDC_FADE_INIT_ERROR_STR "LEDC fade channel init error"
  58. static void ledc_ls_timer_update(ledc_mode_t speed_mode, ledc_timer_t timer_sel)
  59. {
  60. if (speed_mode == LEDC_LOW_SPEED_MODE) {
  61. LEDC.timer_group[speed_mode].timer[timer_sel].conf.low_speed_update = 1;
  62. }
  63. }
  64. static IRAM_ATTR void ledc_ls_channel_update(ledc_mode_t speed_mode, ledc_channel_t channel_num)
  65. {
  66. if (speed_mode == LEDC_LOW_SPEED_MODE) {
  67. LEDC.channel_group[speed_mode].channel[channel_num].conf0.low_speed_update = 1;
  68. }
  69. }
  70. esp_err_t ledc_timer_set(ledc_mode_t speed_mode, ledc_timer_t timer_sel, uint32_t clock_divider, uint32_t duty_resolution,
  71. ledc_clk_src_t clk_src)
  72. {
  73. LEDC_CHECK(speed_mode < LEDC_SPEED_MODE_MAX, LEDC_MODE_ERR_STR, ESP_ERR_INVALID_ARG);
  74. LEDC_CHECK(timer_sel <= LEDC_TIMER_3, LEDC_TIMER_ERR_STR, ESP_ERR_INVALID_ARG);
  75. portENTER_CRITICAL(&ledc_spinlock);
  76. LEDC.timer_group[speed_mode].timer[timer_sel].conf.clock_divider = clock_divider;
  77. LEDC.timer_group[speed_mode].timer[timer_sel].conf.tick_sel = clk_src;
  78. LEDC.timer_group[speed_mode].timer[timer_sel].conf.duty_resolution = duty_resolution;
  79. ledc_ls_timer_update(speed_mode, timer_sel);
  80. portEXIT_CRITICAL(&ledc_spinlock);
  81. return ESP_OK;
  82. }
  83. static IRAM_ATTR esp_err_t ledc_duty_config(ledc_mode_t speed_mode, ledc_channel_t channel_num, int hpoint_val, uint32_t duty_val,
  84. uint32_t duty_direction, uint32_t duty_num, uint32_t duty_cycle, uint32_t duty_scale)
  85. {
  86. portENTER_CRITICAL(&ledc_spinlock);
  87. if (hpoint_val >= 0) {
  88. LEDC.channel_group[speed_mode].channel[channel_num].hpoint.hpoint = hpoint_val;
  89. }
  90. LEDC.channel_group[speed_mode].channel[channel_num].duty.duty = duty_val;
  91. LEDC.channel_group[speed_mode].channel[channel_num].conf1.val = ((duty_direction & LEDC_DUTY_INC_HSCH0_V) << LEDC_DUTY_INC_HSCH0_S) |
  92. ((duty_num & LEDC_DUTY_NUM_HSCH0_V) << LEDC_DUTY_NUM_HSCH0_S) |
  93. ((duty_cycle & LEDC_DUTY_CYCLE_HSCH0_V) << LEDC_DUTY_CYCLE_HSCH0_S) |
  94. ((duty_scale & LEDC_DUTY_SCALE_HSCH0_V) << LEDC_DUTY_SCALE_HSCH0_S);
  95. ledc_ls_channel_update(speed_mode, channel_num);
  96. portEXIT_CRITICAL(&ledc_spinlock);
  97. return ESP_OK;
  98. }
  99. esp_err_t ledc_bind_channel_timer(ledc_mode_t speed_mode, ledc_channel_t channel, uint32_t timer_idx)
  100. {
  101. LEDC_CHECK(speed_mode < LEDC_SPEED_MODE_MAX, LEDC_MODE_ERR_STR, ESP_ERR_INVALID_ARG);
  102. LEDC_CHECK(timer_idx <= LEDC_TIMER_3, LEDC_TIMER_ERR_STR, ESP_ERR_INVALID_ARG);
  103. portENTER_CRITICAL(&ledc_spinlock);
  104. LEDC.channel_group[speed_mode].channel[channel].conf0.timer_sel = timer_idx;
  105. ledc_ls_channel_update(speed_mode, channel);
  106. portEXIT_CRITICAL(&ledc_spinlock);
  107. return ESP_OK;
  108. }
  109. esp_err_t ledc_timer_rst(ledc_mode_t speed_mode, uint32_t timer_sel)
  110. {
  111. LEDC_CHECK(speed_mode < LEDC_SPEED_MODE_MAX, LEDC_MODE_ERR_STR, ESP_ERR_INVALID_ARG);
  112. LEDC_CHECK(timer_sel <= LEDC_TIMER_3, LEDC_TIMER_ERR_STR, ESP_ERR_INVALID_ARG);
  113. portENTER_CRITICAL(&ledc_spinlock);
  114. LEDC.timer_group[speed_mode].timer[timer_sel].conf.rst = 1;
  115. LEDC.timer_group[speed_mode].timer[timer_sel].conf.rst = 0;
  116. ledc_ls_timer_update(speed_mode, timer_sel);
  117. portEXIT_CRITICAL(&ledc_spinlock);
  118. return ESP_OK;
  119. }
  120. esp_err_t ledc_timer_pause(ledc_mode_t speed_mode, uint32_t timer_sel)
  121. {
  122. LEDC_CHECK(speed_mode < LEDC_SPEED_MODE_MAX, LEDC_MODE_ERR_STR, ESP_ERR_INVALID_ARG);
  123. LEDC_CHECK(timer_sel <= LEDC_TIMER_3, LEDC_TIMER_ERR_STR, ESP_ERR_INVALID_ARG);
  124. portENTER_CRITICAL(&ledc_spinlock);
  125. LEDC.timer_group[speed_mode].timer[timer_sel].conf.pause = 1;
  126. ledc_ls_timer_update(speed_mode, timer_sel);
  127. portEXIT_CRITICAL(&ledc_spinlock);
  128. return ESP_OK;
  129. }
  130. esp_err_t ledc_timer_resume(ledc_mode_t speed_mode, uint32_t timer_sel)
  131. {
  132. LEDC_CHECK(speed_mode < LEDC_SPEED_MODE_MAX, LEDC_MODE_ERR_STR, ESP_ERR_INVALID_ARG);
  133. LEDC_CHECK(timer_sel <= LEDC_TIMER_3, LEDC_TIMER_ERR_STR, ESP_ERR_INVALID_ARG);
  134. portENTER_CRITICAL(&ledc_spinlock);
  135. LEDC.timer_group[speed_mode].timer[timer_sel].conf.pause = 0;
  136. ledc_ls_timer_update(speed_mode, timer_sel);
  137. portEXIT_CRITICAL(&ledc_spinlock);
  138. return ESP_OK;
  139. }
  140. static esp_err_t ledc_enable_intr_type(ledc_mode_t speed_mode, uint32_t channel, ledc_intr_type_t type)
  141. {
  142. LEDC_CHECK(speed_mode < LEDC_SPEED_MODE_MAX, LEDC_MODE_ERR_STR, ESP_ERR_INVALID_ARG);
  143. uint32_t value;
  144. uint32_t intr_type = type;
  145. portENTER_CRITICAL(&ledc_spinlock);
  146. value = LEDC.int_ena.val;
  147. uint8_t int_en_base = LEDC_DUTY_CHNG_END_HSCH0_INT_ENA_S;
  148. if (speed_mode == LEDC_LOW_SPEED_MODE) {
  149. int_en_base = LEDC_DUTY_CHNG_END_LSCH0_INT_ENA_S;
  150. }
  151. if (intr_type == LEDC_INTR_FADE_END) {
  152. LEDC.int_ena.val = value | BIT(int_en_base + channel);
  153. } else {
  154. LEDC.int_ena.val = (value & (~(BIT(int_en_base + channel))));
  155. }
  156. portEXIT_CRITICAL(&ledc_spinlock);
  157. return ESP_OK;
  158. }
  159. esp_err_t ledc_isr_register(void (*fn)(void*), void * arg, int intr_alloc_flags, ledc_isr_handle_t *handle)
  160. {
  161. esp_err_t ret;
  162. LEDC_CHECK(fn, "ledc isr null", ESP_ERR_INVALID_ARG);
  163. portENTER_CRITICAL(&ledc_spinlock);
  164. ret = esp_intr_alloc(ETS_LEDC_INTR_SOURCE, intr_alloc_flags, fn, arg, handle);
  165. portEXIT_CRITICAL(&ledc_spinlock);
  166. return ret;
  167. }
  168. esp_err_t ledc_timer_config(const ledc_timer_config_t* timer_conf)
  169. {
  170. int freq_hz = timer_conf->freq_hz;
  171. int duty_resolution = timer_conf->duty_resolution;
  172. int timer_num = timer_conf->timer_num;
  173. int speed_mode = timer_conf->speed_mode;
  174. LEDC_CHECK(speed_mode < LEDC_SPEED_MODE_MAX, LEDC_MODE_ERR_STR, ESP_ERR_INVALID_ARG);
  175. periph_module_enable(PERIPH_LEDC_MODULE);
  176. if (freq_hz == 0 || duty_resolution == 0 || duty_resolution > LEDC_TIMER_15_BIT) {
  177. ESP_LOGE(LEDC_TAG, "freq_hz=%u duty_resolution=%u", freq_hz, duty_resolution);
  178. return ESP_ERR_INVALID_ARG;
  179. }
  180. if (timer_num > LEDC_TIMER_3) {
  181. ESP_LOGE(LEDC_TAG, "invalid timer #%u", timer_num);
  182. return ESP_ERR_INVALID_ARG;
  183. }
  184. esp_err_t ret = ESP_OK;
  185. uint32_t precision = ( 0x1 << duty_resolution ); // 2**depth
  186. // Try calculating divisor based on LEDC_APB_CLK
  187. ledc_clk_src_t timer_clk_src = LEDC_APB_CLK;
  188. // div_param is a Q10.8 fixed point value
  189. uint64_t div_param = ( (uint64_t) LEDC_APB_CLK_HZ << 8 ) / freq_hz / precision;
  190. if (div_param < 256) {
  191. // divisor is too low
  192. ESP_LOGE(LEDC_TAG, "requested frequency and duty resolution can not be achieved, try reducing freq_hz or duty_resolution. div_param=%d",
  193. (uint32_t ) div_param);
  194. ret = ESP_FAIL;
  195. }
  196. if (div_param > LEDC_DIV_NUM_HSTIMER0_V) {
  197. // APB_CLK results in divisor which too high. Try using REF_TICK as clock source.
  198. timer_clk_src = LEDC_REF_TICK;
  199. div_param = ((uint64_t) LEDC_REF_CLK_HZ << 8) / freq_hz / precision;
  200. if (div_param < 256 || div_param > LEDC_DIV_NUM_HSTIMER0_V) {
  201. ESP_LOGE(LEDC_TAG, "requested frequency and duty resolution can not be achieved, try increasing freq_hz or duty_resolution. div_param=%d",
  202. (uint32_t ) div_param);
  203. ret = ESP_FAIL;
  204. }
  205. } else {
  206. if (speed_mode == LEDC_LOW_SPEED_MODE) {
  207. //for now, we only select 80mhz for slow clk of LEDC low speed channels.
  208. LEDC.conf.slow_clk_sel = 1;
  209. }
  210. }
  211. // set timer parameters
  212. ledc_timer_set(speed_mode, timer_num, div_param, duty_resolution, timer_clk_src);
  213. // reset timer
  214. ledc_timer_rst(speed_mode, timer_num);
  215. return ret;
  216. }
  217. esp_err_t ledc_set_pin(int gpio_num, ledc_mode_t speed_mode, ledc_channel_t ledc_channel)
  218. {
  219. LEDC_CHECK(ledc_channel <= LEDC_CHANNEL_7, LEDC_CHANNEL_ERR_STR, ESP_ERR_INVALID_ARG);
  220. LEDC_CHECK(GPIO_IS_VALID_OUTPUT_GPIO(gpio_num), LEDC_GPIO_OUT_ERR_STR, ESP_ERR_INVALID_ARG);
  221. LEDC_CHECK(speed_mode < LEDC_SPEED_MODE_MAX, LEDC_MODE_ERR_STR, ESP_ERR_INVALID_ARG);
  222. PIN_FUNC_SELECT(GPIO_PIN_MUX_REG[gpio_num], PIN_FUNC_GPIO);
  223. gpio_set_direction(gpio_num, GPIO_MODE_OUTPUT);
  224. if (speed_mode == LEDC_HIGH_SPEED_MODE) {
  225. gpio_matrix_out(gpio_num, LEDC_HS_SIG_OUT0_IDX + ledc_channel, 0, 0);
  226. } else {
  227. gpio_matrix_out(gpio_num, LEDC_LS_SIG_OUT0_IDX + ledc_channel, 0, 0);
  228. }
  229. return ESP_OK;
  230. }
  231. esp_err_t ledc_channel_config(const ledc_channel_config_t* ledc_conf)
  232. {
  233. uint32_t speed_mode = ledc_conf->speed_mode;
  234. uint32_t gpio_num = ledc_conf->gpio_num;
  235. uint32_t ledc_channel = ledc_conf->channel;
  236. uint32_t timer_select = ledc_conf->timer_sel;
  237. uint32_t intr_type = ledc_conf->intr_type;
  238. uint32_t duty = ledc_conf->duty;
  239. LEDC_CHECK(ledc_channel <= LEDC_CHANNEL_7, LEDC_CHANNEL_ERR_STR, ESP_ERR_INVALID_ARG);
  240. LEDC_CHECK(speed_mode < LEDC_SPEED_MODE_MAX, LEDC_MODE_ERR_STR, ESP_ERR_INVALID_ARG);
  241. LEDC_CHECK(GPIO_IS_VALID_OUTPUT_GPIO(gpio_num), LEDC_GPIO_OUT_ERR_STR, ESP_ERR_INVALID_ARG);
  242. LEDC_CHECK(timer_select <= LEDC_TIMER_3, LEDC_TIMER_ERR_STR, ESP_ERR_INVALID_ARG);
  243. periph_module_enable(PERIPH_LEDC_MODULE);
  244. esp_err_t ret = ESP_OK;
  245. /*set channel parameters*/
  246. /* channel parameters decide how the waveform looks like in one period*/
  247. /* set channel duty, duty range is (0 ~ ((2 ** duty_resolution) - 1))*/
  248. ledc_set_duty(speed_mode, ledc_channel, duty);
  249. /*update duty settings*/
  250. ledc_update_duty(speed_mode, ledc_channel);
  251. /*bind the channel with the timer*/
  252. ledc_bind_channel_timer(speed_mode, ledc_channel, timer_select);
  253. /*set interrupt type*/
  254. ledc_enable_intr_type(speed_mode, ledc_channel, intr_type);
  255. ESP_LOGD(LEDC_TAG, "LEDC_PWM CHANNEL %1u|GPIO %02u|Duty %04u|Time %01u",
  256. ledc_channel, gpio_num, duty, timer_select
  257. );
  258. /*set LEDC signal in gpio matrix*/
  259. PIN_FUNC_SELECT(GPIO_PIN_MUX_REG[gpio_num], PIN_FUNC_GPIO);
  260. gpio_set_direction(gpio_num, GPIO_MODE_OUTPUT);
  261. if (speed_mode == LEDC_HIGH_SPEED_MODE) {
  262. gpio_matrix_out(gpio_num, LEDC_HS_SIG_OUT0_IDX + ledc_channel, 0, 0);
  263. } else {
  264. gpio_matrix_out(gpio_num, LEDC_LS_SIG_OUT0_IDX + ledc_channel, 0, 0);
  265. }
  266. return ret;
  267. }
  268. esp_err_t ledc_update_duty(ledc_mode_t speed_mode, ledc_channel_t channel)
  269. {
  270. LEDC_CHECK(speed_mode < LEDC_SPEED_MODE_MAX, LEDC_MODE_ERR_STR, ESP_ERR_INVALID_ARG);
  271. LEDC_CHECK(channel <= LEDC_CHANNEL_7, LEDC_CHANNEL_ERR_STR, ESP_ERR_INVALID_ARG);
  272. portENTER_CRITICAL(&ledc_spinlock);
  273. LEDC.channel_group[speed_mode].channel[channel].conf0.sig_out_en = 1;
  274. LEDC.channel_group[speed_mode].channel[channel].conf1.duty_start = 1;
  275. ledc_ls_channel_update(speed_mode, channel);
  276. portEXIT_CRITICAL(&ledc_spinlock);
  277. return ESP_OK;
  278. }
  279. esp_err_t ledc_stop(ledc_mode_t speed_mode, ledc_channel_t channel, uint32_t idle_level)
  280. {
  281. LEDC_CHECK(speed_mode < LEDC_SPEED_MODE_MAX, LEDC_MODE_ERR_STR, ESP_ERR_INVALID_ARG);
  282. LEDC_CHECK(channel <= LEDC_CHANNEL_7, LEDC_CHANNEL_ERR_STR, ESP_ERR_INVALID_ARG);
  283. portENTER_CRITICAL(&ledc_spinlock);
  284. LEDC.channel_group[speed_mode].channel[channel].conf0.idle_lv = idle_level & 0x1;
  285. LEDC.channel_group[speed_mode].channel[channel].conf0.sig_out_en = 0;
  286. LEDC.channel_group[speed_mode].channel[channel].conf1.duty_start = 0;
  287. ledc_ls_channel_update(speed_mode, channel);
  288. portEXIT_CRITICAL(&ledc_spinlock);
  289. return ESP_OK;
  290. }
  291. esp_err_t ledc_set_fade(ledc_mode_t speed_mode, ledc_channel_t channel, uint32_t duty, ledc_duty_direction_t fade_direction,
  292. uint32_t step_num, uint32_t duty_cyle_num, uint32_t duty_scale)
  293. {
  294. LEDC_CHECK(speed_mode < LEDC_SPEED_MODE_MAX, LEDC_MODE_ERR_STR, ESP_ERR_INVALID_ARG);
  295. LEDC_CHECK(channel <= LEDC_CHANNEL_7, LEDC_CHANNEL_ERR_STR, ESP_ERR_INVALID_ARG);
  296. LEDC_CHECK(fade_direction <= LEDC_DUTY_DIR_INCREASE, LEDC_FADE_DIR_ERR_STR, ESP_ERR_INVALID_ARG);
  297. if (step_num > LEDC_DUTY_NUM_HSCH0_V || duty_cyle_num > LEDC_DUTY_CYCLE_HSCH0_V || duty_scale > LEDC_DUTY_SCALE_HSCH0_V) {
  298. ESP_LOGE(LEDC_TAG, "step_num=%u duty_cyle_num=%u duty_scale=%u", step_num, duty_cyle_num, duty_scale);
  299. return ESP_ERR_INVALID_ARG;
  300. }
  301. if (s_ledc_fade_rec[speed_mode][channel]) {
  302. ledc_enable_intr_type(speed_mode, channel, LEDC_INTR_DISABLE);
  303. }
  304. ledc_duty_config(speed_mode,
  305. channel, //uint32_t chan_num,
  306. 0, //uint32_t hpoint_val,
  307. duty << 4, //uint32_t duty_val,the least 4 bits are decimal part
  308. fade_direction, //uint32_t increase,
  309. step_num, //uint32_t duty_num,
  310. duty_cyle_num, //uint32_t duty_cycle,
  311. duty_scale //uint32_t duty_scale
  312. );
  313. return ESP_OK;
  314. }
  315. esp_err_t ledc_set_duty(ledc_mode_t speed_mode, ledc_channel_t channel, uint32_t duty)
  316. {
  317. LEDC_CHECK(speed_mode < LEDC_SPEED_MODE_MAX, LEDC_MODE_ERR_STR, ESP_ERR_INVALID_ARG);
  318. LEDC_CHECK(channel <= LEDC_CHANNEL_7, LEDC_CHANNEL_ERR_STR, ESP_ERR_INVALID_ARG);
  319. if (s_ledc_fade_rec[speed_mode][channel]) {
  320. ledc_enable_intr_type(speed_mode, channel, LEDC_INTR_DISABLE);
  321. }
  322. ledc_duty_config(speed_mode,
  323. channel, //uint32_t chan_num,
  324. 0, //uint32_t hpoint_val,
  325. duty << 4, //uint32_t duty_val,the least 4 bits are decimal part
  326. 1, //uint32_t increase,
  327. 1, //uint32_t duty_num,
  328. 1, //uint32_t duty_cycle,
  329. 0 //uint32_t duty_scale
  330. );
  331. return ESP_OK;
  332. }
  333. uint32_t ledc_get_duty(ledc_mode_t speed_mode, ledc_channel_t channel)
  334. {
  335. LEDC_CHECK(speed_mode < LEDC_SPEED_MODE_MAX, LEDC_MODE_ERR_STR, (LEDC_ERR_DUTY));
  336. uint32_t duty = (LEDC.channel_group[speed_mode].channel[channel].duty_rd.duty_read >> 4);
  337. return duty;
  338. }
  339. esp_err_t ledc_set_freq(ledc_mode_t speed_mode, ledc_timer_t timer_num, uint32_t freq_hz)
  340. {
  341. LEDC_CHECK(speed_mode < LEDC_SPEED_MODE_MAX, LEDC_MODE_ERR_STR, ESP_ERR_INVALID_ARG);
  342. portENTER_CRITICAL(&ledc_spinlock);
  343. esp_err_t ret = ESP_OK;
  344. uint32_t clock_divider = 0;
  345. uint32_t duty_resolution = LEDC.timer_group[speed_mode].timer[timer_num].conf.duty_resolution;
  346. uint32_t timer_source_clk = LEDC.timer_group[speed_mode].timer[timer_num].conf.tick_sel;
  347. uint32_t precision = (0x1 << duty_resolution);
  348. if (timer_source_clk == LEDC_APB_CLK) {
  349. clock_divider = ((uint64_t) LEDC_APB_CLK_HZ << 8) / freq_hz / precision;
  350. } else {
  351. clock_divider = ((uint64_t) LEDC_REF_CLK_HZ << 8) / freq_hz / precision;
  352. }
  353. if (clock_divider <= 256 || clock_divider > LEDC_DIV_NUM_HSTIMER0) {
  354. ESP_LOGE(LEDC_TAG, "div param err,div_param=%u", clock_divider);
  355. ret = ESP_FAIL;
  356. }
  357. LEDC.timer_group[speed_mode].timer[timer_num].conf.clock_divider = clock_divider;
  358. portEXIT_CRITICAL(&ledc_spinlock);
  359. return ret;
  360. }
  361. uint32_t ledc_get_freq(ledc_mode_t speed_mode, ledc_timer_t timer_num)
  362. {
  363. LEDC_CHECK(speed_mode < LEDC_SPEED_MODE_MAX, LEDC_MODE_ERR_STR, (0));
  364. portENTER_CRITICAL(&ledc_spinlock);
  365. uint32_t freq = 0;
  366. uint32_t timer_source_clk = LEDC.timer_group[speed_mode].timer[timer_num].conf.tick_sel;
  367. uint32_t duty_resolution = LEDC.timer_group[speed_mode].timer[timer_num].conf.duty_resolution;
  368. uint32_t clock_divider = LEDC.timer_group[speed_mode].timer[timer_num].conf.clock_divider;
  369. uint32_t precision = (0x1 << duty_resolution);
  370. if (timer_source_clk == LEDC_APB_CLK) {
  371. freq = ((uint64_t) LEDC_APB_CLK_HZ << 8) / precision / clock_divider;
  372. } else {
  373. freq = ((uint64_t) LEDC_REF_CLK_HZ << 8) / precision / clock_divider;
  374. }
  375. portEXIT_CRITICAL(&ledc_spinlock);
  376. return freq;
  377. }
  378. void IRAM_ATTR ledc_fade_isr(void* arg)
  379. {
  380. int channel;
  381. portBASE_TYPE HPTaskAwoken = pdFALSE;
  382. uint32_t intr_status = LEDC.int_st.val; //read LEDC interrupt status.
  383. LEDC.int_clr.val = intr_status; //clear LEDC interrupt status.
  384. int speed_mode = LEDC_HIGH_SPEED_MODE;
  385. for (channel = 0; channel < LEDC_CHANNEL_MAX; channel++) {
  386. if (intr_status & (BIT(LEDC_DUTY_CHNG_END_HSCH0_INT_ST_S + channel) | BIT(LEDC_DUTY_CHNG_END_LSCH0_INT_ST_S + channel))) {
  387. if (intr_status & BIT(LEDC_DUTY_CHNG_END_HSCH0_INT_ST_S + channel)) {
  388. speed_mode = LEDC_HIGH_SPEED_MODE;
  389. } else {
  390. speed_mode = LEDC_LOW_SPEED_MODE;
  391. }
  392. if (s_ledc_fade_rec[speed_mode][channel] == NULL) {
  393. //fade object not initialized yet.
  394. continue;
  395. }
  396. uint32_t duty_cur = LEDC.channel_group[speed_mode].channel[channel].duty_rd.duty_read >> LEDC_DUTY_DECIMAL_BIT_NUM;
  397. if (duty_cur == s_ledc_fade_rec[speed_mode][channel]->target_duty) {
  398. if (s_ledc_fade_rec[speed_mode][channel]->mode == LEDC_FADE_WAIT_DONE) {
  399. xSemaphoreGiveFromISR(s_ledc_fade_rec[speed_mode][channel]->ledc_fade_sem, &HPTaskAwoken);
  400. if (HPTaskAwoken == pdTRUE) {
  401. portYIELD_FROM_ISR();
  402. }
  403. }
  404. continue;
  405. }
  406. uint32_t duty_tar = s_ledc_fade_rec[speed_mode][channel]->target_duty;
  407. int scale = s_ledc_fade_rec[speed_mode][channel]->scale;
  408. if (scale == 0) {
  409. continue;
  410. }
  411. int cycle = s_ledc_fade_rec[speed_mode][channel]->cycle_num;
  412. int delta = s_ledc_fade_rec[speed_mode][channel]->direction == LEDC_DUTY_DIR_DECREASE ? duty_cur - duty_tar : duty_tar - duty_cur;
  413. int step = delta / scale > LEDC_STEP_NUM_MAX ? LEDC_STEP_NUM_MAX : delta / scale;
  414. if (delta > scale) {
  415. ledc_duty_config(
  416. speed_mode,
  417. channel,
  418. LEDC_VAL_NO_CHANGE,
  419. duty_cur << LEDC_DUTY_DECIMAL_BIT_NUM,
  420. s_ledc_fade_rec[speed_mode][channel]->direction,
  421. step,
  422. cycle,
  423. scale);
  424. } else {
  425. ledc_duty_config(
  426. speed_mode,
  427. channel,
  428. LEDC_VAL_NO_CHANGE,
  429. duty_tar << LEDC_DUTY_DECIMAL_BIT_NUM,
  430. s_ledc_fade_rec[speed_mode][channel]->direction,
  431. 1,
  432. 1,
  433. 0);
  434. }
  435. LEDC.channel_group[speed_mode].channel[channel].conf1.duty_start = 1;
  436. }
  437. }
  438. LEDC.int_clr.val = intr_status; //clear LEDC interrupt status.
  439. }
  440. static esp_err_t ledc_fade_channel_deinit(ledc_mode_t speed_mode, ledc_channel_t channel)
  441. {
  442. if (s_ledc_fade_rec[speed_mode][channel]) {
  443. if (s_ledc_fade_rec[speed_mode][channel]->ledc_fade_mux) {
  444. vSemaphoreDelete(s_ledc_fade_rec[speed_mode][channel]->ledc_fade_mux);
  445. s_ledc_fade_rec[speed_mode][channel]->ledc_fade_mux = NULL;
  446. }
  447. if (s_ledc_fade_rec[speed_mode][channel]->ledc_fade_sem) {
  448. vSemaphoreDelete(s_ledc_fade_rec[speed_mode][channel]->ledc_fade_sem);
  449. s_ledc_fade_rec[speed_mode][channel]->ledc_fade_sem = NULL;
  450. }
  451. free(s_ledc_fade_rec[speed_mode][channel]);
  452. s_ledc_fade_rec[speed_mode][channel] = NULL;
  453. }
  454. return ESP_OK;
  455. }
  456. static esp_err_t ledc_fade_channel_init_check(ledc_mode_t speed_mode, ledc_channel_t channel)
  457. {
  458. if (s_ledc_fade_rec[speed_mode][channel] == NULL) {
  459. s_ledc_fade_rec[speed_mode][channel] = (ledc_fade_t *) calloc(1, sizeof(ledc_fade_t));
  460. s_ledc_fade_rec[speed_mode][channel]->ledc_fade_mux = xSemaphoreCreateMutex();
  461. s_ledc_fade_rec[speed_mode][channel]->ledc_fade_sem = xSemaphoreCreateBinary();
  462. }
  463. if (s_ledc_fade_rec[speed_mode][channel]
  464. && s_ledc_fade_rec[speed_mode][channel]->ledc_fade_mux
  465. && s_ledc_fade_rec[speed_mode][channel]->ledc_fade_sem) {
  466. return ESP_OK;
  467. } else {
  468. ledc_fade_channel_deinit(speed_mode, channel);
  469. return ESP_FAIL;
  470. }
  471. }
  472. esp_err_t ledc_set_fade_with_time(ledc_mode_t speed_mode, ledc_channel_t channel, uint32_t target_duty, int max_fade_time_ms)
  473. {
  474. LEDC_CHECK(speed_mode < LEDC_SPEED_MODE_MAX, LEDC_MODE_ERR_STR, ESP_ERR_INVALID_ARG);
  475. LEDC_CHECK(channel < LEDC_CHANNEL_MAX, LEDC_CHANNEL_ERR_STR, ESP_ERR_INVALID_ARG);
  476. LEDC_CHECK(ledc_fade_channel_init_check(speed_mode, channel) == ESP_OK , LEDC_FADE_INIT_ERROR_STR, ESP_FAIL);
  477. int timer_sel = LEDC.channel_group[speed_mode].channel[channel].conf0.timer_sel;
  478. uint32_t max_duty = (1 << (LEDC.timer_group[speed_mode].timer[timer_sel].conf.duty_resolution)) - 1;
  479. LEDC_CHECK(target_duty <= max_duty, LEDC_FADE_TARGET_ERR_STR, ESP_ERR_INVALID_ARG);
  480. uint32_t freq = ledc_get_freq(speed_mode, timer_sel);
  481. uint32_t duty_cur = LEDC.channel_group[speed_mode].channel[channel].duty_rd.duty_read >> LEDC_DUTY_DECIMAL_BIT_NUM;
  482. uint32_t duty_delta = target_duty > duty_cur ? target_duty - duty_cur : duty_cur - target_duty;
  483. if (duty_delta == 0) {
  484. return ESP_OK;
  485. }
  486. int total_cycles = max_fade_time_ms * freq / 1000;
  487. if (total_cycles == 0) {
  488. return ledc_set_duty(speed_mode, channel, target_duty);
  489. }
  490. int scale, cycle_num;
  491. if (total_cycles > duty_delta) {
  492. scale = 1;
  493. cycle_num = total_cycles / duty_delta;
  494. } else {
  495. cycle_num = 1;
  496. scale = (duty_delta + total_cycles - 1) / total_cycles;
  497. }
  498. return ledc_set_fade_with_step(speed_mode, channel, target_duty, scale, cycle_num);
  499. }
  500. esp_err_t ledc_set_fade_with_step(ledc_mode_t speed_mode, ledc_channel_t channel, uint32_t target_duty, int scale, int cycle_num)
  501. {
  502. LEDC_CHECK(speed_mode < LEDC_SPEED_MODE_MAX, LEDC_MODE_ERR_STR, ESP_ERR_INVALID_ARG);
  503. LEDC_CHECK(channel < LEDC_CHANNEL_MAX, LEDC_CHANNEL_ERR_STR, ESP_ERR_INVALID_ARG);
  504. LEDC_CHECK(ledc_fade_channel_init_check(speed_mode, channel) == ESP_OK , LEDC_FADE_INIT_ERROR_STR, ESP_FAIL);
  505. LEDC_CHECK(scale > 0, LEDC_SCALE_ERR_STR, ESP_ERR_INVALID_ARG);
  506. LEDC_CHECK(cycle_num > 0, LEDC_CYCLE_ERR_STR, ESP_ERR_INVALID_ARG);
  507. int timer_sel = LEDC.channel_group[speed_mode].channel[channel].conf0.timer_sel;
  508. uint32_t max_duty = (1 << (LEDC.timer_group[speed_mode].timer[timer_sel].conf.duty_resolution)) - 1;
  509. LEDC_CHECK(target_duty <= max_duty, LEDC_FADE_TARGET_ERR_STR, ESP_ERR_INVALID_ARG);
  510. //disable the interrupt, so the operation will not mess up
  511. ledc_enable_intr_type(speed_mode, channel, LEDC_INTR_DISABLE);
  512. portENTER_CRITICAL(&ledc_spinlock);
  513. uint32_t duty_cur = LEDC.channel_group[speed_mode].channel[channel].duty_rd.duty_read >> LEDC_DUTY_DECIMAL_BIT_NUM;
  514. uint32_t duty_delta = target_duty > duty_cur ? target_duty - duty_cur : duty_cur - target_duty;
  515. if (duty_delta == 0) {
  516. portEXIT_CRITICAL(&ledc_spinlock);
  517. return ESP_OK;
  518. }
  519. s_ledc_fade_rec[speed_mode][channel]->speed_mode = speed_mode;
  520. s_ledc_fade_rec[speed_mode][channel]->target_duty = target_duty;
  521. s_ledc_fade_rec[speed_mode][channel]->cycle_num = cycle_num;
  522. s_ledc_fade_rec[speed_mode][channel]->scale = scale;
  523. int step_num;
  524. if (duty_cur > target_duty) {
  525. s_ledc_fade_rec[speed_mode][channel]->direction = LEDC_DUTY_DIR_DECREASE;
  526. step_num = (duty_cur - target_duty) / scale;
  527. step_num = step_num > LEDC_STEP_NUM_MAX ? LEDC_STEP_NUM_MAX : step_num;
  528. } else {
  529. s_ledc_fade_rec[speed_mode][channel]->direction = LEDC_DUTY_DIR_INCREASE;
  530. step_num = (target_duty - duty_cur) / scale;
  531. step_num = step_num > LEDC_STEP_NUM_MAX ? LEDC_STEP_NUM_MAX : step_num;
  532. }
  533. portEXIT_CRITICAL(&ledc_spinlock);
  534. ledc_set_fade(
  535. speed_mode,
  536. channel,
  537. duty_cur,
  538. s_ledc_fade_rec[speed_mode][channel]->direction,
  539. step_num,
  540. s_ledc_fade_rec[speed_mode][channel]->cycle_num,
  541. s_ledc_fade_rec[speed_mode][channel]->scale
  542. );
  543. ESP_LOGD(LEDC_TAG, "cur duty: %d; target: %d, step: %d, cycle: %d; scale: %d\n",
  544. LEDC.channel_group[speed_mode].channel[channel].duty_rd.duty_read >> LEDC_DUTY_DECIMAL_BIT_NUM,
  545. target_duty,
  546. step_num,
  547. s_ledc_fade_rec[speed_mode][channel]->cycle_num,
  548. s_ledc_fade_rec[speed_mode][channel]->scale
  549. );
  550. int duty_resolution_ch0 = (speed_mode == LEDC_HIGH_SPEED_MODE) ? LEDC_DUTY_CHNG_END_HSCH0_INT_ENA_S : LEDC_DUTY_CHNG_END_LSCH0_INT_ENA_S;
  551. LEDC.int_clr.val |= BIT(duty_resolution_ch0 + channel);
  552. ledc_enable_intr_type(speed_mode, channel, LEDC_INTR_FADE_END);
  553. return ESP_OK;
  554. }
  555. esp_err_t ledc_fade_func_install(int intr_alloc_flags)
  556. {
  557. //OR intr_alloc_flags with ESP_INTR_FLAG_IRAM because the fade isr is in IRAM
  558. return ledc_isr_register(ledc_fade_isr, NULL, intr_alloc_flags | ESP_INTR_FLAG_IRAM, &s_ledc_fade_isr_handle);
  559. }
  560. void ledc_fade_func_uninstall()
  561. {
  562. if (s_ledc_fade_rec == NULL) {
  563. return;
  564. }
  565. if (s_ledc_fade_isr_handle) {
  566. esp_intr_free(s_ledc_fade_isr_handle);
  567. s_ledc_fade_isr_handle = NULL;
  568. }
  569. int channel, mode;
  570. for (mode = 0; mode < LEDC_SPEED_MODE_MAX; mode++) {
  571. for (channel = 0; channel < LEDC_CHANNEL_MAX; channel++) {
  572. ledc_fade_channel_deinit(mode, channel);
  573. }
  574. }
  575. return;
  576. }
  577. esp_err_t ledc_fade_start(ledc_mode_t speed_mode, ledc_channel_t channel, ledc_fade_mode_t wait_done)
  578. {
  579. LEDC_CHECK(s_ledc_fade_rec != NULL, LEDC_FADE_SERVICE_ERR_STR, ESP_ERR_INVALID_STATE);
  580. LEDC_CHECK(wait_done < LEDC_FADE_MAX, LEDC_FADE_MODE_ERR_STR, ESP_ERR_INVALID_ARG);
  581. xSemaphoreTake(s_ledc_fade_rec[speed_mode][channel]->ledc_fade_mux, portMAX_DELAY);
  582. if (wait_done == LEDC_FADE_WAIT_DONE) {
  583. s_ledc_fade_rec[speed_mode][channel]->mode = LEDC_FADE_WAIT_DONE;
  584. ledc_update_duty(speed_mode, channel);
  585. xSemaphoreTake(s_ledc_fade_rec[speed_mode][channel]->ledc_fade_sem, portMAX_DELAY);
  586. } else {
  587. s_ledc_fade_rec[speed_mode][channel]->mode = LEDC_FADE_NO_WAIT;
  588. ledc_update_duty(speed_mode, channel);
  589. }
  590. xSemaphoreGive(s_ledc_fade_rec[speed_mode][channel]->ledc_fade_mux);
  591. return ESP_OK;
  592. }