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; }