1 files changed, 51 insertions, 35 deletions

diff --git a/firmware/target/mips/ingenic_jz47xx/onda_vx747/backlight-onda_vx747.c b/firmware/target/mips/ingenic_jz47xx/onda_vx747/backlight-onda_vx747.c
index 9deab7712a..598fa1a0eb 100644
--- a/firmware/target/mips/ingenic_jz47xx/onda_vx747/backlight-onda_vx747.c
+++ b/firmware/target/mips/ingenic_jz47xx/onda_vx747/backlight-onda_vx747.c
@@ -23,58 +23,74 @@
 #include "jz4740.h"
 #include "backlight-target.h"
 
-#define GPIO_PWM    123
-#define PWM_CHN     7
-#define PWM_FULL    101
+#define GPIO_PWM          (32*3)+31
+#define PWM_CHN            7
+#define __gpio_as_PWM_CHN  __gpio_as_pwm7
 
-static void set_backlight(int unk, int val)
+static void set_backlight(int val)
 {
-    if(val == 0)
-        __gpio_as_pwm7();
-    else
-    {
-        REG_TCU_TCSR(7) |= 2;
-        REG_TCU_TCSR(7) &= ~0x100;
-        int tmp;
-        tmp = (unk/2 + __cpm_get_rtcclk()) / unk;
-        if(tmp > 0xFFFF)
-            tmp = 0xFFFF;
-        
-        __tcu_set_half_data(7, (tmp * unk * 1374389535) >> 5);
-        __tcu_set_full_data(7, tmp);
-        
-        REG_TCU_TSCR = (1 << 7);
-        REG_TCU_TESR = (1 << 7);
-
-        __tcu_enable_pwm_output(7);
-    }
-    __tcu_set_count(7, 0);
+    /* Taken from the OF */
+    int tmp;
+    tmp = (val/2 + __cpm_get_rtcclk()) / val;
+    if(tmp > 0xFFFF)
+        tmp = 0xFFFF;
+
+    __tcu_set_half_data(PWM_CHN, (tmp * val * 1374389535) >> 5);
+    __tcu_set_full_data(PWM_CHN, tmp);
 }
 
-bool _backlight_init(void)
+static void set_backlight_on(void)
 {
-    __gpio_as_pwm7();
-    
-    __tcu_stop_counter(7);
-    __tcu_disable_pwm_output(7);
-    
-    set_backlight(300, 7);
+    __tcu_start_timer_clock(PWM_CHN);
     
+    set_backlight(MAX_BRIGHTNESS_SETTING);
+
+    __tcu_set_count(PWM_CHN, 0);
+    __tcu_start_counter(PWM_CHN);
+
+    __tcu_enable_pwm_output(PWM_CHN);
+}
+
+static void set_backlight_off(void)
+{
+    __tcu_stop_counter(PWM_CHN);
+    __tcu_disable_pwm_output(PWM_CHN);
+    __tcu_stop_timer_clock(PWM_CHN);
+}
+
+bool _backlight_init(void)
+{
+    __gpio_as_PWM_CHN();
+    __tcu_start_timer_clock(PWM_CHN);
+
+    __tcu_stop_counter(PWM_CHN);
+    __tcu_disable_pwm_output(PWM_CHN);
+
+    __tcu_init_pwm_output_low(PWM_CHN);
+    __tcu_select_rtcclk(PWM_CHN);
+    __tcu_select_clk_div1(PWM_CHN);
+
+    __tcu_mask_half_match_irq(PWM_CHN);
+    __tcu_mask_full_match_irq(PWM_CHN);
+
+    set_backlight_on();
+
     return true;
 }
+
 void _backlight_on(void)
 {
-    set_backlight(300, 7);
+    set_backlight_on();
 }
+
 void _backlight_off(void)
 {
-    set_backlight(300, 0);
+    set_backlight_off();
 }
 
 #ifdef HAVE_BACKLIGHT_BRIGHTNESS
 void _backlight_set_brightness(int brightness)
 {
-    (void)brightness;
-    return;
+    set_backlight(brightness);
 }
 #endif