学步园

杂项函数在 BSP 中也是非常重要的。我为了图省事，全部都放置在了：c/src/lib/libcpu/arm/at91sam9260/pmc/pmc.c中。

主要是获取CPU当前的频率和系统主时钟的频率。

前几篇连载中，我们在串口和时钟驱动里都是用了获取主时钟频率的函数。

另外一个就是 udelay 函数。udelay函数原来是posix的标准函数，但是rtems并没有实现，

我们不可能用时钟节拍去做微秒级别的时间延时。

许多驱动程序必须要延迟一定的时间才能工作，这里我给出了一个简单的实现方式。

启动定时器1，采用计数方式，选择一个合适的时钟平率，我选择的是主时钟的 32 分之一，一个脉冲大约是300ns。然后

给定时器一个初值，测量一段空循环的时间。得出循环多少次正好是1微秒。

这是通过 calc_delay 来实现的。实际实现中，为了防止除法的精度不够，还做了一下微调。

我是在c/src/lib/libbsp/arm/at9260/startup/bspstart.c中的bsp_start_default函数中调用这个函数，bsp_start_default会在bootcard函数一开始就调用。不用担心定时器1会和别的驱动冲突。只调用calc_delay一次，不要再调用，就绝对不会冲突。

闲话少说，看pmc.c的全部代码：

/*<br /> * Atmel AT91sam9260 PMC functions<br /> *<br /> * Bacon xu<br /> */<br /> #include <rtems.h><br /> #include <bsp.h><br /> #include <at91sam9260.h><br /> uint32_t at91sam9260_get_mainclk(void)<br /> {<br /> return (BSP_MAIN_FREQ);<br /> }<br /> uint32_t at91sam9260_get_slck(void)<br /> {<br /> return (BSP_SLCK_FREQ);<br /> }<br /> uint32_t at91sam9260_get_cpuclk(void)<br /> {<br /> uint32_t mckr_css;<br /> uint32_t pll_mult;<br /> uint32_t pll_div;<br /> uint32_t pclk_div;<br /> uint32_t cpu_freq;</p> <p> mckr_css = (AT91C_BASE_PMC->PMC_MCKR) & AT91C_PMC_CSS;<br /> if (mckr_css == AT91C_PMC_CSS_SLOW_CLK) {<br /> return (BSP_SLCK_FREQ);<br /> }<br /> if (mckr_css == AT91C_PMC_CSS_MAIN_CLK) {<br /> return (BSP_MAIN_FREQ);<br /> }<br /> if (mckr_css == AT91C_PMC_CSS_PLLA_CLK) {<br /> pll_mult = ((AT91C_BASE_PMC->PMC_PLLAR & AT91C_CKGR_MULA) >> 16);<br /> pll_div = (AT91C_BASE_PMC->PMC_PLLAR & AT91C_CKGR_DIVA) >> 0;<br /> } else {<br /> pll_mult = ((AT91C_BASE_PMC->PMC_PLLBR & AT91C_CKGR_MULB) >> 16);<br /> pll_div = (AT91C_BASE_PMC->PMC_PLLBR & AT91C_CKGR_DIVB) >> 0;<br /> }<br /> if (pll_div == 0) {<br /> return (BSP_MAIN_FREQ); /* If the PLL mult is 0, then the PLL is disabled */<br /> }<br /> /* Read the Master Clock divider */<br /> pclk_div = (AT91C_BASE_PMC->PMC_MCKR >> 2) & 0x07;<br /> pclk_div = 1 << pclk_div; /* Convert 0-7 into 1, 2, 4, 8, 16, 32, or 64 */<br /> if (pclk_div >= 128) { /* Divider pattern for 128 is reserved */<br /> return (BSP_MAIN_FREQ);<br /> }<br /> cpu_freq = ((BSP_MAIN_FREQ / pll_div) / pclk_div) * (pll_mult + 1);<br /> return (cpu_freq);<br /> }<br /> uint32_t at91sam9260_get_mck(void)<br /> {<br /> uint32_t mclk_div;<br /> uint32_t cpu_freq;</p> <p> cpu_freq = at91sam9260_get_cpuclk();<br /> mclk_div = (AT91C_BASE_PMC->PMC_MCKR >> 8) & 0x03; /* Read the Master Clock divider */<br /> mclk_div = 1 << mclk_div; /* Convert 0-3 into 1, 2, 4 */<br /> cpu_freq = cpu_freq / mclk_div;<br /> return (cpu_freq);<br /> }</p> <p>static unsigned int _gLoopsPerMicrosec = 0;<br /> #define TIMER_INT_VALUE 0xFFFFFFFFL<br /> #define INIT_DELAY_TIMES (1 << 10)<br /> static inline void __const_delay(unsigned int value)<br /> {<br /> for ( ; value > 0; value--)<br /> {<br /> __asm__ __volatile__ ("nop;/n");<br /> }<br /> }<br /> #define START_TIMER() /<br /> do {/<br /> AT91C_BASE_TC2->TC_CMR = AT91C_TC_CLKS_TIMER_DIV3_CLOCK | AT91C_TC_WAVE;/<br /> AT91C_BASE_TC2->TC_CCR = AT91C_TC_CLKDIS | AT91C_TC_SWTRG;/<br /> AT91C_BASE_TC2->TC_CCR = AT91C_TC_CLKEN | AT91C_TC_SWTRG;/<br /> } while (0)<br /> #define STOP_TIMER() /<br /> (AT91C_BASE_TC2->TC_CCR = AT91C_TC_CLKDIS)<br /> #define READ_TIMER(clock) /<br /> ((uint64_t) (32 * 1000000) * (AT91C_BASE_TC2->TC_CV) / clock)<br /> void calc_delay(void)<br /> {<br /> uint32_t time;<br /> uint32_t mck;<br /> mck = at91sam9260_get_mck();<br /> AT91C_BASE_PMC->PMC_PCER = 1 << AT91C_ID_TC2;<br /> START_TIMER();<br /> __const_delay(INIT_DELAY_TIMES);<br /> STOP_TIMER();<br /> time = READ_TIMER(mck);<br /> _gLoopsPerMicrosec = INIT_DELAY_TIMES / time;<br /> while (1)<br /> {<br /> START_TIMER();<br /> udelay(1000);<br /> STOP_TIMER();<br /> time = READ_TIMER(mck);<br /> if (time < 1000)<br /> {<br /> _gLoopsPerMicrosec++;<br /> }<br /> else<br /> break;<br /> }</p> <p> AT91C_BASE_PMC->PMC_PCDR = 1 << AT91C_ID_TC2;<br /> }<br /> void udelay(unsigned int usecs)<br /> {<br /> unsigned int loops = usecs * _gLoopsPerMicrosec;<br /> __const_delay(loops);<br /> }<br />

这里，杂项函数我们就搞定了。