samsung-laptop.c 39 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648
  1. /*
  2. * Samsung Laptop driver
  3. *
  4. * Copyright (C) 2009,2011 Greg Kroah-Hartman (gregkh@suse.de)
  5. * Copyright (C) 2009,2011 Novell Inc.
  6. *
  7. * This program is free software; you can redistribute it and/or modify it
  8. * under the terms of the GNU General Public License version 2 as published by
  9. * the Free Software Foundation.
  10. *
  11. */
  12. #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  13. #include <linux/kernel.h>
  14. #include <linux/init.h>
  15. #include <linux/module.h>
  16. #include <linux/delay.h>
  17. #include <linux/pci.h>
  18. #include <linux/backlight.h>
  19. #include <linux/leds.h>
  20. #include <linux/fb.h>
  21. #include <linux/dmi.h>
  22. #include <linux/platform_device.h>
  23. #include <linux/rfkill.h>
  24. #include <linux/acpi.h>
  25. #include <linux/seq_file.h>
  26. #include <linux/debugfs.h>
  27. #include <linux/ctype.h>
  28. #include <linux/efi.h>
  29. #if (defined CONFIG_ACPI_VIDEO || defined CONFIG_ACPI_VIDEO_MODULE)
  30. #include <acpi/video.h>
  31. #endif
  32. /*
  33. * This driver is needed because a number of Samsung laptops do not hook
  34. * their control settings through ACPI. So we have to poke around in the
  35. * BIOS to do things like brightness values, and "special" key controls.
  36. */
  37. /*
  38. * We have 0 - 8 as valid brightness levels. The specs say that level 0 should
  39. * be reserved by the BIOS (which really doesn't make much sense), we tell
  40. * userspace that the value is 0 - 7 and then just tell the hardware 1 - 8
  41. */
  42. #define MAX_BRIGHT 0x07
  43. #define SABI_IFACE_MAIN 0x00
  44. #define SABI_IFACE_SUB 0x02
  45. #define SABI_IFACE_COMPLETE 0x04
  46. #define SABI_IFACE_DATA 0x05
  47. #define WL_STATUS_WLAN 0x0
  48. #define WL_STATUS_BT 0x2
  49. /* Structure get/set data using sabi */
  50. struct sabi_data {
  51. union {
  52. struct {
  53. u32 d0;
  54. u32 d1;
  55. u16 d2;
  56. u8 d3;
  57. };
  58. u8 data[11];
  59. };
  60. };
  61. struct sabi_header_offsets {
  62. u8 port;
  63. u8 re_mem;
  64. u8 iface_func;
  65. u8 en_mem;
  66. u8 data_offset;
  67. u8 data_segment;
  68. };
  69. struct sabi_commands {
  70. /*
  71. * Brightness is 0 - 8, as described above.
  72. * Value 0 is for the BIOS to use
  73. */
  74. u16 get_brightness;
  75. u16 set_brightness;
  76. /*
  77. * first byte:
  78. * 0x00 - wireless is off
  79. * 0x01 - wireless is on
  80. * second byte:
  81. * 0x02 - 3G is off
  82. * 0x03 - 3G is on
  83. * TODO, verify 3G is correct, that doesn't seem right...
  84. */
  85. u16 get_wireless_button;
  86. u16 set_wireless_button;
  87. /* 0 is off, 1 is on */
  88. u16 get_backlight;
  89. u16 set_backlight;
  90. /*
  91. * 0x80 or 0x00 - no action
  92. * 0x81 - recovery key pressed
  93. */
  94. u16 get_recovery_mode;
  95. u16 set_recovery_mode;
  96. /*
  97. * on seclinux: 0 is low, 1 is high,
  98. * on swsmi: 0 is normal, 1 is silent, 2 is turbo
  99. */
  100. u16 get_performance_level;
  101. u16 set_performance_level;
  102. /* 0x80 is off, 0x81 is on */
  103. u16 get_battery_life_extender;
  104. u16 set_battery_life_extender;
  105. /* 0x80 is off, 0x81 is on */
  106. u16 get_usb_charge;
  107. u16 set_usb_charge;
  108. /* the first byte is for bluetooth and the third one is for wlan */
  109. u16 get_wireless_status;
  110. u16 set_wireless_status;
  111. /* 0x81 to read, (0x82 | level << 8) to set, 0xaabb to enable */
  112. u16 kbd_backlight;
  113. /*
  114. * Tell the BIOS that Linux is running on this machine.
  115. * 81 is on, 80 is off
  116. */
  117. u16 set_linux;
  118. };
  119. struct sabi_performance_level {
  120. const char *name;
  121. u16 value;
  122. };
  123. struct sabi_config {
  124. int sabi_version;
  125. const char *test_string;
  126. u16 main_function;
  127. const struct sabi_header_offsets header_offsets;
  128. const struct sabi_commands commands;
  129. const struct sabi_performance_level performance_levels[4];
  130. u8 min_brightness;
  131. u8 max_brightness;
  132. };
  133. static const struct sabi_config sabi_configs[] = {
  134. {
  135. /* I don't know if it is really 2, but it it is
  136. * less than 3 anyway */
  137. .sabi_version = 2,
  138. .test_string = "SECLINUX",
  139. .main_function = 0x4c49,
  140. .header_offsets = {
  141. .port = 0x00,
  142. .re_mem = 0x02,
  143. .iface_func = 0x03,
  144. .en_mem = 0x04,
  145. .data_offset = 0x05,
  146. .data_segment = 0x07,
  147. },
  148. .commands = {
  149. .get_brightness = 0x00,
  150. .set_brightness = 0x01,
  151. .get_wireless_button = 0x02,
  152. .set_wireless_button = 0x03,
  153. .get_backlight = 0x04,
  154. .set_backlight = 0x05,
  155. .get_recovery_mode = 0x06,
  156. .set_recovery_mode = 0x07,
  157. .get_performance_level = 0x08,
  158. .set_performance_level = 0x09,
  159. .get_battery_life_extender = 0xFFFF,
  160. .set_battery_life_extender = 0xFFFF,
  161. .get_usb_charge = 0xFFFF,
  162. .set_usb_charge = 0xFFFF,
  163. .get_wireless_status = 0xFFFF,
  164. .set_wireless_status = 0xFFFF,
  165. .kbd_backlight = 0xFFFF,
  166. .set_linux = 0x0a,
  167. },
  168. .performance_levels = {
  169. {
  170. .name = "silent",
  171. .value = 0,
  172. },
  173. {
  174. .name = "normal",
  175. .value = 1,
  176. },
  177. { },
  178. },
  179. .min_brightness = 1,
  180. .max_brightness = 8,
  181. },
  182. {
  183. .sabi_version = 3,
  184. .test_string = "SwSmi@",
  185. .main_function = 0x5843,
  186. .header_offsets = {
  187. .port = 0x00,
  188. .re_mem = 0x04,
  189. .iface_func = 0x02,
  190. .en_mem = 0x03,
  191. .data_offset = 0x05,
  192. .data_segment = 0x07,
  193. },
  194. .commands = {
  195. .get_brightness = 0x10,
  196. .set_brightness = 0x11,
  197. .get_wireless_button = 0x12,
  198. .set_wireless_button = 0x13,
  199. .get_backlight = 0x2d,
  200. .set_backlight = 0x2e,
  201. .get_recovery_mode = 0xff,
  202. .set_recovery_mode = 0xff,
  203. .get_performance_level = 0x31,
  204. .set_performance_level = 0x32,
  205. .get_battery_life_extender = 0x65,
  206. .set_battery_life_extender = 0x66,
  207. .get_usb_charge = 0x67,
  208. .set_usb_charge = 0x68,
  209. .get_wireless_status = 0x69,
  210. .set_wireless_status = 0x6a,
  211. .kbd_backlight = 0x78,
  212. .set_linux = 0xff,
  213. },
  214. .performance_levels = {
  215. {
  216. .name = "normal",
  217. .value = 0,
  218. },
  219. {
  220. .name = "silent",
  221. .value = 1,
  222. },
  223. {
  224. .name = "overclock",
  225. .value = 2,
  226. },
  227. { },
  228. },
  229. .min_brightness = 0,
  230. .max_brightness = 8,
  231. },
  232. { },
  233. };
  234. /*
  235. * samsung-laptop/ - debugfs root directory
  236. * f0000_segment - dump f0000 segment
  237. * command - current command
  238. * data - current data
  239. * d0, d1, d2, d3 - data fields
  240. * call - call SABI using command and data
  241. *
  242. * This allow to call arbitrary sabi commands wihout
  243. * modifying the driver at all.
  244. * For example, setting the keyboard backlight brightness to 5
  245. *
  246. * echo 0x78 > command
  247. * echo 0x0582 > d0
  248. * echo 0 > d1
  249. * echo 0 > d2
  250. * echo 0 > d3
  251. * cat call
  252. */
  253. struct samsung_laptop_debug {
  254. struct dentry *root;
  255. struct sabi_data data;
  256. u16 command;
  257. struct debugfs_blob_wrapper f0000_wrapper;
  258. struct debugfs_blob_wrapper data_wrapper;
  259. struct debugfs_blob_wrapper sdiag_wrapper;
  260. };
  261. struct samsung_laptop;
  262. struct samsung_rfkill {
  263. struct samsung_laptop *samsung;
  264. struct rfkill *rfkill;
  265. enum rfkill_type type;
  266. };
  267. struct samsung_laptop {
  268. const struct sabi_config *config;
  269. void __iomem *sabi;
  270. void __iomem *sabi_iface;
  271. void __iomem *f0000_segment;
  272. struct mutex sabi_mutex;
  273. struct platform_device *platform_device;
  274. struct backlight_device *backlight_device;
  275. struct samsung_rfkill wlan;
  276. struct samsung_rfkill bluetooth;
  277. struct led_classdev kbd_led;
  278. int kbd_led_wk;
  279. struct workqueue_struct *led_workqueue;
  280. struct work_struct kbd_led_work;
  281. struct samsung_laptop_debug debug;
  282. struct samsung_quirks *quirks;
  283. bool handle_backlight;
  284. bool has_stepping_quirk;
  285. char sdiag[64];
  286. };
  287. struct samsung_quirks {
  288. bool broken_acpi_video;
  289. };
  290. static struct samsung_quirks samsung_unknown = {};
  291. static struct samsung_quirks samsung_broken_acpi_video = {
  292. .broken_acpi_video = true,
  293. };
  294. static bool force;
  295. module_param(force, bool, 0);
  296. MODULE_PARM_DESC(force,
  297. "Disable the DMI check and forces the driver to be loaded");
  298. static bool debug;
  299. module_param(debug, bool, S_IRUGO | S_IWUSR);
  300. MODULE_PARM_DESC(debug, "Debug enabled or not");
  301. static int sabi_command(struct samsung_laptop *samsung, u16 command,
  302. struct sabi_data *in,
  303. struct sabi_data *out)
  304. {
  305. const struct sabi_config *config = samsung->config;
  306. int ret = 0;
  307. u16 port = readw(samsung->sabi + config->header_offsets.port);
  308. u8 complete, iface_data;
  309. mutex_lock(&samsung->sabi_mutex);
  310. if (debug) {
  311. if (in)
  312. pr_info("SABI command:0x%04x "
  313. "data:{0x%08x, 0x%08x, 0x%04x, 0x%02x}",
  314. command, in->d0, in->d1, in->d2, in->d3);
  315. else
  316. pr_info("SABI command:0x%04x", command);
  317. }
  318. /* enable memory to be able to write to it */
  319. outb(readb(samsung->sabi + config->header_offsets.en_mem), port);
  320. /* write out the command */
  321. writew(config->main_function, samsung->sabi_iface + SABI_IFACE_MAIN);
  322. writew(command, samsung->sabi_iface + SABI_IFACE_SUB);
  323. writeb(0, samsung->sabi_iface + SABI_IFACE_COMPLETE);
  324. if (in) {
  325. writel(in->d0, samsung->sabi_iface + SABI_IFACE_DATA);
  326. writel(in->d1, samsung->sabi_iface + SABI_IFACE_DATA + 4);
  327. writew(in->d2, samsung->sabi_iface + SABI_IFACE_DATA + 8);
  328. writeb(in->d3, samsung->sabi_iface + SABI_IFACE_DATA + 10);
  329. }
  330. outb(readb(samsung->sabi + config->header_offsets.iface_func), port);
  331. /* write protect memory to make it safe */
  332. outb(readb(samsung->sabi + config->header_offsets.re_mem), port);
  333. /* see if the command actually succeeded */
  334. complete = readb(samsung->sabi_iface + SABI_IFACE_COMPLETE);
  335. iface_data = readb(samsung->sabi_iface + SABI_IFACE_DATA);
  336. /* iface_data = 0xFF happens when a command is not known
  337. * so we only add a warning in debug mode since we will
  338. * probably issue some unknown command at startup to find
  339. * out which features are supported */
  340. if (complete != 0xaa || (iface_data == 0xff && debug))
  341. pr_warn("SABI command 0x%04x failed with"
  342. " completion flag 0x%02x and interface data 0x%02x",
  343. command, complete, iface_data);
  344. if (complete != 0xaa || iface_data == 0xff) {
  345. ret = -EINVAL;
  346. goto exit;
  347. }
  348. if (out) {
  349. out->d0 = readl(samsung->sabi_iface + SABI_IFACE_DATA);
  350. out->d1 = readl(samsung->sabi_iface + SABI_IFACE_DATA + 4);
  351. out->d2 = readw(samsung->sabi_iface + SABI_IFACE_DATA + 2);
  352. out->d3 = readb(samsung->sabi_iface + SABI_IFACE_DATA + 1);
  353. }
  354. if (debug && out) {
  355. pr_info("SABI return data:{0x%08x, 0x%08x, 0x%04x, 0x%02x}",
  356. out->d0, out->d1, out->d2, out->d3);
  357. }
  358. exit:
  359. mutex_unlock(&samsung->sabi_mutex);
  360. return ret;
  361. }
  362. /* simple wrappers usable with most commands */
  363. static int sabi_set_commandb(struct samsung_laptop *samsung,
  364. u16 command, u8 data)
  365. {
  366. struct sabi_data in = { { { .d0 = 0, .d1 = 0, .d2 = 0, .d3 = 0 } } };
  367. in.data[0] = data;
  368. return sabi_command(samsung, command, &in, NULL);
  369. }
  370. static int read_brightness(struct samsung_laptop *samsung)
  371. {
  372. const struct sabi_config *config = samsung->config;
  373. const struct sabi_commands *commands = &samsung->config->commands;
  374. struct sabi_data sretval;
  375. int user_brightness = 0;
  376. int retval;
  377. retval = sabi_command(samsung, commands->get_brightness,
  378. NULL, &sretval);
  379. if (retval)
  380. return retval;
  381. user_brightness = sretval.data[0];
  382. if (user_brightness > config->min_brightness)
  383. user_brightness -= config->min_brightness;
  384. else
  385. user_brightness = 0;
  386. return user_brightness;
  387. }
  388. static void set_brightness(struct samsung_laptop *samsung, u8 user_brightness)
  389. {
  390. const struct sabi_config *config = samsung->config;
  391. const struct sabi_commands *commands = &samsung->config->commands;
  392. u8 user_level = user_brightness + config->min_brightness;
  393. if (samsung->has_stepping_quirk && user_level != 0) {
  394. /*
  395. * short circuit if the specified level is what's already set
  396. * to prevent the screen from flickering needlessly
  397. */
  398. if (user_brightness == read_brightness(samsung))
  399. return;
  400. sabi_set_commandb(samsung, commands->set_brightness, 0);
  401. }
  402. sabi_set_commandb(samsung, commands->set_brightness, user_level);
  403. }
  404. static int get_brightness(struct backlight_device *bd)
  405. {
  406. struct samsung_laptop *samsung = bl_get_data(bd);
  407. return read_brightness(samsung);
  408. }
  409. static void check_for_stepping_quirk(struct samsung_laptop *samsung)
  410. {
  411. int initial_level;
  412. int check_level;
  413. int orig_level = read_brightness(samsung);
  414. /*
  415. * Some laptops exhibit the strange behaviour of stepping toward
  416. * (rather than setting) the brightness except when changing to/from
  417. * brightness level 0. This behaviour is checked for here and worked
  418. * around in set_brightness.
  419. */
  420. if (orig_level == 0)
  421. set_brightness(samsung, 1);
  422. initial_level = read_brightness(samsung);
  423. if (initial_level <= 2)
  424. check_level = initial_level + 2;
  425. else
  426. check_level = initial_level - 2;
  427. samsung->has_stepping_quirk = false;
  428. set_brightness(samsung, check_level);
  429. if (read_brightness(samsung) != check_level) {
  430. samsung->has_stepping_quirk = true;
  431. pr_info("enabled workaround for brightness stepping quirk\n");
  432. }
  433. set_brightness(samsung, orig_level);
  434. }
  435. static int update_status(struct backlight_device *bd)
  436. {
  437. struct samsung_laptop *samsung = bl_get_data(bd);
  438. const struct sabi_commands *commands = &samsung->config->commands;
  439. set_brightness(samsung, bd->props.brightness);
  440. if (bd->props.power == FB_BLANK_UNBLANK)
  441. sabi_set_commandb(samsung, commands->set_backlight, 1);
  442. else
  443. sabi_set_commandb(samsung, commands->set_backlight, 0);
  444. return 0;
  445. }
  446. static const struct backlight_ops backlight_ops = {
  447. .get_brightness = get_brightness,
  448. .update_status = update_status,
  449. };
  450. static int seclinux_rfkill_set(void *data, bool blocked)
  451. {
  452. struct samsung_rfkill *srfkill = data;
  453. struct samsung_laptop *samsung = srfkill->samsung;
  454. const struct sabi_commands *commands = &samsung->config->commands;
  455. return sabi_set_commandb(samsung, commands->set_wireless_button,
  456. !blocked);
  457. }
  458. static struct rfkill_ops seclinux_rfkill_ops = {
  459. .set_block = seclinux_rfkill_set,
  460. };
  461. static int swsmi_wireless_status(struct samsung_laptop *samsung,
  462. struct sabi_data *data)
  463. {
  464. const struct sabi_commands *commands = &samsung->config->commands;
  465. return sabi_command(samsung, commands->get_wireless_status,
  466. NULL, data);
  467. }
  468. static int swsmi_rfkill_set(void *priv, bool blocked)
  469. {
  470. struct samsung_rfkill *srfkill = priv;
  471. struct samsung_laptop *samsung = srfkill->samsung;
  472. const struct sabi_commands *commands = &samsung->config->commands;
  473. struct sabi_data data;
  474. int ret, i;
  475. ret = swsmi_wireless_status(samsung, &data);
  476. if (ret)
  477. return ret;
  478. /* Don't set the state for non-present devices */
  479. for (i = 0; i < 4; i++)
  480. if (data.data[i] == 0x02)
  481. data.data[1] = 0;
  482. if (srfkill->type == RFKILL_TYPE_WLAN)
  483. data.data[WL_STATUS_WLAN] = !blocked;
  484. else if (srfkill->type == RFKILL_TYPE_BLUETOOTH)
  485. data.data[WL_STATUS_BT] = !blocked;
  486. return sabi_command(samsung, commands->set_wireless_status,
  487. &data, &data);
  488. }
  489. static void swsmi_rfkill_query(struct rfkill *rfkill, void *priv)
  490. {
  491. struct samsung_rfkill *srfkill = priv;
  492. struct samsung_laptop *samsung = srfkill->samsung;
  493. struct sabi_data data;
  494. int ret;
  495. ret = swsmi_wireless_status(samsung, &data);
  496. if (ret)
  497. return ;
  498. if (srfkill->type == RFKILL_TYPE_WLAN)
  499. ret = data.data[WL_STATUS_WLAN];
  500. else if (srfkill->type == RFKILL_TYPE_BLUETOOTH)
  501. ret = data.data[WL_STATUS_BT];
  502. else
  503. return ;
  504. rfkill_set_sw_state(rfkill, !ret);
  505. }
  506. static struct rfkill_ops swsmi_rfkill_ops = {
  507. .set_block = swsmi_rfkill_set,
  508. .query = swsmi_rfkill_query,
  509. };
  510. static ssize_t get_performance_level(struct device *dev,
  511. struct device_attribute *attr, char *buf)
  512. {
  513. struct samsung_laptop *samsung = dev_get_drvdata(dev);
  514. const struct sabi_config *config = samsung->config;
  515. const struct sabi_commands *commands = &config->commands;
  516. struct sabi_data sretval;
  517. int retval;
  518. int i;
  519. /* Read the state */
  520. retval = sabi_command(samsung, commands->get_performance_level,
  521. NULL, &sretval);
  522. if (retval)
  523. return retval;
  524. /* The logic is backwards, yeah, lots of fun... */
  525. for (i = 0; config->performance_levels[i].name; ++i) {
  526. if (sretval.data[0] == config->performance_levels[i].value)
  527. return sprintf(buf, "%s\n", config->performance_levels[i].name);
  528. }
  529. return sprintf(buf, "%s\n", "unknown");
  530. }
  531. static ssize_t set_performance_level(struct device *dev,
  532. struct device_attribute *attr, const char *buf,
  533. size_t count)
  534. {
  535. struct samsung_laptop *samsung = dev_get_drvdata(dev);
  536. const struct sabi_config *config = samsung->config;
  537. const struct sabi_commands *commands = &config->commands;
  538. int i;
  539. if (count < 1)
  540. return count;
  541. for (i = 0; config->performance_levels[i].name; ++i) {
  542. const struct sabi_performance_level *level =
  543. &config->performance_levels[i];
  544. if (!strncasecmp(level->name, buf, strlen(level->name))) {
  545. sabi_set_commandb(samsung,
  546. commands->set_performance_level,
  547. level->value);
  548. break;
  549. }
  550. }
  551. if (!config->performance_levels[i].name)
  552. return -EINVAL;
  553. return count;
  554. }
  555. static DEVICE_ATTR(performance_level, S_IWUSR | S_IRUGO,
  556. get_performance_level, set_performance_level);
  557. static int read_battery_life_extender(struct samsung_laptop *samsung)
  558. {
  559. const struct sabi_commands *commands = &samsung->config->commands;
  560. struct sabi_data data;
  561. int retval;
  562. if (commands->get_battery_life_extender == 0xFFFF)
  563. return -ENODEV;
  564. memset(&data, 0, sizeof(data));
  565. data.data[0] = 0x80;
  566. retval = sabi_command(samsung, commands->get_battery_life_extender,
  567. &data, &data);
  568. if (retval)
  569. return retval;
  570. if (data.data[0] != 0 && data.data[0] != 1)
  571. return -ENODEV;
  572. return data.data[0];
  573. }
  574. static int write_battery_life_extender(struct samsung_laptop *samsung,
  575. int enabled)
  576. {
  577. const struct sabi_commands *commands = &samsung->config->commands;
  578. struct sabi_data data;
  579. memset(&data, 0, sizeof(data));
  580. data.data[0] = 0x80 | enabled;
  581. return sabi_command(samsung, commands->set_battery_life_extender,
  582. &data, NULL);
  583. }
  584. static ssize_t get_battery_life_extender(struct device *dev,
  585. struct device_attribute *attr,
  586. char *buf)
  587. {
  588. struct samsung_laptop *samsung = dev_get_drvdata(dev);
  589. int ret;
  590. ret = read_battery_life_extender(samsung);
  591. if (ret < 0)
  592. return ret;
  593. return sprintf(buf, "%d\n", ret);
  594. }
  595. static ssize_t set_battery_life_extender(struct device *dev,
  596. struct device_attribute *attr,
  597. const char *buf, size_t count)
  598. {
  599. struct samsung_laptop *samsung = dev_get_drvdata(dev);
  600. int ret, value;
  601. if (!count || sscanf(buf, "%i", &value) != 1)
  602. return -EINVAL;
  603. ret = write_battery_life_extender(samsung, !!value);
  604. if (ret < 0)
  605. return ret;
  606. return count;
  607. }
  608. static DEVICE_ATTR(battery_life_extender, S_IWUSR | S_IRUGO,
  609. get_battery_life_extender, set_battery_life_extender);
  610. static int read_usb_charge(struct samsung_laptop *samsung)
  611. {
  612. const struct sabi_commands *commands = &samsung->config->commands;
  613. struct sabi_data data;
  614. int retval;
  615. if (commands->get_usb_charge == 0xFFFF)
  616. return -ENODEV;
  617. memset(&data, 0, sizeof(data));
  618. data.data[0] = 0x80;
  619. retval = sabi_command(samsung, commands->get_usb_charge,
  620. &data, &data);
  621. if (retval)
  622. return retval;
  623. if (data.data[0] != 0 && data.data[0] != 1)
  624. return -ENODEV;
  625. return data.data[0];
  626. }
  627. static int write_usb_charge(struct samsung_laptop *samsung,
  628. int enabled)
  629. {
  630. const struct sabi_commands *commands = &samsung->config->commands;
  631. struct sabi_data data;
  632. memset(&data, 0, sizeof(data));
  633. data.data[0] = 0x80 | enabled;
  634. return sabi_command(samsung, commands->set_usb_charge,
  635. &data, NULL);
  636. }
  637. static ssize_t get_usb_charge(struct device *dev,
  638. struct device_attribute *attr,
  639. char *buf)
  640. {
  641. struct samsung_laptop *samsung = dev_get_drvdata(dev);
  642. int ret;
  643. ret = read_usb_charge(samsung);
  644. if (ret < 0)
  645. return ret;
  646. return sprintf(buf, "%d\n", ret);
  647. }
  648. static ssize_t set_usb_charge(struct device *dev,
  649. struct device_attribute *attr,
  650. const char *buf, size_t count)
  651. {
  652. struct samsung_laptop *samsung = dev_get_drvdata(dev);
  653. int ret, value;
  654. if (!count || sscanf(buf, "%i", &value) != 1)
  655. return -EINVAL;
  656. ret = write_usb_charge(samsung, !!value);
  657. if (ret < 0)
  658. return ret;
  659. return count;
  660. }
  661. static DEVICE_ATTR(usb_charge, S_IWUSR | S_IRUGO,
  662. get_usb_charge, set_usb_charge);
  663. static struct attribute *platform_attributes[] = {
  664. &dev_attr_performance_level.attr,
  665. &dev_attr_battery_life_extender.attr,
  666. &dev_attr_usb_charge.attr,
  667. NULL
  668. };
  669. static int find_signature(void __iomem *memcheck, const char *testStr)
  670. {
  671. int i = 0;
  672. int loca;
  673. for (loca = 0; loca < 0xffff; loca++) {
  674. char temp = readb(memcheck + loca);
  675. if (temp == testStr[i]) {
  676. if (i == strlen(testStr)-1)
  677. break;
  678. ++i;
  679. } else {
  680. i = 0;
  681. }
  682. }
  683. return loca;
  684. }
  685. static void samsung_rfkill_exit(struct samsung_laptop *samsung)
  686. {
  687. if (samsung->wlan.rfkill) {
  688. rfkill_unregister(samsung->wlan.rfkill);
  689. rfkill_destroy(samsung->wlan.rfkill);
  690. samsung->wlan.rfkill = NULL;
  691. }
  692. if (samsung->bluetooth.rfkill) {
  693. rfkill_unregister(samsung->bluetooth.rfkill);
  694. rfkill_destroy(samsung->bluetooth.rfkill);
  695. samsung->bluetooth.rfkill = NULL;
  696. }
  697. }
  698. static int samsung_new_rfkill(struct samsung_laptop *samsung,
  699. struct samsung_rfkill *arfkill,
  700. const char *name, enum rfkill_type type,
  701. const struct rfkill_ops *ops,
  702. int blocked)
  703. {
  704. struct rfkill **rfkill = &arfkill->rfkill;
  705. int ret;
  706. arfkill->type = type;
  707. arfkill->samsung = samsung;
  708. *rfkill = rfkill_alloc(name, &samsung->platform_device->dev,
  709. type, ops, arfkill);
  710. if (!*rfkill)
  711. return -EINVAL;
  712. if (blocked != -1)
  713. rfkill_init_sw_state(*rfkill, blocked);
  714. ret = rfkill_register(*rfkill);
  715. if (ret) {
  716. rfkill_destroy(*rfkill);
  717. *rfkill = NULL;
  718. return ret;
  719. }
  720. return 0;
  721. }
  722. static int __init samsung_rfkill_init_seclinux(struct samsung_laptop *samsung)
  723. {
  724. return samsung_new_rfkill(samsung, &samsung->wlan, "samsung-wlan",
  725. RFKILL_TYPE_WLAN, &seclinux_rfkill_ops, -1);
  726. }
  727. static int __init samsung_rfkill_init_swsmi(struct samsung_laptop *samsung)
  728. {
  729. struct sabi_data data;
  730. int ret;
  731. ret = swsmi_wireless_status(samsung, &data);
  732. if (ret) {
  733. /* Some swsmi laptops use the old seclinux way to control
  734. * wireless devices */
  735. if (ret == -EINVAL)
  736. ret = samsung_rfkill_init_seclinux(samsung);
  737. return ret;
  738. }
  739. /* 0x02 seems to mean that the device is no present/available */
  740. if (data.data[WL_STATUS_WLAN] != 0x02)
  741. ret = samsung_new_rfkill(samsung, &samsung->wlan,
  742. "samsung-wlan",
  743. RFKILL_TYPE_WLAN,
  744. &swsmi_rfkill_ops,
  745. !data.data[WL_STATUS_WLAN]);
  746. if (ret)
  747. goto exit;
  748. if (data.data[WL_STATUS_BT] != 0x02)
  749. ret = samsung_new_rfkill(samsung, &samsung->bluetooth,
  750. "samsung-bluetooth",
  751. RFKILL_TYPE_BLUETOOTH,
  752. &swsmi_rfkill_ops,
  753. !data.data[WL_STATUS_BT]);
  754. if (ret)
  755. goto exit;
  756. exit:
  757. if (ret)
  758. samsung_rfkill_exit(samsung);
  759. return ret;
  760. }
  761. static int __init samsung_rfkill_init(struct samsung_laptop *samsung)
  762. {
  763. if (samsung->config->sabi_version == 2)
  764. return samsung_rfkill_init_seclinux(samsung);
  765. if (samsung->config->sabi_version == 3)
  766. return samsung_rfkill_init_swsmi(samsung);
  767. return 0;
  768. }
  769. static int kbd_backlight_enable(struct samsung_laptop *samsung)
  770. {
  771. const struct sabi_commands *commands = &samsung->config->commands;
  772. struct sabi_data data;
  773. int retval;
  774. if (commands->kbd_backlight == 0xFFFF)
  775. return -ENODEV;
  776. memset(&data, 0, sizeof(data));
  777. data.d0 = 0xaabb;
  778. retval = sabi_command(samsung, commands->kbd_backlight,
  779. &data, &data);
  780. if (retval)
  781. return retval;
  782. if (data.d0 != 0xccdd)
  783. return -ENODEV;
  784. return 0;
  785. }
  786. static int kbd_backlight_read(struct samsung_laptop *samsung)
  787. {
  788. const struct sabi_commands *commands = &samsung->config->commands;
  789. struct sabi_data data;
  790. int retval;
  791. memset(&data, 0, sizeof(data));
  792. data.data[0] = 0x81;
  793. retval = sabi_command(samsung, commands->kbd_backlight,
  794. &data, &data);
  795. if (retval)
  796. return retval;
  797. return data.data[0];
  798. }
  799. static int kbd_backlight_write(struct samsung_laptop *samsung, int brightness)
  800. {
  801. const struct sabi_commands *commands = &samsung->config->commands;
  802. struct sabi_data data;
  803. memset(&data, 0, sizeof(data));
  804. data.d0 = 0x82 | ((brightness & 0xFF) << 8);
  805. return sabi_command(samsung, commands->kbd_backlight,
  806. &data, NULL);
  807. }
  808. static void kbd_led_update(struct work_struct *work)
  809. {
  810. struct samsung_laptop *samsung;
  811. samsung = container_of(work, struct samsung_laptop, kbd_led_work);
  812. kbd_backlight_write(samsung, samsung->kbd_led_wk);
  813. }
  814. static void kbd_led_set(struct led_classdev *led_cdev,
  815. enum led_brightness value)
  816. {
  817. struct samsung_laptop *samsung;
  818. samsung = container_of(led_cdev, struct samsung_laptop, kbd_led);
  819. if (value > samsung->kbd_led.max_brightness)
  820. value = samsung->kbd_led.max_brightness;
  821. else if (value < 0)
  822. value = 0;
  823. samsung->kbd_led_wk = value;
  824. queue_work(samsung->led_workqueue, &samsung->kbd_led_work);
  825. }
  826. static enum led_brightness kbd_led_get(struct led_classdev *led_cdev)
  827. {
  828. struct samsung_laptop *samsung;
  829. samsung = container_of(led_cdev, struct samsung_laptop, kbd_led);
  830. return kbd_backlight_read(samsung);
  831. }
  832. static void samsung_leds_exit(struct samsung_laptop *samsung)
  833. {
  834. if (!IS_ERR_OR_NULL(samsung->kbd_led.dev))
  835. led_classdev_unregister(&samsung->kbd_led);
  836. if (samsung->led_workqueue)
  837. destroy_workqueue(samsung->led_workqueue);
  838. }
  839. static int __init samsung_leds_init(struct samsung_laptop *samsung)
  840. {
  841. int ret = 0;
  842. samsung->led_workqueue = create_singlethread_workqueue("led_workqueue");
  843. if (!samsung->led_workqueue)
  844. return -ENOMEM;
  845. if (kbd_backlight_enable(samsung) >= 0) {
  846. INIT_WORK(&samsung->kbd_led_work, kbd_led_update);
  847. samsung->kbd_led.name = "samsung::kbd_backlight";
  848. samsung->kbd_led.brightness_set = kbd_led_set;
  849. samsung->kbd_led.brightness_get = kbd_led_get;
  850. samsung->kbd_led.max_brightness = 8;
  851. ret = led_classdev_register(&samsung->platform_device->dev,
  852. &samsung->kbd_led);
  853. }
  854. if (ret)
  855. samsung_leds_exit(samsung);
  856. return ret;
  857. }
  858. static void samsung_backlight_exit(struct samsung_laptop *samsung)
  859. {
  860. if (samsung->backlight_device) {
  861. backlight_device_unregister(samsung->backlight_device);
  862. samsung->backlight_device = NULL;
  863. }
  864. }
  865. static int __init samsung_backlight_init(struct samsung_laptop *samsung)
  866. {
  867. struct backlight_device *bd;
  868. struct backlight_properties props;
  869. if (!samsung->handle_backlight)
  870. return 0;
  871. memset(&props, 0, sizeof(struct backlight_properties));
  872. props.type = BACKLIGHT_PLATFORM;
  873. props.max_brightness = samsung->config->max_brightness -
  874. samsung->config->min_brightness;
  875. bd = backlight_device_register("samsung",
  876. &samsung->platform_device->dev,
  877. samsung, &backlight_ops,
  878. &props);
  879. if (IS_ERR(bd))
  880. return PTR_ERR(bd);
  881. samsung->backlight_device = bd;
  882. samsung->backlight_device->props.brightness = read_brightness(samsung);
  883. samsung->backlight_device->props.power = FB_BLANK_UNBLANK;
  884. backlight_update_status(samsung->backlight_device);
  885. return 0;
  886. }
  887. static umode_t samsung_sysfs_is_visible(struct kobject *kobj,
  888. struct attribute *attr, int idx)
  889. {
  890. struct device *dev = container_of(kobj, struct device, kobj);
  891. struct platform_device *pdev = to_platform_device(dev);
  892. struct samsung_laptop *samsung = platform_get_drvdata(pdev);
  893. bool ok = true;
  894. if (attr == &dev_attr_performance_level.attr)
  895. ok = !!samsung->config->performance_levels[0].name;
  896. if (attr == &dev_attr_battery_life_extender.attr)
  897. ok = !!(read_battery_life_extender(samsung) >= 0);
  898. if (attr == &dev_attr_usb_charge.attr)
  899. ok = !!(read_usb_charge(samsung) >= 0);
  900. return ok ? attr->mode : 0;
  901. }
  902. static struct attribute_group platform_attribute_group = {
  903. .is_visible = samsung_sysfs_is_visible,
  904. .attrs = platform_attributes
  905. };
  906. static void samsung_sysfs_exit(struct samsung_laptop *samsung)
  907. {
  908. struct platform_device *device = samsung->platform_device;
  909. sysfs_remove_group(&device->dev.kobj, &platform_attribute_group);
  910. }
  911. static int __init samsung_sysfs_init(struct samsung_laptop *samsung)
  912. {
  913. struct platform_device *device = samsung->platform_device;
  914. return sysfs_create_group(&device->dev.kobj, &platform_attribute_group);
  915. }
  916. static int show_call(struct seq_file *m, void *data)
  917. {
  918. struct samsung_laptop *samsung = m->private;
  919. struct sabi_data *sdata = &samsung->debug.data;
  920. int ret;
  921. seq_printf(m, "SABI 0x%04x {0x%08x, 0x%08x, 0x%04x, 0x%02x}\n",
  922. samsung->debug.command,
  923. sdata->d0, sdata->d1, sdata->d2, sdata->d3);
  924. ret = sabi_command(samsung, samsung->debug.command, sdata, sdata);
  925. if (ret) {
  926. seq_printf(m, "SABI command 0x%04x failed\n",
  927. samsung->debug.command);
  928. return ret;
  929. }
  930. seq_printf(m, "SABI {0x%08x, 0x%08x, 0x%04x, 0x%02x}\n",
  931. sdata->d0, sdata->d1, sdata->d2, sdata->d3);
  932. return 0;
  933. }
  934. static int samsung_debugfs_open(struct inode *inode, struct file *file)
  935. {
  936. return single_open(file, show_call, inode->i_private);
  937. }
  938. static const struct file_operations samsung_laptop_call_io_ops = {
  939. .owner = THIS_MODULE,
  940. .open = samsung_debugfs_open,
  941. .read = seq_read,
  942. .llseek = seq_lseek,
  943. .release = single_release,
  944. };
  945. static void samsung_debugfs_exit(struct samsung_laptop *samsung)
  946. {
  947. debugfs_remove_recursive(samsung->debug.root);
  948. }
  949. static int samsung_debugfs_init(struct samsung_laptop *samsung)
  950. {
  951. struct dentry *dent;
  952. samsung->debug.root = debugfs_create_dir("samsung-laptop", NULL);
  953. if (!samsung->debug.root) {
  954. pr_err("failed to create debugfs directory");
  955. goto error_debugfs;
  956. }
  957. samsung->debug.f0000_wrapper.data = samsung->f0000_segment;
  958. samsung->debug.f0000_wrapper.size = 0xffff;
  959. samsung->debug.data_wrapper.data = &samsung->debug.data;
  960. samsung->debug.data_wrapper.size = sizeof(samsung->debug.data);
  961. samsung->debug.sdiag_wrapper.data = samsung->sdiag;
  962. samsung->debug.sdiag_wrapper.size = strlen(samsung->sdiag);
  963. dent = debugfs_create_u16("command", S_IRUGO | S_IWUSR,
  964. samsung->debug.root, &samsung->debug.command);
  965. if (!dent)
  966. goto error_debugfs;
  967. dent = debugfs_create_u32("d0", S_IRUGO | S_IWUSR, samsung->debug.root,
  968. &samsung->debug.data.d0);
  969. if (!dent)
  970. goto error_debugfs;
  971. dent = debugfs_create_u32("d1", S_IRUGO | S_IWUSR, samsung->debug.root,
  972. &samsung->debug.data.d1);
  973. if (!dent)
  974. goto error_debugfs;
  975. dent = debugfs_create_u16("d2", S_IRUGO | S_IWUSR, samsung->debug.root,
  976. &samsung->debug.data.d2);
  977. if (!dent)
  978. goto error_debugfs;
  979. dent = debugfs_create_u8("d3", S_IRUGO | S_IWUSR, samsung->debug.root,
  980. &samsung->debug.data.d3);
  981. if (!dent)
  982. goto error_debugfs;
  983. dent = debugfs_create_blob("data", S_IRUGO | S_IWUSR,
  984. samsung->debug.root,
  985. &samsung->debug.data_wrapper);
  986. if (!dent)
  987. goto error_debugfs;
  988. dent = debugfs_create_blob("f0000_segment", S_IRUSR | S_IWUSR,
  989. samsung->debug.root,
  990. &samsung->debug.f0000_wrapper);
  991. if (!dent)
  992. goto error_debugfs;
  993. dent = debugfs_create_file("call", S_IFREG | S_IRUGO,
  994. samsung->debug.root, samsung,
  995. &samsung_laptop_call_io_ops);
  996. if (!dent)
  997. goto error_debugfs;
  998. dent = debugfs_create_blob("sdiag", S_IRUGO | S_IWUSR,
  999. samsung->debug.root,
  1000. &samsung->debug.sdiag_wrapper);
  1001. if (!dent)
  1002. goto error_debugfs;
  1003. return 0;
  1004. error_debugfs:
  1005. samsung_debugfs_exit(samsung);
  1006. return -ENOMEM;
  1007. }
  1008. static void samsung_sabi_exit(struct samsung_laptop *samsung)
  1009. {
  1010. const struct sabi_config *config = samsung->config;
  1011. /* Turn off "Linux" mode in the BIOS */
  1012. if (config && config->commands.set_linux != 0xff)
  1013. sabi_set_commandb(samsung, config->commands.set_linux, 0x80);
  1014. if (samsung->sabi_iface) {
  1015. iounmap(samsung->sabi_iface);
  1016. samsung->sabi_iface = NULL;
  1017. }
  1018. if (samsung->f0000_segment) {
  1019. iounmap(samsung->f0000_segment);
  1020. samsung->f0000_segment = NULL;
  1021. }
  1022. samsung->config = NULL;
  1023. }
  1024. static __init void samsung_sabi_infos(struct samsung_laptop *samsung, int loca,
  1025. unsigned int ifaceP)
  1026. {
  1027. const struct sabi_config *config = samsung->config;
  1028. printk(KERN_DEBUG "This computer supports SABI==%x\n",
  1029. loca + 0xf0000 - 6);
  1030. printk(KERN_DEBUG "SABI header:\n");
  1031. printk(KERN_DEBUG " SMI Port Number = 0x%04x\n",
  1032. readw(samsung->sabi + config->header_offsets.port));
  1033. printk(KERN_DEBUG " SMI Interface Function = 0x%02x\n",
  1034. readb(samsung->sabi + config->header_offsets.iface_func));
  1035. printk(KERN_DEBUG " SMI enable memory buffer = 0x%02x\n",
  1036. readb(samsung->sabi + config->header_offsets.en_mem));
  1037. printk(KERN_DEBUG " SMI restore memory buffer = 0x%02x\n",
  1038. readb(samsung->sabi + config->header_offsets.re_mem));
  1039. printk(KERN_DEBUG " SABI data offset = 0x%04x\n",
  1040. readw(samsung->sabi + config->header_offsets.data_offset));
  1041. printk(KERN_DEBUG " SABI data segment = 0x%04x\n",
  1042. readw(samsung->sabi + config->header_offsets.data_segment));
  1043. printk(KERN_DEBUG " SABI pointer = 0x%08x\n", ifaceP);
  1044. }
  1045. static void __init samsung_sabi_diag(struct samsung_laptop *samsung)
  1046. {
  1047. int loca = find_signature(samsung->f0000_segment, "SDiaG@");
  1048. int i;
  1049. if (loca == 0xffff)
  1050. return ;
  1051. /* Example:
  1052. * Ident: @SDiaG@686XX-N90X3A/966-SEC-07HL-S90X3A
  1053. *
  1054. * Product name: 90X3A
  1055. * BIOS Version: 07HL
  1056. */
  1057. loca += 1;
  1058. for (i = 0; loca < 0xffff && i < sizeof(samsung->sdiag) - 1; loca++) {
  1059. char temp = readb(samsung->f0000_segment + loca);
  1060. if (isalnum(temp) || temp == '/' || temp == '-')
  1061. samsung->sdiag[i++] = temp;
  1062. else
  1063. break ;
  1064. }
  1065. if (debug && samsung->sdiag[0])
  1066. pr_info("sdiag: %s", samsung->sdiag);
  1067. }
  1068. static int __init samsung_sabi_init(struct samsung_laptop *samsung)
  1069. {
  1070. const struct sabi_config *config = NULL;
  1071. const struct sabi_commands *commands;
  1072. unsigned int ifaceP;
  1073. int ret = 0;
  1074. int i;
  1075. int loca;
  1076. samsung->f0000_segment = ioremap_nocache(0xf0000, 0xffff);
  1077. if (!samsung->f0000_segment) {
  1078. if (debug || force)
  1079. pr_err("Can't map the segment at 0xf0000\n");
  1080. ret = -EINVAL;
  1081. goto exit;
  1082. }
  1083. samsung_sabi_diag(samsung);
  1084. /* Try to find one of the signatures in memory to find the header */
  1085. for (i = 0; sabi_configs[i].test_string != 0; ++i) {
  1086. samsung->config = &sabi_configs[i];
  1087. loca = find_signature(samsung->f0000_segment,
  1088. samsung->config->test_string);
  1089. if (loca != 0xffff)
  1090. break;
  1091. }
  1092. if (loca == 0xffff) {
  1093. if (debug || force)
  1094. pr_err("This computer does not support SABI\n");
  1095. ret = -ENODEV;
  1096. goto exit;
  1097. }
  1098. config = samsung->config;
  1099. commands = &config->commands;
  1100. /* point to the SMI port Number */
  1101. loca += 1;
  1102. samsung->sabi = (samsung->f0000_segment + loca);
  1103. /* Get a pointer to the SABI Interface */
  1104. ifaceP = (readw(samsung->sabi + config->header_offsets.data_segment) & 0x0ffff) << 4;
  1105. ifaceP += readw(samsung->sabi + config->header_offsets.data_offset) & 0x0ffff;
  1106. if (debug)
  1107. samsung_sabi_infos(samsung, loca, ifaceP);
  1108. samsung->sabi_iface = ioremap_nocache(ifaceP, 16);
  1109. if (!samsung->sabi_iface) {
  1110. pr_err("Can't remap %x\n", ifaceP);
  1111. ret = -EINVAL;
  1112. goto exit;
  1113. }
  1114. /* Turn on "Linux" mode in the BIOS */
  1115. if (commands->set_linux != 0xff) {
  1116. int retval = sabi_set_commandb(samsung,
  1117. commands->set_linux, 0x81);
  1118. if (retval) {
  1119. pr_warn("Linux mode was not set!\n");
  1120. ret = -ENODEV;
  1121. goto exit;
  1122. }
  1123. }
  1124. /* Check for stepping quirk */
  1125. if (samsung->handle_backlight)
  1126. check_for_stepping_quirk(samsung);
  1127. pr_info("detected SABI interface: %s\n",
  1128. samsung->config->test_string);
  1129. exit:
  1130. if (ret)
  1131. samsung_sabi_exit(samsung);
  1132. return ret;
  1133. }
  1134. static void samsung_platform_exit(struct samsung_laptop *samsung)
  1135. {
  1136. if (samsung->platform_device) {
  1137. platform_device_unregister(samsung->platform_device);
  1138. samsung->platform_device = NULL;
  1139. }
  1140. }
  1141. static int __init samsung_platform_init(struct samsung_laptop *samsung)
  1142. {
  1143. struct platform_device *pdev;
  1144. pdev = platform_device_register_simple("samsung", -1, NULL, 0);
  1145. if (IS_ERR(pdev))
  1146. return PTR_ERR(pdev);
  1147. samsung->platform_device = pdev;
  1148. platform_set_drvdata(samsung->platform_device, samsung);
  1149. return 0;
  1150. }
  1151. static struct samsung_quirks *quirks;
  1152. static int __init samsung_dmi_matched(const struct dmi_system_id *d)
  1153. {
  1154. quirks = d->driver_data;
  1155. return 0;
  1156. }
  1157. static struct dmi_system_id __initdata samsung_dmi_table[] = {
  1158. {
  1159. .matches = {
  1160. DMI_MATCH(DMI_SYS_VENDOR,
  1161. "SAMSUNG ELECTRONICS CO., LTD."),
  1162. DMI_MATCH(DMI_CHASSIS_TYPE, "8"), /* Portable */
  1163. },
  1164. },
  1165. {
  1166. .matches = {
  1167. DMI_MATCH(DMI_SYS_VENDOR,
  1168. "SAMSUNG ELECTRONICS CO., LTD."),
  1169. DMI_MATCH(DMI_CHASSIS_TYPE, "9"), /* Laptop */
  1170. },
  1171. },
  1172. {
  1173. .matches = {
  1174. DMI_MATCH(DMI_SYS_VENDOR,
  1175. "SAMSUNG ELECTRONICS CO., LTD."),
  1176. DMI_MATCH(DMI_CHASSIS_TYPE, "10"), /* Notebook */
  1177. },
  1178. },
  1179. {
  1180. .matches = {
  1181. DMI_MATCH(DMI_SYS_VENDOR,
  1182. "SAMSUNG ELECTRONICS CO., LTD."),
  1183. DMI_MATCH(DMI_CHASSIS_TYPE, "14"), /* Sub-Notebook */
  1184. },
  1185. },
  1186. /* Specific DMI ids for laptop with quirks */
  1187. {
  1188. .callback = samsung_dmi_matched,
  1189. .ident = "N150P",
  1190. .matches = {
  1191. DMI_MATCH(DMI_SYS_VENDOR, "SAMSUNG ELECTRONICS CO., LTD."),
  1192. DMI_MATCH(DMI_PRODUCT_NAME, "N150P"),
  1193. DMI_MATCH(DMI_BOARD_NAME, "N150P"),
  1194. },
  1195. .driver_data = &samsung_broken_acpi_video,
  1196. },
  1197. {
  1198. .callback = samsung_dmi_matched,
  1199. .ident = "N145P/N250P/N260P",
  1200. .matches = {
  1201. DMI_MATCH(DMI_SYS_VENDOR, "SAMSUNG ELECTRONICS CO., LTD."),
  1202. DMI_MATCH(DMI_PRODUCT_NAME, "N145P/N250P/N260P"),
  1203. DMI_MATCH(DMI_BOARD_NAME, "N145P/N250P/N260P"),
  1204. },
  1205. .driver_data = &samsung_broken_acpi_video,
  1206. },
  1207. {
  1208. .callback = samsung_dmi_matched,
  1209. .ident = "N150/N210/N220",
  1210. .matches = {
  1211. DMI_MATCH(DMI_SYS_VENDOR, "SAMSUNG ELECTRONICS CO., LTD."),
  1212. DMI_MATCH(DMI_PRODUCT_NAME, "N150/N210/N220"),
  1213. DMI_MATCH(DMI_BOARD_NAME, "N150/N210/N220"),
  1214. },
  1215. .driver_data = &samsung_broken_acpi_video,
  1216. },
  1217. {
  1218. .callback = samsung_dmi_matched,
  1219. .ident = "NF110/NF210/NF310",
  1220. .matches = {
  1221. DMI_MATCH(DMI_SYS_VENDOR, "SAMSUNG ELECTRONICS CO., LTD."),
  1222. DMI_MATCH(DMI_PRODUCT_NAME, "NF110/NF210/NF310"),
  1223. DMI_MATCH(DMI_BOARD_NAME, "NF110/NF210/NF310"),
  1224. },
  1225. .driver_data = &samsung_broken_acpi_video,
  1226. },
  1227. {
  1228. .callback = samsung_dmi_matched,
  1229. .ident = "N250P",
  1230. .matches = {
  1231. DMI_MATCH(DMI_SYS_VENDOR, "SAMSUNG ELECTRONICS CO., LTD."),
  1232. DMI_MATCH(DMI_PRODUCT_NAME, "N250P"),
  1233. DMI_MATCH(DMI_BOARD_NAME, "N250P"),
  1234. },
  1235. .driver_data = &samsung_broken_acpi_video,
  1236. },
  1237. {
  1238. .callback = samsung_dmi_matched,
  1239. .ident = "NC210",
  1240. .matches = {
  1241. DMI_MATCH(DMI_SYS_VENDOR, "SAMSUNG ELECTRONICS CO., LTD."),
  1242. DMI_MATCH(DMI_PRODUCT_NAME, "NC210/NC110"),
  1243. DMI_MATCH(DMI_BOARD_NAME, "NC210/NC110"),
  1244. },
  1245. .driver_data = &samsung_broken_acpi_video,
  1246. },
  1247. { },
  1248. };
  1249. MODULE_DEVICE_TABLE(dmi, samsung_dmi_table);
  1250. static struct platform_device *samsung_platform_device;
  1251. static int __init samsung_init(void)
  1252. {
  1253. struct samsung_laptop *samsung;
  1254. int ret;
  1255. if (efi_enabled(EFI_BOOT))
  1256. return -ENODEV;
  1257. quirks = &samsung_unknown;
  1258. if (!force && !dmi_check_system(samsung_dmi_table))
  1259. return -ENODEV;
  1260. samsung = kzalloc(sizeof(*samsung), GFP_KERNEL);
  1261. if (!samsung)
  1262. return -ENOMEM;
  1263. mutex_init(&samsung->sabi_mutex);
  1264. samsung->handle_backlight = true;
  1265. samsung->quirks = quirks;
  1266. #if (defined CONFIG_ACPI_VIDEO || defined CONFIG_ACPI_VIDEO_MODULE)
  1267. /* Don't handle backlight here if the acpi video already handle it */
  1268. if (acpi_video_backlight_support()) {
  1269. if (samsung->quirks->broken_acpi_video) {
  1270. pr_info("Disabling ACPI video driver\n");
  1271. acpi_video_unregister();
  1272. } else {
  1273. samsung->handle_backlight = false;
  1274. }
  1275. }
  1276. #endif
  1277. ret = samsung_platform_init(samsung);
  1278. if (ret)
  1279. goto error_platform;
  1280. ret = samsung_sabi_init(samsung);
  1281. if (ret)
  1282. goto error_sabi;
  1283. #ifdef CONFIG_ACPI
  1284. /* Only log that if we are really on a sabi platform */
  1285. if (acpi_video_backlight_support() &&
  1286. !samsung->quirks->broken_acpi_video)
  1287. pr_info("Backlight controlled by ACPI video driver\n");
  1288. #endif
  1289. ret = samsung_sysfs_init(samsung);
  1290. if (ret)
  1291. goto error_sysfs;
  1292. ret = samsung_backlight_init(samsung);
  1293. if (ret)
  1294. goto error_backlight;
  1295. ret = samsung_rfkill_init(samsung);
  1296. if (ret)
  1297. goto error_rfkill;
  1298. ret = samsung_leds_init(samsung);
  1299. if (ret)
  1300. goto error_leds;
  1301. ret = samsung_debugfs_init(samsung);
  1302. if (ret)
  1303. goto error_debugfs;
  1304. samsung_platform_device = samsung->platform_device;
  1305. return ret;
  1306. error_debugfs:
  1307. samsung_leds_exit(samsung);
  1308. error_leds:
  1309. samsung_rfkill_exit(samsung);
  1310. error_rfkill:
  1311. samsung_backlight_exit(samsung);
  1312. error_backlight:
  1313. samsung_sysfs_exit(samsung);
  1314. error_sysfs:
  1315. samsung_sabi_exit(samsung);
  1316. error_sabi:
  1317. samsung_platform_exit(samsung);
  1318. error_platform:
  1319. kfree(samsung);
  1320. return ret;
  1321. }
  1322. static void __exit samsung_exit(void)
  1323. {
  1324. struct samsung_laptop *samsung;
  1325. samsung = platform_get_drvdata(samsung_platform_device);
  1326. samsung_debugfs_exit(samsung);
  1327. samsung_leds_exit(samsung);
  1328. samsung_rfkill_exit(samsung);
  1329. samsung_backlight_exit(samsung);
  1330. samsung_sysfs_exit(samsung);
  1331. samsung_sabi_exit(samsung);
  1332. samsung_platform_exit(samsung);
  1333. kfree(samsung);
  1334. samsung_platform_device = NULL;
  1335. }
  1336. module_init(samsung_init);
  1337. module_exit(samsung_exit);
  1338. MODULE_AUTHOR("Greg Kroah-Hartman <gregkh@suse.de>");
  1339. MODULE_DESCRIPTION("Samsung Backlight driver");
  1340. MODULE_LICENSE("GPL");