eeepc-laptop.c 31 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379
  1. /*
  2. * eepc-laptop.c - Asus Eee PC extras
  3. *
  4. * Based on asus_acpi.c as patched for the Eee PC by Asus:
  5. * ftp://ftp.asus.com/pub/ASUS/EeePC/701/ASUS_ACPI_071126.rar
  6. * Based on eee.c from eeepc-linux
  7. *
  8. * This program is free software; you can redistribute it and/or modify
  9. * it under the terms of the GNU General Public License as published by
  10. * the Free Software Foundation; either version 2 of the License, or
  11. * (at your option) any later version.
  12. *
  13. * This program is distributed in the hope that it will be useful,
  14. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  16. * GNU General Public License for more details.
  17. */
  18. #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  19. #include <linux/kernel.h>
  20. #include <linux/module.h>
  21. #include <linux/init.h>
  22. #include <linux/types.h>
  23. #include <linux/platform_device.h>
  24. #include <linux/backlight.h>
  25. #include <linux/fb.h>
  26. #include <linux/hwmon.h>
  27. #include <linux/hwmon-sysfs.h>
  28. #include <acpi/acpi_drivers.h>
  29. #include <acpi/acpi_bus.h>
  30. #include <linux/uaccess.h>
  31. #include <linux/input.h>
  32. #include <linux/rfkill.h>
  33. #include <linux/pci.h>
  34. #include <linux/pci_hotplug.h>
  35. #include <linux/leds.h>
  36. #define EEEPC_LAPTOP_VERSION "0.1"
  37. #define EEEPC_HOTK_NAME "Eee PC Hotkey Driver"
  38. #define EEEPC_HOTK_FILE "eeepc"
  39. #define EEEPC_HOTK_CLASS "hotkey"
  40. #define EEEPC_HOTK_DEVICE_NAME "Hotkey"
  41. #define EEEPC_HOTK_HID "ASUS010"
  42. /*
  43. * Definitions for Asus EeePC
  44. */
  45. #define NOTIFY_WLAN_ON 0x10
  46. #define NOTIFY_BRN_MIN 0x20
  47. #define NOTIFY_BRN_MAX 0x2f
  48. enum {
  49. DISABLE_ASL_WLAN = 0x0001,
  50. DISABLE_ASL_BLUETOOTH = 0x0002,
  51. DISABLE_ASL_IRDA = 0x0004,
  52. DISABLE_ASL_CAMERA = 0x0008,
  53. DISABLE_ASL_TV = 0x0010,
  54. DISABLE_ASL_GPS = 0x0020,
  55. DISABLE_ASL_DISPLAYSWITCH = 0x0040,
  56. DISABLE_ASL_MODEM = 0x0080,
  57. DISABLE_ASL_CARDREADER = 0x0100,
  58. DISABLE_ASL_3G = 0x0200,
  59. DISABLE_ASL_WIMAX = 0x0400,
  60. DISABLE_ASL_HWCF = 0x0800
  61. };
  62. enum {
  63. CM_ASL_WLAN = 0,
  64. CM_ASL_BLUETOOTH,
  65. CM_ASL_IRDA,
  66. CM_ASL_1394,
  67. CM_ASL_CAMERA,
  68. CM_ASL_TV,
  69. CM_ASL_GPS,
  70. CM_ASL_DVDROM,
  71. CM_ASL_DISPLAYSWITCH,
  72. CM_ASL_PANELBRIGHT,
  73. CM_ASL_BIOSFLASH,
  74. CM_ASL_ACPIFLASH,
  75. CM_ASL_CPUFV,
  76. CM_ASL_CPUTEMPERATURE,
  77. CM_ASL_FANCPU,
  78. CM_ASL_FANCHASSIS,
  79. CM_ASL_USBPORT1,
  80. CM_ASL_USBPORT2,
  81. CM_ASL_USBPORT3,
  82. CM_ASL_MODEM,
  83. CM_ASL_CARDREADER,
  84. CM_ASL_3G,
  85. CM_ASL_WIMAX,
  86. CM_ASL_HWCF,
  87. CM_ASL_LID,
  88. CM_ASL_TYPE,
  89. CM_ASL_PANELPOWER, /*P901*/
  90. CM_ASL_TPD
  91. };
  92. static const char *cm_getv[] = {
  93. "WLDG", "BTHG", NULL, NULL,
  94. "CAMG", NULL, NULL, NULL,
  95. NULL, "PBLG", NULL, NULL,
  96. "CFVG", NULL, NULL, NULL,
  97. "USBG", NULL, NULL, "MODG",
  98. "CRDG", "M3GG", "WIMG", "HWCF",
  99. "LIDG", "TYPE", "PBPG", "TPDG"
  100. };
  101. static const char *cm_setv[] = {
  102. "WLDS", "BTHS", NULL, NULL,
  103. "CAMS", NULL, NULL, NULL,
  104. "SDSP", "PBLS", "HDPS", NULL,
  105. "CFVS", NULL, NULL, NULL,
  106. "USBG", NULL, NULL, "MODS",
  107. "CRDS", "M3GS", "WIMS", NULL,
  108. NULL, NULL, "PBPS", "TPDS"
  109. };
  110. #define EEEPC_EC "\\_SB.PCI0.SBRG.EC0."
  111. #define EEEPC_EC_FAN_PWM EEEPC_EC "SC02" /* Fan PWM duty cycle (%) */
  112. #define EEEPC_EC_SC02 0x63
  113. #define EEEPC_EC_FAN_HRPM EEEPC_EC "SC05" /* High byte, fan speed (RPM) */
  114. #define EEEPC_EC_FAN_LRPM EEEPC_EC "SC06" /* Low byte, fan speed (RPM) */
  115. #define EEEPC_EC_FAN_CTRL EEEPC_EC "SFB3" /* Byte containing SF25 */
  116. #define EEEPC_EC_SFB3 0xD3
  117. /*
  118. * This is the main structure, we can use it to store useful information
  119. * about the hotk device
  120. */
  121. struct eeepc_hotk {
  122. struct acpi_device *device; /* the device we are in */
  123. acpi_handle handle; /* the handle of the hotk device */
  124. u32 cm_supported; /* the control methods supported
  125. by this BIOS */
  126. uint init_flag; /* Init flags */
  127. u16 event_count[128]; /* count for each event */
  128. struct input_dev *inputdev;
  129. u16 *keycode_map;
  130. struct rfkill *wlan_rfkill;
  131. struct rfkill *bluetooth_rfkill;
  132. struct rfkill *wwan3g_rfkill;
  133. struct rfkill *wimax_rfkill;
  134. struct hotplug_slot *hotplug_slot;
  135. struct mutex hotplug_lock;
  136. };
  137. /* The actual device the driver binds to */
  138. static struct eeepc_hotk *ehotk;
  139. /* Platform device/driver */
  140. static int eeepc_hotk_thaw(struct device *device);
  141. static int eeepc_hotk_restore(struct device *device);
  142. static struct dev_pm_ops eeepc_pm_ops = {
  143. .thaw = eeepc_hotk_thaw,
  144. .restore = eeepc_hotk_restore,
  145. };
  146. static struct platform_driver platform_driver = {
  147. .driver = {
  148. .name = EEEPC_HOTK_FILE,
  149. .owner = THIS_MODULE,
  150. .pm = &eeepc_pm_ops,
  151. }
  152. };
  153. static struct platform_device *platform_device;
  154. struct key_entry {
  155. char type;
  156. u8 code;
  157. u16 keycode;
  158. };
  159. enum { KE_KEY, KE_END };
  160. static struct key_entry eeepc_keymap[] = {
  161. /* Sleep already handled via generic ACPI code */
  162. {KE_KEY, 0x10, KEY_WLAN },
  163. {KE_KEY, 0x11, KEY_WLAN },
  164. {KE_KEY, 0x12, KEY_PROG1 },
  165. {KE_KEY, 0x13, KEY_MUTE },
  166. {KE_KEY, 0x14, KEY_VOLUMEDOWN },
  167. {KE_KEY, 0x15, KEY_VOLUMEUP },
  168. {KE_KEY, 0x1a, KEY_COFFEE },
  169. {KE_KEY, 0x1b, KEY_ZOOM },
  170. {KE_KEY, 0x1c, KEY_PROG2 },
  171. {KE_KEY, 0x1d, KEY_PROG3 },
  172. {KE_KEY, NOTIFY_BRN_MIN, KEY_BRIGHTNESSDOWN },
  173. {KE_KEY, NOTIFY_BRN_MIN + 2, KEY_BRIGHTNESSUP },
  174. {KE_KEY, 0x30, KEY_SWITCHVIDEOMODE },
  175. {KE_KEY, 0x31, KEY_SWITCHVIDEOMODE },
  176. {KE_KEY, 0x32, KEY_SWITCHVIDEOMODE },
  177. {KE_END, 0},
  178. };
  179. /*
  180. * The hotkey driver declaration
  181. */
  182. static int eeepc_hotk_add(struct acpi_device *device);
  183. static int eeepc_hotk_remove(struct acpi_device *device, int type);
  184. static void eeepc_hotk_notify(struct acpi_device *device, u32 event);
  185. static const struct acpi_device_id eeepc_device_ids[] = {
  186. {EEEPC_HOTK_HID, 0},
  187. {"", 0},
  188. };
  189. MODULE_DEVICE_TABLE(acpi, eeepc_device_ids);
  190. static struct acpi_driver eeepc_hotk_driver = {
  191. .name = EEEPC_HOTK_NAME,
  192. .class = EEEPC_HOTK_CLASS,
  193. .owner = THIS_MODULE,
  194. .ids = eeepc_device_ids,
  195. .flags = ACPI_DRIVER_ALL_NOTIFY_EVENTS,
  196. .ops = {
  197. .add = eeepc_hotk_add,
  198. .remove = eeepc_hotk_remove,
  199. .notify = eeepc_hotk_notify,
  200. },
  201. };
  202. /* PCI hotplug ops */
  203. static int eeepc_get_adapter_status(struct hotplug_slot *slot, u8 *value);
  204. static struct hotplug_slot_ops eeepc_hotplug_slot_ops = {
  205. .owner = THIS_MODULE,
  206. .get_adapter_status = eeepc_get_adapter_status,
  207. .get_power_status = eeepc_get_adapter_status,
  208. };
  209. /* The backlight device /sys/class/backlight */
  210. static struct backlight_device *eeepc_backlight_device;
  211. /* The hwmon device */
  212. static struct device *eeepc_hwmon_device;
  213. /*
  214. * The backlight class declaration
  215. */
  216. static int read_brightness(struct backlight_device *bd);
  217. static int update_bl_status(struct backlight_device *bd);
  218. static struct backlight_ops eeepcbl_ops = {
  219. .get_brightness = read_brightness,
  220. .update_status = update_bl_status,
  221. };
  222. MODULE_AUTHOR("Corentin Chary, Eric Cooper");
  223. MODULE_DESCRIPTION(EEEPC_HOTK_NAME);
  224. MODULE_LICENSE("GPL");
  225. /*
  226. * ACPI Helpers
  227. */
  228. static int write_acpi_int(acpi_handle handle, const char *method, int val,
  229. struct acpi_buffer *output)
  230. {
  231. struct acpi_object_list params;
  232. union acpi_object in_obj;
  233. acpi_status status;
  234. params.count = 1;
  235. params.pointer = &in_obj;
  236. in_obj.type = ACPI_TYPE_INTEGER;
  237. in_obj.integer.value = val;
  238. status = acpi_evaluate_object(handle, (char *)method, &params, output);
  239. return (status == AE_OK ? 0 : -1);
  240. }
  241. static int read_acpi_int(acpi_handle handle, const char *method, int *val)
  242. {
  243. acpi_status status;
  244. unsigned long long result;
  245. status = acpi_evaluate_integer(handle, (char *)method, NULL, &result);
  246. if (ACPI_FAILURE(status)) {
  247. *val = -1;
  248. return -1;
  249. } else {
  250. *val = result;
  251. return 0;
  252. }
  253. }
  254. static int set_acpi(int cm, int value)
  255. {
  256. if (ehotk->cm_supported & (0x1 << cm)) {
  257. const char *method = cm_setv[cm];
  258. if (method == NULL)
  259. return -ENODEV;
  260. if (write_acpi_int(ehotk->handle, method, value, NULL))
  261. pr_warning("Error writing %s\n", method);
  262. }
  263. return 0;
  264. }
  265. static int get_acpi(int cm)
  266. {
  267. int value = -ENODEV;
  268. if ((ehotk->cm_supported & (0x1 << cm))) {
  269. const char *method = cm_getv[cm];
  270. if (method == NULL)
  271. return -ENODEV;
  272. if (read_acpi_int(ehotk->handle, method, &value))
  273. pr_warning("Error reading %s\n", method);
  274. }
  275. return value;
  276. }
  277. /*
  278. * Backlight
  279. */
  280. static int read_brightness(struct backlight_device *bd)
  281. {
  282. return get_acpi(CM_ASL_PANELBRIGHT);
  283. }
  284. static int set_brightness(struct backlight_device *bd, int value)
  285. {
  286. value = max(0, min(15, value));
  287. return set_acpi(CM_ASL_PANELBRIGHT, value);
  288. }
  289. static int update_bl_status(struct backlight_device *bd)
  290. {
  291. return set_brightness(bd, bd->props.brightness);
  292. }
  293. /*
  294. * Rfkill helpers
  295. */
  296. static bool eeepc_wlan_rfkill_blocked(void)
  297. {
  298. if (get_acpi(CM_ASL_WLAN) == 1)
  299. return false;
  300. return true;
  301. }
  302. static int eeepc_rfkill_set(void *data, bool blocked)
  303. {
  304. unsigned long asl = (unsigned long)data;
  305. return set_acpi(asl, !blocked);
  306. }
  307. static const struct rfkill_ops eeepc_rfkill_ops = {
  308. .set_block = eeepc_rfkill_set,
  309. };
  310. static void __devinit eeepc_enable_camera(void)
  311. {
  312. /*
  313. * If the following call to set_acpi() fails, it's because there's no
  314. * camera so we can ignore the error.
  315. */
  316. if (get_acpi(CM_ASL_CAMERA) == 0)
  317. set_acpi(CM_ASL_CAMERA, 1);
  318. }
  319. /*
  320. * Sys helpers
  321. */
  322. static int parse_arg(const char *buf, unsigned long count, int *val)
  323. {
  324. if (!count)
  325. return 0;
  326. if (sscanf(buf, "%i", val) != 1)
  327. return -EINVAL;
  328. return count;
  329. }
  330. static ssize_t store_sys_acpi(int cm, const char *buf, size_t count)
  331. {
  332. int rv, value;
  333. rv = parse_arg(buf, count, &value);
  334. if (rv > 0)
  335. value = set_acpi(cm, value);
  336. if (value < 0)
  337. return -EIO;
  338. return rv;
  339. }
  340. static ssize_t show_sys_acpi(int cm, char *buf)
  341. {
  342. int value = get_acpi(cm);
  343. if (value < 0)
  344. return -EIO;
  345. return sprintf(buf, "%d\n", value);
  346. }
  347. #define EEEPC_CREATE_DEVICE_ATTR(_name, _mode, _cm) \
  348. static ssize_t show_##_name(struct device *dev, \
  349. struct device_attribute *attr, \
  350. char *buf) \
  351. { \
  352. return show_sys_acpi(_cm, buf); \
  353. } \
  354. static ssize_t store_##_name(struct device *dev, \
  355. struct device_attribute *attr, \
  356. const char *buf, size_t count) \
  357. { \
  358. return store_sys_acpi(_cm, buf, count); \
  359. } \
  360. static struct device_attribute dev_attr_##_name = { \
  361. .attr = { \
  362. .name = __stringify(_name), \
  363. .mode = _mode }, \
  364. .show = show_##_name, \
  365. .store = store_##_name, \
  366. }
  367. EEEPC_CREATE_DEVICE_ATTR(camera, 0644, CM_ASL_CAMERA);
  368. EEEPC_CREATE_DEVICE_ATTR(cardr, 0644, CM_ASL_CARDREADER);
  369. EEEPC_CREATE_DEVICE_ATTR(disp, 0200, CM_ASL_DISPLAYSWITCH);
  370. struct eeepc_cpufv {
  371. int num;
  372. int cur;
  373. };
  374. static int get_cpufv(struct eeepc_cpufv *c)
  375. {
  376. c->cur = get_acpi(CM_ASL_CPUFV);
  377. c->num = (c->cur >> 8) & 0xff;
  378. c->cur &= 0xff;
  379. if (c->cur < 0 || c->num <= 0 || c->num > 12)
  380. return -ENODEV;
  381. return 0;
  382. }
  383. static ssize_t show_available_cpufv(struct device *dev,
  384. struct device_attribute *attr,
  385. char *buf)
  386. {
  387. struct eeepc_cpufv c;
  388. int i;
  389. ssize_t len = 0;
  390. if (get_cpufv(&c))
  391. return -ENODEV;
  392. for (i = 0; i < c.num; i++)
  393. len += sprintf(buf + len, "%d ", i);
  394. len += sprintf(buf + len, "\n");
  395. return len;
  396. }
  397. static ssize_t show_cpufv(struct device *dev,
  398. struct device_attribute *attr,
  399. char *buf)
  400. {
  401. struct eeepc_cpufv c;
  402. if (get_cpufv(&c))
  403. return -ENODEV;
  404. return sprintf(buf, "%#x\n", (c.num << 8) | c.cur);
  405. }
  406. static ssize_t store_cpufv(struct device *dev,
  407. struct device_attribute *attr,
  408. const char *buf, size_t count)
  409. {
  410. struct eeepc_cpufv c;
  411. int rv, value;
  412. if (get_cpufv(&c))
  413. return -ENODEV;
  414. rv = parse_arg(buf, count, &value);
  415. if (rv < 0)
  416. return rv;
  417. if (!rv || value < 0 || value >= c.num)
  418. return -EINVAL;
  419. set_acpi(CM_ASL_CPUFV, value);
  420. return rv;
  421. }
  422. static struct device_attribute dev_attr_cpufv = {
  423. .attr = {
  424. .name = "cpufv",
  425. .mode = 0644 },
  426. .show = show_cpufv,
  427. .store = store_cpufv
  428. };
  429. static struct device_attribute dev_attr_available_cpufv = {
  430. .attr = {
  431. .name = "available_cpufv",
  432. .mode = 0444 },
  433. .show = show_available_cpufv
  434. };
  435. static struct attribute *platform_attributes[] = {
  436. &dev_attr_camera.attr,
  437. &dev_attr_cardr.attr,
  438. &dev_attr_disp.attr,
  439. &dev_attr_cpufv.attr,
  440. &dev_attr_available_cpufv.attr,
  441. NULL
  442. };
  443. static struct attribute_group platform_attribute_group = {
  444. .attrs = platform_attributes
  445. };
  446. /*
  447. * LEDs
  448. */
  449. /*
  450. * These functions actually update the LED's, and are called from a
  451. * workqueue. By doing this as separate work rather than when the LED
  452. * subsystem asks, we avoid messing with the Asus ACPI stuff during a
  453. * potentially bad time, such as a timer interrupt.
  454. */
  455. static int tpd_led_wk;
  456. static void tpd_led_update(struct work_struct *ignored)
  457. {
  458. int value = tpd_led_wk;
  459. set_acpi(CM_ASL_TPD, value);
  460. }
  461. static struct workqueue_struct *led_workqueue;
  462. static DECLARE_WORK(tpd_led_work, tpd_led_update);
  463. static void tpd_led_set(struct led_classdev *led_cdev,
  464. enum led_brightness value)
  465. {
  466. tpd_led_wk = (value > 0) ? 1 : 0;
  467. queue_work(led_workqueue, &tpd_led_work);
  468. }
  469. static struct led_classdev tpd_led = {
  470. .name = "eeepc::touchpad",
  471. .brightness_set = tpd_led_set,
  472. .max_brightness = 1
  473. };
  474. /*
  475. * Hotkey functions
  476. */
  477. static struct key_entry *eepc_get_entry_by_scancode(int code)
  478. {
  479. struct key_entry *key;
  480. for (key = eeepc_keymap; key->type != KE_END; key++)
  481. if (code == key->code)
  482. return key;
  483. return NULL;
  484. }
  485. static struct key_entry *eepc_get_entry_by_keycode(int code)
  486. {
  487. struct key_entry *key;
  488. for (key = eeepc_keymap; key->type != KE_END; key++)
  489. if (code == key->keycode && key->type == KE_KEY)
  490. return key;
  491. return NULL;
  492. }
  493. static int eeepc_getkeycode(struct input_dev *dev, int scancode, int *keycode)
  494. {
  495. struct key_entry *key = eepc_get_entry_by_scancode(scancode);
  496. if (key && key->type == KE_KEY) {
  497. *keycode = key->keycode;
  498. return 0;
  499. }
  500. return -EINVAL;
  501. }
  502. static int eeepc_setkeycode(struct input_dev *dev, int scancode, int keycode)
  503. {
  504. struct key_entry *key;
  505. int old_keycode;
  506. if (keycode < 0 || keycode > KEY_MAX)
  507. return -EINVAL;
  508. key = eepc_get_entry_by_scancode(scancode);
  509. if (key && key->type == KE_KEY) {
  510. old_keycode = key->keycode;
  511. key->keycode = keycode;
  512. set_bit(keycode, dev->keybit);
  513. if (!eepc_get_entry_by_keycode(old_keycode))
  514. clear_bit(old_keycode, dev->keybit);
  515. return 0;
  516. }
  517. return -EINVAL;
  518. }
  519. static void cmsg_quirk(int cm, const char *name)
  520. {
  521. int dummy;
  522. /* Some BIOSes do not report cm although it is avaliable.
  523. Check if cm_getv[cm] works and, if yes, assume cm should be set. */
  524. if (!(ehotk->cm_supported & (1 << cm))
  525. && !read_acpi_int(ehotk->handle, cm_getv[cm], &dummy)) {
  526. pr_info("%s (%x) not reported by BIOS,"
  527. " enabling anyway\n", name, 1 << cm);
  528. ehotk->cm_supported |= 1 << cm;
  529. }
  530. }
  531. static void cmsg_quirks(void)
  532. {
  533. cmsg_quirk(CM_ASL_LID, "LID");
  534. cmsg_quirk(CM_ASL_TYPE, "TYPE");
  535. cmsg_quirk(CM_ASL_PANELPOWER, "PANELPOWER");
  536. cmsg_quirk(CM_ASL_TPD, "TPD");
  537. }
  538. static int eeepc_hotk_check(void)
  539. {
  540. struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
  541. int result;
  542. result = acpi_bus_get_status(ehotk->device);
  543. if (result)
  544. return result;
  545. if (ehotk->device->status.present) {
  546. if (write_acpi_int(ehotk->handle, "INIT", ehotk->init_flag,
  547. &buffer)) {
  548. pr_err("Hotkey initialization failed\n");
  549. return -ENODEV;
  550. } else {
  551. pr_notice("Hotkey init flags 0x%x\n", ehotk->init_flag);
  552. }
  553. /* get control methods supported */
  554. if (read_acpi_int(ehotk->handle, "CMSG"
  555. , &ehotk->cm_supported)) {
  556. pr_err("Get control methods supported failed\n");
  557. return -ENODEV;
  558. } else {
  559. cmsg_quirks();
  560. pr_info("Get control methods supported: 0x%x\n",
  561. ehotk->cm_supported);
  562. }
  563. } else {
  564. pr_err("Hotkey device not present, aborting\n");
  565. return -EINVAL;
  566. }
  567. return 0;
  568. }
  569. static int notify_brn(void)
  570. {
  571. /* returns the *previous* brightness, or -1 */
  572. struct backlight_device *bd = eeepc_backlight_device;
  573. if (bd) {
  574. int old = bd->props.brightness;
  575. backlight_force_update(bd, BACKLIGHT_UPDATE_HOTKEY);
  576. return old;
  577. }
  578. return -1;
  579. }
  580. static int eeepc_get_adapter_status(struct hotplug_slot *hotplug_slot,
  581. u8 *value)
  582. {
  583. int val = get_acpi(CM_ASL_WLAN);
  584. if (val == 1 || val == 0)
  585. *value = val;
  586. else
  587. return -EINVAL;
  588. return 0;
  589. }
  590. static void eeepc_rfkill_hotplug(void)
  591. {
  592. struct pci_dev *dev;
  593. struct pci_bus *bus;
  594. bool blocked = eeepc_wlan_rfkill_blocked();
  595. if (ehotk->wlan_rfkill)
  596. rfkill_set_sw_state(ehotk->wlan_rfkill, blocked);
  597. mutex_lock(&ehotk->hotplug_lock);
  598. if (ehotk->hotplug_slot) {
  599. bus = pci_find_bus(0, 1);
  600. if (!bus) {
  601. pr_warning("Unable to find PCI bus 1?\n");
  602. goto out_unlock;
  603. }
  604. if (!blocked) {
  605. dev = pci_get_slot(bus, 0);
  606. if (dev) {
  607. /* Device already present */
  608. pci_dev_put(dev);
  609. goto out_unlock;
  610. }
  611. dev = pci_scan_single_device(bus, 0);
  612. if (dev) {
  613. pci_bus_assign_resources(bus);
  614. if (pci_bus_add_device(dev))
  615. pr_err("Unable to hotplug wifi\n");
  616. }
  617. } else {
  618. dev = pci_get_slot(bus, 0);
  619. if (dev) {
  620. pci_remove_bus_device(dev);
  621. pci_dev_put(dev);
  622. }
  623. }
  624. }
  625. out_unlock:
  626. mutex_unlock(&ehotk->hotplug_lock);
  627. }
  628. static void eeepc_rfkill_notify(acpi_handle handle, u32 event, void *data)
  629. {
  630. if (event != ACPI_NOTIFY_BUS_CHECK)
  631. return;
  632. eeepc_rfkill_hotplug();
  633. }
  634. static void eeepc_hotk_notify(struct acpi_device *device, u32 event)
  635. {
  636. static struct key_entry *key;
  637. u16 count;
  638. int brn = -ENODEV;
  639. if (!ehotk)
  640. return;
  641. if (event > ACPI_MAX_SYS_NOTIFY)
  642. return;
  643. if (event >= NOTIFY_BRN_MIN && event <= NOTIFY_BRN_MAX)
  644. brn = notify_brn();
  645. count = ehotk->event_count[event % 128]++;
  646. acpi_bus_generate_proc_event(ehotk->device, event, count);
  647. acpi_bus_generate_netlink_event(ehotk->device->pnp.device_class,
  648. dev_name(&ehotk->device->dev), event,
  649. count);
  650. if (ehotk->inputdev) {
  651. if (brn != -ENODEV) {
  652. /* brightness-change events need special
  653. * handling for conversion to key events
  654. */
  655. if (brn < 0)
  656. brn = event;
  657. else
  658. brn += NOTIFY_BRN_MIN;
  659. if (event < brn)
  660. event = NOTIFY_BRN_MIN; /* brightness down */
  661. else if (event > brn)
  662. event = NOTIFY_BRN_MIN + 2; /* ... up */
  663. else
  664. event = NOTIFY_BRN_MIN + 1; /* ... unchanged */
  665. }
  666. key = eepc_get_entry_by_scancode(event);
  667. if (key) {
  668. switch (key->type) {
  669. case KE_KEY:
  670. input_report_key(ehotk->inputdev, key->keycode,
  671. 1);
  672. input_sync(ehotk->inputdev);
  673. input_report_key(ehotk->inputdev, key->keycode,
  674. 0);
  675. input_sync(ehotk->inputdev);
  676. break;
  677. }
  678. }
  679. }
  680. }
  681. static int eeepc_register_rfkill_notifier(char *node)
  682. {
  683. acpi_status status = AE_OK;
  684. acpi_handle handle;
  685. status = acpi_get_handle(NULL, node, &handle);
  686. if (ACPI_SUCCESS(status)) {
  687. status = acpi_install_notify_handler(handle,
  688. ACPI_SYSTEM_NOTIFY,
  689. eeepc_rfkill_notify,
  690. NULL);
  691. if (ACPI_FAILURE(status))
  692. pr_warning("Failed to register notify on %s\n", node);
  693. } else
  694. return -ENODEV;
  695. return 0;
  696. }
  697. static void eeepc_unregister_rfkill_notifier(char *node)
  698. {
  699. acpi_status status = AE_OK;
  700. acpi_handle handle;
  701. status = acpi_get_handle(NULL, node, &handle);
  702. if (ACPI_SUCCESS(status)) {
  703. status = acpi_remove_notify_handler(handle,
  704. ACPI_SYSTEM_NOTIFY,
  705. eeepc_rfkill_notify);
  706. if (ACPI_FAILURE(status))
  707. pr_err("Error removing rfkill notify handler %s\n",
  708. node);
  709. }
  710. }
  711. static void eeepc_cleanup_pci_hotplug(struct hotplug_slot *hotplug_slot)
  712. {
  713. kfree(hotplug_slot->info);
  714. kfree(hotplug_slot);
  715. }
  716. static int eeepc_setup_pci_hotplug(void)
  717. {
  718. int ret = -ENOMEM;
  719. struct pci_bus *bus = pci_find_bus(0, 1);
  720. if (!bus) {
  721. pr_err("Unable to find wifi PCI bus\n");
  722. return -ENODEV;
  723. }
  724. ehotk->hotplug_slot = kzalloc(sizeof(struct hotplug_slot), GFP_KERNEL);
  725. if (!ehotk->hotplug_slot)
  726. goto error_slot;
  727. ehotk->hotplug_slot->info = kzalloc(sizeof(struct hotplug_slot_info),
  728. GFP_KERNEL);
  729. if (!ehotk->hotplug_slot->info)
  730. goto error_info;
  731. ehotk->hotplug_slot->private = ehotk;
  732. ehotk->hotplug_slot->release = &eeepc_cleanup_pci_hotplug;
  733. ehotk->hotplug_slot->ops = &eeepc_hotplug_slot_ops;
  734. eeepc_get_adapter_status(ehotk->hotplug_slot,
  735. &ehotk->hotplug_slot->info->adapter_status);
  736. ret = pci_hp_register(ehotk->hotplug_slot, bus, 0, "eeepc-wifi");
  737. if (ret) {
  738. pr_err("Unable to register hotplug slot - %d\n", ret);
  739. goto error_register;
  740. }
  741. return 0;
  742. error_register:
  743. kfree(ehotk->hotplug_slot->info);
  744. error_info:
  745. kfree(ehotk->hotplug_slot);
  746. ehotk->hotplug_slot = NULL;
  747. error_slot:
  748. return ret;
  749. }
  750. static int eeepc_hotk_thaw(struct device *device)
  751. {
  752. if (ehotk->wlan_rfkill) {
  753. bool wlan;
  754. /*
  755. * Work around bios bug - acpi _PTS turns off the wireless led
  756. * during suspend. Normally it restores it on resume, but
  757. * we should kick it ourselves in case hibernation is aborted.
  758. */
  759. wlan = get_acpi(CM_ASL_WLAN);
  760. set_acpi(CM_ASL_WLAN, wlan);
  761. }
  762. return 0;
  763. }
  764. static int eeepc_hotk_restore(struct device *device)
  765. {
  766. /* Refresh both wlan rfkill state and pci hotplug */
  767. if (ehotk->wlan_rfkill)
  768. eeepc_rfkill_hotplug();
  769. if (ehotk->bluetooth_rfkill)
  770. rfkill_set_sw_state(ehotk->bluetooth_rfkill,
  771. get_acpi(CM_ASL_BLUETOOTH) != 1);
  772. if (ehotk->wwan3g_rfkill)
  773. rfkill_set_sw_state(ehotk->wwan3g_rfkill,
  774. get_acpi(CM_ASL_3G) != 1);
  775. if (ehotk->wimax_rfkill)
  776. rfkill_set_sw_state(ehotk->wimax_rfkill,
  777. get_acpi(CM_ASL_WIMAX) != 1);
  778. return 0;
  779. }
  780. /*
  781. * Hwmon
  782. */
  783. static int eeepc_get_fan_pwm(void)
  784. {
  785. int value = 0;
  786. read_acpi_int(NULL, EEEPC_EC_FAN_PWM, &value);
  787. value = value * 255 / 100;
  788. return (value);
  789. }
  790. static void eeepc_set_fan_pwm(int value)
  791. {
  792. value = SENSORS_LIMIT(value, 0, 255);
  793. value = value * 100 / 255;
  794. ec_write(EEEPC_EC_SC02, value);
  795. }
  796. static int eeepc_get_fan_rpm(void)
  797. {
  798. int high = 0;
  799. int low = 0;
  800. read_acpi_int(NULL, EEEPC_EC_FAN_HRPM, &high);
  801. read_acpi_int(NULL, EEEPC_EC_FAN_LRPM, &low);
  802. return (high << 8 | low);
  803. }
  804. static int eeepc_get_fan_ctrl(void)
  805. {
  806. int value = 0;
  807. read_acpi_int(NULL, EEEPC_EC_FAN_CTRL, &value);
  808. return ((value & 0x02 ? 1 : 0));
  809. }
  810. static void eeepc_set_fan_ctrl(int manual)
  811. {
  812. int value = 0;
  813. read_acpi_int(NULL, EEEPC_EC_FAN_CTRL, &value);
  814. if (manual)
  815. value |= 0x02;
  816. else
  817. value &= ~0x02;
  818. ec_write(EEEPC_EC_SFB3, value);
  819. }
  820. static ssize_t store_sys_hwmon(void (*set)(int), const char *buf, size_t count)
  821. {
  822. int rv, value;
  823. rv = parse_arg(buf, count, &value);
  824. if (rv > 0)
  825. set(value);
  826. return rv;
  827. }
  828. static ssize_t show_sys_hwmon(int (*get)(void), char *buf)
  829. {
  830. return sprintf(buf, "%d\n", get());
  831. }
  832. #define EEEPC_CREATE_SENSOR_ATTR(_name, _mode, _set, _get) \
  833. static ssize_t show_##_name(struct device *dev, \
  834. struct device_attribute *attr, \
  835. char *buf) \
  836. { \
  837. return show_sys_hwmon(_set, buf); \
  838. } \
  839. static ssize_t store_##_name(struct device *dev, \
  840. struct device_attribute *attr, \
  841. const char *buf, size_t count) \
  842. { \
  843. return store_sys_hwmon(_get, buf, count); \
  844. } \
  845. static SENSOR_DEVICE_ATTR(_name, _mode, show_##_name, store_##_name, 0);
  846. EEEPC_CREATE_SENSOR_ATTR(fan1_input, S_IRUGO, eeepc_get_fan_rpm, NULL);
  847. EEEPC_CREATE_SENSOR_ATTR(pwm1, S_IRUGO | S_IWUSR,
  848. eeepc_get_fan_pwm, eeepc_set_fan_pwm);
  849. EEEPC_CREATE_SENSOR_ATTR(pwm1_enable, S_IRUGO | S_IWUSR,
  850. eeepc_get_fan_ctrl, eeepc_set_fan_ctrl);
  851. static ssize_t
  852. show_name(struct device *dev, struct device_attribute *attr, char *buf)
  853. {
  854. return sprintf(buf, "eeepc\n");
  855. }
  856. static SENSOR_DEVICE_ATTR(name, S_IRUGO, show_name, NULL, 0);
  857. static struct attribute *hwmon_attributes[] = {
  858. &sensor_dev_attr_pwm1.dev_attr.attr,
  859. &sensor_dev_attr_fan1_input.dev_attr.attr,
  860. &sensor_dev_attr_pwm1_enable.dev_attr.attr,
  861. &sensor_dev_attr_name.dev_attr.attr,
  862. NULL
  863. };
  864. static struct attribute_group hwmon_attribute_group = {
  865. .attrs = hwmon_attributes
  866. };
  867. /*
  868. * exit/init
  869. */
  870. static void eeepc_backlight_exit(void)
  871. {
  872. if (eeepc_backlight_device)
  873. backlight_device_unregister(eeepc_backlight_device);
  874. eeepc_backlight_device = NULL;
  875. }
  876. static void eeepc_rfkill_exit(void)
  877. {
  878. eeepc_unregister_rfkill_notifier("\\_SB.PCI0.P0P5");
  879. eeepc_unregister_rfkill_notifier("\\_SB.PCI0.P0P6");
  880. eeepc_unregister_rfkill_notifier("\\_SB.PCI0.P0P7");
  881. if (ehotk->wlan_rfkill) {
  882. rfkill_unregister(ehotk->wlan_rfkill);
  883. rfkill_destroy(ehotk->wlan_rfkill);
  884. ehotk->wlan_rfkill = NULL;
  885. }
  886. /*
  887. * Refresh pci hotplug in case the rfkill state was changed after
  888. * eeepc_unregister_rfkill_notifier()
  889. */
  890. eeepc_rfkill_hotplug();
  891. if (ehotk->hotplug_slot)
  892. pci_hp_deregister(ehotk->hotplug_slot);
  893. if (ehotk->bluetooth_rfkill) {
  894. rfkill_unregister(ehotk->bluetooth_rfkill);
  895. rfkill_destroy(ehotk->bluetooth_rfkill);
  896. ehotk->bluetooth_rfkill = NULL;
  897. }
  898. if (ehotk->wwan3g_rfkill) {
  899. rfkill_unregister(ehotk->wwan3g_rfkill);
  900. rfkill_destroy(ehotk->wwan3g_rfkill);
  901. ehotk->wwan3g_rfkill = NULL;
  902. }
  903. if (ehotk->wimax_rfkill) {
  904. rfkill_unregister(ehotk->wimax_rfkill);
  905. rfkill_destroy(ehotk->wimax_rfkill);
  906. ehotk->wimax_rfkill = NULL;
  907. }
  908. }
  909. static void eeepc_input_exit(void)
  910. {
  911. if (ehotk->inputdev)
  912. input_unregister_device(ehotk->inputdev);
  913. }
  914. static void eeepc_hwmon_exit(void)
  915. {
  916. struct device *hwmon;
  917. hwmon = eeepc_hwmon_device;
  918. if (!hwmon)
  919. return ;
  920. sysfs_remove_group(&hwmon->kobj,
  921. &hwmon_attribute_group);
  922. hwmon_device_unregister(hwmon);
  923. eeepc_hwmon_device = NULL;
  924. }
  925. static void eeepc_led_exit(void)
  926. {
  927. if (led_workqueue)
  928. destroy_workqueue(led_workqueue);
  929. if (tpd_led.dev)
  930. led_classdev_unregister(&tpd_led);
  931. }
  932. static int eeepc_new_rfkill(struct rfkill **rfkill,
  933. const char *name, struct device *dev,
  934. enum rfkill_type type, int cm)
  935. {
  936. int result;
  937. result = get_acpi(cm);
  938. if (result < 0)
  939. return result;
  940. *rfkill = rfkill_alloc(name, dev, type,
  941. &eeepc_rfkill_ops, (void *)(unsigned long)cm);
  942. if (!*rfkill)
  943. return -EINVAL;
  944. rfkill_init_sw_state(*rfkill, get_acpi(cm) != 1);
  945. result = rfkill_register(*rfkill);
  946. if (result) {
  947. rfkill_destroy(*rfkill);
  948. *rfkill = NULL;
  949. return result;
  950. }
  951. return 0;
  952. }
  953. static int eeepc_rfkill_init(struct device *dev)
  954. {
  955. int result = 0;
  956. mutex_init(&ehotk->hotplug_lock);
  957. result = eeepc_new_rfkill(&ehotk->wlan_rfkill,
  958. "eeepc-wlan", dev,
  959. RFKILL_TYPE_WLAN, CM_ASL_WLAN);
  960. if (result && result != -ENODEV)
  961. goto exit;
  962. result = eeepc_new_rfkill(&ehotk->bluetooth_rfkill,
  963. "eeepc-bluetooth", dev,
  964. RFKILL_TYPE_BLUETOOTH, CM_ASL_BLUETOOTH);
  965. if (result && result != -ENODEV)
  966. goto exit;
  967. result = eeepc_new_rfkill(&ehotk->wwan3g_rfkill,
  968. "eeepc-wwan3g", dev,
  969. RFKILL_TYPE_WWAN, CM_ASL_3G);
  970. if (result && result != -ENODEV)
  971. goto exit;
  972. result = eeepc_new_rfkill(&ehotk->wimax_rfkill,
  973. "eeepc-wimax", dev,
  974. RFKILL_TYPE_WIMAX, CM_ASL_WIMAX);
  975. if (result && result != -ENODEV)
  976. goto exit;
  977. result = eeepc_setup_pci_hotplug();
  978. /*
  979. * If we get -EBUSY then something else is handling the PCI hotplug -
  980. * don't fail in this case
  981. */
  982. if (result == -EBUSY)
  983. result = 0;
  984. eeepc_register_rfkill_notifier("\\_SB.PCI0.P0P5");
  985. eeepc_register_rfkill_notifier("\\_SB.PCI0.P0P6");
  986. eeepc_register_rfkill_notifier("\\_SB.PCI0.P0P7");
  987. /*
  988. * Refresh pci hotplug in case the rfkill state was changed during
  989. * setup.
  990. */
  991. eeepc_rfkill_hotplug();
  992. exit:
  993. if (result && result != -ENODEV)
  994. eeepc_rfkill_exit();
  995. return result;
  996. }
  997. static int eeepc_backlight_init(struct device *dev)
  998. {
  999. struct backlight_device *bd;
  1000. bd = backlight_device_register(EEEPC_HOTK_FILE, dev,
  1001. NULL, &eeepcbl_ops);
  1002. if (IS_ERR(bd)) {
  1003. pr_err("Could not register eeepc backlight device\n");
  1004. eeepc_backlight_device = NULL;
  1005. return PTR_ERR(bd);
  1006. }
  1007. eeepc_backlight_device = bd;
  1008. bd->props.max_brightness = 15;
  1009. bd->props.brightness = read_brightness(NULL);
  1010. bd->props.power = FB_BLANK_UNBLANK;
  1011. backlight_update_status(bd);
  1012. return 0;
  1013. }
  1014. static int eeepc_hwmon_init(struct device *dev)
  1015. {
  1016. struct device *hwmon;
  1017. int result;
  1018. hwmon = hwmon_device_register(dev);
  1019. if (IS_ERR(hwmon)) {
  1020. pr_err("Could not register eeepc hwmon device\n");
  1021. eeepc_hwmon_device = NULL;
  1022. return PTR_ERR(hwmon);
  1023. }
  1024. eeepc_hwmon_device = hwmon;
  1025. result = sysfs_create_group(&hwmon->kobj,
  1026. &hwmon_attribute_group);
  1027. if (result)
  1028. eeepc_hwmon_exit();
  1029. return result;
  1030. }
  1031. static int eeepc_input_init(struct device *dev)
  1032. {
  1033. const struct key_entry *key;
  1034. int result;
  1035. ehotk->inputdev = input_allocate_device();
  1036. if (!ehotk->inputdev) {
  1037. pr_info("Unable to allocate input device\n");
  1038. return -ENOMEM;
  1039. }
  1040. ehotk->inputdev->name = "Asus EeePC extra buttons";
  1041. ehotk->inputdev->dev.parent = dev;
  1042. ehotk->inputdev->phys = EEEPC_HOTK_FILE "/input0";
  1043. ehotk->inputdev->id.bustype = BUS_HOST;
  1044. ehotk->inputdev->getkeycode = eeepc_getkeycode;
  1045. ehotk->inputdev->setkeycode = eeepc_setkeycode;
  1046. for (key = eeepc_keymap; key->type != KE_END; key++) {
  1047. switch (key->type) {
  1048. case KE_KEY:
  1049. set_bit(EV_KEY, ehotk->inputdev->evbit);
  1050. set_bit(key->keycode, ehotk->inputdev->keybit);
  1051. break;
  1052. }
  1053. }
  1054. result = input_register_device(ehotk->inputdev);
  1055. if (result) {
  1056. pr_info("Unable to register input device\n");
  1057. input_free_device(ehotk->inputdev);
  1058. return result;
  1059. }
  1060. return 0;
  1061. }
  1062. static int eeepc_led_init(struct device *dev)
  1063. {
  1064. int rv;
  1065. if (get_acpi(CM_ASL_TPD) == -ENODEV)
  1066. return 0;
  1067. rv = led_classdev_register(dev, &tpd_led);
  1068. if (rv)
  1069. return rv;
  1070. led_workqueue = create_singlethread_workqueue("led_workqueue");
  1071. if (!led_workqueue)
  1072. return -ENOMEM;
  1073. return 0;
  1074. }
  1075. static int __devinit eeepc_hotk_add(struct acpi_device *device)
  1076. {
  1077. struct device *dev;
  1078. int result;
  1079. pr_notice(EEEPC_HOTK_NAME "\n");
  1080. ehotk = kzalloc(sizeof(struct eeepc_hotk), GFP_KERNEL);
  1081. if (!ehotk)
  1082. return -ENOMEM;
  1083. ehotk->init_flag = DISABLE_ASL_WLAN | DISABLE_ASL_DISPLAYSWITCH;
  1084. ehotk->handle = device->handle;
  1085. strcpy(acpi_device_name(device), EEEPC_HOTK_DEVICE_NAME);
  1086. strcpy(acpi_device_class(device), EEEPC_HOTK_CLASS);
  1087. device->driver_data = ehotk;
  1088. ehotk->device = device;
  1089. result = eeepc_hotk_check();
  1090. if (result)
  1091. goto fail_platform_driver;
  1092. eeepc_enable_camera();
  1093. /* Register platform stuff */
  1094. result = platform_driver_register(&platform_driver);
  1095. if (result)
  1096. goto fail_platform_driver;
  1097. platform_device = platform_device_alloc(EEEPC_HOTK_FILE, -1);
  1098. if (!platform_device) {
  1099. result = -ENOMEM;
  1100. goto fail_platform_device1;
  1101. }
  1102. result = platform_device_add(platform_device);
  1103. if (result)
  1104. goto fail_platform_device2;
  1105. result = sysfs_create_group(&platform_device->dev.kobj,
  1106. &platform_attribute_group);
  1107. if (result)
  1108. goto fail_sysfs;
  1109. dev = &platform_device->dev;
  1110. if (!acpi_video_backlight_support()) {
  1111. result = eeepc_backlight_init(dev);
  1112. if (result)
  1113. goto fail_backlight;
  1114. } else
  1115. pr_info("Backlight controlled by ACPI video "
  1116. "driver\n");
  1117. result = eeepc_input_init(dev);
  1118. if (result)
  1119. goto fail_input;
  1120. result = eeepc_hwmon_init(dev);
  1121. if (result)
  1122. goto fail_hwmon;
  1123. result = eeepc_led_init(dev);
  1124. if (result)
  1125. goto fail_led;
  1126. result = eeepc_rfkill_init(dev);
  1127. if (result)
  1128. goto fail_rfkill;
  1129. return 0;
  1130. fail_rfkill:
  1131. eeepc_led_exit();
  1132. fail_led:
  1133. eeepc_hwmon_exit();
  1134. fail_hwmon:
  1135. eeepc_input_exit();
  1136. fail_input:
  1137. eeepc_backlight_exit();
  1138. fail_backlight:
  1139. sysfs_remove_group(&platform_device->dev.kobj,
  1140. &platform_attribute_group);
  1141. fail_sysfs:
  1142. platform_device_del(platform_device);
  1143. fail_platform_device2:
  1144. platform_device_put(platform_device);
  1145. fail_platform_device1:
  1146. platform_driver_unregister(&platform_driver);
  1147. fail_platform_driver:
  1148. kfree(ehotk);
  1149. return result;
  1150. }
  1151. static int eeepc_hotk_remove(struct acpi_device *device, int type)
  1152. {
  1153. eeepc_backlight_exit();
  1154. eeepc_rfkill_exit();
  1155. eeepc_input_exit();
  1156. eeepc_hwmon_exit();
  1157. eeepc_led_exit();
  1158. sysfs_remove_group(&platform_device->dev.kobj,
  1159. &platform_attribute_group);
  1160. platform_device_unregister(platform_device);
  1161. platform_driver_unregister(&platform_driver);
  1162. kfree(ehotk);
  1163. return 0;
  1164. }
  1165. static int __init eeepc_laptop_init(void)
  1166. {
  1167. int result;
  1168. result = acpi_bus_register_driver(&eeepc_hotk_driver);
  1169. if (result < 0)
  1170. return result;
  1171. if (!ehotk) {
  1172. acpi_bus_unregister_driver(&eeepc_hotk_driver);
  1173. return -ENODEV;
  1174. }
  1175. return 0;
  1176. }
  1177. static void __exit eeepc_laptop_exit(void)
  1178. {
  1179. acpi_bus_unregister_driver(&eeepc_hotk_driver);
  1180. }
  1181. module_init(eeepc_laptop_init);
  1182. module_exit(eeepc_laptop_exit);