esp32/machine_pwm.c: Fix freq.

Signed-off-by: Ihor Nehrutsa <[email protected]>

Author: IhorNehrutsa

ports/esp32/machine_pwm.c

@@ -42,7 +42,7 @@
 
 #define debug_printf(...) // mp_printf(&mp_plat_print, __VA_ARGS__); mp_printf(&mp_plat_print, " | %d at %s\n", __LINE__, __FILE__);
 
-#define FADE 1
+#define FADE 0
 
 // 10-bit user interface resolution compatible with esp8266 PWM.duty()
 #define UI_RES_10_BIT  (10)
@@ -440,8 +440,17 @@ static bool is_free_channels(int mode, int pin) {
     return false;
 }
 
+static bool is_free_timers(int mode, int32_t freq) {
+    for (int timer = 0; timer < LEDC_TIMER_MAX; ++timer) {
+        if ((timers[mode][timer].freq < 0) || (timers[mode][timer].freq == freq)) {
+            return true;
+        }
+    }
+    return false;
+}
+
 // Find self channel or free channel
-static void find_channel(machine_pwm_obj_t *self, int *ret_mode, int *ret_channel) {
+static void find_channel(machine_pwm_obj_t *self, int *ret_mode, int *ret_channel, int32_t freq) {
     // Try to find self channel first
     for (int mode = 0; mode < LEDC_SPEED_MODE_MAX; ++mode) {
         #if SOC_LEDC_SUPPORT_HS_MODE
@@ -465,7 +474,7 @@ static void find_channel(machine_pwm_obj_t *self, int *ret_mode, int *ret_channe
         }
         #endif
         for (int channel = 0; channel < LEDC_CHANNEL_MAX; ++channel) {
-            if (chans[mode][channel].pin < 0) {
+            if ((chans[mode][channel].pin < 0) && is_free_timers(mode, freq)) {
                 *ret_mode = mode;
                 *ret_channel = channel;
                 return;
@@ -617,7 +626,7 @@ static void mp_machine_pwm_init_helper(machine_pwm_obj_t *self,
     // Check the current mode and channel
     int mode = -1;
     int channel = -1;
-    find_channel(self, &mode, &channel);
+    find_channel(self, &mode, &channel, freq);
     if (channel < 0) {
         mp_raise_msg_varg(&mp_type_RuntimeError, MP_ERROR_TEXT("out of %sPWM channels:%d"), self->light_sleep_enable ? "light sleep capable " : "", self->light_sleep_enable ? LEDC_CHANNEL_MAX : LEDC_SPEED_MODE_MAX *LEDC_CHANNEL_MAX);
     }