|
@@ -304,8 +304,6 @@ struct sc16is7xx_one {
|
|
|
struct uart_port port;
|
|
|
struct work_struct tx_work;
|
|
|
struct work_struct md_work;
|
|
|
-
|
|
|
- struct serial_rs485 rs485;
|
|
|
};
|
|
|
|
|
|
struct sc16is7xx_port {
|
|
@@ -657,15 +655,15 @@ static void sc16is7xx_stop_tx(struct uart_port* port)
|
|
|
struct circ_buf *xmit = &one->port.state->xmit;
|
|
|
|
|
|
/* handle rs485 */
|
|
|
- if (one->rs485.flags & SER_RS485_ENABLED) {
|
|
|
+ if (port->rs485.flags & SER_RS485_ENABLED) {
|
|
|
/* do nothing if current tx not yet completed */
|
|
|
int lsr = sc16is7xx_port_read(port, SC16IS7XX_LSR_REG);
|
|
|
if (!(lsr & SC16IS7XX_LSR_TEMT_BIT))
|
|
|
return;
|
|
|
|
|
|
if (uart_circ_empty(xmit) &&
|
|
|
- (one->rs485.delay_rts_after_send > 0))
|
|
|
- mdelay(one->rs485.delay_rts_after_send);
|
|
|
+ (port->rs485.delay_rts_after_send > 0))
|
|
|
+ mdelay(port->rs485.delay_rts_after_send);
|
|
|
}
|
|
|
|
|
|
sc16is7xx_port_update(port, SC16IS7XX_IER_REG,
|
|
@@ -688,9 +686,9 @@ static void sc16is7xx_start_tx(struct uart_port *port)
|
|
|
struct sc16is7xx_one *one = to_sc16is7xx_one(port, port);
|
|
|
|
|
|
/* handle rs485 */
|
|
|
- if ((one->rs485.flags & SER_RS485_ENABLED) &&
|
|
|
- (one->rs485.delay_rts_before_send > 0)) {
|
|
|
- mdelay(one->rs485.delay_rts_before_send);
|
|
|
+ if ((port->rs485.flags & SER_RS485_ENABLED) &&
|
|
|
+ (port->rs485.delay_rts_before_send > 0)) {
|
|
|
+ mdelay(port->rs485.delay_rts_before_send);
|
|
|
}
|
|
|
|
|
|
if (!work_pending(&one->tx_work))
|
|
@@ -830,47 +828,20 @@ static void sc16is7xx_set_termios(struct uart_port *port,
|
|
|
uart_update_timeout(port, termios->c_cflag, baud);
|
|
|
}
|
|
|
|
|
|
-static void sc16is7xx_config_rs485(struct uart_port *port,
|
|
|
+static int sc16is7xx_config_rs485(struct uart_port *port,
|
|
|
struct serial_rs485 *rs485)
|
|
|
{
|
|
|
- struct sc16is7xx_one *one = to_sc16is7xx_one(port, port);
|
|
|
-
|
|
|
- one->rs485 = *rs485;
|
|
|
-
|
|
|
- if (one->rs485.flags & SER_RS485_ENABLED) {
|
|
|
+ if (port->rs485.flags & SER_RS485_ENABLED)
|
|
|
sc16is7xx_port_update(port, SC16IS7XX_EFCR_REG,
|
|
|
SC16IS7XX_EFCR_AUTO_RS485_BIT,
|
|
|
SC16IS7XX_EFCR_AUTO_RS485_BIT);
|
|
|
- } else {
|
|
|
+ else
|
|
|
sc16is7xx_port_update(port, SC16IS7XX_EFCR_REG,
|
|
|
SC16IS7XX_EFCR_AUTO_RS485_BIT,
|
|
|
0);
|
|
|
- }
|
|
|
-}
|
|
|
-
|
|
|
-static int sc16is7xx_ioctl(struct uart_port *port, unsigned int cmd,
|
|
|
- unsigned long arg)
|
|
|
-{
|
|
|
- struct serial_rs485 rs485;
|
|
|
+ port->rs485 = *rs485;
|
|
|
|
|
|
- switch (cmd) {
|
|
|
- case TIOCSRS485:
|
|
|
- if (copy_from_user(&rs485, (void __user *)arg, sizeof(rs485)))
|
|
|
- return -EFAULT;
|
|
|
-
|
|
|
- sc16is7xx_config_rs485(port, &rs485);
|
|
|
- return 0;
|
|
|
- case TIOCGRS485:
|
|
|
- if (copy_to_user((void __user *)arg,
|
|
|
- &(to_sc16is7xx_one(port, port)->rs485),
|
|
|
- sizeof(rs485)))
|
|
|
- return -EFAULT;
|
|
|
- return 0;
|
|
|
- default:
|
|
|
- break;
|
|
|
- }
|
|
|
-
|
|
|
- return -ENOIOCTLCMD;
|
|
|
+ return 0;
|
|
|
}
|
|
|
|
|
|
static int sc16is7xx_startup(struct uart_port *port)
|
|
@@ -996,7 +967,6 @@ static const struct uart_ops sc16is7xx_ops = {
|
|
|
.release_port = sc16is7xx_null_void,
|
|
|
.config_port = sc16is7xx_config_port,
|
|
|
.verify_port = sc16is7xx_verify_port,
|
|
|
- .ioctl = sc16is7xx_ioctl,
|
|
|
.pm = sc16is7xx_pm,
|
|
|
};
|
|
|
|
|
@@ -1126,6 +1096,7 @@ static int sc16is7xx_probe(struct device *dev,
|
|
|
s->p[i].port.flags = UPF_FIXED_TYPE | UPF_LOW_LATENCY;
|
|
|
s->p[i].port.iotype = UPIO_PORT;
|
|
|
s->p[i].port.uartclk = freq;
|
|
|
+ s->p[i].port.rs485_config = sc16is7xx_config_rs485;
|
|
|
s->p[i].port.ops = &sc16is7xx_ops;
|
|
|
/* Disable all interrupts */
|
|
|
sc16is7xx_port_write(&s->p[i].port, SC16IS7XX_IER_REG, 0);
|