• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
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 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
15 
16 #include <linux/module.h>
17 #include <linux/kernel.h>
18 #include <linux/init.h>
19 #include <linux/platform_device.h>
20 #include <linux/backlight.h>
21 #include <linux/err.h>
22 #include <linux/dmi.h>
23 #include <linux/io.h>
24 #include <linux/rfkill.h>
25 #include <linux/power_supply.h>
26 #include <linux/acpi.h>
27 #include <linux/mm.h>
28 #include <linux/i8042.h>
29 #include <linux/slab.h>
30 #include <linux/debugfs.h>
31 #include <linux/seq_file.h>
32 #include "../../firmware/dcdbas.h"
33 
34 #define BRIGHTNESS_TOKEN 0x7d
35 
36 /* This structure will be modified by the firmware when we enter
37  * system management mode, hence the volatiles */
38 
39 struct calling_interface_buffer {
40 	u16 class;
41 	u16 select;
42 	volatile u32 input[4];
43 	volatile u32 output[4];
44 } __packed;
45 
46 struct calling_interface_token {
47 	u16 tokenID;
48 	u16 location;
49 	union {
50 		u16 value;
51 		u16 stringlength;
52 	};
53 };
54 
55 struct calling_interface_structure {
56 	struct dmi_header header;
57 	u16 cmdIOAddress;
58 	u8 cmdIOCode;
59 	u32 supportedCmds;
60 	struct calling_interface_token tokens[];
61 } __packed;
62 
63 struct quirk_entry {
64 	u8 touchpad_led;
65 };
66 
67 static struct quirk_entry *quirks;
68 
69 static struct quirk_entry quirk_dell_vostro_v130 = {
70 	.touchpad_led = 1,
71 };
72 
dmi_matched(const struct dmi_system_id * dmi)73 static int __init dmi_matched(const struct dmi_system_id *dmi)
74 {
75 	quirks = dmi->driver_data;
76 	return 1;
77 }
78 
79 static int da_command_address;
80 static int da_command_code;
81 static int da_num_tokens;
82 static struct calling_interface_token *da_tokens;
83 
84 static struct platform_driver platform_driver = {
85 	.driver = {
86 		.name = "dell-laptop",
87 		.owner = THIS_MODULE,
88 	}
89 };
90 
91 static struct platform_device *platform_device;
92 static struct backlight_device *dell_backlight_device;
93 static struct rfkill *wifi_rfkill;
94 static struct rfkill *bluetooth_rfkill;
95 static struct rfkill *wwan_rfkill;
96 static bool force_rfkill;
97 
98 module_param(force_rfkill, bool, 0444);
99 MODULE_PARM_DESC(force_rfkill, "enable rfkill on non whitelisted models");
100 
101 static const struct dmi_system_id dell_device_table[] __initconst = {
102 	{
103 		.ident = "Dell laptop",
104 		.matches = {
105 			DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
106 			DMI_MATCH(DMI_CHASSIS_TYPE, "8"),
107 		},
108 	},
109 	{
110 		.matches = {
111 			DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
112 			DMI_MATCH(DMI_CHASSIS_TYPE, "9"), /*Laptop*/
113 		},
114 	},
115 	{
116 		.ident = "Dell Computer Corporation",
117 		.matches = {
118 			DMI_MATCH(DMI_SYS_VENDOR, "Dell Computer Corporation"),
119 			DMI_MATCH(DMI_CHASSIS_TYPE, "8"),
120 		},
121 	},
122 	{ }
123 };
124 MODULE_DEVICE_TABLE(dmi, dell_device_table);
125 
126 static const struct dmi_system_id dell_quirks[] __initconst = {
127 	{
128 		.callback = dmi_matched,
129 		.ident = "Dell Vostro V130",
130 		.matches = {
131 			DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
132 			DMI_MATCH(DMI_PRODUCT_NAME, "Vostro V130"),
133 		},
134 		.driver_data = &quirk_dell_vostro_v130,
135 	},
136 	{
137 		.callback = dmi_matched,
138 		.ident = "Dell Vostro V131",
139 		.matches = {
140 			DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
141 			DMI_MATCH(DMI_PRODUCT_NAME, "Vostro V131"),
142 		},
143 		.driver_data = &quirk_dell_vostro_v130,
144 	},
145 	{
146 		.callback = dmi_matched,
147 		.ident = "Dell Vostro 3350",
148 		.matches = {
149 			DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
150 			DMI_MATCH(DMI_PRODUCT_NAME, "Vostro 3350"),
151 		},
152 		.driver_data = &quirk_dell_vostro_v130,
153 	},
154 	{
155 		.callback = dmi_matched,
156 		.ident = "Dell Vostro 3555",
157 		.matches = {
158 			DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
159 			DMI_MATCH(DMI_PRODUCT_NAME, "Vostro 3555"),
160 		},
161 		.driver_data = &quirk_dell_vostro_v130,
162 	},
163 	{
164 		.callback = dmi_matched,
165 		.ident = "Dell Inspiron N311z",
166 		.matches = {
167 			DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
168 			DMI_MATCH(DMI_PRODUCT_NAME, "Inspiron N311z"),
169 		},
170 		.driver_data = &quirk_dell_vostro_v130,
171 	},
172 	{
173 		.callback = dmi_matched,
174 		.ident = "Dell Inspiron M5110",
175 		.matches = {
176 			DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
177 			DMI_MATCH(DMI_PRODUCT_NAME, "Inspiron M5110"),
178 		},
179 		.driver_data = &quirk_dell_vostro_v130,
180 	},
181 	{
182 		.callback = dmi_matched,
183 		.ident = "Dell Vostro 3360",
184 		.matches = {
185 			DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
186 			DMI_MATCH(DMI_PRODUCT_NAME, "Vostro 3360"),
187 		},
188 		.driver_data = &quirk_dell_vostro_v130,
189 	},
190 	{
191 		.callback = dmi_matched,
192 		.ident = "Dell Vostro 3460",
193 		.matches = {
194 			DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
195 			DMI_MATCH(DMI_PRODUCT_NAME, "Vostro 3460"),
196 		},
197 		.driver_data = &quirk_dell_vostro_v130,
198 	},
199 	{
200 		.callback = dmi_matched,
201 		.ident = "Dell Vostro 3560",
202 		.matches = {
203 			DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
204 			DMI_MATCH(DMI_PRODUCT_NAME, "Vostro 3560"),
205 		},
206 		.driver_data = &quirk_dell_vostro_v130,
207 	},
208 	{
209 		.callback = dmi_matched,
210 		.ident = "Dell Vostro 3450",
211 		.matches = {
212 			DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
213 			DMI_MATCH(DMI_PRODUCT_NAME, "Dell System Vostro 3450"),
214 		},
215 		.driver_data = &quirk_dell_vostro_v130,
216 	},
217 	{
218 		.callback = dmi_matched,
219 		.ident = "Dell Inspiron 5420",
220 		.matches = {
221 			DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
222 			DMI_MATCH(DMI_PRODUCT_NAME, "Inspiron 5420"),
223 		},
224 		.driver_data = &quirk_dell_vostro_v130,
225 	},
226 	{
227 		.callback = dmi_matched,
228 		.ident = "Dell Inspiron 5520",
229 		.matches = {
230 			DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
231 			DMI_MATCH(DMI_PRODUCT_NAME, "Inspiron 5520"),
232 		},
233 		.driver_data = &quirk_dell_vostro_v130,
234 	},
235 	{
236 		.callback = dmi_matched,
237 		.ident = "Dell Inspiron 5720",
238 		.matches = {
239 			DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
240 			DMI_MATCH(DMI_PRODUCT_NAME, "Inspiron 5720"),
241 		},
242 		.driver_data = &quirk_dell_vostro_v130,
243 	},
244 	{
245 		.callback = dmi_matched,
246 		.ident = "Dell Inspiron 7420",
247 		.matches = {
248 			DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
249 			DMI_MATCH(DMI_PRODUCT_NAME, "Inspiron 7420"),
250 		},
251 		.driver_data = &quirk_dell_vostro_v130,
252 	},
253 	{
254 		.callback = dmi_matched,
255 		.ident = "Dell Inspiron 7520",
256 		.matches = {
257 			DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
258 			DMI_MATCH(DMI_PRODUCT_NAME, "Inspiron 7520"),
259 		},
260 		.driver_data = &quirk_dell_vostro_v130,
261 	},
262 	{
263 		.callback = dmi_matched,
264 		.ident = "Dell Inspiron 7720",
265 		.matches = {
266 			DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
267 			DMI_MATCH(DMI_PRODUCT_NAME, "Inspiron 7720"),
268 		},
269 		.driver_data = &quirk_dell_vostro_v130,
270 	},
271 	{ }
272 };
273 
274 static struct calling_interface_buffer *buffer;
275 static DEFINE_MUTEX(buffer_mutex);
276 
277 static int hwswitch_state;
278 
get_buffer(void)279 static void get_buffer(void)
280 {
281 	mutex_lock(&buffer_mutex);
282 	memset(buffer, 0, sizeof(struct calling_interface_buffer));
283 }
284 
release_buffer(void)285 static void release_buffer(void)
286 {
287 	mutex_unlock(&buffer_mutex);
288 }
289 
parse_da_table(const struct dmi_header * dm)290 static void __init parse_da_table(const struct dmi_header *dm)
291 {
292 	/* Final token is a terminator, so we don't want to copy it */
293 	int tokens = (dm->length-11)/sizeof(struct calling_interface_token)-1;
294 	struct calling_interface_token *new_da_tokens;
295 	struct calling_interface_structure *table =
296 		container_of(dm, struct calling_interface_structure, header);
297 
298 	/* 4 bytes of table header, plus 7 bytes of Dell header, plus at least
299 	   6 bytes of entry */
300 
301 	if (dm->length < 17)
302 		return;
303 
304 	da_command_address = table->cmdIOAddress;
305 	da_command_code = table->cmdIOCode;
306 
307 	new_da_tokens = krealloc(da_tokens, (da_num_tokens + tokens) *
308 				 sizeof(struct calling_interface_token),
309 				 GFP_KERNEL);
310 
311 	if (!new_da_tokens)
312 		return;
313 	da_tokens = new_da_tokens;
314 
315 	memcpy(da_tokens+da_num_tokens, table->tokens,
316 	       sizeof(struct calling_interface_token) * tokens);
317 
318 	da_num_tokens += tokens;
319 }
320 
find_tokens(const struct dmi_header * dm,void * dummy)321 static void __init find_tokens(const struct dmi_header *dm, void *dummy)
322 {
323 	switch (dm->type) {
324 	case 0xd4: /* Indexed IO */
325 	case 0xd5: /* Protected Area Type 1 */
326 	case 0xd6: /* Protected Area Type 2 */
327 		break;
328 	case 0xda: /* Calling interface */
329 		parse_da_table(dm);
330 		break;
331 	}
332 }
333 
find_token_location(int tokenid)334 static int find_token_location(int tokenid)
335 {
336 	int i;
337 	for (i = 0; i < da_num_tokens; i++) {
338 		if (da_tokens[i].tokenID == tokenid)
339 			return da_tokens[i].location;
340 	}
341 
342 	return -1;
343 }
344 
345 static struct calling_interface_buffer *
dell_send_request(struct calling_interface_buffer * buffer,int class,int select)346 dell_send_request(struct calling_interface_buffer *buffer, int class,
347 		  int select)
348 {
349 	struct smi_cmd command;
350 
351 	command.magic = SMI_CMD_MAGIC;
352 	command.command_address = da_command_address;
353 	command.command_code = da_command_code;
354 	command.ebx = virt_to_phys(buffer);
355 	command.ecx = 0x42534931;
356 
357 	buffer->class = class;
358 	buffer->select = select;
359 
360 	dcdbas_smi_request(&command);
361 
362 	return buffer;
363 }
364 
365 /* Derived from information in DellWirelessCtl.cpp:
366    Class 17, select 11 is radio control. It returns an array of 32-bit values.
367 
368    Input byte 0 = 0: Wireless information
369 
370    result[0]: return code
371    result[1]:
372      Bit 0:      Hardware switch supported
373      Bit 1:      Wifi locator supported
374      Bit 2:      Wifi is supported
375      Bit 3:      Bluetooth is supported
376      Bit 4:      WWAN is supported
377      Bit 5:      Wireless keyboard supported
378      Bits 6-7:   Reserved
379      Bit 8:      Wifi is installed
380      Bit 9:      Bluetooth is installed
381      Bit 10:     WWAN is installed
382      Bits 11-15: Reserved
383      Bit 16:     Hardware switch is on
384      Bit 17:     Wifi is blocked
385      Bit 18:     Bluetooth is blocked
386      Bit 19:     WWAN is blocked
387      Bits 20-31: Reserved
388    result[2]: NVRAM size in bytes
389    result[3]: NVRAM format version number
390 
391    Input byte 0 = 2: Wireless switch configuration
392    result[0]: return code
393    result[1]:
394      Bit 0:      Wifi controlled by switch
395      Bit 1:      Bluetooth controlled by switch
396      Bit 2:      WWAN controlled by switch
397      Bits 3-6:   Reserved
398      Bit 7:      Wireless switch config locked
399      Bit 8:      Wifi locator enabled
400      Bits 9-14:  Reserved
401      Bit 15:     Wifi locator setting locked
402      Bits 16-31: Reserved
403 */
404 
dell_rfkill_set(void * data,bool blocked)405 static int dell_rfkill_set(void *data, bool blocked)
406 {
407 	int disable = blocked ? 1 : 0;
408 	unsigned long radio = (unsigned long)data;
409 	int hwswitch_bit = (unsigned long)data - 1;
410 
411 	get_buffer();
412 	dell_send_request(buffer, 17, 11);
413 
414 	/* If the hardware switch controls this radio, and the hardware
415 	   switch is disabled, always disable the radio */
416 	if ((hwswitch_state & BIT(hwswitch_bit)) &&
417 	    !(buffer->output[1] & BIT(16)))
418 		disable = 1;
419 
420 	buffer->input[0] = (1 | (radio<<8) | (disable << 16));
421 	dell_send_request(buffer, 17, 11);
422 
423 	release_buffer();
424 	return 0;
425 }
426 
427 /* Must be called with the buffer held */
dell_rfkill_update_sw_state(struct rfkill * rfkill,int radio,int status)428 static void dell_rfkill_update_sw_state(struct rfkill *rfkill, int radio,
429 					int status)
430 {
431 	if (status & BIT(0)) {
432 		/* Has hw-switch, sync sw_state to BIOS */
433 		int block = rfkill_blocked(rfkill);
434 		buffer->input[0] = (1 | (radio << 8) | (block << 16));
435 		dell_send_request(buffer, 17, 11);
436 	} else {
437 		/* No hw-switch, sync BIOS state to sw_state */
438 		rfkill_set_sw_state(rfkill, !!(status & BIT(radio + 16)));
439 	}
440 }
441 
dell_rfkill_update_hw_state(struct rfkill * rfkill,int radio,int status)442 static void dell_rfkill_update_hw_state(struct rfkill *rfkill, int radio,
443 					int status)
444 {
445 	if (hwswitch_state & (BIT(radio - 1)))
446 		rfkill_set_hw_state(rfkill, !(status & BIT(16)));
447 }
448 
dell_rfkill_query(struct rfkill * rfkill,void * data)449 static void dell_rfkill_query(struct rfkill *rfkill, void *data)
450 {
451 	int status;
452 
453 	get_buffer();
454 	dell_send_request(buffer, 17, 11);
455 	status = buffer->output[1];
456 
457 	dell_rfkill_update_hw_state(rfkill, (unsigned long)data, status);
458 
459 	release_buffer();
460 }
461 
462 static const struct rfkill_ops dell_rfkill_ops = {
463 	.set_block = dell_rfkill_set,
464 	.query = dell_rfkill_query,
465 };
466 
467 static struct dentry *dell_laptop_dir;
468 
dell_debugfs_show(struct seq_file * s,void * data)469 static int dell_debugfs_show(struct seq_file *s, void *data)
470 {
471 	int status;
472 
473 	get_buffer();
474 	dell_send_request(buffer, 17, 11);
475 	status = buffer->output[1];
476 	release_buffer();
477 
478 	seq_printf(s, "status:\t0x%X\n", status);
479 	seq_printf(s, "Bit 0 : Hardware switch supported:   %lu\n",
480 		   status & BIT(0));
481 	seq_printf(s, "Bit 1 : Wifi locator supported:      %lu\n",
482 		  (status & BIT(1)) >> 1);
483 	seq_printf(s, "Bit 2 : Wifi is supported:           %lu\n",
484 		  (status & BIT(2)) >> 2);
485 	seq_printf(s, "Bit 3 : Bluetooth is supported:      %lu\n",
486 		  (status & BIT(3)) >> 3);
487 	seq_printf(s, "Bit 4 : WWAN is supported:           %lu\n",
488 		  (status & BIT(4)) >> 4);
489 	seq_printf(s, "Bit 5 : Wireless keyboard supported: %lu\n",
490 		  (status & BIT(5)) >> 5);
491 	seq_printf(s, "Bit 8 : Wifi is installed:           %lu\n",
492 		  (status & BIT(8)) >> 8);
493 	seq_printf(s, "Bit 9 : Bluetooth is installed:      %lu\n",
494 		  (status & BIT(9)) >> 9);
495 	seq_printf(s, "Bit 10: WWAN is installed:           %lu\n",
496 		  (status & BIT(10)) >> 10);
497 	seq_printf(s, "Bit 16: Hardware switch is on:       %lu\n",
498 		  (status & BIT(16)) >> 16);
499 	seq_printf(s, "Bit 17: Wifi is blocked:             %lu\n",
500 		  (status & BIT(17)) >> 17);
501 	seq_printf(s, "Bit 18: Bluetooth is blocked:        %lu\n",
502 		  (status & BIT(18)) >> 18);
503 	seq_printf(s, "Bit 19: WWAN is blocked:             %lu\n",
504 		  (status & BIT(19)) >> 19);
505 
506 	seq_printf(s, "\nhwswitch_state:\t0x%X\n", hwswitch_state);
507 	seq_printf(s, "Bit 0 : Wifi controlled by switch:      %lu\n",
508 		   hwswitch_state & BIT(0));
509 	seq_printf(s, "Bit 1 : Bluetooth controlled by switch: %lu\n",
510 		   (hwswitch_state & BIT(1)) >> 1);
511 	seq_printf(s, "Bit 2 : WWAN controlled by switch:      %lu\n",
512 		   (hwswitch_state & BIT(2)) >> 2);
513 	seq_printf(s, "Bit 7 : Wireless switch config locked:  %lu\n",
514 		   (hwswitch_state & BIT(7)) >> 7);
515 	seq_printf(s, "Bit 8 : Wifi locator enabled:           %lu\n",
516 		   (hwswitch_state & BIT(8)) >> 8);
517 	seq_printf(s, "Bit 15: Wifi locator setting locked:    %lu\n",
518 		   (hwswitch_state & BIT(15)) >> 15);
519 
520 	return 0;
521 }
522 
dell_debugfs_open(struct inode * inode,struct file * file)523 static int dell_debugfs_open(struct inode *inode, struct file *file)
524 {
525 	return single_open(file, dell_debugfs_show, inode->i_private);
526 }
527 
528 static const struct file_operations dell_debugfs_fops = {
529 	.owner = THIS_MODULE,
530 	.open = dell_debugfs_open,
531 	.read = seq_read,
532 	.llseek = seq_lseek,
533 	.release = single_release,
534 };
535 
dell_update_rfkill(struct work_struct * ignored)536 static void dell_update_rfkill(struct work_struct *ignored)
537 {
538 	int status;
539 
540 	get_buffer();
541 	dell_send_request(buffer, 17, 11);
542 	status = buffer->output[1];
543 
544 	if (wifi_rfkill) {
545 		dell_rfkill_update_hw_state(wifi_rfkill, 1, status);
546 		dell_rfkill_update_sw_state(wifi_rfkill, 1, status);
547 	}
548 	if (bluetooth_rfkill) {
549 		dell_rfkill_update_hw_state(bluetooth_rfkill, 2, status);
550 		dell_rfkill_update_sw_state(bluetooth_rfkill, 2, status);
551 	}
552 	if (wwan_rfkill) {
553 		dell_rfkill_update_hw_state(wwan_rfkill, 3, status);
554 		dell_rfkill_update_sw_state(wwan_rfkill, 3, status);
555 	}
556 
557 	release_buffer();
558 }
559 static DECLARE_DELAYED_WORK(dell_rfkill_work, dell_update_rfkill);
560 
dell_laptop_i8042_filter(unsigned char data,unsigned char str,struct serio * port)561 static bool dell_laptop_i8042_filter(unsigned char data, unsigned char str,
562 			      struct serio *port)
563 {
564 	static bool extended;
565 
566 	if (str & 0x20)
567 		return false;
568 
569 	if (unlikely(data == 0xe0)) {
570 		extended = true;
571 		return false;
572 	} else if (unlikely(extended)) {
573 		switch (data) {
574 		case 0x8:
575 			schedule_delayed_work(&dell_rfkill_work,
576 					      round_jiffies_relative(HZ / 4));
577 			break;
578 		}
579 		extended = false;
580 	}
581 
582 	return false;
583 }
584 
dell_setup_rfkill(void)585 static int __init dell_setup_rfkill(void)
586 {
587 	int status, ret, whitelisted;
588 	const char *product;
589 
590 	/*
591 	 * rfkill support causes trouble on various models, mostly Inspirons.
592 	 * So we whitelist certain series, and don't support rfkill on others.
593 	 */
594 	whitelisted = 0;
595 	product = dmi_get_system_info(DMI_PRODUCT_NAME);
596 	if (product &&  (strncmp(product, "Latitude", 8) == 0 ||
597 			 strncmp(product, "Precision", 9) == 0))
598 		whitelisted = 1;
599 	if (!force_rfkill && !whitelisted)
600 		return 0;
601 
602 	get_buffer();
603 	dell_send_request(buffer, 17, 11);
604 	status = buffer->output[1];
605 	buffer->input[0] = 0x2;
606 	dell_send_request(buffer, 17, 11);
607 	hwswitch_state = buffer->output[1];
608 	release_buffer();
609 
610 	if (!(status & BIT(0))) {
611 		if (force_rfkill) {
612 			/* No hwsitch, clear all hw-controlled bits */
613 			hwswitch_state &= ~7;
614 		} else {
615 			/* rfkill is only tested on laptops with a hwswitch */
616 			return 0;
617 		}
618 	}
619 
620 	if ((status & (1<<2|1<<8)) == (1<<2|1<<8)) {
621 		wifi_rfkill = rfkill_alloc("dell-wifi", &platform_device->dev,
622 					   RFKILL_TYPE_WLAN,
623 					   &dell_rfkill_ops, (void *) 1);
624 		if (!wifi_rfkill) {
625 			ret = -ENOMEM;
626 			goto err_wifi;
627 		}
628 		ret = rfkill_register(wifi_rfkill);
629 		if (ret)
630 			goto err_wifi;
631 	}
632 
633 	if ((status & (1<<3|1<<9)) == (1<<3|1<<9)) {
634 		bluetooth_rfkill = rfkill_alloc("dell-bluetooth",
635 						&platform_device->dev,
636 						RFKILL_TYPE_BLUETOOTH,
637 						&dell_rfkill_ops, (void *) 2);
638 		if (!bluetooth_rfkill) {
639 			ret = -ENOMEM;
640 			goto err_bluetooth;
641 		}
642 		ret = rfkill_register(bluetooth_rfkill);
643 		if (ret)
644 			goto err_bluetooth;
645 	}
646 
647 	if ((status & (1<<4|1<<10)) == (1<<4|1<<10)) {
648 		wwan_rfkill = rfkill_alloc("dell-wwan",
649 					   &platform_device->dev,
650 					   RFKILL_TYPE_WWAN,
651 					   &dell_rfkill_ops, (void *) 3);
652 		if (!wwan_rfkill) {
653 			ret = -ENOMEM;
654 			goto err_wwan;
655 		}
656 		ret = rfkill_register(wwan_rfkill);
657 		if (ret)
658 			goto err_wwan;
659 	}
660 
661 	ret = i8042_install_filter(dell_laptop_i8042_filter);
662 	if (ret) {
663 		pr_warn("Unable to install key filter\n");
664 		goto err_filter;
665 	}
666 
667 	return 0;
668 err_filter:
669 	if (wwan_rfkill)
670 		rfkill_unregister(wwan_rfkill);
671 err_wwan:
672 	rfkill_destroy(wwan_rfkill);
673 	if (bluetooth_rfkill)
674 		rfkill_unregister(bluetooth_rfkill);
675 err_bluetooth:
676 	rfkill_destroy(bluetooth_rfkill);
677 	if (wifi_rfkill)
678 		rfkill_unregister(wifi_rfkill);
679 err_wifi:
680 	rfkill_destroy(wifi_rfkill);
681 
682 	return ret;
683 }
684 
dell_cleanup_rfkill(void)685 static void dell_cleanup_rfkill(void)
686 {
687 	if (wifi_rfkill) {
688 		rfkill_unregister(wifi_rfkill);
689 		rfkill_destroy(wifi_rfkill);
690 	}
691 	if (bluetooth_rfkill) {
692 		rfkill_unregister(bluetooth_rfkill);
693 		rfkill_destroy(bluetooth_rfkill);
694 	}
695 	if (wwan_rfkill) {
696 		rfkill_unregister(wwan_rfkill);
697 		rfkill_destroy(wwan_rfkill);
698 	}
699 }
700 
dell_send_intensity(struct backlight_device * bd)701 static int dell_send_intensity(struct backlight_device *bd)
702 {
703 	int ret = 0;
704 
705 	get_buffer();
706 	buffer->input[0] = find_token_location(BRIGHTNESS_TOKEN);
707 	buffer->input[1] = bd->props.brightness;
708 
709 	if (buffer->input[0] == -1) {
710 		ret = -ENODEV;
711 		goto out;
712 	}
713 
714 	if (power_supply_is_system_supplied() > 0)
715 		dell_send_request(buffer, 1, 2);
716 	else
717 		dell_send_request(buffer, 1, 1);
718 
719 out:
720 	release_buffer();
721 	return ret;
722 }
723 
dell_get_intensity(struct backlight_device * bd)724 static int dell_get_intensity(struct backlight_device *bd)
725 {
726 	int ret = 0;
727 
728 	get_buffer();
729 	buffer->input[0] = find_token_location(BRIGHTNESS_TOKEN);
730 
731 	if (buffer->input[0] == -1) {
732 		ret = -ENODEV;
733 		goto out;
734 	}
735 
736 	if (power_supply_is_system_supplied() > 0)
737 		dell_send_request(buffer, 0, 2);
738 	else
739 		dell_send_request(buffer, 0, 1);
740 
741 	ret = buffer->output[1];
742 
743 out:
744 	release_buffer();
745 	return ret;
746 }
747 
748 static const struct backlight_ops dell_ops = {
749 	.get_brightness = dell_get_intensity,
750 	.update_status  = dell_send_intensity,
751 };
752 
touchpad_led_on(void)753 static void touchpad_led_on(void)
754 {
755 	int command = 0x97;
756 	char data = 1;
757 	i8042_command(&data, command | 1 << 12);
758 }
759 
touchpad_led_off(void)760 static void touchpad_led_off(void)
761 {
762 	int command = 0x97;
763 	char data = 2;
764 	i8042_command(&data, command | 1 << 12);
765 }
766 
touchpad_led_set(struct led_classdev * led_cdev,enum led_brightness value)767 static void touchpad_led_set(struct led_classdev *led_cdev,
768 	enum led_brightness value)
769 {
770 	if (value > 0)
771 		touchpad_led_on();
772 	else
773 		touchpad_led_off();
774 }
775 
776 static struct led_classdev touchpad_led = {
777 	.name = "dell-laptop::touchpad",
778 	.brightness_set = touchpad_led_set,
779 	.flags = LED_CORE_SUSPENDRESUME,
780 };
781 
touchpad_led_init(struct device * dev)782 static int __init touchpad_led_init(struct device *dev)
783 {
784 	return led_classdev_register(dev, &touchpad_led);
785 }
786 
touchpad_led_exit(void)787 static void touchpad_led_exit(void)
788 {
789 	led_classdev_unregister(&touchpad_led);
790 }
791 
dell_init(void)792 static int __init dell_init(void)
793 {
794 	int max_intensity = 0;
795 	int ret;
796 
797 	if (!dmi_check_system(dell_device_table))
798 		return -ENODEV;
799 
800 	quirks = NULL;
801 	/* find if this machine support other functions */
802 	dmi_check_system(dell_quirks);
803 
804 	dmi_walk(find_tokens, NULL);
805 
806 	if (!da_tokens)  {
807 		pr_info("Unable to find dmi tokens\n");
808 		return -ENODEV;
809 	}
810 
811 	ret = platform_driver_register(&platform_driver);
812 	if (ret)
813 		goto fail_platform_driver;
814 	platform_device = platform_device_alloc("dell-laptop", -1);
815 	if (!platform_device) {
816 		ret = -ENOMEM;
817 		goto fail_platform_device1;
818 	}
819 	ret = platform_device_add(platform_device);
820 	if (ret)
821 		goto fail_platform_device2;
822 
823 	/*
824 	 * Allocate buffer below 4GB for SMI data--only 32-bit physical addr
825 	 * is passed to SMI handler.
826 	 */
827 	buffer = (void *)__get_free_page(GFP_KERNEL | GFP_DMA32);
828 	if (!buffer) {
829 		ret = -ENOMEM;
830 		goto fail_buffer;
831 	}
832 
833 	ret = dell_setup_rfkill();
834 
835 	if (ret) {
836 		pr_warn("Unable to setup rfkill\n");
837 		goto fail_rfkill;
838 	}
839 
840 	if (quirks && quirks->touchpad_led)
841 		touchpad_led_init(&platform_device->dev);
842 
843 	dell_laptop_dir = debugfs_create_dir("dell_laptop", NULL);
844 	if (dell_laptop_dir != NULL)
845 		debugfs_create_file("rfkill", 0444, dell_laptop_dir, NULL,
846 				    &dell_debugfs_fops);
847 
848 #ifdef CONFIG_ACPI
849 	/* In the event of an ACPI backlight being available, don't
850 	 * register the platform controller.
851 	 */
852 	if (acpi_video_backlight_support())
853 		return 0;
854 #endif
855 
856 	get_buffer();
857 	buffer->input[0] = find_token_location(BRIGHTNESS_TOKEN);
858 	if (buffer->input[0] != -1) {
859 		dell_send_request(buffer, 0, 2);
860 		max_intensity = buffer->output[3];
861 	}
862 	release_buffer();
863 
864 	if (max_intensity) {
865 		struct backlight_properties props;
866 		memset(&props, 0, sizeof(struct backlight_properties));
867 		props.type = BACKLIGHT_PLATFORM;
868 		props.max_brightness = max_intensity;
869 		dell_backlight_device = backlight_device_register("dell_backlight",
870 								  &platform_device->dev,
871 								  NULL,
872 								  &dell_ops,
873 								  &props);
874 
875 		if (IS_ERR(dell_backlight_device)) {
876 			ret = PTR_ERR(dell_backlight_device);
877 			dell_backlight_device = NULL;
878 			goto fail_backlight;
879 		}
880 
881 		dell_backlight_device->props.brightness =
882 			dell_get_intensity(dell_backlight_device);
883 		backlight_update_status(dell_backlight_device);
884 	}
885 
886 	return 0;
887 
888 fail_backlight:
889 	i8042_remove_filter(dell_laptop_i8042_filter);
890 	cancel_delayed_work_sync(&dell_rfkill_work);
891 	dell_cleanup_rfkill();
892 fail_rfkill:
893 	free_page((unsigned long)buffer);
894 fail_buffer:
895 	platform_device_del(platform_device);
896 fail_platform_device2:
897 	platform_device_put(platform_device);
898 fail_platform_device1:
899 	platform_driver_unregister(&platform_driver);
900 fail_platform_driver:
901 	kfree(da_tokens);
902 	return ret;
903 }
904 
dell_exit(void)905 static void __exit dell_exit(void)
906 {
907 	debugfs_remove_recursive(dell_laptop_dir);
908 	if (quirks && quirks->touchpad_led)
909 		touchpad_led_exit();
910 	i8042_remove_filter(dell_laptop_i8042_filter);
911 	cancel_delayed_work_sync(&dell_rfkill_work);
912 	backlight_device_unregister(dell_backlight_device);
913 	dell_cleanup_rfkill();
914 	if (platform_device) {
915 		platform_device_unregister(platform_device);
916 		platform_driver_unregister(&platform_driver);
917 	}
918 	kfree(da_tokens);
919 	free_page((unsigned long)buffer);
920 }
921 
922 module_init(dell_init);
923 module_exit(dell_exit);
924 
925 MODULE_AUTHOR("Matthew Garrett <mjg@redhat.com>");
926 MODULE_DESCRIPTION("Dell laptop driver");
927 MODULE_LICENSE("GPL");
928