ledc.c 24 KB

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