drivers/platform/x86/samsung-laptop.c

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