ibm_acpi.c 44 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973
  1. /*
  2. * ibm_acpi.c - IBM ThinkPad ACPI Extras
  3. *
  4. *
  5. * Copyright (C) 2004-2005 Borislav Deianov <borislav@users.sf.net>
  6. *
  7. * This program is free software; you can redistribute it and/or modify
  8. * it under the terms of the GNU General Public License as published by
  9. * the Free Software Foundation; either version 2 of the License, or
  10. * (at your option) any later version.
  11. *
  12. * This program is distributed in the hope that it will be useful,
  13. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  14. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  15. * GNU General Public License for more details.
  16. *
  17. * You should have received a copy of the GNU General Public License
  18. * along with this program; if not, write to the Free Software
  19. * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
  20. */
  21. #define IBM_VERSION "0.12a"
  22. /*
  23. * Changelog:
  24. *
  25. * 2005-08-17 0.12 fix compilation on 2.6.13-rc kernels
  26. * 2005-03-17 0.11 support for 600e, 770x
  27. * thanks to Jamie Lentin <lentinj@dial.pipex.com>
  28. * support for 770e, G41
  29. * G40 and G41 don't have a thinklight
  30. * temperatures no longer experimental
  31. * experimental brightness control
  32. * experimental volume control
  33. * experimental fan enable/disable
  34. * 2005-01-16 0.10 fix module loading on R30, R31
  35. * 2005-01-16 0.9 support for 570, R30, R31
  36. * ultrabay support on A22p, A3x
  37. * limit arg for cmos, led, beep, drop experimental status
  38. * more capable led control on A21e, A22p, T20-22, X20
  39. * experimental temperatures and fan speed
  40. * experimental embedded controller register dump
  41. * mark more functions as __init, drop incorrect __exit
  42. * use MODULE_VERSION
  43. * thanks to Henrik Brix Andersen <brix@gentoo.org>
  44. * fix parameter passing on module loading
  45. * thanks to Rusty Russell <rusty@rustcorp.com.au>
  46. * thanks to Jim Radford <radford@blackbean.org>
  47. * 2004-11-08 0.8 fix init error case, don't return from a macro
  48. * thanks to Chris Wright <chrisw@osdl.org>
  49. * 2004-10-23 0.7 fix module loading on A21e, A22p, T20, T21, X20
  50. * fix led control on A21e
  51. * 2004-10-19 0.6 use acpi_bus_register_driver() to claim HKEY device
  52. * 2004-10-18 0.5 thinklight support on A21e, G40, R32, T20, T21, X20
  53. * proc file format changed
  54. * video_switch command
  55. * experimental cmos control
  56. * experimental led control
  57. * experimental acpi sounds
  58. * 2004-09-16 0.4 support for module parameters
  59. * hotkey mask can be prefixed by 0x
  60. * video output switching
  61. * video expansion control
  62. * ultrabay eject support
  63. * removed lcd brightness/on/off control, didn't work
  64. * 2004-08-17 0.3 support for R40
  65. * lcd off, brightness control
  66. * thinklight on/off
  67. * 2004-08-14 0.2 support for T series, X20
  68. * bluetooth enable/disable
  69. * hotkey events disabled by default
  70. * removed fan control, currently useless
  71. * 2004-08-09 0.1 initial release, support for X series
  72. */
  73. #include <linux/kernel.h>
  74. #include <linux/module.h>
  75. #include <linux/init.h>
  76. #include <linux/types.h>
  77. #include <linux/proc_fs.h>
  78. #include <asm/uaccess.h>
  79. #include <acpi/acpi_drivers.h>
  80. #include <acpi/acnamesp.h>
  81. #define IBM_NAME "ibm"
  82. #define IBM_DESC "IBM ThinkPad ACPI Extras"
  83. #define IBM_FILE "ibm_acpi"
  84. #define IBM_URL "http://ibm-acpi.sf.net/"
  85. MODULE_AUTHOR("Borislav Deianov");
  86. MODULE_DESCRIPTION(IBM_DESC);
  87. MODULE_VERSION(IBM_VERSION);
  88. MODULE_LICENSE("GPL");
  89. #define IBM_DIR IBM_NAME
  90. #define IBM_LOG IBM_FILE ": "
  91. #define IBM_ERR KERN_ERR IBM_LOG
  92. #define IBM_NOTICE KERN_NOTICE IBM_LOG
  93. #define IBM_INFO KERN_INFO IBM_LOG
  94. #define IBM_DEBUG KERN_DEBUG IBM_LOG
  95. #define IBM_MAX_ACPI_ARGS 3
  96. #define __unused __attribute__ ((unused))
  97. static int experimental;
  98. module_param(experimental, int, 0);
  99. static acpi_handle root_handle = NULL;
  100. #define IBM_HANDLE(object, parent, paths...) \
  101. static acpi_handle object##_handle; \
  102. static acpi_handle *object##_parent = &parent##_handle; \
  103. static char *object##_path; \
  104. static char *object##_paths[] = { paths }
  105. /*
  106. * The following models are supported to various degrees:
  107. *
  108. * 570, 600e, 600x, 770e, 770x
  109. * A20m, A21e, A21m, A21p, A22p, A30, A30p, A31, A31p
  110. * G40, G41
  111. * R30, R31, R32, R40, R40e, R50, R50e, R50p, R51
  112. * T20, T21, T22, T23, T30, T40, T40p, T41, T41p, T42, T42p, T43
  113. * X20, X21, X22, X23, X24, X30, X31, X40
  114. *
  115. * The following models have no supported features:
  116. *
  117. * 240, 240x, i1400
  118. *
  119. * Still missing DSDTs for the following models:
  120. *
  121. * A20p, A22e, A22m
  122. * R52
  123. * S31
  124. * T43p
  125. */
  126. IBM_HANDLE(ec, root, "\\_SB.PCI0.ISA.EC0", /* 240, 240x */
  127. "\\_SB.PCI.ISA.EC", /* 570 */
  128. "\\_SB.PCI0.ISA0.EC0", /* 600e/x, 770e, 770x */
  129. "\\_SB.PCI0.ISA.EC", /* A21e, A2xm/p, T20-22, X20-21 */
  130. "\\_SB.PCI0.AD4S.EC0", /* i1400, R30 */
  131. "\\_SB.PCI0.ICH3.EC0", /* R31 */
  132. "\\_SB.PCI0.LPC.EC", /* all others */
  133. );
  134. IBM_HANDLE(vid, root, "\\_SB.PCI.AGP.VGA", /* 570 */
  135. "\\_SB.PCI0.AGP0.VID0", /* 600e/x, 770x */
  136. "\\_SB.PCI0.VID0", /* 770e */
  137. "\\_SB.PCI0.VID", /* A21e, G4x, R50e, X30, X40 */
  138. "\\_SB.PCI0.AGP.VID", /* all others */
  139. ); /* R30, R31 */
  140. IBM_HANDLE(vid2, root, "\\_SB.PCI0.AGPB.VID"); /* G41 */
  141. IBM_HANDLE(cmos, root, "\\UCMS", /* R50, R50e, R50p, R51, T4x, X31, X40 */
  142. "\\CMOS", /* A3x, G4x, R32, T23, T30, X22-24, X30 */
  143. "\\CMS", /* R40, R40e */
  144. ); /* all others */
  145. #ifdef CONFIG_ACPI_IBM_DOCK
  146. IBM_HANDLE(dock, root, "\\_SB.GDCK", /* X30, X31, X40 */
  147. "\\_SB.PCI0.DOCK", /* 600e/x,770e,770x,A2xm/p,T20-22,X20-21 */
  148. "\\_SB.PCI0.PCI1.DOCK", /* all others */
  149. "\\_SB.PCI.ISA.SLCE", /* 570 */
  150. ); /* A21e,G4x,R30,R31,R32,R40,R40e,R50e */
  151. #endif
  152. IBM_HANDLE(bay, root, "\\_SB.PCI.IDE.SECN.MAST", /* 570 */
  153. "\\_SB.PCI0.IDE0.IDES.IDSM", /* 600e/x, 770e, 770x */
  154. "\\_SB.PCI0.IDE0.SCND.MSTR", /* all others */
  155. ); /* A21e, R30, R31 */
  156. IBM_HANDLE(bay_ej, bay, "_EJ3", /* 600e/x, A2xm/p, A3x */
  157. "_EJ0", /* all others */
  158. ); /* 570,A21e,G4x,R30,R31,R32,R40e,R50e */
  159. IBM_HANDLE(bay2, root, "\\_SB.PCI0.IDE0.PRIM.SLAV", /* A3x, R32 */
  160. "\\_SB.PCI0.IDE0.IDEP.IDPS", /* 600e/x, 770e, 770x */
  161. ); /* all others */
  162. IBM_HANDLE(bay2_ej, bay2, "_EJ3", /* 600e/x, 770e, A3x */
  163. "_EJ0", /* 770x */
  164. ); /* all others */
  165. /* don't list other alternatives as we install a notify handler on the 570 */
  166. IBM_HANDLE(pci, root, "\\_SB.PCI"); /* 570 */
  167. IBM_HANDLE(hkey, ec, "\\_SB.HKEY", /* 600e/x, 770e, 770x */
  168. "^HKEY", /* R30, R31 */
  169. "HKEY", /* all others */
  170. ); /* 570 */
  171. IBM_HANDLE(lght, root, "\\LGHT"); /* A21e, A2xm/p, T20-22, X20-21 */
  172. IBM_HANDLE(ledb, ec, "LEDB"); /* G4x */
  173. IBM_HANDLE(led, ec, "SLED", /* 570 */
  174. "SYSL", /* 600e/x, 770e, 770x, A21e, A2xm/p, T20-22, X20-21 */
  175. "LED", /* all others */
  176. ); /* R30, R31 */
  177. IBM_HANDLE(beep, ec, "BEEP"); /* all except R30, R31 */
  178. IBM_HANDLE(ecrd, ec, "ECRD"); /* 570 */
  179. IBM_HANDLE(ecwr, ec, "ECWR"); /* 570 */
  180. IBM_HANDLE(fans, ec, "FANS"); /* X31, X40 */
  181. IBM_HANDLE(gfan, ec, "GFAN", /* 570 */
  182. "\\FSPD", /* 600e/x, 770e, 770x */
  183. ); /* all others */
  184. IBM_HANDLE(sfan, ec, "SFAN", /* 570 */
  185. "JFNS", /* 770x-JL */
  186. ); /* all others */
  187. #define IBM_HKEY_HID "IBM0068"
  188. #define IBM_PCI_HID "PNP0A03"
  189. struct ibm_struct {
  190. char *name;
  191. char param[32];
  192. char *hid;
  193. struct acpi_driver *driver;
  194. int (*init) (void);
  195. int (*read) (char *);
  196. int (*write) (char *);
  197. void (*exit) (void);
  198. void (*notify) (struct ibm_struct *, u32);
  199. acpi_handle *handle;
  200. int type;
  201. struct acpi_device *device;
  202. int driver_registered;
  203. int proc_created;
  204. int init_called;
  205. int notify_installed;
  206. int experimental;
  207. };
  208. static struct proc_dir_entry *proc_dir = NULL;
  209. #define onoff(status,bit) ((status) & (1 << (bit)) ? "on" : "off")
  210. #define enabled(status,bit) ((status) & (1 << (bit)) ? "enabled" : "disabled")
  211. #define strlencmp(a,b) (strncmp((a), (b), strlen(b)))
  212. static int acpi_evalf(acpi_handle handle,
  213. void *res, char *method, char *fmt, ...)
  214. {
  215. char *fmt0 = fmt;
  216. struct acpi_object_list params;
  217. union acpi_object in_objs[IBM_MAX_ACPI_ARGS];
  218. struct acpi_buffer result, *resultp;
  219. union acpi_object out_obj;
  220. acpi_status status;
  221. va_list ap;
  222. char res_type;
  223. int success;
  224. int quiet;
  225. if (!*fmt) {
  226. printk(IBM_ERR "acpi_evalf() called with empty format\n");
  227. return 0;
  228. }
  229. if (*fmt == 'q') {
  230. quiet = 1;
  231. fmt++;
  232. } else
  233. quiet = 0;
  234. res_type = *(fmt++);
  235. params.count = 0;
  236. params.pointer = &in_objs[0];
  237. va_start(ap, fmt);
  238. while (*fmt) {
  239. char c = *(fmt++);
  240. switch (c) {
  241. case 'd': /* int */
  242. in_objs[params.count].integer.value = va_arg(ap, int);
  243. in_objs[params.count++].type = ACPI_TYPE_INTEGER;
  244. break;
  245. /* add more types as needed */
  246. default:
  247. printk(IBM_ERR "acpi_evalf() called "
  248. "with invalid format character '%c'\n", c);
  249. return 0;
  250. }
  251. }
  252. va_end(ap);
  253. if (res_type != 'v') {
  254. result.length = sizeof(out_obj);
  255. result.pointer = &out_obj;
  256. resultp = &result;
  257. } else
  258. resultp = NULL;
  259. status = acpi_evaluate_object(handle, method, &params, resultp);
  260. switch (res_type) {
  261. case 'd': /* int */
  262. if (res)
  263. *(int *)res = out_obj.integer.value;
  264. success = status == AE_OK && out_obj.type == ACPI_TYPE_INTEGER;
  265. break;
  266. case 'v': /* void */
  267. success = status == AE_OK;
  268. break;
  269. /* add more types as needed */
  270. default:
  271. printk(IBM_ERR "acpi_evalf() called "
  272. "with invalid format character '%c'\n", res_type);
  273. return 0;
  274. }
  275. if (!success && !quiet)
  276. printk(IBM_ERR "acpi_evalf(%s, %s, ...) failed: %d\n",
  277. method, fmt0, status);
  278. return success;
  279. }
  280. static void __unused acpi_print_int(acpi_handle handle, char *method)
  281. {
  282. int i;
  283. if (acpi_evalf(handle, &i, method, "d"))
  284. printk(IBM_INFO "%s = 0x%x\n", method, i);
  285. else
  286. printk(IBM_ERR "error calling %s\n", method);
  287. }
  288. static char *next_cmd(char **cmds)
  289. {
  290. char *start = *cmds;
  291. char *end;
  292. while ((end = strchr(start, ',')) && end == start)
  293. start = end + 1;
  294. if (!end)
  295. return NULL;
  296. *end = 0;
  297. *cmds = end + 1;
  298. return start;
  299. }
  300. static int driver_init(void)
  301. {
  302. printk(IBM_INFO "%s v%s\n", IBM_DESC, IBM_VERSION);
  303. printk(IBM_INFO "%s\n", IBM_URL);
  304. return 0;
  305. }
  306. static int driver_read(char *p)
  307. {
  308. int len = 0;
  309. len += sprintf(p + len, "driver:\t\t%s\n", IBM_DESC);
  310. len += sprintf(p + len, "version:\t%s\n", IBM_VERSION);
  311. return len;
  312. }
  313. static int hotkey_supported;
  314. static int hotkey_mask_supported;
  315. static int hotkey_orig_status;
  316. static int hotkey_orig_mask;
  317. static int hotkey_get(int *status, int *mask)
  318. {
  319. if (!acpi_evalf(hkey_handle, status, "DHKC", "d"))
  320. return 0;
  321. if (hotkey_mask_supported)
  322. if (!acpi_evalf(hkey_handle, mask, "DHKN", "d"))
  323. return 0;
  324. return 1;
  325. }
  326. static int hotkey_set(int status, int mask)
  327. {
  328. int i;
  329. if (!acpi_evalf(hkey_handle, NULL, "MHKC", "vd", status))
  330. return 0;
  331. if (hotkey_mask_supported)
  332. for (i = 0; i < 32; i++) {
  333. int bit = ((1 << i) & mask) != 0;
  334. if (!acpi_evalf(hkey_handle,
  335. NULL, "MHKM", "vdd", i + 1, bit))
  336. return 0;
  337. }
  338. return 1;
  339. }
  340. static int hotkey_init(void)
  341. {
  342. /* hotkey not supported on 570 */
  343. hotkey_supported = hkey_handle != NULL;
  344. if (hotkey_supported) {
  345. /* mask not supported on 570, 600e/x, 770e, 770x, A21e, A2xm/p,
  346. A30, R30, R31, T20-22, X20-21, X22-24 */
  347. hotkey_mask_supported =
  348. acpi_evalf(hkey_handle, NULL, "DHKN", "qv");
  349. if (!hotkey_get(&hotkey_orig_status, &hotkey_orig_mask))
  350. return -ENODEV;
  351. }
  352. return 0;
  353. }
  354. static int hotkey_read(char *p)
  355. {
  356. int status, mask;
  357. int len = 0;
  358. if (!hotkey_supported) {
  359. len += sprintf(p + len, "status:\t\tnot supported\n");
  360. return len;
  361. }
  362. if (!hotkey_get(&status, &mask))
  363. return -EIO;
  364. len += sprintf(p + len, "status:\t\t%s\n", enabled(status, 0));
  365. if (hotkey_mask_supported) {
  366. len += sprintf(p + len, "mask:\t\t0x%04x\n", mask);
  367. len += sprintf(p + len,
  368. "commands:\tenable, disable, reset, <mask>\n");
  369. } else {
  370. len += sprintf(p + len, "mask:\t\tnot supported\n");
  371. len += sprintf(p + len, "commands:\tenable, disable, reset\n");
  372. }
  373. return len;
  374. }
  375. static int hotkey_write(char *buf)
  376. {
  377. int status, mask;
  378. char *cmd;
  379. int do_cmd = 0;
  380. if (!hotkey_supported)
  381. return -ENODEV;
  382. if (!hotkey_get(&status, &mask))
  383. return -EIO;
  384. while ((cmd = next_cmd(&buf))) {
  385. if (strlencmp(cmd, "enable") == 0) {
  386. status = 1;
  387. } else if (strlencmp(cmd, "disable") == 0) {
  388. status = 0;
  389. } else if (strlencmp(cmd, "reset") == 0) {
  390. status = hotkey_orig_status;
  391. mask = hotkey_orig_mask;
  392. } else if (sscanf(cmd, "0x%x", &mask) == 1) {
  393. /* mask set */
  394. } else if (sscanf(cmd, "%x", &mask) == 1) {
  395. /* mask set */
  396. } else
  397. return -EINVAL;
  398. do_cmd = 1;
  399. }
  400. if (do_cmd && !hotkey_set(status, mask))
  401. return -EIO;
  402. return 0;
  403. }
  404. static void hotkey_exit(void)
  405. {
  406. if (hotkey_supported)
  407. hotkey_set(hotkey_orig_status, hotkey_orig_mask);
  408. }
  409. static void hotkey_notify(struct ibm_struct *ibm, u32 event)
  410. {
  411. int hkey;
  412. if (acpi_evalf(hkey_handle, &hkey, "MHKP", "d"))
  413. acpi_bus_generate_event(ibm->device, event, hkey);
  414. else {
  415. printk(IBM_ERR "unknown hotkey event %d\n", event);
  416. acpi_bus_generate_event(ibm->device, event, 0);
  417. }
  418. }
  419. static int bluetooth_supported;
  420. static int bluetooth_init(void)
  421. {
  422. /* bluetooth not supported on 570, 600e/x, 770e, 770x, A21e, A2xm/p,
  423. G4x, R30, R31, R40e, R50e, T20-22, X20-21 */
  424. bluetooth_supported = hkey_handle &&
  425. acpi_evalf(hkey_handle, NULL, "GBDC", "qv");
  426. return 0;
  427. }
  428. static int bluetooth_status(void)
  429. {
  430. int status;
  431. if (!bluetooth_supported ||
  432. !acpi_evalf(hkey_handle, &status, "GBDC", "d"))
  433. status = 0;
  434. return status;
  435. }
  436. static int bluetooth_read(char *p)
  437. {
  438. int len = 0;
  439. int status = bluetooth_status();
  440. if (!bluetooth_supported)
  441. len += sprintf(p + len, "status:\t\tnot supported\n");
  442. else if (!(status & 1))
  443. len += sprintf(p + len, "status:\t\tnot installed\n");
  444. else {
  445. len += sprintf(p + len, "status:\t\t%s\n", enabled(status, 1));
  446. len += sprintf(p + len, "commands:\tenable, disable\n");
  447. }
  448. return len;
  449. }
  450. static int bluetooth_write(char *buf)
  451. {
  452. int status = bluetooth_status();
  453. char *cmd;
  454. int do_cmd = 0;
  455. if (!bluetooth_supported)
  456. return -ENODEV;
  457. while ((cmd = next_cmd(&buf))) {
  458. if (strlencmp(cmd, "enable") == 0) {
  459. status |= 2;
  460. } else if (strlencmp(cmd, "disable") == 0) {
  461. status &= ~2;
  462. } else
  463. return -EINVAL;
  464. do_cmd = 1;
  465. }
  466. if (do_cmd && !acpi_evalf(hkey_handle, NULL, "SBDC", "vd", status))
  467. return -EIO;
  468. return 0;
  469. }
  470. static int video_supported;
  471. static int video_orig_autosw;
  472. #define VIDEO_570 1
  473. #define VIDEO_770 2
  474. #define VIDEO_NEW 3
  475. static int video_init(void)
  476. {
  477. int ivga;
  478. if (vid2_handle && acpi_evalf(NULL, &ivga, "\\IVGA", "d") && ivga)
  479. /* G41, assume IVGA doesn't change */
  480. vid_handle = vid2_handle;
  481. if (!vid_handle)
  482. /* video switching not supported on R30, R31 */
  483. video_supported = 0;
  484. else if (acpi_evalf(vid_handle, &video_orig_autosw, "SWIT", "qd"))
  485. /* 570 */
  486. video_supported = VIDEO_570;
  487. else if (acpi_evalf(vid_handle, &video_orig_autosw, "^VADL", "qd"))
  488. /* 600e/x, 770e, 770x */
  489. video_supported = VIDEO_770;
  490. else
  491. /* all others */
  492. video_supported = VIDEO_NEW;
  493. return 0;
  494. }
  495. static int video_status(void)
  496. {
  497. int status = 0;
  498. int i;
  499. if (video_supported == VIDEO_570) {
  500. if (acpi_evalf(NULL, &i, "\\_SB.PHS", "dd", 0x87))
  501. status = i & 3;
  502. } else if (video_supported == VIDEO_770) {
  503. if (acpi_evalf(NULL, &i, "\\VCDL", "d"))
  504. status |= 0x01 * i;
  505. if (acpi_evalf(NULL, &i, "\\VCDC", "d"))
  506. status |= 0x02 * i;
  507. } else if (video_supported == VIDEO_NEW) {
  508. acpi_evalf(NULL, NULL, "\\VUPS", "vd", 1);
  509. if (acpi_evalf(NULL, &i, "\\VCDC", "d"))
  510. status |= 0x02 * i;
  511. acpi_evalf(NULL, NULL, "\\VUPS", "vd", 0);
  512. if (acpi_evalf(NULL, &i, "\\VCDL", "d"))
  513. status |= 0x01 * i;
  514. if (acpi_evalf(NULL, &i, "\\VCDD", "d"))
  515. status |= 0x08 * i;
  516. }
  517. return status;
  518. }
  519. static int video_autosw(void)
  520. {
  521. int autosw = 0;
  522. if (video_supported == VIDEO_570)
  523. acpi_evalf(vid_handle, &autosw, "SWIT", "d");
  524. else if (video_supported == VIDEO_770 || video_supported == VIDEO_NEW)
  525. acpi_evalf(vid_handle, &autosw, "^VDEE", "d");
  526. return autosw & 1;
  527. }
  528. static int video_read(char *p)
  529. {
  530. int status = video_status();
  531. int autosw = video_autosw();
  532. int len = 0;
  533. if (!video_supported) {
  534. len += sprintf(p + len, "status:\t\tnot supported\n");
  535. return len;
  536. }
  537. len += sprintf(p + len, "status:\t\tsupported\n");
  538. len += sprintf(p + len, "lcd:\t\t%s\n", enabled(status, 0));
  539. len += sprintf(p + len, "crt:\t\t%s\n", enabled(status, 1));
  540. if (video_supported == VIDEO_NEW)
  541. len += sprintf(p + len, "dvi:\t\t%s\n", enabled(status, 3));
  542. len += sprintf(p + len, "auto:\t\t%s\n", enabled(autosw, 0));
  543. len += sprintf(p + len, "commands:\tlcd_enable, lcd_disable\n");
  544. len += sprintf(p + len, "commands:\tcrt_enable, crt_disable\n");
  545. if (video_supported == VIDEO_NEW)
  546. len += sprintf(p + len, "commands:\tdvi_enable, dvi_disable\n");
  547. len += sprintf(p + len, "commands:\tauto_enable, auto_disable\n");
  548. len += sprintf(p + len, "commands:\tvideo_switch, expand_toggle\n");
  549. return len;
  550. }
  551. static int video_switch(void)
  552. {
  553. int autosw = video_autosw();
  554. int ret;
  555. if (!acpi_evalf(vid_handle, NULL, "_DOS", "vd", 1))
  556. return -EIO;
  557. ret = video_supported == VIDEO_570 ?
  558. acpi_evalf(ec_handle, NULL, "_Q16", "v") :
  559. acpi_evalf(vid_handle, NULL, "VSWT", "v");
  560. acpi_evalf(vid_handle, NULL, "_DOS", "vd", autosw);
  561. return ret;
  562. }
  563. static int video_expand(void)
  564. {
  565. if (video_supported == VIDEO_570)
  566. return acpi_evalf(ec_handle, NULL, "_Q17", "v");
  567. else if (video_supported == VIDEO_770)
  568. return acpi_evalf(vid_handle, NULL, "VEXP", "v");
  569. else
  570. return acpi_evalf(NULL, NULL, "\\VEXP", "v");
  571. }
  572. static int video_switch2(int status)
  573. {
  574. int ret;
  575. if (video_supported == VIDEO_570) {
  576. ret = acpi_evalf(NULL, NULL,
  577. "\\_SB.PHS2", "vdd", 0x8b, status | 0x80);
  578. } else if (video_supported == VIDEO_770) {
  579. int autosw = video_autosw();
  580. if (!acpi_evalf(vid_handle, NULL, "_DOS", "vd", 1))
  581. return -EIO;
  582. ret = acpi_evalf(vid_handle, NULL,
  583. "ASWT", "vdd", status * 0x100, 0);
  584. acpi_evalf(vid_handle, NULL, "_DOS", "vd", autosw);
  585. } else {
  586. ret = acpi_evalf(NULL, NULL, "\\VUPS", "vd", 0x80) &&
  587. acpi_evalf(NULL, NULL, "\\VSDS", "vdd", status, 1);
  588. }
  589. return ret;
  590. }
  591. static int video_write(char *buf)
  592. {
  593. char *cmd;
  594. int enable, disable, status;
  595. if (!video_supported)
  596. return -ENODEV;
  597. enable = disable = 0;
  598. while ((cmd = next_cmd(&buf))) {
  599. if (strlencmp(cmd, "lcd_enable") == 0) {
  600. enable |= 0x01;
  601. } else if (strlencmp(cmd, "lcd_disable") == 0) {
  602. disable |= 0x01;
  603. } else if (strlencmp(cmd, "crt_enable") == 0) {
  604. enable |= 0x02;
  605. } else if (strlencmp(cmd, "crt_disable") == 0) {
  606. disable |= 0x02;
  607. } else if (video_supported == VIDEO_NEW &&
  608. strlencmp(cmd, "dvi_enable") == 0) {
  609. enable |= 0x08;
  610. } else if (video_supported == VIDEO_NEW &&
  611. strlencmp(cmd, "dvi_disable") == 0) {
  612. disable |= 0x08;
  613. } else if (strlencmp(cmd, "auto_enable") == 0) {
  614. if (!acpi_evalf(vid_handle, NULL, "_DOS", "vd", 1))
  615. return -EIO;
  616. } else if (strlencmp(cmd, "auto_disable") == 0) {
  617. if (!acpi_evalf(vid_handle, NULL, "_DOS", "vd", 0))
  618. return -EIO;
  619. } else if (strlencmp(cmd, "video_switch") == 0) {
  620. if (!video_switch())
  621. return -EIO;
  622. } else if (strlencmp(cmd, "expand_toggle") == 0) {
  623. if (!video_expand())
  624. return -EIO;
  625. } else
  626. return -EINVAL;
  627. }
  628. if (enable || disable) {
  629. status = (video_status() & 0x0f & ~disable) | enable;
  630. if (!video_switch2(status))
  631. return -EIO;
  632. }
  633. return 0;
  634. }
  635. static void video_exit(void)
  636. {
  637. acpi_evalf(vid_handle, NULL, "_DOS", "vd", video_orig_autosw);
  638. }
  639. static int light_supported;
  640. static int light_status_supported;
  641. static int light_init(void)
  642. {
  643. /* light not supported on 570, 600e/x, 770e, 770x, G4x, R30, R31 */
  644. light_supported = (cmos_handle || lght_handle) && !ledb_handle;
  645. if (light_supported)
  646. /* light status not supported on
  647. 570, 600e/x, 770e, 770x, G4x, R30, R31, R32, X20 */
  648. light_status_supported = acpi_evalf(ec_handle, NULL,
  649. "KBLT", "qv");
  650. return 0;
  651. }
  652. static int light_read(char *p)
  653. {
  654. int len = 0;
  655. int status = 0;
  656. if (!light_supported) {
  657. len += sprintf(p + len, "status:\t\tnot supported\n");
  658. } else if (!light_status_supported) {
  659. len += sprintf(p + len, "status:\t\tunknown\n");
  660. len += sprintf(p + len, "commands:\ton, off\n");
  661. } else {
  662. if (!acpi_evalf(ec_handle, &status, "KBLT", "d"))
  663. return -EIO;
  664. len += sprintf(p + len, "status:\t\t%s\n", onoff(status, 0));
  665. len += sprintf(p + len, "commands:\ton, off\n");
  666. }
  667. return len;
  668. }
  669. static int light_write(char *buf)
  670. {
  671. int cmos_cmd, lght_cmd;
  672. char *cmd;
  673. int success;
  674. if (!light_supported)
  675. return -ENODEV;
  676. while ((cmd = next_cmd(&buf))) {
  677. if (strlencmp(cmd, "on") == 0) {
  678. cmos_cmd = 0x0c;
  679. lght_cmd = 1;
  680. } else if (strlencmp(cmd, "off") == 0) {
  681. cmos_cmd = 0x0d;
  682. lght_cmd = 0;
  683. } else
  684. return -EINVAL;
  685. success = cmos_handle ?
  686. acpi_evalf(cmos_handle, NULL, NULL, "vd", cmos_cmd) :
  687. acpi_evalf(lght_handle, NULL, NULL, "vd", lght_cmd);
  688. if (!success)
  689. return -EIO;
  690. }
  691. return 0;
  692. }
  693. static int _sta(acpi_handle handle)
  694. {
  695. int status;
  696. if (!handle || !acpi_evalf(handle, &status, "_STA", "d"))
  697. status = 0;
  698. return status;
  699. }
  700. #ifdef CONFIG_ACPI_IBM_DOCK
  701. #define dock_docked() (_sta(dock_handle) & 1)
  702. static int dock_read(char *p)
  703. {
  704. int len = 0;
  705. int docked = dock_docked();
  706. if (!dock_handle)
  707. len += sprintf(p + len, "status:\t\tnot supported\n");
  708. else if (!docked)
  709. len += sprintf(p + len, "status:\t\tundocked\n");
  710. else {
  711. len += sprintf(p + len, "status:\t\tdocked\n");
  712. len += sprintf(p + len, "commands:\tdock, undock\n");
  713. }
  714. return len;
  715. }
  716. static int dock_write(char *buf)
  717. {
  718. char *cmd;
  719. if (!dock_docked())
  720. return -ENODEV;
  721. while ((cmd = next_cmd(&buf))) {
  722. if (strlencmp(cmd, "undock") == 0) {
  723. if (!acpi_evalf(dock_handle, NULL, "_DCK", "vd", 0) ||
  724. !acpi_evalf(dock_handle, NULL, "_EJ0", "vd", 1))
  725. return -EIO;
  726. } else if (strlencmp(cmd, "dock") == 0) {
  727. if (!acpi_evalf(dock_handle, NULL, "_DCK", "vd", 1))
  728. return -EIO;
  729. } else
  730. return -EINVAL;
  731. }
  732. return 0;
  733. }
  734. static void dock_notify(struct ibm_struct *ibm, u32 event)
  735. {
  736. int docked = dock_docked();
  737. int pci = ibm->hid && strstr(ibm->hid, IBM_PCI_HID);
  738. if (event == 1 && !pci) /* 570 */
  739. acpi_bus_generate_event(ibm->device, event, 1); /* button */
  740. else if (event == 1 && pci) /* 570 */
  741. acpi_bus_generate_event(ibm->device, event, 3); /* dock */
  742. else if (event == 3 && docked)
  743. acpi_bus_generate_event(ibm->device, event, 1); /* button */
  744. else if (event == 3 && !docked)
  745. acpi_bus_generate_event(ibm->device, event, 2); /* undock */
  746. else if (event == 0 && docked)
  747. acpi_bus_generate_event(ibm->device, event, 3); /* dock */
  748. else {
  749. printk(IBM_ERR "unknown dock event %d, status %d\n",
  750. event, _sta(dock_handle));
  751. acpi_bus_generate_event(ibm->device, event, 0); /* unknown */
  752. }
  753. }
  754. #endif
  755. static int bay_status_supported;
  756. static int bay_status2_supported;
  757. static int bay_eject_supported;
  758. static int bay_eject2_supported;
  759. static int bay_init(void)
  760. {
  761. bay_status_supported = bay_handle &&
  762. acpi_evalf(bay_handle, NULL, "_STA", "qv");
  763. bay_status2_supported = bay2_handle &&
  764. acpi_evalf(bay2_handle, NULL, "_STA", "qv");
  765. bay_eject_supported = bay_handle && bay_ej_handle &&
  766. (strlencmp(bay_ej_path, "_EJ0") == 0 || experimental);
  767. bay_eject2_supported = bay2_handle && bay2_ej_handle &&
  768. (strlencmp(bay2_ej_path, "_EJ0") == 0 || experimental);
  769. return 0;
  770. }
  771. #define bay_occupied(b) (_sta(b##_handle) & 1)
  772. static int bay_read(char *p)
  773. {
  774. int len = 0;
  775. int occupied = bay_occupied(bay);
  776. int occupied2 = bay_occupied(bay2);
  777. int eject, eject2;
  778. len += sprintf(p + len, "status:\t\t%s\n", bay_status_supported ?
  779. (occupied ? "occupied" : "unoccupied") :
  780. "not supported");
  781. if (bay_status2_supported)
  782. len += sprintf(p + len, "status2:\t%s\n", occupied2 ?
  783. "occupied" : "unoccupied");
  784. eject = bay_eject_supported && occupied;
  785. eject2 = bay_eject2_supported && occupied2;
  786. if (eject && eject2)
  787. len += sprintf(p + len, "commands:\teject, eject2\n");
  788. else if (eject)
  789. len += sprintf(p + len, "commands:\teject\n");
  790. else if (eject2)
  791. len += sprintf(p + len, "commands:\teject2\n");
  792. return len;
  793. }
  794. static int bay_write(char *buf)
  795. {
  796. char *cmd;
  797. if (!bay_eject_supported && !bay_eject2_supported)
  798. return -ENODEV;
  799. while ((cmd = next_cmd(&buf))) {
  800. if (bay_eject_supported && strlencmp(cmd, "eject") == 0) {
  801. if (!acpi_evalf(bay_ej_handle, NULL, NULL, "vd", 1))
  802. return -EIO;
  803. } else if (bay_eject2_supported &&
  804. strlencmp(cmd, "eject2") == 0) {
  805. if (!acpi_evalf(bay2_ej_handle, NULL, NULL, "vd", 1))
  806. return -EIO;
  807. } else
  808. return -EINVAL;
  809. }
  810. return 0;
  811. }
  812. static void bay_notify(struct ibm_struct *ibm, u32 event)
  813. {
  814. acpi_bus_generate_event(ibm->device, event, 0);
  815. }
  816. static int cmos_read(char *p)
  817. {
  818. int len = 0;
  819. /* cmos not supported on 570, 600e/x, 770e, 770x, A21e, A2xm/p,
  820. R30, R31, T20-22, X20-21 */
  821. if (!cmos_handle)
  822. len += sprintf(p + len, "status:\t\tnot supported\n");
  823. else {
  824. len += sprintf(p + len, "status:\t\tsupported\n");
  825. len += sprintf(p + len, "commands:\t<cmd> (<cmd> is 0-21)\n");
  826. }
  827. return len;
  828. }
  829. static int cmos_eval(int cmos_cmd)
  830. {
  831. if (cmos_handle)
  832. return acpi_evalf(cmos_handle, NULL, NULL, "vd", cmos_cmd);
  833. else
  834. return 1;
  835. }
  836. static int cmos_write(char *buf)
  837. {
  838. char *cmd;
  839. int cmos_cmd;
  840. if (!cmos_handle)
  841. return -EINVAL;
  842. while ((cmd = next_cmd(&buf))) {
  843. if (sscanf(cmd, "%u", &cmos_cmd) == 1 &&
  844. cmos_cmd >= 0 && cmos_cmd <= 21) {
  845. /* cmos_cmd set */
  846. } else
  847. return -EINVAL;
  848. if (!cmos_eval(cmos_cmd))
  849. return -EIO;
  850. }
  851. return 0;
  852. }
  853. static int led_supported;
  854. #define LED_570 1
  855. #define LED_OLD 2
  856. #define LED_NEW 3
  857. static int led_init(void)
  858. {
  859. if (!led_handle)
  860. /* led not supported on R30, R31 */
  861. led_supported = 0;
  862. else if (strlencmp(led_path, "SLED") == 0)
  863. /* 570 */
  864. led_supported = LED_570;
  865. else if (strlencmp(led_path, "SYSL") == 0)
  866. /* 600e/x, 770e, 770x, A21e, A2xm/p, T20-22, X20-21 */
  867. led_supported = LED_OLD;
  868. else
  869. /* all others */
  870. led_supported = LED_NEW;
  871. return 0;
  872. }
  873. #define led_status(s) ((s) == 0 ? "off" : ((s) == 1 ? "on" : "blinking"))
  874. static int led_read(char *p)
  875. {
  876. int len = 0;
  877. if (!led_supported) {
  878. len += sprintf(p + len, "status:\t\tnot supported\n");
  879. return len;
  880. }
  881. len += sprintf(p + len, "status:\t\tsupported\n");
  882. if (led_supported == LED_570) {
  883. /* 570 */
  884. int i, status;
  885. for (i = 0; i < 8; i++) {
  886. if (!acpi_evalf(ec_handle,
  887. &status, "GLED", "dd", 1 << i))
  888. return -EIO;
  889. len += sprintf(p + len, "%d:\t\t%s\n",
  890. i, led_status(status));
  891. }
  892. }
  893. len += sprintf(p + len, "commands:\t"
  894. "<led> on, <led> off, <led> blink (<led> is 0-7)\n");
  895. return len;
  896. }
  897. /* off, on, blink */
  898. static const int led_sled_arg1[] = { 0, 1, 3 };
  899. static const int led_exp_hlbl[] = { 0, 0, 1 }; /* led# * */
  900. static const int led_exp_hlcl[] = { 0, 1, 1 }; /* led# * */
  901. static const int led_led_arg1[] = { 0, 0x80, 0xc0 };
  902. #define EC_HLCL 0x0c
  903. #define EC_HLBL 0x0d
  904. #define EC_HLMS 0x0e
  905. static int led_write(char *buf)
  906. {
  907. char *cmd;
  908. int led, ind, ret;
  909. if (!led_supported)
  910. return -ENODEV;
  911. while ((cmd = next_cmd(&buf))) {
  912. if (sscanf(cmd, "%d", &led) != 1 || led < 0 || led > 7)
  913. return -EINVAL;
  914. if (strstr(cmd, "off")) {
  915. ind = 0;
  916. } else if (strstr(cmd, "on")) {
  917. ind = 1;
  918. } else if (strstr(cmd, "blink")) {
  919. ind = 2;
  920. } else
  921. return -EINVAL;
  922. if (led_supported == LED_570) {
  923. /* 570 */
  924. led = 1 << led;
  925. if (!acpi_evalf(led_handle, NULL, NULL, "vdd",
  926. led, led_sled_arg1[ind]))
  927. return -EIO;
  928. } else if (led_supported == LED_OLD) {
  929. /* 600e/x, 770e, 770x, A21e, A2xm/p, T20-22, X20 */
  930. led = 1 << led;
  931. ret = ec_write(EC_HLMS, led);
  932. if (ret >= 0)
  933. ret =
  934. ec_write(EC_HLBL, led * led_exp_hlbl[ind]);
  935. if (ret >= 0)
  936. ret =
  937. ec_write(EC_HLCL, led * led_exp_hlcl[ind]);
  938. if (ret < 0)
  939. return ret;
  940. } else {
  941. /* all others */
  942. if (!acpi_evalf(led_handle, NULL, NULL, "vdd",
  943. led, led_led_arg1[ind]))
  944. return -EIO;
  945. }
  946. }
  947. return 0;
  948. }
  949. static int beep_read(char *p)
  950. {
  951. int len = 0;
  952. if (!beep_handle)
  953. len += sprintf(p + len, "status:\t\tnot supported\n");
  954. else {
  955. len += sprintf(p + len, "status:\t\tsupported\n");
  956. len += sprintf(p + len, "commands:\t<cmd> (<cmd> is 0-17)\n");
  957. }
  958. return len;
  959. }
  960. static int beep_write(char *buf)
  961. {
  962. char *cmd;
  963. int beep_cmd;
  964. if (!beep_handle)
  965. return -ENODEV;
  966. while ((cmd = next_cmd(&buf))) {
  967. if (sscanf(cmd, "%u", &beep_cmd) == 1 &&
  968. beep_cmd >= 0 && beep_cmd <= 17) {
  969. /* beep_cmd set */
  970. } else
  971. return -EINVAL;
  972. if (!acpi_evalf(beep_handle, NULL, NULL, "vdd", beep_cmd, 0))
  973. return -EIO;
  974. }
  975. return 0;
  976. }
  977. static int acpi_ec_read(int i, u8 * p)
  978. {
  979. int v;
  980. if (ecrd_handle) {
  981. if (!acpi_evalf(ecrd_handle, &v, NULL, "dd", i))
  982. return 0;
  983. *p = v;
  984. } else {
  985. if (ec_read(i, p) < 0)
  986. return 0;
  987. }
  988. return 1;
  989. }
  990. static int acpi_ec_write(int i, u8 v)
  991. {
  992. if (ecwr_handle) {
  993. if (!acpi_evalf(ecwr_handle, NULL, NULL, "vdd", i, v))
  994. return 0;
  995. } else {
  996. if (ec_write(i, v) < 0)
  997. return 0;
  998. }
  999. return 1;
  1000. }
  1001. static int thermal_tmp_supported;
  1002. static int thermal_updt_supported;
  1003. static int thermal_init(void)
  1004. {
  1005. /* temperatures not supported on 570, G4x, R30, R31, R32 */
  1006. thermal_tmp_supported = acpi_evalf(ec_handle, NULL, "TMP7", "qv");
  1007. /* 600e/x, 770e, 770x */
  1008. thermal_updt_supported = acpi_evalf(ec_handle, NULL, "UPDT", "qv");
  1009. return 0;
  1010. }
  1011. static int thermal_read(char *p)
  1012. {
  1013. int len = 0;
  1014. if (!thermal_tmp_supported)
  1015. len += sprintf(p + len, "temperatures:\tnot supported\n");
  1016. else {
  1017. int i, t;
  1018. char tmpi[] = "TMPi";
  1019. s8 tmp[8];
  1020. if (thermal_updt_supported)
  1021. if (!acpi_evalf(ec_handle, NULL, "UPDT", "v"))
  1022. return -EIO;
  1023. for (i = 0; i < 8; i++) {
  1024. tmpi[3] = '0' + i;
  1025. if (!acpi_evalf(ec_handle, &t, tmpi, "d"))
  1026. return -EIO;
  1027. if (thermal_updt_supported)
  1028. tmp[i] = (t - 2732 + 5) / 10;
  1029. else
  1030. tmp[i] = t;
  1031. }
  1032. len += sprintf(p + len,
  1033. "temperatures:\t%d %d %d %d %d %d %d %d\n",
  1034. tmp[0], tmp[1], tmp[2], tmp[3],
  1035. tmp[4], tmp[5], tmp[6], tmp[7]);
  1036. }
  1037. return len;
  1038. }
  1039. static u8 ecdump_regs[256];
  1040. static int ecdump_read(char *p)
  1041. {
  1042. int len = 0;
  1043. int i, j;
  1044. u8 v;
  1045. len += sprintf(p + len, "EC "
  1046. " +00 +01 +02 +03 +04 +05 +06 +07"
  1047. " +08 +09 +0a +0b +0c +0d +0e +0f\n");
  1048. for (i = 0; i < 256; i += 16) {
  1049. len += sprintf(p + len, "EC 0x%02x:", i);
  1050. for (j = 0; j < 16; j++) {
  1051. if (!acpi_ec_read(i + j, &v))
  1052. break;
  1053. if (v != ecdump_regs[i + j])
  1054. len += sprintf(p + len, " *%02x", v);
  1055. else
  1056. len += sprintf(p + len, " %02x", v);
  1057. ecdump_regs[i + j] = v;
  1058. }
  1059. len += sprintf(p + len, "\n");
  1060. if (j != 16)
  1061. break;
  1062. }
  1063. /* These are way too dangerous to advertise openly... */
  1064. #if 0
  1065. len += sprintf(p + len, "commands:\t0x<offset> 0x<value>"
  1066. " (<offset> is 00-ff, <value> is 00-ff)\n");
  1067. len += sprintf(p + len, "commands:\t0x<offset> <value> "
  1068. " (<offset> is 00-ff, <value> is 0-255)\n");
  1069. #endif
  1070. return len;
  1071. }
  1072. static int ecdump_write(char *buf)
  1073. {
  1074. char *cmd;
  1075. int i, v;
  1076. while ((cmd = next_cmd(&buf))) {
  1077. if (sscanf(cmd, "0x%x 0x%x", &i, &v) == 2) {
  1078. /* i and v set */
  1079. } else if (sscanf(cmd, "0x%x %u", &i, &v) == 2) {
  1080. /* i and v set */
  1081. } else
  1082. return -EINVAL;
  1083. if (i >= 0 && i < 256 && v >= 0 && v < 256) {
  1084. if (!acpi_ec_write(i, v))
  1085. return -EIO;
  1086. } else
  1087. return -EINVAL;
  1088. }
  1089. return 0;
  1090. }
  1091. static int brightness_offset = 0x31;
  1092. static int brightness_read(char *p)
  1093. {
  1094. int len = 0;
  1095. u8 level;
  1096. if (!acpi_ec_read(brightness_offset, &level)) {
  1097. len += sprintf(p + len, "level:\t\tunreadable\n");
  1098. } else {
  1099. len += sprintf(p + len, "level:\t\t%d\n", level & 0x7);
  1100. len += sprintf(p + len, "commands:\tup, down\n");
  1101. len += sprintf(p + len, "commands:\tlevel <level>"
  1102. " (<level> is 0-7)\n");
  1103. }
  1104. return len;
  1105. }
  1106. #define BRIGHTNESS_UP 4
  1107. #define BRIGHTNESS_DOWN 5
  1108. static int brightness_write(char *buf)
  1109. {
  1110. int cmos_cmd, inc, i;
  1111. u8 level;
  1112. int new_level;
  1113. char *cmd;
  1114. while ((cmd = next_cmd(&buf))) {
  1115. if (!acpi_ec_read(brightness_offset, &level))
  1116. return -EIO;
  1117. level &= 7;
  1118. if (strlencmp(cmd, "up") == 0) {
  1119. new_level = level == 7 ? 7 : level + 1;
  1120. } else if (strlencmp(cmd, "down") == 0) {
  1121. new_level = level == 0 ? 0 : level - 1;
  1122. } else if (sscanf(cmd, "level %d", &new_level) == 1 &&
  1123. new_level >= 0 && new_level <= 7) {
  1124. /* new_level set */
  1125. } else
  1126. return -EINVAL;
  1127. cmos_cmd = new_level > level ? BRIGHTNESS_UP : BRIGHTNESS_DOWN;
  1128. inc = new_level > level ? 1 : -1;
  1129. for (i = level; i != new_level; i += inc) {
  1130. if (!cmos_eval(cmos_cmd))
  1131. return -EIO;
  1132. if (!acpi_ec_write(brightness_offset, i + inc))
  1133. return -EIO;
  1134. }
  1135. }
  1136. return 0;
  1137. }
  1138. static int volume_offset = 0x30;
  1139. static int volume_read(char *p)
  1140. {
  1141. int len = 0;
  1142. u8 level;
  1143. if (!acpi_ec_read(volume_offset, &level)) {
  1144. len += sprintf(p + len, "level:\t\tunreadable\n");
  1145. } else {
  1146. len += sprintf(p + len, "level:\t\t%d\n", level & 0xf);
  1147. len += sprintf(p + len, "mute:\t\t%s\n", onoff(level, 6));
  1148. len += sprintf(p + len, "commands:\tup, down, mute\n");
  1149. len += sprintf(p + len, "commands:\tlevel <level>"
  1150. " (<level> is 0-15)\n");
  1151. }
  1152. return len;
  1153. }
  1154. #define VOLUME_DOWN 0
  1155. #define VOLUME_UP 1
  1156. #define VOLUME_MUTE 2
  1157. static int volume_write(char *buf)
  1158. {
  1159. int cmos_cmd, inc, i;
  1160. u8 level, mute;
  1161. int new_level, new_mute;
  1162. char *cmd;
  1163. while ((cmd = next_cmd(&buf))) {
  1164. if (!acpi_ec_read(volume_offset, &level))
  1165. return -EIO;
  1166. new_mute = mute = level & 0x40;
  1167. new_level = level = level & 0xf;
  1168. if (strlencmp(cmd, "up") == 0) {
  1169. if (mute)
  1170. new_mute = 0;
  1171. else
  1172. new_level = level == 15 ? 15 : level + 1;
  1173. } else if (strlencmp(cmd, "down") == 0) {
  1174. if (mute)
  1175. new_mute = 0;
  1176. else
  1177. new_level = level == 0 ? 0 : level - 1;
  1178. } else if (sscanf(cmd, "level %d", &new_level) == 1 &&
  1179. new_level >= 0 && new_level <= 15) {
  1180. /* new_level set */
  1181. } else if (strlencmp(cmd, "mute") == 0) {
  1182. new_mute = 0x40;
  1183. } else
  1184. return -EINVAL;
  1185. if (new_level != level) { /* mute doesn't change */
  1186. cmos_cmd = new_level > level ? VOLUME_UP : VOLUME_DOWN;
  1187. inc = new_level > level ? 1 : -1;
  1188. if (mute && (!cmos_eval(cmos_cmd) ||
  1189. !acpi_ec_write(volume_offset, level)))
  1190. return -EIO;
  1191. for (i = level; i != new_level; i += inc)
  1192. if (!cmos_eval(cmos_cmd) ||
  1193. !acpi_ec_write(volume_offset, i + inc))
  1194. return -EIO;
  1195. if (mute && (!cmos_eval(VOLUME_MUTE) ||
  1196. !acpi_ec_write(volume_offset,
  1197. new_level + mute)))
  1198. return -EIO;
  1199. }
  1200. if (new_mute != mute) { /* level doesn't change */
  1201. cmos_cmd = new_mute ? VOLUME_MUTE : VOLUME_UP;
  1202. if (!cmos_eval(cmos_cmd) ||
  1203. !acpi_ec_write(volume_offset, level + new_mute))
  1204. return -EIO;
  1205. }
  1206. }
  1207. return 0;
  1208. }
  1209. static int fan_status_offset = 0x2f;
  1210. static int fan_rpm_offset = 0x84;
  1211. static int fan_read(char *p)
  1212. {
  1213. int len = 0;
  1214. int s;
  1215. u8 lo, hi, status;
  1216. if (gfan_handle) {
  1217. /* 570, 600e/x, 770e, 770x */
  1218. if (!acpi_evalf(gfan_handle, &s, NULL, "d"))
  1219. return -EIO;
  1220. len += sprintf(p + len, "level:\t\t%d\n", s);
  1221. } else {
  1222. /* all except 570, 600e/x, 770e, 770x */
  1223. if (!acpi_ec_read(fan_status_offset, &status))
  1224. len += sprintf(p + len, "status:\t\tunreadable\n");
  1225. else
  1226. len += sprintf(p + len, "status:\t\t%s\n",
  1227. enabled(status, 7));
  1228. if (!acpi_ec_read(fan_rpm_offset, &lo) ||
  1229. !acpi_ec_read(fan_rpm_offset + 1, &hi))
  1230. len += sprintf(p + len, "speed:\t\tunreadable\n");
  1231. else
  1232. len += sprintf(p + len, "speed:\t\t%d\n",
  1233. (hi << 8) + lo);
  1234. }
  1235. if (sfan_handle)
  1236. /* 570, 770x-JL */
  1237. len += sprintf(p + len, "commands:\tlevel <level>"
  1238. " (<level> is 0-7)\n");
  1239. if (!gfan_handle)
  1240. /* all except 570, 600e/x, 770e, 770x */
  1241. len += sprintf(p + len, "commands:\tenable, disable\n");
  1242. if (fans_handle)
  1243. /* X31, X40 */
  1244. len += sprintf(p + len, "commands:\tspeed <speed>"
  1245. " (<speed> is 0-65535)\n");
  1246. return len;
  1247. }
  1248. static int fan_write(char *buf)
  1249. {
  1250. char *cmd;
  1251. int level, speed;
  1252. while ((cmd = next_cmd(&buf))) {
  1253. if (sfan_handle &&
  1254. sscanf(cmd, "level %d", &level) == 1 &&
  1255. level >= 0 && level <= 7) {
  1256. /* 570, 770x-JL */
  1257. if (!acpi_evalf(sfan_handle, NULL, NULL, "vd", level))
  1258. return -EIO;
  1259. } else if (!gfan_handle && strlencmp(cmd, "enable") == 0) {
  1260. /* all except 570, 600e/x, 770e, 770x */
  1261. if (!acpi_ec_write(fan_status_offset, 0x80))
  1262. return -EIO;
  1263. } else if (!gfan_handle && strlencmp(cmd, "disable") == 0) {
  1264. /* all except 570, 600e/x, 770e, 770x */
  1265. if (!acpi_ec_write(fan_status_offset, 0x00))
  1266. return -EIO;
  1267. } else if (fans_handle &&
  1268. sscanf(cmd, "speed %d", &speed) == 1 &&
  1269. speed >= 0 && speed <= 65535) {
  1270. /* X31, X40 */
  1271. if (!acpi_evalf(fans_handle, NULL, NULL, "vddd",
  1272. speed, speed, speed))
  1273. return -EIO;
  1274. } else
  1275. return -EINVAL;
  1276. }
  1277. return 0;
  1278. }
  1279. static struct ibm_struct ibms[] = {
  1280. {
  1281. .name = "driver",
  1282. .init = driver_init,
  1283. .read = driver_read,
  1284. },
  1285. {
  1286. .name = "hotkey",
  1287. .hid = IBM_HKEY_HID,
  1288. .init = hotkey_init,
  1289. .read = hotkey_read,
  1290. .write = hotkey_write,
  1291. .exit = hotkey_exit,
  1292. .notify = hotkey_notify,
  1293. .handle = &hkey_handle,
  1294. .type = ACPI_DEVICE_NOTIFY,
  1295. },
  1296. {
  1297. .name = "bluetooth",
  1298. .init = bluetooth_init,
  1299. .read = bluetooth_read,
  1300. .write = bluetooth_write,
  1301. },
  1302. {
  1303. .name = "video",
  1304. .init = video_init,
  1305. .read = video_read,
  1306. .write = video_write,
  1307. .exit = video_exit,
  1308. },
  1309. {
  1310. .name = "light",
  1311. .init = light_init,
  1312. .read = light_read,
  1313. .write = light_write,
  1314. },
  1315. #ifdef CONFIG_ACPI_IBM_DOCK
  1316. {
  1317. .name = "dock",
  1318. .read = dock_read,
  1319. .write = dock_write,
  1320. .notify = dock_notify,
  1321. .handle = &dock_handle,
  1322. .type = ACPI_SYSTEM_NOTIFY,
  1323. },
  1324. {
  1325. .name = "dock",
  1326. .hid = IBM_PCI_HID,
  1327. .notify = dock_notify,
  1328. .handle = &pci_handle,
  1329. .type = ACPI_SYSTEM_NOTIFY,
  1330. },
  1331. #endif
  1332. {
  1333. .name = "bay",
  1334. .init = bay_init,
  1335. .read = bay_read,
  1336. .write = bay_write,
  1337. .notify = bay_notify,
  1338. .handle = &bay_handle,
  1339. .type = ACPI_SYSTEM_NOTIFY,
  1340. },
  1341. {
  1342. .name = "cmos",
  1343. .read = cmos_read,
  1344. .write = cmos_write,
  1345. },
  1346. {
  1347. .name = "led",
  1348. .init = led_init,
  1349. .read = led_read,
  1350. .write = led_write,
  1351. },
  1352. {
  1353. .name = "beep",
  1354. .read = beep_read,
  1355. .write = beep_write,
  1356. },
  1357. {
  1358. .name = "thermal",
  1359. .init = thermal_init,
  1360. .read = thermal_read,
  1361. },
  1362. {
  1363. .name = "ecdump",
  1364. .read = ecdump_read,
  1365. .write = ecdump_write,
  1366. .experimental = 1,
  1367. },
  1368. {
  1369. .name = "brightness",
  1370. .read = brightness_read,
  1371. .write = brightness_write,
  1372. .experimental = 1,
  1373. },
  1374. {
  1375. .name = "volume",
  1376. .read = volume_read,
  1377. .write = volume_write,
  1378. .experimental = 1,
  1379. },
  1380. {
  1381. .name = "fan",
  1382. .read = fan_read,
  1383. .write = fan_write,
  1384. .experimental = 1,
  1385. },
  1386. };
  1387. static int dispatch_read(char *page, char **start, off_t off, int count,
  1388. int *eof, void *data)
  1389. {
  1390. struct ibm_struct *ibm = (struct ibm_struct *)data;
  1391. int len;
  1392. if (!ibm || !ibm->read)
  1393. return -EINVAL;
  1394. len = ibm->read(page);
  1395. if (len < 0)
  1396. return len;
  1397. if (len <= off + count)
  1398. *eof = 1;
  1399. *start = page + off;
  1400. len -= off;
  1401. if (len > count)
  1402. len = count;
  1403. if (len < 0)
  1404. len = 0;
  1405. return len;
  1406. }
  1407. static int dispatch_write(struct file *file, const char __user * userbuf,
  1408. unsigned long count, void *data)
  1409. {
  1410. struct ibm_struct *ibm = (struct ibm_struct *)data;
  1411. char *kernbuf;
  1412. int ret;
  1413. if (!ibm || !ibm->write)
  1414. return -EINVAL;
  1415. kernbuf = kmalloc(count + 2, GFP_KERNEL);
  1416. if (!kernbuf)
  1417. return -ENOMEM;
  1418. if (copy_from_user(kernbuf, userbuf, count)) {
  1419. kfree(kernbuf);
  1420. return -EFAULT;
  1421. }
  1422. kernbuf[count] = 0;
  1423. strcat(kernbuf, ",");
  1424. ret = ibm->write(kernbuf);
  1425. if (ret == 0)
  1426. ret = count;
  1427. kfree(kernbuf);
  1428. return ret;
  1429. }
  1430. static void dispatch_notify(acpi_handle handle, u32 event, void *data)
  1431. {
  1432. struct ibm_struct *ibm = (struct ibm_struct *)data;
  1433. if (!ibm || !ibm->notify)
  1434. return;
  1435. ibm->notify(ibm, event);
  1436. }
  1437. static int __init setup_notify(struct ibm_struct *ibm)
  1438. {
  1439. acpi_status status;
  1440. int ret;
  1441. if (!*ibm->handle)
  1442. return 0;
  1443. ret = acpi_bus_get_device(*ibm->handle, &ibm->device);
  1444. if (ret < 0) {
  1445. printk(IBM_ERR "%s device not present\n", ibm->name);
  1446. return 0;
  1447. }
  1448. acpi_driver_data(ibm->device) = ibm;
  1449. sprintf(acpi_device_class(ibm->device), "%s/%s", IBM_NAME, ibm->name);
  1450. status = acpi_install_notify_handler(*ibm->handle, ibm->type,
  1451. dispatch_notify, ibm);
  1452. if (ACPI_FAILURE(status)) {
  1453. printk(IBM_ERR "acpi_install_notify_handler(%s) failed: %d\n",
  1454. ibm->name, status);
  1455. return -ENODEV;
  1456. }
  1457. return 0;
  1458. }
  1459. static int __init ibm_device_add(struct acpi_device *device)
  1460. {
  1461. return 0;
  1462. }
  1463. static int __init register_driver(struct ibm_struct *ibm)
  1464. {
  1465. int ret;
  1466. ibm->driver = kmalloc(sizeof(struct acpi_driver), GFP_KERNEL);
  1467. if (!ibm->driver) {
  1468. printk(IBM_ERR "kmalloc(ibm->driver) failed\n");
  1469. return -1;
  1470. }
  1471. memset(ibm->driver, 0, sizeof(struct acpi_driver));
  1472. sprintf(ibm->driver->name, "%s/%s", IBM_NAME, ibm->name);
  1473. ibm->driver->ids = ibm->hid;
  1474. ibm->driver->ops.add = &ibm_device_add;
  1475. ret = acpi_bus_register_driver(ibm->driver);
  1476. if (ret < 0) {
  1477. printk(IBM_ERR "acpi_bus_register_driver(%s) failed: %d\n",
  1478. ibm->hid, ret);
  1479. kfree(ibm->driver);
  1480. }
  1481. return ret;
  1482. }
  1483. static int __init ibm_init(struct ibm_struct *ibm)
  1484. {
  1485. int ret;
  1486. struct proc_dir_entry *entry;
  1487. if (ibm->experimental && !experimental)
  1488. return 0;
  1489. if (ibm->hid) {
  1490. ret = register_driver(ibm);
  1491. if (ret < 0)
  1492. return ret;
  1493. ibm->driver_registered = 1;
  1494. }
  1495. if (ibm->init) {
  1496. ret = ibm->init();
  1497. if (ret != 0)
  1498. return ret;
  1499. ibm->init_called = 1;
  1500. }
  1501. if (ibm->read) {
  1502. entry = create_proc_entry(ibm->name,
  1503. S_IFREG | S_IRUGO | S_IWUSR,
  1504. proc_dir);
  1505. if (!entry) {
  1506. printk(IBM_ERR "unable to create proc entry %s\n",
  1507. ibm->name);
  1508. return -ENODEV;
  1509. }
  1510. entry->owner = THIS_MODULE;
  1511. entry->data = ibm;
  1512. entry->read_proc = &dispatch_read;
  1513. if (ibm->write)
  1514. entry->write_proc = &dispatch_write;
  1515. ibm->proc_created = 1;
  1516. }
  1517. if (ibm->notify) {
  1518. ret = setup_notify(ibm);
  1519. if (ret < 0)
  1520. return ret;
  1521. ibm->notify_installed = 1;
  1522. }
  1523. return 0;
  1524. }
  1525. static void ibm_exit(struct ibm_struct *ibm)
  1526. {
  1527. if (ibm->notify_installed)
  1528. acpi_remove_notify_handler(*ibm->handle, ibm->type,
  1529. dispatch_notify);
  1530. if (ibm->proc_created)
  1531. remove_proc_entry(ibm->name, proc_dir);
  1532. if (ibm->init_called && ibm->exit)
  1533. ibm->exit();
  1534. if (ibm->driver_registered) {
  1535. acpi_bus_unregister_driver(ibm->driver);
  1536. kfree(ibm->driver);
  1537. }
  1538. }
  1539. static void __init ibm_handle_init(char *name,
  1540. acpi_handle * handle, acpi_handle parent,
  1541. char **paths, int num_paths, char **path)
  1542. {
  1543. int i;
  1544. acpi_status status;
  1545. for (i = 0; i < num_paths; i++) {
  1546. status = acpi_get_handle(parent, paths[i], handle);
  1547. if (ACPI_SUCCESS(status)) {
  1548. *path = paths[i];
  1549. return;
  1550. }
  1551. }
  1552. *handle = NULL;
  1553. }
  1554. #define IBM_HANDLE_INIT(object) \
  1555. ibm_handle_init(#object, &object##_handle, *object##_parent, \
  1556. object##_paths, ARRAY_SIZE(object##_paths), &object##_path)
  1557. static int set_ibm_param(const char *val, struct kernel_param *kp)
  1558. {
  1559. unsigned int i;
  1560. for (i = 0; i < ARRAY_SIZE(ibms); i++)
  1561. if (strcmp(ibms[i].name, kp->name) == 0 && ibms[i].write) {
  1562. if (strlen(val) > sizeof(ibms[i].param) - 2)
  1563. return -ENOSPC;
  1564. strcpy(ibms[i].param, val);
  1565. strcat(ibms[i].param, ",");
  1566. return 0;
  1567. }
  1568. return -EINVAL;
  1569. }
  1570. #define IBM_PARAM(feature) \
  1571. module_param_call(feature, set_ibm_param, NULL, NULL, 0)
  1572. IBM_PARAM(hotkey);
  1573. IBM_PARAM(bluetooth);
  1574. IBM_PARAM(video);
  1575. IBM_PARAM(light);
  1576. #ifdef CONFIG_ACPI_IBM_DOCK
  1577. IBM_PARAM(dock);
  1578. #endif
  1579. IBM_PARAM(bay);
  1580. IBM_PARAM(cmos);
  1581. IBM_PARAM(led);
  1582. IBM_PARAM(beep);
  1583. IBM_PARAM(ecdump);
  1584. IBM_PARAM(brightness);
  1585. IBM_PARAM(volume);
  1586. IBM_PARAM(fan);
  1587. static void acpi_ibm_exit(void)
  1588. {
  1589. int i;
  1590. for (i = ARRAY_SIZE(ibms) - 1; i >= 0; i--)
  1591. ibm_exit(&ibms[i]);
  1592. remove_proc_entry(IBM_DIR, acpi_root_dir);
  1593. }
  1594. static int __init acpi_ibm_init(void)
  1595. {
  1596. int ret, i;
  1597. if (acpi_disabled)
  1598. return -ENODEV;
  1599. if (!acpi_specific_hotkey_enabled) {
  1600. printk(IBM_ERR "using generic hotkey driver\n");
  1601. return -ENODEV;
  1602. }
  1603. /* ec is required because many other handles are relative to it */
  1604. IBM_HANDLE_INIT(ec);
  1605. if (!ec_handle) {
  1606. printk(IBM_ERR "ec object not found\n");
  1607. return -ENODEV;
  1608. }
  1609. /* these handles are not required */
  1610. IBM_HANDLE_INIT(vid);
  1611. IBM_HANDLE_INIT(vid2);
  1612. IBM_HANDLE_INIT(ledb);
  1613. IBM_HANDLE_INIT(led);
  1614. IBM_HANDLE_INIT(hkey);
  1615. IBM_HANDLE_INIT(lght);
  1616. IBM_HANDLE_INIT(cmos);
  1617. #ifdef CONFIG_ACPI_IBM_DOCK
  1618. IBM_HANDLE_INIT(dock);
  1619. #endif
  1620. IBM_HANDLE_INIT(pci);
  1621. IBM_HANDLE_INIT(bay);
  1622. if (bay_handle)
  1623. IBM_HANDLE_INIT(bay_ej);
  1624. IBM_HANDLE_INIT(bay2);
  1625. if (bay2_handle)
  1626. IBM_HANDLE_INIT(bay2_ej);
  1627. IBM_HANDLE_INIT(beep);
  1628. IBM_HANDLE_INIT(ecrd);
  1629. IBM_HANDLE_INIT(ecwr);
  1630. IBM_HANDLE_INIT(fans);
  1631. IBM_HANDLE_INIT(gfan);
  1632. IBM_HANDLE_INIT(sfan);
  1633. proc_dir = proc_mkdir(IBM_DIR, acpi_root_dir);
  1634. if (!proc_dir) {
  1635. printk(IBM_ERR "unable to create proc dir %s", IBM_DIR);
  1636. return -ENODEV;
  1637. }
  1638. proc_dir->owner = THIS_MODULE;
  1639. for (i = 0; i < ARRAY_SIZE(ibms); i++) {
  1640. ret = ibm_init(&ibms[i]);
  1641. if (ret >= 0 && *ibms[i].param)
  1642. ret = ibms[i].write(ibms[i].param);
  1643. if (ret < 0) {
  1644. acpi_ibm_exit();
  1645. return ret;
  1646. }
  1647. }
  1648. return 0;
  1649. }
  1650. module_init(acpi_ibm_init);
  1651. module_exit(acpi_ibm_exit);