Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 | /* * Toshiba Bluetooth Enable Driver * * Copyright (C) 2009 Jes Sorensen <Jes.Sorensen@gmail.com> * * Thanks to Matthew Garrett for background info on ACPI innards which * normal people aren't meant to understand :-) * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as * published by the Free Software Foundation. * * Note the Toshiba Bluetooth RFKill switch seems to be a strange * fish. It only provides a BT event when the switch is flipped to * the 'on' position. When flipping it to 'off', the USB device is * simply pulled away underneath us, without any BT event being * delivered. */ #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt #include <linux/kernel.h> #include <linux/module.h> #include <linux/init.h> #include <linux/types.h> #include <linux/acpi.h> MODULE_AUTHOR("Jes Sorensen <Jes.Sorensen@gmail.com>"); MODULE_DESCRIPTION("Toshiba Laptop ACPI Bluetooth Enable Driver"); MODULE_LICENSE("GPL"); static int toshiba_bt_rfkill_add(struct acpi_device *device); static int toshiba_bt_rfkill_remove(struct acpi_device *device); static void toshiba_bt_rfkill_notify(struct acpi_device *device, u32 event); static const struct acpi_device_id bt_device_ids[] = { { "TOS6205", 0}, { "", 0}, }; MODULE_DEVICE_TABLE(acpi, bt_device_ids); #ifdef CONFIG_PM_SLEEP static int toshiba_bt_resume(struct device *dev); #endif static SIMPLE_DEV_PM_OPS(toshiba_bt_pm, NULL, toshiba_bt_resume); static struct acpi_driver toshiba_bt_rfkill_driver = { .name = "Toshiba BT", .class = "Toshiba", .ids = bt_device_ids, .ops = { .add = toshiba_bt_rfkill_add, .remove = toshiba_bt_rfkill_remove, .notify = toshiba_bt_rfkill_notify, }, .owner = THIS_MODULE, .drv.pm = &toshiba_bt_pm, }; static int toshiba_bluetooth_enable(acpi_handle handle) { acpi_status res1, res2; u64 result; /* * Query ACPI to verify RFKill switch is set to 'on'. * If not, we return silently, no need to report it as * an error. */ res1 = acpi_evaluate_integer(handle, "BTST", NULL, &result); if (ACPI_FAILURE(res1)) return res1; if (!(result & 0x01)) return 0; pr_info("Re-enabling Toshiba Bluetooth\n"); res1 = acpi_evaluate_object(handle, "AUSB", NULL, NULL); res2 = acpi_evaluate_object(handle, "BTPO", NULL, NULL); if (!ACPI_FAILURE(res1) || !ACPI_FAILURE(res2)) return 0; pr_warn("Failed to re-enable Toshiba Bluetooth\n"); return -ENODEV; } static void toshiba_bt_rfkill_notify(struct acpi_device *device, u32 event) { toshiba_bluetooth_enable(device->handle); } #ifdef CONFIG_PM_SLEEP static int toshiba_bt_resume(struct device *dev) { return toshiba_bluetooth_enable(to_acpi_device(dev)->handle); } #endif static int toshiba_bt_rfkill_add(struct acpi_device *device) { acpi_status status; u64 bt_present; int result = -ENODEV; /* * Some Toshiba laptops may have a fake TOS6205 device in * their ACPI BIOS, so query the _STA method to see if there * is really anything there, before trying to enable it. */ status = acpi_evaluate_integer(device->handle, "_STA", NULL, &bt_present); if (!ACPI_FAILURE(status) && bt_present) { pr_info("Detected Toshiba ACPI Bluetooth device - " "installing RFKill handler\n"); result = toshiba_bluetooth_enable(device->handle); } return result; } static int toshiba_bt_rfkill_remove(struct acpi_device *device) { /* clean up */ return 0; } module_acpi_driver(toshiba_bt_rfkill_driver); |