diff options
author | ian <ian@FreeBSD.org> | 2013-10-20 23:40:16 +0000 |
---|---|---|
committer | ian <ian@FreeBSD.org> | 2013-10-20 23:40:16 +0000 |
commit | 3bf0291c8b47df26ae764781ec6c3c0f9adf74ab (patch) | |
tree | 1cf0a76610de38ac6a680600a988ec85388bcd2b | |
parent | 2f3164c5bb2ebe183649644371c36f821afd6611 (diff) | |
download | FreeBSD-src-3bf0291c8b47df26ae764781ec6c3c0f9adf74ab.zip FreeBSD-src-3bf0291c8b47df26ae764781ec6c3c0f9adf74ab.tar.gz |
Calculate the baud rate divisor rather than using a hard-coded value.
Submitted by: Steven Lawrance <stl@koffein.net>
-rw-r--r-- | sys/dev/uart/uart_dev_pl011.c | 10 |
1 files changed, 5 insertions, 5 deletions
diff --git a/sys/dev/uart/uart_dev_pl011.c b/sys/dev/uart/uart_dev_pl011.c index 583dedf..82e8b03 100644 --- a/sys/dev/uart/uart_dev_pl011.c +++ b/sys/dev/uart/uart_dev_pl011.c @@ -147,9 +147,6 @@ uart_pl011_param(struct uart_bas *bas, int baudrate, int databits, int stopbits, break; } - /* TODO: Calculate divisors */ - baud = (0x1 << 16) | 0x28; - if (stopbits == 2) line |= LCR_H_STP2; else @@ -164,8 +161,11 @@ uart_pl011_param(struct uart_bas *bas, int baudrate, int databits, int stopbits, line &= ~LCR_H_FEN; ctrl |= (CR_RXE | CR_TXE | CR_UARTEN); - __uart_setreg(bas, UART_IBRD, ((uint32_t)(baud >> 16)) & IBRD_BDIVINT); - __uart_setreg(bas, UART_FBRD, (uint32_t)(baud) & FBRD_BDIVFRAC); + if (bas->rclk != 0 && baudrate != 0) { + baud = bas->rclk * 4 / baudrate; + __uart_setreg(bas, UART_IBRD, ((uint32_t)(baud >> 6)) & IBRD_BDIVINT); + __uart_setreg(bas, UART_FBRD, (uint32_t)(baud & 0x3F) & FBRD_BDIVFRAC); + } /* Add config. to line before reenabling UART */ __uart_setreg(bas, UART_LCR_H, (__uart_getreg(bas, UART_LCR_H) & |