samsung-laptop.c 43 KB

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