[mirror_ubuntu-bionic-kernel.git] / drivers / platform / x86 / dell-laptop.c

/*
 *  Driver for Dell laptop extras
 *
 *  Copyright (c) Red Hat <mjg@redhat.com>
 *
 *  Based on documentation in the libsmbios package, Copyright (C) 2005 Dell
 *  Inc.
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License version 2 as
 *  published by the Free Software Foundation.
 */

#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/platform_device.h>
#include <linux/backlight.h>
#include <linux/err.h>
#include <linux/dmi.h>
#include <linux/io.h>
#include <linux/rfkill.h>
#include <linux/power_supply.h>
#include <linux/acpi.h>
#include <linux/i8042.h>
#include "../../firmware/dcdbas.h"

#define BRIGHTNESS_TOKEN 0x7d

/* This structure will be modified by the firmware when we enter
 * system management mode, hence the volatiles */

struct calling_interface_buffer {
	u16 class;
	u16 select;
	volatile u32 input[4];
	volatile u32 output[4];
} __packed;

struct calling_interface_token {
	u16 tokenID;
	u16 location;
	union {
		u16 value;
		u16 stringlength;
	};
};

struct calling_interface_structure {
	struct dmi_header header;
	u16 cmdIOAddress;
	u8 cmdIOCode;
	u32 supportedCmds;
	struct calling_interface_token tokens[];
} __packed;

static int da_command_address;
static int da_command_code;
static int da_num_tokens;
static struct calling_interface_token *da_tokens;

static struct platform_driver platform_driver = {
	.driver = {
		.name = "dell-laptop",
		.owner = THIS_MODULE,
	}
};

static struct platform_device *platform_device;
static struct backlight_device *dell_backlight_device;
static struct rfkill *wifi_rfkill;
static struct rfkill *bluetooth_rfkill;
static struct rfkill *wwan_rfkill;

static const struct dmi_system_id __initdata dell_device_table[] = {
	{
		.ident = "Dell laptop",
		.matches = {
			DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
			DMI_MATCH(DMI_CHASSIS_TYPE, "8"),
		},
	},
	{ }
};

static void __init parse_da_table(const struct dmi_header *dm)
{
	/* Final token is a terminator, so we don't want to copy it */
	int tokens = (dm->length-11)/sizeof(struct calling_interface_token)-1;
	struct calling_interface_structure *table =
		container_of(dm, struct calling_interface_structure, header);

	/* 4 bytes of table header, plus 7 bytes of Dell header, plus at least
	   6 bytes of entry */

	if (dm->length < 17)
		return;

	da_command_address = table->cmdIOAddress;
	da_command_code = table->cmdIOCode;

	da_tokens = krealloc(da_tokens, (da_num_tokens + tokens) *
			     sizeof(struct calling_interface_token),
			     GFP_KERNEL);

	if (!da_tokens)
		return;

	memcpy(da_tokens+da_num_tokens, table->tokens,
	       sizeof(struct calling_interface_token) * tokens);

	da_num_tokens += tokens;
}

static void __init find_tokens(const struct dmi_header *dm, void *dummy)
{
	switch (dm->type) {
	case 0xd4: /* Indexed IO */
		break;
	case 0xd5: /* Protected Area Type 1 */
		break;
	case 0xd6: /* Protected Area Type 2 */
		break;
	case 0xda: /* Calling interface */
		parse_da_table(dm);
		break;
	}
}

static int find_token_location(int tokenid)
{
	int i;
	for (i = 0; i < da_num_tokens; i++) {
		if (da_tokens[i].tokenID == tokenid)
			return da_tokens[i].location;
	}

	return -1;
}

static struct calling_interface_buffer *
dell_send_request(struct calling_interface_buffer *buffer, int class,
		  int select)
{
	struct smi_cmd command;

	command.magic = SMI_CMD_MAGIC;
	command.command_address = da_command_address;
	command.command_code = da_command_code;
	command.ebx = virt_to_phys(buffer);
	command.ecx = 0x42534931;

	buffer->class = class;
	buffer->select = select;

	dcdbas_smi_request(&command);

	return buffer;
}

/* Derived from information in DellWirelessCtl.cpp:
   Class 17, select 11 is radio control. It returns an array of 32-bit values.

   result[0]: return code
   result[1]:
     Bit 0:      Hardware switch supported
     Bit 1:      Wifi locator supported
     Bit 2:      Wifi is supported
     Bit 3:      Bluetooth is supported
     Bit 4:      WWAN is supported
     Bit 5:      Wireless keyboard supported
     Bits 6-7:   Reserved
     Bit 8:      Wifi is installed
     Bit 9:      Bluetooth is installed
     Bit 10:     WWAN is installed
     Bits 11-15: Reserved
     Bit 16:     Hardware switch is on
     Bit 17:     Wifi is blocked
     Bit 18:     Bluetooth is blocked
     Bit 19:     WWAN is blocked
     Bits 20-31: Reserved
   result[2]: NVRAM size in bytes
   result[3]: NVRAM format version number
*/

static int dell_rfkill_set(void *data, bool blocked)
{
	struct calling_interface_buffer buffer;
	int disable = blocked ? 1 : 0;
	unsigned long radio = (unsigned long)data;

	memset(&buffer, 0, sizeof(struct calling_interface_buffer));
	dell_send_request(&buffer, 17, 11);
	if (!(buffer.output[1] & BIT(16)))
		return -EINVAL;

	buffer.input[0] = (1 | (radio<<8) | (disable << 16));
	dell_send_request(&buffer, 17, 11);

	return 0;
}

static void dell_rfkill_query(struct rfkill *rfkill, void *data)
{
	struct calling_interface_buffer buffer;
	int status;
	int bit = (unsigned long)data + 16;

	memset(&buffer, 0, sizeof(struct calling_interface_buffer));
	dell_send_request(&buffer, 17, 11);
	status = buffer.output[1];

	rfkill_set_sw_state(rfkill, !!(status & BIT(bit)));
	rfkill_set_hw_state(rfkill, !(status & BIT(16)));
}

static const struct rfkill_ops dell_rfkill_ops = {
	.set_block = dell_rfkill_set,
	.query = dell_rfkill_query,
};

static void dell_update_rfkill(struct work_struct *ignored)
{
	if (wifi_rfkill)
		dell_rfkill_query(wifi_rfkill, (void *)1);
	if (bluetooth_rfkill)
		dell_rfkill_query(bluetooth_rfkill, (void *)2);
	if (wwan_rfkill)
		dell_rfkill_query(wwan_rfkill, (void *)3);
}
static DECLARE_DELAYED_WORK(dell_rfkill_work, dell_update_rfkill);


static int __init dell_setup_rfkill(void)
{
	struct calling_interface_buffer buffer;
	int status;
	int ret;

	memset(&buffer, 0, sizeof(struct calling_interface_buffer));
	dell_send_request(&buffer, 17, 11);
	status = buffer.output[1];

	if ((status & (1<<2|1<<8)) == (1<<2|1<<8)) {
		wifi_rfkill = rfkill_alloc("dell-wifi", &platform_device->dev,
					   RFKILL_TYPE_WLAN,
					   &dell_rfkill_ops, (void *) 1);
		if (!wifi_rfkill) {
			ret = -ENOMEM;
			goto err_wifi;
		}
		ret = rfkill_register(wifi_rfkill);
		if (ret)
			goto err_wifi;
	}

	if ((status & (1<<3|1<<9)) == (1<<3|1<<9)) {
		bluetooth_rfkill = rfkill_alloc("dell-bluetooth",
						&platform_device->dev,
						RFKILL_TYPE_BLUETOOTH,
						&dell_rfkill_ops, (void *) 2);
		if (!bluetooth_rfkill) {
			ret = -ENOMEM;
			goto err_bluetooth;
		}
		ret = rfkill_register(bluetooth_rfkill);
		if (ret)
			goto err_bluetooth;
	}

	if ((status & (1<<4|1<<10)) == (1<<4|1<<10)) {
		wwan_rfkill = rfkill_alloc("dell-wwan",
					   &platform_device->dev,
					   RFKILL_TYPE_WWAN,
					   &dell_rfkill_ops, (void *) 3);
		if (!wwan_rfkill) {
			ret = -ENOMEM;
			goto err_wwan;
		}
		ret = rfkill_register(wwan_rfkill);
		if (ret)
			goto err_wwan;
	}

	return 0;
err_wwan:
	rfkill_destroy(wwan_rfkill);
	if (bluetooth_rfkill)
		rfkill_unregister(bluetooth_rfkill);
err_bluetooth:
	rfkill_destroy(bluetooth_rfkill);
	if (wifi_rfkill)
		rfkill_unregister(wifi_rfkill);
err_wifi:
	rfkill_destroy(wifi_rfkill);

	return ret;
}

static void dell_cleanup_rfkill(void)
{
	if (wifi_rfkill) {
		rfkill_unregister(wifi_rfkill);
		rfkill_destroy(wifi_rfkill);
	}
	if (bluetooth_rfkill) {
		rfkill_unregister(bluetooth_rfkill);
		rfkill_destroy(bluetooth_rfkill);
	}
	if (wwan_rfkill) {
		rfkill_unregister(wwan_rfkill);
		rfkill_destroy(wwan_rfkill);
	}
}

static int dell_send_intensity(struct backlight_device *bd)
{
	struct calling_interface_buffer buffer;

	memset(&buffer, 0, sizeof(struct calling_interface_buffer));
	buffer.input[0] = find_token_location(BRIGHTNESS_TOKEN);
	buffer.input[1] = bd->props.brightness;

	if (buffer.input[0] == -1)
		return -ENODEV;

	if (power_supply_is_system_supplied() > 0)
		dell_send_request(&buffer, 1, 2);
	else
		dell_send_request(&buffer, 1, 1);

	return 0;
}

static int dell_get_intensity(struct backlight_device *bd)
{
	struct calling_interface_buffer buffer;

	memset(&buffer, 0, sizeof(struct calling_interface_buffer));
	buffer.input[0] = find_token_location(BRIGHTNESS_TOKEN);

	if (buffer.input[0] == -1)
		return -ENODEV;

	if (power_supply_is_system_supplied() > 0)
		dell_send_request(&buffer, 0, 2);
	else
		dell_send_request(&buffer, 0, 1);

	return buffer.output[1];
}

static struct backlight_ops dell_ops = {
	.get_brightness = dell_get_intensity,
	.update_status  = dell_send_intensity,
};

bool dell_laptop_i8042_filter(unsigned char data, unsigned char str,
			      struct serio *port)
{
	static bool extended;

	if (str & 0x20)
		return false;

	if (unlikely(data == 0xe0)) {
		extended = true;
		return false;
	} else if (unlikely(extended)) {
		switch (data) {
		case 0x8:
			schedule_delayed_work(&dell_rfkill_work,
					      round_jiffies_relative(HZ));
			break;
		}
		extended = false;
	}

	return false;
}

static int __init dell_init(void)
{
	struct calling_interface_buffer buffer;
	int max_intensity = 0;
	int ret;

	if (!dmi_check_system(dell_device_table))
		return -ENODEV;

	dmi_walk(find_tokens, NULL);

	if (!da_tokens)  {
		printk(KERN_INFO "dell-laptop: Unable to find dmi tokens\n");
		return -ENODEV;
	}

	ret = platform_driver_register(&platform_driver);
	if (ret)
		goto fail_platform_driver;
	platform_device = platform_device_alloc("dell-laptop", -1);
	if (!platform_device) {
		ret = -ENOMEM;
		goto fail_platform_device1;
	}
	ret = platform_device_add(platform_device);
	if (ret)
		goto fail_platform_device2;

	ret = dell_setup_rfkill();

	if (ret) {
		printk(KERN_WARNING "dell-laptop: Unable to setup rfkill\n");
		goto fail_rfkill;
	}

	ret = i8042_install_filter(dell_laptop_i8042_filter);
	if (ret) {
		printk(KERN_WARNING
		       "dell-laptop: Unable to install key filter\n");
		goto fail_filter;
	}

#ifdef CONFIG_ACPI
	/* In the event of an ACPI backlight being available, don't
	 * register the platform controller.
	 */
	if (acpi_video_backlight_support())
		return 0;
#endif

	memset(&buffer, 0, sizeof(struct calling_interface_buffer));
	buffer.input[0] = find_token_location(BRIGHTNESS_TOKEN);

	if (buffer.input[0] != -1) {
		dell_send_request(&buffer, 0, 2);
		max_intensity = buffer.output[3];
	}

	if (max_intensity) {
		dell_backlight_device = backlight_device_register(
			"dell_backlight",
			&platform_device->dev, NULL,
			&dell_ops);

		if (IS_ERR(dell_backlight_device)) {
			ret = PTR_ERR(dell_backlight_device);
			dell_backlight_device = NULL;
			goto fail_backlight;
		}

		dell_backlight_device->props.max_brightness = max_intensity;
		dell_backlight_device->props.brightness =
			dell_get_intensity(dell_backlight_device);
		backlight_update_status(dell_backlight_device);
	}

	return 0;

fail_backlight:
	i8042_remove_filter(dell_laptop_i8042_filter);
fail_filter:
	dell_cleanup_rfkill();
fail_rfkill:
	platform_device_del(platform_device);
fail_platform_device2:
	platform_device_put(platform_device);
fail_platform_device1:
	platform_driver_unregister(&platform_driver);
fail_platform_driver:
	kfree(da_tokens);
	return ret;
}

static void __exit dell_exit(void)
{
	cancel_delayed_work_sync(&dell_rfkill_work);
	i8042_remove_filter(dell_laptop_i8042_filter);
	backlight_device_unregister(dell_backlight_device);
	dell_cleanup_rfkill();
	if (platform_device) {
		platform_device_del(platform_device);
		platform_driver_unregister(&platform_driver);
	}
	kfree(da_tokens);
}

module_init(dell_init);
module_exit(dell_exit);

MODULE_AUTHOR("Matthew Garrett <mjg@redhat.com>");
MODULE_DESCRIPTION("Dell laptop driver");
MODULE_LICENSE("GPL");
MODULE_ALIAS("dmi:*svnDellInc.:*:ct8:*");
Commit	Line	Data
ad8f07cc MG	1	/*
	2	* Driver for Dell laptop extras
	3	*
	4	* Copyright (c) Red Hat <mjg@redhat.com>
	5	*
	6	* Based on documentation in the libsmbios package, Copyright (C) 2005 Dell
	7	* Inc.
	8	*
	9	* This program is free software; you can redistribute it and/or modify
	10	* it under the terms of the GNU General Public License version 2 as
	11	* published by the Free Software Foundation.
	12	*/
	13
	14	#include <linux/module.h>
	15	#include <linux/kernel.h>
	16	#include <linux/init.h>
	17	#include <linux/platform_device.h>
	18	#include <linux/backlight.h>
	19	#include <linux/err.h>
	20	#include <linux/dmi.h>
	21	#include <linux/io.h>
	22	#include <linux/rfkill.h>
	23	#include <linux/power_supply.h>
	24	#include <linux/acpi.h>
814cb8ad	25	#include <linux/i8042.h>
cad73120	26	#include "../../firmware/dcdbas.h"
ad8f07cc MG	27
	28	#define BRIGHTNESS_TOKEN 0x7d
	29
	30	/* This structure will be modified by the firmware when we enter
	31	* system management mode, hence the volatiles */
	32
	33	struct calling_interface_buffer {
	34	u16 class;
	35	u16 select;
	36	volatile u32 input[4];
	37	volatile u32 output[4];
	38	} __packed;
	39
	40	struct calling_interface_token {
	41	u16 tokenID;
	42	u16 location;
	43	union {
	44	u16 value;
	45	u16 stringlength;
	46	};
	47	};
	48
	49	struct calling_interface_structure {
	50	struct dmi_header header;
	51	u16 cmdIOAddress;
	52	u8 cmdIOCode;
	53	u32 supportedCmds;
	54	struct calling_interface_token tokens[];
	55	} __packed;
	56
	57	static int da_command_address;
	58	static int da_command_code;
	59	static int da_num_tokens;
	60	static struct calling_interface_token *da_tokens;
	61
ada3248a AJ	62	static struct platform_driver platform_driver = {
	63	.driver = {
	64	.name = "dell-laptop",
	65	.owner = THIS_MODULE,
	66	}
	67	};
	68
	69	static struct platform_device *platform_device;
ad8f07cc MG	70	static struct backlight_device *dell_backlight_device;
	71	static struct rfkill *wifi_rfkill;
	72	static struct rfkill *bluetooth_rfkill;
	73	static struct rfkill *wwan_rfkill;
	74
	75	static const struct dmi_system_id __initdata dell_device_table[] = {
	76	{
	77	.ident = "Dell laptop",
	78	.matches = {
	79	DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
	80	DMI_MATCH(DMI_CHASSIS_TYPE, "8"),
	81	},
	82	},
	83	{ }
	84	};
	85
4788df4c	86	static void __init parse_da_table(const struct dmi_header *dm)
ad8f07cc MG	87	{
	88	/* Final token is a terminator, so we don't want to copy it */
	89	int tokens = (dm->length-11)/sizeof(struct calling_interface_token)-1;
	90	struct calling_interface_structure *table =
	91	container_of(dm, struct calling_interface_structure, header);
	92
	93	/* 4 bytes of table header, plus 7 bytes of Dell header, plus at least
	94	6 bytes of entry */
	95
	96	if (dm->length < 17)
	97	return;
	98
	99	da_command_address = table->cmdIOAddress;
	100	da_command_code = table->cmdIOCode;
	101
	102	da_tokens = krealloc(da_tokens, (da_num_tokens + tokens) *
	103	sizeof(struct calling_interface_token),
	104	GFP_KERNEL);
	105
	106	if (!da_tokens)
	107	return;
	108
	109	memcpy(da_tokens+da_num_tokens, table->tokens,
	110	sizeof(struct calling_interface_token) * tokens);
	111
	112	da_num_tokens += tokens;
	113	}
	114
4788df4c	115	static void __init find_tokens(const struct dmi_header dm, void dummy)
ad8f07cc MG	116	{
	117	switch (dm->type) {
	118	case 0xd4: /* Indexed IO */
	119	break;
	120	case 0xd5: /* Protected Area Type 1 */
	121	break;
	122	case 0xd6: /* Protected Area Type 2 */
	123	break;
	124	case 0xda: /* Calling interface */
	125	parse_da_table(dm);
	126	break;
	127	}
	128	}
	129
	130	static int find_token_location(int tokenid)
	131	{
	132	int i;
	133	for (i = 0; i < da_num_tokens; i++) {
	134	if (da_tokens[i].tokenID == tokenid)
	135	return da_tokens[i].location;
	136	}
	137
	138	return -1;
	139	}
	140
	141	static struct calling_interface_buffer *
	142	dell_send_request(struct calling_interface_buffer *buffer, int class,
	143	int select)
	144	{
	145	struct smi_cmd command;
	146
	147	command.magic = SMI_CMD_MAGIC;
	148	command.command_address = da_command_address;
	149	command.command_code = da_command_code;
	150	command.ebx = virt_to_phys(buffer);
	151	command.ecx = 0x42534931;
	152
	153	buffer->class = class;
	154	buffer->select = select;
	155
	156	dcdbas_smi_request(&command);
	157
	158	return buffer;
	159	}
	160
	161	/* Derived from information in DellWirelessCtl.cpp:
	162	Class 17, select 11 is radio control. It returns an array of 32-bit values.
	163
	164	result[0]: return code
	165	result[1]:
	166	Bit 0: Hardware switch supported
	167	Bit 1: Wifi locator supported
	168	Bit 2: Wifi is supported
	169	Bit 3: Bluetooth is supported
	170	Bit 4: WWAN is supported
	171	Bit 5: Wireless keyboard supported
	172	Bits 6-7: Reserved
	173	Bit 8: Wifi is installed
	174	Bit 9: Bluetooth is installed
	175	Bit 10: WWAN is installed
	176	Bits 11-15: Reserved
	177	Bit 16: Hardware switch is on
	178	Bit 17: Wifi is blocked
	179	Bit 18: Bluetooth is blocked
180	Bit 19: WWAN is blocked
181	Bits 20-31: Reserved
182	result[2]: NVRAM size in bytes
183	result[3]: NVRAM format version number
184	*/
185
19d337df	186	static int dell_rfkill_set(void *data, bool blocked)
ad8f07cc MG	187	{
ad8f07cc MG	188	struct calling_interface_buffer buffer;
624f0de4	189	int disable = blocked ? 1 : 0;
19d337df	190	unsigned long radio = (unsigned long)data;
ad8f07cc MG	191
ad8f07cc MG	192	memset(&buffer, 0, sizeof(struct calling_interface_buffer));
ec1722a2 ML	193	dell_send_request(&buffer, 17, 11);
	194	if (!(buffer.output[1] & BIT(16)))
	195	return -EINVAL;
	196
ad8f07cc MG	197	buffer.input[0] = (1 \| (radio<<8) \| (disable << 16));
	198	dell_send_request(&buffer, 17, 11);
	199
	200	return 0;
	201	}
	202
19d337df	203	static void dell_rfkill_query(struct rfkill rfkill, void data)
ad8f07cc MG	204	{
	205	struct calling_interface_buffer buffer;
	206	int status;
19d337df	207	int bit = (unsigned long)data + 16;
ad8f07cc MG	208
	209	memset(&buffer, 0, sizeof(struct calling_interface_buffer));
	210	dell_send_request(&buffer, 17, 11);
	211	status = buffer.output[1];
	212
e1fbf346 MG	213	rfkill_set_sw_state(rfkill, !!(status & BIT(bit)));
e1fbf346 MG	214	rfkill_set_hw_state(rfkill, !(status & BIT(16)));
ad8f07cc MG	215	}
ad8f07cc MG	216
19d337df JB	217	static const struct rfkill_ops dell_rfkill_ops = {
	218	.set_block = dell_rfkill_set,
	219	.query = dell_rfkill_query,
	220	};
ad8f07cc	221
814cb8ad MG	222	static void dell_update_rfkill(struct work_struct *ignored)
	223	{
	224	if (wifi_rfkill)
	225	dell_rfkill_query(wifi_rfkill, (void *)1);
	226	if (bluetooth_rfkill)
	227	dell_rfkill_query(bluetooth_rfkill, (void *)2);
	228	if (wwan_rfkill)
	229	dell_rfkill_query(wwan_rfkill, (void *)3);
	230	}
	231	static DECLARE_DELAYED_WORK(dell_rfkill_work, dell_update_rfkill);
	232
	233
4788df4c	234	static int __init dell_setup_rfkill(void)
ad8f07cc MG	235	{
	236	struct calling_interface_buffer buffer;
	237	int status;
	238	int ret;
	239
	240	memset(&buffer, 0, sizeof(struct calling_interface_buffer));
	241	dell_send_request(&buffer, 17, 11);
	242	status = buffer.output[1];
	243
	244	if ((status & (1<<2\|1<<8)) == (1<<2\|1<<8)) {
ada3248a AJ	245	wifi_rfkill = rfkill_alloc("dell-wifi", &platform_device->dev,
ada3248a AJ	246	RFKILL_TYPE_WLAN,
19d337df JB	247	&dell_rfkill_ops, (void *) 1);
	248	if (!wifi_rfkill) {
	249	ret = -ENOMEM;
ad8f07cc	250	goto err_wifi;
19d337df	251	}
ad8f07cc MG	252	ret = rfkill_register(wifi_rfkill);
	253	if (ret)
	254	goto err_wifi;
	255	}
	256
	257	if ((status & (1<<3\|1<<9)) == (1<<3\|1<<9)) {
ada3248a AJ	258	bluetooth_rfkill = rfkill_alloc("dell-bluetooth",
ada3248a AJ	259	&platform_device->dev,
19d337df JB	260	RFKILL_TYPE_BLUETOOTH,
	261	&dell_rfkill_ops, (void *) 2);
	262	if (!bluetooth_rfkill) {
	263	ret = -ENOMEM;
ad8f07cc	264	goto err_bluetooth;
19d337df	265	}
ad8f07cc MG	266	ret = rfkill_register(bluetooth_rfkill);
	267	if (ret)
	268	goto err_bluetooth;
	269	}
	270
	271	if ((status & (1<<4\|1<<10)) == (1<<4\|1<<10)) {
ada3248a AJ	272	wwan_rfkill = rfkill_alloc("dell-wwan",
	273	&platform_device->dev,
	274	RFKILL_TYPE_WWAN,
19d337df JB	275	&dell_rfkill_ops, (void *) 3);
	276	if (!wwan_rfkill) {
	277	ret = -ENOMEM;
ad8f07cc	278	goto err_wwan;
19d337df	279	}
ad8f07cc MG	280	ret = rfkill_register(wwan_rfkill);
	281	if (ret)
	282	goto err_wwan;
	283	}
	284
	285	return 0;
	286	err_wwan:
19d337df JB	287	rfkill_destroy(wwan_rfkill);
19d337df JB	288	if (bluetooth_rfkill)
ad8f07cc	289	rfkill_unregister(bluetooth_rfkill);
ad8f07cc	290	err_bluetooth:
19d337df JB	291	rfkill_destroy(bluetooth_rfkill);
19d337df JB	292	if (wifi_rfkill)
ad8f07cc	293	rfkill_unregister(wifi_rfkill);
ad8f07cc	294	err_wifi:
19d337df	295	rfkill_destroy(wifi_rfkill);
ad8f07cc MG	296
	297	return ret;
	298	}
	299
4311bb23 AJ	300	static void dell_cleanup_rfkill(void)
	301	{
	302	if (wifi_rfkill) {
	303	rfkill_unregister(wifi_rfkill);
	304	rfkill_destroy(wifi_rfkill);
	305	}
	306	if (bluetooth_rfkill) {
	307	rfkill_unregister(bluetooth_rfkill);
	308	rfkill_destroy(bluetooth_rfkill);
	309	}
	310	if (wwan_rfkill) {
	311	rfkill_unregister(wwan_rfkill);
	312	rfkill_destroy(wwan_rfkill);
	313	}
	314	}
	315
ad8f07cc MG	316	static int dell_send_intensity(struct backlight_device *bd)
	317	{
	318	struct calling_interface_buffer buffer;
	319
	320	memset(&buffer, 0, sizeof(struct calling_interface_buffer));
	321	buffer.input[0] = find_token_location(BRIGHTNESS_TOKEN);
	322	buffer.input[1] = bd->props.brightness;
	323
	324	if (buffer.input[0] == -1)
	325	return -ENODEV;
	326
	327	if (power_supply_is_system_supplied() > 0)
	328	dell_send_request(&buffer, 1, 2);
	329	else
	330	dell_send_request(&buffer, 1, 1);
	331
	332	return 0;
	333	}
	334
	335	static int dell_get_intensity(struct backlight_device *bd)
	336	{
	337	struct calling_interface_buffer buffer;
	338
	339	memset(&buffer, 0, sizeof(struct calling_interface_buffer));
	340	buffer.input[0] = find_token_location(BRIGHTNESS_TOKEN);
	341
	342	if (buffer.input[0] == -1)
	343	return -ENODEV;
	344
	345	if (power_supply_is_system_supplied() > 0)
	346	dell_send_request(&buffer, 0, 2);
	347	else
	348	dell_send_request(&buffer, 0, 1);
	349
	350	return buffer.output[1];
	351	}
	352
	353	static struct backlight_ops dell_ops = {
	354	.get_brightness = dell_get_intensity,
	355	.update_status = dell_send_intensity,
	356	};
	357
814cb8ad MG	358	bool dell_laptop_i8042_filter(unsigned char data, unsigned char str,
	359	struct serio *port)
	360	{
	361	static bool extended;
	362
	363	if (str & 0x20)
	364	return false;
	365
	366	if (unlikely(data == 0xe0)) {
	367	extended = true;
	368	return false;
	369	} else if (unlikely(extended)) {
	370	switch (data) {
	371	case 0x8:
	372	schedule_delayed_work(&dell_rfkill_work,
	373	round_jiffies_relative(HZ));
	374	break;
	375	}
	376	extended = false;
	377	}
	378
	379	return false;
	380	}
	381
ad8f07cc MG	382	static int __init dell_init(void)
	383	{
	384	struct calling_interface_buffer buffer;
	385	int max_intensity = 0;
	386	int ret;
	387
	388	if (!dmi_check_system(dell_device_table))
	389	return -ENODEV;
	390
e7a19c56	391	dmi_walk(find_tokens, NULL);
ad8f07cc MG	392
	393	if (!da_tokens) {
	394	printk(KERN_INFO "dell-laptop: Unable to find dmi tokens\n");
	395	return -ENODEV;
	396	}
	397
ada3248a AJ	398	ret = platform_driver_register(&platform_driver);
	399	if (ret)
	400	goto fail_platform_driver;
	401	platform_device = platform_device_alloc("dell-laptop", -1);
	402	if (!platform_device) {
	403	ret = -ENOMEM;
	404	goto fail_platform_device1;
	405	}
	406	ret = platform_device_add(platform_device);
	407	if (ret)
	408	goto fail_platform_device2;
	409
ad8f07cc MG	410	ret = dell_setup_rfkill();
	411
	412	if (ret) {
	413	printk(KERN_WARNING "dell-laptop: Unable to setup rfkill\n");
71e9dc73	414	goto fail_rfkill;
ad8f07cc MG	415	}
ad8f07cc MG	416
814cb8ad MG	417	ret = i8042_install_filter(dell_laptop_i8042_filter);
	418	if (ret) {
	419	printk(KERN_WARNING
	420	"dell-laptop: Unable to install key filter\n");
	421	goto fail_filter;
	422	}
	423
ad8f07cc MG	424	#ifdef CONFIG_ACPI
	425	/* In the event of an ACPI backlight being available, don't
	426	* register the platform controller.
	427	*/
	428	if (acpi_video_backlight_support())
	429	return 0;
	430	#endif
	431
	432	memset(&buffer, 0, sizeof(struct calling_interface_buffer));
	433	buffer.input[0] = find_token_location(BRIGHTNESS_TOKEN);
	434
	435	if (buffer.input[0] != -1) {
	436	dell_send_request(&buffer, 0, 2);
	437	max_intensity = buffer.output[3];
	438	}
	439
	440	if (max_intensity) {
	441	dell_backlight_device = backlight_device_register(
	442	"dell_backlight",
ada3248a	443	&platform_device->dev, NULL,
ad8f07cc MG	444	&dell_ops);
	445
	446	if (IS_ERR(dell_backlight_device)) {
	447	ret = PTR_ERR(dell_backlight_device);
	448	dell_backlight_device = NULL;
71e9dc73	449	goto fail_backlight;
ad8f07cc MG	450	}
	451
	452	dell_backlight_device->props.max_brightness = max_intensity;
	453	dell_backlight_device->props.brightness =
	454	dell_get_intensity(dell_backlight_device);
	455	backlight_update_status(dell_backlight_device);
	456	}
	457
	458	return 0;
71e9dc73 AJ	459
71e9dc73 AJ	460	fail_backlight:
814cb8ad MG	461	i8042_remove_filter(dell_laptop_i8042_filter);
814cb8ad MG	462	fail_filter:
4311bb23	463	dell_cleanup_rfkill();
71e9dc73	464	fail_rfkill:
ada3248a AJ	465	platform_device_del(platform_device);
	466	fail_platform_device2:
	467	platform_device_put(platform_device);
	468	fail_platform_device1:
	469	platform_driver_unregister(&platform_driver);
	470	fail_platform_driver:
ad8f07cc MG	471	kfree(da_tokens);
	472	return ret;
	473	}
	474
	475	static void __exit dell_exit(void)
	476	{
814cb8ad MG	477	cancel_delayed_work_sync(&dell_rfkill_work);
814cb8ad MG	478	i8042_remove_filter(dell_laptop_i8042_filter);
ad8f07cc	479	backlight_device_unregister(dell_backlight_device);
4311bb23	480	dell_cleanup_rfkill();
facd61d7 MG	481	if (platform_device) {
	482	platform_device_del(platform_device);
	483	platform_driver_unregister(&platform_driver);
	484	}
e551260b	485	kfree(da_tokens);
ad8f07cc MG	486	}
	487
	488	module_init(dell_init);
	489	module_exit(dell_exit);
	490
	491	MODULE_AUTHOR("Matthew Garrett <mjg@redhat.com>");
	492	MODULE_DESCRIPTION("Dell laptop driver");
	493	MODULE_LICENSE("GPL");
	494	MODULE_ALIAS("dmi:svnDellInc.::ct8:*");