hp-wmi.c 23 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968
  1. /*
  2. * HP WMI hotkeys
  3. *
  4. * Copyright (C) 2008 Red Hat <mjg@redhat.com>
  5. * Copyright (C) 2010, 2011 Anssi Hannula <anssi.hannula@iki.fi>
  6. *
  7. * Portions based on wistron_btns.c:
  8. * Copyright (C) 2005 Miloslav Trmac <mitr@volny.cz>
  9. * Copyright (C) 2005 Bernhard Rosenkraenzer <bero@arklinux.org>
  10. * Copyright (C) 2005 Dmitry Torokhov <dtor@mail.ru>
  11. *
  12. * This program is free software; you can redistribute it and/or modify
  13. * it under the terms of the GNU General Public License as published by
  14. * the Free Software Foundation; either version 2 of the License, or
  15. * (at your option) any later version.
  16. *
  17. * This program is distributed in the hope that it will be useful,
  18. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  19. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  20. * GNU General Public License for more details.
  21. *
  22. * You should have received a copy of the GNU General Public License
  23. * along with this program; if not, write to the Free Software
  24. * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
  25. */
  26. #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  27. #include <linux/kernel.h>
  28. #include <linux/module.h>
  29. #include <linux/init.h>
  30. #include <linux/slab.h>
  31. #include <linux/types.h>
  32. #include <linux/input.h>
  33. #include <linux/input/sparse-keymap.h>
  34. #include <linux/platform_device.h>
  35. #include <linux/acpi.h>
  36. #include <linux/rfkill.h>
  37. #include <linux/string.h>
  38. MODULE_AUTHOR("Matthew Garrett <mjg59@srcf.ucam.org>");
  39. MODULE_DESCRIPTION("HP laptop WMI hotkeys driver");
  40. MODULE_LICENSE("GPL");
  41. MODULE_ALIAS("wmi:95F24279-4D7B-4334-9387-ACCDC67EF61C");
  42. MODULE_ALIAS("wmi:5FB7F034-2C63-45e9-BE91-3D44E2C707E4");
  43. #define HPWMI_EVENT_GUID "95F24279-4D7B-4334-9387-ACCDC67EF61C"
  44. #define HPWMI_BIOS_GUID "5FB7F034-2C63-45e9-BE91-3D44E2C707E4"
  45. #define HPWMI_DISPLAY_QUERY 0x1
  46. #define HPWMI_HDDTEMP_QUERY 0x2
  47. #define HPWMI_ALS_QUERY 0x3
  48. #define HPWMI_HARDWARE_QUERY 0x4
  49. #define HPWMI_WIRELESS_QUERY 0x5
  50. #define HPWMI_HOTKEY_QUERY 0xc
  51. #define HPWMI_WIRELESS2_QUERY 0x1b
  52. enum hp_wmi_radio {
  53. HPWMI_WIFI = 0,
  54. HPWMI_BLUETOOTH = 1,
  55. HPWMI_WWAN = 2,
  56. HPWMI_GPS = 3,
  57. };
  58. enum hp_wmi_event_ids {
  59. HPWMI_DOCK_EVENT = 1,
  60. HPWMI_PARK_HDD = 2,
  61. HPWMI_SMART_ADAPTER = 3,
  62. HPWMI_BEZEL_BUTTON = 4,
  63. HPWMI_WIRELESS = 5,
  64. HPWMI_CPU_BATTERY_THROTTLE = 6,
  65. HPWMI_LOCK_SWITCH = 7,
  66. };
  67. struct bios_args {
  68. u32 signature;
  69. u32 command;
  70. u32 commandtype;
  71. u32 datasize;
  72. u32 data;
  73. };
  74. struct bios_return {
  75. u32 sigpass;
  76. u32 return_code;
  77. };
  78. enum hp_return_value {
  79. HPWMI_RET_WRONG_SIGNATURE = 0x02,
  80. HPWMI_RET_UNKNOWN_COMMAND = 0x03,
  81. HPWMI_RET_UNKNOWN_CMDTYPE = 0x04,
  82. HPWMI_RET_INVALID_PARAMETERS = 0x05,
  83. };
  84. enum hp_wireless2_bits {
  85. HPWMI_POWER_STATE = 0x01,
  86. HPWMI_POWER_SOFT = 0x02,
  87. HPWMI_POWER_BIOS = 0x04,
  88. HPWMI_POWER_HARD = 0x08,
  89. };
  90. #define IS_HWBLOCKED(x) ((x & (HPWMI_POWER_BIOS | HPWMI_POWER_HARD)) \
  91. != (HPWMI_POWER_BIOS | HPWMI_POWER_HARD))
  92. #define IS_SWBLOCKED(x) !(x & HPWMI_POWER_SOFT)
  93. struct bios_rfkill2_device_state {
  94. u8 radio_type;
  95. u8 bus_type;
  96. u16 vendor_id;
  97. u16 product_id;
  98. u16 subsys_vendor_id;
  99. u16 subsys_product_id;
  100. u8 rfkill_id;
  101. u8 power;
  102. u8 unknown[4];
  103. };
  104. /* 7 devices fit into the 128 byte buffer */
  105. #define HPWMI_MAX_RFKILL2_DEVICES 7
  106. struct bios_rfkill2_state {
  107. u8 unknown[7];
  108. u8 count;
  109. u8 pad[8];
  110. struct bios_rfkill2_device_state device[HPWMI_MAX_RFKILL2_DEVICES];
  111. };
  112. static const struct key_entry hp_wmi_keymap[] = {
  113. { KE_KEY, 0x02, { KEY_BRIGHTNESSUP } },
  114. { KE_KEY, 0x03, { KEY_BRIGHTNESSDOWN } },
  115. { KE_KEY, 0x20e6, { KEY_PROG1 } },
  116. { KE_KEY, 0x20e8, { KEY_MEDIA } },
  117. { KE_KEY, 0x2142, { KEY_MEDIA } },
  118. { KE_KEY, 0x213b, { KEY_INFO } },
  119. { KE_KEY, 0x2169, { KEY_DIRECTION } },
  120. { KE_KEY, 0x216a, { KEY_SETUP } },
  121. { KE_KEY, 0x231b, { KEY_HELP } },
  122. { KE_END, 0 }
  123. };
  124. static struct input_dev *hp_wmi_input_dev;
  125. static struct platform_device *hp_wmi_platform_dev;
  126. static struct rfkill *wifi_rfkill;
  127. static struct rfkill *bluetooth_rfkill;
  128. static struct rfkill *wwan_rfkill;
  129. static struct rfkill *gps_rfkill;
  130. struct rfkill2_device {
  131. u8 id;
  132. int num;
  133. struct rfkill *rfkill;
  134. };
  135. static int rfkill2_count;
  136. static struct rfkill2_device rfkill2[HPWMI_MAX_RFKILL2_DEVICES];
  137. /*
  138. * hp_wmi_perform_query
  139. *
  140. * query: The commandtype -> What should be queried
  141. * write: The command -> 0 read, 1 write, 3 ODM specific
  142. * buffer: Buffer used as input and/or output
  143. * insize: Size of input buffer
  144. * outsize: Size of output buffer
  145. *
  146. * returns zero on success
  147. * an HP WMI query specific error code (which is positive)
  148. * -EINVAL if the query was not successful at all
  149. * -EINVAL if the output buffer size exceeds buffersize
  150. *
  151. * Note: The buffersize must at least be the maximum of the input and output
  152. * size. E.g. Battery info query (0x7) is defined to have 1 byte input
  153. * and 128 byte output. The caller would do:
  154. * buffer = kzalloc(128, GFP_KERNEL);
  155. * ret = hp_wmi_perform_query(0x7, 0, buffer, 1, 128)
  156. */
  157. static int hp_wmi_perform_query(int query, int write, void *buffer,
  158. int insize, int outsize)
  159. {
  160. struct bios_return *bios_return;
  161. int actual_outsize;
  162. union acpi_object *obj;
  163. struct bios_args args = {
  164. .signature = 0x55434553,
  165. .command = write ? 0x2 : 0x1,
  166. .commandtype = query,
  167. .datasize = insize,
  168. .data = 0,
  169. };
  170. struct acpi_buffer input = { sizeof(struct bios_args), &args };
  171. struct acpi_buffer output = { ACPI_ALLOCATE_BUFFER, NULL };
  172. u32 rc;
  173. if (WARN_ON(insize > sizeof(args.data)))
  174. return -EINVAL;
  175. memcpy(&args.data, buffer, insize);
  176. wmi_evaluate_method(HPWMI_BIOS_GUID, 0, 0x3, &input, &output);
  177. obj = output.pointer;
  178. if (!obj)
  179. return -EINVAL;
  180. else if (obj->type != ACPI_TYPE_BUFFER) {
  181. kfree(obj);
  182. return -EINVAL;
  183. }
  184. bios_return = (struct bios_return *)obj->buffer.pointer;
  185. rc = bios_return->return_code;
  186. if (rc) {
  187. if (rc != HPWMI_RET_UNKNOWN_CMDTYPE)
  188. pr_warn("query 0x%x returned error 0x%x\n", query, rc);
  189. kfree(obj);
  190. return rc;
  191. }
  192. if (!outsize) {
  193. /* ignore output data */
  194. kfree(obj);
  195. return 0;
  196. }
  197. actual_outsize = min(outsize, (int)(obj->buffer.length - sizeof(*bios_return)));
  198. memcpy(buffer, obj->buffer.pointer + sizeof(*bios_return), actual_outsize);
  199. memset(buffer + actual_outsize, 0, outsize - actual_outsize);
  200. kfree(obj);
  201. return 0;
  202. }
  203. static int hp_wmi_display_state(void)
  204. {
  205. int state = 0;
  206. int ret = hp_wmi_perform_query(HPWMI_DISPLAY_QUERY, 0, &state,
  207. sizeof(state), sizeof(state));
  208. if (ret)
  209. return -EINVAL;
  210. return state;
  211. }
  212. static int hp_wmi_hddtemp_state(void)
  213. {
  214. int state = 0;
  215. int ret = hp_wmi_perform_query(HPWMI_HDDTEMP_QUERY, 0, &state,
  216. sizeof(state), sizeof(state));
  217. if (ret)
  218. return -EINVAL;
  219. return state;
  220. }
  221. static int hp_wmi_als_state(void)
  222. {
  223. int state = 0;
  224. int ret = hp_wmi_perform_query(HPWMI_ALS_QUERY, 0, &state,
  225. sizeof(state), sizeof(state));
  226. if (ret)
  227. return -EINVAL;
  228. return state;
  229. }
  230. static int hp_wmi_dock_state(void)
  231. {
  232. int state = 0;
  233. int ret = hp_wmi_perform_query(HPWMI_HARDWARE_QUERY, 0, &state,
  234. sizeof(state), sizeof(state));
  235. if (ret)
  236. return -EINVAL;
  237. return state & 0x1;
  238. }
  239. static int hp_wmi_tablet_state(void)
  240. {
  241. int state = 0;
  242. int ret = hp_wmi_perform_query(HPWMI_HARDWARE_QUERY, 0, &state,
  243. sizeof(state), sizeof(state));
  244. if (ret)
  245. return ret;
  246. return (state & 0x4) ? 1 : 0;
  247. }
  248. static int hp_wmi_set_block(void *data, bool blocked)
  249. {
  250. enum hp_wmi_radio r = (enum hp_wmi_radio) data;
  251. int query = BIT(r + 8) | ((!blocked) << r);
  252. int ret;
  253. ret = hp_wmi_perform_query(HPWMI_WIRELESS_QUERY, 1,
  254. &query, sizeof(query), 0);
  255. if (ret)
  256. return -EINVAL;
  257. return 0;
  258. }
  259. static const struct rfkill_ops hp_wmi_rfkill_ops = {
  260. .set_block = hp_wmi_set_block,
  261. };
  262. static bool hp_wmi_get_sw_state(enum hp_wmi_radio r)
  263. {
  264. int wireless = 0;
  265. int mask;
  266. hp_wmi_perform_query(HPWMI_WIRELESS_QUERY, 0,
  267. &wireless, sizeof(wireless),
  268. sizeof(wireless));
  269. /* TBD: Pass error */
  270. mask = 0x200 << (r * 8);
  271. if (wireless & mask)
  272. return false;
  273. else
  274. return true;
  275. }
  276. static bool hp_wmi_get_hw_state(enum hp_wmi_radio r)
  277. {
  278. int wireless = 0;
  279. int mask;
  280. hp_wmi_perform_query(HPWMI_WIRELESS_QUERY, 0,
  281. &wireless, sizeof(wireless),
  282. sizeof(wireless));
  283. /* TBD: Pass error */
  284. mask = 0x800 << (r * 8);
  285. if (wireless & mask)
  286. return false;
  287. else
  288. return true;
  289. }
  290. static int hp_wmi_rfkill2_set_block(void *data, bool blocked)
  291. {
  292. int rfkill_id = (int)(long)data;
  293. char buffer[4] = { 0x01, 0x00, rfkill_id, !blocked };
  294. if (hp_wmi_perform_query(HPWMI_WIRELESS2_QUERY, 1,
  295. buffer, sizeof(buffer), 0))
  296. return -EINVAL;
  297. return 0;
  298. }
  299. static const struct rfkill_ops hp_wmi_rfkill2_ops = {
  300. .set_block = hp_wmi_rfkill2_set_block,
  301. };
  302. static int hp_wmi_rfkill2_refresh(void)
  303. {
  304. int err, i;
  305. struct bios_rfkill2_state state;
  306. err = hp_wmi_perform_query(HPWMI_WIRELESS2_QUERY, 0, &state,
  307. 0, sizeof(state));
  308. if (err)
  309. return err;
  310. for (i = 0; i < rfkill2_count; i++) {
  311. int num = rfkill2[i].num;
  312. struct bios_rfkill2_device_state *devstate;
  313. devstate = &state.device[num];
  314. if (num >= state.count ||
  315. devstate->rfkill_id != rfkill2[i].id) {
  316. pr_warn("power configuration of the wireless devices unexpectedly changed\n");
  317. continue;
  318. }
  319. rfkill_set_states(rfkill2[i].rfkill,
  320. IS_SWBLOCKED(devstate->power),
  321. IS_HWBLOCKED(devstate->power));
  322. }
  323. return 0;
  324. }
  325. static ssize_t show_display(struct device *dev, struct device_attribute *attr,
  326. char *buf)
  327. {
  328. int value = hp_wmi_display_state();
  329. if (value < 0)
  330. return -EINVAL;
  331. return sprintf(buf, "%d\n", value);
  332. }
  333. static ssize_t show_hddtemp(struct device *dev, struct device_attribute *attr,
  334. char *buf)
  335. {
  336. int value = hp_wmi_hddtemp_state();
  337. if (value < 0)
  338. return -EINVAL;
  339. return sprintf(buf, "%d\n", value);
  340. }
  341. static ssize_t show_als(struct device *dev, struct device_attribute *attr,
  342. char *buf)
  343. {
  344. int value = hp_wmi_als_state();
  345. if (value < 0)
  346. return -EINVAL;
  347. return sprintf(buf, "%d\n", value);
  348. }
  349. static ssize_t show_dock(struct device *dev, struct device_attribute *attr,
  350. char *buf)
  351. {
  352. int value = hp_wmi_dock_state();
  353. if (value < 0)
  354. return -EINVAL;
  355. return sprintf(buf, "%d\n", value);
  356. }
  357. static ssize_t show_tablet(struct device *dev, struct device_attribute *attr,
  358. char *buf)
  359. {
  360. int value = hp_wmi_tablet_state();
  361. if (value < 0)
  362. return -EINVAL;
  363. return sprintf(buf, "%d\n", value);
  364. }
  365. static ssize_t set_als(struct device *dev, struct device_attribute *attr,
  366. const char *buf, size_t count)
  367. {
  368. u32 tmp = simple_strtoul(buf, NULL, 10);
  369. int ret = hp_wmi_perform_query(HPWMI_ALS_QUERY, 1, &tmp,
  370. sizeof(tmp), sizeof(tmp));
  371. if (ret)
  372. return -EINVAL;
  373. return count;
  374. }
  375. static DEVICE_ATTR(display, S_IRUGO, show_display, NULL);
  376. static DEVICE_ATTR(hddtemp, S_IRUGO, show_hddtemp, NULL);
  377. static DEVICE_ATTR(als, S_IRUGO | S_IWUSR, show_als, set_als);
  378. static DEVICE_ATTR(dock, S_IRUGO, show_dock, NULL);
  379. static DEVICE_ATTR(tablet, S_IRUGO, show_tablet, NULL);
  380. static void hp_wmi_notify(u32 value, void *context)
  381. {
  382. struct acpi_buffer response = { ACPI_ALLOCATE_BUFFER, NULL };
  383. union acpi_object *obj;
  384. u32 event_id, event_data;
  385. int key_code = 0, ret;
  386. u32 *location;
  387. acpi_status status;
  388. status = wmi_get_event_data(value, &response);
  389. if (status != AE_OK) {
  390. pr_info("bad event status 0x%x\n", status);
  391. return;
  392. }
  393. obj = (union acpi_object *)response.pointer;
  394. if (!obj)
  395. return;
  396. if (obj->type != ACPI_TYPE_BUFFER) {
  397. pr_info("Unknown response received %d\n", obj->type);
  398. kfree(obj);
  399. return;
  400. }
  401. /*
  402. * Depending on ACPI version the concatenation of id and event data
  403. * inside _WED function will result in a 8 or 16 byte buffer.
  404. */
  405. location = (u32 *)obj->buffer.pointer;
  406. if (obj->buffer.length == 8) {
  407. event_id = *location;
  408. event_data = *(location + 1);
  409. } else if (obj->buffer.length == 16) {
  410. event_id = *location;
  411. event_data = *(location + 2);
  412. } else {
  413. pr_info("Unknown buffer length %d\n", obj->buffer.length);
  414. kfree(obj);
  415. return;
  416. }
  417. kfree(obj);
  418. switch (event_id) {
  419. case HPWMI_DOCK_EVENT:
  420. input_report_switch(hp_wmi_input_dev, SW_DOCK,
  421. hp_wmi_dock_state());
  422. input_report_switch(hp_wmi_input_dev, SW_TABLET_MODE,
  423. hp_wmi_tablet_state());
  424. input_sync(hp_wmi_input_dev);
  425. break;
  426. case HPWMI_PARK_HDD:
  427. break;
  428. case HPWMI_SMART_ADAPTER:
  429. break;
  430. case HPWMI_BEZEL_BUTTON:
  431. ret = hp_wmi_perform_query(HPWMI_HOTKEY_QUERY, 0,
  432. &key_code,
  433. sizeof(key_code),
  434. sizeof(key_code));
  435. if (ret)
  436. break;
  437. if (!sparse_keymap_report_event(hp_wmi_input_dev,
  438. key_code, 1, true))
  439. pr_info("Unknown key code - 0x%x\n", key_code);
  440. break;
  441. case HPWMI_WIRELESS:
  442. if (rfkill2_count) {
  443. hp_wmi_rfkill2_refresh();
  444. break;
  445. }
  446. if (wifi_rfkill)
  447. rfkill_set_states(wifi_rfkill,
  448. hp_wmi_get_sw_state(HPWMI_WIFI),
  449. hp_wmi_get_hw_state(HPWMI_WIFI));
  450. if (bluetooth_rfkill)
  451. rfkill_set_states(bluetooth_rfkill,
  452. hp_wmi_get_sw_state(HPWMI_BLUETOOTH),
  453. hp_wmi_get_hw_state(HPWMI_BLUETOOTH));
  454. if (wwan_rfkill)
  455. rfkill_set_states(wwan_rfkill,
  456. hp_wmi_get_sw_state(HPWMI_WWAN),
  457. hp_wmi_get_hw_state(HPWMI_WWAN));
  458. if (gps_rfkill)
  459. rfkill_set_states(gps_rfkill,
  460. hp_wmi_get_sw_state(HPWMI_GPS),
  461. hp_wmi_get_hw_state(HPWMI_GPS));
  462. break;
  463. case HPWMI_CPU_BATTERY_THROTTLE:
  464. pr_info("Unimplemented CPU throttle because of 3 Cell battery event detected\n");
  465. break;
  466. case HPWMI_LOCK_SWITCH:
  467. break;
  468. default:
  469. pr_info("Unknown event_id - %d - 0x%x\n", event_id, event_data);
  470. break;
  471. }
  472. }
  473. static int __init hp_wmi_input_setup(void)
  474. {
  475. acpi_status status;
  476. int err;
  477. hp_wmi_input_dev = input_allocate_device();
  478. if (!hp_wmi_input_dev)
  479. return -ENOMEM;
  480. hp_wmi_input_dev->name = "HP WMI hotkeys";
  481. hp_wmi_input_dev->phys = "wmi/input0";
  482. hp_wmi_input_dev->id.bustype = BUS_HOST;
  483. __set_bit(EV_SW, hp_wmi_input_dev->evbit);
  484. __set_bit(SW_DOCK, hp_wmi_input_dev->swbit);
  485. __set_bit(SW_TABLET_MODE, hp_wmi_input_dev->swbit);
  486. err = sparse_keymap_setup(hp_wmi_input_dev, hp_wmi_keymap, NULL);
  487. if (err)
  488. goto err_free_dev;
  489. /* Set initial hardware state */
  490. input_report_switch(hp_wmi_input_dev, SW_DOCK, hp_wmi_dock_state());
  491. input_report_switch(hp_wmi_input_dev, SW_TABLET_MODE,
  492. hp_wmi_tablet_state());
  493. input_sync(hp_wmi_input_dev);
  494. status = wmi_install_notify_handler(HPWMI_EVENT_GUID, hp_wmi_notify, NULL);
  495. if (ACPI_FAILURE(status)) {
  496. err = -EIO;
  497. goto err_free_keymap;
  498. }
  499. err = input_register_device(hp_wmi_input_dev);
  500. if (err)
  501. goto err_uninstall_notifier;
  502. return 0;
  503. err_uninstall_notifier:
  504. wmi_remove_notify_handler(HPWMI_EVENT_GUID);
  505. err_free_keymap:
  506. sparse_keymap_free(hp_wmi_input_dev);
  507. err_free_dev:
  508. input_free_device(hp_wmi_input_dev);
  509. return err;
  510. }
  511. static void hp_wmi_input_destroy(void)
  512. {
  513. wmi_remove_notify_handler(HPWMI_EVENT_GUID);
  514. sparse_keymap_free(hp_wmi_input_dev);
  515. input_unregister_device(hp_wmi_input_dev);
  516. }
  517. static void cleanup_sysfs(struct platform_device *device)
  518. {
  519. device_remove_file(&device->dev, &dev_attr_display);
  520. device_remove_file(&device->dev, &dev_attr_hddtemp);
  521. device_remove_file(&device->dev, &dev_attr_als);
  522. device_remove_file(&device->dev, &dev_attr_dock);
  523. device_remove_file(&device->dev, &dev_attr_tablet);
  524. }
  525. static int hp_wmi_rfkill_setup(struct platform_device *device)
  526. {
  527. int err;
  528. int wireless = 0;
  529. err = hp_wmi_perform_query(HPWMI_WIRELESS_QUERY, 0, &wireless,
  530. sizeof(wireless), sizeof(wireless));
  531. if (err)
  532. return err;
  533. if (wireless & 0x1) {
  534. wifi_rfkill = rfkill_alloc("hp-wifi", &device->dev,
  535. RFKILL_TYPE_WLAN,
  536. &hp_wmi_rfkill_ops,
  537. (void *) HPWMI_WIFI);
  538. if (!wifi_rfkill)
  539. return -ENOMEM;
  540. rfkill_init_sw_state(wifi_rfkill,
  541. hp_wmi_get_sw_state(HPWMI_WIFI));
  542. rfkill_set_hw_state(wifi_rfkill,
  543. hp_wmi_get_hw_state(HPWMI_WIFI));
  544. err = rfkill_register(wifi_rfkill);
  545. if (err)
  546. goto register_wifi_error;
  547. }
  548. if (wireless & 0x2) {
  549. bluetooth_rfkill = rfkill_alloc("hp-bluetooth", &device->dev,
  550. RFKILL_TYPE_BLUETOOTH,
  551. &hp_wmi_rfkill_ops,
  552. (void *) HPWMI_BLUETOOTH);
  553. if (!bluetooth_rfkill) {
  554. err = -ENOMEM;
  555. goto register_wifi_error;
  556. }
  557. rfkill_init_sw_state(bluetooth_rfkill,
  558. hp_wmi_get_sw_state(HPWMI_BLUETOOTH));
  559. rfkill_set_hw_state(bluetooth_rfkill,
  560. hp_wmi_get_hw_state(HPWMI_BLUETOOTH));
  561. err = rfkill_register(bluetooth_rfkill);
  562. if (err)
  563. goto register_bluetooth_error;
  564. }
  565. if (wireless & 0x4) {
  566. wwan_rfkill = rfkill_alloc("hp-wwan", &device->dev,
  567. RFKILL_TYPE_WWAN,
  568. &hp_wmi_rfkill_ops,
  569. (void *) HPWMI_WWAN);
  570. if (!wwan_rfkill) {
  571. err = -ENOMEM;
  572. goto register_gps_error;
  573. }
  574. rfkill_init_sw_state(wwan_rfkill,
  575. hp_wmi_get_sw_state(HPWMI_WWAN));
  576. rfkill_set_hw_state(wwan_rfkill,
  577. hp_wmi_get_hw_state(HPWMI_WWAN));
  578. err = rfkill_register(wwan_rfkill);
  579. if (err)
  580. goto register_wwan_err;
  581. }
  582. if (wireless & 0x8) {
  583. gps_rfkill = rfkill_alloc("hp-gps", &device->dev,
  584. RFKILL_TYPE_GPS,
  585. &hp_wmi_rfkill_ops,
  586. (void *) HPWMI_GPS);
  587. if (!gps_rfkill) {
  588. err = -ENOMEM;
  589. goto register_bluetooth_error;
  590. }
  591. rfkill_init_sw_state(gps_rfkill,
  592. hp_wmi_get_sw_state(HPWMI_GPS));
  593. rfkill_set_hw_state(bluetooth_rfkill,
  594. hp_wmi_get_hw_state(HPWMI_GPS));
  595. err = rfkill_register(gps_rfkill);
  596. if (err)
  597. goto register_gps_error;
  598. }
  599. return 0;
  600. register_wwan_err:
  601. rfkill_destroy(wwan_rfkill);
  602. wwan_rfkill = NULL;
  603. if (gps_rfkill)
  604. rfkill_unregister(gps_rfkill);
  605. register_gps_error:
  606. rfkill_destroy(gps_rfkill);
  607. gps_rfkill = NULL;
  608. if (bluetooth_rfkill)
  609. rfkill_unregister(bluetooth_rfkill);
  610. register_bluetooth_error:
  611. rfkill_destroy(bluetooth_rfkill);
  612. bluetooth_rfkill = NULL;
  613. if (wifi_rfkill)
  614. rfkill_unregister(wifi_rfkill);
  615. register_wifi_error:
  616. rfkill_destroy(wifi_rfkill);
  617. wifi_rfkill = NULL;
  618. return err;
  619. }
  620. static int hp_wmi_rfkill2_setup(struct platform_device *device)
  621. {
  622. int err, i;
  623. struct bios_rfkill2_state state;
  624. err = hp_wmi_perform_query(HPWMI_WIRELESS2_QUERY, 0, &state,
  625. 0, sizeof(state));
  626. if (err)
  627. return err;
  628. if (state.count > HPWMI_MAX_RFKILL2_DEVICES) {
  629. pr_warn("unable to parse 0x1b query output\n");
  630. return -EINVAL;
  631. }
  632. for (i = 0; i < state.count; i++) {
  633. struct rfkill *rfkill;
  634. enum rfkill_type type;
  635. char *name;
  636. switch (state.device[i].radio_type) {
  637. case HPWMI_WIFI:
  638. type = RFKILL_TYPE_WLAN;
  639. name = "hp-wifi";
  640. break;
  641. case HPWMI_BLUETOOTH:
  642. type = RFKILL_TYPE_BLUETOOTH;
  643. name = "hp-bluetooth";
  644. break;
  645. case HPWMI_WWAN:
  646. type = RFKILL_TYPE_WWAN;
  647. name = "hp-wwan";
  648. break;
  649. case HPWMI_GPS:
  650. type = RFKILL_TYPE_GPS;
  651. name = "hp-gps";
  652. break;
  653. default:
  654. pr_warn("unknown device type 0x%x\n",
  655. state.device[i].radio_type);
  656. continue;
  657. }
  658. if (!state.device[i].vendor_id) {
  659. pr_warn("zero device %d while %d reported\n",
  660. i, state.count);
  661. continue;
  662. }
  663. rfkill = rfkill_alloc(name, &device->dev, type,
  664. &hp_wmi_rfkill2_ops, (void *)(long)i);
  665. if (!rfkill) {
  666. err = -ENOMEM;
  667. goto fail;
  668. }
  669. rfkill2[rfkill2_count].id = state.device[i].rfkill_id;
  670. rfkill2[rfkill2_count].num = i;
  671. rfkill2[rfkill2_count].rfkill = rfkill;
  672. rfkill_init_sw_state(rfkill,
  673. IS_SWBLOCKED(state.device[i].power));
  674. rfkill_set_hw_state(rfkill,
  675. IS_HWBLOCKED(state.device[i].power));
  676. if (!(state.device[i].power & HPWMI_POWER_BIOS))
  677. pr_info("device %s blocked by BIOS\n", name);
  678. err = rfkill_register(rfkill);
  679. if (err) {
  680. rfkill_destroy(rfkill);
  681. goto fail;
  682. }
  683. rfkill2_count++;
  684. }
  685. return 0;
  686. fail:
  687. for (; rfkill2_count > 0; rfkill2_count--) {
  688. rfkill_unregister(rfkill2[rfkill2_count - 1].rfkill);
  689. rfkill_destroy(rfkill2[rfkill2_count - 1].rfkill);
  690. }
  691. return err;
  692. }
  693. static int __init hp_wmi_bios_setup(struct platform_device *device)
  694. {
  695. int err;
  696. /* clear detected rfkill devices */
  697. wifi_rfkill = NULL;
  698. bluetooth_rfkill = NULL;
  699. wwan_rfkill = NULL;
  700. gps_rfkill = NULL;
  701. rfkill2_count = 0;
  702. if (hp_wmi_rfkill_setup(device))
  703. hp_wmi_rfkill2_setup(device);
  704. err = device_create_file(&device->dev, &dev_attr_display);
  705. if (err)
  706. goto add_sysfs_error;
  707. err = device_create_file(&device->dev, &dev_attr_hddtemp);
  708. if (err)
  709. goto add_sysfs_error;
  710. err = device_create_file(&device->dev, &dev_attr_als);
  711. if (err)
  712. goto add_sysfs_error;
  713. err = device_create_file(&device->dev, &dev_attr_dock);
  714. if (err)
  715. goto add_sysfs_error;
  716. err = device_create_file(&device->dev, &dev_attr_tablet);
  717. if (err)
  718. goto add_sysfs_error;
  719. return 0;
  720. add_sysfs_error:
  721. cleanup_sysfs(device);
  722. return err;
  723. }
  724. static int __exit hp_wmi_bios_remove(struct platform_device *device)
  725. {
  726. int i;
  727. cleanup_sysfs(device);
  728. for (i = 0; i < rfkill2_count; i++) {
  729. rfkill_unregister(rfkill2[i].rfkill);
  730. rfkill_destroy(rfkill2[i].rfkill);
  731. }
  732. if (wifi_rfkill) {
  733. rfkill_unregister(wifi_rfkill);
  734. rfkill_destroy(wifi_rfkill);
  735. }
  736. if (bluetooth_rfkill) {
  737. rfkill_unregister(bluetooth_rfkill);
  738. rfkill_destroy(bluetooth_rfkill);
  739. }
  740. if (wwan_rfkill) {
  741. rfkill_unregister(wwan_rfkill);
  742. rfkill_destroy(wwan_rfkill);
  743. }
  744. if (gps_rfkill) {
  745. rfkill_unregister(gps_rfkill);
  746. rfkill_destroy(gps_rfkill);
  747. }
  748. return 0;
  749. }
  750. static int hp_wmi_resume_handler(struct device *device)
  751. {
  752. /*
  753. * Hardware state may have changed while suspended, so trigger
  754. * input events for the current state. As this is a switch,
  755. * the input layer will only actually pass it on if the state
  756. * changed.
  757. */
  758. if (hp_wmi_input_dev) {
  759. input_report_switch(hp_wmi_input_dev, SW_DOCK,
  760. hp_wmi_dock_state());
  761. input_report_switch(hp_wmi_input_dev, SW_TABLET_MODE,
  762. hp_wmi_tablet_state());
  763. input_sync(hp_wmi_input_dev);
  764. }
  765. if (rfkill2_count)
  766. hp_wmi_rfkill2_refresh();
  767. if (wifi_rfkill)
  768. rfkill_set_states(wifi_rfkill,
  769. hp_wmi_get_sw_state(HPWMI_WIFI),
  770. hp_wmi_get_hw_state(HPWMI_WIFI));
  771. if (bluetooth_rfkill)
  772. rfkill_set_states(bluetooth_rfkill,
  773. hp_wmi_get_sw_state(HPWMI_BLUETOOTH),
  774. hp_wmi_get_hw_state(HPWMI_BLUETOOTH));
  775. if (wwan_rfkill)
  776. rfkill_set_states(wwan_rfkill,
  777. hp_wmi_get_sw_state(HPWMI_WWAN),
  778. hp_wmi_get_hw_state(HPWMI_WWAN));
  779. if (gps_rfkill)
  780. rfkill_set_states(gps_rfkill,
  781. hp_wmi_get_sw_state(HPWMI_GPS),
  782. hp_wmi_get_hw_state(HPWMI_GPS));
  783. return 0;
  784. }
  785. static const struct dev_pm_ops hp_wmi_pm_ops = {
  786. .resume = hp_wmi_resume_handler,
  787. .restore = hp_wmi_resume_handler,
  788. };
  789. static struct platform_driver hp_wmi_driver = {
  790. .driver = {
  791. .name = "hp-wmi",
  792. .owner = THIS_MODULE,
  793. .pm = &hp_wmi_pm_ops,
  794. },
  795. .remove = __exit_p(hp_wmi_bios_remove),
  796. };
  797. static int __init hp_wmi_init(void)
  798. {
  799. int err;
  800. int event_capable = wmi_has_guid(HPWMI_EVENT_GUID);
  801. int bios_capable = wmi_has_guid(HPWMI_BIOS_GUID);
  802. if (!bios_capable && !event_capable)
  803. return -ENODEV;
  804. if (event_capable) {
  805. err = hp_wmi_input_setup();
  806. if (err)
  807. return err;
  808. //Enable magic for hotkeys that run on the SMBus
  809. ec_write(0xe6,0x6e);
  810. }
  811. if (bios_capable) {
  812. hp_wmi_platform_dev =
  813. platform_device_register_simple("hp-wmi", -1, NULL, 0);
  814. if (IS_ERR(hp_wmi_platform_dev)) {
  815. err = PTR_ERR(hp_wmi_platform_dev);
  816. goto err_destroy_input;
  817. }
  818. err = platform_driver_probe(&hp_wmi_driver, hp_wmi_bios_setup);
  819. if (err)
  820. goto err_unregister_device;
  821. }
  822. return 0;
  823. err_unregister_device:
  824. platform_device_unregister(hp_wmi_platform_dev);
  825. err_destroy_input:
  826. if (event_capable)
  827. hp_wmi_input_destroy();
  828. return err;
  829. }
  830. module_init(hp_wmi_init);
  831. static void __exit hp_wmi_exit(void)
  832. {
  833. if (wmi_has_guid(HPWMI_EVENT_GUID))
  834. hp_wmi_input_destroy();
  835. if (hp_wmi_platform_dev) {
  836. platform_device_unregister(hp_wmi_platform_dev);
  837. platform_driver_unregister(&hp_wmi_driver);
  838. }
  839. }
  840. module_exit(hp_wmi_exit);