diff options
author | Sudip Mukherjee <sudipm.mukherjee@gmail.com> | 2015-07-20 17:27:24 +0530 |
---|---|---|
committer | Greg Kroah-Hartman <gregkh@linuxfoundation.org> | 2015-08-05 13:36:49 -0700 |
commit | 4edd70c133f3921c594883d8f9da31a7261f8b4f (patch) | |
tree | 99461ce0e9d52b41aafcc41df8c31a3ea4294990 | |
parent | c9efdbe63410984668a4983cc46e31a7b3f0c74e (diff) | |
download | linux-stable-4edd70c133f3921c594883d8f9da31a7261f8b4f.tar.gz linux-stable-4edd70c133f3921c594883d8f9da31a7261f8b4f.tar.bz2 linux-stable-4edd70c133f3921c594883d8f9da31a7261f8b4f.zip |
auxdisplay: ks0108: use new parport device model
Modify auxdisplay driver to use the new parallel port device model.
Signed-off-by: Sudip Mukherjee <sudip@vectorindia.org>
Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
-rw-r--r-- | drivers/auxdisplay/ks0108.c | 76 |
1 files changed, 47 insertions, 29 deletions
diff --git a/drivers/auxdisplay/ks0108.c b/drivers/auxdisplay/ks0108.c index ce00e95040bf..4c471bd8c2f7 100644 --- a/drivers/auxdisplay/ks0108.c +++ b/drivers/auxdisplay/ks0108.c @@ -125,51 +125,69 @@ unsigned char ks0108_isinited(void) } EXPORT_SYMBOL_GPL(ks0108_isinited); -/* - * Module Init & Exit - */ - -static int __init ks0108_init(void) +static void ks0108_parport_attach(struct parport *port) { - int result; - int ret = -EINVAL; + struct pardev_cb ks0108_cb; - ks0108_parport = parport_find_base(ks0108_port); - if (ks0108_parport == NULL) { - pr_err("ERROR: parport didn't find %i port\n", ks0108_port); - goto none; - } + if (port->base != ks0108_port) + return; - ks0108_pardevice = parport_register_device(ks0108_parport, KS0108_NAME, - NULL, NULL, NULL, PARPORT_DEV_EXCL, NULL); - parport_put_port(ks0108_parport); - if (ks0108_pardevice == NULL) { + memset(&ks0108_cb, 0, sizeof(ks0108_cb)); + ks0108_cb.flags = PARPORT_DEV_EXCL; + ks0108_pardevice = parport_register_dev_model(port, KS0108_NAME, + &ks0108_cb, 0); + if (!ks0108_pardevice) { pr_err("ERROR: parport didn't register new device\n"); - goto none; + return; } - - result = parport_claim(ks0108_pardevice); - if (result != 0) { - pr_err("ERROR: can't claim %i parport, maybe in use\n", + if (parport_claim(ks0108_pardevice)) { + pr_err("could not claim access to parport %i. Aborting.\n", ks0108_port); - ret = result; - goto registered; + goto err_unreg_device; } ks0108_inited = 1; - return 0; + return; -registered: +err_unreg_device: parport_unregister_device(ks0108_pardevice); - -none: - return ret; + ks0108_pardevice = NULL; } -static void __exit ks0108_exit(void) +static void ks0108_parport_detach(struct parport *port) { + if (port->base != ks0108_port) + return; + + if (!ks0108_pardevice) { + pr_err("%s: already unregistered.\n", KS0108_NAME); + return; + } + parport_release(ks0108_pardevice); parport_unregister_device(ks0108_pardevice); + ks0108_pardevice = NULL; +} + +/* + * Module Init & Exit + */ + +static struct parport_driver ks0108_parport_driver = { + .name = "ks0108", + .match_port = ks0108_parport_attach, + .detach = ks0108_parport_detach, + .devmodel = true, +}; + +static int __init ks0108_init(void) +{ + return parport_register_driver(&ks0108_parport_driver); +} + +static void __exit ks0108_exit(void) +{ + parport_unregister_driver(&ks0108_parport_driver); } module_init(ks0108_init); |