static void set_backlight(int val)
{
if(val == old_val)
return;
__tcu_disable_pwm_output(BACKLIGHT_PWM);
__tcu_stop_counter(BACKLIGHT_PWM);
__tcu_set_count(BACKLIGHT_PWM, 0);
__tcu_set_half_data(BACKLIGHT_PWM, logtable[val - 1]);
__tcu_set_full_data(BACKLIGHT_PWM, 256);
__tcu_start_counter(BACKLIGHT_PWM);
__tcu_enable_pwm_output(BACKLIGHT_PWM);
old_val = val;
}
/* This function will delay sdelay ms*/
static void sd_mdelay(int sdelay)
{
__tcu_set_count(0,0);
__tcu_disable_pwm_output(0);
__tcu_select_rtcclk(0);
__tcu_select_clk_div1(0);
__tcu_mask_half_match_irq(0);
__tcu_mask_full_match_irq(0);
REG_TCU_TDFR(0) = 32; // 1 ms
__tcu_start_counter(0);
while(1) {
if(REG_TCU_TCNT(0) > sdelay)
break;
}
__tcu_stop_counter(0);
__tcu_stop_timer_clock(0);
}
bool _backlight_init(void)
{
__gpio_as_pwm(BACKLIGHT_PWM);
__tcu_start_timer_clock(BACKLIGHT_PWM);
__tcu_stop_counter(BACKLIGHT_PWM);
__tcu_init_pwm_output_low(BACKLIGHT_PWM);
__tcu_set_pwm_output_shutdown_graceful(BACKLIGHT_PWM);
__tcu_disable_pwm_output(BACKLIGHT_PWM);
__tcu_select_extalclk(BACKLIGHT_PWM); /* 12 MHz */
__tcu_select_clk_div64(BACKLIGHT_PWM); /* 187.5 kHz */
__tcu_mask_half_match_irq(BACKLIGHT_PWM);
__tcu_mask_full_match_irq(BACKLIGHT_PWM);
__tcu_set_count(BACKLIGHT_PWM, 0);
__tcu_set_half_data(BACKLIGHT_PWM, 0);
__tcu_set_full_data(BACKLIGHT_PWM, 256);
return true;
}
void mdelay (unsigned int ms) {
int i;
__tcu_disable_pwm_output(3);
__tcu_mask_half_match_irq(3);
__tcu_mask_full_match_irq(3);
__tcu_select_extalclk(3);
__tcu_select_clk_div16(3);
REG_TCU_TDFR(3) = CFG_EXTAL / 16 / 1000;
REG_TCU_TDHR(3) = CFG_EXTAL / 16 / 1000;
__tcu_set_count(3, 0);
__tcu_start_counter(3);
for (i = 0; i < ms; i++) {
__tcu_clear_full_match_flag(3);
while (!__tcu_full_match_flag(3));
}
__tcu_stop_counter(3);
}
