diff options
| author | ian <ian@FreeBSD.org> | 2013-12-13 18:21:27 +0000 |
|---|---|---|
| committer | ian <ian@FreeBSD.org> | 2013-12-13 18:21:27 +0000 |
| commit | 3270502674e0cfc32dca7e8fea47926e7d7570ca (patch) | |
| tree | 67b40af089493acae1169681b1fd9174bb5c31ef /sys/dev/uart | |
| parent | 66e5b415b9b5937b923ea97cffa10ba712279015 (diff) | |
| download | FreeBSD-src-3270502674e0cfc32dca7e8fea47926e7d7570ca.zip FreeBSD-src-3270502674e0cfc32dca7e8fea47926e7d7570ca.tar.gz | |
MFC r256815:
Calculate the baud rate divisor rather than using a hard-coded value.
Diffstat (limited to 'sys/dev/uart')
| -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) & |
