Commit 92a5f11a authored by Ricardo Ribalda Delgado's avatar Ricardo Ribalda Delgado Committed by Greg Kroah-Hartman

serial/8250_fintek: Use private data structure

Save the port index and the line id in a private structure.
Reported-by: default avatarPeter Hong <peter_hong@fintek.com.tw>
Reviewed-by: default avatarAlan Cox <alan@linux.intel.com>
Signed-off-by: default avatarRicardo Ribalda Delgado <ricardo.ribalda@gmail.com>
Signed-off-by: default avatarGreg Kroah-Hartman <gregkh@linuxfoundation.org>
parent 75406b3b
...@@ -39,6 +39,11 @@ ...@@ -39,6 +39,11 @@
#define DRIVER_NAME "8250_fintek" #define DRIVER_NAME "8250_fintek"
struct fintek_8250 {
u8 index;
long line;
};
static int fintek_8250_enter_key(void){ static int fintek_8250_enter_key(void){
if (!request_muxed_region(ADDR_PORT, 2, DRIVER_NAME)) if (!request_muxed_region(ADDR_PORT, 2, DRIVER_NAME))
...@@ -93,9 +98,9 @@ static int fintek_8250_rs485_config(struct uart_port *port, ...@@ -93,9 +98,9 @@ static int fintek_8250_rs485_config(struct uart_port *port,
struct serial_rs485 *rs485) struct serial_rs485 *rs485)
{ {
uint8_t config = 0; uint8_t config = 0;
int index = fintek_8250_get_index(port->iobase); struct fintek_8250 *pdata = port->private_data;
if (index < 0) if (!pdata)
return -EINVAL; return -EINVAL;
if (rs485->flags & SER_RS485_ENABLED) if (rs485->flags & SER_RS485_ENABLED)
...@@ -129,7 +134,7 @@ static int fintek_8250_rs485_config(struct uart_port *port, ...@@ -129,7 +134,7 @@ static int fintek_8250_rs485_config(struct uart_port *port,
return -EBUSY; return -EBUSY;
outb(LDN, ADDR_PORT); outb(LDN, ADDR_PORT);
outb(index, DATA_PORT); outb(pdata->index, DATA_PORT);
outb(RS485, ADDR_PORT); outb(RS485, ADDR_PORT);
outb(config, DATA_PORT); outb(config, DATA_PORT);
fintek_8250_exit_key(); fintek_8250_exit_key();
...@@ -142,14 +147,16 @@ static int fintek_8250_rs485_config(struct uart_port *port, ...@@ -142,14 +147,16 @@ static int fintek_8250_rs485_config(struct uart_port *port,
static int static int
fintek_8250_probe(struct pnp_dev *dev, const struct pnp_device_id *dev_id) fintek_8250_probe(struct pnp_dev *dev, const struct pnp_device_id *dev_id)
{ {
int line;
struct uart_8250_port uart; struct uart_8250_port uart;
struct fintek_8250 *pdata;
int ret; int ret;
int index;
if (!pnp_port_valid(dev, 0)) if (!pnp_port_valid(dev, 0))
return -ENODEV; return -ENODEV;
if (fintek_8250_get_index(pnp_port_start(dev, 0)) < 0) index = fintek_8250_get_index(pnp_port_start(dev, 0));
if (index < 0)
return -ENODEV; return -ENODEV;
/* Enable configuration registers*/ /* Enable configuration registers*/
...@@ -163,6 +170,12 @@ fintek_8250_probe(struct pnp_dev *dev, const struct pnp_device_id *dev_id) ...@@ -163,6 +170,12 @@ fintek_8250_probe(struct pnp_dev *dev, const struct pnp_device_id *dev_id)
return ret; return ret;
memset(&uart, 0, sizeof(uart)); memset(&uart, 0, sizeof(uart));
pdata = devm_kzalloc(&dev->dev, sizeof(*pdata), GFP_KERNEL);
if (!pdata)
return -ENOMEM;
uart.port.private_data = pdata;
if (!pnp_irq_valid(dev, 0)) if (!pnp_irq_valid(dev, 0))
return -ENODEV; return -ENODEV;
uart.port.irq = pnp_irq(dev, 0); uart.port.irq = pnp_irq(dev, 0);
...@@ -176,40 +189,41 @@ fintek_8250_probe(struct pnp_dev *dev, const struct pnp_device_id *dev_id) ...@@ -176,40 +189,41 @@ fintek_8250_probe(struct pnp_dev *dev, const struct pnp_device_id *dev_id)
uart.port.uartclk = 1843200; uart.port.uartclk = 1843200;
uart.port.dev = &dev->dev; uart.port.dev = &dev->dev;
line = serial8250_register_8250_port(&uart); pdata->index = index;
if (line < 0) pdata->line = serial8250_register_8250_port(&uart);
if (pdata->line < 0)
return -ENODEV; return -ENODEV;
pnp_set_drvdata(dev, (void *)((long)line + 1)); pnp_set_drvdata(dev, pdata);
return 0; return 0;
} }
static void fintek_8250_remove(struct pnp_dev *dev) static void fintek_8250_remove(struct pnp_dev *dev)
{ {
long line = (long)pnp_get_drvdata(dev); struct fintek_8250 *pdata = pnp_get_drvdata(dev);
if (line) if (pdata)
serial8250_unregister_port(line - 1); serial8250_unregister_port(pdata->line);
} }
#ifdef CONFIG_PM #ifdef CONFIG_PM
static int fintek_8250_suspend(struct pnp_dev *dev, pm_message_t state) static int fintek_8250_suspend(struct pnp_dev *dev, pm_message_t state)
{ {
long line = (long)pnp_get_drvdata(dev); struct fintek_8250 *pdata = pnp_get_drvdata(dev);
if (!line) if (!pdata)
return -ENODEV; return -ENODEV;
serial8250_suspend_port(line - 1); serial8250_suspend_port(pdata->line);
return 0; return 0;
} }
static int fintek_8250_resume(struct pnp_dev *dev) static int fintek_8250_resume(struct pnp_dev *dev)
{ {
long line = (long)pnp_get_drvdata(dev); struct fintek_8250 *pdata = pnp_get_drvdata(dev);
if (!line) if (!pdata)
return -ENODEV; return -ENODEV;
serial8250_resume_port(line - 1); serial8250_resume_port(pdata->line);
return 0; return 0;
} }
#else #else
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment