|
@@ -70,9 +70,21 @@ void serial_setbrg (void)
|
|
|
{
|
|
|
volatile u32 *uart_clk = (volatile u32*)(UART0_ADDR+UART_CLK);
|
|
|
volatile u32 *uart_lcr = (volatile u32*)(UART0_ADDR+UART_LCR);
|
|
|
+ volatile u32 *sys_powerctrl = (u32 *)SYS_POWERCTRL;
|
|
|
+ int sd;
|
|
|
+ int divisorx2;
|
|
|
|
|
|
- /* Set baudrate - FIXME for bus speeds != CPU/2 */
|
|
|
- *uart_clk = ((CFG_HZ/(CONFIG_BAUDRATE * 64)));
|
|
|
+ /* sd is system clock divisor */
|
|
|
+ /* see section 10.4.5 in au1550 datasheet */
|
|
|
+ sd = (*sys_powerctrl & 0x03) + 2;
|
|
|
+
|
|
|
+ /* calulate 2x baudrate and round */
|
|
|
+ divisorx2 = ((CFG_HZ/(sd * 16 * CONFIG_BAUDRATE)));
|
|
|
+
|
|
|
+ if (divisorx2 & 0x01)
|
|
|
+ divisorx2 = divisorx2 + 1;
|
|
|
+
|
|
|
+ *uart_clk = divisorx2 / 2;
|
|
|
|
|
|
/* Set parity, stop bits and word length to 8N1 */
|
|
|
*uart_lcr = UART_LCR_WLEN8;
|