ACPI: thinkpad-acpi: clean up hotkey subdriver
[pandora-kernel.git] / drivers / misc / thinkpad_acpi.c
index 80ef195..344eb55 100644 (file)
@@ -277,9 +277,9 @@ static int _sta(acpi_handle handle)
  * ACPI device model
  */
 
-static void __init ibm_handle_init(char *name,
-                                  acpi_handle * handle, acpi_handle parent,
-                                  char **paths, int num_paths, char **path)
+static void drv_acpi_handle_init(char *name,
+                          acpi_handle *handle, acpi_handle parent,
+                          char **paths, int num_paths, char **path)
 {
        int i;
        acpi_status status;
@@ -295,37 +295,42 @@ static void __init ibm_handle_init(char *name,
        *handle = NULL;
 }
 
-static void dispatch_notify(acpi_handle handle, u32 event, void *data)
+static void dispatch_acpi_notify(acpi_handle handle, u32 event, void *data)
 {
        struct ibm_struct *ibm = data;
 
-       if (!ibm || !ibm->notify)
+       if (!ibm || !ibm->acpi || !ibm->acpi->notify)
                return;
 
-       ibm->notify(ibm, event);
+       ibm->acpi->notify(ibm, event);
 }
 
-static int __init setup_notify(struct ibm_struct *ibm)
+static int __init setup_acpi_notify(struct ibm_struct *ibm)
 {
        acpi_status status;
        int ret;
 
-       if (!*ibm->handle)
+       BUG_ON(!ibm->acpi);
+
+       if (!*ibm->acpi->handle)
                return 0;
 
-       ret = acpi_bus_get_device(*ibm->handle, &ibm->device);
+       dbg_printk(TPACPI_DBG_INIT,
+               "setting up ACPI notify for %s\n", ibm->name);
+
+       ret = acpi_bus_get_device(*ibm->acpi->handle, &ibm->acpi->device);
        if (ret < 0) {
                printk(IBM_ERR "%s device not present\n", ibm->name);
                return -ENODEV;
        }
 
-       acpi_driver_data(ibm->device) = ibm;
-       sprintf(acpi_device_class(ibm->device), "%s/%s",
+       acpi_driver_data(ibm->acpi->device) = ibm;
+       sprintf(acpi_device_class(ibm->acpi->device), "%s/%s",
                IBM_ACPI_EVENT_PREFIX,
                ibm->name);
 
-       status = acpi_install_notify_handler(*ibm->handle, ibm->type,
-                                            dispatch_notify, ibm);
+       status = acpi_install_notify_handler(*ibm->acpi->handle,
+                       ibm->acpi->type, dispatch_acpi_notify, ibm);
        if (ACPI_FAILURE(status)) {
                if (status == AE_ALREADY_EXISTS) {
                        printk(IBM_NOTICE "another device driver is already handling %s events\n",
@@ -336,11 +341,11 @@ static int __init setup_notify(struct ibm_struct *ibm)
                }
                return -ENODEV;
        }
-       ibm->notify_installed = 1;
+       ibm->flags.acpi_notify_installed = 1;
        return 0;
 }
 
-static int __init ibm_device_add(struct acpi_device *device)
+static int __init tpacpi_device_add(struct acpi_device *device)
 {
        return 0;
 }
@@ -349,22 +354,29 @@ static int __init register_tpacpi_subdriver(struct ibm_struct *ibm)
 {
        int ret;
 
-       ibm->driver = kzalloc(sizeof(struct acpi_driver), GFP_KERNEL);
-       if (!ibm->driver) {
-               printk(IBM_ERR "kmalloc(ibm->driver) failed\n");
-               return -1;
+       dbg_printk(TPACPI_DBG_INIT,
+               "registering %s as an ACPI driver\n", ibm->name);
+
+       BUG_ON(!ibm->acpi);
+
+       ibm->acpi->driver = kzalloc(sizeof(struct acpi_driver), GFP_KERNEL);
+       if (!ibm->acpi->driver) {
+               printk(IBM_ERR "kzalloc(ibm->driver) failed\n");
+               return -ENOMEM;
        }
 
-       sprintf(ibm->driver->name, "%s_%s", IBM_NAME, ibm->name);
-       ibm->driver->ids = ibm->hid;
-       ibm->driver->ops.add = &ibm_device_add;
+       sprintf(ibm->acpi->driver->name, "%s_%s", IBM_NAME, ibm->name);
+       ibm->acpi->driver->ids = ibm->acpi->hid;
+       ibm->acpi->driver->ops.add = &tpacpi_device_add;
 
-       ret = acpi_bus_register_driver(ibm->driver);
+       ret = acpi_bus_register_driver(ibm->acpi->driver);
        if (ret < 0) {
                printk(IBM_ERR "acpi_bus_register_driver(%s) failed: %d\n",
-                      ibm->hid, ret);
-               kfree(ibm->driver);
-       }
+                      ibm->acpi->hid, ret);
+               kfree(ibm->acpi->driver);
+               ibm->acpi->driver = NULL;
+       } else if (!ret)
+               ibm->flags.acpi_driver_registered = 1;
 
        return ret;
 }
@@ -378,8 +390,8 @@ static int __init register_tpacpi_subdriver(struct ibm_struct *ibm)
  ****************************************************************************
  ****************************************************************************/
 
-static int dispatch_read(char *page, char **start, off_t off, int count,
-                        int *eof, void *data)
+static int dispatch_procfs_read(char *page, char **start, off_t off,
+                       int count, int *eof, void *data)
 {
        struct ibm_struct *ibm = data;
        int len;
@@ -403,8 +415,9 @@ static int dispatch_read(char *page, char **start, off_t off, int count,
        return len;
 }
 
-static int dispatch_write(struct file *file, const char __user * userbuf,
-                         unsigned long count, void *data)
+static int dispatch_procfs_write(struct file *file,
+                       const char __user * userbuf,
+                       unsigned long count, void *data)
 {
        struct ibm_struct *ibm = data;
        char *kernbuf;
@@ -462,7 +475,7 @@ static char *next_cmd(char **cmds)
  * thinkpad-acpi init subdriver
  */
 
-static int thinkpad_acpi_driver_init(void)
+static int __init thinkpad_acpi_driver_init(struct ibm_init_struct *iibm)
 {
        printk(IBM_INFO "%s v%s\n", IBM_DESC, IBM_VERSION);
        printk(IBM_INFO "%s\n", IBM_URL);
@@ -484,37 +497,59 @@ static int thinkpad_acpi_driver_read(char *p)
        return len;
 }
 
+static struct ibm_struct thinkpad_acpi_driver_data = {
+       .name = "driver",
+       .read = thinkpad_acpi_driver_read,
+};
+
 /*************************************************************************
  * Hotkey subdriver
  */
 
-static int hotkey_supported;
-static int hotkey_mask_supported;
 static int hotkey_orig_status;
 static int hotkey_orig_mask;
 
-static int hotkey_init(void)
+static int __init hotkey_init(struct ibm_init_struct *iibm)
 {
+       int res;
+
+       vdbg_printk(TPACPI_DBG_INIT, "initializing hotkey subdriver\n");
+
+       IBM_ACPIHANDLE_INIT(hkey);
+
        /* hotkey not supported on 570 */
-       hotkey_supported = hkey_handle != NULL;
+       tp_features.hotkey = hkey_handle != NULL;
+
+       vdbg_printk(TPACPI_DBG_INIT, "hotkeys are %s\n",
+               str_supported(tp_features.hotkey));
 
-       if (hotkey_supported) {
+       if (tp_features.hotkey) {
                /* mask not supported on 570, 600e/x, 770e, 770x, A21e, A2xm/p,
                   A30, R30, R31, T20-22, X20-21, X22-24 */
-               hotkey_mask_supported =
-                   acpi_evalf(hkey_handle, NULL, "DHKN", "qv");
+               tp_features.hotkey_mask =
+                       acpi_evalf(hkey_handle, NULL, "DHKN", "qv");
 
-               if (!hotkey_get(&hotkey_orig_status, &hotkey_orig_mask))
-                       return -ENODEV;
+               vdbg_printk(TPACPI_DBG_INIT, "hotkey masks are %s\n",
+                       str_supported(tp_features.hotkey_mask));
+
+               res = hotkey_get(&hotkey_orig_status, &hotkey_orig_mask);
+               if (res)
+                       return res;
        }
 
-       return 0;
+       return (tp_features.hotkey)? 0 : 1;
 }
 
 static void hotkey_exit(void)
 {
-       if (hotkey_supported)
-               hotkey_set(hotkey_orig_status, hotkey_orig_mask);
+       int res;
+
+       if (tp_features.hotkey) {
+               dbg_printk(TPACPI_DBG_EXIT, "restoring original hotkey mask\n");
+               res = hotkey_set(hotkey_orig_status, hotkey_orig_mask);
+               if (res)
+                       printk(IBM_ERR "failed to restore hotkey to BIOS defaults\n");
+       }
 }
 
 static void hotkey_notify(struct ibm_struct *ibm, u32 event)
@@ -522,23 +557,23 @@ static void hotkey_notify(struct ibm_struct *ibm, u32 event)
        int hkey;
 
        if (acpi_evalf(hkey_handle, &hkey, "MHKP", "d"))
-               acpi_bus_generate_event(ibm->device, event, hkey);
+               acpi_bus_generate_event(ibm->acpi->device, event, hkey);
        else {
                printk(IBM_ERR "unknown hotkey event %d\n", event);
-               acpi_bus_generate_event(ibm->device, event, 0);
+               acpi_bus_generate_event(ibm->acpi->device, event, 0);
        }
 }
 
 static int hotkey_get(int *status, int *mask)
 {
        if (!acpi_evalf(hkey_handle, status, "DHKC", "d"))
-               return 0;
+               return -EIO;
 
-       if (hotkey_mask_supported)
+       if (tp_features.hotkey_mask)
                if (!acpi_evalf(hkey_handle, mask, "DHKN", "d"))
-                       return 0;
+                       return -EIO;
 
-       return 1;
+       return 0;
 }
 
 static int hotkey_set(int status, int mask)
@@ -546,34 +581,35 @@ static int hotkey_set(int status, int mask)
        int i;
 
        if (!acpi_evalf(hkey_handle, NULL, "MHKC", "vd", status))
-               return 0;
+               return -EIO;
 
-       if (hotkey_mask_supported)
+       if (tp_features.hotkey_mask)
                for (i = 0; i < 32; i++) {
                        int bit = ((1 << i) & mask) != 0;
                        if (!acpi_evalf(hkey_handle,
                                        NULL, "MHKM", "vdd", i + 1, bit))
-                               return 0;
+                               return -EIO;
                }
 
-       return 1;
+       return 0;
 }
 
 static int hotkey_read(char *p)
 {
-       int status, mask;
+       int res, status, mask;
        int len = 0;
 
-       if (!hotkey_supported) {
+       if (!tp_features.hotkey) {
                len += sprintf(p + len, "status:\t\tnot supported\n");
                return len;
        }
 
-       if (!hotkey_get(&status, &mask))
-               return -EIO;
+       res = hotkey_get(&status, &mask);
+       if (res)
+               return res;
 
        len += sprintf(p + len, "status:\t\t%s\n", enabled(status, 0));
-       if (hotkey_mask_supported) {
+       if (tp_features.hotkey_mask) {
                len += sprintf(p + len, "mask:\t\t0x%04x\n", mask);
                len += sprintf(p + len,
                               "commands:\tenable, disable, reset, <mask>\n");
@@ -587,15 +623,16 @@ static int hotkey_read(char *p)
 
 static int hotkey_write(char *buf)
 {
-       int status, mask;
+       int res, status, mask;
        char *cmd;
        int do_cmd = 0;
 
-       if (!hotkey_supported)
+       if (!tp_features.hotkey)
                return -ENODEV;
 
-       if (!hotkey_get(&status, &mask))
-               return -EIO;
+       res = hotkey_get(&status, &mask);
+       if (res)
+               return res;
 
        while ((cmd = next_cmd(&buf))) {
                if (strlencmp(cmd, "enable") == 0) {
@@ -614,33 +651,56 @@ static int hotkey_write(char *buf)
                do_cmd = 1;
        }
 
-       if (do_cmd && !hotkey_set(status, mask))
-               return -EIO;
+       if (do_cmd) {
+               res = hotkey_set(status, mask);
+               if (res)
+                       return res;
+       }
 
        return 0;
 }
 
+static struct tp_acpi_drv_struct ibm_hotkey_acpidriver = {
+       .hid = IBM_HKEY_HID,
+       .notify = hotkey_notify,
+       .handle = &hkey_handle,
+       .type = ACPI_DEVICE_NOTIFY,
+};
+
+static struct ibm_struct hotkey_driver_data = {
+       .name = "hotkey",
+       .read = hotkey_read,
+       .write = hotkey_write,
+       .exit = hotkey_exit,
+       .acpi = &ibm_hotkey_acpidriver,
+};
+
 /*************************************************************************
  * Bluetooth subdriver
  */
 
-static int bluetooth_supported;
-
-static int bluetooth_init(void)
+static int __init bluetooth_init(struct ibm_init_struct *iibm)
 {
+       vdbg_printk(TPACPI_DBG_INIT, "initializing bluetooth subdriver\n");
+
+       IBM_ACPIHANDLE_INIT(hkey);
+
        /* bluetooth not supported on 570, 600e/x, 770e, 770x, A21e, A2xm/p,
           G4x, R30, R31, R40e, R50e, T20-22, X20-21 */
-       bluetooth_supported = hkey_handle &&
+       tp_features.bluetooth = hkey_handle &&
            acpi_evalf(hkey_handle, NULL, "GBDC", "qv");
 
-       return 0;
+       vdbg_printk(TPACPI_DBG_INIT, "bluetooth is %s\n",
+               str_supported(tp_features.bluetooth));
+
+       return (tp_features.bluetooth)? 0 : 1;
 }
 
 static int bluetooth_status(void)
 {
        int status;
 
-       if (!bluetooth_supported ||
+       if (!tp_features.bluetooth ||
            !acpi_evalf(hkey_handle, &status, "GBDC", "d"))
                status = 0;
 
@@ -652,7 +712,7 @@ static int bluetooth_read(char *p)
        int len = 0;
        int status = bluetooth_status();
 
-       if (!bluetooth_supported)
+       if (!tp_features.bluetooth)
                len += sprintf(p + len, "status:\t\tnot supported\n");
        else if (!(status & 1))
                len += sprintf(p + len, "status:\t\tnot installed\n");
@@ -670,7 +730,7 @@ static int bluetooth_write(char *buf)
        char *cmd;
        int do_cmd = 0;
 
-       if (!bluetooth_supported)
+       if (!tp_features.bluetooth)
                return -ENODEV;
 
        while ((cmd = next_cmd(&buf))) {
@@ -689,25 +749,37 @@ static int bluetooth_write(char *buf)
        return 0;
 }
 
+static struct ibm_struct bluetooth_driver_data = {
+       .name = "bluetooth",
+       .read = bluetooth_read,
+       .write = bluetooth_write,
+};
+
 /*************************************************************************
  * Wan subdriver
  */
 
-static int wan_supported;
-
-static int wan_init(void)
+static int __init wan_init(struct ibm_init_struct *iibm)
 {
-       wan_supported = hkey_handle &&
-           acpi_evalf(hkey_handle, NULL, "GWAN", "qv");
+       vdbg_printk(TPACPI_DBG_INIT, "initializing wan subdriver\n");
 
-       return 0;
+       IBM_ACPIHANDLE_INIT(hkey);
+
+       tp_features.wan = hkey_handle &&
+                         acpi_evalf(hkey_handle, NULL, "GWAN", "qv");
+
+       vdbg_printk(TPACPI_DBG_INIT, "wan is %s\n",
+               str_supported(tp_features.wan));
+
+       return (tp_features.wan)? 0 : 1;
 }
 
 static int wan_status(void)
 {
        int status;
 
-       if (!wan_supported || !acpi_evalf(hkey_handle, &status, "GWAN", "d"))
+       if (!tp_features.wan ||
+           !acpi_evalf(hkey_handle, &status, "GWAN", "d"))
                status = 0;
 
        return status;
@@ -718,7 +790,7 @@ static int wan_read(char *p)
        int len = 0;
        int status = wan_status();
 
-       if (!wan_supported)
+       if (!tp_features.wan)
                len += sprintf(p + len, "status:\t\tnot supported\n");
        else if (!(status & 1))
                len += sprintf(p + len, "status:\t\tnot installed\n");
@@ -736,7 +808,7 @@ static int wan_write(char *buf)
        char *cmd;
        int do_cmd = 0;
 
-       if (!wan_supported)
+       if (!tp_features.wan)
                return -ENODEV;
 
        while ((cmd = next_cmd(&buf))) {
@@ -755,6 +827,13 @@ static int wan_write(char *buf)
        return 0;
 }
 
+static struct ibm_struct wan_driver_data = {
+       .name = "wan",
+       .read = wan_read,
+       .write = wan_write,
+       .flags.experimental = 1,
+};
+
 /*************************************************************************
  * Video subdriver
  */
@@ -771,32 +850,42 @@ IBM_HANDLE(vid, root, "\\_SB.PCI.AGP.VGA",        /* 570 */
 
 IBM_HANDLE(vid2, root, "\\_SB.PCI0.AGPB.VID"); /* G41 */
 
-static int video_init(void)
+static int __init video_init(struct ibm_init_struct *iibm)
 {
        int ivga;
 
+       vdbg_printk(TPACPI_DBG_INIT, "initializing video subdriver\n");
+
+       IBM_ACPIHANDLE_INIT(vid);
+       IBM_ACPIHANDLE_INIT(vid2);
+
        if (vid2_handle && acpi_evalf(NULL, &ivga, "\\IVGA", "d") && ivga)
                /* G41, assume IVGA doesn't change */
                vid_handle = vid2_handle;
 
        if (!vid_handle)
                /* video switching not supported on R30, R31 */
-               video_supported = IBMACPI_VIDEO_NONE;
+               video_supported = TPACPI_VIDEO_NONE;
        else if (acpi_evalf(vid_handle, &video_orig_autosw, "SWIT", "qd"))
                /* 570 */
-               video_supported = IBMACPI_VIDEO_570;
+               video_supported = TPACPI_VIDEO_570;
        else if (acpi_evalf(vid_handle, &video_orig_autosw, "^VADL", "qd"))
                /* 600e/x, 770e, 770x */
-               video_supported = IBMACPI_VIDEO_770;
+               video_supported = TPACPI_VIDEO_770;
        else
                /* all others */
-               video_supported = IBMACPI_VIDEO_NEW;
+               video_supported = TPACPI_VIDEO_NEW;
 
-       return 0;
+       vdbg_printk(TPACPI_DBG_INIT, "video is %s, mode %d\n",
+               str_supported(video_supported != TPACPI_VIDEO_NONE),
+               video_supported);
+
+       return (video_supported != TPACPI_VIDEO_NONE)? 0 : 1;
 }
 
 static void video_exit(void)
 {
+       dbg_printk(TPACPI_DBG_EXIT, "restoring original video autoswitch mode\n");
        acpi_evalf(vid_handle, NULL, "_DOS", "vd", video_orig_autosw);
 }
 
@@ -805,15 +894,15 @@ static int video_status(void)
        int status = 0;
        int i;
 
-       if (video_supported == IBMACPI_VIDEO_570) {
+       if (video_supported == TPACPI_VIDEO_570) {
                if (acpi_evalf(NULL, &i, "\\_SB.PHS", "dd", 0x87))
                        status = i & 3;
-       } else if (video_supported == IBMACPI_VIDEO_770) {
+       } else if (video_supported == TPACPI_VIDEO_770) {
                if (acpi_evalf(NULL, &i, "\\VCDL", "d"))
                        status |= 0x01 * i;
                if (acpi_evalf(NULL, &i, "\\VCDC", "d"))
                        status |= 0x02 * i;
-       } else if (video_supported == IBMACPI_VIDEO_NEW) {
+       } else if (video_supported == TPACPI_VIDEO_NEW) {
                acpi_evalf(NULL, NULL, "\\VUPS", "vd", 1);
                if (acpi_evalf(NULL, &i, "\\VCDC", "d"))
                        status |= 0x02 * i;
@@ -832,10 +921,10 @@ static int video_autosw(void)
 {
        int autosw = 0;
 
-       if (video_supported == IBMACPI_VIDEO_570)
+       if (video_supported == TPACPI_VIDEO_570)
                acpi_evalf(vid_handle, &autosw, "SWIT", "d");
-       else if (video_supported == IBMACPI_VIDEO_770 ||
-                video_supported == IBMACPI_VIDEO_NEW)
+       else if (video_supported == TPACPI_VIDEO_770 ||
+                video_supported == TPACPI_VIDEO_NEW)
                acpi_evalf(vid_handle, &autosw, "^VDEE", "d");
 
        return autosw & 1;
@@ -848,7 +937,7 @@ static int video_switch(void)
 
        if (!acpi_evalf(vid_handle, NULL, "_DOS", "vd", 1))
                return -EIO;
-       ret = video_supported == IBMACPI_VIDEO_570 ?
+       ret = video_supported == TPACPI_VIDEO_570 ?
            acpi_evalf(ec_handle, NULL, "_Q16", "v") :
            acpi_evalf(vid_handle, NULL, "VSWT", "v");
        acpi_evalf(vid_handle, NULL, "_DOS", "vd", autosw);
@@ -858,9 +947,9 @@ static int video_switch(void)
 
 static int video_expand(void)
 {
-       if (video_supported == IBMACPI_VIDEO_570)
+       if (video_supported == TPACPI_VIDEO_570)
                return acpi_evalf(ec_handle, NULL, "_Q17", "v");
-       else if (video_supported == IBMACPI_VIDEO_770)
+       else if (video_supported == TPACPI_VIDEO_770)
                return acpi_evalf(vid_handle, NULL, "VEXP", "v");
        else
                return acpi_evalf(NULL, NULL, "\\VEXP", "v");
@@ -870,10 +959,10 @@ static int video_switch2(int status)
 {
        int ret;
 
-       if (video_supported == IBMACPI_VIDEO_570) {
+       if (video_supported == TPACPI_VIDEO_570) {
                ret = acpi_evalf(NULL, NULL,
                                 "\\_SB.PHS2", "vdd", 0x8b, status | 0x80);
-       } else if (video_supported == IBMACPI_VIDEO_770) {
+       } else if (video_supported == TPACPI_VIDEO_770) {
                int autosw = video_autosw();
                if (!acpi_evalf(vid_handle, NULL, "_DOS", "vd", 1))
                        return -EIO;
@@ -904,12 +993,12 @@ static int video_read(char *p)
        len += sprintf(p + len, "status:\t\tsupported\n");
        len += sprintf(p + len, "lcd:\t\t%s\n", enabled(status, 0));
        len += sprintf(p + len, "crt:\t\t%s\n", enabled(status, 1));
-       if (video_supported == IBMACPI_VIDEO_NEW)
+       if (video_supported == TPACPI_VIDEO_NEW)
                len += sprintf(p + len, "dvi:\t\t%s\n", enabled(status, 3));
        len += sprintf(p + len, "auto:\t\t%s\n", enabled(autosw, 0));
        len += sprintf(p + len, "commands:\tlcd_enable, lcd_disable\n");
        len += sprintf(p + len, "commands:\tcrt_enable, crt_disable\n");
-       if (video_supported == IBMACPI_VIDEO_NEW)
+       if (video_supported == TPACPI_VIDEO_NEW)
                len += sprintf(p + len, "commands:\tdvi_enable, dvi_disable\n");
        len += sprintf(p + len, "commands:\tauto_enable, auto_disable\n");
        len += sprintf(p + len, "commands:\tvideo_switch, expand_toggle\n");
@@ -936,10 +1025,10 @@ static int video_write(char *buf)
                        enable |= 0x02;
                } else if (strlencmp(cmd, "crt_disable") == 0) {
                        disable |= 0x02;
-               } else if (video_supported == IBMACPI_VIDEO_NEW &&
+               } else if (video_supported == TPACPI_VIDEO_NEW &&
                           strlencmp(cmd, "dvi_enable") == 0) {
                        enable |= 0x08;
-               } else if (video_supported == IBMACPI_VIDEO_NEW &&
+               } else if (video_supported == TPACPI_VIDEO_NEW &&
                           strlencmp(cmd, "dvi_disable") == 0) {
                        disable |= 0x08;
                } else if (strlencmp(cmd, "auto_enable") == 0) {
@@ -967,28 +1056,41 @@ static int video_write(char *buf)
        return 0;
 }
 
+static struct ibm_struct video_driver_data = {
+       .name = "video",
+       .read = video_read,
+       .write = video_write,
+       .exit = video_exit,
+};
+
 /*************************************************************************
  * Light (thinklight) subdriver
  */
 
-static int light_supported;
-static int light_status_supported;
-
 IBM_HANDLE(lght, root, "\\LGHT");      /* A21e, A2xm/p, T20-22, X20-21 */
 IBM_HANDLE(ledb, ec, "LEDB");          /* G4x */
 
-static int light_init(void)
+static int __init light_init(struct ibm_init_struct *iibm)
 {
+       vdbg_printk(TPACPI_DBG_INIT, "initializing light subdriver\n");
+
+       IBM_ACPIHANDLE_INIT(ledb);
+       IBM_ACPIHANDLE_INIT(lght);
+       IBM_ACPIHANDLE_INIT(cmos);
+
        /* light not supported on 570, 600e/x, 770e, 770x, G4x, R30, R31 */
-       light_supported = (cmos_handle || lght_handle) && !ledb_handle;
+       tp_features.light = (cmos_handle || lght_handle) && !ledb_handle;
 
-       if (light_supported)
+       if (tp_features.light)
                /* light status not supported on
                   570, 600e/x, 770e, 770x, G4x, R30, R31, R32, X20 */
-               light_status_supported = acpi_evalf(ec_handle, NULL,
-                                                   "KBLT", "qv");
+               tp_features.light_status =
+                       acpi_evalf(ec_handle, NULL, "KBLT", "qv");
 
-       return 0;
+       vdbg_printk(TPACPI_DBG_INIT, "light is %s\n",
+               str_supported(tp_features.light));
+
+       return (tp_features.light)? 0 : 1;
 }
 
 static int light_read(char *p)
@@ -996,9 +1098,9 @@ static int light_read(char *p)
        int len = 0;
        int status = 0;
 
-       if (!light_supported) {
+       if (!tp_features.light) {
                len += sprintf(p + len, "status:\t\tnot supported\n");
-       } else if (!light_status_supported) {
+       } else if (!tp_features.light_status) {
                len += sprintf(p + len, "status:\t\tunknown\n");
                len += sprintf(p + len, "commands:\ton, off\n");
        } else {
@@ -1017,7 +1119,7 @@ static int light_write(char *buf)
        char *cmd;
        int success;
 
-       if (!light_supported)
+       if (!tp_features.light)
                return -ENODEV;
 
        while ((cmd = next_cmd(&buf))) {
@@ -1040,13 +1142,16 @@ static int light_write(char *buf)
        return 0;
 }
 
+static struct ibm_struct light_driver_data = {
+       .name = "light",
+       .read = light_read,
+       .write = light_write,
+};
+
 /*************************************************************************
  * Dock subdriver
  */
 
-/* don't list other alternatives as we install a notify handler on the 570 */
-IBM_HANDLE(pci, root, "\\_SB.PCI");    /* 570 */
-
 #ifdef CONFIG_THINKPAD_ACPI_DOCK
 
 IBM_HANDLE(dock, root, "\\_SB.GDCK",   /* X30, X31, X40 */
@@ -1055,27 +1160,43 @@ IBM_HANDLE(dock, root, "\\_SB.GDCK",    /* X30, X31, X40 */
           "\\_SB.PCI.ISA.SLCE",        /* 570 */
     );                         /* A21e,G4x,R30,R31,R32,R40,R40e,R50e */
 
+/* don't list other alternatives as we install a notify handler on the 570 */
+IBM_HANDLE(pci, root, "\\_SB.PCI");    /* 570 */
+
 #define dock_docked() (_sta(dock_handle) & 1)
 
+static int __init dock_init(struct ibm_init_struct *iibm)
+{
+       vdbg_printk(TPACPI_DBG_INIT, "initializing dock subdriver\n");
+
+       IBM_ACPIHANDLE_INIT(dock);
+       IBM_ACPIHANDLE_INIT(pci);
+
+       vdbg_printk(TPACPI_DBG_INIT, "dock is %s\n",
+               str_supported(dock_handle != NULL));
+
+       return (dock_handle)? 0 : 1;
+}
+
 static void dock_notify(struct ibm_struct *ibm, u32 event)
 {
        int docked = dock_docked();
-       int pci = ibm->hid && strstr(ibm->hid, IBM_PCI_HID);
+       int pci = ibm->acpi->hid && strstr(ibm->acpi->hid, IBM_PCI_HID);
 
        if (event == 1 && !pci) /* 570 */
-               acpi_bus_generate_event(ibm->device, event, 1); /* button */
+               acpi_bus_generate_event(ibm->acpi->device, event, 1);   /* button */
        else if (event == 1 && pci)     /* 570 */
-               acpi_bus_generate_event(ibm->device, event, 3); /* dock */
+               acpi_bus_generate_event(ibm->acpi->device, event, 3);   /* dock */
        else if (event == 3 && docked)
-               acpi_bus_generate_event(ibm->device, event, 1); /* button */
+               acpi_bus_generate_event(ibm->acpi->device, event, 1);   /* button */
        else if (event == 3 && !docked)
-               acpi_bus_generate_event(ibm->device, event, 2); /* undock */
+               acpi_bus_generate_event(ibm->acpi->device, event, 2);   /* undock */
        else if (event == 0 && docked)
-               acpi_bus_generate_event(ibm->device, event, 3); /* dock */
+               acpi_bus_generate_event(ibm->acpi->device, event, 3);   /* dock */
        else {
                printk(IBM_ERR "unknown dock event %d, status %d\n",
                       event, _sta(dock_handle));
-               acpi_bus_generate_event(ibm->device, event, 0); /* unknown */
+               acpi_bus_generate_event(ibm->acpi->device, event, 0);   /* unknown */
        }
 }
 
@@ -1118,6 +1239,33 @@ static int dock_write(char *buf)
        return 0;
 }
 
+static struct tp_acpi_drv_struct ibm_dock_acpidriver[2] = {
+       {
+        .notify = dock_notify,
+        .handle = &dock_handle,
+        .type = ACPI_SYSTEM_NOTIFY,
+       },
+       {
+        .hid = IBM_PCI_HID,
+        .notify = dock_notify,
+        .handle = &pci_handle,
+        .type = ACPI_SYSTEM_NOTIFY,
+       },
+};
+
+static struct ibm_struct dock_driver_data[2] = {
+       {
+        .name = "dock",
+        .read = dock_read,
+        .write = dock_write,
+        .acpi = &ibm_dock_acpidriver[0],
+       },
+       {
+        .name = "dock",
+        .acpi = &ibm_dock_acpidriver[1],
+       },
+};
+
 #endif /* CONFIG_THINKPAD_ACPI_DOCK */
 
 /*************************************************************************
@@ -1125,11 +1273,6 @@ static int dock_write(char *buf)
  */
 
 #ifdef CONFIG_THINKPAD_ACPI_BAY
-static int bay_status_supported;
-static int bay_status2_supported;
-static int bay_eject_supported;
-static int bay_eject2_supported;
-
 IBM_HANDLE(bay, root, "\\_SB.PCI.IDE.SECN.MAST",       /* 570 */
           "\\_SB.PCI0.IDE0.IDES.IDSM", /* 600e/x, 770e, 770x */
           "\\_SB.PCI0.SATA.SCND.MSTR", /* T60, X60, Z60 */
@@ -1145,24 +1288,41 @@ IBM_HANDLE(bay2_ej, bay2, "_EJ3",       /* 600e/x, 770e, A3x */
           "_EJ0",                      /* 770x */
           );                           /* all others */
 
-static int bay_init(void)
+static int __init bay_init(struct ibm_init_struct *iibm)
 {
-       bay_status_supported = bay_handle &&
-           acpi_evalf(bay_handle, NULL, "_STA", "qv");
-       bay_status2_supported = bay2_handle &&
-           acpi_evalf(bay2_handle, NULL, "_STA", "qv");
+       vdbg_printk(TPACPI_DBG_INIT, "initializing bay subdriver\n");
 
-       bay_eject_supported = bay_handle && bay_ej_handle &&
-           (strlencmp(bay_ej_path, "_EJ0") == 0 || experimental);
-       bay_eject2_supported = bay2_handle && bay2_ej_handle &&
-           (strlencmp(bay2_ej_path, "_EJ0") == 0 || experimental);
+       IBM_ACPIHANDLE_INIT(bay);
+       if (bay_handle)
+               IBM_ACPIHANDLE_INIT(bay_ej);
+       IBM_ACPIHANDLE_INIT(bay2);
+       if (bay2_handle)
+               IBM_ACPIHANDLE_INIT(bay2_ej);
 
-       return 0;
+       tp_features.bay_status = bay_handle &&
+               acpi_evalf(bay_handle, NULL, "_STA", "qv");
+       tp_features.bay_status2 = bay2_handle &&
+               acpi_evalf(bay2_handle, NULL, "_STA", "qv");
+
+       tp_features.bay_eject = bay_handle && bay_ej_handle &&
+               (strlencmp(bay_ej_path, "_EJ0") == 0 || experimental);
+       tp_features.bay_eject2 = bay2_handle && bay2_ej_handle &&
+               (strlencmp(bay2_ej_path, "_EJ0") == 0 || experimental);
+
+       vdbg_printk(TPACPI_DBG_INIT,
+               "bay 1: status %s, eject %s; bay 2: status %s, eject %s\n",
+               str_supported(tp_features.bay_status),
+               str_supported(tp_features.bay_eject),
+               str_supported(tp_features.bay_status2),
+               str_supported(tp_features.bay_eject2));
+
+       return (tp_features.bay_status || tp_features.bay_eject ||
+               tp_features.bay_status2 || tp_features.bay_eject2)? 0 : 1;
 }
 
 static void bay_notify(struct ibm_struct *ibm, u32 event)
 {
-       acpi_bus_generate_event(ibm->device, event, 0);
+       acpi_bus_generate_event(ibm->acpi->device, event, 0);
 }
 
 #define bay_occupied(b) (_sta(b##_handle) & 1)
@@ -1174,15 +1334,16 @@ static int bay_read(char *p)
        int occupied2 = bay_occupied(bay2);
        int eject, eject2;
 
-       len += sprintf(p + len, "status:\t\t%s\n", bay_status_supported ?
-                      (occupied ? "occupied" : "unoccupied") :
-                      "not supported");
-       if (bay_status2_supported)
+       len += sprintf(p + len, "status:\t\t%s\n",
+               tp_features.bay_status ?
+                       (occupied ? "occupied" : "unoccupied") :
+                               "not supported");
+       if (tp_features.bay_status2)
                len += sprintf(p + len, "status2:\t%s\n", occupied2 ?
                               "occupied" : "unoccupied");
 
-       eject = bay_eject_supported && occupied;
-       eject2 = bay_eject2_supported && occupied2;
+       eject = tp_features.bay_eject && occupied;
+       eject2 = tp_features.bay_eject2 && occupied2;
 
        if (eject && eject2)
                len += sprintf(p + len, "commands:\teject, eject2\n");
@@ -1198,14 +1359,14 @@ static int bay_write(char *buf)
 {
        char *cmd;
 
-       if (!bay_eject_supported && !bay_eject2_supported)
+       if (!tp_features.bay_eject && !tp_features.bay_eject2)
                return -ENODEV;
 
        while ((cmd = next_cmd(&buf))) {
-               if (bay_eject_supported && strlencmp(cmd, "eject") == 0) {
+               if (tp_features.bay_eject && strlencmp(cmd, "eject") == 0) {
                        if (!acpi_evalf(bay_ej_handle, NULL, NULL, "vd", 1))
                                return -EIO;
-               } else if (bay_eject2_supported &&
+               } else if (tp_features.bay_eject2 &&
                           strlencmp(cmd, "eject2") == 0) {
                        if (!acpi_evalf(bay2_ej_handle, NULL, NULL, "vd", 1))
                                return -EIO;
@@ -1215,12 +1376,38 @@ static int bay_write(char *buf)
 
        return 0;
 }
+
+static struct tp_acpi_drv_struct ibm_bay_acpidriver = {
+       .notify = bay_notify,
+       .handle = &bay_handle,
+       .type = ACPI_SYSTEM_NOTIFY,
+};
+
+static struct ibm_struct bay_driver_data = {
+       .name = "bay",
+       .read = bay_read,
+       .write = bay_write,
+       .acpi = &ibm_bay_acpidriver,
+};
+
 #endif /* CONFIG_THINKPAD_ACPI_BAY */
 
 /*************************************************************************
  * CMOS subdriver
  */
 
+static int __init cmos_init(struct ibm_init_struct *iibm)
+{
+       vdbg_printk(TPACPI_DBG_INIT,
+               "initializing cmos commands subdriver\n");
+
+       IBM_ACPIHANDLE_INIT(cmos);
+
+       vdbg_printk(TPACPI_DBG_INIT, "cmos commands are %s\n",
+               str_supported(cmos_handle != NULL));
+       return (cmos_handle)? 0 : 1;
+}
+
 static int cmos_eval(int cmos_cmd)
 {
        if (cmos_handle)
@@ -1267,6 +1454,11 @@ static int cmos_write(char *buf)
        return 0;
 }
 
+static struct ibm_struct cmos_driver_data = {
+       .name = "cmos",
+       .read = cmos_read,
+       .write = cmos_write,
+};
 
 /*************************************************************************
  * LED subdriver
@@ -1279,22 +1471,29 @@ IBM_HANDLE(led, ec, "SLED",     /* 570 */
           "LED",               /* all others */
           );                   /* R30, R31 */
 
-static int led_init(void)
+static int __init led_init(struct ibm_init_struct *iibm)
 {
+       vdbg_printk(TPACPI_DBG_INIT, "initializing LED subdriver\n");
+
+       IBM_ACPIHANDLE_INIT(led);
+
        if (!led_handle)
                /* led not supported on R30, R31 */
-               led_supported = IBMACPI_LED_NONE;
+               led_supported = TPACPI_LED_NONE;
        else if (strlencmp(led_path, "SLED") == 0)
                /* 570 */
-               led_supported = IBMACPI_LED_570;
+               led_supported = TPACPI_LED_570;
        else if (strlencmp(led_path, "SYSL") == 0)
                /* 600e/x, 770e, 770x, A21e, A2xm/p, T20-22, X20-21 */
-               led_supported = IBMACPI_LED_OLD;
+               led_supported = TPACPI_LED_OLD;
        else
                /* all others */
-               led_supported = IBMACPI_LED_NEW;
+               led_supported = TPACPI_LED_NEW;
 
-       return 0;
+       vdbg_printk(TPACPI_DBG_INIT, "LED commands are %s, mode %d\n",
+               str_supported(led_supported), led_supported);
+
+       return (led_supported != TPACPI_LED_NONE)? 0 : 1;
 }
 
 #define led_status(s) ((s) == 0 ? "off" : ((s) == 1 ? "on" : "blinking"))
@@ -1309,7 +1508,7 @@ static int led_read(char *p)
        }
        len += sprintf(p + len, "status:\t\tsupported\n");
 
-       if (led_supported == IBMACPI_LED_570) {
+       if (led_supported == TPACPI_LED_570) {
                /* 570 */
                int i, status;
                for (i = 0; i < 8; i++) {
@@ -1354,23 +1553,23 @@ static int led_write(char *buf)
                } else
                        return -EINVAL;
 
-               if (led_supported == IBMACPI_LED_570) {
+               if (led_supported == TPACPI_LED_570) {
                        /* 570 */
                        led = 1 << led;
                        if (!acpi_evalf(led_handle, NULL, NULL, "vdd",
                                        led, led_sled_arg1[ind]))
                                return -EIO;
-               } else if (led_supported == IBMACPI_LED_OLD) {
+               } else if (led_supported == TPACPI_LED_OLD) {
                        /* 600e/x, 770e, 770x, A21e, A2xm/p, T20-22, X20 */
                        led = 1 << led;
-                       ret = ec_write(IBMACPI_LED_EC_HLMS, led);
+                       ret = ec_write(TPACPI_LED_EC_HLMS, led);
                        if (ret >= 0)
                                ret =
-                                   ec_write(IBMACPI_LED_EC_HLBL,
+                                   ec_write(TPACPI_LED_EC_HLBL,
                                             led * led_exp_hlbl[ind]);
                        if (ret >= 0)
                                ret =
-                                   ec_write(IBMACPI_LED_EC_HLCL,
+                                   ec_write(TPACPI_LED_EC_HLCL,
                                             led * led_exp_hlcl[ind]);
                        if (ret < 0)
                                return ret;
@@ -1385,12 +1584,30 @@ static int led_write(char *buf)
        return 0;
 }
 
+static struct ibm_struct led_driver_data = {
+       .name = "led",
+       .read = led_read,
+       .write = led_write,
+};
+
 /*************************************************************************
  * Beep subdriver
  */
 
 IBM_HANDLE(beep, ec, "BEEP");  /* all except R30, R31 */
 
+static int __init beep_init(struct ibm_init_struct *iibm)
+{
+       vdbg_printk(TPACPI_DBG_INIT, "initializing beep subdriver\n");
+
+       IBM_ACPIHANDLE_INIT(beep);
+
+       vdbg_printk(TPACPI_DBG_INIT, "beep is %s\n",
+               str_supported(beep_handle != NULL));
+
+       return (beep_handle)? 0 : 1;
+}
+
 static int beep_read(char *p)
 {
        int len = 0;
@@ -1426,17 +1643,27 @@ static int beep_write(char *buf)
        return 0;
 }
 
+static struct ibm_struct beep_driver_data = {
+       .name = "beep",
+       .read = beep_read,
+       .write = beep_write,
+};
+
 /*************************************************************************
  * Thermal subdriver
  */
 
 static enum thermal_access_mode thermal_read_mode;
 
-static int thermal_init(void)
+static int __init thermal_init(struct ibm_init_struct *iibm)
 {
        u8 t, ta1, ta2;
        int i;
-       int acpi_tmp7 = acpi_evalf(ec_handle, NULL, "TMP7", "qv");
+       int acpi_tmp7;
+
+       vdbg_printk(TPACPI_DBG_INIT, "initializing thermal subdriver\n");
+
+       acpi_tmp7 = acpi_evalf(ec_handle, NULL, "TMP7", "qv");
 
        if (ibm_thinkpad_ec_found && experimental) {
                /*
@@ -1467,32 +1694,36 @@ static int thermal_init(void)
                                printk(IBM_ERR
                                       "ThinkPad ACPI EC access misbehaving, "
                                       "falling back to ACPI TMPx access mode\n");
-                               thermal_read_mode = IBMACPI_THERMAL_ACPI_TMP07;
+                               thermal_read_mode = TPACPI_THERMAL_ACPI_TMP07;
                        } else {
                                printk(IBM_ERR
                                       "ThinkPad ACPI EC access misbehaving, "
                                       "disabling thermal sensors access\n");
-                               thermal_read_mode = IBMACPI_THERMAL_NONE;
+                               thermal_read_mode = TPACPI_THERMAL_NONE;
                        }
                } else {
                        thermal_read_mode =
                            (ta2 != 0) ?
-                           IBMACPI_THERMAL_TPEC_16 : IBMACPI_THERMAL_TPEC_8;
+                           TPACPI_THERMAL_TPEC_16 : TPACPI_THERMAL_TPEC_8;
                }
        } else if (acpi_tmp7) {
                if (acpi_evalf(ec_handle, NULL, "UPDT", "qv")) {
                        /* 600e/x, 770e, 770x */
-                       thermal_read_mode = IBMACPI_THERMAL_ACPI_UPDT;
+                       thermal_read_mode = TPACPI_THERMAL_ACPI_UPDT;
                } else {
                        /* Standard ACPI TMPx access, max 8 sensors */
-                       thermal_read_mode = IBMACPI_THERMAL_ACPI_TMP07;
+                       thermal_read_mode = TPACPI_THERMAL_ACPI_TMP07;
                }
        } else {
                /* temperatures not supported on 570, G4x, R30, R31, R32 */
-               thermal_read_mode = IBMACPI_THERMAL_NONE;
+               thermal_read_mode = TPACPI_THERMAL_NONE;
        }
 
-       return 0;
+       vdbg_printk(TPACPI_DBG_INIT, "thermal is %s, mode %d\n",
+               str_supported(thermal_read_mode != TPACPI_THERMAL_NONE),
+               thermal_read_mode);
+
+       return (thermal_read_mode != TPACPI_THERMAL_NONE)? 0 : 1;
 }
 
 static int thermal_get_sensors(struct ibm_thermal_sensors_struct *s)
@@ -1505,8 +1736,8 @@ static int thermal_get_sensors(struct ibm_thermal_sensors_struct *s)
                return -EINVAL;
 
        switch (thermal_read_mode) {
-#if IBMACPI_MAX_THERMAL_SENSORS >= 16
-       case IBMACPI_THERMAL_TPEC_16:
+#if TPACPI_MAX_THERMAL_SENSORS >= 16
+       case TPACPI_THERMAL_TPEC_16:
                for (i = 0; i < 8; i++) {
                        if (!acpi_ec_read(0xC0 + i, &tmp))
                                return -EIO;
@@ -1514,15 +1745,15 @@ static int thermal_get_sensors(struct ibm_thermal_sensors_struct *s)
                }
                /* fallthrough */
 #endif
-       case IBMACPI_THERMAL_TPEC_8:
+       case TPACPI_THERMAL_TPEC_8:
                for (i = 0; i < 8; i++) {
                        if (!acpi_ec_read(0x78 + i, &tmp))
                                return -EIO;
                        s->temp[i] = tmp * 1000;
                }
-               return (thermal_read_mode == IBMACPI_THERMAL_TPEC_16) ? 16 : 8;
+               return (thermal_read_mode == TPACPI_THERMAL_TPEC_16) ? 16 : 8;
 
-       case IBMACPI_THERMAL_ACPI_UPDT:
+       case TPACPI_THERMAL_ACPI_UPDT:
                if (!acpi_evalf(ec_handle, NULL, "UPDT", "v"))
                        return -EIO;
                for (i = 0; i < 8; i++) {
@@ -1533,7 +1764,7 @@ static int thermal_get_sensors(struct ibm_thermal_sensors_struct *s)
                }
                return 8;
 
-       case IBMACPI_THERMAL_ACPI_TMP07:
+       case TPACPI_THERMAL_ACPI_TMP07:
                for (i = 0; i < 8; i++) {
                        tmpi[3] = '0' + i;
                        if (!acpi_evalf(ec_handle, &t, tmpi, "d"))
@@ -1542,7 +1773,7 @@ static int thermal_get_sensors(struct ibm_thermal_sensors_struct *s)
                }
                return 8;
 
-       case IBMACPI_THERMAL_NONE:
+       case TPACPI_THERMAL_NONE:
        default:
                return 0;
        }
@@ -1570,6 +1801,11 @@ static int thermal_read(char *p)
        return len;
 }
 
+static struct ibm_struct thermal_driver_data = {
+       .name = "thermal",
+       .read = thermal_read,
+};
+
 /*************************************************************************
  * EC Dump subdriver
  */
@@ -1633,6 +1869,13 @@ static int ecdump_write(char *buf)
        return 0;
 }
 
+static struct ibm_struct ecdump_driver_data = {
+       .name = "ecdump",
+       .read = ecdump_read,
+       .write = ecdump_write,
+       .flags.experimental = 1,
+};
+
 /*************************************************************************
  * Backlight/brightness subdriver
  */
@@ -1644,10 +1887,12 @@ static struct backlight_ops ibm_backlight_data = {
         .update_status  = brightness_update_status,
 };
 
-static int brightness_init(void)
+static int __init brightness_init(struct ibm_init_struct *iibm)
 {
        int b;
 
+       vdbg_printk(TPACPI_DBG_INIT, "initializing brightness subdriver\n");
+
        b = brightness_get(NULL);
        if (b < 0)
                return b;
@@ -1658,6 +1903,7 @@ static int brightness_init(void)
                printk(IBM_ERR "Could not register backlight device\n");
                return PTR_ERR(ibm_backlight_device);
        }
+       vdbg_printk(TPACPI_DBG_INIT, "brightness is supported\n");
 
        ibm_backlight_device->props.max_brightness = 7;
        ibm_backlight_device->props.brightness = b;
@@ -1669,6 +1915,8 @@ static int brightness_init(void)
 static void brightness_exit(void)
 {
        if (ibm_backlight_device) {
+               vdbg_printk(TPACPI_DBG_EXIT,
+                           "calling backlight_device_unregister()\n");
                backlight_device_unregister(ibm_backlight_device);
                ibm_backlight_device = NULL;
        }
@@ -1756,6 +2004,13 @@ static int brightness_write(char *buf)
        return 0;
 }
 
+static struct ibm_struct brightness_driver_data = {
+       .name = "brightness",
+       .read = brightness_read,
+       .write = brightness_write,
+       .exit = brightness_exit,
+};
+
 /*************************************************************************
  * Volume subdriver
  */
@@ -1840,6 +2095,11 @@ static int volume_write(char *buf)
        return 0;
 }
 
+static struct ibm_struct volume_driver_data = {
+       .name = "volume",
+       .read = volume_read,
+       .write = volume_write,
+};
 
 /*************************************************************************
  * Fan subdriver
@@ -1848,20 +2108,21 @@ static int volume_write(char *buf)
 /*
  * FAN ACCESS MODES
  *
- * IBMACPI_FAN_RD_ACPI_GFAN:
+ * TPACPI_FAN_RD_ACPI_GFAN:
  *     ACPI GFAN method: returns fan level
  *
- *     see IBMACPI_FAN_WR_ACPI_SFAN
- *     EC 0x2f not available if GFAN exists
+ *     see TPACPI_FAN_WR_ACPI_SFAN
+ *     EC 0x2f (HFSP) not available if GFAN exists
  *
- * IBMACPI_FAN_WR_ACPI_SFAN:
+ * TPACPI_FAN_WR_ACPI_SFAN:
  *     ACPI SFAN method: sets fan level, 0 (stop) to 7 (max)
  *
- *     EC 0x2f might be available *for reading*, but never for writing.
+ *     EC 0x2f (HFSP) might be available *for reading*, but do not use
+ *     it for writing.
  *
- * IBMACPI_FAN_WR_TPEC:
- *     ThinkPad EC register 0x2f (HFSP): fan control loop mode Supported
- *     on almost all ThinkPads
+ * TPACPI_FAN_WR_TPEC:
+ *     ThinkPad EC register 0x2f (HFSP): fan control loop mode
+ *     Supported on almost all ThinkPads
  *
  *     Fan speed changes of any sort (including those caused by the
  *     disengaged mode) are usually done slowly by the firmware as the
@@ -1875,12 +2136,13 @@ static int volume_write(char *buf)
  *      7      automatic mode engaged;
  *             (default operation mode of the ThinkPad)
  *             fan level is ignored in this mode.
- *      6      disengage mode (takes precedence over bit 7);
+ *      6      full speed mode (takes precedence over bit 7);
  *             not available on all thinkpads.  May disable
- *             the tachometer, and speeds up fan to 100% duty-cycle,
- *             which speeds it up far above the standard RPM
- *             levels.  It is not impossible that it could cause
- *             hardware damage.
+ *             the tachometer while the fan controller ramps up
+ *             the speed (which can take up to a few *minutes*).
+ *             Speeds up fan to 100% duty-cycle, which is far above
+ *             the standard RPM levels.  It is not impossible that
+ *             it could cause hardware damage.
  *     5-3     unused in some models.  Extra bits for fan level
  *             in others, but still useless as all values above
  *             7 map to the same speed as level 7 in these models.
@@ -1888,7 +2150,7 @@ static int volume_write(char *buf)
  *                     0x00 = stop
  *                     0x07 = max (set when temperatures critical)
  *             Some ThinkPads may have other levels, see
- *             IBMACPI_FAN_WR_ACPI_FANS (X31/X40/X41)
+ *             TPACPI_FAN_WR_ACPI_FANS (X31/X40/X41)
  *
  *     FIRMWARE BUG: on some models, EC 0x2f might not be initialized at
  *     boot. Apparently the EC does not intialize it, so unless ACPI DSDT
@@ -1916,14 +2178,13 @@ static int volume_write(char *buf)
  *     FIRMWARE BUG: always read 0x84 first, otherwise incorrect readings
  *     might result.
  *
- *     FIRMWARE BUG: when EC 0x2f bit 6 is set (disengaged mode), this
- *     register is not invalidated in ThinkPads that disable tachometer
- *     readings.  Thus, the tachometer readings go stale.
+ *     FIRMWARE BUG: may go stale while the EC is switching to full speed
+ *     mode.
  *
  *     For firmware bugs, refer to:
  *     http://thinkwiki.org/wiki/Embedded_Controller_Firmware#Firmware_Issues
  *
- * IBMACPI_FAN_WR_ACPI_FANS:
+ * TPACPI_FAN_WR_ACPI_FANS:
  *     ThinkPad X31, X40, X41.  Not available in the X60.
  *
  *     FANS ACPI handle: takes three arguments: low speed, medium speed,
@@ -1940,7 +2201,7 @@ static int volume_write(char *buf)
  *     ACPI DSDT switches which set is in use depending on various
  *     factors.
  *
- *     IBMACPI_FAN_WR_TPEC is also available and should be used to
+ *     TPACPI_FAN_WR_TPEC is also available and should be used to
  *     command the fan.  The X31/X40/X41 seems to have 8 fan levels,
  *     but the ACPI tables just mention level 7.
  */
@@ -1949,7 +2210,6 @@ static enum fan_status_access_mode fan_status_access_mode;
 static enum fan_control_access_mode fan_control_access_mode;
 static enum fan_control_commands fan_control_commands;
 
-static int fan_control_status_known;
 static u8 fan_control_initial_status;
 
 static void fan_watchdog_fire(struct work_struct *ignored);
@@ -1964,23 +2224,29 @@ IBM_HANDLE(sfan, ec, "SFAN",    /* 570 */
           "JFNS",              /* 770x-JL */
           );                   /* all others */
 
-static int fan_init(void)
+static int __init fan_init(struct ibm_init_struct *iibm)
 {
-       fan_status_access_mode = IBMACPI_FAN_NONE;
-       fan_control_access_mode = IBMACPI_FAN_WR_NONE;
+       vdbg_printk(TPACPI_DBG_INIT, "initializing fan subdriver\n");
+
+       fan_status_access_mode = TPACPI_FAN_NONE;
+       fan_control_access_mode = TPACPI_FAN_WR_NONE;
        fan_control_commands = 0;
-       fan_control_status_known = 1;
        fan_watchdog_maxinterval = 0;
+       tp_features.fan_ctrl_status_undef = 0;
+
+       IBM_ACPIHANDLE_INIT(fans);
+       IBM_ACPIHANDLE_INIT(gfan);
+       IBM_ACPIHANDLE_INIT(sfan);
 
        if (gfan_handle) {
                /* 570, 600e/x, 770e, 770x */
-               fan_status_access_mode = IBMACPI_FAN_RD_ACPI_GFAN;
+               fan_status_access_mode = TPACPI_FAN_RD_ACPI_GFAN;
        } else {
                /* all other ThinkPads: note that even old-style
                 * ThinkPad ECs supports the fan control register */
                if (likely(acpi_ec_read(fan_status_offset,
                                        &fan_control_initial_status))) {
-                       fan_status_access_mode = IBMACPI_FAN_RD_TPEC;
+                       fan_status_access_mode = TPACPI_FAN_RD_TPEC;
 
                        /* In some ThinkPads, neither the EC nor the ACPI
                         * DSDT initialize the fan status, and it ends up
@@ -2003,21 +2269,21 @@ static int fan_init(void)
                                       "fan_init: initial fan status is "
                                       "unknown, assuming it is in auto "
                                       "mode\n");
-                               fan_control_status_known = 0;
+                               tp_features.fan_ctrl_status_undef = 1;
                        }
                } else {
                        printk(IBM_ERR
                               "ThinkPad ACPI EC access misbehaving, "
                               "fan status and control unavailable\n");
-                       return 0;
+                       return 1;
                }
        }
 
        if (sfan_handle) {
                /* 570, 770x-JL */
-               fan_control_access_mode = IBMACPI_FAN_WR_ACPI_SFAN;
+               fan_control_access_mode = TPACPI_FAN_WR_ACPI_SFAN;
                fan_control_commands |=
-                   IBMACPI_FAN_CMD_LEVEL | IBMACPI_FAN_CMD_ENABLE;
+                   TPACPI_FAN_CMD_LEVEL | TPACPI_FAN_CMD_ENABLE;
        } else {
                if (!gfan_handle) {
                        /* gfan without sfan means no fan control */
@@ -2026,21 +2292,28 @@ static int fan_init(void)
                        if (fans_handle) {
                                /* X31, X40, X41 */
                                fan_control_access_mode =
-                                   IBMACPI_FAN_WR_ACPI_FANS;
+                                   TPACPI_FAN_WR_ACPI_FANS;
                                fan_control_commands |=
-                                   IBMACPI_FAN_CMD_SPEED |
-                                   IBMACPI_FAN_CMD_LEVEL |
-                                   IBMACPI_FAN_CMD_ENABLE;
+                                   TPACPI_FAN_CMD_SPEED |
+                                   TPACPI_FAN_CMD_LEVEL |
+                                   TPACPI_FAN_CMD_ENABLE;
                        } else {
-                               fan_control_access_mode = IBMACPI_FAN_WR_TPEC;
+                               fan_control_access_mode = TPACPI_FAN_WR_TPEC;
                                fan_control_commands |=
-                                   IBMACPI_FAN_CMD_LEVEL |
-                                   IBMACPI_FAN_CMD_ENABLE;
+                                   TPACPI_FAN_CMD_LEVEL |
+                                   TPACPI_FAN_CMD_ENABLE;
                        }
                }
        }
 
-       return 0;
+       vdbg_printk(TPACPI_DBG_INIT, "fan is %s, modes %d, %d\n",
+               str_supported(fan_status_access_mode != TPACPI_FAN_NONE ||
+                 fan_control_access_mode != TPACPI_FAN_WR_NONE),
+               fan_status_access_mode, fan_control_access_mode);
+
+       return (fan_status_access_mode != TPACPI_FAN_NONE ||
+               fan_control_access_mode != TPACPI_FAN_WR_NONE)?
+                       0 : 1;
 }
 
 static int fan_get_status(u8 *status)
@@ -2048,10 +2321,10 @@ static int fan_get_status(u8 *status)
        u8 s;
 
        /* TODO:
-        * Add IBMACPI_FAN_RD_ACPI_FANS ? */
+        * Add TPACPI_FAN_RD_ACPI_FANS ? */
 
        switch (fan_status_access_mode) {
-       case IBMACPI_FAN_RD_ACPI_GFAN:
+       case TPACPI_FAN_RD_ACPI_GFAN:
                /* 570, 600e/x, 770e, 770x */
 
                if (unlikely(!acpi_evalf(gfan_handle, &s, NULL, "d")))
@@ -2062,7 +2335,7 @@ static int fan_get_status(u8 *status)
 
                break;
 
-       case IBMACPI_FAN_RD_TPEC:
+       case TPACPI_FAN_RD_TPEC:
                /* all except 570, 600e/x, 770e, 770x */
                if (unlikely(!acpi_ec_read(fan_status_offset, &s)))
                        return -EIO;
@@ -2081,6 +2354,7 @@ static int fan_get_status(u8 *status)
 
 static void fan_exit(void)
 {
+       vdbg_printk(TPACPI_DBG_EXIT, "cancelling any pending watchdogs\n");
        cancel_delayed_work(&fan_watchdog_task);
        flush_scheduled_work();
 }
@@ -2090,7 +2364,7 @@ static int fan_get_speed(unsigned int *speed)
        u8 hi, lo;
 
        switch (fan_status_access_mode) {
-       case IBMACPI_FAN_RD_TPEC:
+       case TPACPI_FAN_RD_TPEC:
                /* all except 570, 600e/x, 770e, 770x */
                if (unlikely(!acpi_ec_read(fan_rpm_offset, &lo) ||
                             !acpi_ec_read(fan_rpm_offset + 1, &hi)))
@@ -2140,7 +2414,7 @@ static void fan_watchdog_reset(void)
 static int fan_set_level(int level)
 {
        switch (fan_control_access_mode) {
-       case IBMACPI_FAN_WR_ACPI_SFAN:
+       case TPACPI_FAN_WR_ACPI_SFAN:
                if (level >= 0 && level <= 7) {
                        if (!acpi_evalf(sfan_handle, NULL, NULL, "vd", level))
                                return -EIO;
@@ -2148,17 +2422,17 @@ static int fan_set_level(int level)
                        return -EINVAL;
                break;
 
-       case IBMACPI_FAN_WR_ACPI_FANS:
-       case IBMACPI_FAN_WR_TPEC:
-               if ((level != IBMACPI_FAN_EC_AUTO) &&
-                   (level != IBMACPI_FAN_EC_DISENGAGED) &&
+       case TPACPI_FAN_WR_ACPI_FANS:
+       case TPACPI_FAN_WR_TPEC:
+               if ((level != TP_EC_FAN_AUTO) &&
+                   (level != TP_EC_FAN_FULLSPEED) &&
                    ((level < 0) || (level > 7)))
                        return -EINVAL;
 
                if (!acpi_ec_write(fan_status_offset, level))
                        return -EIO;
                else
-                       fan_control_status_known = 1;
+                       tp_features.fan_ctrl_status_undef = 0;
                break;
 
        default:
@@ -2173,22 +2447,22 @@ static int fan_set_enable(void)
        int rc;
 
        switch (fan_control_access_mode) {
-       case IBMACPI_FAN_WR_ACPI_FANS:
-       case IBMACPI_FAN_WR_TPEC:
+       case TPACPI_FAN_WR_ACPI_FANS:
+       case TPACPI_FAN_WR_TPEC:
                if ((rc = fan_get_status(&s)) < 0)
                        return rc;
 
                /* Don't go out of emergency fan mode */
                if (s != 7)
-                       s = IBMACPI_FAN_EC_AUTO;
+                       s = TP_EC_FAN_AUTO;
 
                if (!acpi_ec_write(fan_status_offset, s))
                        return -EIO;
                else
-                       fan_control_status_known = 1;
+                       tp_features.fan_ctrl_status_undef = 0;
                break;
 
-       case IBMACPI_FAN_WR_ACPI_SFAN:
+       case TPACPI_FAN_WR_ACPI_SFAN:
                if ((rc = fan_get_status(&s)) < 0)
                        return rc;
 
@@ -2211,15 +2485,15 @@ static int fan_set_enable(void)
 static int fan_set_disable(void)
 {
        switch (fan_control_access_mode) {
-       case IBMACPI_FAN_WR_ACPI_FANS:
-       case IBMACPI_FAN_WR_TPEC:
+       case TPACPI_FAN_WR_ACPI_FANS:
+       case TPACPI_FAN_WR_TPEC:
                if (!acpi_ec_write(fan_status_offset, 0x00))
                        return -EIO;
                else
-                       fan_control_status_known = 1;
+                       tp_features.fan_ctrl_status_undef = 0;
                break;
 
-       case IBMACPI_FAN_WR_ACPI_SFAN:
+       case TPACPI_FAN_WR_ACPI_SFAN:
                if (!acpi_evalf(sfan_handle, NULL, NULL, "vd", 0x00))
                        return -EIO;
                break;
@@ -2233,7 +2507,7 @@ static int fan_set_disable(void)
 static int fan_set_speed(int speed)
 {
        switch (fan_control_access_mode) {
-       case IBMACPI_FAN_WR_ACPI_FANS:
+       case TPACPI_FAN_WR_ACPI_FANS:
                if (speed >= 0 && speed <= 65535) {
                        if (!acpi_evalf(fans_handle, NULL, NULL, "vddd",
                                        speed, speed, speed))
@@ -2256,7 +2530,7 @@ static int fan_read(char *p)
        unsigned int speed = 0;
 
        switch (fan_status_access_mode) {
-       case IBMACPI_FAN_RD_ACPI_GFAN:
+       case TPACPI_FAN_RD_ACPI_GFAN:
                /* 570, 600e/x, 770e, 770x */
                if ((rc = fan_get_status(&status)) < 0)
                        return rc;
@@ -2266,50 +2540,47 @@ static int fan_read(char *p)
                               (status != 0) ? "enabled" : "disabled", status);
                break;
 
-       case IBMACPI_FAN_RD_TPEC:
+       case TPACPI_FAN_RD_TPEC:
                /* all except 570, 600e/x, 770e, 770x */
                if ((rc = fan_get_status(&status)) < 0)
                        return rc;
 
-               if (unlikely(!fan_control_status_known)) {
+               if (unlikely(tp_features.fan_ctrl_status_undef)) {
                        if (status != fan_control_initial_status)
-                               fan_control_status_known = 1;
+                               tp_features.fan_ctrl_status_undef = 0;
                        else
                                /* Return most likely status. In fact, it
                                 * might be the only possible status */
-                               status = IBMACPI_FAN_EC_AUTO;
+                               status = TP_EC_FAN_AUTO;
                }
 
                len += sprintf(p + len, "status:\t\t%s\n",
                               (status != 0) ? "enabled" : "disabled");
 
-               /* No ThinkPad boots on disengaged mode, we can safely
-                * assume the tachometer is online if fan control status
-                * was unknown */
                if ((rc = fan_get_speed(&speed)) < 0)
                        return rc;
 
                len += sprintf(p + len, "speed:\t\t%d\n", speed);
 
-               if (status & IBMACPI_FAN_EC_DISENGAGED)
+               if (status & TP_EC_FAN_FULLSPEED)
                        /* Disengaged mode takes precedence */
                        len += sprintf(p + len, "level:\t\tdisengaged\n");
-               else if (status & IBMACPI_FAN_EC_AUTO)
+               else if (status & TP_EC_FAN_AUTO)
                        len += sprintf(p + len, "level:\t\tauto\n");
                else
                        len += sprintf(p + len, "level:\t\t%d\n", status);
                break;
 
-       case IBMACPI_FAN_NONE:
+       case TPACPI_FAN_NONE:
        default:
                len += sprintf(p + len, "status:\t\tnot supported\n");
        }
 
-       if (fan_control_commands & IBMACPI_FAN_CMD_LEVEL) {
+       if (fan_control_commands & TPACPI_FAN_CMD_LEVEL) {
                len += sprintf(p + len, "commands:\tlevel <level>");
 
                switch (fan_control_access_mode) {
-               case IBMACPI_FAN_WR_ACPI_SFAN:
+               case TPACPI_FAN_WR_ACPI_SFAN:
                        len += sprintf(p + len, " (<level> is 0-7)\n");
                        break;
 
@@ -2320,12 +2591,12 @@ static int fan_read(char *p)
                }
        }
 
-       if (fan_control_commands & IBMACPI_FAN_CMD_ENABLE)
+       if (fan_control_commands & TPACPI_FAN_CMD_ENABLE)
                len += sprintf(p + len, "commands:\tenable, disable\n"
                               "commands:\twatchdog <timeout> (<timeout> is 0 (off), "
                               "1-120 (seconds))\n");
 
-       if (fan_control_commands & IBMACPI_FAN_CMD_SPEED)
+       if (fan_control_commands & TPACPI_FAN_CMD_SPEED)
                len += sprintf(p + len, "commands:\tspeed <speed>"
                               " (<speed> is 0-65535)\n");
 
@@ -2337,9 +2608,9 @@ static int fan_write_cmd_level(const char *cmd, int *rc)
        int level;
 
        if (strlencmp(cmd, "level auto") == 0)
-               level = IBMACPI_FAN_EC_AUTO;
+               level = TP_EC_FAN_AUTO;
        else if (strlencmp(cmd, "level disengaged") == 0)
-               level = IBMACPI_FAN_EC_DISENGAGED;
+               level = TP_EC_FAN_FULLSPEED;
        else if (sscanf(cmd, "level %d", &level) != 1)
                return 0;
 
@@ -2412,13 +2683,13 @@ static int fan_write(char *buf)
        int rc = 0;
 
        while (!rc && (cmd = next_cmd(&buf))) {
-               if (!((fan_control_commands & IBMACPI_FAN_CMD_LEVEL) &&
+               if (!((fan_control_commands & TPACPI_FAN_CMD_LEVEL) &&
                      fan_write_cmd_level(cmd, &rc)) &&
-                   !((fan_control_commands & IBMACPI_FAN_CMD_ENABLE) &&
+                   !((fan_control_commands & TPACPI_FAN_CMD_ENABLE) &&
                      (fan_write_cmd_enable(cmd, &rc) ||
                       fan_write_cmd_disable(cmd, &rc) ||
                       fan_write_cmd_watchdog(cmd, &rc))) &&
-                   !((fan_control_commands & IBMACPI_FAN_CMD_SPEED) &&
+                   !((fan_control_commands & TPACPI_FAN_CMD_SPEED) &&
                      fan_write_cmd_speed(cmd, &rc))
                    )
                        rc = -EINVAL;
@@ -2429,6 +2700,14 @@ static int fan_write(char *buf)
        return rc;
 }
 
+static struct ibm_struct fan_driver_data = {
+       .name = "fan",
+       .read = fan_read,
+       .write = fan_write,
+       .exit = fan_exit,
+       .flags.experimental = 1,
+};
+
 /****************************************************************************
  ****************************************************************************
  *
@@ -2441,152 +2720,71 @@ static int fan_write(char *buf)
 static struct proc_dir_entry *proc_dir = NULL;
 
 /* Subdriver registry */
-static struct ibm_struct ibms[] = {
-       {
-        .name = "driver",
-        .init = thinkpad_acpi_driver_init,
-        .read = thinkpad_acpi_driver_read,
-        },
-       {
-        .name = "hotkey",
-        .hid = IBM_HKEY_HID,
-        .init = hotkey_init,
-        .read = hotkey_read,
-        .write = hotkey_write,
-        .exit = hotkey_exit,
-        .notify = hotkey_notify,
-        .handle = &hkey_handle,
-        .type = ACPI_DEVICE_NOTIFY,
-        },
-       {
-        .name = "bluetooth",
-        .init = bluetooth_init,
-        .read = bluetooth_read,
-        .write = bluetooth_write,
-        },
-       {
-        .name = "wan",
-        .init = wan_init,
-        .read = wan_read,
-        .write = wan_write,
-        .experimental = 1,
-        },
-       {
-        .name = "video",
-        .init = video_init,
-        .read = video_read,
-        .write = video_write,
-        .exit = video_exit,
-        },
-       {
-        .name = "light",
-        .init = light_init,
-        .read = light_read,
-        .write = light_write,
-        },
-#ifdef CONFIG_THINKPAD_ACPI_DOCK
-       {
-        .name = "dock",
-        .read = dock_read,
-        .write = dock_write,
-        .notify = dock_notify,
-        .handle = &dock_handle,
-        .type = ACPI_SYSTEM_NOTIFY,
-        },
-       {
-        .name = "dock",
-        .hid = IBM_PCI_HID,
-        .notify = dock_notify,
-        .handle = &pci_handle,
-        .type = ACPI_SYSTEM_NOTIFY,
-        },
-#endif
-#ifdef CONFIG_THINKPAD_ACPI_BAY
-       {
-        .name = "bay",
-        .init = bay_init,
-        .read = bay_read,
-        .write = bay_write,
-        .notify = bay_notify,
-        .handle = &bay_handle,
-        .type = ACPI_SYSTEM_NOTIFY,
-        },
-#endif /* CONFIG_THINKPAD_ACPI_BAY */
-       {
-        .name = "cmos",
-        .read = cmos_read,
-        .write = cmos_write,
-        },
-       {
-        .name = "led",
-        .init = led_init,
-        .read = led_read,
-        .write = led_write,
-        },
-       {
-        .name = "beep",
-        .read = beep_read,
-        .write = beep_write,
-        },
-       {
-        .name = "thermal",
-        .init = thermal_init,
-        .read = thermal_read,
-        },
-       {
-        .name = "ecdump",
-        .read = ecdump_read,
-        .write = ecdump_write,
-        .experimental = 1,
-        },
-       {
-        .name = "brightness",
-        .read = brightness_read,
-        .write = brightness_write,
-        .init = brightness_init,
-        .exit = brightness_exit,
-        },
-       {
-        .name = "volume",
-        .read = volume_read,
-        .write = volume_write,
-        },
-       {
-        .name = "fan",
-        .read = fan_read,
-        .write = fan_write,
-        .init = fan_init,
-        .exit = fan_exit,
-        .experimental = 1,
-        },
-};
+static LIST_HEAD(tpacpi_all_drivers);
+
 
 /*
  * Module and infrastructure proble, init and exit handling
  */
 
-static int __init ibm_init(struct ibm_struct *ibm)
+#ifdef CONFIG_THINKPAD_ACPI_DEBUG
+static const char * __init str_supported(int is_supported)
+{
+       static char text_unsupported[] __initdata = "not supported";
+
+       return (is_supported)? &text_unsupported[4] : &text_unsupported[0];
+}
+#endif /* CONFIG_THINKPAD_ACPI_DEBUG */
+
+static int __init ibm_init(struct ibm_init_struct *iibm)
 {
        int ret;
+       struct ibm_struct *ibm = iibm->data;
        struct proc_dir_entry *entry;
 
-       if (ibm->experimental && !experimental)
+       BUG_ON(ibm == NULL);
+
+       INIT_LIST_HEAD(&ibm->all_drivers);
+
+       if (ibm->flags.experimental && !experimental)
                return 0;
 
-       if (ibm->hid) {
-               ret = register_tpacpi_subdriver(ibm);
-               if (ret < 0)
+       dbg_printk(TPACPI_DBG_INIT,
+               "probing for %s\n", ibm->name);
+
+       if (iibm->init) {
+               ret = iibm->init(iibm);
+               if (ret > 0)
+                       return 0;       /* probe failed */
+               if (ret)
                        return ret;
-               ibm->driver_registered = 1;
+
+               ibm->flags.init_called = 1;
        }
 
-       if (ibm->init) {
-               ret = ibm->init();
-               if (ret != 0)
-                       return ret;
-               ibm->init_called = 1;
+       if (ibm->acpi) {
+               if (ibm->acpi->hid) {
+                       ret = register_tpacpi_subdriver(ibm);
+                       if (ret)
+                               goto err_out;
+               }
+
+               if (ibm->acpi->notify) {
+                       ret = setup_acpi_notify(ibm);
+                       if (ret == -ENODEV) {
+                               printk(IBM_NOTICE "disabling subdriver %s\n",
+                                       ibm->name);
+                               ret = 0;
+                               goto err_out;
+                       }
+                       if (ret < 0)
+                               goto err_out;
+               }
        }
 
+       dbg_printk(TPACPI_DBG_INIT,
+               "%s installed\n", ibm->name);
+
        if (ibm->read) {
                entry = create_proc_entry(ibm->name,
                                          S_IFREG | S_IRUGO | S_IWUSR,
@@ -2594,47 +2792,70 @@ static int __init ibm_init(struct ibm_struct *ibm)
                if (!entry) {
                        printk(IBM_ERR "unable to create proc entry %s\n",
                               ibm->name);
-                       return -ENODEV;
+                       ret = -ENODEV;
+                       goto err_out;
                }
                entry->owner = THIS_MODULE;
                entry->data = ibm;
-               entry->read_proc = &dispatch_read;
+               entry->read_proc = &dispatch_procfs_read;
                if (ibm->write)
-                       entry->write_proc = &dispatch_write;
-               ibm->proc_created = 1;
+                       entry->write_proc = &dispatch_procfs_write;
+               ibm->flags.proc_created = 1;
        }
 
-       if (ibm->notify) {
-               ret = setup_notify(ibm);
-               if (ret == -ENODEV) {
-                       printk(IBM_NOTICE "disabling subdriver %s\n",
-                               ibm->name);
-                       ibm_exit(ibm);
-                       return 0;
-               }
-               if (ret < 0)
-                       return ret;
-       }
+       list_add_tail(&ibm->all_drivers, &tpacpi_all_drivers);
 
        return 0;
+
+err_out:
+       dbg_printk(TPACPI_DBG_INIT,
+               "%s: at error exit path with result %d\n",
+               ibm->name, ret);
+
+       ibm_exit(ibm);
+       return (ret < 0)? ret : 0;
 }
 
 static void ibm_exit(struct ibm_struct *ibm)
 {
-       if (ibm->notify_installed)
-               acpi_remove_notify_handler(*ibm->handle, ibm->type,
-                                          dispatch_notify);
+       dbg_printk(TPACPI_DBG_EXIT, "removing %s\n", ibm->name);
+
+       list_del_init(&ibm->all_drivers);
+
+       if (ibm->flags.acpi_notify_installed) {
+               dbg_printk(TPACPI_DBG_EXIT,
+                       "%s: acpi_remove_notify_handler\n", ibm->name);
+               BUG_ON(!ibm->acpi);
+               acpi_remove_notify_handler(*ibm->acpi->handle,
+                                          ibm->acpi->type,
+                                          dispatch_acpi_notify);
+               ibm->flags.acpi_notify_installed = 0;
+               ibm->flags.acpi_notify_installed = 0;
+       }
 
-       if (ibm->proc_created)
+       if (ibm->flags.proc_created) {
+               dbg_printk(TPACPI_DBG_EXIT,
+                       "%s: remove_proc_entry\n", ibm->name);
                remove_proc_entry(ibm->name, proc_dir);
+               ibm->flags.proc_created = 0;
+       }
 
-       if (ibm->init_called && ibm->exit)
-               ibm->exit();
+       if (ibm->flags.acpi_driver_registered) {
+               dbg_printk(TPACPI_DBG_EXIT,
+                       "%s: acpi_bus_unregister_driver\n", ibm->name);
+               BUG_ON(!ibm->acpi);
+               acpi_bus_unregister_driver(ibm->acpi->driver);
+               kfree(ibm->acpi->driver);
+               ibm->acpi->driver = NULL;
+               ibm->flags.acpi_driver_registered = 0;
+       }
 
-       if (ibm->driver_registered) {
-               acpi_bus_unregister_driver(ibm->driver);
-               kfree(ibm->driver);
+       if (ibm->flags.init_called && ibm->exit) {
+               ibm->exit();
+               ibm->flags.init_called = 0;
        }
+
+       dbg_printk(TPACPI_DBG_INIT, "finished removing %s\n", ibm->name);
 }
 
 /* Probing */
@@ -2665,20 +2886,133 @@ static char* __init check_dmi_for_ec(void)
        return NULL;
 }
 
+static int __init probe_for_thinkpad(void)
+{
+       int is_thinkpad;
+
+       if (acpi_disabled)
+               return -ENODEV;
+
+       /*
+        * Non-ancient models have better DMI tagging, but very old models
+        * don't.
+        */
+       is_thinkpad = dmi_name_in_vendors("ThinkPad");
+
+       /* ec is required because many other handles are relative to it */
+       IBM_ACPIHANDLE_INIT(ec);
+       if (!ec_handle) {
+               if (is_thinkpad)
+                       printk(IBM_ERR
+                               "Not yet supported ThinkPad detected!\n");
+               return -ENODEV;
+       }
+
+       /*
+        * Risks a regression on very old machines, but reduces potential
+        * false positives a damn great deal
+        */
+       if (!is_thinkpad)
+               is_thinkpad = dmi_name_in_vendors("IBM");
+
+       if (!is_thinkpad && !force_load)
+               return -ENODEV;
+
+       return 0;
+}
+
+
 /* Module init, exit, parameters */
 
+static struct ibm_init_struct ibms_init[] __initdata = {
+       {
+               .init = thinkpad_acpi_driver_init,
+               .data = &thinkpad_acpi_driver_data,
+       },
+       {
+               .init = hotkey_init,
+               .data = &hotkey_driver_data,
+       },
+       {
+               .init = bluetooth_init,
+               .data = &bluetooth_driver_data,
+       },
+       {
+               .init = wan_init,
+               .data = &wan_driver_data,
+       },
+       {
+               .init = video_init,
+               .data = &video_driver_data,
+       },
+       {
+               .init = light_init,
+               .data = &light_driver_data,
+       },
+#ifdef CONFIG_THINKPAD_ACPI_DOCK
+       {
+               .init = dock_init,
+               .data = &dock_driver_data[0],
+       },
+       {
+               .data = &dock_driver_data[1],
+       },
+#endif
+#ifdef CONFIG_THINKPAD_ACPI_BAY
+       {
+               .init = bay_init,
+               .data = &bay_driver_data,
+       },
+#endif
+       {
+               .init = cmos_init,
+               .data = &cmos_driver_data,
+       },
+       {
+               .init = led_init,
+               .data = &led_driver_data,
+       },
+       {
+               .init = beep_init,
+               .data = &beep_driver_data,
+       },
+       {
+               .init = thermal_init,
+               .data = &thermal_driver_data,
+       },
+       {
+               .data = &ecdump_driver_data,
+       },
+       {
+               .init = brightness_init,
+               .data = &brightness_driver_data,
+       },
+       {
+               .data = &volume_driver_data,
+       },
+       {
+               .init = fan_init,
+               .data = &fan_driver_data,
+       },
+};
+
 static int __init set_ibm_param(const char *val, struct kernel_param *kp)
 {
        unsigned int i;
+       struct ibm_struct *ibm;
 
-       for (i = 0; i < ARRAY_SIZE(ibms); i++)
-               if (strcmp(ibms[i].name, kp->name) == 0 && ibms[i].write) {
-                       if (strlen(val) > sizeof(ibms[i].param) - 2)
+       for (i = 0; i < ARRAY_SIZE(ibms_init); i++) {
+               ibm = ibms_init[i].data;
+               BUG_ON(ibm == NULL);
+
+               if (strcmp(ibm->name, kp->name) == 0 && ibm->write) {
+                       if (strlen(val) > sizeof(ibms_init[i].param) - 2)
                                return -ENOSPC;
-                       strcpy(ibms[i].param, val);
-                       strcat(ibms[i].param, ",");
+                       strcpy(ibms_init[i].param, val);
+                       strcat(ibms_init[i].param, ",");
                        return 0;
                }
+       }
 
        return -EINVAL;
 }
@@ -2686,6 +3020,12 @@ static int __init set_ibm_param(const char *val, struct kernel_param *kp)
 static int experimental;
 module_param(experimental, int, 0);
 
+static u32 dbg_level;
+module_param_named(debug, dbg_level, uint, 0);
+
+static int force_load;
+module_param(force_load, int, 0);
+
 #define IBM_PARAM(feature) \
        module_param_call(feature, set_ibm_param, NULL, NULL, 0)
 
@@ -2711,58 +3051,26 @@ static int __init thinkpad_acpi_module_init(void)
 {
        int ret, i;
 
-       if (acpi_disabled)
-               return -ENODEV;
+       ret = probe_for_thinkpad();
+       if (ret)
+               return ret;
 
-       /* ec is required because many other handles are relative to it */
-       IBM_HANDLE_INIT(ec);
-       if (!ec_handle) {
-               printk(IBM_ERR "ec object not found\n");
-               return -ENODEV;
-       }
-
-       /* Models with newer firmware report the EC in DMI */
        ibm_thinkpad_ec_found = check_dmi_for_ec();
+       IBM_ACPIHANDLE_INIT(ecrd);
+       IBM_ACPIHANDLE_INIT(ecwr);
 
-       /* these handles are not required */
-       IBM_HANDLE_INIT(vid);
-       IBM_HANDLE_INIT(vid2);
-       IBM_HANDLE_INIT(ledb);
-       IBM_HANDLE_INIT(led);
-       IBM_HANDLE_INIT(hkey);
-       IBM_HANDLE_INIT(lght);
-       IBM_HANDLE_INIT(cmos);
-#ifdef CONFIG_THINKPAD_ACPI_DOCK
-       IBM_HANDLE_INIT(dock);
-#endif
-       IBM_HANDLE_INIT(pci);
-#ifdef CONFIG_THINKPAD_ACPI_BAY
-       IBM_HANDLE_INIT(bay);
-       if (bay_handle)
-               IBM_HANDLE_INIT(bay_ej);
-       IBM_HANDLE_INIT(bay2);
-       if (bay2_handle)
-               IBM_HANDLE_INIT(bay2_ej);
-#endif /* CONFIG_THINKPAD_ACPI_BAY */
-       IBM_HANDLE_INIT(beep);
-       IBM_HANDLE_INIT(ecrd);
-       IBM_HANDLE_INIT(ecwr);
-       IBM_HANDLE_INIT(fans);
-       IBM_HANDLE_INIT(gfan);
-       IBM_HANDLE_INIT(sfan);
-
-       proc_dir = proc_mkdir(IBM_DIR, acpi_root_dir);
+       proc_dir = proc_mkdir(IBM_PROC_DIR, acpi_root_dir);
        if (!proc_dir) {
-               printk(IBM_ERR "unable to create proc dir %s", IBM_DIR);
+               printk(IBM_ERR "unable to create proc dir " IBM_PROC_DIR);
                thinkpad_acpi_module_exit();
                return -ENODEV;
        }
        proc_dir->owner = THIS_MODULE;
 
-       for (i = 0; i < ARRAY_SIZE(ibms); i++) {
-               ret = ibm_init(&ibms[i]);
-               if (ret >= 0 && *ibms[i].param)
-                       ret = ibms[i].write(ibms[i].param);
+       for (i = 0; i < ARRAY_SIZE(ibms_init); i++) {
+               ret = ibm_init(&ibms_init[i]);
+               if (ret >= 0 && *ibms_init[i].param)
+                       ret = ibms_init[i].data->write(ibms_init[i].param);
                if (ret < 0) {
                        thinkpad_acpi_module_exit();
                        return ret;
@@ -2774,16 +3082,20 @@ static int __init thinkpad_acpi_module_init(void)
 
 static void thinkpad_acpi_module_exit(void)
 {
-       int i;
+       struct ibm_struct *ibm, *itmp;
+
+       list_for_each_entry_safe_reverse(ibm, itmp,
+                                        &tpacpi_all_drivers,
+                                        all_drivers) {
+               ibm_exit(ibm);
+       }
 
-       for (i = ARRAY_SIZE(ibms) - 1; i >= 0; i--)
-               ibm_exit(&ibms[i]);
+       dbg_printk(TPACPI_DBG_INIT, "finished subdriver exit path...\n");
 
        if (proc_dir)
-               remove_proc_entry(IBM_DIR, acpi_root_dir);
+               remove_proc_entry(IBM_PROC_DIR, acpi_root_dir);
 
-       if (ibm_thinkpad_ec_found)
-               kfree(ibm_thinkpad_ec_found);
+       kfree(ibm_thinkpad_ec_found);
 }
 
 module_init(thinkpad_acpi_module_init);