-static void timer_init(const unsigned int timer, const unsigned int interval)
-{
- /* Set timer to periodic mode */
- orl(AR9170_TIMER_REG_CONTROL, BIT(timer));
-
- /* Set time interval */
- set(AR9170_TIMER_REG_TIMER0 + (timer << 2), interval - 1);
-
- /* Clear timer interrupt flag */
- orl(AR9170_TIMER_REG_INTERRUPT, BIT(timer));
-}
-
-void clock_set(enum cpu_clock_t clock_, bool on)
-{
- /*
- * Word of Warning!
- * This setting does more than just mess with the CPU Clock.
- * So watch out, if you need _stable_ timer interrupts.
- */
- if (fw.phy.frequency < 3000000)
- set(AR9170_PWR_REG_PLL_ADDAC, 0x5163);
- else
- set(AR9170_PWR_REG_PLL_ADDAC, 0x5143);
-
- fw.ticks_per_usec = GET_VAL(AR9170_PWR_PLL_ADDAC_DIV,
- get(AR9170_PWR_REG_PLL_ADDAC));
-
- set(AR9170_PWR_REG_CLOCK_SEL, (uint32_t) ((on ? 0x70 : 0x600) | clock_));
-
- switch (clock_) {
- case AHB_20_22MHZ:
- fw.ticks_per_usec >>= 1;
- case AHB_40MHZ_OSC:
- case AHB_40_44MHZ:
- fw.ticks_per_usec >>= 1;
- case AHB_80_88MHZ:
- break;
- }
-
- timer_init(1, (fw.ticks_per_usec * 25) >> 1);
-
- INFO("SET CLOCK c:%d t:%d tt:%d f:%d\n", clock_, fw.ticks_per_usec, (fw.ticks_per_usec * 25) >> 1, fw.phy.frequency);
-}
-