Linux Audio

Check our new training course

Loading...
v3.1
   1/*-*-linux-c-*-*/
   2
   3/*
   4  Copyright (C) 2007,2008 Jonathan Woithe <jwoithe@physics.adelaide.edu.au>
   5  Copyright (C) 2008 Peter Gruber <nokos@gmx.net>
   6  Copyright (C) 2008 Tony Vroon <tony@linx.net>
   7  Based on earlier work:
   8    Copyright (C) 2003 Shane Spencer <shane@bogomip.com>
   9    Adrian Yee <brewt-fujitsu@brewt.org>
  10
  11  Templated from msi-laptop.c and thinkpad_acpi.c which is copyright
  12  by its respective authors.
  13
  14  This program is free software; you can redistribute it and/or modify
  15  it under the terms of the GNU General Public License as published by
  16  the Free Software Foundation; either version 2 of the License, or
  17  (at your option) any later version.
  18
  19  This program is distributed in the hope that it will be useful, but
  20  WITHOUT ANY WARRANTY; without even the implied warranty of
  21  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  22  General Public License for more details.
  23
  24  You should have received a copy of the GNU General Public License
  25  along with this program; if not, write to the Free Software
  26  Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
  27  02110-1301, USA.
  28 */
  29
  30/*
  31 * fujitsu-laptop.c - Fujitsu laptop support, providing access to additional
  32 * features made available on a range of Fujitsu laptops including the
  33 * P2xxx/P5xxx/S6xxx/S7xxx series.
  34 *
  35 * This driver exports a few files in /sys/devices/platform/fujitsu-laptop/;
  36 * others may be added at a later date.
  37 *
  38 *   lcd_level - Screen brightness: contains a single integer in the
  39 *   range 0..7. (rw)
  40 *
  41 * In addition to these platform device attributes the driver
  42 * registers itself in the Linux backlight control subsystem and is
  43 * available to userspace under /sys/class/backlight/fujitsu-laptop/.
  44 *
  45 * Hotkeys present on certain Fujitsu laptops (eg: the S6xxx series) are
  46 * also supported by this driver.
  47 *
  48 * This driver has been tested on a Fujitsu Lifebook S6410, S7020 and
  49 * P8010.  It should work on most P-series and S-series Lifebooks, but
  50 * YMMV.
  51 *
  52 * The module parameter use_alt_lcd_levels switches between different ACPI
  53 * brightness controls which are used by different Fujitsu laptops.  In most
  54 * cases the correct method is automatically detected. "use_alt_lcd_levels=1"
  55 * is applicable for a Fujitsu Lifebook S6410 if autodetection fails.
  56 *
  57 */
  58
  59#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  60
  61#include <linux/module.h>
  62#include <linux/kernel.h>
  63#include <linux/init.h>
  64#include <linux/acpi.h>
 
  65#include <linux/dmi.h>
  66#include <linux/backlight.h>
 
  67#include <linux/input.h>
 
  68#include <linux/kfifo.h>
  69#include <linux/video_output.h>
  70#include <linux/platform_device.h>
  71#include <linux/slab.h>
  72#if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
  73#include <linux/leds.h>
  74#endif
  75
  76#define FUJITSU_DRIVER_VERSION "0.6.0"
  77
  78#define FUJITSU_LCD_N_LEVELS 8
  79
  80#define ACPI_FUJITSU_CLASS              "fujitsu"
  81#define ACPI_FUJITSU_HID                "FUJ02B1"
  82#define ACPI_FUJITSU_DRIVER_NAME	"Fujitsu laptop FUJ02B1 ACPI brightness driver"
  83#define ACPI_FUJITSU_DEVICE_NAME        "Fujitsu FUJ02B1"
  84#define ACPI_FUJITSU_HOTKEY_HID 	"FUJ02E3"
  85#define ACPI_FUJITSU_HOTKEY_DRIVER_NAME "Fujitsu laptop FUJ02E3 ACPI hotkeys driver"
  86#define ACPI_FUJITSU_HOTKEY_DEVICE_NAME "Fujitsu FUJ02E3"
  87
  88#define ACPI_FUJITSU_NOTIFY_CODE1     0x80
 
 
 
 
 
 
  89
  90#define ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS     0x86
  91#define ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS     0x87
  92
  93/* FUNC interface - command values */
  94#define FUNC_RFKILL	0x1000
  95#define FUNC_LEDS	0x1001
  96#define FUNC_BUTTONS	0x1002
  97#define FUNC_BACKLIGHT  0x1004
  98
  99/* FUNC interface - responses */
 100#define UNSUPPORTED_CMD 0x80000000
 
 
 
 
 
 101
 102#if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
 103/* FUNC interface - LED control */
 104#define FUNC_LED_OFF	0x1
 105#define FUNC_LED_ON	0x30001
 106#define KEYBOARD_LAMPS	0x100
 107#define LOGOLAMP_POWERON 0x2000
 108#define LOGOLAMP_ALWAYS  0x4000
 109#endif
 110
 111/* Hotkey details */
 112#define KEY1_CODE	0x410	/* codes for the keys in the GIRB register */
 113#define KEY2_CODE	0x411
 114#define KEY3_CODE	0x412
 115#define KEY4_CODE	0x413
 116
 117#define MAX_HOTKEY_RINGBUFFER_SIZE 100
 118#define RINGBUFFERSIZE 40
 119
 120/* Debugging */
 121#define FUJLAPTOP_LOG	   ACPI_FUJITSU_HID ": "
 122#define FUJLAPTOP_ERR	   KERN_ERR FUJLAPTOP_LOG
 123#define FUJLAPTOP_NOTICE   KERN_NOTICE FUJLAPTOP_LOG
 124#define FUJLAPTOP_INFO	   KERN_INFO FUJLAPTOP_LOG
 125#define FUJLAPTOP_DEBUG    KERN_DEBUG FUJLAPTOP_LOG
 126
 127#define FUJLAPTOP_DBG_ALL	  0xffff
 128#define FUJLAPTOP_DBG_ERROR	  0x0001
 129#define FUJLAPTOP_DBG_WARN	  0x0002
 130#define FUJLAPTOP_DBG_INFO	  0x0004
 131#define FUJLAPTOP_DBG_TRACE	  0x0008
 132
 133#define dbg_printk(a_dbg_level, format, arg...) \
 134	do { if (dbg_level & a_dbg_level) \
 135		printk(FUJLAPTOP_DEBUG "%s: " format, __func__ , ## arg); \
 136	} while (0)
 137#ifdef CONFIG_FUJITSU_LAPTOP_DEBUG
 138#define vdbg_printk(a_dbg_level, format, arg...) \
 139	dbg_printk(a_dbg_level, format, ## arg)
 140#else
 141#define vdbg_printk(a_dbg_level, format, arg...)
 142#endif
 143
 144/* Device controlling the backlight and associated keys */
 145struct fujitsu_t {
 146	acpi_handle acpi_handle;
 147	struct acpi_device *dev;
 148	struct input_dev *input;
 149	char phys[32];
 150	struct backlight_device *bl_device;
 151	struct platform_device *pf_device;
 152	int keycode1, keycode2, keycode3, keycode4;
 153
 154	unsigned int max_brightness;
 155	unsigned int brightness_changed;
 156	unsigned int brightness_level;
 157};
 158
 159static struct fujitsu_t *fujitsu;
 160static int use_alt_lcd_levels = -1;
 161static int disable_brightness_adjust = -1;
 162
 163/* Device used to access other hotkeys on the laptop */
 164struct fujitsu_hotkey_t {
 165	acpi_handle acpi_handle;
 166	struct acpi_device *dev;
 167	struct input_dev *input;
 168	char phys[32];
 169	struct platform_device *pf_device;
 170	struct kfifo fifo;
 171	spinlock_t fifo_lock;
 172	int rfkill_supported;
 173	int rfkill_state;
 174	int logolamp_registered;
 175	int kblamps_registered;
 176};
 177
 178static struct fujitsu_hotkey_t *fujitsu_hotkey;
 179
 180static void acpi_fujitsu_hotkey_notify(struct acpi_device *device, u32 event);
 181
 182#if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
 183static enum led_brightness logolamp_get(struct led_classdev *cdev);
 184static void logolamp_set(struct led_classdev *cdev,
 185			       enum led_brightness brightness);
 186
 187static struct led_classdev logolamp_led = {
 188 .name = "fujitsu::logolamp",
 189 .brightness_get = logolamp_get,
 190 .brightness_set = logolamp_set
 191};
 192
 193static enum led_brightness kblamps_get(struct led_classdev *cdev);
 194static void kblamps_set(struct led_classdev *cdev,
 195			       enum led_brightness brightness);
 196
 197static struct led_classdev kblamps_led = {
 198 .name = "fujitsu::kblamps",
 199 .brightness_get = kblamps_get,
 200 .brightness_set = kblamps_set
 201};
 202#endif
 203
 204#ifdef CONFIG_FUJITSU_LAPTOP_DEBUG
 205static u32 dbg_level = 0x03;
 206#endif
 207
 208static void acpi_fujitsu_notify(struct acpi_device *device, u32 event);
 209
 210/* Fujitsu ACPI interface function */
 211
 212static int call_fext_func(int cmd, int arg0, int arg1, int arg2)
 
 213{
 214	acpi_status status = AE_OK;
 215	union acpi_object params[4] = {
 216	{ .type = ACPI_TYPE_INTEGER },
 217	{ .type = ACPI_TYPE_INTEGER },
 218	{ .type = ACPI_TYPE_INTEGER },
 219	{ .type = ACPI_TYPE_INTEGER }
 220	};
 221	struct acpi_object_list arg_list = { 4, &params[0] };
 222	struct acpi_buffer output;
 223	union acpi_object out_obj;
 224	acpi_handle handle = NULL;
 225
 226	status = acpi_get_handle(fujitsu_hotkey->acpi_handle, "FUNC", &handle);
 227	if (ACPI_FAILURE(status)) {
 228		vdbg_printk(FUJLAPTOP_DBG_ERROR,
 229				"FUNC interface is not present\n");
 230		return -ENODEV;
 231	}
 232
 233	params[0].integer.value = cmd;
 234	params[1].integer.value = arg0;
 235	params[2].integer.value = arg1;
 236	params[3].integer.value = arg2;
 237
 238	output.length = sizeof(out_obj);
 239	output.pointer = &out_obj;
 240
 241	status = acpi_evaluate_object(handle, NULL, &arg_list, &output);
 242	if (ACPI_FAILURE(status)) {
 243		vdbg_printk(FUJLAPTOP_DBG_WARN,
 244			"FUNC 0x%x (args 0x%x, 0x%x, 0x%x) call failed\n",
 245				cmd, arg0, arg1, arg2);
 246		return -ENODEV;
 247	}
 248
 249	if (out_obj.type != ACPI_TYPE_INTEGER) {
 250		vdbg_printk(FUJLAPTOP_DBG_WARN,
 251			"FUNC 0x%x (args 0x%x, 0x%x, 0x%x) did not "
 252			"return an integer\n",
 253			cmd, arg0, arg1, arg2);
 254		return -ENODEV;
 255	}
 256
 257	vdbg_printk(FUJLAPTOP_DBG_TRACE,
 258		"FUNC 0x%x (args 0x%x, 0x%x, 0x%x) returned 0x%x\n",
 259			cmd, arg0, arg1, arg2, (int)out_obj.integer.value);
 260	return out_obj.integer.value;
 261}
 262
 263#if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
 264/* LED class callbacks */
 265
 266static void logolamp_set(struct led_classdev *cdev,
 267			       enum led_brightness brightness)
 268{
 269	if (brightness >= LED_FULL) {
 270		call_fext_func(FUNC_LEDS, 0x1, LOGOLAMP_POWERON, FUNC_LED_ON);
 271		call_fext_func(FUNC_LEDS, 0x1, LOGOLAMP_ALWAYS, FUNC_LED_ON);
 272	} else if (brightness >= LED_HALF) {
 273		call_fext_func(FUNC_LEDS, 0x1, LOGOLAMP_POWERON, FUNC_LED_ON);
 274		call_fext_func(FUNC_LEDS, 0x1, LOGOLAMP_ALWAYS, FUNC_LED_OFF);
 275	} else {
 276		call_fext_func(FUNC_LEDS, 0x1, LOGOLAMP_POWERON, FUNC_LED_OFF);
 277	}
 278}
 279
 280static void kblamps_set(struct led_classdev *cdev,
 281			       enum led_brightness brightness)
 282{
 283	if (brightness >= LED_FULL)
 284		call_fext_func(FUNC_LEDS, 0x1, KEYBOARD_LAMPS, FUNC_LED_ON);
 285	else
 286		call_fext_func(FUNC_LEDS, 0x1, KEYBOARD_LAMPS, FUNC_LED_OFF);
 287}
 288
 289static enum led_brightness logolamp_get(struct led_classdev *cdev)
 290{
 291	enum led_brightness brightness = LED_OFF;
 292	int poweron, always;
 293
 294	poweron = call_fext_func(FUNC_LEDS, 0x2, LOGOLAMP_POWERON, 0x0);
 295	if (poweron == FUNC_LED_ON) {
 296		brightness = LED_HALF;
 297		always = call_fext_func(FUNC_LEDS, 0x2, LOGOLAMP_ALWAYS, 0x0);
 298		if (always == FUNC_LED_ON)
 299			brightness = LED_FULL;
 300	}
 301	return brightness;
 302}
 303
 304static enum led_brightness kblamps_get(struct led_classdev *cdev)
 305{
 306	enum led_brightness brightness = LED_OFF;
 307
 308	if (call_fext_func(FUNC_LEDS, 0x2, KEYBOARD_LAMPS, 0x0) == FUNC_LED_ON)
 309		brightness = LED_FULL;
 310
 311	return brightness;
 312}
 313#endif
 314
 315/* Hardware access for LCD brightness control */
 316
 317static int set_lcd_level(int level)
 318{
 319	acpi_status status = AE_OK;
 320	union acpi_object arg0 = { ACPI_TYPE_INTEGER };
 321	struct acpi_object_list arg_list = { 1, &arg0 };
 322	acpi_handle handle = NULL;
 323
 324	vdbg_printk(FUJLAPTOP_DBG_TRACE, "set lcd level via SBLL [%d]\n",
 325		    level);
 326
 327	if (level < 0 || level >= fujitsu->max_brightness)
 328		return -EINVAL;
 329
 330	status = acpi_get_handle(fujitsu->acpi_handle, "SBLL", &handle);
 331	if (ACPI_FAILURE(status)) {
 332		vdbg_printk(FUJLAPTOP_DBG_ERROR, "SBLL not present\n");
 333		return -ENODEV;
 
 
 334	}
 335
 336	arg0.integer.value = level;
 337
 338	status = acpi_evaluate_object(handle, NULL, &arg_list, NULL);
 339	if (ACPI_FAILURE(status))
 340		return -ENODEV;
 341
 342	return 0;
 343}
 344
 345static int set_lcd_level_alt(int level)
 346{
 347	acpi_status status = AE_OK;
 348	union acpi_object arg0 = { ACPI_TYPE_INTEGER };
 349	struct acpi_object_list arg_list = { 1, &arg0 };
 350	acpi_handle handle = NULL;
 351
 352	vdbg_printk(FUJLAPTOP_DBG_TRACE, "set lcd level via SBL2 [%d]\n",
 353		    level);
 354
 355	if (level < 0 || level >= fujitsu->max_brightness)
 356		return -EINVAL;
 357
 358	status = acpi_get_handle(fujitsu->acpi_handle, "SBL2", &handle);
 359	if (ACPI_FAILURE(status)) {
 360		vdbg_printk(FUJLAPTOP_DBG_ERROR, "SBL2 not present\n");
 
 361		return -ENODEV;
 362	}
 363
 364	arg0.integer.value = level;
 365
 366	status = acpi_evaluate_object(handle, NULL, &arg_list, NULL);
 367	if (ACPI_FAILURE(status))
 368		return -ENODEV;
 369
 370	return 0;
 371}
 372
 373static int get_lcd_level(void)
 374{
 
 375	unsigned long long state = 0;
 376	acpi_status status = AE_OK;
 377
 378	vdbg_printk(FUJLAPTOP_DBG_TRACE, "get lcd level via GBLL\n");
 379
 380	status =
 381	    acpi_evaluate_integer(fujitsu->acpi_handle, "GBLL", NULL, &state);
 382	if (ACPI_FAILURE(status))
 383		return 0;
 384
 385	fujitsu->brightness_level = state & 0x0fffffff;
 386
 387	if (state & 0x80000000)
 388		fujitsu->brightness_changed = 1;
 389	else
 390		fujitsu->brightness_changed = 0;
 391
 392	return fujitsu->brightness_level;
 393}
 394
 395static int get_max_brightness(void)
 396{
 
 397	unsigned long long state = 0;
 398	acpi_status status = AE_OK;
 399
 400	vdbg_printk(FUJLAPTOP_DBG_TRACE, "get max lcd level via RBLL\n");
 401
 402	status =
 403	    acpi_evaluate_integer(fujitsu->acpi_handle, "RBLL", NULL, &state);
 404	if (ACPI_FAILURE(status))
 405		return -1;
 406
 407	fujitsu->max_brightness = state;
 408
 409	return fujitsu->max_brightness;
 410}
 411
 412/* Backlight device stuff */
 413
 414static int bl_get_brightness(struct backlight_device *b)
 415{
 416	return get_lcd_level();
 
 
 417}
 418
 419static int bl_update_status(struct backlight_device *b)
 420{
 421	int ret;
 422	if (b->props.power == 4)
 423		ret = call_fext_func(FUNC_BACKLIGHT, 0x1, 0x4, 0x3);
 424	else
 425		ret = call_fext_func(FUNC_BACKLIGHT, 0x1, 0x4, 0x0);
 426	if (ret != 0)
 427		vdbg_printk(FUJLAPTOP_DBG_ERROR,
 428			"Unable to adjust backlight power, error code %i\n",
 429			ret);
 430
 431	if (use_alt_lcd_levels)
 432		ret = set_lcd_level_alt(b->props.brightness);
 433	else
 434		ret = set_lcd_level(b->props.brightness);
 435	if (ret != 0)
 436		vdbg_printk(FUJLAPTOP_DBG_ERROR,
 437			"Unable to adjust LCD brightness, error code %i\n",
 438			ret);
 439	return ret;
 
 440}
 441
 442static const struct backlight_ops fujitsubl_ops = {
 443	.get_brightness = bl_get_brightness,
 444	.update_status = bl_update_status,
 445};
 446
 447/* Platform LCD brightness device */
 448
 449static ssize_t
 450show_max_brightness(struct device *dev,
 451		    struct device_attribute *attr, char *buf)
 452{
 
 453
 454	int ret;
 455
 456	ret = get_max_brightness();
 457	if (ret < 0)
 458		return ret;
 459
 460	return sprintf(buf, "%i\n", ret);
 461}
 462
 463static ssize_t
 464show_brightness_changed(struct device *dev,
 465			struct device_attribute *attr, char *buf)
 466{
 467
 468	int ret;
 469
 470	ret = fujitsu->brightness_changed;
 471	if (ret < 0)
 472		return ret;
 473
 474	return sprintf(buf, "%i\n", ret);
 475}
 476
 477static ssize_t show_lcd_level(struct device *dev,
 478			      struct device_attribute *attr, char *buf)
 479{
 480
 481	int ret;
 482
 483	ret = get_lcd_level();
 484	if (ret < 0)
 485		return ret;
 486
 487	return sprintf(buf, "%i\n", ret);
 488}
 489
 490static ssize_t store_lcd_level(struct device *dev,
 491			       struct device_attribute *attr, const char *buf,
 492			       size_t count)
 493{
 494
 495	int level, ret;
 496
 497	if (sscanf(buf, "%i", &level) != 1
 498	    || (level < 0 || level >= fujitsu->max_brightness))
 499		return -EINVAL;
 500
 501	if (use_alt_lcd_levels)
 502		ret = set_lcd_level_alt(level);
 503	else
 504		ret = set_lcd_level(level);
 505	if (ret < 0)
 506		return ret;
 507
 508	ret = get_lcd_level();
 509	if (ret < 0)
 510		return ret;
 511
 512	return count;
 513}
 514
 515static ssize_t
 516ignore_store(struct device *dev,
 517	     struct device_attribute *attr, const char *buf, size_t count)
 518{
 519	return count;
 520}
 521
 522static ssize_t
 523show_lid_state(struct device *dev,
 524			struct device_attribute *attr, char *buf)
 525{
 526	if (!(fujitsu_hotkey->rfkill_supported & 0x100))
 527		return sprintf(buf, "unknown\n");
 528	if (fujitsu_hotkey->rfkill_state & 0x100)
 529		return sprintf(buf, "open\n");
 530	else
 531		return sprintf(buf, "closed\n");
 532}
 533
 534static ssize_t
 535show_dock_state(struct device *dev,
 536			struct device_attribute *attr, char *buf)
 537{
 538	if (!(fujitsu_hotkey->rfkill_supported & 0x200))
 
 
 539		return sprintf(buf, "unknown\n");
 540	if (fujitsu_hotkey->rfkill_state & 0x200)
 541		return sprintf(buf, "docked\n");
 542	else
 543		return sprintf(buf, "undocked\n");
 544}
 545
 546static ssize_t
 547show_radios_state(struct device *dev,
 548			struct device_attribute *attr, char *buf)
 549{
 550	if (!(fujitsu_hotkey->rfkill_supported & 0x20))
 
 
 551		return sprintf(buf, "unknown\n");
 552	if (fujitsu_hotkey->rfkill_state & 0x20)
 553		return sprintf(buf, "on\n");
 554	else
 555		return sprintf(buf, "killed\n");
 556}
 557
 558static DEVICE_ATTR(max_brightness, 0444, show_max_brightness, ignore_store);
 559static DEVICE_ATTR(brightness_changed, 0444, show_brightness_changed,
 560		   ignore_store);
 561static DEVICE_ATTR(lcd_level, 0644, show_lcd_level, store_lcd_level);
 562static DEVICE_ATTR(lid, 0444, show_lid_state, ignore_store);
 563static DEVICE_ATTR(dock, 0444, show_dock_state, ignore_store);
 564static DEVICE_ATTR(radios, 0444, show_radios_state, ignore_store);
 565
 566static struct attribute *fujitsupf_attributes[] = {
 567	&dev_attr_brightness_changed.attr,
 568	&dev_attr_max_brightness.attr,
 569	&dev_attr_lcd_level.attr,
 570	&dev_attr_lid.attr,
 571	&dev_attr_dock.attr,
 572	&dev_attr_radios.attr,
 573	NULL
 574};
 575
 576static struct attribute_group fujitsupf_attribute_group = {
 577	.attrs = fujitsupf_attributes
 578};
 579
 580static struct platform_driver fujitsupf_driver = {
 581	.driver = {
 582		   .name = "fujitsu-laptop",
 583		   .owner = THIS_MODULE,
 584		   }
 585};
 586
 587static void dmi_check_cb_common(const struct dmi_system_id *id)
 
 
 
 
 
 
 
 
 588{
 589	acpi_handle handle;
 590	pr_info("Identified laptop model '%s'\n", id->ident);
 591	if (use_alt_lcd_levels == -1) {
 592		if (ACPI_SUCCESS(acpi_get_handle(NULL,
 593				"\\_SB.PCI0.LPCB.FJEX.SBL2", &handle)))
 594			use_alt_lcd_levels = 1;
 595		else
 596			use_alt_lcd_levels = 0;
 597		vdbg_printk(FUJLAPTOP_DBG_TRACE, "auto-detected usealt as "
 598			"%i\n", use_alt_lcd_levels);
 599	}
 
 
 
 
 
 
 
 
 
 600}
 601
 602static int dmi_check_cb_s6410(const struct dmi_system_id *id)
 603{
 604	dmi_check_cb_common(id);
 605	fujitsu->keycode1 = KEY_SCREENLOCK;	/* "Lock" */
 606	fujitsu->keycode2 = KEY_HELP;	/* "Mobility Center" */
 607	return 1;
 
 
 
 
 
 
 
 
 
 
 
 
 
 608}
 609
 610static int dmi_check_cb_s6420(const struct dmi_system_id *id)
 611{
 612	dmi_check_cb_common(id);
 613	fujitsu->keycode1 = KEY_SCREENLOCK;	/* "Lock" */
 614	fujitsu->keycode2 = KEY_HELP;	/* "Mobility Center" */
 615	return 1;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 616}
 617
 618static int dmi_check_cb_p8010(const struct dmi_system_id *id)
 
 
 619{
 620	dmi_check_cb_common(id);
 621	fujitsu->keycode1 = KEY_HELP;	/* "Support" */
 622	fujitsu->keycode3 = KEY_SWITCHVIDEOMODE;	/* "Presentation" */
 623	fujitsu->keycode4 = KEY_WWW;	/* "Internet" */
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 624	return 1;
 625}
 626
 627static struct dmi_system_id fujitsu_dmi_table[] = {
 628	{
 629	 .ident = "Fujitsu Siemens S6410",
 630	 .matches = {
 631		     DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"),
 632		     DMI_MATCH(DMI_PRODUCT_NAME, "LIFEBOOK S6410"),
 633		     },
 634	 .callback = dmi_check_cb_s6410},
 
 
 635	{
 636	 .ident = "Fujitsu Siemens S6420",
 637	 .matches = {
 638		     DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"),
 639		     DMI_MATCH(DMI_PRODUCT_NAME, "LIFEBOOK S6420"),
 640		     },
 641	 .callback = dmi_check_cb_s6420},
 
 
 642	{
 643	 .ident = "Fujitsu LifeBook P8010",
 644	 .matches = {
 645		     DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU"),
 646		     DMI_MATCH(DMI_PRODUCT_NAME, "LifeBook P8010"),
 647		     },
 648	 .callback = dmi_check_cb_p8010},
 
 
 649	{}
 650};
 651
 652/* ACPI device for LCD brightness control */
 
 
 
 
 
 
 
 653
 654static int acpi_fujitsu_add(struct acpi_device *device)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 655{
 656	acpi_handle handle;
 657	int result = 0;
 658	int state = 0;
 659	struct input_dev *input;
 660	int error;
 661
 662	if (!device)
 663		return -EINVAL;
 
 664
 665	fujitsu->acpi_handle = device->handle;
 666	sprintf(acpi_device_name(device), "%s", ACPI_FUJITSU_DEVICE_NAME);
 667	sprintf(acpi_device_class(device), "%s", ACPI_FUJITSU_CLASS);
 668	device->driver_data = fujitsu;
 669
 670	fujitsu->input = input = input_allocate_device();
 671	if (!input) {
 672		error = -ENOMEM;
 673		goto err_stop;
 674	}
 675
 676	snprintf(fujitsu->phys, sizeof(fujitsu->phys),
 677		 "%s/video/input0", acpi_device_hid(device));
 
 678
 679	input->name = acpi_device_name(device);
 680	input->phys = fujitsu->phys;
 681	input->id.bustype = BUS_HOST;
 682	input->id.product = 0x06;
 683	input->dev.parent = &device->dev;
 684	input->evbit[0] = BIT(EV_KEY);
 685	set_bit(KEY_BRIGHTNESSUP, input->keybit);
 686	set_bit(KEY_BRIGHTNESSDOWN, input->keybit);
 687	set_bit(KEY_UNKNOWN, input->keybit);
 688
 689	error = input_register_device(input);
 690	if (error)
 691		goto err_free_input_dev;
 692
 693	result = acpi_bus_update_power(fujitsu->acpi_handle, &state);
 694	if (result) {
 695		pr_err("Error reading power state\n");
 696		goto err_unregister_input_dev;
 697	}
 698
 699	pr_info("ACPI: %s [%s] (%s)\n",
 700	       acpi_device_name(device), acpi_device_bid(device),
 701	       !device->power.state ? "on" : "off");
 702
 703	fujitsu->dev = device;
 704
 705	if (ACPI_SUCCESS
 706	    (acpi_get_handle(device->handle, METHOD_NAME__INI, &handle))) {
 707		vdbg_printk(FUJLAPTOP_DBG_INFO, "Invoking _INI\n");
 708		if (ACPI_FAILURE
 709		    (acpi_evaluate_object
 710		     (device->handle, METHOD_NAME__INI, NULL, NULL)))
 711			pr_err("_INI Method failed\n");
 712	}
 713
 714	/* do config (detect defaults) */
 715	use_alt_lcd_levels = use_alt_lcd_levels == 1 ? 1 : 0;
 716	disable_brightness_adjust = disable_brightness_adjust == 1 ? 1 : 0;
 717	vdbg_printk(FUJLAPTOP_DBG_INFO,
 718		    "config: [alt interface: %d], [adjust disable: %d]\n",
 719		    use_alt_lcd_levels, disable_brightness_adjust);
 720
 721	if (get_max_brightness() <= 0)
 722		fujitsu->max_brightness = FUJITSU_LCD_N_LEVELS;
 723	get_lcd_level();
 724
 725	return result;
 
 
 726
 727err_unregister_input_dev:
 728	input_unregister_device(input);
 729	input = NULL;
 730err_free_input_dev:
 731	input_free_device(input);
 732err_stop:
 733	return result;
 734}
 735
 736static int acpi_fujitsu_remove(struct acpi_device *device, int type)
 
 737{
 738	struct fujitsu_t *fujitsu = acpi_driver_data(device);
 739	struct input_dev *input = fujitsu->input;
 
 740
 741	input_unregister_device(input);
 
 742
 743	fujitsu->acpi_handle = NULL;
 
 744
 745	return 0;
 
 
 
 
 746}
 747
 748/* Brightness notify */
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 749
 750static void acpi_fujitsu_notify(struct acpi_device *device, u32 event)
 
 751{
 752	struct input_dev *input;
 753	int keycode;
 754	int oldb, newb;
 755
 756	input = fujitsu->input;
 
 
 
 
 
 
 757
 758	switch (event) {
 759	case ACPI_FUJITSU_NOTIFY_CODE1:
 760		keycode = 0;
 761		oldb = fujitsu->brightness_level;
 762		get_lcd_level();
 763		newb = fujitsu->brightness_level;
 764
 765		vdbg_printk(FUJLAPTOP_DBG_TRACE,
 766			    "brightness button event [%i -> %i (%i)]\n",
 767			    oldb, newb, fujitsu->brightness_changed);
 768
 769		if (oldb < newb) {
 770			if (disable_brightness_adjust != 1) {
 771				if (use_alt_lcd_levels)
 772					set_lcd_level_alt(newb);
 773				else
 774					set_lcd_level(newb);
 775			}
 776			acpi_bus_generate_proc_event(fujitsu->dev,
 777				ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS, 0);
 778			keycode = KEY_BRIGHTNESSUP;
 779		} else if (oldb > newb) {
 780			if (disable_brightness_adjust != 1) {
 781				if (use_alt_lcd_levels)
 782					set_lcd_level_alt(newb);
 783				else
 784					set_lcd_level(newb);
 785			}
 786			acpi_bus_generate_proc_event(fujitsu->dev,
 787				ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS, 0);
 788			keycode = KEY_BRIGHTNESSDOWN;
 789		}
 790		break;
 791	default:
 792		keycode = KEY_UNKNOWN;
 793		vdbg_printk(FUJLAPTOP_DBG_WARN,
 794			    "unsupported event [0x%x]\n", event);
 795		break;
 796	}
 797
 798	if (keycode != 0) {
 799		input_report_key(input, keycode, 1);
 800		input_sync(input);
 801		input_report_key(input, keycode, 0);
 802		input_sync(input);
 803	}
 804}
 805
 806/* ACPI device for hotkey handling */
 
 
 
 
 
 
 
 
 
 
 
 807
 808static int acpi_fujitsu_hotkey_add(struct acpi_device *device)
 809{
 810	acpi_handle handle;
 811	int result = 0;
 812	int state = 0;
 813	struct input_dev *input;
 814	int error;
 815	int i;
 816
 817	if (!device)
 818		return -EINVAL;
 819
 820	fujitsu_hotkey->acpi_handle = device->handle;
 821	sprintf(acpi_device_name(device), "%s",
 822		ACPI_FUJITSU_HOTKEY_DEVICE_NAME);
 823	sprintf(acpi_device_class(device), "%s", ACPI_FUJITSU_CLASS);
 824	device->driver_data = fujitsu_hotkey;
 825
 826	/* kfifo */
 827	spin_lock_init(&fujitsu_hotkey->fifo_lock);
 828	error = kfifo_alloc(&fujitsu_hotkey->fifo, RINGBUFFERSIZE * sizeof(int),
 829			GFP_KERNEL);
 830	if (error) {
 831		pr_err("kfifo_alloc failed\n");
 832		goto err_stop;
 833	}
 834
 835	fujitsu_hotkey->input = input = input_allocate_device();
 836	if (!input) {
 837		error = -ENOMEM;
 838		goto err_free_fifo;
 839	}
 
 
 
 840
 841	snprintf(fujitsu_hotkey->phys, sizeof(fujitsu_hotkey->phys),
 842		 "%s/video/input0", acpi_device_hid(device));
 
 
 843
 844	input->name = acpi_device_name(device);
 845	input->phys = fujitsu_hotkey->phys;
 846	input->id.bustype = BUS_HOST;
 847	input->id.product = 0x06;
 848	input->dev.parent = &device->dev;
 849
 850	set_bit(EV_KEY, input->evbit);
 851	set_bit(fujitsu->keycode1, input->keybit);
 852	set_bit(fujitsu->keycode2, input->keybit);
 853	set_bit(fujitsu->keycode3, input->keybit);
 854	set_bit(fujitsu->keycode4, input->keybit);
 855	set_bit(KEY_UNKNOWN, input->keybit);
 856
 857	error = input_register_device(input);
 858	if (error)
 859		goto err_free_input_dev;
 860
 861	result = acpi_bus_update_power(fujitsu_hotkey->acpi_handle, &state);
 862	if (result) {
 863		pr_err("Error reading power state\n");
 864		goto err_unregister_input_dev;
 865	}
 866
 867	pr_info("ACPI: %s [%s] (%s)\n",
 868		acpi_device_name(device), acpi_device_bid(device),
 869		!device->power.state ? "on" : "off");
 870
 871	fujitsu_hotkey->dev = device;
 872
 873	if (ACPI_SUCCESS
 874	    (acpi_get_handle(device->handle, METHOD_NAME__INI, &handle))) {
 875		vdbg_printk(FUJLAPTOP_DBG_INFO, "Invoking _INI\n");
 876		if (ACPI_FAILURE
 877		    (acpi_evaluate_object
 878		     (device->handle, METHOD_NAME__INI, NULL, NULL)))
 879			pr_err("_INI Method failed\n");
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 880	}
 881
 882	i = 0;
 883	while (call_fext_func(FUNC_BUTTONS, 0x1, 0x0, 0x0) != 0
 884		&& (i++) < MAX_HOTKEY_RINGBUFFER_SIZE)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 885		; /* No action, result is discarded */
 886	vdbg_printk(FUJLAPTOP_DBG_INFO, "Discarded %i ringbuffer entries\n", i);
 
 887
 888	fujitsu_hotkey->rfkill_supported =
 889		call_fext_func(FUNC_RFKILL, 0x0, 0x0, 0x0);
 890
 891	/* Make sure our bitmask of supported functions is cleared if the
 892	   RFKILL function block is not implemented, like on the S7020. */
 893	if (fujitsu_hotkey->rfkill_supported == UNSUPPORTED_CMD)
 894		fujitsu_hotkey->rfkill_supported = 0;
 895
 896	if (fujitsu_hotkey->rfkill_supported)
 897		fujitsu_hotkey->rfkill_state =
 898			call_fext_func(FUNC_RFKILL, 0x4, 0x0, 0x0);
 899
 900	/* Suspect this is a keymap of the application panel, print it */
 901	pr_info("BTNI: [0x%x]\n", call_fext_func(FUNC_BUTTONS, 0x0, 0x0, 0x0));
 
 902
 903#if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
 904	if (call_fext_func(FUNC_LEDS, 0x0, 0x0, 0x0) & LOGOLAMP_POWERON) {
 905		result = led_classdev_register(&fujitsu->pf_device->dev,
 906						&logolamp_led);
 907		if (result == 0) {
 908			fujitsu_hotkey->logolamp_registered = 1;
 909		} else {
 910			pr_err("Could not register LED handler for logo lamp, error %i\n",
 911			       result);
 912		}
 913	}
 914
 915	if ((call_fext_func(FUNC_LEDS, 0x0, 0x0, 0x0) & KEYBOARD_LAMPS) &&
 916	   (call_fext_func(FUNC_BUTTONS, 0x0, 0x0, 0x0) == 0x0)) {
 917		result = led_classdev_register(&fujitsu->pf_device->dev,
 918						&kblamps_led);
 919		if (result == 0) {
 920			fujitsu_hotkey->kblamps_registered = 1;
 921		} else {
 922			pr_err("Could not register LED handler for keyboard lamps, error %i\n",
 923			       result);
 924		}
 925	}
 926#endif
 927
 928	return result;
 929
 930err_unregister_input_dev:
 931	input_unregister_device(input);
 932	input = NULL;
 933err_free_input_dev:
 934	input_free_device(input);
 935err_free_fifo:
 936	kfifo_free(&fujitsu_hotkey->fifo);
 937err_stop:
 938	return result;
 939}
 940
 941static int acpi_fujitsu_hotkey_remove(struct acpi_device *device, int type)
 942{
 943	struct fujitsu_hotkey_t *fujitsu_hotkey = acpi_driver_data(device);
 944	struct input_dev *input = fujitsu_hotkey->input;
 945
 946#if defined(CONFIG_LEDS_CLASS) || defined(CONFIG_LEDS_CLASS_MODULE)
 947	if (fujitsu_hotkey->logolamp_registered)
 948		led_classdev_unregister(&logolamp_led);
 949
 950	if (fujitsu_hotkey->kblamps_registered)
 951		led_classdev_unregister(&kblamps_led);
 952#endif
 953
 954	input_unregister_device(input);
 955
 956	kfifo_free(&fujitsu_hotkey->fifo);
 957
 958	fujitsu_hotkey->acpi_handle = NULL;
 959
 960	return 0;
 961}
 962
 963static void acpi_fujitsu_hotkey_notify(struct acpi_device *device, u32 event)
 964{
 965	struct input_dev *input;
 966	int keycode, keycode_r;
 967	unsigned int irb = 1;
 968	int i, status;
 969
 970	input = fujitsu_hotkey->input;
 971
 972	if (fujitsu_hotkey->rfkill_supported)
 973		fujitsu_hotkey->rfkill_state =
 974			call_fext_func(FUNC_RFKILL, 0x4, 0x0, 0x0);
 975
 976	switch (event) {
 977	case ACPI_FUJITSU_NOTIFY_CODE1:
 978		i = 0;
 979		while ((irb =
 980			call_fext_func(FUNC_BUTTONS, 0x1, 0x0, 0x0)) != 0
 981				&& (i++) < MAX_HOTKEY_RINGBUFFER_SIZE) {
 982			switch (irb & 0x4ff) {
 983			case KEY1_CODE:
 984				keycode = fujitsu->keycode1;
 985				break;
 986			case KEY2_CODE:
 987				keycode = fujitsu->keycode2;
 988				break;
 989			case KEY3_CODE:
 990				keycode = fujitsu->keycode3;
 991				break;
 992			case KEY4_CODE:
 993				keycode = fujitsu->keycode4;
 994				break;
 995			case 0:
 996				keycode = 0;
 997				break;
 998			default:
 999				vdbg_printk(FUJLAPTOP_DBG_WARN,
1000					    "Unknown GIRB result [%x]\n", irb);
1001				keycode = -1;
1002				break;
1003			}
1004			if (keycode > 0) {
1005				vdbg_printk(FUJLAPTOP_DBG_TRACE,
1006					"Push keycode into ringbuffer [%d]\n",
1007					keycode);
1008				status = kfifo_in_locked(&fujitsu_hotkey->fifo,
1009						   (unsigned char *)&keycode,
1010						   sizeof(keycode),
1011						   &fujitsu_hotkey->fifo_lock);
1012				if (status != sizeof(keycode)) {
1013					vdbg_printk(FUJLAPTOP_DBG_WARN,
1014					    "Could not push keycode [0x%x]\n",
1015					    keycode);
1016				} else {
1017					input_report_key(input, keycode, 1);
1018					input_sync(input);
1019				}
1020			} else if (keycode == 0) {
1021				while ((status =
1022					kfifo_out_locked(
1023					 &fujitsu_hotkey->fifo,
1024					 (unsigned char *) &keycode_r,
1025					 sizeof(keycode_r),
1026					 &fujitsu_hotkey->fifo_lock))
1027					 == sizeof(keycode_r)) {
1028					input_report_key(input, keycode_r, 0);
1029					input_sync(input);
1030					vdbg_printk(FUJLAPTOP_DBG_TRACE,
1031					  "Pop keycode from ringbuffer [%d]\n",
1032					  keycode_r);
1033				}
1034			}
1035		}
1036
1037		break;
1038	default:
1039		keycode = KEY_UNKNOWN;
1040		vdbg_printk(FUJLAPTOP_DBG_WARN,
1041			    "Unsupported event [0x%x]\n", event);
1042		input_report_key(input, keycode, 1);
1043		input_sync(input);
1044		input_report_key(input, keycode, 0);
1045		input_sync(input);
1046		break;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1047	}
1048}
1049
1050/* Initialization */
1051
1052static const struct acpi_device_id fujitsu_device_ids[] = {
1053	{ACPI_FUJITSU_HID, 0},
1054	{"", 0},
1055};
1056
1057static struct acpi_driver acpi_fujitsu_driver = {
1058	.name = ACPI_FUJITSU_DRIVER_NAME,
1059	.class = ACPI_FUJITSU_CLASS,
1060	.ids = fujitsu_device_ids,
1061	.ops = {
1062		.add = acpi_fujitsu_add,
1063		.remove = acpi_fujitsu_remove,
1064		.notify = acpi_fujitsu_notify,
1065		},
1066};
1067
1068static const struct acpi_device_id fujitsu_hotkey_device_ids[] = {
1069	{ACPI_FUJITSU_HOTKEY_HID, 0},
1070	{"", 0},
1071};
1072
1073static struct acpi_driver acpi_fujitsu_hotkey_driver = {
1074	.name = ACPI_FUJITSU_HOTKEY_DRIVER_NAME,
1075	.class = ACPI_FUJITSU_CLASS,
1076	.ids = fujitsu_hotkey_device_ids,
1077	.ops = {
1078		.add = acpi_fujitsu_hotkey_add,
1079		.remove = acpi_fujitsu_hotkey_remove,
1080		.notify = acpi_fujitsu_hotkey_notify,
1081		},
1082};
1083
 
 
 
 
 
 
 
1084static int __init fujitsu_init(void)
1085{
1086	int ret, result, max_brightness;
1087
1088	if (acpi_disabled)
1089		return -ENODEV;
1090
1091	fujitsu = kzalloc(sizeof(struct fujitsu_t), GFP_KERNEL);
1092	if (!fujitsu)
1093		return -ENOMEM;
1094	fujitsu->keycode1 = KEY_PROG1;
1095	fujitsu->keycode2 = KEY_PROG2;
1096	fujitsu->keycode3 = KEY_PROG3;
1097	fujitsu->keycode4 = KEY_PROG4;
1098	dmi_check_system(fujitsu_dmi_table);
1099
1100	result = acpi_bus_register_driver(&acpi_fujitsu_driver);
1101	if (result < 0) {
1102		ret = -ENODEV;
1103		goto fail_acpi;
1104	}
1105
1106	/* Register platform stuff */
1107
1108	fujitsu->pf_device = platform_device_alloc("fujitsu-laptop", -1);
1109	if (!fujitsu->pf_device) {
1110		ret = -ENOMEM;
1111		goto fail_platform_driver;
1112	}
1113
1114	ret = platform_device_add(fujitsu->pf_device);
1115	if (ret)
1116		goto fail_platform_device1;
1117
1118	ret =
1119	    sysfs_create_group(&fujitsu->pf_device->dev.kobj,
1120			       &fujitsupf_attribute_group);
1121	if (ret)
1122		goto fail_platform_device2;
1123
1124	/* Register backlight stuff */
1125
1126	if (!acpi_video_backlight_support()) {
1127		struct backlight_properties props;
1128
1129		memset(&props, 0, sizeof(struct backlight_properties));
1130		max_brightness = fujitsu->max_brightness;
1131		props.type = BACKLIGHT_PLATFORM;
1132		props.max_brightness = max_brightness - 1;
1133		fujitsu->bl_device = backlight_device_register("fujitsu-laptop",
1134							       NULL, NULL,
1135							       &fujitsubl_ops,
1136							       &props);
1137		if (IS_ERR(fujitsu->bl_device)) {
1138			ret = PTR_ERR(fujitsu->bl_device);
1139			fujitsu->bl_device = NULL;
1140			goto fail_sysfs_group;
1141		}
1142		fujitsu->bl_device->props.brightness = fujitsu->brightness_level;
1143	}
1144
1145	ret = platform_driver_register(&fujitsupf_driver);
1146	if (ret)
1147		goto fail_backlight;
1148
1149	/* Register hotkey driver */
1150
1151	fujitsu_hotkey = kzalloc(sizeof(struct fujitsu_hotkey_t), GFP_KERNEL);
1152	if (!fujitsu_hotkey) {
1153		ret = -ENOMEM;
1154		goto fail_hotkey;
1155	}
1156
1157	result = acpi_bus_register_driver(&acpi_fujitsu_hotkey_driver);
1158	if (result < 0) {
1159		ret = -ENODEV;
1160		goto fail_hotkey1;
1161	}
1162
1163	/* Sync backlight power status (needs FUJ02E3 device, hence deferred) */
1164
1165	if (!acpi_video_backlight_support()) {
1166		if (call_fext_func(FUNC_BACKLIGHT, 0x2, 0x4, 0x0) == 3)
1167			fujitsu->bl_device->props.power = 4;
1168		else
1169			fujitsu->bl_device->props.power = 0;
1170	}
1171
1172	pr_info("driver " FUJITSU_DRIVER_VERSION " successfully loaded\n");
1173
1174	return 0;
1175
1176fail_hotkey1:
1177	kfree(fujitsu_hotkey);
1178fail_hotkey:
1179	platform_driver_unregister(&fujitsupf_driver);
1180fail_backlight:
1181	if (fujitsu->bl_device)
1182		backlight_device_unregister(fujitsu->bl_device);
1183fail_sysfs_group:
1184	sysfs_remove_group(&fujitsu->pf_device->dev.kobj,
1185			   &fujitsupf_attribute_group);
1186fail_platform_device2:
1187	platform_device_del(fujitsu->pf_device);
1188fail_platform_device1:
1189	platform_device_put(fujitsu->pf_device);
1190fail_platform_driver:
1191	acpi_bus_unregister_driver(&acpi_fujitsu_driver);
1192fail_acpi:
1193	kfree(fujitsu);
1194
1195	return ret;
1196}
1197
1198static void __exit fujitsu_cleanup(void)
1199{
1200	acpi_bus_unregister_driver(&acpi_fujitsu_hotkey_driver);
1201
1202	kfree(fujitsu_hotkey);
1203
1204	platform_driver_unregister(&fujitsupf_driver);
1205
1206	if (fujitsu->bl_device)
1207		backlight_device_unregister(fujitsu->bl_device);
1208
1209	sysfs_remove_group(&fujitsu->pf_device->dev.kobj,
1210			   &fujitsupf_attribute_group);
1211
1212	platform_device_unregister(fujitsu->pf_device);
1213
1214	acpi_bus_unregister_driver(&acpi_fujitsu_driver);
1215
1216	kfree(fujitsu);
1217
1218	pr_info("driver unloaded\n");
1219}
1220
1221module_init(fujitsu_init);
1222module_exit(fujitsu_cleanup);
1223
1224module_param(use_alt_lcd_levels, uint, 0644);
1225MODULE_PARM_DESC(use_alt_lcd_levels,
1226		 "Use alternative interface for lcd_levels (needed for Lifebook s6410).");
1227module_param(disable_brightness_adjust, uint, 0644);
1228MODULE_PARM_DESC(disable_brightness_adjust, "Disable brightness adjustment .");
1229#ifdef CONFIG_FUJITSU_LAPTOP_DEBUG
1230module_param_named(debug, dbg_level, uint, 0644);
1231MODULE_PARM_DESC(debug, "Sets debug level bit-mask");
1232#endif
1233
1234MODULE_AUTHOR("Jonathan Woithe, Peter Gruber, Tony Vroon");
1235MODULE_DESCRIPTION("Fujitsu laptop extras support");
1236MODULE_VERSION(FUJITSU_DRIVER_VERSION);
1237MODULE_LICENSE("GPL");
1238
1239MODULE_ALIAS("dmi:*:svnFUJITSUSIEMENS:*:pvr:rvnFUJITSU:rnFJNB1D3:*:cvrS6410:*");
1240MODULE_ALIAS("dmi:*:svnFUJITSUSIEMENS:*:pvr:rvnFUJITSU:rnFJNB1E6:*:cvrS6420:*");
1241MODULE_ALIAS("dmi:*:svnFUJITSU:*:pvr:rvnFUJITSU:rnFJNB19C:*:cvrS7020:*");
1242
1243static struct pnp_device_id pnp_ids[] __used = {
1244	{.id = "FUJ02bf"},
1245	{.id = "FUJ02B1"},
1246	{.id = "FUJ02E3"},
1247	{.id = ""}
1248};
1249
1250MODULE_DEVICE_TABLE(pnp, pnp_ids);
v4.17
   1/*-*-linux-c-*-*/
   2
   3/*
   4  Copyright (C) 2007,2008 Jonathan Woithe <jwoithe@just42.net>
   5  Copyright (C) 2008 Peter Gruber <nokos@gmx.net>
   6  Copyright (C) 2008 Tony Vroon <tony@linx.net>
   7  Based on earlier work:
   8    Copyright (C) 2003 Shane Spencer <shane@bogomip.com>
   9    Adrian Yee <brewt-fujitsu@brewt.org>
  10
  11  Templated from msi-laptop.c and thinkpad_acpi.c which is copyright
  12  by its respective authors.
  13
  14  This program is free software; you can redistribute it and/or modify
  15  it under the terms of the GNU General Public License as published by
  16  the Free Software Foundation; either version 2 of the License, or
  17  (at your option) any later version.
  18
  19  This program is distributed in the hope that it will be useful, but
  20  WITHOUT ANY WARRANTY; without even the implied warranty of
  21  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  22  General Public License for more details.
  23
  24  You should have received a copy of the GNU General Public License
  25  along with this program; if not, write to the Free Software
  26  Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
  27  02110-1301, USA.
  28 */
  29
  30/*
  31 * fujitsu-laptop.c - Fujitsu laptop support, providing access to additional
  32 * features made available on a range of Fujitsu laptops including the
  33 * P2xxx/P5xxx/S6xxx/S7xxx series.
  34 *
  35 * This driver implements a vendor-specific backlight control interface for
  36 * Fujitsu laptops and provides support for hotkeys present on certain Fujitsu
  37 * laptops.
 
 
 
 
 
 
 
 
 
  38 *
  39 * This driver has been tested on a Fujitsu Lifebook S6410, S7020 and
  40 * P8010.  It should work on most P-series and S-series Lifebooks, but
  41 * YMMV.
  42 *
  43 * The module parameter use_alt_lcd_levels switches between different ACPI
  44 * brightness controls which are used by different Fujitsu laptops.  In most
  45 * cases the correct method is automatically detected. "use_alt_lcd_levels=1"
  46 * is applicable for a Fujitsu Lifebook S6410 if autodetection fails.
  47 *
  48 */
  49
  50#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  51
  52#include <linux/module.h>
  53#include <linux/kernel.h>
  54#include <linux/init.h>
  55#include <linux/acpi.h>
  56#include <linux/bitops.h>
  57#include <linux/dmi.h>
  58#include <linux/backlight.h>
  59#include <linux/fb.h>
  60#include <linux/input.h>
  61#include <linux/input/sparse-keymap.h>
  62#include <linux/kfifo.h>
 
 
 
 
  63#include <linux/leds.h>
  64#include <linux/platform_device.h>
  65#include <acpi/video.h>
 
  66
  67#define FUJITSU_DRIVER_VERSION		"0.6.0"
  68
  69#define FUJITSU_LCD_N_LEVELS		8
 
 
 
 
 
 
  70
  71#define ACPI_FUJITSU_CLASS		"fujitsu"
  72#define ACPI_FUJITSU_BL_HID		"FUJ02B1"
  73#define ACPI_FUJITSU_BL_DRIVER_NAME	"Fujitsu laptop FUJ02B1 ACPI brightness driver"
  74#define ACPI_FUJITSU_BL_DEVICE_NAME	"Fujitsu FUJ02B1"
  75#define ACPI_FUJITSU_LAPTOP_HID		"FUJ02E3"
  76#define ACPI_FUJITSU_LAPTOP_DRIVER_NAME	"Fujitsu laptop FUJ02E3 ACPI hotkeys driver"
  77#define ACPI_FUJITSU_LAPTOP_DEVICE_NAME	"Fujitsu FUJ02E3"
  78
  79#define ACPI_FUJITSU_NOTIFY_CODE	0x80
 
  80
  81/* FUNC interface - command values */
  82#define FUNC_FLAGS			BIT(12)
  83#define FUNC_LEDS			(BIT(12) | BIT(0))
  84#define FUNC_BUTTONS			(BIT(12) | BIT(1))
  85#define FUNC_BACKLIGHT			(BIT(12) | BIT(2))
  86
  87/* FUNC interface - responses */
  88#define UNSUPPORTED_CMD			0x80000000
  89
  90/* FUNC interface - status flags */
  91#define FLAG_RFKILL			BIT(5)
  92#define FLAG_LID			BIT(8)
  93#define FLAG_DOCK			BIT(9)
  94
 
  95/* FUNC interface - LED control */
  96#define FUNC_LED_OFF			BIT(0)
  97#define FUNC_LED_ON			(BIT(0) | BIT(16) | BIT(17))
  98#define LOGOLAMP_POWERON		BIT(13)
  99#define LOGOLAMP_ALWAYS			BIT(14)
 100#define KEYBOARD_LAMPS			BIT(8)
 101#define RADIO_LED_ON			BIT(5)
 102#define ECO_LED				BIT(16)
 103#define ECO_LED_ON			BIT(19)
 104
 105/* FUNC interface - backlight power control */
 106#define BACKLIGHT_PARAM_POWER		BIT(2)
 107#define BACKLIGHT_OFF			(BIT(0) | BIT(1))
 108#define BACKLIGHT_ON			0
 109
 110/* Scancodes read from the GIRB register */
 111#define KEY1_CODE			0x410
 112#define KEY2_CODE			0x411
 113#define KEY3_CODE			0x412
 114#define KEY4_CODE			0x413
 115#define KEY5_CODE			0x420
 116
 117/* Hotkey ringbuffer limits */
 118#define MAX_HOTKEY_RINGBUFFER_SIZE	100
 119#define RINGBUFFERSIZE			40
 120
 121/* Module parameters */
 122static int use_alt_lcd_levels = -1;
 123static bool disable_brightness_adjust;
 
 
 
 
 
 
 
 
 
 
 
 124
 125/* Device controlling the backlight and associated keys */
 126struct fujitsu_bl {
 
 
 127	struct input_dev *input;
 128	char phys[32];
 129	struct backlight_device *bl_device;
 
 
 
 130	unsigned int max_brightness;
 
 131	unsigned int brightness_level;
 132};
 133
 134static struct fujitsu_bl *fujitsu_bl;
 
 
 135
 136/* Device used to access hotkeys and other features on the laptop */
 137struct fujitsu_laptop {
 
 
 138	struct input_dev *input;
 139	char phys[32];
 140	struct platform_device *pf_device;
 141	struct kfifo fifo;
 142	spinlock_t fifo_lock;
 143	int flags_supported;
 144	int flags_state;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 145};
 146
 147static struct acpi_device *fext;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 148
 149/* Fujitsu ACPI interface function */
 150
 151static int call_fext_func(struct acpi_device *device,
 152			  int func, int op, int feature, int state)
 153{
 
 154	union acpi_object params[4] = {
 155		{ .integer.type = ACPI_TYPE_INTEGER, .integer.value = func },
 156		{ .integer.type = ACPI_TYPE_INTEGER, .integer.value = op },
 157		{ .integer.type = ACPI_TYPE_INTEGER, .integer.value = feature },
 158		{ .integer.type = ACPI_TYPE_INTEGER, .integer.value = state }
 159	};
 160	struct acpi_object_list arg_list = { 4, params };
 161	unsigned long long value;
 162	acpi_status status;
 
 
 
 
 
 
 
 
 
 
 
 
 
 163
 164	status = acpi_evaluate_integer(device->handle, "FUNC", &arg_list,
 165				       &value);
 
 
 166	if (ACPI_FAILURE(status)) {
 167		acpi_handle_err(device->handle, "Failed to evaluate FUNC\n");
 
 
 168		return -ENODEV;
 169	}
 170
 171	acpi_handle_debug(device->handle,
 172			  "FUNC 0x%x (args 0x%x, 0x%x, 0x%x) returned 0x%x\n",
 173			  func, op, feature, state, (int)value);
 174	return value;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 175}
 
 176
 177/* Hardware access for LCD brightness control */
 178
 179static int set_lcd_level(struct acpi_device *device, int level)
 180{
 181	struct fujitsu_bl *priv = acpi_driver_data(device);
 182	acpi_status status;
 183	char *method;
 184
 185	switch (use_alt_lcd_levels) {
 186	case -1:
 187		if (acpi_has_method(device->handle, "SBL2"))
 188			method = "SBL2";
 189		else
 190			method = "SBLL";
 191		break;
 192	case 1:
 193		method = "SBL2";
 194		break;
 195	default:
 196		method = "SBLL";
 197		break;
 198	}
 199
 200	acpi_handle_debug(device->handle, "set lcd level via %s [%d]\n", method,
 201			  level);
 
 
 
 
 
 
 202
 203	if (level < 0 || level >= priv->max_brightness)
 
 
 
 
 
 
 
 
 
 
 204		return -EINVAL;
 205
 206	status = acpi_execute_simple_method(device->handle, method, level);
 207	if (ACPI_FAILURE(status)) {
 208		acpi_handle_err(device->handle, "Failed to evaluate %s\n",
 209				method);
 210		return -ENODEV;
 211	}
 212
 213	priv->brightness_level = level;
 
 
 
 
 214
 215	return 0;
 216}
 217
 218static int get_lcd_level(struct acpi_device *device)
 219{
 220	struct fujitsu_bl *priv = acpi_driver_data(device);
 221	unsigned long long state = 0;
 222	acpi_status status = AE_OK;
 223
 224	acpi_handle_debug(device->handle, "get lcd level via GBLL\n");
 225
 226	status = acpi_evaluate_integer(device->handle, "GBLL", NULL, &state);
 
 227	if (ACPI_FAILURE(status))
 228		return 0;
 229
 230	priv->brightness_level = state & 0x0fffffff;
 231
 232	return priv->brightness_level;
 
 
 
 
 
 233}
 234
 235static int get_max_brightness(struct acpi_device *device)
 236{
 237	struct fujitsu_bl *priv = acpi_driver_data(device);
 238	unsigned long long state = 0;
 239	acpi_status status = AE_OK;
 240
 241	acpi_handle_debug(device->handle, "get max lcd level via RBLL\n");
 242
 243	status = acpi_evaluate_integer(device->handle, "RBLL", NULL, &state);
 
 244	if (ACPI_FAILURE(status))
 245		return -1;
 246
 247	priv->max_brightness = state;
 248
 249	return priv->max_brightness;
 250}
 251
 252/* Backlight device stuff */
 253
 254static int bl_get_brightness(struct backlight_device *b)
 255{
 256	struct acpi_device *device = bl_get_data(b);
 257
 258	return b->props.power == FB_BLANK_POWERDOWN ? 0 : get_lcd_level(device);
 259}
 260
 261static int bl_update_status(struct backlight_device *b)
 262{
 263	struct acpi_device *device = bl_get_data(b);
 
 
 
 
 
 
 
 
 264
 265	if (fext) {
 266		if (b->props.power == FB_BLANK_POWERDOWN)
 267			call_fext_func(fext, FUNC_BACKLIGHT, 0x1,
 268				       BACKLIGHT_PARAM_POWER, BACKLIGHT_OFF);
 269		else
 270			call_fext_func(fext, FUNC_BACKLIGHT, 0x1,
 271				       BACKLIGHT_PARAM_POWER, BACKLIGHT_ON);
 272	}
 273
 274	return set_lcd_level(device, b->props.brightness);
 275}
 276
 277static const struct backlight_ops fujitsu_bl_ops = {
 278	.get_brightness = bl_get_brightness,
 279	.update_status = bl_update_status,
 280};
 281
 282static ssize_t lid_show(struct device *dev, struct device_attribute *attr,
 283			char *buf)
 
 
 
 284{
 285	struct fujitsu_laptop *priv = dev_get_drvdata(dev);
 286
 287	if (!(priv->flags_supported & FLAG_LID))
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 288		return sprintf(buf, "unknown\n");
 289	if (priv->flags_state & FLAG_LID)
 290		return sprintf(buf, "open\n");
 291	else
 292		return sprintf(buf, "closed\n");
 293}
 294
 295static ssize_t dock_show(struct device *dev, struct device_attribute *attr,
 296			 char *buf)
 
 297{
 298	struct fujitsu_laptop *priv = dev_get_drvdata(dev);
 299
 300	if (!(priv->flags_supported & FLAG_DOCK))
 301		return sprintf(buf, "unknown\n");
 302	if (priv->flags_state & FLAG_DOCK)
 303		return sprintf(buf, "docked\n");
 304	else
 305		return sprintf(buf, "undocked\n");
 306}
 307
 308static ssize_t radios_show(struct device *dev, struct device_attribute *attr,
 309			   char *buf)
 
 310{
 311	struct fujitsu_laptop *priv = dev_get_drvdata(dev);
 312
 313	if (!(priv->flags_supported & FLAG_RFKILL))
 314		return sprintf(buf, "unknown\n");
 315	if (priv->flags_state & FLAG_RFKILL)
 316		return sprintf(buf, "on\n");
 317	else
 318		return sprintf(buf, "killed\n");
 319}
 320
 321static DEVICE_ATTR_RO(lid);
 322static DEVICE_ATTR_RO(dock);
 323static DEVICE_ATTR_RO(radios);
 324
 325static struct attribute *fujitsu_pf_attributes[] = {
 
 
 
 
 
 
 
 326	&dev_attr_lid.attr,
 327	&dev_attr_dock.attr,
 328	&dev_attr_radios.attr,
 329	NULL
 330};
 331
 332static const struct attribute_group fujitsu_pf_attribute_group = {
 333	.attrs = fujitsu_pf_attributes
 334};
 335
 336static struct platform_driver fujitsu_pf_driver = {
 337	.driver = {
 338		   .name = "fujitsu-laptop",
 
 339		   }
 340};
 341
 342/* ACPI device for LCD brightness control */
 343
 344static const struct key_entry keymap_backlight[] = {
 345	{ KE_KEY, true, { KEY_BRIGHTNESSUP } },
 346	{ KE_KEY, false, { KEY_BRIGHTNESSDOWN } },
 347	{ KE_END, 0 }
 348};
 349
 350static int acpi_fujitsu_bl_input_setup(struct acpi_device *device)
 351{
 352	struct fujitsu_bl *priv = acpi_driver_data(device);
 353	int ret;
 354
 355	priv->input = devm_input_allocate_device(&device->dev);
 356	if (!priv->input)
 357		return -ENOMEM;
 358
 359	snprintf(priv->phys, sizeof(priv->phys), "%s/video/input0",
 360		 acpi_device_hid(device));
 361
 362	priv->input->name = acpi_device_name(device);
 363	priv->input->phys = priv->phys;
 364	priv->input->id.bustype = BUS_HOST;
 365	priv->input->id.product = 0x06;
 366
 367	ret = sparse_keymap_setup(priv->input, keymap_backlight, NULL);
 368	if (ret)
 369		return ret;
 370
 371	return input_register_device(priv->input);
 372}
 373
 374static int fujitsu_backlight_register(struct acpi_device *device)
 375{
 376	struct fujitsu_bl *priv = acpi_driver_data(device);
 377	const struct backlight_properties props = {
 378		.brightness = priv->brightness_level,
 379		.max_brightness = priv->max_brightness - 1,
 380		.type = BACKLIGHT_PLATFORM
 381	};
 382	struct backlight_device *bd;
 383
 384	bd = devm_backlight_device_register(&device->dev, "fujitsu-laptop",
 385					    &device->dev, device,
 386					    &fujitsu_bl_ops, &props);
 387	if (IS_ERR(bd))
 388		return PTR_ERR(bd);
 389
 390	priv->bl_device = bd;
 391
 392	return 0;
 393}
 394
 395static int acpi_fujitsu_bl_add(struct acpi_device *device)
 396{
 397	struct fujitsu_bl *priv;
 398	int ret;
 399
 400	if (acpi_video_get_backlight_type() != acpi_backlight_vendor)
 401		return -ENODEV;
 402
 403	priv = devm_kzalloc(&device->dev, sizeof(*priv), GFP_KERNEL);
 404	if (!priv)
 405		return -ENOMEM;
 406
 407	fujitsu_bl = priv;
 408	strcpy(acpi_device_name(device), ACPI_FUJITSU_BL_DEVICE_NAME);
 409	strcpy(acpi_device_class(device), ACPI_FUJITSU_CLASS);
 410	device->driver_data = priv;
 411
 412	pr_info("ACPI: %s [%s]\n",
 413		acpi_device_name(device), acpi_device_bid(device));
 414
 415	if (get_max_brightness(device) <= 0)
 416		priv->max_brightness = FUJITSU_LCD_N_LEVELS;
 417	get_lcd_level(device);
 418
 419	ret = acpi_fujitsu_bl_input_setup(device);
 420	if (ret)
 421		return ret;
 422
 423	return fujitsu_backlight_register(device);
 424}
 425
 426/* Brightness notify */
 427
 428static void acpi_fujitsu_bl_notify(struct acpi_device *device, u32 event)
 429{
 430	struct fujitsu_bl *priv = acpi_driver_data(device);
 431	int oldb, newb;
 432
 433	if (event != ACPI_FUJITSU_NOTIFY_CODE) {
 434		acpi_handle_info(device->handle, "unsupported event [0x%x]\n",
 435				 event);
 436		sparse_keymap_report_event(priv->input, -1, 1, true);
 437		return;
 438	}
 439
 440	oldb = priv->brightness_level;
 441	get_lcd_level(device);
 442	newb = priv->brightness_level;
 443
 444	acpi_handle_debug(device->handle,
 445			  "brightness button event [%i -> %i]\n", oldb, newb);
 446
 447	if (oldb == newb)
 448		return;
 449
 450	if (!disable_brightness_adjust)
 451		set_lcd_level(device, newb);
 452
 453	sparse_keymap_report_event(priv->input, oldb < newb, 1, true);
 454}
 455
 456/* ACPI device for hotkey handling */
 457
 458static const struct key_entry keymap_default[] = {
 459	{ KE_KEY, KEY1_CODE, { KEY_PROG1 } },
 460	{ KE_KEY, KEY2_CODE, { KEY_PROG2 } },
 461	{ KE_KEY, KEY3_CODE, { KEY_PROG3 } },
 462	{ KE_KEY, KEY4_CODE, { KEY_PROG4 } },
 463	{ KE_KEY, KEY5_CODE, { KEY_RFKILL } },
 464	{ KE_KEY, BIT(5),    { KEY_RFKILL } },
 465	{ KE_KEY, BIT(26),   { KEY_TOUCHPAD_TOGGLE } },
 466	{ KE_KEY, BIT(29),   { KEY_MICMUTE } },
 467	{ KE_END, 0 }
 468};
 469
 470static const struct key_entry keymap_s64x0[] = {
 471	{ KE_KEY, KEY1_CODE, { KEY_SCREENLOCK } },	/* "Lock" */
 472	{ KE_KEY, KEY2_CODE, { KEY_HELP } },		/* "Mobility Center */
 473	{ KE_KEY, KEY3_CODE, { KEY_PROG3 } },
 474	{ KE_KEY, KEY4_CODE, { KEY_PROG4 } },
 475	{ KE_END, 0 }
 476};
 477
 478static const struct key_entry keymap_p8010[] = {
 479	{ KE_KEY, KEY1_CODE, { KEY_HELP } },		/* "Support" */
 480	{ KE_KEY, KEY2_CODE, { KEY_PROG2 } },
 481	{ KE_KEY, KEY3_CODE, { KEY_SWITCHVIDEOMODE } },	/* "Presentation" */
 482	{ KE_KEY, KEY4_CODE, { KEY_WWW } },		/* "WWW" */
 483	{ KE_END, 0 }
 484};
 485
 486static const struct key_entry *keymap = keymap_default;
 487
 488static int fujitsu_laptop_dmi_keymap_override(const struct dmi_system_id *id)
 489{
 490	pr_info("Identified laptop model '%s'\n", id->ident);
 491	keymap = id->driver_data;
 492	return 1;
 493}
 494
 495static const struct dmi_system_id fujitsu_laptop_dmi_table[] = {
 496	{
 497		.callback = fujitsu_laptop_dmi_keymap_override,
 498		.ident = "Fujitsu Siemens S6410",
 499		.matches = {
 500			DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"),
 501			DMI_MATCH(DMI_PRODUCT_NAME, "LIFEBOOK S6410"),
 502		},
 503		.driver_data = (void *)keymap_s64x0
 504	},
 505	{
 506		.callback = fujitsu_laptop_dmi_keymap_override,
 507		.ident = "Fujitsu Siemens S6420",
 508		.matches = {
 509			DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU SIEMENS"),
 510			DMI_MATCH(DMI_PRODUCT_NAME, "LIFEBOOK S6420"),
 511		},
 512		.driver_data = (void *)keymap_s64x0
 513	},
 514	{
 515		.callback = fujitsu_laptop_dmi_keymap_override,
 516		.ident = "Fujitsu LifeBook P8010",
 517		.matches = {
 518			DMI_MATCH(DMI_SYS_VENDOR, "FUJITSU"),
 519			DMI_MATCH(DMI_PRODUCT_NAME, "LifeBook P8010"),
 520		},
 521		.driver_data = (void *)keymap_p8010
 522	},
 523	{}
 524};
 525
 526static int acpi_fujitsu_laptop_input_setup(struct acpi_device *device)
 527{
 528	struct fujitsu_laptop *priv = acpi_driver_data(device);
 529	int ret;
 530
 531	priv->input = devm_input_allocate_device(&device->dev);
 532	if (!priv->input)
 533		return -ENOMEM;
 534
 535	snprintf(priv->phys, sizeof(priv->phys), "%s/input0",
 536		 acpi_device_hid(device));
 537
 538	priv->input->name = acpi_device_name(device);
 539	priv->input->phys = priv->phys;
 540	priv->input->id.bustype = BUS_HOST;
 541
 542	dmi_check_system(fujitsu_laptop_dmi_table);
 543	ret = sparse_keymap_setup(priv->input, keymap, NULL);
 544	if (ret)
 545		return ret;
 546
 547	return input_register_device(priv->input);
 548}
 549
 550static int fujitsu_laptop_platform_add(struct acpi_device *device)
 551{
 552	struct fujitsu_laptop *priv = acpi_driver_data(device);
 553	int ret;
 
 
 
 554
 555	priv->pf_device = platform_device_alloc("fujitsu-laptop", -1);
 556	if (!priv->pf_device)
 557		return -ENOMEM;
 558
 559	platform_set_drvdata(priv->pf_device, priv);
 
 
 
 
 
 
 
 
 
 560
 561	ret = platform_device_add(priv->pf_device);
 562	if (ret)
 563		goto err_put_platform_device;
 564
 565	ret = sysfs_create_group(&priv->pf_device->dev.kobj,
 566				 &fujitsu_pf_attribute_group);
 567	if (ret)
 568		goto err_del_platform_device;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 569
 570	return 0;
 
 
 
 
 
 
 
 
 
 
 
 
 
 571
 572err_del_platform_device:
 573	platform_device_del(priv->pf_device);
 574err_put_platform_device:
 575	platform_device_put(priv->pf_device);
 
 
 576
 577	return ret;
 578}
 
 579
 580static void fujitsu_laptop_platform_remove(struct acpi_device *device)
 581{
 582	struct fujitsu_laptop *priv = acpi_driver_data(device);
 583
 584	sysfs_remove_group(&priv->pf_device->dev.kobj,
 585			   &fujitsu_pf_attribute_group);
 586	platform_device_unregister(priv->pf_device);
 
 
 
 
 587}
 588
 589static int logolamp_set(struct led_classdev *cdev,
 590			enum led_brightness brightness)
 591{
 592	struct acpi_device *device = to_acpi_device(cdev->dev->parent);
 593	int poweron = FUNC_LED_ON, always = FUNC_LED_ON;
 594	int ret;
 595
 596	if (brightness < LED_HALF)
 597		poweron = FUNC_LED_OFF;
 598
 599	if (brightness < LED_FULL)
 600		always = FUNC_LED_OFF;
 601
 602	ret = call_fext_func(device, FUNC_LEDS, 0x1, LOGOLAMP_POWERON, poweron);
 603	if (ret < 0)
 604		return ret;
 605
 606	return call_fext_func(device, FUNC_LEDS, 0x1, LOGOLAMP_ALWAYS, always);
 607}
 608
 609static enum led_brightness logolamp_get(struct led_classdev *cdev)
 610{
 611	struct acpi_device *device = to_acpi_device(cdev->dev->parent);
 612	int ret;
 613
 614	ret = call_fext_func(device, FUNC_LEDS, 0x2, LOGOLAMP_ALWAYS, 0x0);
 615	if (ret == FUNC_LED_ON)
 616		return LED_FULL;
 617
 618	ret = call_fext_func(device, FUNC_LEDS, 0x2, LOGOLAMP_POWERON, 0x0);
 619	if (ret == FUNC_LED_ON)
 620		return LED_HALF;
 621
 622	return LED_OFF;
 623}
 624
 625static int kblamps_set(struct led_classdev *cdev,
 626		       enum led_brightness brightness)
 627{
 628	struct acpi_device *device = to_acpi_device(cdev->dev->parent);
 
 
 629
 630	if (brightness >= LED_FULL)
 631		return call_fext_func(device, FUNC_LEDS, 0x1, KEYBOARD_LAMPS,
 632				      FUNC_LED_ON);
 633	else
 634		return call_fext_func(device, FUNC_LEDS, 0x1, KEYBOARD_LAMPS,
 635				      FUNC_LED_OFF);
 636}
 637
 638static enum led_brightness kblamps_get(struct led_classdev *cdev)
 639{
 640	struct acpi_device *device = to_acpi_device(cdev->dev->parent);
 641	enum led_brightness brightness = LED_OFF;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 642
 643	if (call_fext_func(device,
 644			   FUNC_LEDS, 0x2, KEYBOARD_LAMPS, 0x0) == FUNC_LED_ON)
 645		brightness = LED_FULL;
 646
 647	return brightness;
 
 648}
 649
 650static int radio_led_set(struct led_classdev *cdev,
 651			 enum led_brightness brightness)
 652{
 653	struct acpi_device *device = to_acpi_device(cdev->dev->parent);
 654
 655	if (brightness >= LED_FULL)
 656		return call_fext_func(device, FUNC_FLAGS, 0x5, RADIO_LED_ON,
 657				      RADIO_LED_ON);
 658	else
 659		return call_fext_func(device, FUNC_FLAGS, 0x5, RADIO_LED_ON,
 660				      0x0);
 661}
 662
 663static enum led_brightness radio_led_get(struct led_classdev *cdev)
 664{
 665	struct acpi_device *device = to_acpi_device(cdev->dev->parent);
 666	enum led_brightness brightness = LED_OFF;
 
 
 
 
 667
 668	if (call_fext_func(device, FUNC_FLAGS, 0x4, 0x0, 0x0) & RADIO_LED_ON)
 669		brightness = LED_FULL;
 670
 671	return brightness;
 672}
 
 
 
 673
 674static int eco_led_set(struct led_classdev *cdev,
 675		       enum led_brightness brightness)
 676{
 677	struct acpi_device *device = to_acpi_device(cdev->dev->parent);
 678	int curr;
 
 
 
 679
 680	curr = call_fext_func(device, FUNC_LEDS, 0x2, ECO_LED, 0x0);
 681	if (brightness >= LED_FULL)
 682		return call_fext_func(device, FUNC_LEDS, 0x1, ECO_LED,
 683				      curr | ECO_LED_ON);
 684	else
 685		return call_fext_func(device, FUNC_LEDS, 0x1, ECO_LED,
 686				      curr & ~ECO_LED_ON);
 687}
 688
 689static enum led_brightness eco_led_get(struct led_classdev *cdev)
 690{
 691	struct acpi_device *device = to_acpi_device(cdev->dev->parent);
 692	enum led_brightness brightness = LED_OFF;
 693
 694	if (call_fext_func(device, FUNC_LEDS, 0x2, ECO_LED, 0x0) & ECO_LED_ON)
 695		brightness = LED_FULL;
 696
 697	return brightness;
 698}
 699
 700static int acpi_fujitsu_laptop_leds_register(struct acpi_device *device)
 701{
 702	struct fujitsu_laptop *priv = acpi_driver_data(device);
 703	struct led_classdev *led;
 704	int ret;
 
 
 
 
 
 
 
 
 
 
 
 705
 706	if (call_fext_func(device,
 707			   FUNC_LEDS, 0x0, 0x0, 0x0) & LOGOLAMP_POWERON) {
 708		led = devm_kzalloc(&device->dev, sizeof(*led), GFP_KERNEL);
 709		if (!led)
 710			return -ENOMEM;
 711
 712		led->name = "fujitsu::logolamp";
 713		led->brightness_set_blocking = logolamp_set;
 714		led->brightness_get = logolamp_get;
 715		ret = devm_led_classdev_register(&device->dev, led);
 716		if (ret)
 717			return ret;
 718	}
 719
 720	if ((call_fext_func(device,
 721			    FUNC_LEDS, 0x0, 0x0, 0x0) & KEYBOARD_LAMPS) &&
 722	    (call_fext_func(device, FUNC_BUTTONS, 0x0, 0x0, 0x0) == 0x0)) {
 723		led = devm_kzalloc(&device->dev, sizeof(*led), GFP_KERNEL);
 724		if (!led)
 725			return -ENOMEM;
 726
 727		led->name = "fujitsu::kblamps";
 728		led->brightness_set_blocking = kblamps_set;
 729		led->brightness_get = kblamps_get;
 730		ret = devm_led_classdev_register(&device->dev, led);
 731		if (ret)
 732			return ret;
 733	}
 734
 735	/*
 736	 * Some Fujitsu laptops have a radio toggle button in place of a slide
 737	 * switch and all such machines appear to also have an RF LED.  Based on
 738	 * comparing DSDT tables of four Fujitsu Lifebook models (E744, E751,
 739	 * S7110, S8420; the first one has a radio toggle button, the other
 740	 * three have slide switches), bit 17 of flags_supported (the value
 741	 * returned by method S000 of ACPI device FUJ02E3) seems to indicate
 742	 * whether given model has a radio toggle button.
 743	 */
 744	if (priv->flags_supported & BIT(17)) {
 745		led = devm_kzalloc(&device->dev, sizeof(*led), GFP_KERNEL);
 746		if (!led)
 747			return -ENOMEM;
 748
 749		led->name = "fujitsu::radio_led";
 750		led->brightness_set_blocking = radio_led_set;
 751		led->brightness_get = radio_led_get;
 752		led->default_trigger = "rfkill-any";
 753		ret = devm_led_classdev_register(&device->dev, led);
 754		if (ret)
 755			return ret;
 756	}
 757
 758	/* Support for eco led is not always signaled in bit corresponding
 759	 * to the bit used to control the led. According to the DSDT table,
 760	 * bit 14 seems to indicate presence of said led as well.
 761	 * Confirm by testing the status.
 762	 */
 763	if ((call_fext_func(device, FUNC_LEDS, 0x0, 0x0, 0x0) & BIT(14)) &&
 764	    (call_fext_func(device,
 765			    FUNC_LEDS, 0x2, ECO_LED, 0x0) != UNSUPPORTED_CMD)) {
 766		led = devm_kzalloc(&device->dev, sizeof(*led), GFP_KERNEL);
 767		if (!led)
 768			return -ENOMEM;
 769
 770		led->name = "fujitsu::eco_led";
 771		led->brightness_set_blocking = eco_led_set;
 772		led->brightness_get = eco_led_get;
 773		ret = devm_led_classdev_register(&device->dev, led);
 774		if (ret)
 775			return ret;
 776	}
 777
 778	return 0;
 779}
 780
 781static int acpi_fujitsu_laptop_add(struct acpi_device *device)
 782{
 783	struct fujitsu_laptop *priv;
 784	int ret, i = 0;
 785
 786	priv = devm_kzalloc(&device->dev, sizeof(*priv), GFP_KERNEL);
 787	if (!priv)
 788		return -ENOMEM;
 789
 790	WARN_ONCE(fext, "More than one FUJ02E3 ACPI device was found.  Driver may not work as intended.");
 791	fext = device;
 792
 793	strcpy(acpi_device_name(device), ACPI_FUJITSU_LAPTOP_DEVICE_NAME);
 794	strcpy(acpi_device_class(device), ACPI_FUJITSU_CLASS);
 795	device->driver_data = priv;
 796
 797	/* kfifo */
 798	spin_lock_init(&priv->fifo_lock);
 799	ret = kfifo_alloc(&priv->fifo, RINGBUFFERSIZE * sizeof(int),
 800			  GFP_KERNEL);
 801	if (ret)
 802		return ret;
 803
 804	pr_info("ACPI: %s [%s]\n",
 805		acpi_device_name(device), acpi_device_bid(device));
 806
 807	while (call_fext_func(device, FUNC_BUTTONS, 0x1, 0x0, 0x0) != 0 &&
 808	       i++ < MAX_HOTKEY_RINGBUFFER_SIZE)
 809		; /* No action, result is discarded */
 810	acpi_handle_debug(device->handle, "Discarded %i ringbuffer entries\n",
 811			  i);
 812
 813	priv->flags_supported = call_fext_func(device, FUNC_FLAGS, 0x0, 0x0,
 814					       0x0);
 815
 816	/* Make sure our bitmask of supported functions is cleared if the
 817	   RFKILL function block is not implemented, like on the S7020. */
 818	if (priv->flags_supported == UNSUPPORTED_CMD)
 819		priv->flags_supported = 0;
 820
 821	if (priv->flags_supported)
 822		priv->flags_state = call_fext_func(device, FUNC_FLAGS, 0x4, 0x0,
 823						   0x0);
 824
 825	/* Suspect this is a keymap of the application panel, print it */
 826	acpi_handle_info(device->handle, "BTNI: [0x%x]\n",
 827			 call_fext_func(device, FUNC_BUTTONS, 0x0, 0x0, 0x0));
 828
 829	/* Sync backlight power status */
 830	if (fujitsu_bl && fujitsu_bl->bl_device &&
 831	    acpi_video_get_backlight_type() == acpi_backlight_vendor) {
 832		if (call_fext_func(fext, FUNC_BACKLIGHT, 0x2,
 833				   BACKLIGHT_PARAM_POWER, 0x0) == BACKLIGHT_OFF)
 834			fujitsu_bl->bl_device->props.power = FB_BLANK_POWERDOWN;
 835		else
 836			fujitsu_bl->bl_device->props.power = FB_BLANK_UNBLANK;
 
 
 837	}
 838
 839	ret = acpi_fujitsu_laptop_input_setup(device);
 840	if (ret)
 841		goto err_free_fifo;
 842
 843	ret = acpi_fujitsu_laptop_leds_register(device);
 844	if (ret)
 845		goto err_free_fifo;
 846
 847	ret = fujitsu_laptop_platform_add(device);
 848	if (ret)
 849		goto err_free_fifo;
 
 850
 851	return 0;
 852
 
 
 
 
 
 853err_free_fifo:
 854	kfifo_free(&priv->fifo);
 855
 856	return ret;
 857}
 858
 859static int acpi_fujitsu_laptop_remove(struct acpi_device *device)
 860{
 861	struct fujitsu_laptop *priv = acpi_driver_data(device);
 
 
 
 
 
 
 
 
 
 862
 863	fujitsu_laptop_platform_remove(device);
 864
 865	kfifo_free(&priv->fifo);
 
 
 866
 867	return 0;
 868}
 869
 870static void acpi_fujitsu_laptop_press(struct acpi_device *device, int scancode)
 871{
 872	struct fujitsu_laptop *priv = acpi_driver_data(device);
 873	int ret;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 874
 875	ret = kfifo_in_locked(&priv->fifo, (unsigned char *)&scancode,
 876			      sizeof(scancode), &priv->fifo_lock);
 877	if (ret != sizeof(scancode)) {
 878		dev_info(&priv->input->dev, "Could not push scancode [0x%x]\n",
 879			 scancode);
 880		return;
 881	}
 882	sparse_keymap_report_event(priv->input, scancode, 1, false);
 883	dev_dbg(&priv->input->dev, "Push scancode into ringbuffer [0x%x]\n",
 884		scancode);
 885}
 886
 887static void acpi_fujitsu_laptop_release(struct acpi_device *device)
 888{
 889	struct fujitsu_laptop *priv = acpi_driver_data(device);
 890	int scancode, ret;
 891
 892	while (true) {
 893		ret = kfifo_out_locked(&priv->fifo, (unsigned char *)&scancode,
 894				       sizeof(scancode), &priv->fifo_lock);
 895		if (ret != sizeof(scancode))
 896			return;
 897		sparse_keymap_report_event(priv->input, scancode, 0, false);
 898		dev_dbg(&priv->input->dev,
 899			"Pop scancode from ringbuffer [0x%x]\n", scancode);
 900	}
 901}
 902
 903static void acpi_fujitsu_laptop_notify(struct acpi_device *device, u32 event)
 904{
 905	struct fujitsu_laptop *priv = acpi_driver_data(device);
 906	int scancode, i = 0, ret;
 907	unsigned int irb;
 908
 909	if (event != ACPI_FUJITSU_NOTIFY_CODE) {
 910		acpi_handle_info(device->handle, "Unsupported event [0x%x]\n",
 911				 event);
 912		sparse_keymap_report_event(priv->input, -1, 1, true);
 913		return;
 914	}
 915
 916	if (priv->flags_supported)
 917		priv->flags_state = call_fext_func(device, FUNC_FLAGS, 0x4, 0x0,
 918						   0x0);
 919
 920	while ((irb = call_fext_func(device,
 921				     FUNC_BUTTONS, 0x1, 0x0, 0x0)) != 0 &&
 922	       i++ < MAX_HOTKEY_RINGBUFFER_SIZE) {
 923		scancode = irb & 0x4ff;
 924		if (sparse_keymap_entry_from_scancode(priv->input, scancode))
 925			acpi_fujitsu_laptop_press(device, scancode);
 926		else if (scancode == 0)
 927			acpi_fujitsu_laptop_release(device);
 928		else
 929			acpi_handle_info(device->handle,
 930					 "Unknown GIRB result [%x]\n", irb);
 931	}
 932
 933	/* On some models (first seen on the Skylake-based Lifebook
 934	 * E736/E746/E756), the touchpad toggle hotkey (Fn+F4) is
 935	 * handled in software; its state is queried using FUNC_FLAGS
 936	 */
 937	if (priv->flags_supported & (BIT(5) | BIT(26) | BIT(29))) {
 938		ret = call_fext_func(device, FUNC_FLAGS, 0x1, 0x0, 0x0);
 939		if (ret & BIT(5))
 940			sparse_keymap_report_event(priv->input,
 941						   BIT(5), 1, true);
 942		if (ret & BIT(26))
 943			sparse_keymap_report_event(priv->input,
 944						   BIT(26), 1, true);
 945		if (ret & BIT(29))
 946			sparse_keymap_report_event(priv->input,
 947						   BIT(29), 1, true);
 948	}
 949}
 950
 951/* Initialization */
 952
 953static const struct acpi_device_id fujitsu_bl_device_ids[] = {
 954	{ACPI_FUJITSU_BL_HID, 0},
 955	{"", 0},
 956};
 957
 958static struct acpi_driver acpi_fujitsu_bl_driver = {
 959	.name = ACPI_FUJITSU_BL_DRIVER_NAME,
 960	.class = ACPI_FUJITSU_CLASS,
 961	.ids = fujitsu_bl_device_ids,
 962	.ops = {
 963		.add = acpi_fujitsu_bl_add,
 964		.notify = acpi_fujitsu_bl_notify,
 
 965		},
 966};
 967
 968static const struct acpi_device_id fujitsu_laptop_device_ids[] = {
 969	{ACPI_FUJITSU_LAPTOP_HID, 0},
 970	{"", 0},
 971};
 972
 973static struct acpi_driver acpi_fujitsu_laptop_driver = {
 974	.name = ACPI_FUJITSU_LAPTOP_DRIVER_NAME,
 975	.class = ACPI_FUJITSU_CLASS,
 976	.ids = fujitsu_laptop_device_ids,
 977	.ops = {
 978		.add = acpi_fujitsu_laptop_add,
 979		.remove = acpi_fujitsu_laptop_remove,
 980		.notify = acpi_fujitsu_laptop_notify,
 981		},
 982};
 983
 984static const struct acpi_device_id fujitsu_ids[] __used = {
 985	{ACPI_FUJITSU_BL_HID, 0},
 986	{ACPI_FUJITSU_LAPTOP_HID, 0},
 987	{"", 0}
 988};
 989MODULE_DEVICE_TABLE(acpi, fujitsu_ids);
 990
 991static int __init fujitsu_init(void)
 992{
 993	int ret;
 
 
 
 994
 995	ret = acpi_bus_register_driver(&acpi_fujitsu_bl_driver);
 996	if (ret)
 997		return ret;
 
 
 
 
 
 
 
 
 
 
 
 998
 999	/* Register platform stuff */
1000
1001	ret = platform_driver_register(&fujitsu_pf_driver);
 
 
 
 
 
 
1002	if (ret)
1003		goto err_unregister_acpi;
1004
1005	/* Register laptop driver */
 
 
 
 
1006
1007	ret = acpi_bus_register_driver(&acpi_fujitsu_laptop_driver);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1008	if (ret)
1009		goto err_unregister_platform_driver;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1010
1011	pr_info("driver " FUJITSU_DRIVER_VERSION " successfully loaded\n");
1012
1013	return 0;
1014
1015err_unregister_platform_driver:
1016	platform_driver_unregister(&fujitsu_pf_driver);
1017err_unregister_acpi:
1018	acpi_bus_unregister_driver(&acpi_fujitsu_bl_driver);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1019
1020	return ret;
1021}
1022
1023static void __exit fujitsu_cleanup(void)
1024{
1025	acpi_bus_unregister_driver(&acpi_fujitsu_laptop_driver);
 
 
 
 
 
 
 
1026
1027	platform_driver_unregister(&fujitsu_pf_driver);
 
1028
1029	acpi_bus_unregister_driver(&acpi_fujitsu_bl_driver);
 
 
 
 
1030
1031	pr_info("driver unloaded\n");
1032}
1033
1034module_init(fujitsu_init);
1035module_exit(fujitsu_cleanup);
1036
1037module_param(use_alt_lcd_levels, int, 0644);
1038MODULE_PARM_DESC(use_alt_lcd_levels, "Interface used for setting LCD brightness level (-1 = auto, 0 = force SBLL, 1 = force SBL2)");
1039module_param(disable_brightness_adjust, bool, 0644);
1040MODULE_PARM_DESC(disable_brightness_adjust, "Disable LCD brightness adjustment");
 
 
 
 
 
1041
1042MODULE_AUTHOR("Jonathan Woithe, Peter Gruber, Tony Vroon");
1043MODULE_DESCRIPTION("Fujitsu laptop extras support");
1044MODULE_VERSION(FUJITSU_DRIVER_VERSION);
1045MODULE_LICENSE("GPL");