serial/8250_fintek: Use private data structure
authorRicardo Ribalda Delgado <ricardo.ribalda@gmail.com>
Tue, 16 Jun 2015 08:59:36 +0000 (10:59 +0200)
committerGreg Kroah-Hartman <gregkh@linuxfoundation.org>
Thu, 23 Jul 2015 22:14:42 +0000 (15:14 -0700)
Save the port index and the line id in a private structure.

Reported-by: Peter Hong <peter_hong@fintek.com.tw>
Reviewed-by: Alan Cox <alan@linux.intel.com>
Signed-off-by: Ricardo Ribalda Delgado <ricardo.ribalda@gmail.com>
Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
drivers/tty/serial/8250/8250_fintek.c

index 5815e81b5fc603cdad8463bcdd5cfe0880186376..76d739bb5d1fdb89a09559760a33ed35c8669e06 100644 (file)
 
 #define DRIVER_NAME "8250_fintek"
 
+struct fintek_8250 {
+       u8 index;
+       long line;
+};
+
 static int fintek_8250_enter_key(void){
 
        if (!request_muxed_region(ADDR_PORT, 2, DRIVER_NAME))
@@ -93,9 +98,9 @@ static int fintek_8250_rs485_config(struct uart_port *port,
                              struct serial_rs485 *rs485)
 {
        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;
 
        if (rs485->flags & SER_RS485_ENABLED)
@@ -129,7 +134,7 @@ static int fintek_8250_rs485_config(struct uart_port *port,
                return -EBUSY;
 
        outb(LDN, ADDR_PORT);
-       outb(index, DATA_PORT);
+       outb(pdata->index, DATA_PORT);
        outb(RS485, ADDR_PORT);
        outb(config, DATA_PORT);
        fintek_8250_exit_key();
@@ -142,14 +147,16 @@ static int fintek_8250_rs485_config(struct uart_port *port,
 static int
 fintek_8250_probe(struct pnp_dev *dev, const struct pnp_device_id *dev_id)
 {
-       int line;
        struct uart_8250_port uart;
+       struct fintek_8250 *pdata;
        int ret;
+       int index;
 
        if (!pnp_port_valid(dev, 0))
                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;
 
        /* Enable configuration registers*/
@@ -163,6 +170,12 @@ fintek_8250_probe(struct pnp_dev *dev, const struct pnp_device_id *dev_id)
                return ret;
 
        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))
                return -ENODEV;
        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)
        uart.port.uartclk = 1843200;
        uart.port.dev = &dev->dev;
 
-       line = serial8250_register_8250_port(&uart);
-       if (line < 0)
+       pdata->index = index;
+       pdata->line = serial8250_register_8250_port(&uart);
+       if (pdata->line < 0)
                return -ENODEV;
 
-       pnp_set_drvdata(dev, (void *)((long)line + 1));
+       pnp_set_drvdata(dev, pdata);
        return 0;
 }
 
 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)
-               serial8250_unregister_port(line - 1);
+       if (pdata)
+               serial8250_unregister_port(pdata->line);
 }
 
 #ifdef CONFIG_PM
 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;
-       serial8250_suspend_port(line - 1);
+       serial8250_suspend_port(pdata->line);
        return 0;
 }
 
 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;
-       serial8250_resume_port(line - 1);
+       serial8250_resume_port(pdata->line);
        return 0;
 }
 #else