bool timer_set(long cycles, bool start)
{
unsigned int divider = cycles, prescaler_bit = 0, prescaler = 1, old_irq;
if(cycles < 1)
return false;
if(start && pfn_unregister != NULL)
{
pfn_unregister();
pfn_unregister = NULL;
}
/* Increase prescale values starting from 0 to make the cycle count fit */
while(divider > 65535 && prescaler <= 1024)
{
prescaler <<= 2; /* 1, 4, 16, 64, 256, 1024 */
prescaler_bit++;
divider = cycles / prescaler;
}
old_irq = disable_irq_save();
__tcu_stop_counter(1);
if(start)
{
__tcu_disable_pwm_output(1);
__tcu_mask_half_match_irq(1);
__tcu_unmask_full_match_irq(1);
/* EXTAL clock = CFG_EXTAL (12Mhz in most targets) */
__tcu_select_extalclk(1);
}
REG_TCU_TCSR(1) = (REG_TCU_TCSR(1) & ~TCU_TCSR_PRESCALE_MASK) | (prescaler_bit << TCU_TCSR_PRESCALE_BIT);
REG_TCU_TCNT(1) = 0;
REG_TCU_TDHR(1) = 0;
REG_TCU_TDFR(1) = divider;
__tcu_clear_full_match_flag(1);
if(start)
{
system_enable_irq(IRQ_TCU1);
__tcu_start_counter(1);
}
restore_irq(old_irq);
return true;
}
int do_check_rtc ( cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
{
int i = 0, number;
unsigned int tcu_last_time, rtc_result, full_counter = 0;
REG_OST_CSR = OST_CSR_RTC_EN;
REG_OST_DR = 0xffffffff;
REG_TCU_TCSR(CH_EXT) = TCU_TCSR_EXT_EN;
REG_TCU_TDHR(CH_EXT) = 0xffff;
REG_TCU_TDFR(CH_EXT) = 0xffff;
REG_TCU_TSCR = ((1 << CH_OST) | (1 << CH_EXT)); /* enable timer clock */
REG_TCU_TESR = ((1 << CH_OST) | (1 << CH_EXT)); /* start counting up */
if(argc < 2) {
printf("Usage:\n%s\n", cmdtp->usage);
return -1;
}
number = (unsigned int)simple_strtoul(argv[1], NULL, 10);
REG_OST_CNT = 0;
REG_TCU_TCNT(CH_EXT) = 0;
// 32.768KHz
while(REG_OST_CNT < (number * 60 * 60 * ((32 << 10) - 1))) {
while(REG_TCU_TCNT(CH_EXT) == ((64 << 10) - 1)); // 16-bit
full_counter++;
}
REG_TCU_TECR = ((1 << CH_OST) | (1 << CH_EXT)); /* stop counting up */
REG_TCU_TSSR = ((1 << CH_OST) | (1 << CH_EXT)); /* disable timer clock */
tcu_last_time = REG_TCU_TCNT(CH_EXT);
rtc_result = REG_OST_CNT;
printf("tcu_result = %d(S)\n, rtc_result = %d(S)\n", full_counter * (64 << 10) + tcu_last_time / (12 << 20), rtc_result / (32 << 10));
return 0;
}
int do_check_rtc ( cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
{
int i = 0, number;
unsigned short result[100];
REG_TCU_TCSR(CH_RTC) = TCU_TCSR_RTC_EN;
REG_TCU_TDHR(CH_RTC) = 0xffff;
REG_TCU_TDFR(CH_RTC) = 0xffff;
REG_TCU_TSCR = (1 << CH_RTC); /* enable timer clock */
REG_TCU_TCSR(CH_EXT) = TCU_TCSR_EXT_EN;
REG_TCU_TDHR(CH_EXT) = 0xffff;
REG_TCU_TDFR(CH_EXT) = 0xffff;
REG_TCU_TSCR = (1 << CH_EXT); /* enable timer clock */
REG_TCU_TESR = ((1 << CH_RTC) | (1 << CH_EXT)); /* start counting up */
if(argc < 2) {
printf("Usage:\n%s\n", cmdtp->usage);
return -1;
}
number = (unsigned int)simple_strtoul(argv[1], NULL, 10);
while(0) {
REG_TCU_TCNT(CH_RTC) = 0;
for(i = 0; i < 100; i++) {
REG_TCU_TCNT(CH_EXT) = 0;
while(REG_TCU_TCNT(CH_RTC) < ((i + 1) * number));
result[i] = REG_TCU_TCNT(CH_EXT);
}
for(i = 0; i < 100; i++)
printf("result[%d] = %d\n", i, result[i]);
printf("press 'c' to continue, or exit\n");
if(getc() == 'c')
continue;
else
return 0;
}
REG_TCU_TCNT(CH_RTC) = 0;
REG_TCU_TCNT(CH_EXT) = 0;
while(REG_TCU_TCNT(CH_RTC) < (number * 60 * 60 * (64 << 10))) {
while(REG_TCU_TCNT(CH_EXT) == (64 << 10));
full_counter++;
}
last_time = REG_TCU_TCNT(CH_EXT);
rtc_result = REG_TCU_TCNT(CH_RTC);
printf("tcu_result = %d\n, rtc_result = %d\n", full_counter * (64 << 10) + tcu_last_time, rtc_result);
return 0;
}
