diff options
-rw-r--r-- | sys/dev/uart/uart_dev_z8530.c | 8 |
1 files changed, 7 insertions, 1 deletions
diff --git a/sys/dev/uart/uart_dev_z8530.c b/sys/dev/uart/uart_dev_z8530.c index bcde32f..49b152b 100644 --- a/sys/dev/uart/uart_dev_z8530.c +++ b/sys/dev/uart/uart_dev_z8530.c @@ -383,7 +383,7 @@ z8530_bus_ioctl(struct uart_softc *sc, int request, intptr_t data) { struct z8530_softc *z8530 = (struct z8530_softc*)sc; struct uart_bas *bas; - int error; + int baudrate, divisor, error; bas = &sc->sc_bas; error = 0; @@ -397,6 +397,12 @@ z8530_bus_ioctl(struct uart_softc *sc, int request, intptr_t data) uart_setmreg(bas, WR_TPC, z8530->tpc); uart_barrier(bas); break; + case UART_IOCTL_BAUD: + divisor = uart_getmreg(bas, RR_TCH); + divisor = (divisor << 8) | uart_getmreg(bas, RR_TCL); + baudrate = bas->rclk / 2 / (divisor + 2); + *(int*)data = baudrate; + break; default: error = EINVAL; break; |