Loading drivers/acpi/bay.c +76 −11 Original line number Diff line number Diff line Loading @@ -30,6 +30,7 @@ #include <acpi/acpi_drivers.h> #include <linux/seq_file.h> #include <asm/uaccess.h> #include <linux/platform_device.h> #define ACPI_BAY_DRIVER_NAME "ACPI Removable Drive Bay Driver" Loading @@ -45,7 +46,6 @@ MODULE_LICENSE("GPL"); struct acpi_buffer buffer = {sizeof(prefix), prefix};\ acpi_get_name(h, ACPI_FULL_PATHNAME, &buffer);\ printk(KERN_DEBUG PREFIX "%s: %s\n", prefix, s); } static void bay_notify(acpi_handle handle, u32 event, void *data); static int acpi_bay_add(struct acpi_device *device); static int acpi_bay_remove(struct acpi_device *device, int type); Loading @@ -66,6 +66,7 @@ struct bay { acpi_handle handle; char *name; struct list_head list; struct platform_device *pdev; }; LIST_HEAD(drive_bays); Loading Loading @@ -133,6 +134,33 @@ static void eject_device(acpi_handle handle) pr_debug("Failed to evaluate _EJ0!\n"); } /* * show_present - read method for "present" file in sysfs */ static ssize_t show_present(struct device *dev, struct device_attribute *attr, char *buf) { struct bay *bay = dev_get_drvdata(dev); return snprintf(buf, PAGE_SIZE, "%d\n", bay_present(bay)); } DEVICE_ATTR(present, S_IRUGO, show_present, NULL); /* * write_eject - write method for "eject" file in sysfs */ static ssize_t write_eject(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) { struct bay *bay = dev_get_drvdata(dev); if (!count) return -EINVAL; eject_device(bay->handle); return count; } DEVICE_ATTR(eject, S_IWUSR, NULL, write_eject); /** * is_ata - see if a device is an ata device Loading Loading @@ -218,14 +246,31 @@ static int acpi_bay_add(struct acpi_device *device) static int acpi_bay_add_fs(struct bay *bay) { if (!bay) return -EINVAL; int ret; struct device *dev = &bay->pdev->dev; ret = device_create_file(dev, &dev_attr_present); if (ret) goto add_fs_err; ret = device_create_file(dev, &dev_attr_eject); if (ret) { device_remove_file(dev, &dev_attr_present); goto add_fs_err; } return 0; add_fs_err: bay_dprintk(bay->handle, "Error adding sysfs files\n"); return ret; } static void acpi_bay_remove_fs(struct bay *bay) { if (!bay) return; struct device *dev = &bay->pdev->dev; /* cleanup sysfs */ device_remove_file(dev, &dev_attr_present); device_remove_file(dev, &dev_attr_eject); } static int bay_is_dock_device(acpi_handle handle) Loading @@ -240,10 +285,11 @@ static int bay_is_dock_device(acpi_handle handle) return (is_dock_device(handle) || is_dock_device(parent)); } static int bay_add(acpi_handle handle) static int bay_add(acpi_handle handle, int id) { acpi_status status; struct bay *new_bay; struct platform_device *pdev; struct acpi_buffer nbuffer = {ACPI_ALLOCATE_BUFFER, NULL}; acpi_get_name(handle, ACPI_FULL_PATHNAME, &nbuffer); Loading @@ -252,12 +298,24 @@ static int bay_add(acpi_handle handle) /* * Initialize bay device structure */ new_bay = kmalloc(GFP_ATOMIC, sizeof(*new_bay)); new_bay = kzalloc(GFP_ATOMIC, sizeof(*new_bay)); INIT_LIST_HEAD(&new_bay->list); new_bay->handle = handle; new_bay->name = (char *)nbuffer.pointer; list_add(&new_bay->list, &drive_bays); acpi_bay_add_fs(new_bay); /* initialize platform device stuff */ pdev = platform_device_register_simple(ACPI_BAY_CLASS, id, NULL, 0); if (pdev == NULL) { printk(KERN_ERR PREFIX "Error registering bay device\n"); goto bay_add_err; } new_bay->pdev = pdev; platform_set_drvdata(pdev, new_bay); if (acpi_bay_add_fs(new_bay)) { platform_device_unregister(new_bay->pdev); goto bay_add_err; } /* register for events on this device */ status = acpi_install_notify_handler(handle, ACPI_SYSTEM_NOTIFY, Loading @@ -273,8 +331,14 @@ static int bay_add(acpi_handle handle) bay_dprintk(handle, "Is dependent on dock\n"); register_hotplug_dock_device(handle, bay_notify, new_bay); } list_add(&new_bay->list, &drive_bays); printk(KERN_INFO PREFIX "Bay [%s] Added\n", new_bay->name); return 0; bay_add_err: kfree(new_bay->name); kfree(new_bay); return -ENODEV; } static int acpi_bay_remove(struct acpi_device *device, int type) Loading Loading @@ -393,7 +457,7 @@ find_bay(acpi_handle handle, u32 lvl, void *context, void **rv) */ if (is_ejectable_bay(handle)) { bay_dprintk(handle, "found ejectable bay"); bay_add(handle); if (!bay_add(handle, *count)) (*count)++; } return AE_OK; Loading Loading @@ -429,6 +493,7 @@ static void __exit bay_exit(void) acpi_bay_remove_fs(bay); acpi_remove_notify_handler(bay->handle, ACPI_SYSTEM_NOTIFY, bay_notify); platform_device_unregister(bay->pdev); kfree(bay->name); kfree(bay); } Loading Loading
drivers/acpi/bay.c +76 −11 Original line number Diff line number Diff line Loading @@ -30,6 +30,7 @@ #include <acpi/acpi_drivers.h> #include <linux/seq_file.h> #include <asm/uaccess.h> #include <linux/platform_device.h> #define ACPI_BAY_DRIVER_NAME "ACPI Removable Drive Bay Driver" Loading @@ -45,7 +46,6 @@ MODULE_LICENSE("GPL"); struct acpi_buffer buffer = {sizeof(prefix), prefix};\ acpi_get_name(h, ACPI_FULL_PATHNAME, &buffer);\ printk(KERN_DEBUG PREFIX "%s: %s\n", prefix, s); } static void bay_notify(acpi_handle handle, u32 event, void *data); static int acpi_bay_add(struct acpi_device *device); static int acpi_bay_remove(struct acpi_device *device, int type); Loading @@ -66,6 +66,7 @@ struct bay { acpi_handle handle; char *name; struct list_head list; struct platform_device *pdev; }; LIST_HEAD(drive_bays); Loading Loading @@ -133,6 +134,33 @@ static void eject_device(acpi_handle handle) pr_debug("Failed to evaluate _EJ0!\n"); } /* * show_present - read method for "present" file in sysfs */ static ssize_t show_present(struct device *dev, struct device_attribute *attr, char *buf) { struct bay *bay = dev_get_drvdata(dev); return snprintf(buf, PAGE_SIZE, "%d\n", bay_present(bay)); } DEVICE_ATTR(present, S_IRUGO, show_present, NULL); /* * write_eject - write method for "eject" file in sysfs */ static ssize_t write_eject(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) { struct bay *bay = dev_get_drvdata(dev); if (!count) return -EINVAL; eject_device(bay->handle); return count; } DEVICE_ATTR(eject, S_IWUSR, NULL, write_eject); /** * is_ata - see if a device is an ata device Loading Loading @@ -218,14 +246,31 @@ static int acpi_bay_add(struct acpi_device *device) static int acpi_bay_add_fs(struct bay *bay) { if (!bay) return -EINVAL; int ret; struct device *dev = &bay->pdev->dev; ret = device_create_file(dev, &dev_attr_present); if (ret) goto add_fs_err; ret = device_create_file(dev, &dev_attr_eject); if (ret) { device_remove_file(dev, &dev_attr_present); goto add_fs_err; } return 0; add_fs_err: bay_dprintk(bay->handle, "Error adding sysfs files\n"); return ret; } static void acpi_bay_remove_fs(struct bay *bay) { if (!bay) return; struct device *dev = &bay->pdev->dev; /* cleanup sysfs */ device_remove_file(dev, &dev_attr_present); device_remove_file(dev, &dev_attr_eject); } static int bay_is_dock_device(acpi_handle handle) Loading @@ -240,10 +285,11 @@ static int bay_is_dock_device(acpi_handle handle) return (is_dock_device(handle) || is_dock_device(parent)); } static int bay_add(acpi_handle handle) static int bay_add(acpi_handle handle, int id) { acpi_status status; struct bay *new_bay; struct platform_device *pdev; struct acpi_buffer nbuffer = {ACPI_ALLOCATE_BUFFER, NULL}; acpi_get_name(handle, ACPI_FULL_PATHNAME, &nbuffer); Loading @@ -252,12 +298,24 @@ static int bay_add(acpi_handle handle) /* * Initialize bay device structure */ new_bay = kmalloc(GFP_ATOMIC, sizeof(*new_bay)); new_bay = kzalloc(GFP_ATOMIC, sizeof(*new_bay)); INIT_LIST_HEAD(&new_bay->list); new_bay->handle = handle; new_bay->name = (char *)nbuffer.pointer; list_add(&new_bay->list, &drive_bays); acpi_bay_add_fs(new_bay); /* initialize platform device stuff */ pdev = platform_device_register_simple(ACPI_BAY_CLASS, id, NULL, 0); if (pdev == NULL) { printk(KERN_ERR PREFIX "Error registering bay device\n"); goto bay_add_err; } new_bay->pdev = pdev; platform_set_drvdata(pdev, new_bay); if (acpi_bay_add_fs(new_bay)) { platform_device_unregister(new_bay->pdev); goto bay_add_err; } /* register for events on this device */ status = acpi_install_notify_handler(handle, ACPI_SYSTEM_NOTIFY, Loading @@ -273,8 +331,14 @@ static int bay_add(acpi_handle handle) bay_dprintk(handle, "Is dependent on dock\n"); register_hotplug_dock_device(handle, bay_notify, new_bay); } list_add(&new_bay->list, &drive_bays); printk(KERN_INFO PREFIX "Bay [%s] Added\n", new_bay->name); return 0; bay_add_err: kfree(new_bay->name); kfree(new_bay); return -ENODEV; } static int acpi_bay_remove(struct acpi_device *device, int type) Loading Loading @@ -393,7 +457,7 @@ find_bay(acpi_handle handle, u32 lvl, void *context, void **rv) */ if (is_ejectable_bay(handle)) { bay_dprintk(handle, "found ejectable bay"); bay_add(handle); if (!bay_add(handle, *count)) (*count)++; } return AE_OK; Loading Loading @@ -429,6 +493,7 @@ static void __exit bay_exit(void) acpi_bay_remove_fs(bay); acpi_remove_notify_handler(bay->handle, ACPI_SYSTEM_NOTIFY, bay_notify); platform_device_unregister(bay->pdev); kfree(bay->name); kfree(bay); } Loading