提交 b57d15fe 编写于 作者: R Ricardo Ribalda Delgado 提交者: Greg Kroah-Hartman

serial/sc16is7xx: Use the rs485 functions on serial_core

In order to unify all the rs485 ioctl handling.
Use the implementation of TIOC[GS]RS485 ioctl handling on serial_core.
Reviewed-by: NAlan Cox <alan@linux.intel.com>
Cc: Jiri Slaby <jslaby@suse.cz>
Signed-off-by: NRicardo Ribalda Delgado <ricardo.ribalda@gmail.com>
Signed-off-by: NGreg Kroah-Hartman <gregkh@linuxfoundation.org>
上级 039ec1f0
...@@ -304,8 +304,6 @@ struct sc16is7xx_one { ...@@ -304,8 +304,6 @@ struct sc16is7xx_one {
struct uart_port port; struct uart_port port;
struct work_struct tx_work; struct work_struct tx_work;
struct work_struct md_work; struct work_struct md_work;
struct serial_rs485 rs485;
}; };
struct sc16is7xx_port { struct sc16is7xx_port {
...@@ -657,15 +655,15 @@ static void sc16is7xx_stop_tx(struct uart_port* port) ...@@ -657,15 +655,15 @@ static void sc16is7xx_stop_tx(struct uart_port* port)
struct circ_buf *xmit = &one->port.state->xmit; struct circ_buf *xmit = &one->port.state->xmit;
/* handle rs485 */ /* handle rs485 */
if (one->rs485.flags & SER_RS485_ENABLED) { if (port->rs485.flags & SER_RS485_ENABLED) {
/* do nothing if current tx not yet completed */ /* do nothing if current tx not yet completed */
int lsr = sc16is7xx_port_read(port, SC16IS7XX_LSR_REG); int lsr = sc16is7xx_port_read(port, SC16IS7XX_LSR_REG);
if (!(lsr & SC16IS7XX_LSR_TEMT_BIT)) if (!(lsr & SC16IS7XX_LSR_TEMT_BIT))
return; return;
if (uart_circ_empty(xmit) && if (uart_circ_empty(xmit) &&
(one->rs485.delay_rts_after_send > 0)) (port->rs485.delay_rts_after_send > 0))
mdelay(one->rs485.delay_rts_after_send); mdelay(port->rs485.delay_rts_after_send);
} }
sc16is7xx_port_update(port, SC16IS7XX_IER_REG, sc16is7xx_port_update(port, SC16IS7XX_IER_REG,
...@@ -688,9 +686,9 @@ static void sc16is7xx_start_tx(struct uart_port *port) ...@@ -688,9 +686,9 @@ static void sc16is7xx_start_tx(struct uart_port *port)
struct sc16is7xx_one *one = to_sc16is7xx_one(port, port); struct sc16is7xx_one *one = to_sc16is7xx_one(port, port);
/* handle rs485 */ /* handle rs485 */
if ((one->rs485.flags & SER_RS485_ENABLED) && if ((port->rs485.flags & SER_RS485_ENABLED) &&
(one->rs485.delay_rts_before_send > 0)) { (port->rs485.delay_rts_before_send > 0)) {
mdelay(one->rs485.delay_rts_before_send); mdelay(port->rs485.delay_rts_before_send);
} }
if (!work_pending(&one->tx_work)) if (!work_pending(&one->tx_work))
...@@ -830,47 +828,20 @@ static void sc16is7xx_set_termios(struct uart_port *port, ...@@ -830,47 +828,20 @@ static void sc16is7xx_set_termios(struct uart_port *port,
uart_update_timeout(port, termios->c_cflag, baud); 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 serial_rs485 *rs485)
{ {
struct sc16is7xx_one *one = to_sc16is7xx_one(port, port); if (port->rs485.flags & SER_RS485_ENABLED)
one->rs485 = *rs485;
if (one->rs485.flags & SER_RS485_ENABLED) {
sc16is7xx_port_update(port, SC16IS7XX_EFCR_REG, sc16is7xx_port_update(port, SC16IS7XX_EFCR_REG,
SC16IS7XX_EFCR_AUTO_RS485_BIT, SC16IS7XX_EFCR_AUTO_RS485_BIT,
SC16IS7XX_EFCR_AUTO_RS485_BIT); SC16IS7XX_EFCR_AUTO_RS485_BIT);
} else { else
sc16is7xx_port_update(port, SC16IS7XX_EFCR_REG, sc16is7xx_port_update(port, SC16IS7XX_EFCR_REG,
SC16IS7XX_EFCR_AUTO_RS485_BIT, SC16IS7XX_EFCR_AUTO_RS485_BIT,
0); 0);
} port->rs485 = *rs485;
}
static int sc16is7xx_ioctl(struct uart_port *port, unsigned int cmd,
unsigned long arg)
{
struct serial_rs485 rs485;
switch (cmd) { return 0;
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;
} }
static int sc16is7xx_startup(struct uart_port *port) static int sc16is7xx_startup(struct uart_port *port)
...@@ -996,7 +967,6 @@ static const struct uart_ops sc16is7xx_ops = { ...@@ -996,7 +967,6 @@ static const struct uart_ops sc16is7xx_ops = {
.release_port = sc16is7xx_null_void, .release_port = sc16is7xx_null_void,
.config_port = sc16is7xx_config_port, .config_port = sc16is7xx_config_port,
.verify_port = sc16is7xx_verify_port, .verify_port = sc16is7xx_verify_port,
.ioctl = sc16is7xx_ioctl,
.pm = sc16is7xx_pm, .pm = sc16is7xx_pm,
}; };
...@@ -1126,6 +1096,7 @@ static int sc16is7xx_probe(struct device *dev, ...@@ -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.flags = UPF_FIXED_TYPE | UPF_LOW_LATENCY;
s->p[i].port.iotype = UPIO_PORT; s->p[i].port.iotype = UPIO_PORT;
s->p[i].port.uartclk = freq; s->p[i].port.uartclk = freq;
s->p[i].port.rs485_config = sc16is7xx_config_rs485;
s->p[i].port.ops = &sc16is7xx_ops; s->p[i].port.ops = &sc16is7xx_ops;
/* Disable all interrupts */ /* Disable all interrupts */
sc16is7xx_port_write(&s->p[i].port, SC16IS7XX_IER_REG, 0); sc16is7xx_port_write(&s->p[i].port, SC16IS7XX_IER_REG, 0);
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册