hamradio: baycom: use new parport device model
authorSudip Mukherjee <sudipm.mukherjee@gmail.com>
Sun, 17 Sep 2017 11:46:20 +0000 (12:46 +0100)
committerDavid S. Miller <davem@davemloft.net>
Mon, 18 Sep 2017 23:40:25 +0000 (16:40 -0700)
Modify baycom driver to use the new parallel port device model.

Signed-off-by: Sudip Mukherjee <sudipm.mukherjee@gmail.com>
Acked-By: Thomas Sailer <t.sailer@alumni.ethz.ch>
Signed-off-by: David S. Miller <davem@davemloft.net>
drivers/net/hamradio/baycom_epp.c

index 1503f10..1e62d00 100644 (file)
@@ -840,6 +840,7 @@ static int epp_open(struct net_device *dev)
        unsigned char tmp[128];
        unsigned char stat;
        unsigned long tstart;
+       struct pardev_cb par_cb;
        
         if (!pp) {
                 printk(KERN_ERR "%s: parport at 0x%lx unknown\n", bc_drvname, dev->base_addr);
@@ -859,8 +860,21 @@ static int epp_open(struct net_device *dev)
                 return -EIO;
        }
        memset(&bc->modem, 0, sizeof(bc->modem));
-        bc->pdev = parport_register_device(pp, dev->name, NULL, epp_wakeup, 
-                                          NULL, PARPORT_DEV_EXCL, dev);
+       memset(&par_cb, 0, sizeof(par_cb));
+       par_cb.wakeup = epp_wakeup;
+       par_cb.private = (void *)dev;
+       par_cb.flags = PARPORT_DEV_EXCL;
+       for (i = 0; i < NR_PORTS; i++)
+               if (baycom_device[i] == dev)
+                       break;
+
+       if (i == NR_PORTS) {
+               pr_err("%s: no device found\n", bc_drvname);
+               parport_put_port(pp);
+               return -ENODEV;
+       }
+
+       bc->pdev = parport_register_dev_model(pp, dev->name, &par_cb, i);
        parport_put_port(pp);
         if (!bc->pdev) {
                 printk(KERN_ERR "%s: cannot register parport at 0x%lx\n", bc_drvname, pp->base);
@@ -1185,6 +1199,23 @@ MODULE_LICENSE("GPL");
 
 /* --------------------------------------------------------------------- */
 
+static int baycom_epp_par_probe(struct pardevice *par_dev)
+{
+       struct device_driver *drv = par_dev->dev.driver;
+       int len = strlen(drv->name);
+
+       if (strncmp(par_dev->name, drv->name, len))
+               return -ENODEV;
+
+       return 0;
+}
+
+static struct parport_driver baycom_epp_par_driver = {
+       .name = "bce",
+       .probe = baycom_epp_par_probe,
+       .devmodel = true,
+};
+
 static void __init baycom_epp_dev_setup(struct net_device *dev)
 {
        struct baycom_state *bc = netdev_priv(dev);
@@ -1204,10 +1235,15 @@ static void __init baycom_epp_dev_setup(struct net_device *dev)
 
 static int __init init_baycomepp(void)
 {
-       int i, found = 0;
+       int i, found = 0, ret;
        char set_hw = 1;
 
        printk(bc_drvinfo);
+
+       ret = parport_register_driver(&baycom_epp_par_driver);
+       if (ret)
+               return ret;
+
        /*
         * register net devices
         */
@@ -1241,7 +1277,12 @@ static int __init init_baycomepp(void)
                found++;
        }
 
-       return found ? 0 : -ENXIO;
+       if (found == 0) {
+               parport_unregister_driver(&baycom_epp_par_driver);
+               return -ENXIO;
+       }
+
+       return 0;
 }
 
 static void __exit cleanup_baycomepp(void)
@@ -1260,6 +1301,7 @@ static void __exit cleanup_baycomepp(void)
                                printk(paranoia_str, "cleanup_module");
                }
        }
+       parport_unregister_driver(&baycom_epp_par_driver);
 }
 
 module_init(init_baycomepp);