diff options
Diffstat (limited to 'drivers/serial/pmac_zilog.c')
-rw-r--r-- | drivers/serial/pmac_zilog.c | 23 |
1 files changed, 11 insertions, 12 deletions
diff --git a/drivers/serial/pmac_zilog.c b/drivers/serial/pmac_zilog.c index 9b7ed58cb53b..513ff8597707 100644 --- a/drivers/serial/pmac_zilog.c +++ b/drivers/serial/pmac_zilog.c | |||
@@ -1916,6 +1916,16 @@ static void __exit exit_pmz(void) | |||
1916 | 1916 | ||
1917 | #ifdef CONFIG_SERIAL_PMACZILOG_CONSOLE | 1917 | #ifdef CONFIG_SERIAL_PMACZILOG_CONSOLE |
1918 | 1918 | ||
1919 | static void pmz_console_putchar(struct uart_port *port, int ch) | ||
1920 | { | ||
1921 | struct uart_pmac_port *uap = (struct uart_pmac_port *)port; | ||
1922 | |||
1923 | /* Wait for the transmit buffer to empty. */ | ||
1924 | while ((read_zsreg(uap, R0) & Tx_BUF_EMP) == 0) | ||
1925 | udelay(5); | ||
1926 | write_zsdata(uap, ch); | ||
1927 | } | ||
1928 | |||
1919 | /* | 1929 | /* |
1920 | * Print a string to the serial port trying not to disturb | 1930 | * Print a string to the serial port trying not to disturb |
1921 | * any possible real use of the port... | 1931 | * any possible real use of the port... |
@@ -1924,7 +1934,6 @@ static void pmz_console_write(struct console *con, const char *s, unsigned int c | |||
1924 | { | 1934 | { |
1925 | struct uart_pmac_port *uap = &pmz_ports[con->index]; | 1935 | struct uart_pmac_port *uap = &pmz_ports[con->index]; |
1926 | unsigned long flags; | 1936 | unsigned long flags; |
1927 | int i; | ||
1928 | 1937 | ||
1929 | if (ZS_IS_ASLEEP(uap)) | 1938 | if (ZS_IS_ASLEEP(uap)) |
1930 | return; | 1939 | return; |
@@ -1934,17 +1943,7 @@ static void pmz_console_write(struct console *con, const char *s, unsigned int c | |||
1934 | write_zsreg(uap, R1, uap->curregs[1] & ~TxINT_ENAB); | 1943 | write_zsreg(uap, R1, uap->curregs[1] & ~TxINT_ENAB); |
1935 | write_zsreg(uap, R5, uap->curregs[5] | TxENABLE | RTS | DTR); | 1944 | write_zsreg(uap, R5, uap->curregs[5] | TxENABLE | RTS | DTR); |
1936 | 1945 | ||
1937 | for (i = 0; i < count; i++) { | 1946 | uart_console_write(&uap->port, s, count, pmz_console_putchar); |
1938 | /* Wait for the transmit buffer to empty. */ | ||
1939 | while ((read_zsreg(uap, R0) & Tx_BUF_EMP) == 0) | ||
1940 | udelay(5); | ||
1941 | write_zsdata(uap, s[i]); | ||
1942 | if (s[i] == 10) { | ||
1943 | while ((read_zsreg(uap, R0) & Tx_BUF_EMP) == 0) | ||
1944 | udelay(5); | ||
1945 | write_zsdata(uap, R13); | ||
1946 | } | ||
1947 | } | ||
1948 | 1947 | ||
1949 | /* Restore the values in the registers. */ | 1948 | /* Restore the values in the registers. */ |
1950 | write_zsreg(uap, R1, uap->curregs[1]); | 1949 | write_zsreg(uap, R1, uap->curregs[1]); |