static int sb1250_uart_ioctl(cfe_devctx_t *ctx,iocb_buffer_t *buffer) { sb1250_uart_t *softc = ctx->dev_softc; unsigned int *info = (unsigned int *) buffer->buf_ptr; switch ((int)buffer->buf_ioctlcmd) { case IOCTL_SERIAL_GETSPEED: *info = softc->uart_speed; break; case IOCTL_SERIAL_SETSPEED: softc->uart_speed = *info; SBDUARTWRITE(softc,uart_clk_sel, V_DUART_BAUD_RATE(softc->uart_speed)); break; case IOCTL_SERIAL_GETFLOW: *info = softc->uart_flowcontrol; break; case IOCTL_SERIAL_SETFLOW: softc->uart_flowcontrol = *info; sb1250_uart_setflow(softc); break; default: return -1; } return 0; }
static int ser_console_setup(struct console *cons, char *str) { int i; for (i=0; i<DUART_MAX_LINE; i++) { uart_state_t *port = uart_states + i; if (!sb1250_duart_present[i]) continue; init_duart_port(port, i); #if SIBYTE_1956_WAR last_mode1[i] = V_DUART_PARITY_MODE_NONE|V_DUART_BITS_PER_CHAR_8; #endif WRITE_SERCSR(V_DUART_PARITY_MODE_NONE|V_DUART_BITS_PER_CHAR_8, port->mode_1, i); WRITE_SERCSR(M_DUART_STOP_BIT_LEN_1, port->mode_2, i); WRITE_SERCSR(V_DUART_BAUD_RATE(115200), port->clk_sel, i); WRITE_SERCSR(M_DUART_RX_EN|M_DUART_TX_EN, port->cmd, i); } return 0; }
static int sb1250_uart_open(cfe_devctx_t *ctx) { sb1250_uart_t *softc = ctx->dev_softc; SBDUARTWRITE(softc,uart_mode_reg_1,V_DUART_BITS_PER_CHAR_8 | V_DUART_PARITY_MODE_NONE); SBDUARTWRITE(softc,uart_mode_reg_2,M_DUART_STOP_BIT_LEN_1); SBDUARTWRITE(softc,uart_clk_sel, V_DUART_BAUD_RATE(CFG_SERIAL_BAUD_RATE)); SBDUARTWRITE(softc,uart_imr, 0); /* DISABLE all interrupts */ SBDUARTWRITE(softc,uart_cmd, M_DUART_RX_EN | M_DUART_TX_EN); if (softc->uart_channel == 0) { SBDUARTWRITE(softc,uart_oprset, M_DUART_SET_OPR0 | M_DUART_SET_OPR2); /* CTS and DTR */ } else { SBDUARTWRITE(softc,uart_oprset, M_DUART_SET_OPR1 | M_DUART_SET_OPR3); /* CTS and DTR */ } sb1250_uart_setflow(softc); return 0; }
static void sbd_set_termios(struct uart_port *uport, struct ktermios *termios, struct ktermios *old_termios) { struct sbd_port *sport = to_sport(uport); unsigned int mode1 = 0, mode2 = 0, aux = 0; unsigned int mode1mask = 0, mode2mask = 0, auxmask = 0; unsigned int oldmode1, oldmode2, oldaux; unsigned int baud, brg; unsigned int command; mode1mask |= ~(M_DUART_PARITY_MODE | M_DUART_PARITY_TYPE_ODD | M_DUART_BITS_PER_CHAR); mode2mask |= ~M_DUART_STOP_BIT_LEN_2; auxmask |= ~M_DUART_CTS_CHNG_ENA; /* Byte size. */ switch (termios->c_cflag & CSIZE) { case CS5: case CS6: /* Unsupported, leave unchanged. */ mode1mask |= M_DUART_PARITY_MODE; break; case CS7: mode1 |= V_DUART_BITS_PER_CHAR_7; break; case CS8: default: mode1 |= V_DUART_BITS_PER_CHAR_8; break; } /* Parity and stop bits. */ if (termios->c_cflag & CSTOPB) mode2 |= M_DUART_STOP_BIT_LEN_2; else mode2 |= M_DUART_STOP_BIT_LEN_1; if (termios->c_cflag & PARENB) mode1 |= V_DUART_PARITY_MODE_ADD; else mode1 |= V_DUART_PARITY_MODE_NONE; if (termios->c_cflag & PARODD) mode1 |= M_DUART_PARITY_TYPE_ODD; else mode1 |= M_DUART_PARITY_TYPE_EVEN; baud = uart_get_baud_rate(uport, termios, old_termios, 1200, 5000000); brg = V_DUART_BAUD_RATE(baud); /* The actual lower bound is 1221bps, so compensate. */ if (brg > M_DUART_CLK_COUNTER) brg = M_DUART_CLK_COUNTER; uart_update_timeout(uport, termios->c_cflag, baud); uport->read_status_mask = M_DUART_OVRUN_ERR; if (termios->c_iflag & INPCK) uport->read_status_mask |= M_DUART_FRM_ERR | M_DUART_PARITY_ERR; if (termios->c_iflag & (BRKINT | PARMRK)) uport->read_status_mask |= M_DUART_RCVD_BRK; uport->ignore_status_mask = 0; if (termios->c_iflag & IGNPAR) uport->ignore_status_mask |= M_DUART_FRM_ERR | M_DUART_PARITY_ERR; if (termios->c_iflag & IGNBRK) { uport->ignore_status_mask |= M_DUART_RCVD_BRK; if (termios->c_iflag & IGNPAR) uport->ignore_status_mask |= M_DUART_OVRUN_ERR; } if (termios->c_cflag & CREAD) command = M_DUART_RX_EN; else command = M_DUART_RX_DIS; if (termios->c_cflag & CRTSCTS) aux |= M_DUART_CTS_CHNG_ENA; else aux &= ~M_DUART_CTS_CHNG_ENA; spin_lock(&uport->lock); if (sport->tx_stopped) command |= M_DUART_TX_DIS; else command |= M_DUART_TX_EN; oldmode1 = read_sbdchn(sport, R_DUART_MODE_REG_1) & mode1mask; oldmode2 = read_sbdchn(sport, R_DUART_MODE_REG_2) & mode2mask; oldaux = read_sbdchn(sport, R_DUART_AUXCTL_X) & auxmask; if (!sport->tx_stopped) sbd_line_drain(sport); write_sbdchn(sport, R_DUART_CMD, M_DUART_TX_DIS | M_DUART_RX_DIS); write_sbdchn(sport, R_DUART_MODE_REG_1, mode1 | oldmode1); write_sbdchn(sport, R_DUART_MODE_REG_2, mode2 | oldmode2); write_sbdchn(sport, R_DUART_CLK_SEL, brg); write_sbdchn(sport, R_DUART_AUXCTL_X, aux | oldaux); write_sbdchn(sport, R_DUART_CMD, command); spin_unlock(&uport->lock); }