mirror of
				git://git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
				synced 2025-09-04 20:19:47 +08:00 
			
		
		
		
	 9ab762a84b
			
		
	
	
		9ab762a84b
		
	
	
	
	
		
			
			After system resume the hp-wmi driver may complain: [ 702.620180] hp_wmi: Unknown event_id - 23 - 0x0 According to HP it means 'Sanitization Mode' and it's harmless to just ignore the event. Cc: Jorge Lopez <jorge.lopez2@hp.com> Signed-off-by: Kai-Heng Feng <kai.heng.feng@canonical.com> Link: https://lore.kernel.org/r/20220628123726.250062-1-kai.heng.feng@canonical.com Reviewed-by: Hans de Goede <hdegoede@redhat.com> Signed-off-by: Hans de Goede <hdegoede@redhat.com>
		
			
				
	
	
		
			1545 lines
		
	
	
		
			36 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			1545 lines
		
	
	
		
			36 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| // SPDX-License-Identifier: GPL-2.0-or-later
 | |
| /*
 | |
|  * HP WMI hotkeys
 | |
|  *
 | |
|  * Copyright (C) 2008 Red Hat <mjg@redhat.com>
 | |
|  * Copyright (C) 2010, 2011 Anssi Hannula <anssi.hannula@iki.fi>
 | |
|  *
 | |
|  * Portions based on wistron_btns.c:
 | |
|  * Copyright (C) 2005 Miloslav Trmac <mitr@volny.cz>
 | |
|  * Copyright (C) 2005 Bernhard Rosenkraenzer <bero@arklinux.org>
 | |
|  * Copyright (C) 2005 Dmitry Torokhov <dtor@mail.ru>
 | |
|  */
 | |
| 
 | |
| #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
 | |
| 
 | |
| #include <linux/kernel.h>
 | |
| #include <linux/module.h>
 | |
| #include <linux/init.h>
 | |
| #include <linux/slab.h>
 | |
| #include <linux/types.h>
 | |
| #include <linux/input.h>
 | |
| #include <linux/input/sparse-keymap.h>
 | |
| #include <linux/platform_device.h>
 | |
| #include <linux/platform_profile.h>
 | |
| #include <linux/hwmon.h>
 | |
| #include <linux/acpi.h>
 | |
| #include <linux/rfkill.h>
 | |
| #include <linux/string.h>
 | |
| #include <linux/dmi.h>
 | |
| 
 | |
| MODULE_AUTHOR("Matthew Garrett <mjg59@srcf.ucam.org>");
 | |
| MODULE_DESCRIPTION("HP laptop WMI hotkeys driver");
 | |
| MODULE_LICENSE("GPL");
 | |
| 
 | |
| MODULE_ALIAS("wmi:95F24279-4D7B-4334-9387-ACCDC67EF61C");
 | |
| MODULE_ALIAS("wmi:5FB7F034-2C63-45e9-BE91-3D44E2C707E4");
 | |
| 
 | |
| #define HPWMI_EVENT_GUID "95F24279-4D7B-4334-9387-ACCDC67EF61C"
 | |
| #define HPWMI_BIOS_GUID "5FB7F034-2C63-45e9-BE91-3D44E2C707E4"
 | |
| #define HP_OMEN_EC_THERMAL_PROFILE_OFFSET 0x95
 | |
| #define zero_if_sup(tmp) (zero_insize_support?0:sizeof(tmp)) // use when zero insize is required
 | |
| 
 | |
| /* DMI board names of devices that should use the omen specific path for
 | |
|  * thermal profiles.
 | |
|  * This was obtained by taking a look in the windows omen command center
 | |
|  * app and parsing a json file that they use to figure out what capabilities
 | |
|  * the device should have.
 | |
|  * A device is considered an omen if the DisplayName in that list contains
 | |
|  * "OMEN", and it can use the thermal profile stuff if the "Feature" array
 | |
|  * contains "PerformanceControl".
 | |
|  */
 | |
| static const char * const omen_thermal_profile_boards[] = {
 | |
| 	"84DA", "84DB", "84DC", "8574", "8575", "860A", "87B5", "8572", "8573",
 | |
| 	"8600", "8601", "8602", "8605", "8606", "8607", "8746", "8747", "8749",
 | |
| 	"874A", "8603", "8604", "8748", "886B", "886C", "878A", "878B", "878C",
 | |
| 	"88C8", "88CB", "8786", "8787", "8788", "88D1", "88D2", "88F4", "88FD",
 | |
| 	"88F5", "88F6", "88F7", "88FE", "88FF", "8900", "8901", "8902", "8912",
 | |
| 	"8917", "8918", "8949", "894A", "89EB"
 | |
| };
 | |
| 
 | |
| /* DMI Board names of Omen laptops that are specifically set to be thermal
 | |
|  * profile version 0 by the Omen Command Center app, regardless of what
 | |
|  * the get system design information WMI call returns
 | |
|  */
 | |
| static const char *const omen_thermal_profile_force_v0_boards[] = {
 | |
| 	"8607", "8746", "8747", "8749", "874A", "8748"
 | |
| };
 | |
| 
 | |
| enum hp_wmi_radio {
 | |
| 	HPWMI_WIFI	= 0x0,
 | |
| 	HPWMI_BLUETOOTH	= 0x1,
 | |
| 	HPWMI_WWAN	= 0x2,
 | |
| 	HPWMI_GPS	= 0x3,
 | |
| };
 | |
| 
 | |
| enum hp_wmi_event_ids {
 | |
| 	HPWMI_DOCK_EVENT		= 0x01,
 | |
| 	HPWMI_PARK_HDD			= 0x02,
 | |
| 	HPWMI_SMART_ADAPTER		= 0x03,
 | |
| 	HPWMI_BEZEL_BUTTON		= 0x04,
 | |
| 	HPWMI_WIRELESS			= 0x05,
 | |
| 	HPWMI_CPU_BATTERY_THROTTLE	= 0x06,
 | |
| 	HPWMI_LOCK_SWITCH		= 0x07,
 | |
| 	HPWMI_LID_SWITCH		= 0x08,
 | |
| 	HPWMI_SCREEN_ROTATION		= 0x09,
 | |
| 	HPWMI_COOLSENSE_SYSTEM_MOBILE	= 0x0A,
 | |
| 	HPWMI_COOLSENSE_SYSTEM_HOT	= 0x0B,
 | |
| 	HPWMI_PROXIMITY_SENSOR		= 0x0C,
 | |
| 	HPWMI_BACKLIT_KB_BRIGHTNESS	= 0x0D,
 | |
| 	HPWMI_PEAKSHIFT_PERIOD		= 0x0F,
 | |
| 	HPWMI_BATTERY_CHARGE_PERIOD	= 0x10,
 | |
| 	HPWMI_SANITIZATION_MODE		= 0x17,
 | |
| };
 | |
| 
 | |
| /*
 | |
|  * struct bios_args buffer is dynamically allocated.  New WMI command types
 | |
|  * were introduced that exceeds 128-byte data size.  Changes to handle
 | |
|  * the data size allocation scheme were kept in hp_wmi_perform_qurey function.
 | |
|  */
 | |
| struct bios_args {
 | |
| 	u32 signature;
 | |
| 	u32 command;
 | |
| 	u32 commandtype;
 | |
| 	u32 datasize;
 | |
| 	u8 data[];
 | |
| };
 | |
| 
 | |
| enum hp_wmi_commandtype {
 | |
| 	HPWMI_DISPLAY_QUERY		= 0x01,
 | |
| 	HPWMI_HDDTEMP_QUERY		= 0x02,
 | |
| 	HPWMI_ALS_QUERY			= 0x03,
 | |
| 	HPWMI_HARDWARE_QUERY		= 0x04,
 | |
| 	HPWMI_WIRELESS_QUERY		= 0x05,
 | |
| 	HPWMI_BATTERY_QUERY		= 0x07,
 | |
| 	HPWMI_BIOS_QUERY		= 0x09,
 | |
| 	HPWMI_FEATURE_QUERY		= 0x0b,
 | |
| 	HPWMI_HOTKEY_QUERY		= 0x0c,
 | |
| 	HPWMI_FEATURE2_QUERY		= 0x0d,
 | |
| 	HPWMI_WIRELESS2_QUERY		= 0x1b,
 | |
| 	HPWMI_POSTCODEERROR_QUERY	= 0x2a,
 | |
| 	HPWMI_SYSTEM_DEVICE_MODE	= 0x40,
 | |
| 	HPWMI_THERMAL_PROFILE_QUERY	= 0x4c,
 | |
| };
 | |
| 
 | |
| enum hp_wmi_gm_commandtype {
 | |
| 	HPWMI_FAN_SPEED_GET_QUERY = 0x11,
 | |
| 	HPWMI_SET_PERFORMANCE_MODE = 0x1A,
 | |
| 	HPWMI_FAN_SPEED_MAX_GET_QUERY = 0x26,
 | |
| 	HPWMI_FAN_SPEED_MAX_SET_QUERY = 0x27,
 | |
| 	HPWMI_GET_SYSTEM_DESIGN_DATA = 0x28,
 | |
| };
 | |
| 
 | |
| enum hp_wmi_command {
 | |
| 	HPWMI_READ	= 0x01,
 | |
| 	HPWMI_WRITE	= 0x02,
 | |
| 	HPWMI_ODM	= 0x03,
 | |
| 	HPWMI_GM	= 0x20008,
 | |
| };
 | |
| 
 | |
| enum hp_wmi_hardware_mask {
 | |
| 	HPWMI_DOCK_MASK		= 0x01,
 | |
| 	HPWMI_TABLET_MASK	= 0x04,
 | |
| };
 | |
| 
 | |
| struct bios_return {
 | |
| 	u32 sigpass;
 | |
| 	u32 return_code;
 | |
| };
 | |
| 
 | |
| enum hp_return_value {
 | |
| 	HPWMI_RET_WRONG_SIGNATURE	= 0x02,
 | |
| 	HPWMI_RET_UNKNOWN_COMMAND	= 0x03,
 | |
| 	HPWMI_RET_UNKNOWN_CMDTYPE	= 0x04,
 | |
| 	HPWMI_RET_INVALID_PARAMETERS	= 0x05,
 | |
| };
 | |
| 
 | |
| enum hp_wireless2_bits {
 | |
| 	HPWMI_POWER_STATE	= 0x01,
 | |
| 	HPWMI_POWER_SOFT	= 0x02,
 | |
| 	HPWMI_POWER_BIOS	= 0x04,
 | |
| 	HPWMI_POWER_HARD	= 0x08,
 | |
| 	HPWMI_POWER_FW_OR_HW	= HPWMI_POWER_BIOS | HPWMI_POWER_HARD,
 | |
| };
 | |
| 
 | |
| enum hp_thermal_profile_omen_v0 {
 | |
| 	HP_OMEN_V0_THERMAL_PROFILE_DEFAULT     = 0x00,
 | |
| 	HP_OMEN_V0_THERMAL_PROFILE_PERFORMANCE = 0x01,
 | |
| 	HP_OMEN_V0_THERMAL_PROFILE_COOL        = 0x02,
 | |
| };
 | |
| 
 | |
| enum hp_thermal_profile_omen_v1 {
 | |
| 	HP_OMEN_V1_THERMAL_PROFILE_DEFAULT	= 0x30,
 | |
| 	HP_OMEN_V1_THERMAL_PROFILE_PERFORMANCE	= 0x31,
 | |
| 	HP_OMEN_V1_THERMAL_PROFILE_COOL		= 0x50,
 | |
| };
 | |
| 
 | |
| enum hp_thermal_profile {
 | |
| 	HP_THERMAL_PROFILE_PERFORMANCE	= 0x00,
 | |
| 	HP_THERMAL_PROFILE_DEFAULT		= 0x01,
 | |
| 	HP_THERMAL_PROFILE_COOL			= 0x02
 | |
| };
 | |
| 
 | |
| #define IS_HWBLOCKED(x) ((x & HPWMI_POWER_FW_OR_HW) != HPWMI_POWER_FW_OR_HW)
 | |
| #define IS_SWBLOCKED(x) !(x & HPWMI_POWER_SOFT)
 | |
| 
 | |
| struct bios_rfkill2_device_state {
 | |
| 	u8 radio_type;
 | |
| 	u8 bus_type;
 | |
| 	u16 vendor_id;
 | |
| 	u16 product_id;
 | |
| 	u16 subsys_vendor_id;
 | |
| 	u16 subsys_product_id;
 | |
| 	u8 rfkill_id;
 | |
| 	u8 power;
 | |
| 	u8 unknown[4];
 | |
| };
 | |
| 
 | |
| /* 7 devices fit into the 128 byte buffer */
 | |
| #define HPWMI_MAX_RFKILL2_DEVICES	7
 | |
| 
 | |
| struct bios_rfkill2_state {
 | |
| 	u8 unknown[7];
 | |
| 	u8 count;
 | |
| 	u8 pad[8];
 | |
| 	struct bios_rfkill2_device_state device[HPWMI_MAX_RFKILL2_DEVICES];
 | |
| };
 | |
| 
 | |
| static const struct key_entry hp_wmi_keymap[] = {
 | |
| 	{ KE_KEY, 0x02,   { KEY_BRIGHTNESSUP } },
 | |
| 	{ KE_KEY, 0x03,   { KEY_BRIGHTNESSDOWN } },
 | |
| 	{ KE_KEY, 0x20e6, { KEY_PROG1 } },
 | |
| 	{ KE_KEY, 0x20e8, { KEY_MEDIA } },
 | |
| 	{ KE_KEY, 0x2142, { KEY_MEDIA } },
 | |
| 	{ KE_KEY, 0x213b, { KEY_INFO } },
 | |
| 	{ KE_KEY, 0x2169, { KEY_ROTATE_DISPLAY } },
 | |
| 	{ KE_KEY, 0x216a, { KEY_SETUP } },
 | |
| 	{ KE_KEY, 0x231b, { KEY_HELP } },
 | |
| 	{ KE_END, 0 }
 | |
| };
 | |
| 
 | |
| static struct input_dev *hp_wmi_input_dev;
 | |
| static struct platform_device *hp_wmi_platform_dev;
 | |
| static struct platform_profile_handler platform_profile_handler;
 | |
| static bool platform_profile_support;
 | |
| static bool zero_insize_support;
 | |
| 
 | |
| static struct rfkill *wifi_rfkill;
 | |
| static struct rfkill *bluetooth_rfkill;
 | |
| static struct rfkill *wwan_rfkill;
 | |
| 
 | |
| struct rfkill2_device {
 | |
| 	u8 id;
 | |
| 	int num;
 | |
| 	struct rfkill *rfkill;
 | |
| };
 | |
| 
 | |
| static int rfkill2_count;
 | |
| static struct rfkill2_device rfkill2[HPWMI_MAX_RFKILL2_DEVICES];
 | |
| 
 | |
| /*
 | |
|  * Chassis Types values were obtained from SMBIOS reference
 | |
|  * specification version 3.00. A complete list of system enclosures
 | |
|  * and chassis types is available on Table 17.
 | |
|  */
 | |
| static const char * const tablet_chassis_types[] = {
 | |
| 	"30", /* Tablet*/
 | |
| 	"31", /* Convertible */
 | |
| 	"32"  /* Detachable */
 | |
| };
 | |
| 
 | |
| #define DEVICE_MODE_TABLET	0x06
 | |
| 
 | |
| /* map output size to the corresponding WMI method id */
 | |
| static inline int encode_outsize_for_pvsz(int outsize)
 | |
| {
 | |
| 	if (outsize > 4096)
 | |
| 		return -EINVAL;
 | |
| 	if (outsize > 1024)
 | |
| 		return 5;
 | |
| 	if (outsize > 128)
 | |
| 		return 4;
 | |
| 	if (outsize > 4)
 | |
| 		return 3;
 | |
| 	if (outsize > 0)
 | |
| 		return 2;
 | |
| 	return 1;
 | |
| }
 | |
| 
 | |
| /*
 | |
|  * hp_wmi_perform_query
 | |
|  *
 | |
|  * query:	The commandtype (enum hp_wmi_commandtype)
 | |
|  * write:	The command (enum hp_wmi_command)
 | |
|  * buffer:	Buffer used as input and/or output
 | |
|  * insize:	Size of input buffer
 | |
|  * outsize:	Size of output buffer
 | |
|  *
 | |
|  * returns zero on success
 | |
|  *         an HP WMI query specific error code (which is positive)
 | |
|  *         -EINVAL if the query was not successful at all
 | |
|  *         -EINVAL if the output buffer size exceeds buffersize
 | |
|  *
 | |
|  * Note: The buffersize must at least be the maximum of the input and output
 | |
|  *       size. E.g. Battery info query is defined to have 1 byte input
 | |
|  *       and 128 byte output. The caller would do:
 | |
|  *       buffer = kzalloc(128, GFP_KERNEL);
 | |
|  *       ret = hp_wmi_perform_query(HPWMI_BATTERY_QUERY, HPWMI_READ, buffer, 1, 128)
 | |
|  */
 | |
| static int hp_wmi_perform_query(int query, enum hp_wmi_command command,
 | |
| 				void *buffer, int insize, int outsize)
 | |
| {
 | |
| 	struct acpi_buffer input, output = { ACPI_ALLOCATE_BUFFER, NULL };
 | |
| 	struct bios_return *bios_return;
 | |
| 	union acpi_object *obj = NULL;
 | |
| 	struct bios_args *args = NULL;
 | |
| 	int mid, actual_insize, actual_outsize;
 | |
| 	size_t bios_args_size;
 | |
| 	int ret;
 | |
| 
 | |
| 	mid = encode_outsize_for_pvsz(outsize);
 | |
| 	if (WARN_ON(mid < 0))
 | |
| 		return mid;
 | |
| 
 | |
| 	actual_insize = max(insize, 128);
 | |
| 	bios_args_size = struct_size(args, data, actual_insize);
 | |
| 	args = kmalloc(bios_args_size, GFP_KERNEL);
 | |
| 	if (!args)
 | |
| 		return -ENOMEM;
 | |
| 
 | |
| 	input.length = bios_args_size;
 | |
| 	input.pointer = args;
 | |
| 
 | |
| 	args->signature = 0x55434553;
 | |
| 	args->command = command;
 | |
| 	args->commandtype = query;
 | |
| 	args->datasize = insize;
 | |
| 	memcpy(args->data, buffer, flex_array_size(args, data, insize));
 | |
| 
 | |
| 	ret = wmi_evaluate_method(HPWMI_BIOS_GUID, 0, mid, &input, &output);
 | |
| 	if (ret)
 | |
| 		goto out_free;
 | |
| 
 | |
| 	obj = output.pointer;
 | |
| 	if (!obj) {
 | |
| 		ret = -EINVAL;
 | |
| 		goto out_free;
 | |
| 	}
 | |
| 
 | |
| 	if (obj->type != ACPI_TYPE_BUFFER) {
 | |
| 		pr_warn("query 0x%x returned an invalid object 0x%x\n", query, ret);
 | |
| 		ret = -EINVAL;
 | |
| 		goto out_free;
 | |
| 	}
 | |
| 
 | |
| 	bios_return = (struct bios_return *)obj->buffer.pointer;
 | |
| 	ret = bios_return->return_code;
 | |
| 
 | |
| 	if (ret) {
 | |
| 		if (ret != HPWMI_RET_UNKNOWN_COMMAND &&
 | |
| 		    ret != HPWMI_RET_UNKNOWN_CMDTYPE)
 | |
| 			pr_warn("query 0x%x returned error 0x%x\n", query, ret);
 | |
| 		goto out_free;
 | |
| 	}
 | |
| 
 | |
| 	/* Ignore output data of zero size */
 | |
| 	if (!outsize)
 | |
| 		goto out_free;
 | |
| 
 | |
| 	actual_outsize = min(outsize, (int)(obj->buffer.length - sizeof(*bios_return)));
 | |
| 	memcpy(buffer, obj->buffer.pointer + sizeof(*bios_return), actual_outsize);
 | |
| 	memset(buffer + actual_outsize, 0, outsize - actual_outsize);
 | |
| 
 | |
| out_free:
 | |
| 	kfree(obj);
 | |
| 	kfree(args);
 | |
| 	return ret;
 | |
| }
 | |
| 
 | |
| static int hp_wmi_get_fan_speed(int fan)
 | |
| {
 | |
| 	u8 fsh, fsl;
 | |
| 	char fan_data[4] = { fan, 0, 0, 0 };
 | |
| 
 | |
| 	int ret = hp_wmi_perform_query(HPWMI_FAN_SPEED_GET_QUERY, HPWMI_GM,
 | |
| 				       &fan_data, sizeof(char),
 | |
| 				       sizeof(fan_data));
 | |
| 
 | |
| 	if (ret != 0)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	fsh = fan_data[2];
 | |
| 	fsl = fan_data[3];
 | |
| 
 | |
| 	return (fsh << 8) | fsl;
 | |
| }
 | |
| 
 | |
| static int hp_wmi_read_int(int query)
 | |
| {
 | |
| 	int val = 0, ret;
 | |
| 
 | |
| 	ret = hp_wmi_perform_query(query, HPWMI_READ, &val,
 | |
| 				   zero_if_sup(val), sizeof(val));
 | |
| 
 | |
| 	if (ret)
 | |
| 		return ret < 0 ? ret : -EINVAL;
 | |
| 
 | |
| 	return val;
 | |
| }
 | |
| 
 | |
| static int hp_wmi_get_dock_state(void)
 | |
| {
 | |
| 	int state = hp_wmi_read_int(HPWMI_HARDWARE_QUERY);
 | |
| 
 | |
| 	if (state < 0)
 | |
| 		return state;
 | |
| 
 | |
| 	return !!(state & HPWMI_DOCK_MASK);
 | |
| }
 | |
| 
 | |
| static int hp_wmi_get_tablet_mode(void)
 | |
| {
 | |
| 	char system_device_mode[4] = { 0 };
 | |
| 	const char *chassis_type;
 | |
| 	bool tablet_found;
 | |
| 	int ret;
 | |
| 
 | |
| 	chassis_type = dmi_get_system_info(DMI_CHASSIS_TYPE);
 | |
| 	if (!chassis_type)
 | |
| 		return -ENODEV;
 | |
| 
 | |
| 	tablet_found = match_string(tablet_chassis_types,
 | |
| 				    ARRAY_SIZE(tablet_chassis_types),
 | |
| 				    chassis_type) >= 0;
 | |
| 	if (!tablet_found)
 | |
| 		return -ENODEV;
 | |
| 
 | |
| 	ret = hp_wmi_perform_query(HPWMI_SYSTEM_DEVICE_MODE, HPWMI_READ,
 | |
| 				   system_device_mode, zero_if_sup(system_device_mode),
 | |
| 				   sizeof(system_device_mode));
 | |
| 	if (ret < 0)
 | |
| 		return ret;
 | |
| 
 | |
| 	return system_device_mode[0] == DEVICE_MODE_TABLET;
 | |
| }
 | |
| 
 | |
| static int omen_thermal_profile_set(int mode)
 | |
| {
 | |
| 	char buffer[2] = {0, mode};
 | |
| 	int ret;
 | |
| 
 | |
| 	ret = hp_wmi_perform_query(HPWMI_SET_PERFORMANCE_MODE, HPWMI_GM,
 | |
| 				   &buffer, sizeof(buffer), 0);
 | |
| 
 | |
| 	if (ret)
 | |
| 		return ret < 0 ? ret : -EINVAL;
 | |
| 
 | |
| 	return mode;
 | |
| }
 | |
| 
 | |
| static bool is_omen_thermal_profile(void)
 | |
| {
 | |
| 	const char *board_name = dmi_get_system_info(DMI_BOARD_NAME);
 | |
| 
 | |
| 	if (!board_name)
 | |
| 		return false;
 | |
| 
 | |
| 	return match_string(omen_thermal_profile_boards,
 | |
| 			    ARRAY_SIZE(omen_thermal_profile_boards),
 | |
| 			    board_name) >= 0;
 | |
| }
 | |
| 
 | |
| static int omen_get_thermal_policy_version(void)
 | |
| {
 | |
| 	unsigned char buffer[8] = { 0 };
 | |
| 	int ret;
 | |
| 
 | |
| 	const char *board_name = dmi_get_system_info(DMI_BOARD_NAME);
 | |
| 
 | |
| 	if (board_name) {
 | |
| 		int matches = match_string(omen_thermal_profile_force_v0_boards,
 | |
| 			ARRAY_SIZE(omen_thermal_profile_force_v0_boards),
 | |
| 			board_name);
 | |
| 		if (matches >= 0)
 | |
| 			return 0;
 | |
| 	}
 | |
| 
 | |
| 	ret = hp_wmi_perform_query(HPWMI_GET_SYSTEM_DESIGN_DATA, HPWMI_GM,
 | |
| 				   &buffer, sizeof(buffer), sizeof(buffer));
 | |
| 
 | |
| 	if (ret)
 | |
| 		return ret < 0 ? ret : -EINVAL;
 | |
| 
 | |
| 	return buffer[3];
 | |
| }
 | |
| 
 | |
| static int omen_thermal_profile_get(void)
 | |
| {
 | |
| 	u8 data;
 | |
| 
 | |
| 	int ret = ec_read(HP_OMEN_EC_THERMAL_PROFILE_OFFSET, &data);
 | |
| 
 | |
| 	if (ret)
 | |
| 		return ret;
 | |
| 
 | |
| 	return data;
 | |
| }
 | |
| 
 | |
| static int hp_wmi_fan_speed_max_set(int enabled)
 | |
| {
 | |
| 	int ret;
 | |
| 
 | |
| 	ret = hp_wmi_perform_query(HPWMI_FAN_SPEED_MAX_SET_QUERY, HPWMI_GM,
 | |
| 				   &enabled, sizeof(enabled), 0);
 | |
| 
 | |
| 	if (ret)
 | |
| 		return ret < 0 ? ret : -EINVAL;
 | |
| 
 | |
| 	return enabled;
 | |
| }
 | |
| 
 | |
| static int hp_wmi_fan_speed_max_get(void)
 | |
| {
 | |
| 	int val = 0, ret;
 | |
| 
 | |
| 	ret = hp_wmi_perform_query(HPWMI_FAN_SPEED_MAX_GET_QUERY, HPWMI_GM,
 | |
| 				   &val, zero_if_sup(val), sizeof(val));
 | |
| 
 | |
| 	if (ret)
 | |
| 		return ret < 0 ? ret : -EINVAL;
 | |
| 
 | |
| 	return val;
 | |
| }
 | |
| 
 | |
| static int __init hp_wmi_bios_2008_later(void)
 | |
| {
 | |
| 	int state = 0;
 | |
| 	int ret = hp_wmi_perform_query(HPWMI_FEATURE_QUERY, HPWMI_READ, &state,
 | |
| 				       zero_if_sup(state), sizeof(state));
 | |
| 	if (!ret)
 | |
| 		return 1;
 | |
| 
 | |
| 	return (ret == HPWMI_RET_UNKNOWN_CMDTYPE) ? 0 : -ENXIO;
 | |
| }
 | |
| 
 | |
| static int __init hp_wmi_bios_2009_later(void)
 | |
| {
 | |
| 	u8 state[128];
 | |
| 	int ret = hp_wmi_perform_query(HPWMI_FEATURE2_QUERY, HPWMI_READ, &state,
 | |
| 				       zero_if_sup(state), sizeof(state));
 | |
| 	if (!ret)
 | |
| 		return 1;
 | |
| 
 | |
| 	return (ret == HPWMI_RET_UNKNOWN_CMDTYPE) ? 0 : -ENXIO;
 | |
| }
 | |
| 
 | |
| static int __init hp_wmi_enable_hotkeys(void)
 | |
| {
 | |
| 	int value = 0x6e;
 | |
| 	int ret = hp_wmi_perform_query(HPWMI_BIOS_QUERY, HPWMI_WRITE, &value,
 | |
| 				       sizeof(value), 0);
 | |
| 
 | |
| 	return ret <= 0 ? ret : -EINVAL;
 | |
| }
 | |
| 
 | |
| static int hp_wmi_set_block(void *data, bool blocked)
 | |
| {
 | |
| 	enum hp_wmi_radio r = (enum hp_wmi_radio) data;
 | |
| 	int query = BIT(r + 8) | ((!blocked) << r);
 | |
| 	int ret;
 | |
| 
 | |
| 	ret = hp_wmi_perform_query(HPWMI_WIRELESS_QUERY, HPWMI_WRITE,
 | |
| 				   &query, sizeof(query), 0);
 | |
| 
 | |
| 	return ret <= 0 ? ret : -EINVAL;
 | |
| }
 | |
| 
 | |
| static const struct rfkill_ops hp_wmi_rfkill_ops = {
 | |
| 	.set_block = hp_wmi_set_block,
 | |
| };
 | |
| 
 | |
| static bool hp_wmi_get_sw_state(enum hp_wmi_radio r)
 | |
| {
 | |
| 	int mask = 0x200 << (r * 8);
 | |
| 
 | |
| 	int wireless = hp_wmi_read_int(HPWMI_WIRELESS_QUERY);
 | |
| 
 | |
| 	/* TBD: Pass error */
 | |
| 	WARN_ONCE(wireless < 0, "error executing HPWMI_WIRELESS_QUERY");
 | |
| 
 | |
| 	return !(wireless & mask);
 | |
| }
 | |
| 
 | |
| static bool hp_wmi_get_hw_state(enum hp_wmi_radio r)
 | |
| {
 | |
| 	int mask = 0x800 << (r * 8);
 | |
| 
 | |
| 	int wireless = hp_wmi_read_int(HPWMI_WIRELESS_QUERY);
 | |
| 
 | |
| 	/* TBD: Pass error */
 | |
| 	WARN_ONCE(wireless < 0, "error executing HPWMI_WIRELESS_QUERY");
 | |
| 
 | |
| 	return !(wireless & mask);
 | |
| }
 | |
| 
 | |
| static int hp_wmi_rfkill2_set_block(void *data, bool blocked)
 | |
| {
 | |
| 	int rfkill_id = (int)(long)data;
 | |
| 	char buffer[4] = { 0x01, 0x00, rfkill_id, !blocked };
 | |
| 	int ret;
 | |
| 
 | |
| 	ret = hp_wmi_perform_query(HPWMI_WIRELESS2_QUERY, HPWMI_WRITE,
 | |
| 				   buffer, sizeof(buffer), 0);
 | |
| 
 | |
| 	return ret <= 0 ? ret : -EINVAL;
 | |
| }
 | |
| 
 | |
| static const struct rfkill_ops hp_wmi_rfkill2_ops = {
 | |
| 	.set_block = hp_wmi_rfkill2_set_block,
 | |
| };
 | |
| 
 | |
| static int hp_wmi_rfkill2_refresh(void)
 | |
| {
 | |
| 	struct bios_rfkill2_state state;
 | |
| 	int err, i;
 | |
| 
 | |
| 	err = hp_wmi_perform_query(HPWMI_WIRELESS2_QUERY, HPWMI_READ, &state,
 | |
| 				   zero_if_sup(state), sizeof(state));
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	for (i = 0; i < rfkill2_count; i++) {
 | |
| 		int num = rfkill2[i].num;
 | |
| 		struct bios_rfkill2_device_state *devstate;
 | |
| 
 | |
| 		devstate = &state.device[num];
 | |
| 
 | |
| 		if (num >= state.count ||
 | |
| 		    devstate->rfkill_id != rfkill2[i].id) {
 | |
| 			pr_warn("power configuration of the wireless devices unexpectedly changed\n");
 | |
| 			continue;
 | |
| 		}
 | |
| 
 | |
| 		rfkill_set_states(rfkill2[i].rfkill,
 | |
| 				  IS_SWBLOCKED(devstate->power),
 | |
| 				  IS_HWBLOCKED(devstate->power));
 | |
| 	}
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static ssize_t display_show(struct device *dev, struct device_attribute *attr,
 | |
| 			    char *buf)
 | |
| {
 | |
| 	int value = hp_wmi_read_int(HPWMI_DISPLAY_QUERY);
 | |
| 
 | |
| 	if (value < 0)
 | |
| 		return value;
 | |
| 	return sprintf(buf, "%d\n", value);
 | |
| }
 | |
| 
 | |
| static ssize_t hddtemp_show(struct device *dev, struct device_attribute *attr,
 | |
| 			    char *buf)
 | |
| {
 | |
| 	int value = hp_wmi_read_int(HPWMI_HDDTEMP_QUERY);
 | |
| 
 | |
| 	if (value < 0)
 | |
| 		return value;
 | |
| 	return sprintf(buf, "%d\n", value);
 | |
| }
 | |
| 
 | |
| static ssize_t als_show(struct device *dev, struct device_attribute *attr,
 | |
| 			char *buf)
 | |
| {
 | |
| 	int value = hp_wmi_read_int(HPWMI_ALS_QUERY);
 | |
| 
 | |
| 	if (value < 0)
 | |
| 		return value;
 | |
| 	return sprintf(buf, "%d\n", value);
 | |
| }
 | |
| 
 | |
| static ssize_t dock_show(struct device *dev, struct device_attribute *attr,
 | |
| 			 char *buf)
 | |
| {
 | |
| 	int value = hp_wmi_get_dock_state();
 | |
| 
 | |
| 	if (value < 0)
 | |
| 		return value;
 | |
| 	return sprintf(buf, "%d\n", value);
 | |
| }
 | |
| 
 | |
| static ssize_t tablet_show(struct device *dev, struct device_attribute *attr,
 | |
| 			   char *buf)
 | |
| {
 | |
| 	int value = hp_wmi_get_tablet_mode();
 | |
| 
 | |
| 	if (value < 0)
 | |
| 		return value;
 | |
| 	return sprintf(buf, "%d\n", value);
 | |
| }
 | |
| 
 | |
| static ssize_t postcode_show(struct device *dev, struct device_attribute *attr,
 | |
| 			     char *buf)
 | |
| {
 | |
| 	/* Get the POST error code of previous boot failure. */
 | |
| 	int value = hp_wmi_read_int(HPWMI_POSTCODEERROR_QUERY);
 | |
| 
 | |
| 	if (value < 0)
 | |
| 		return value;
 | |
| 	return sprintf(buf, "0x%x\n", value);
 | |
| }
 | |
| 
 | |
| static ssize_t als_store(struct device *dev, struct device_attribute *attr,
 | |
| 			 const char *buf, size_t count)
 | |
| {
 | |
| 	u32 tmp;
 | |
| 	int ret;
 | |
| 
 | |
| 	ret = kstrtou32(buf, 10, &tmp);
 | |
| 	if (ret)
 | |
| 		return ret;
 | |
| 
 | |
| 	ret = hp_wmi_perform_query(HPWMI_ALS_QUERY, HPWMI_WRITE, &tmp,
 | |
| 				       sizeof(tmp), 0);
 | |
| 	if (ret)
 | |
| 		return ret < 0 ? ret : -EINVAL;
 | |
| 
 | |
| 	return count;
 | |
| }
 | |
| 
 | |
| static ssize_t postcode_store(struct device *dev, struct device_attribute *attr,
 | |
| 			      const char *buf, size_t count)
 | |
| {
 | |
| 	u32 tmp = 1;
 | |
| 	bool clear;
 | |
| 	int ret;
 | |
| 
 | |
| 	ret = kstrtobool(buf, &clear);
 | |
| 	if (ret)
 | |
| 		return ret;
 | |
| 
 | |
| 	if (clear == false)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	/* Clear the POST error code. It is kept until cleared. */
 | |
| 	ret = hp_wmi_perform_query(HPWMI_POSTCODEERROR_QUERY, HPWMI_WRITE, &tmp,
 | |
| 				       sizeof(tmp), 0);
 | |
| 	if (ret)
 | |
| 		return ret < 0 ? ret : -EINVAL;
 | |
| 
 | |
| 	return count;
 | |
| }
 | |
| 
 | |
| static DEVICE_ATTR_RO(display);
 | |
| static DEVICE_ATTR_RO(hddtemp);
 | |
| static DEVICE_ATTR_RW(als);
 | |
| static DEVICE_ATTR_RO(dock);
 | |
| static DEVICE_ATTR_RO(tablet);
 | |
| static DEVICE_ATTR_RW(postcode);
 | |
| 
 | |
| static struct attribute *hp_wmi_attrs[] = {
 | |
| 	&dev_attr_display.attr,
 | |
| 	&dev_attr_hddtemp.attr,
 | |
| 	&dev_attr_als.attr,
 | |
| 	&dev_attr_dock.attr,
 | |
| 	&dev_attr_tablet.attr,
 | |
| 	&dev_attr_postcode.attr,
 | |
| 	NULL,
 | |
| };
 | |
| ATTRIBUTE_GROUPS(hp_wmi);
 | |
| 
 | |
| static void hp_wmi_notify(u32 value, void *context)
 | |
| {
 | |
| 	struct acpi_buffer response = { ACPI_ALLOCATE_BUFFER, NULL };
 | |
| 	u32 event_id, event_data;
 | |
| 	union acpi_object *obj;
 | |
| 	acpi_status status;
 | |
| 	u32 *location;
 | |
| 	int key_code;
 | |
| 
 | |
| 	status = wmi_get_event_data(value, &response);
 | |
| 	if (status != AE_OK) {
 | |
| 		pr_info("bad event status 0x%x\n", status);
 | |
| 		return;
 | |
| 	}
 | |
| 
 | |
| 	obj = (union acpi_object *)response.pointer;
 | |
| 
 | |
| 	if (!obj)
 | |
| 		return;
 | |
| 	if (obj->type != ACPI_TYPE_BUFFER) {
 | |
| 		pr_info("Unknown response received %d\n", obj->type);
 | |
| 		kfree(obj);
 | |
| 		return;
 | |
| 	}
 | |
| 
 | |
| 	/*
 | |
| 	 * Depending on ACPI version the concatenation of id and event data
 | |
| 	 * inside _WED function will result in a 8 or 16 byte buffer.
 | |
| 	 */
 | |
| 	location = (u32 *)obj->buffer.pointer;
 | |
| 	if (obj->buffer.length == 8) {
 | |
| 		event_id = *location;
 | |
| 		event_data = *(location + 1);
 | |
| 	} else if (obj->buffer.length == 16) {
 | |
| 		event_id = *location;
 | |
| 		event_data = *(location + 2);
 | |
| 	} else {
 | |
| 		pr_info("Unknown buffer length %d\n", obj->buffer.length);
 | |
| 		kfree(obj);
 | |
| 		return;
 | |
| 	}
 | |
| 	kfree(obj);
 | |
| 
 | |
| 	switch (event_id) {
 | |
| 	case HPWMI_DOCK_EVENT:
 | |
| 		if (test_bit(SW_DOCK, hp_wmi_input_dev->swbit))
 | |
| 			input_report_switch(hp_wmi_input_dev, SW_DOCK,
 | |
| 					    hp_wmi_get_dock_state());
 | |
| 		if (test_bit(SW_TABLET_MODE, hp_wmi_input_dev->swbit))
 | |
| 			input_report_switch(hp_wmi_input_dev, SW_TABLET_MODE,
 | |
| 					    hp_wmi_get_tablet_mode());
 | |
| 		input_sync(hp_wmi_input_dev);
 | |
| 		break;
 | |
| 	case HPWMI_PARK_HDD:
 | |
| 		break;
 | |
| 	case HPWMI_SMART_ADAPTER:
 | |
| 		break;
 | |
| 	case HPWMI_BEZEL_BUTTON:
 | |
| 		key_code = hp_wmi_read_int(HPWMI_HOTKEY_QUERY);
 | |
| 		if (key_code < 0)
 | |
| 			break;
 | |
| 
 | |
| 		if (!sparse_keymap_report_event(hp_wmi_input_dev,
 | |
| 						key_code, 1, true))
 | |
| 			pr_info("Unknown key code - 0x%x\n", key_code);
 | |
| 		break;
 | |
| 	case HPWMI_WIRELESS:
 | |
| 		if (rfkill2_count) {
 | |
| 			hp_wmi_rfkill2_refresh();
 | |
| 			break;
 | |
| 		}
 | |
| 
 | |
| 		if (wifi_rfkill)
 | |
| 			rfkill_set_states(wifi_rfkill,
 | |
| 					  hp_wmi_get_sw_state(HPWMI_WIFI),
 | |
| 					  hp_wmi_get_hw_state(HPWMI_WIFI));
 | |
| 		if (bluetooth_rfkill)
 | |
| 			rfkill_set_states(bluetooth_rfkill,
 | |
| 					  hp_wmi_get_sw_state(HPWMI_BLUETOOTH),
 | |
| 					  hp_wmi_get_hw_state(HPWMI_BLUETOOTH));
 | |
| 		if (wwan_rfkill)
 | |
| 			rfkill_set_states(wwan_rfkill,
 | |
| 					  hp_wmi_get_sw_state(HPWMI_WWAN),
 | |
| 					  hp_wmi_get_hw_state(HPWMI_WWAN));
 | |
| 		break;
 | |
| 	case HPWMI_CPU_BATTERY_THROTTLE:
 | |
| 		pr_info("Unimplemented CPU throttle because of 3 Cell battery event detected\n");
 | |
| 		break;
 | |
| 	case HPWMI_LOCK_SWITCH:
 | |
| 		break;
 | |
| 	case HPWMI_LID_SWITCH:
 | |
| 		break;
 | |
| 	case HPWMI_SCREEN_ROTATION:
 | |
| 		break;
 | |
| 	case HPWMI_COOLSENSE_SYSTEM_MOBILE:
 | |
| 		break;
 | |
| 	case HPWMI_COOLSENSE_SYSTEM_HOT:
 | |
| 		break;
 | |
| 	case HPWMI_PROXIMITY_SENSOR:
 | |
| 		break;
 | |
| 	case HPWMI_BACKLIT_KB_BRIGHTNESS:
 | |
| 		break;
 | |
| 	case HPWMI_PEAKSHIFT_PERIOD:
 | |
| 		break;
 | |
| 	case HPWMI_BATTERY_CHARGE_PERIOD:
 | |
| 		break;
 | |
| 	case HPWMI_SANITIZATION_MODE:
 | |
| 		break;
 | |
| 	default:
 | |
| 		pr_info("Unknown event_id - %d - 0x%x\n", event_id, event_data);
 | |
| 		break;
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static int __init hp_wmi_input_setup(void)
 | |
| {
 | |
| 	acpi_status status;
 | |
| 	int err, val;
 | |
| 
 | |
| 	hp_wmi_input_dev = input_allocate_device();
 | |
| 	if (!hp_wmi_input_dev)
 | |
| 		return -ENOMEM;
 | |
| 
 | |
| 	hp_wmi_input_dev->name = "HP WMI hotkeys";
 | |
| 	hp_wmi_input_dev->phys = "wmi/input0";
 | |
| 	hp_wmi_input_dev->id.bustype = BUS_HOST;
 | |
| 
 | |
| 	__set_bit(EV_SW, hp_wmi_input_dev->evbit);
 | |
| 
 | |
| 	/* Dock */
 | |
| 	val = hp_wmi_get_dock_state();
 | |
| 	if (!(val < 0)) {
 | |
| 		__set_bit(SW_DOCK, hp_wmi_input_dev->swbit);
 | |
| 		input_report_switch(hp_wmi_input_dev, SW_DOCK, val);
 | |
| 	}
 | |
| 
 | |
| 	/* Tablet mode */
 | |
| 	val = hp_wmi_get_tablet_mode();
 | |
| 	if (!(val < 0)) {
 | |
| 		__set_bit(SW_TABLET_MODE, hp_wmi_input_dev->swbit);
 | |
| 		input_report_switch(hp_wmi_input_dev, SW_TABLET_MODE, val);
 | |
| 	}
 | |
| 
 | |
| 	err = sparse_keymap_setup(hp_wmi_input_dev, hp_wmi_keymap, NULL);
 | |
| 	if (err)
 | |
| 		goto err_free_dev;
 | |
| 
 | |
| 	/* Set initial hardware state */
 | |
| 	input_sync(hp_wmi_input_dev);
 | |
| 
 | |
| 	if (!hp_wmi_bios_2009_later() && hp_wmi_bios_2008_later())
 | |
| 		hp_wmi_enable_hotkeys();
 | |
| 
 | |
| 	status = wmi_install_notify_handler(HPWMI_EVENT_GUID, hp_wmi_notify, NULL);
 | |
| 	if (ACPI_FAILURE(status)) {
 | |
| 		err = -EIO;
 | |
| 		goto err_free_dev;
 | |
| 	}
 | |
| 
 | |
| 	err = input_register_device(hp_wmi_input_dev);
 | |
| 	if (err)
 | |
| 		goto err_uninstall_notifier;
 | |
| 
 | |
| 	return 0;
 | |
| 
 | |
|  err_uninstall_notifier:
 | |
| 	wmi_remove_notify_handler(HPWMI_EVENT_GUID);
 | |
|  err_free_dev:
 | |
| 	input_free_device(hp_wmi_input_dev);
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static void hp_wmi_input_destroy(void)
 | |
| {
 | |
| 	wmi_remove_notify_handler(HPWMI_EVENT_GUID);
 | |
| 	input_unregister_device(hp_wmi_input_dev);
 | |
| }
 | |
| 
 | |
| static int __init hp_wmi_rfkill_setup(struct platform_device *device)
 | |
| {
 | |
| 	int err, wireless;
 | |
| 
 | |
| 	wireless = hp_wmi_read_int(HPWMI_WIRELESS_QUERY);
 | |
| 	if (wireless < 0)
 | |
| 		return wireless;
 | |
| 
 | |
| 	err = hp_wmi_perform_query(HPWMI_WIRELESS_QUERY, HPWMI_WRITE, &wireless,
 | |
| 				   sizeof(wireless), 0);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	if (wireless & 0x1) {
 | |
| 		wifi_rfkill = rfkill_alloc("hp-wifi", &device->dev,
 | |
| 					   RFKILL_TYPE_WLAN,
 | |
| 					   &hp_wmi_rfkill_ops,
 | |
| 					   (void *) HPWMI_WIFI);
 | |
| 		if (!wifi_rfkill)
 | |
| 			return -ENOMEM;
 | |
| 		rfkill_init_sw_state(wifi_rfkill,
 | |
| 				     hp_wmi_get_sw_state(HPWMI_WIFI));
 | |
| 		rfkill_set_hw_state(wifi_rfkill,
 | |
| 				    hp_wmi_get_hw_state(HPWMI_WIFI));
 | |
| 		err = rfkill_register(wifi_rfkill);
 | |
| 		if (err)
 | |
| 			goto register_wifi_error;
 | |
| 	}
 | |
| 
 | |
| 	if (wireless & 0x2) {
 | |
| 		bluetooth_rfkill = rfkill_alloc("hp-bluetooth", &device->dev,
 | |
| 						RFKILL_TYPE_BLUETOOTH,
 | |
| 						&hp_wmi_rfkill_ops,
 | |
| 						(void *) HPWMI_BLUETOOTH);
 | |
| 		if (!bluetooth_rfkill) {
 | |
| 			err = -ENOMEM;
 | |
| 			goto register_bluetooth_error;
 | |
| 		}
 | |
| 		rfkill_init_sw_state(bluetooth_rfkill,
 | |
| 				     hp_wmi_get_sw_state(HPWMI_BLUETOOTH));
 | |
| 		rfkill_set_hw_state(bluetooth_rfkill,
 | |
| 				    hp_wmi_get_hw_state(HPWMI_BLUETOOTH));
 | |
| 		err = rfkill_register(bluetooth_rfkill);
 | |
| 		if (err)
 | |
| 			goto register_bluetooth_error;
 | |
| 	}
 | |
| 
 | |
| 	if (wireless & 0x4) {
 | |
| 		wwan_rfkill = rfkill_alloc("hp-wwan", &device->dev,
 | |
| 					   RFKILL_TYPE_WWAN,
 | |
| 					   &hp_wmi_rfkill_ops,
 | |
| 					   (void *) HPWMI_WWAN);
 | |
| 		if (!wwan_rfkill) {
 | |
| 			err = -ENOMEM;
 | |
| 			goto register_wwan_error;
 | |
| 		}
 | |
| 		rfkill_init_sw_state(wwan_rfkill,
 | |
| 				     hp_wmi_get_sw_state(HPWMI_WWAN));
 | |
| 		rfkill_set_hw_state(wwan_rfkill,
 | |
| 				    hp_wmi_get_hw_state(HPWMI_WWAN));
 | |
| 		err = rfkill_register(wwan_rfkill);
 | |
| 		if (err)
 | |
| 			goto register_wwan_error;
 | |
| 	}
 | |
| 
 | |
| 	return 0;
 | |
| 
 | |
| register_wwan_error:
 | |
| 	rfkill_destroy(wwan_rfkill);
 | |
| 	wwan_rfkill = NULL;
 | |
| 	if (bluetooth_rfkill)
 | |
| 		rfkill_unregister(bluetooth_rfkill);
 | |
| register_bluetooth_error:
 | |
| 	rfkill_destroy(bluetooth_rfkill);
 | |
| 	bluetooth_rfkill = NULL;
 | |
| 	if (wifi_rfkill)
 | |
| 		rfkill_unregister(wifi_rfkill);
 | |
| register_wifi_error:
 | |
| 	rfkill_destroy(wifi_rfkill);
 | |
| 	wifi_rfkill = NULL;
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static int __init hp_wmi_rfkill2_setup(struct platform_device *device)
 | |
| {
 | |
| 	struct bios_rfkill2_state state;
 | |
| 	int err, i;
 | |
| 
 | |
| 	err = hp_wmi_perform_query(HPWMI_WIRELESS2_QUERY, HPWMI_READ, &state,
 | |
| 				   zero_if_sup(state), sizeof(state));
 | |
| 	if (err)
 | |
| 		return err < 0 ? err : -EINVAL;
 | |
| 
 | |
| 	if (state.count > HPWMI_MAX_RFKILL2_DEVICES) {
 | |
| 		pr_warn("unable to parse 0x1b query output\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	for (i = 0; i < state.count; i++) {
 | |
| 		struct rfkill *rfkill;
 | |
| 		enum rfkill_type type;
 | |
| 		char *name;
 | |
| 
 | |
| 		switch (state.device[i].radio_type) {
 | |
| 		case HPWMI_WIFI:
 | |
| 			type = RFKILL_TYPE_WLAN;
 | |
| 			name = "hp-wifi";
 | |
| 			break;
 | |
| 		case HPWMI_BLUETOOTH:
 | |
| 			type = RFKILL_TYPE_BLUETOOTH;
 | |
| 			name = "hp-bluetooth";
 | |
| 			break;
 | |
| 		case HPWMI_WWAN:
 | |
| 			type = RFKILL_TYPE_WWAN;
 | |
| 			name = "hp-wwan";
 | |
| 			break;
 | |
| 		case HPWMI_GPS:
 | |
| 			type = RFKILL_TYPE_GPS;
 | |
| 			name = "hp-gps";
 | |
| 			break;
 | |
| 		default:
 | |
| 			pr_warn("unknown device type 0x%x\n",
 | |
| 				state.device[i].radio_type);
 | |
| 			continue;
 | |
| 		}
 | |
| 
 | |
| 		if (!state.device[i].vendor_id) {
 | |
| 			pr_warn("zero device %d while %d reported\n",
 | |
| 				i, state.count);
 | |
| 			continue;
 | |
| 		}
 | |
| 
 | |
| 		rfkill = rfkill_alloc(name, &device->dev, type,
 | |
| 				      &hp_wmi_rfkill2_ops, (void *)(long)i);
 | |
| 		if (!rfkill) {
 | |
| 			err = -ENOMEM;
 | |
| 			goto fail;
 | |
| 		}
 | |
| 
 | |
| 		rfkill2[rfkill2_count].id = state.device[i].rfkill_id;
 | |
| 		rfkill2[rfkill2_count].num = i;
 | |
| 		rfkill2[rfkill2_count].rfkill = rfkill;
 | |
| 
 | |
| 		rfkill_init_sw_state(rfkill,
 | |
| 				     IS_SWBLOCKED(state.device[i].power));
 | |
| 		rfkill_set_hw_state(rfkill,
 | |
| 				    IS_HWBLOCKED(state.device[i].power));
 | |
| 
 | |
| 		if (!(state.device[i].power & HPWMI_POWER_BIOS))
 | |
| 			pr_info("device %s blocked by BIOS\n", name);
 | |
| 
 | |
| 		err = rfkill_register(rfkill);
 | |
| 		if (err) {
 | |
| 			rfkill_destroy(rfkill);
 | |
| 			goto fail;
 | |
| 		}
 | |
| 
 | |
| 		rfkill2_count++;
 | |
| 	}
 | |
| 
 | |
| 	return 0;
 | |
| fail:
 | |
| 	for (; rfkill2_count > 0; rfkill2_count--) {
 | |
| 		rfkill_unregister(rfkill2[rfkill2_count - 1].rfkill);
 | |
| 		rfkill_destroy(rfkill2[rfkill2_count - 1].rfkill);
 | |
| 	}
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static int platform_profile_omen_get(struct platform_profile_handler *pprof,
 | |
| 				     enum platform_profile_option *profile)
 | |
| {
 | |
| 	int tp;
 | |
| 
 | |
| 	tp = omen_thermal_profile_get();
 | |
| 	if (tp < 0)
 | |
| 		return tp;
 | |
| 
 | |
| 	switch (tp) {
 | |
| 	case HP_OMEN_V0_THERMAL_PROFILE_PERFORMANCE:
 | |
| 	case HP_OMEN_V1_THERMAL_PROFILE_PERFORMANCE:
 | |
| 		*profile = PLATFORM_PROFILE_PERFORMANCE;
 | |
| 		break;
 | |
| 	case HP_OMEN_V0_THERMAL_PROFILE_DEFAULT:
 | |
| 	case HP_OMEN_V1_THERMAL_PROFILE_DEFAULT:
 | |
| 		*profile = PLATFORM_PROFILE_BALANCED;
 | |
| 		break;
 | |
| 	case HP_OMEN_V0_THERMAL_PROFILE_COOL:
 | |
| 	case HP_OMEN_V1_THERMAL_PROFILE_COOL:
 | |
| 		*profile = PLATFORM_PROFILE_COOL;
 | |
| 		break;
 | |
| 	default:
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int platform_profile_omen_set(struct platform_profile_handler *pprof,
 | |
| 				     enum platform_profile_option profile)
 | |
| {
 | |
| 	int err, tp, tp_version;
 | |
| 
 | |
| 	tp_version = omen_get_thermal_policy_version();
 | |
| 
 | |
| 	if (tp_version < 0 || tp_version > 1)
 | |
| 		return -EOPNOTSUPP;
 | |
| 
 | |
| 	switch (profile) {
 | |
| 	case PLATFORM_PROFILE_PERFORMANCE:
 | |
| 		if (tp_version == 0)
 | |
| 			tp = HP_OMEN_V0_THERMAL_PROFILE_PERFORMANCE;
 | |
| 		else
 | |
| 			tp = HP_OMEN_V1_THERMAL_PROFILE_PERFORMANCE;
 | |
| 		break;
 | |
| 	case PLATFORM_PROFILE_BALANCED:
 | |
| 		if (tp_version == 0)
 | |
| 			tp = HP_OMEN_V0_THERMAL_PROFILE_DEFAULT;
 | |
| 		else
 | |
| 			tp = HP_OMEN_V1_THERMAL_PROFILE_DEFAULT;
 | |
| 		break;
 | |
| 	case PLATFORM_PROFILE_COOL:
 | |
| 		if (tp_version == 0)
 | |
| 			tp = HP_OMEN_V0_THERMAL_PROFILE_COOL;
 | |
| 		else
 | |
| 			tp = HP_OMEN_V1_THERMAL_PROFILE_COOL;
 | |
| 		break;
 | |
| 	default:
 | |
| 		return -EOPNOTSUPP;
 | |
| 	}
 | |
| 
 | |
| 	err = omen_thermal_profile_set(tp);
 | |
| 	if (err < 0)
 | |
| 		return err;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int thermal_profile_get(void)
 | |
| {
 | |
| 	return hp_wmi_read_int(HPWMI_THERMAL_PROFILE_QUERY);
 | |
| }
 | |
| 
 | |
| static int thermal_profile_set(int thermal_profile)
 | |
| {
 | |
| 	return hp_wmi_perform_query(HPWMI_THERMAL_PROFILE_QUERY, HPWMI_WRITE, &thermal_profile,
 | |
| 							   sizeof(thermal_profile), 0);
 | |
| }
 | |
| 
 | |
| static int hp_wmi_platform_profile_get(struct platform_profile_handler *pprof,
 | |
| 					enum platform_profile_option *profile)
 | |
| {
 | |
| 	int tp;
 | |
| 
 | |
| 	tp = thermal_profile_get();
 | |
| 	if (tp < 0)
 | |
| 		return tp;
 | |
| 
 | |
| 	switch (tp) {
 | |
| 	case HP_THERMAL_PROFILE_PERFORMANCE:
 | |
| 		*profile =  PLATFORM_PROFILE_PERFORMANCE;
 | |
| 		break;
 | |
| 	case HP_THERMAL_PROFILE_DEFAULT:
 | |
| 		*profile =  PLATFORM_PROFILE_BALANCED;
 | |
| 		break;
 | |
| 	case HP_THERMAL_PROFILE_COOL:
 | |
| 		*profile =  PLATFORM_PROFILE_COOL;
 | |
| 		break;
 | |
| 	default:
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int hp_wmi_platform_profile_set(struct platform_profile_handler *pprof,
 | |
| 					enum platform_profile_option profile)
 | |
| {
 | |
| 	int err, tp;
 | |
| 
 | |
| 	switch (profile) {
 | |
| 	case PLATFORM_PROFILE_PERFORMANCE:
 | |
| 		tp =  HP_THERMAL_PROFILE_PERFORMANCE;
 | |
| 		break;
 | |
| 	case PLATFORM_PROFILE_BALANCED:
 | |
| 		tp =  HP_THERMAL_PROFILE_DEFAULT;
 | |
| 		break;
 | |
| 	case PLATFORM_PROFILE_COOL:
 | |
| 		tp =  HP_THERMAL_PROFILE_COOL;
 | |
| 		break;
 | |
| 	default:
 | |
| 		return -EOPNOTSUPP;
 | |
| 	}
 | |
| 
 | |
| 	err = thermal_profile_set(tp);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int thermal_profile_setup(void)
 | |
| {
 | |
| 	int err, tp;
 | |
| 
 | |
| 	if (is_omen_thermal_profile()) {
 | |
| 		tp = omen_thermal_profile_get();
 | |
| 		if (tp < 0)
 | |
| 			return tp;
 | |
| 
 | |
| 		/*
 | |
| 		 * call thermal profile write command to ensure that the
 | |
| 		 * firmware correctly sets the OEM variables
 | |
| 		 */
 | |
| 
 | |
| 		err = omen_thermal_profile_set(tp);
 | |
| 		if (err < 0)
 | |
| 			return err;
 | |
| 
 | |
| 		platform_profile_handler.profile_get = platform_profile_omen_get;
 | |
| 		platform_profile_handler.profile_set = platform_profile_omen_set;
 | |
| 	} else {
 | |
| 		tp = thermal_profile_get();
 | |
| 
 | |
| 		if (tp < 0)
 | |
| 			return tp;
 | |
| 
 | |
| 		/*
 | |
| 		 * call thermal profile write command to ensure that the
 | |
| 		 * firmware correctly sets the OEM variables for the DPTF
 | |
| 		 */
 | |
| 		err = thermal_profile_set(tp);
 | |
| 		if (err)
 | |
| 			return err;
 | |
| 
 | |
| 		platform_profile_handler.profile_get = hp_wmi_platform_profile_get;
 | |
| 		platform_profile_handler.profile_set = hp_wmi_platform_profile_set;
 | |
| 	}
 | |
| 
 | |
| 	set_bit(PLATFORM_PROFILE_COOL, platform_profile_handler.choices);
 | |
| 	set_bit(PLATFORM_PROFILE_BALANCED, platform_profile_handler.choices);
 | |
| 	set_bit(PLATFORM_PROFILE_PERFORMANCE, platform_profile_handler.choices);
 | |
| 
 | |
| 	err = platform_profile_register(&platform_profile_handler);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	platform_profile_support = true;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int hp_wmi_hwmon_init(void);
 | |
| 
 | |
| static int __init hp_wmi_bios_setup(struct platform_device *device)
 | |
| {
 | |
| 	int err;
 | |
| 	/* clear detected rfkill devices */
 | |
| 	wifi_rfkill = NULL;
 | |
| 	bluetooth_rfkill = NULL;
 | |
| 	wwan_rfkill = NULL;
 | |
| 	rfkill2_count = 0;
 | |
| 
 | |
| 	if (hp_wmi_rfkill_setup(device))
 | |
| 		hp_wmi_rfkill2_setup(device);
 | |
| 
 | |
| 	err = hp_wmi_hwmon_init();
 | |
| 
 | |
| 	if (err < 0)
 | |
| 		return err;
 | |
| 
 | |
| 	thermal_profile_setup();
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int __exit hp_wmi_bios_remove(struct platform_device *device)
 | |
| {
 | |
| 	int i;
 | |
| 
 | |
| 	for (i = 0; i < rfkill2_count; i++) {
 | |
| 		rfkill_unregister(rfkill2[i].rfkill);
 | |
| 		rfkill_destroy(rfkill2[i].rfkill);
 | |
| 	}
 | |
| 
 | |
| 	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);
 | |
| 	}
 | |
| 
 | |
| 	if (platform_profile_support)
 | |
| 		platform_profile_remove();
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int hp_wmi_resume_handler(struct device *device)
 | |
| {
 | |
| 	/*
 | |
| 	 * Hardware state may have changed while suspended, so trigger
 | |
| 	 * input events for the current state. As this is a switch,
 | |
| 	 * the input layer will only actually pass it on if the state
 | |
| 	 * changed.
 | |
| 	 */
 | |
| 	if (hp_wmi_input_dev) {
 | |
| 		if (test_bit(SW_DOCK, hp_wmi_input_dev->swbit))
 | |
| 			input_report_switch(hp_wmi_input_dev, SW_DOCK,
 | |
| 					    hp_wmi_get_dock_state());
 | |
| 		if (test_bit(SW_TABLET_MODE, hp_wmi_input_dev->swbit))
 | |
| 			input_report_switch(hp_wmi_input_dev, SW_TABLET_MODE,
 | |
| 					    hp_wmi_get_tablet_mode());
 | |
| 		input_sync(hp_wmi_input_dev);
 | |
| 	}
 | |
| 
 | |
| 	if (rfkill2_count)
 | |
| 		hp_wmi_rfkill2_refresh();
 | |
| 
 | |
| 	if (wifi_rfkill)
 | |
| 		rfkill_set_states(wifi_rfkill,
 | |
| 				  hp_wmi_get_sw_state(HPWMI_WIFI),
 | |
| 				  hp_wmi_get_hw_state(HPWMI_WIFI));
 | |
| 	if (bluetooth_rfkill)
 | |
| 		rfkill_set_states(bluetooth_rfkill,
 | |
| 				  hp_wmi_get_sw_state(HPWMI_BLUETOOTH),
 | |
| 				  hp_wmi_get_hw_state(HPWMI_BLUETOOTH));
 | |
| 	if (wwan_rfkill)
 | |
| 		rfkill_set_states(wwan_rfkill,
 | |
| 				  hp_wmi_get_sw_state(HPWMI_WWAN),
 | |
| 				  hp_wmi_get_hw_state(HPWMI_WWAN));
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static const struct dev_pm_ops hp_wmi_pm_ops = {
 | |
| 	.resume  = hp_wmi_resume_handler,
 | |
| 	.restore  = hp_wmi_resume_handler,
 | |
| };
 | |
| 
 | |
| static struct platform_driver hp_wmi_driver = {
 | |
| 	.driver = {
 | |
| 		.name = "hp-wmi",
 | |
| 		.pm = &hp_wmi_pm_ops,
 | |
| 		.dev_groups = hp_wmi_groups,
 | |
| 	},
 | |
| 	.remove = __exit_p(hp_wmi_bios_remove),
 | |
| };
 | |
| 
 | |
| static umode_t hp_wmi_hwmon_is_visible(const void *data,
 | |
| 				       enum hwmon_sensor_types type,
 | |
| 				       u32 attr, int channel)
 | |
| {
 | |
| 	switch (type) {
 | |
| 	case hwmon_pwm:
 | |
| 		return 0644;
 | |
| 	case hwmon_fan:
 | |
| 		if (hp_wmi_get_fan_speed(channel) >= 0)
 | |
| 			return 0444;
 | |
| 		break;
 | |
| 	default:
 | |
| 		return 0;
 | |
| 	}
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int hp_wmi_hwmon_read(struct device *dev, enum hwmon_sensor_types type,
 | |
| 			     u32 attr, int channel, long *val)
 | |
| {
 | |
| 	int ret;
 | |
| 
 | |
| 	switch (type) {
 | |
| 	case hwmon_fan:
 | |
| 		ret = hp_wmi_get_fan_speed(channel);
 | |
| 
 | |
| 		if (ret < 0)
 | |
| 			return ret;
 | |
| 		*val = ret;
 | |
| 		return 0;
 | |
| 	case hwmon_pwm:
 | |
| 		switch (hp_wmi_fan_speed_max_get()) {
 | |
| 		case 0:
 | |
| 			/* 0 is automatic fan, which is 2 for hwmon */
 | |
| 			*val = 2;
 | |
| 			return 0;
 | |
| 		case 1:
 | |
| 			/* 1 is max fan, which is 0
 | |
| 			 * (no fan speed control) for hwmon
 | |
| 			 */
 | |
| 			*val = 0;
 | |
| 			return 0;
 | |
| 		default:
 | |
| 			/* shouldn't happen */
 | |
| 			return -ENODATA;
 | |
| 		}
 | |
| 	default:
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static int hp_wmi_hwmon_write(struct device *dev, enum hwmon_sensor_types type,
 | |
| 			      u32 attr, int channel, long val)
 | |
| {
 | |
| 	switch (type) {
 | |
| 	case hwmon_pwm:
 | |
| 		switch (val) {
 | |
| 		case 0:
 | |
| 			/* 0 is no fan speed control (max), which is 1 for us */
 | |
| 			return hp_wmi_fan_speed_max_set(1);
 | |
| 		case 2:
 | |
| 			/* 2 is automatic speed control, which is 0 for us */
 | |
| 			return hp_wmi_fan_speed_max_set(0);
 | |
| 		default:
 | |
| 			/* we don't support manual fan speed control */
 | |
| 			return -EINVAL;
 | |
| 		}
 | |
| 	default:
 | |
| 		return -EOPNOTSUPP;
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static const struct hwmon_channel_info *info[] = {
 | |
| 	HWMON_CHANNEL_INFO(fan, HWMON_F_INPUT, HWMON_F_INPUT),
 | |
| 	HWMON_CHANNEL_INFO(pwm, HWMON_PWM_ENABLE),
 | |
| 	NULL
 | |
| };
 | |
| 
 | |
| static const struct hwmon_ops ops = {
 | |
| 	.is_visible = hp_wmi_hwmon_is_visible,
 | |
| 	.read = hp_wmi_hwmon_read,
 | |
| 	.write = hp_wmi_hwmon_write,
 | |
| };
 | |
| 
 | |
| static const struct hwmon_chip_info chip_info = {
 | |
| 	.ops = &ops,
 | |
| 	.info = info,
 | |
| };
 | |
| 
 | |
| static int hp_wmi_hwmon_init(void)
 | |
| {
 | |
| 	struct device *dev = &hp_wmi_platform_dev->dev;
 | |
| 	struct device *hwmon;
 | |
| 
 | |
| 	hwmon = devm_hwmon_device_register_with_info(dev, "hp", &hp_wmi_driver,
 | |
| 						     &chip_info, NULL);
 | |
| 
 | |
| 	if (IS_ERR(hwmon)) {
 | |
| 		dev_err(dev, "Could not register hp hwmon device\n");
 | |
| 		return PTR_ERR(hwmon);
 | |
| 	}
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int __init hp_wmi_init(void)
 | |
| {
 | |
| 	int event_capable = wmi_has_guid(HPWMI_EVENT_GUID);
 | |
| 	int bios_capable = wmi_has_guid(HPWMI_BIOS_GUID);
 | |
| 	int err, tmp = 0;
 | |
| 
 | |
| 	if (!bios_capable && !event_capable)
 | |
| 		return -ENODEV;
 | |
| 
 | |
| 	if (hp_wmi_perform_query(HPWMI_HARDWARE_QUERY, HPWMI_READ, &tmp,
 | |
| 				 sizeof(tmp), sizeof(tmp)) == HPWMI_RET_INVALID_PARAMETERS)
 | |
| 		zero_insize_support = true;
 | |
| 
 | |
| 	if (event_capable) {
 | |
| 		err = hp_wmi_input_setup();
 | |
| 		if (err)
 | |
| 			return err;
 | |
| 	}
 | |
| 
 | |
| 	if (bios_capable) {
 | |
| 		hp_wmi_platform_dev =
 | |
| 			platform_device_register_simple("hp-wmi", -1, NULL, 0);
 | |
| 		if (IS_ERR(hp_wmi_platform_dev)) {
 | |
| 			err = PTR_ERR(hp_wmi_platform_dev);
 | |
| 			goto err_destroy_input;
 | |
| 		}
 | |
| 
 | |
| 		err = platform_driver_probe(&hp_wmi_driver, hp_wmi_bios_setup);
 | |
| 		if (err)
 | |
| 			goto err_unregister_device;
 | |
| 	}
 | |
| 
 | |
| 	return 0;
 | |
| 
 | |
| err_unregister_device:
 | |
| 	platform_device_unregister(hp_wmi_platform_dev);
 | |
| err_destroy_input:
 | |
| 	if (event_capable)
 | |
| 		hp_wmi_input_destroy();
 | |
| 
 | |
| 	return err;
 | |
| }
 | |
| module_init(hp_wmi_init);
 | |
| 
 | |
| static void __exit hp_wmi_exit(void)
 | |
| {
 | |
| 	if (wmi_has_guid(HPWMI_EVENT_GUID))
 | |
| 		hp_wmi_input_destroy();
 | |
| 
 | |
| 	if (hp_wmi_platform_dev) {
 | |
| 		platform_device_unregister(hp_wmi_platform_dev);
 | |
| 		platform_driver_unregister(&hp_wmi_driver);
 | |
| 	}
 | |
| }
 | |
| module_exit(hp_wmi_exit);
 |