1 /* 2 * Toshiba Bluetooth Enable Driver 3 * 4 * Copyright (C) 2009 Jes Sorensen <Jes.Sorensen@gmail.com> 5 * Copyright (C) 2015 Azael Avalos <coproscefalo@gmail.com> 6 * 7 * Thanks to Matthew Garrett for background info on ACPI innards which 8 * normal people aren't meant to understand :-) 9 * 10 * This program is free software; you can redistribute it and/or modify 11 * it under the terms of the GNU General Public License version 2 as 12 * published by the Free Software Foundation. 13 */ 14 15 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 16 17 #include <linux/kernel.h> 18 #include <linux/module.h> 19 #include <linux/init.h> 20 #include <linux/types.h> 21 #include <linux/acpi.h> 22 #include <linux/rfkill.h> 23 24 #define BT_KILLSWITCH_MASK 0x01 25 #define BT_PLUGGED_MASK 0x40 26 #define BT_POWER_MASK 0x80 27 28 MODULE_AUTHOR("Jes Sorensen <Jes.Sorensen@gmail.com>"); 29 MODULE_DESCRIPTION("Toshiba Laptop ACPI Bluetooth Enable Driver"); 30 MODULE_LICENSE("GPL"); 31 32 struct toshiba_bluetooth_dev { 33 struct acpi_device *acpi_dev; 34 struct rfkill *rfk; 35 36 bool killswitch; 37 bool plugged; 38 bool powered; 39 }; 40 41 static int toshiba_bt_rfkill_add(struct acpi_device *device); 42 static int toshiba_bt_rfkill_remove(struct acpi_device *device); 43 static void toshiba_bt_rfkill_notify(struct acpi_device *device, u32 event); 44 45 static const struct acpi_device_id bt_device_ids[] = { 46 { "TOS6205", 0}, 47 { "", 0}, 48 }; 49 MODULE_DEVICE_TABLE(acpi, bt_device_ids); 50 51 #ifdef CONFIG_PM_SLEEP 52 static int toshiba_bt_resume(struct device *dev); 53 #endif 54 static SIMPLE_DEV_PM_OPS(toshiba_bt_pm, NULL, toshiba_bt_resume); 55 56 static struct acpi_driver toshiba_bt_rfkill_driver = { 57 .name = "Toshiba BT", 58 .class = "Toshiba", 59 .ids = bt_device_ids, 60 .ops = { 61 .add = toshiba_bt_rfkill_add, 62 .remove = toshiba_bt_rfkill_remove, 63 .notify = toshiba_bt_rfkill_notify, 64 }, 65 .owner = THIS_MODULE, 66 .drv.pm = &toshiba_bt_pm, 67 }; 68 69 static int toshiba_bluetooth_present(acpi_handle handle) 70 { 71 acpi_status result; 72 u64 bt_present; 73 74 /* 75 * Some Toshiba laptops may have a fake TOS6205 device in 76 * their ACPI BIOS, so query the _STA method to see if there 77 * is really anything there. 78 */ 79 result = acpi_evaluate_integer(handle, "_STA", NULL, &bt_present); 80 if (ACPI_FAILURE(result)) { 81 pr_err("ACPI call to query Bluetooth presence failed"); 82 return -ENXIO; 83 } else if (!bt_present) { 84 pr_info("Bluetooth device not present\n"); 85 return -ENODEV; 86 } 87 88 return 0; 89 } 90 91 static int toshiba_bluetooth_status(acpi_handle handle) 92 { 93 acpi_status result; 94 u64 status; 95 96 result = acpi_evaluate_integer(handle, "BTST", NULL, &status); 97 if (ACPI_FAILURE(result)) { 98 pr_err("Could not get Bluetooth device status\n"); 99 return -ENXIO; 100 } 101 102 return status; 103 } 104 105 static int toshiba_bluetooth_enable(acpi_handle handle) 106 { 107 acpi_status result; 108 109 result = acpi_evaluate_object(handle, "AUSB", NULL, NULL); 110 if (ACPI_FAILURE(result)) { 111 pr_err("Could not attach USB Bluetooth device\n"); 112 return -ENXIO; 113 } 114 115 result = acpi_evaluate_object(handle, "BTPO", NULL, NULL); 116 if (ACPI_FAILURE(result)) { 117 pr_err("Could not power ON Bluetooth device\n"); 118 return -ENXIO; 119 } 120 121 return 0; 122 } 123 124 static int toshiba_bluetooth_disable(acpi_handle handle) 125 { 126 acpi_status result; 127 128 result = acpi_evaluate_object(handle, "BTPF", NULL, NULL); 129 if (ACPI_FAILURE(result)) { 130 pr_err("Could not power OFF Bluetooth device\n"); 131 return -ENXIO; 132 } 133 134 result = acpi_evaluate_object(handle, "DUSB", NULL, NULL); 135 if (ACPI_FAILURE(result)) { 136 pr_err("Could not detach USB Bluetooth device\n"); 137 return -ENXIO; 138 } 139 140 return 0; 141 } 142 143 /* Helper function */ 144 static int toshiba_bluetooth_sync_status(struct toshiba_bluetooth_dev *bt_dev) 145 { 146 int status; 147 148 status = toshiba_bluetooth_status(bt_dev->acpi_dev->handle); 149 if (status < 0) { 150 pr_err("Could not sync bluetooth device status\n"); 151 return status; 152 } 153 154 bt_dev->killswitch = (status & BT_KILLSWITCH_MASK) ? true : false; 155 bt_dev->plugged = (status & BT_PLUGGED_MASK) ? true : false; 156 bt_dev->powered = (status & BT_POWER_MASK) ? true : false; 157 158 pr_debug("Bluetooth status %d killswitch %d plugged %d powered %d\n", 159 status, bt_dev->killswitch, bt_dev->plugged, bt_dev->powered); 160 161 return 0; 162 } 163 164 /* RFKill handlers */ 165 static int bt_rfkill_set_block(void *data, bool blocked) 166 { 167 struct toshiba_bluetooth_dev *bt_dev = data; 168 int ret; 169 170 ret = toshiba_bluetooth_sync_status(bt_dev); 171 if (ret) 172 return ret; 173 174 if (!bt_dev->killswitch) 175 return 0; 176 177 if (blocked) 178 ret = toshiba_bluetooth_disable(bt_dev->acpi_dev->handle); 179 else 180 ret = toshiba_bluetooth_enable(bt_dev->acpi_dev->handle); 181 182 return ret; 183 } 184 185 static void bt_rfkill_poll(struct rfkill *rfkill, void *data) 186 { 187 struct toshiba_bluetooth_dev *bt_dev = data; 188 189 if (toshiba_bluetooth_sync_status(bt_dev)) 190 return; 191 192 /* 193 * Note the Toshiba Bluetooth RFKill switch seems to be a strange 194 * fish. It only provides a BT event when the switch is flipped to 195 * the 'on' position. When flipping it to 'off', the USB device is 196 * simply pulled away underneath us, without any BT event being 197 * delivered. 198 */ 199 rfkill_set_hw_state(bt_dev->rfk, !bt_dev->killswitch); 200 } 201 202 static const struct rfkill_ops rfk_ops = { 203 .set_block = bt_rfkill_set_block, 204 .poll = bt_rfkill_poll, 205 }; 206 207 /* ACPI driver functions */ 208 static void toshiba_bt_rfkill_notify(struct acpi_device *device, u32 event) 209 { 210 struct toshiba_bluetooth_dev *bt_dev = acpi_driver_data(device); 211 212 if (toshiba_bluetooth_sync_status(bt_dev)) 213 return; 214 215 rfkill_set_hw_state(bt_dev->rfk, !bt_dev->killswitch); 216 } 217 218 #ifdef CONFIG_PM_SLEEP 219 static int toshiba_bt_resume(struct device *dev) 220 { 221 struct toshiba_bluetooth_dev *bt_dev; 222 int ret; 223 224 bt_dev = acpi_driver_data(to_acpi_device(dev)); 225 226 ret = toshiba_bluetooth_sync_status(bt_dev); 227 if (ret) 228 return ret; 229 230 rfkill_set_hw_state(bt_dev->rfk, !bt_dev->killswitch); 231 232 return 0; 233 } 234 #endif 235 236 static int toshiba_bt_rfkill_add(struct acpi_device *device) 237 { 238 struct toshiba_bluetooth_dev *bt_dev; 239 int result; 240 241 result = toshiba_bluetooth_present(device->handle); 242 if (result) 243 return result; 244 245 pr_info("Toshiba ACPI Bluetooth device driver\n"); 246 247 bt_dev = kzalloc(sizeof(*bt_dev), GFP_KERNEL); 248 if (!bt_dev) 249 return -ENOMEM; 250 bt_dev->acpi_dev = device; 251 device->driver_data = bt_dev; 252 dev_set_drvdata(&device->dev, bt_dev); 253 254 result = toshiba_bluetooth_sync_status(bt_dev); 255 if (result) { 256 kfree(bt_dev); 257 return result; 258 } 259 260 bt_dev->rfk = rfkill_alloc("Toshiba Bluetooth", 261 &device->dev, 262 RFKILL_TYPE_BLUETOOTH, 263 &rfk_ops, 264 bt_dev); 265 if (!bt_dev->rfk) { 266 pr_err("Unable to allocate rfkill device\n"); 267 kfree(bt_dev); 268 return -ENOMEM; 269 } 270 271 rfkill_set_hw_state(bt_dev->rfk, !bt_dev->killswitch); 272 273 result = rfkill_register(bt_dev->rfk); 274 if (result) { 275 pr_err("Unable to register rfkill device\n"); 276 rfkill_destroy(bt_dev->rfk); 277 kfree(bt_dev); 278 } 279 280 return result; 281 } 282 283 static int toshiba_bt_rfkill_remove(struct acpi_device *device) 284 { 285 struct toshiba_bluetooth_dev *bt_dev = acpi_driver_data(device); 286 287 /* clean up */ 288 if (bt_dev->rfk) { 289 rfkill_unregister(bt_dev->rfk); 290 rfkill_destroy(bt_dev->rfk); 291 } 292 293 kfree(bt_dev); 294 295 return toshiba_bluetooth_disable(device->handle); 296 } 297 298 module_acpi_driver(toshiba_bt_rfkill_driver); 299