11019b937SGuillaume Douézan-Grard // SPDX-License-Identifier: GPL-2.0
29caeb532SHerton Ronaldo Krzesinski /*
32c531437SGuillaume Douézan-Grard  * Topstar Laptop ACPI Extras driver
49caeb532SHerton Ronaldo Krzesinski  *
59caeb532SHerton Ronaldo Krzesinski  * Copyright (c) 2009 Herton Ronaldo Krzesinski <herton@mandriva.com.br>
67a580200SGuillaume Douézan-Grard  * Copyright (c) 2018 Guillaume Douézan-Grard
79caeb532SHerton Ronaldo Krzesinski  *
89caeb532SHerton Ronaldo Krzesinski  * Implementation inspired by existing x86 platform drivers, in special
97a580200SGuillaume Douézan-Grard  * asus/eepc/fujitsu-laptop, thanks to their authors.
109caeb532SHerton Ronaldo Krzesinski  */
119caeb532SHerton Ronaldo Krzesinski 
129caeb532SHerton Ronaldo Krzesinski #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
139caeb532SHerton Ronaldo Krzesinski 
149caeb532SHerton Ronaldo Krzesinski #include <linux/kernel.h>
159caeb532SHerton Ronaldo Krzesinski #include <linux/module.h>
169caeb532SHerton Ronaldo Krzesinski #include <linux/init.h>
175a0e3ad6STejun Heo #include <linux/slab.h>
189caeb532SHerton Ronaldo Krzesinski #include <linux/acpi.h>
19bf8f65daSGuillaume Douézan-Grard #include <linux/dmi.h>
209caeb532SHerton Ronaldo Krzesinski #include <linux/input.h>
2197490f1cSDmitry Torokhov #include <linux/input/sparse-keymap.h>
22bf8f65daSGuillaume Douézan-Grard #include <linux/leds.h>
232c531437SGuillaume Douézan-Grard #include <linux/platform_device.h>
249caeb532SHerton Ronaldo Krzesinski 
2566aa0d60SGuillaume Douézan-Grard #define TOPSTAR_LAPTOP_CLASS "topstar"
269caeb532SHerton Ronaldo Krzesinski 
2766aa0d60SGuillaume Douézan-Grard struct topstar_laptop {
283093ced2SGuillaume Douézan-Grard 	struct acpi_device *device;
292c531437SGuillaume Douézan-Grard 	struct platform_device *platform;
3066aa0d60SGuillaume Douézan-Grard 	struct input_dev *input;
31bf8f65daSGuillaume Douézan-Grard 	struct led_classdev led;
329caeb532SHerton Ronaldo Krzesinski };
339caeb532SHerton Ronaldo Krzesinski 
343093ced2SGuillaume Douézan-Grard /*
35bf8f65daSGuillaume Douézan-Grard  * LED
36bf8f65daSGuillaume Douézan-Grard  */
37bf8f65daSGuillaume Douézan-Grard 
topstar_led_get(struct led_classdev * led)38bf8f65daSGuillaume Douézan-Grard static enum led_brightness topstar_led_get(struct led_classdev *led)
39bf8f65daSGuillaume Douézan-Grard {
40bf8f65daSGuillaume Douézan-Grard 	return led->brightness;
41bf8f65daSGuillaume Douézan-Grard }
42bf8f65daSGuillaume Douézan-Grard 
topstar_led_set(struct led_classdev * led,enum led_brightness state)43bf8f65daSGuillaume Douézan-Grard static int topstar_led_set(struct led_classdev *led,
44bf8f65daSGuillaume Douézan-Grard 		enum led_brightness state)
45bf8f65daSGuillaume Douézan-Grard {
46bf8f65daSGuillaume Douézan-Grard 	struct topstar_laptop *topstar = container_of(led,
47bf8f65daSGuillaume Douézan-Grard 			struct topstar_laptop, led);
48bf8f65daSGuillaume Douézan-Grard 
49bf8f65daSGuillaume Douézan-Grard 	struct acpi_object_list params;
50bf8f65daSGuillaume Douézan-Grard 	union acpi_object in_obj;
51bf8f65daSGuillaume Douézan-Grard 	unsigned long long int ret;
52bf8f65daSGuillaume Douézan-Grard 	acpi_status status;
53bf8f65daSGuillaume Douézan-Grard 
54bf8f65daSGuillaume Douézan-Grard 	params.count = 1;
55bf8f65daSGuillaume Douézan-Grard 	params.pointer = &in_obj;
56bf8f65daSGuillaume Douézan-Grard 	in_obj.type = ACPI_TYPE_INTEGER;
57bf8f65daSGuillaume Douézan-Grard 	in_obj.integer.value = 0x83;
58bf8f65daSGuillaume Douézan-Grard 
59bf8f65daSGuillaume Douézan-Grard 	/*
60bf8f65daSGuillaume Douézan-Grard 	 * Topstar ACPI returns 0x30001 when the LED is ON and 0x30000 when it
61bf8f65daSGuillaume Douézan-Grard 	 * is OFF.
62bf8f65daSGuillaume Douézan-Grard 	 */
63bf8f65daSGuillaume Douézan-Grard 	status = acpi_evaluate_integer(topstar->device->handle,
64bf8f65daSGuillaume Douézan-Grard 			"GETX", &params, &ret);
65bf8f65daSGuillaume Douézan-Grard 	if (ACPI_FAILURE(status))
66bf8f65daSGuillaume Douézan-Grard 		return -1;
67bf8f65daSGuillaume Douézan-Grard 
68bf8f65daSGuillaume Douézan-Grard 	/*
69bf8f65daSGuillaume Douézan-Grard 	 * FNCX(0x83) toggles the LED (more precisely, it is supposed to
70bf8f65daSGuillaume Douézan-Grard 	 * act as an hardware switch and disconnect the WLAN adapter but
71bf8f65daSGuillaume Douézan-Grard 	 * it seems to be faulty on some models like the Topstar U931
72bf8f65daSGuillaume Douézan-Grard 	 * Notebook).
73bf8f65daSGuillaume Douézan-Grard 	 */
74bf8f65daSGuillaume Douézan-Grard 	if ((ret == 0x30001 && state == LED_OFF)
75bf8f65daSGuillaume Douézan-Grard 			|| (ret == 0x30000 && state != LED_OFF)) {
76bf8f65daSGuillaume Douézan-Grard 		status = acpi_execute_simple_method(topstar->device->handle,
77bf8f65daSGuillaume Douézan-Grard 				"FNCX", 0x83);
78bf8f65daSGuillaume Douézan-Grard 		if (ACPI_FAILURE(status))
79bf8f65daSGuillaume Douézan-Grard 			return -1;
80bf8f65daSGuillaume Douézan-Grard 	}
81bf8f65daSGuillaume Douézan-Grard 
82bf8f65daSGuillaume Douézan-Grard 	return 0;
83bf8f65daSGuillaume Douézan-Grard }
84bf8f65daSGuillaume Douézan-Grard 
topstar_led_init(struct topstar_laptop * topstar)85bf8f65daSGuillaume Douézan-Grard static int topstar_led_init(struct topstar_laptop *topstar)
86bf8f65daSGuillaume Douézan-Grard {
87bf8f65daSGuillaume Douézan-Grard 	topstar->led = (struct led_classdev) {
88bf8f65daSGuillaume Douézan-Grard 		.default_trigger = "rfkill0",
89bf8f65daSGuillaume Douézan-Grard 		.brightness_get = topstar_led_get,
90bf8f65daSGuillaume Douézan-Grard 		.brightness_set_blocking = topstar_led_set,
91bf8f65daSGuillaume Douézan-Grard 		.name = TOPSTAR_LAPTOP_CLASS "::wlan",
92bf8f65daSGuillaume Douézan-Grard 	};
93bf8f65daSGuillaume Douézan-Grard 
94bf8f65daSGuillaume Douézan-Grard 	return led_classdev_register(&topstar->platform->dev, &topstar->led);
95bf8f65daSGuillaume Douézan-Grard }
96bf8f65daSGuillaume Douézan-Grard 
topstar_led_exit(struct topstar_laptop * topstar)97bf8f65daSGuillaume Douézan-Grard static void topstar_led_exit(struct topstar_laptop *topstar)
98bf8f65daSGuillaume Douézan-Grard {
99bf8f65daSGuillaume Douézan-Grard 	led_classdev_unregister(&topstar->led);
100bf8f65daSGuillaume Douézan-Grard }
101bf8f65daSGuillaume Douézan-Grard 
102bf8f65daSGuillaume Douézan-Grard /*
1033093ced2SGuillaume Douézan-Grard  * Input
1043093ced2SGuillaume Douézan-Grard  */
1053093ced2SGuillaume Douézan-Grard 
10697490f1cSDmitry Torokhov static const struct key_entry topstar_keymap[] = {
10797490f1cSDmitry Torokhov 	{ KE_KEY, 0x80, { KEY_BRIGHTNESSUP } },
10897490f1cSDmitry Torokhov 	{ KE_KEY, 0x81, { KEY_BRIGHTNESSDOWN } },
10997490f1cSDmitry Torokhov 	{ KE_KEY, 0x83, { KEY_VOLUMEUP } },
11097490f1cSDmitry Torokhov 	{ KE_KEY, 0x84, { KEY_VOLUMEDOWN } },
11197490f1cSDmitry Torokhov 	{ KE_KEY, 0x85, { KEY_MUTE } },
11297490f1cSDmitry Torokhov 	{ KE_KEY, 0x86, { KEY_SWITCHVIDEOMODE } },
11397490f1cSDmitry Torokhov 	{ KE_KEY, 0x87, { KEY_F13 } }, /* touchpad enable/disable key */
11497490f1cSDmitry Torokhov 	{ KE_KEY, 0x88, { KEY_WLAN } },
11597490f1cSDmitry Torokhov 	{ KE_KEY, 0x8a, { KEY_WWW } },
11697490f1cSDmitry Torokhov 	{ KE_KEY, 0x8b, { KEY_MAIL } },
11797490f1cSDmitry Torokhov 	{ KE_KEY, 0x8c, { KEY_MEDIA } },
11897490f1cSDmitry Torokhov 
11997490f1cSDmitry Torokhov 	/* Known non hotkey events don't handled or that we don't care yet */
120bd038080SManuel Lauss 	{ KE_IGNORE, 0x82, }, /* backlight event */
12197490f1cSDmitry Torokhov 	{ KE_IGNORE, 0x8e, },
12297490f1cSDmitry Torokhov 	{ KE_IGNORE, 0x8f, },
12397490f1cSDmitry Torokhov 	{ KE_IGNORE, 0x90, },
12497490f1cSDmitry Torokhov 
12597490f1cSDmitry Torokhov 	/*
12697490f1cSDmitry Torokhov 	 * 'G key' generate two event codes, convert to only
12797490f1cSDmitry Torokhov 	 * one event/key code for now, consider replacing by
12897490f1cSDmitry Torokhov 	 * a switch (3G switch - SW_3G?)
12997490f1cSDmitry Torokhov 	 */
13097490f1cSDmitry Torokhov 	{ KE_KEY, 0x96, { KEY_F14 } },
13197490f1cSDmitry Torokhov 	{ KE_KEY, 0x97, { KEY_F14 } },
13297490f1cSDmitry Torokhov 
13397490f1cSDmitry Torokhov 	{ KE_END, 0 }
1349caeb532SHerton Ronaldo Krzesinski };
1359caeb532SHerton Ronaldo Krzesinski 
topstar_input_notify(struct topstar_laptop * topstar,int event)1363093ced2SGuillaume Douézan-Grard static void topstar_input_notify(struct topstar_laptop *topstar, int event)
1379caeb532SHerton Ronaldo Krzesinski {
13866aa0d60SGuillaume Douézan-Grard 	if (!sparse_keymap_report_event(topstar->input, event, 1, true))
1399caeb532SHerton Ronaldo Krzesinski 		pr_info("unknown event = 0x%02x\n", event);
1409caeb532SHerton Ronaldo Krzesinski }
1419caeb532SHerton Ronaldo Krzesinski 
topstar_input_init(struct topstar_laptop * topstar)14266aa0d60SGuillaume Douézan-Grard static int topstar_input_init(struct topstar_laptop *topstar)
1439caeb532SHerton Ronaldo Krzesinski {
14497490f1cSDmitry Torokhov 	struct input_dev *input;
14566aa0d60SGuillaume Douézan-Grard 	int err;
1469caeb532SHerton Ronaldo Krzesinski 
14797490f1cSDmitry Torokhov 	input = input_allocate_device();
148b222cca6SJoe Perches 	if (!input)
14997490f1cSDmitry Torokhov 		return -ENOMEM;
1509caeb532SHerton Ronaldo Krzesinski 
15197490f1cSDmitry Torokhov 	input->name = "Topstar Laptop extra buttons";
15266aa0d60SGuillaume Douézan-Grard 	input->phys = TOPSTAR_LAPTOP_CLASS "/input0";
15397490f1cSDmitry Torokhov 	input->id.bustype = BUS_HOST;
1542c531437SGuillaume Douézan-Grard 	input->dev.parent = &topstar->platform->dev;
15597490f1cSDmitry Torokhov 
15666aa0d60SGuillaume Douézan-Grard 	err = sparse_keymap_setup(input, topstar_keymap, NULL);
15766aa0d60SGuillaume Douézan-Grard 	if (err) {
15897490f1cSDmitry Torokhov 		pr_err("Unable to setup input device keymap\n");
15997490f1cSDmitry Torokhov 		goto err_free_dev;
16097490f1cSDmitry Torokhov 	}
16197490f1cSDmitry Torokhov 
16266aa0d60SGuillaume Douézan-Grard 	err = input_register_device(input);
16366aa0d60SGuillaume Douézan-Grard 	if (err) {
16497490f1cSDmitry Torokhov 		pr_err("Unable to register input device\n");
1653f2e1a32SMichał Kępień 		goto err_free_dev;
16697490f1cSDmitry Torokhov 	}
16797490f1cSDmitry Torokhov 
16866aa0d60SGuillaume Douézan-Grard 	topstar->input = input;
1699caeb532SHerton Ronaldo Krzesinski 	return 0;
17097490f1cSDmitry Torokhov 
17197490f1cSDmitry Torokhov err_free_dev:
17297490f1cSDmitry Torokhov 	input_free_device(input);
17366aa0d60SGuillaume Douézan-Grard 	return err;
1749caeb532SHerton Ronaldo Krzesinski }
1759caeb532SHerton Ronaldo Krzesinski 
topstar_input_exit(struct topstar_laptop * topstar)1763093ced2SGuillaume Douézan-Grard static void topstar_input_exit(struct topstar_laptop *topstar)
1773093ced2SGuillaume Douézan-Grard {
1783093ced2SGuillaume Douézan-Grard 	input_unregister_device(topstar->input);
1793093ced2SGuillaume Douézan-Grard }
1803093ced2SGuillaume Douézan-Grard 
1813093ced2SGuillaume Douézan-Grard /*
1822c531437SGuillaume Douézan-Grard  * Platform
1832c531437SGuillaume Douézan-Grard  */
1842c531437SGuillaume Douézan-Grard 
1852c531437SGuillaume Douézan-Grard static struct platform_driver topstar_platform_driver = {
1862c531437SGuillaume Douézan-Grard 	.driver = {
1872c531437SGuillaume Douézan-Grard 		.name = TOPSTAR_LAPTOP_CLASS,
1882c531437SGuillaume Douézan-Grard 	},
1892c531437SGuillaume Douézan-Grard };
1902c531437SGuillaume Douézan-Grard 
topstar_platform_init(struct topstar_laptop * topstar)1912c531437SGuillaume Douézan-Grard static int topstar_platform_init(struct topstar_laptop *topstar)
1922c531437SGuillaume Douézan-Grard {
1932c531437SGuillaume Douézan-Grard 	int err;
1942c531437SGuillaume Douézan-Grard 
1958d05fc03SBarnabás Pőcze 	topstar->platform = platform_device_alloc(TOPSTAR_LAPTOP_CLASS, PLATFORM_DEVID_NONE);
1962c531437SGuillaume Douézan-Grard 	if (!topstar->platform)
1972c531437SGuillaume Douézan-Grard 		return -ENOMEM;
1982c531437SGuillaume Douézan-Grard 
1992c531437SGuillaume Douézan-Grard 	platform_set_drvdata(topstar->platform, topstar);
2002c531437SGuillaume Douézan-Grard 
2012c531437SGuillaume Douézan-Grard 	err = platform_device_add(topstar->platform);
2022c531437SGuillaume Douézan-Grard 	if (err)
2032c531437SGuillaume Douézan-Grard 		goto err_device_put;
2042c531437SGuillaume Douézan-Grard 
2052c531437SGuillaume Douézan-Grard 	return 0;
2062c531437SGuillaume Douézan-Grard 
2072c531437SGuillaume Douézan-Grard err_device_put:
2082c531437SGuillaume Douézan-Grard 	platform_device_put(topstar->platform);
2092c531437SGuillaume Douézan-Grard 	return err;
2102c531437SGuillaume Douézan-Grard }
2112c531437SGuillaume Douézan-Grard 
topstar_platform_exit(struct topstar_laptop * topstar)2122c531437SGuillaume Douézan-Grard static void topstar_platform_exit(struct topstar_laptop *topstar)
2132c531437SGuillaume Douézan-Grard {
2142c531437SGuillaume Douézan-Grard 	platform_device_unregister(topstar->platform);
2152c531437SGuillaume Douézan-Grard }
2162c531437SGuillaume Douézan-Grard 
2172c531437SGuillaume Douézan-Grard /*
2183093ced2SGuillaume Douézan-Grard  * ACPI
2193093ced2SGuillaume Douézan-Grard  */
2203093ced2SGuillaume Douézan-Grard 
topstar_acpi_fncx_switch(struct acpi_device * device,bool state)2213093ced2SGuillaume Douézan-Grard static int topstar_acpi_fncx_switch(struct acpi_device *device, bool state)
2223093ced2SGuillaume Douézan-Grard {
2233093ced2SGuillaume Douézan-Grard 	acpi_status status;
2243093ced2SGuillaume Douézan-Grard 	u64 arg = state ? 0x86 : 0x87;
2253093ced2SGuillaume Douézan-Grard 
2263093ced2SGuillaume Douézan-Grard 	status = acpi_execute_simple_method(device->handle, "FNCX", arg);
2273093ced2SGuillaume Douézan-Grard 	if (ACPI_FAILURE(status)) {
2283093ced2SGuillaume Douézan-Grard 		pr_err("Unable to switch FNCX notifications\n");
2293093ced2SGuillaume Douézan-Grard 		return -ENODEV;
2303093ced2SGuillaume Douézan-Grard 	}
2313093ced2SGuillaume Douézan-Grard 
2323093ced2SGuillaume Douézan-Grard 	return 0;
2333093ced2SGuillaume Douézan-Grard }
2343093ced2SGuillaume Douézan-Grard 
topstar_acpi_notify(struct acpi_device * device,u32 event)2353093ced2SGuillaume Douézan-Grard static void topstar_acpi_notify(struct acpi_device *device, u32 event)
2363093ced2SGuillaume Douézan-Grard {
2373093ced2SGuillaume Douézan-Grard 	struct topstar_laptop *topstar = acpi_driver_data(device);
2383093ced2SGuillaume Douézan-Grard 	static bool dup_evnt[2];
2393093ced2SGuillaume Douézan-Grard 	bool *dup;
2403093ced2SGuillaume Douézan-Grard 
2413093ced2SGuillaume Douézan-Grard 	/* 0x83 and 0x84 key events comes duplicated... */
2423093ced2SGuillaume Douézan-Grard 	if (event == 0x83 || event == 0x84) {
2433093ced2SGuillaume Douézan-Grard 		dup = &dup_evnt[event - 0x83];
2443093ced2SGuillaume Douézan-Grard 		if (*dup) {
2453093ced2SGuillaume Douézan-Grard 			*dup = false;
2463093ced2SGuillaume Douézan-Grard 			return;
2473093ced2SGuillaume Douézan-Grard 		}
2483093ced2SGuillaume Douézan-Grard 		*dup = true;
2493093ced2SGuillaume Douézan-Grard 	}
2503093ced2SGuillaume Douézan-Grard 
2513093ced2SGuillaume Douézan-Grard 	topstar_input_notify(topstar, event);
2523093ced2SGuillaume Douézan-Grard }
2533093ced2SGuillaume Douézan-Grard 
topstar_acpi_init(struct topstar_laptop * topstar)2543093ced2SGuillaume Douézan-Grard static int topstar_acpi_init(struct topstar_laptop *topstar)
2553093ced2SGuillaume Douézan-Grard {
2563093ced2SGuillaume Douézan-Grard 	return topstar_acpi_fncx_switch(topstar->device, true);
2573093ced2SGuillaume Douézan-Grard }
2583093ced2SGuillaume Douézan-Grard 
topstar_acpi_exit(struct topstar_laptop * topstar)2593093ced2SGuillaume Douézan-Grard static void topstar_acpi_exit(struct topstar_laptop *topstar)
2603093ced2SGuillaume Douézan-Grard {
2613093ced2SGuillaume Douézan-Grard 	topstar_acpi_fncx_switch(topstar->device, false);
2623093ced2SGuillaume Douézan-Grard }
2633093ced2SGuillaume Douézan-Grard 
264bf8f65daSGuillaume Douézan-Grard /*
265bf8f65daSGuillaume Douézan-Grard  * Enable software-based WLAN LED control on systems with defective
266bf8f65daSGuillaume Douézan-Grard  * hardware switch.
267bf8f65daSGuillaume Douézan-Grard  */
268bf8f65daSGuillaume Douézan-Grard static bool led_workaround;
269bf8f65daSGuillaume Douézan-Grard 
dmi_led_workaround(const struct dmi_system_id * id)270bf8f65daSGuillaume Douézan-Grard static int dmi_led_workaround(const struct dmi_system_id *id)
271bf8f65daSGuillaume Douézan-Grard {
272bf8f65daSGuillaume Douézan-Grard 	led_workaround = true;
273bf8f65daSGuillaume Douézan-Grard 	return 0;
274bf8f65daSGuillaume Douézan-Grard }
275bf8f65daSGuillaume Douézan-Grard 
276bf8f65daSGuillaume Douézan-Grard static const struct dmi_system_id topstar_dmi_ids[] = {
277bf8f65daSGuillaume Douézan-Grard 	{
278bf8f65daSGuillaume Douézan-Grard 		.callback = dmi_led_workaround,
279bf8f65daSGuillaume Douézan-Grard 		.ident = "Topstar U931/RVP7",
280bf8f65daSGuillaume Douézan-Grard 		.matches = {
281bf8f65daSGuillaume Douézan-Grard 			DMI_MATCH(DMI_BOARD_NAME, "U931"),
282bf8f65daSGuillaume Douézan-Grard 			DMI_MATCH(DMI_BOARD_VERSION, "RVP7"),
283bf8f65daSGuillaume Douézan-Grard 		},
284bf8f65daSGuillaume Douézan-Grard 	},
285bf8f65daSGuillaume Douézan-Grard 	{}
286bf8f65daSGuillaume Douézan-Grard };
287bf8f65daSGuillaume Douézan-Grard 
topstar_acpi_add(struct acpi_device * device)28866aa0d60SGuillaume Douézan-Grard static int topstar_acpi_add(struct acpi_device *device)
2899caeb532SHerton Ronaldo Krzesinski {
29066aa0d60SGuillaume Douézan-Grard 	struct topstar_laptop *topstar;
2913093ced2SGuillaume Douézan-Grard 	int err;
2929caeb532SHerton Ronaldo Krzesinski 
293bf8f65daSGuillaume Douézan-Grard 	dmi_check_system(topstar_dmi_ids);
294bf8f65daSGuillaume Douézan-Grard 
29566aa0d60SGuillaume Douézan-Grard 	topstar = kzalloc(sizeof(struct topstar_laptop), GFP_KERNEL);
29666aa0d60SGuillaume Douézan-Grard 	if (!topstar)
2979caeb532SHerton Ronaldo Krzesinski 		return -ENOMEM;
2989caeb532SHerton Ronaldo Krzesinski 
2999caeb532SHerton Ronaldo Krzesinski 	strcpy(acpi_device_name(device), "Topstar TPSACPI");
30066aa0d60SGuillaume Douézan-Grard 	strcpy(acpi_device_class(device), TOPSTAR_LAPTOP_CLASS);
30166aa0d60SGuillaume Douézan-Grard 	device->driver_data = topstar;
3023093ced2SGuillaume Douézan-Grard 	topstar->device = device;
3033093ced2SGuillaume Douézan-Grard 
3043093ced2SGuillaume Douézan-Grard 	err = topstar_acpi_init(topstar);
3053093ced2SGuillaume Douézan-Grard 	if (err)
3063093ced2SGuillaume Douézan-Grard 		goto err_free;
3073093ced2SGuillaume Douézan-Grard 
3082c531437SGuillaume Douézan-Grard 	err = topstar_platform_init(topstar);
3093093ced2SGuillaume Douézan-Grard 	if (err)
3103093ced2SGuillaume Douézan-Grard 		goto err_acpi_exit;
3113093ced2SGuillaume Douézan-Grard 
3122c531437SGuillaume Douézan-Grard 	err = topstar_input_init(topstar);
3132c531437SGuillaume Douézan-Grard 	if (err)
3142c531437SGuillaume Douézan-Grard 		goto err_platform_exit;
3152c531437SGuillaume Douézan-Grard 
316bf8f65daSGuillaume Douézan-Grard 	if (led_workaround) {
317bf8f65daSGuillaume Douézan-Grard 		err = topstar_led_init(topstar);
318bf8f65daSGuillaume Douézan-Grard 		if (err)
319bf8f65daSGuillaume Douézan-Grard 			goto err_input_exit;
320bf8f65daSGuillaume Douézan-Grard 	}
321bf8f65daSGuillaume Douézan-Grard 
3229caeb532SHerton Ronaldo Krzesinski 	return 0;
3239caeb532SHerton Ronaldo Krzesinski 
324bf8f65daSGuillaume Douézan-Grard err_input_exit:
325bf8f65daSGuillaume Douézan-Grard 	topstar_input_exit(topstar);
3262c531437SGuillaume Douézan-Grard err_platform_exit:
3272c531437SGuillaume Douézan-Grard 	topstar_platform_exit(topstar);
3283093ced2SGuillaume Douézan-Grard err_acpi_exit:
3293093ced2SGuillaume Douézan-Grard 	topstar_acpi_exit(topstar);
33066aa0d60SGuillaume Douézan-Grard err_free:
33166aa0d60SGuillaume Douézan-Grard 	kfree(topstar);
3323093ced2SGuillaume Douézan-Grard 	return err;
3339caeb532SHerton Ronaldo Krzesinski }
3349caeb532SHerton Ronaldo Krzesinski 
topstar_acpi_remove(struct acpi_device * device)335*6c0eb5baSDawei Li static void topstar_acpi_remove(struct acpi_device *device)
3369caeb532SHerton Ronaldo Krzesinski {
33766aa0d60SGuillaume Douézan-Grard 	struct topstar_laptop *topstar = acpi_driver_data(device);
3389caeb532SHerton Ronaldo Krzesinski 
339bf8f65daSGuillaume Douézan-Grard 	if (led_workaround)
340bf8f65daSGuillaume Douézan-Grard 		topstar_led_exit(topstar);
341bf8f65daSGuillaume Douézan-Grard 
3423093ced2SGuillaume Douézan-Grard 	topstar_input_exit(topstar);
3432c531437SGuillaume Douézan-Grard 	topstar_platform_exit(topstar);
3443093ced2SGuillaume Douézan-Grard 	topstar_acpi_exit(topstar);
3459caeb532SHerton Ronaldo Krzesinski 
34666aa0d60SGuillaume Douézan-Grard 	kfree(topstar);
3479caeb532SHerton Ronaldo Krzesinski }
3489caeb532SHerton Ronaldo Krzesinski 
3499caeb532SHerton Ronaldo Krzesinski static const struct acpi_device_id topstar_device_ids[] = {
35023ccd036SGuillaume Douézan-Grard 	{ "TPS0001", 0 },
3519caeb532SHerton Ronaldo Krzesinski 	{ "TPSACPI01", 0 },
3529caeb532SHerton Ronaldo Krzesinski 	{ "", 0 },
3539caeb532SHerton Ronaldo Krzesinski };
3549caeb532SHerton Ronaldo Krzesinski MODULE_DEVICE_TABLE(acpi, topstar_device_ids);
3559caeb532SHerton Ronaldo Krzesinski 
35666aa0d60SGuillaume Douézan-Grard static struct acpi_driver topstar_acpi_driver = {
3579caeb532SHerton Ronaldo Krzesinski 	.name = "Topstar laptop ACPI driver",
35866aa0d60SGuillaume Douézan-Grard 	.class = TOPSTAR_LAPTOP_CLASS,
3599caeb532SHerton Ronaldo Krzesinski 	.ids = topstar_device_ids,
3609caeb532SHerton Ronaldo Krzesinski 	.ops = {
36166aa0d60SGuillaume Douézan-Grard 		.add = topstar_acpi_add,
36266aa0d60SGuillaume Douézan-Grard 		.remove = topstar_acpi_remove,
36366aa0d60SGuillaume Douézan-Grard 		.notify = topstar_acpi_notify,
3649caeb532SHerton Ronaldo Krzesinski 	},
3659caeb532SHerton Ronaldo Krzesinski };
36682acad40SGuillaume Douézan-Grard 
topstar_laptop_init(void)36782acad40SGuillaume Douézan-Grard static int __init topstar_laptop_init(void)
36882acad40SGuillaume Douézan-Grard {
36982acad40SGuillaume Douézan-Grard 	int ret;
37082acad40SGuillaume Douézan-Grard 
3712c531437SGuillaume Douézan-Grard 	ret = platform_driver_register(&topstar_platform_driver);
37282acad40SGuillaume Douézan-Grard 	if (ret < 0)
37382acad40SGuillaume Douézan-Grard 		return ret;
37482acad40SGuillaume Douézan-Grard 
3752c531437SGuillaume Douézan-Grard 	ret = acpi_bus_register_driver(&topstar_acpi_driver);
3762c531437SGuillaume Douézan-Grard 	if (ret < 0)
3772c531437SGuillaume Douézan-Grard 		goto err_driver_unreg;
3782c531437SGuillaume Douézan-Grard 
37982acad40SGuillaume Douézan-Grard 	pr_info("ACPI extras driver loaded\n");
38082acad40SGuillaume Douézan-Grard 	return 0;
3812c531437SGuillaume Douézan-Grard 
3822c531437SGuillaume Douézan-Grard err_driver_unreg:
3832c531437SGuillaume Douézan-Grard 	platform_driver_unregister(&topstar_platform_driver);
3842c531437SGuillaume Douézan-Grard 	return ret;
38582acad40SGuillaume Douézan-Grard }
38682acad40SGuillaume Douézan-Grard 
topstar_laptop_exit(void)38782acad40SGuillaume Douézan-Grard static void __exit topstar_laptop_exit(void)
38882acad40SGuillaume Douézan-Grard {
38966aa0d60SGuillaume Douézan-Grard 	acpi_bus_unregister_driver(&topstar_acpi_driver);
3902c531437SGuillaume Douézan-Grard 	platform_driver_unregister(&topstar_platform_driver);
39182acad40SGuillaume Douézan-Grard }
39282acad40SGuillaume Douézan-Grard 
39382acad40SGuillaume Douézan-Grard module_init(topstar_laptop_init);
39482acad40SGuillaume Douézan-Grard module_exit(topstar_laptop_exit);
3959caeb532SHerton Ronaldo Krzesinski 
3969caeb532SHerton Ronaldo Krzesinski MODULE_AUTHOR("Herton Ronaldo Krzesinski");
3977a580200SGuillaume Douézan-Grard MODULE_AUTHOR("Guillaume Douézan-Grard");
3989caeb532SHerton Ronaldo Krzesinski MODULE_DESCRIPTION("Topstar Laptop ACPI Extras driver");
3999caeb532SHerton Ronaldo Krzesinski MODULE_LICENSE("GPL");
400