platform-drivers-x86 for 4.10-1
Introduce one new driver for Mellanox platforms. Add support for various new models to existing drivers via quirks, hotkeys, etc. Significant updates to intel_pmc_core in support of Kabylake and Sunrise Point PCH power management debug. Some cleanup and refactoring across various drivers. dell-laptop: - Use brightness_set_blocking for kbd_led_level_set thinkpad_acpi: - Initialize local in_tablet_mode and type - Fix old style declaration GCC warning - Adding new hotkey ID for Lenovo thinkpad - Add support for X1 Yoga (2016) Tablet Mode - Move tablet detection into separate function asus-nb-wmi: - Add X45U quirk - Make use of dmi->ident asus-wmi: - Set specified XUSB2PR value for X550LB intel_mid_thermal: - Fix suspend handlers unused warning intel-vbtn: - Switch to use devm_input_allocate_device dell-wmi: - Add events created by Dell Rugged 2-in-1s - Adjust wifi catcher to emit KEY_WLAN intel_pmc_core: - Add KBL CPUID support - Add LTR IGNORE debug feature - Add MPHY PLL clock gating status - ModPhy core lanes pg status - Add PCH IP Power Gating Status - Fix PWRMBASE mask and mmio reg len acer-wmi: - Only supports AMW0_GUID1 on acer family mlx-platform: - Introduce support for Mellanox hotplug driver platform/x86: - Use ACPI_FAILURE at appropriate places -----BEGIN PGP SIGNATURE----- iQEcBAABAgAGBQJYUwFxAAoJEKbMaAwKp3645GkH/RjsE8jubyerhlKqgG4UZaRA 2a2NnCOI1fuDqSV0bgIo4rzMHeHHjR8Hosz6HXkb3cC67QNfae3Xasr2+vqzqqKd hJFUL/y6JmAhLUcPVp49HWOLrYLKM12iLyEidPOor4r/qWrarLtVEyvX5O8VEy01 +cM29+KcZnHjtQQoDaVwWZ1bEbLVNRlSrQ/YZivGBPXJBsvnz1Wq5xPuGHDm660X rVw8h1GojPwctiNWTpw2VlMUz8Ho0yXMBAPTpEJOzlFR8FTaSD6XQqm/uZ5w8ToJ Sn12XavaKeQSki7VVTmouL+L4Ams0Ygz8pgDd3ynhN6U/hFfTWbGhdRCILxmSRk= =iHwp -----END PGP SIGNATURE----- Merge tag 'platform-drivers-x86-v4.10-1' of git://git.infradead.org/users/dvhart/linux-platform-drivers-x86 Pull x86 platform driver updates from Darrent Hart: "Introduce one new driver for Mellanox platforms. Add support for various new models to existing drivers via quirks, hotkeys, etc. Significant updates to intel_pmc_core in support of Kabylake and Sunrise Point PCH power management debug. Some cleanup and refactoring across various drivers. Detailed summary: dell-laptop: - Use brightness_set_blocking for kbd_led_level_set thinkpad_acpi: - Initialize local in_tablet_mode and type - Fix old style declaration GCC warning - Adding new hotkey ID for Lenovo thinkpad - Add support for X1 Yoga (2016) Tablet Mode - Move tablet detection into separate function asus-nb-wmi: - Add X45U quirk - Make use of dmi->ident asus-wmi: - Set specified XUSB2PR value for X550LB intel_mid_thermal: - Fix suspend handlers unused warning intel-vbtn: - Switch to use devm_input_allocate_device dell-wmi: - Add events created by Dell Rugged 2-in-1s - Adjust wifi catcher to emit KEY_WLAN intel_pmc_core: - Add KBL CPUID support - Add LTR IGNORE debug feature - Add MPHY PLL clock gating status - ModPhy core lanes pg status - Add PCH IP Power Gating Status - Fix PWRMBASE mask and mmio reg len acer-wmi: - Only supports AMW0_GUID1 on acer family mlx-platform: - Introduce support for Mellanox hotplug driver platform/x86: - Use ACPI_FAILURE at appropriate places" * tag 'platform-drivers-x86-v4.10-1' of git://git.infradead.org/users/dvhart/linux-platform-drivers-x86: (22 commits) platform/x86: thinkpad_acpi: Initialize local in_tablet_mode and type platform/x86: dell-laptop: Use brightness_set_blocking for kbd_led_level_set platform/x86: thinkpad_acpi: Fix old style declaration GCC warning platform/x86: thinkpad_acpi: Adding new hotkey ID for Lenovo thinkpad platform/x86: thinkpad_acpi: Add support for X1 Yoga (2016) Tablet Mode platform/x86: thinkpad_acpi: Move tablet detection into separate function platform/x86: asus-nb-wmi.c: Add X45U quirk platform/x86: asus-nb-wmi: Make use of dmi->ident platform/x86: asus-wmi: Set specified XUSB2PR value for X550LB platform/x86: intel_mid_thermal: Fix suspend handlers unused warning platform/x86: intel-vbtn: Switch to use devm_input_allocate_device platform/x86: Use ACPI_FAILURE at appropriate places platform/x86: dell-wmi: Add events created by Dell Rugged 2-in-1s platform/x86: dell-wmi: Adjust wifi catcher to emit KEY_WLAN platform/x86: intel_pmc_core: Add KBL CPUID support platform/x86: intel_pmc_core: Add LTR IGNORE debug feature platform/x86: intel_pmc_core: Add MPHY PLL clock gating status platform/x86: intel_pmc_core: ModPhy core lanes pg status platform/x86: intel_pmc_core: Add PCH IP Power Gating Status platform/x86: intel_pmc_core: Fix PWRMBASE mask and mmio reg len ...
This commit is contained in:
commit
e18bf801f1
@ -540,6 +540,7 @@ Events that are propagated by the driver to userspace:
|
|||||||
0x6022 ALARM: a sensor is extremely hot
|
0x6022 ALARM: a sensor is extremely hot
|
||||||
0x6030 System thermal table changed
|
0x6030 System thermal table changed
|
||||||
0x6040 Nvidia Optimus/AC adapter related (TO BE VERIFIED)
|
0x6040 Nvidia Optimus/AC adapter related (TO BE VERIFIED)
|
||||||
|
0x60C0 X1 Yoga 2016, Tablet mode status changed
|
||||||
|
|
||||||
Battery nearly empty alarms are a last resort attempt to get the
|
Battery nearly empty alarms are a last resort attempt to get the
|
||||||
operating system to hibernate or shutdown cleanly (0x2313), or shutdown
|
operating system to hibernate or shutdown cleanly (0x2313), or shutdown
|
||||||
|
@ -8045,6 +8045,13 @@ L: platform-driver-x86@vger.kernel.org
|
|||||||
S: Supported
|
S: Supported
|
||||||
F: arch/x86/platform/mellanox/mlx-platform.c
|
F: arch/x86/platform/mellanox/mlx-platform.c
|
||||||
|
|
||||||
|
MELLANOX MLX CPLD HOTPLUG DRIVER
|
||||||
|
M: Vadim Pasternak <vadimp@mellanox.com>
|
||||||
|
L: platform-driver-x86@vger.kernel.org
|
||||||
|
S: Supported
|
||||||
|
F: drivers/platform/x86/mlxcpld-hotplug.c
|
||||||
|
F: include/linux/platform_data/mlxcpld-hotplug.h
|
||||||
|
|
||||||
SOFT-ROCE DRIVER (rxe)
|
SOFT-ROCE DRIVER (rxe)
|
||||||
M: Moni Shoua <monis@mellanox.com>
|
M: Moni Shoua <monis@mellanox.com>
|
||||||
L: linux-rdma@vger.kernel.org
|
L: linux-rdma@vger.kernel.org
|
||||||
|
@ -1027,4 +1027,15 @@ config INTEL_TELEMETRY
|
|||||||
used to get various SoC events and parameters
|
used to get various SoC events and parameters
|
||||||
directly via debugfs files. Various tools may use
|
directly via debugfs files. Various tools may use
|
||||||
this interface for SoC state monitoring.
|
this interface for SoC state monitoring.
|
||||||
|
|
||||||
|
config MLX_CPLD_PLATFORM
|
||||||
|
tristate "Mellanox platform hotplug driver support"
|
||||||
|
default n
|
||||||
|
depends on MLX_PLATFORM
|
||||||
|
select HWMON
|
||||||
|
select I2C
|
||||||
|
---help---
|
||||||
|
This driver handles hot-plug events for the power suppliers, power
|
||||||
|
cables and fans on the wide range Mellanox IB and Ethernet systems.
|
||||||
|
|
||||||
endif # X86_PLATFORM_DEVICES
|
endif # X86_PLATFORM_DEVICES
|
||||||
|
@ -71,3 +71,4 @@ obj-$(CONFIG_INTEL_TELEMETRY) += intel_telemetry_core.o \
|
|||||||
intel_telemetry_pltdrv.o \
|
intel_telemetry_pltdrv.o \
|
||||||
intel_telemetry_debugfs.o
|
intel_telemetry_debugfs.o
|
||||||
obj-$(CONFIG_INTEL_PMC_CORE) += intel_pmc_core.o
|
obj-$(CONFIG_INTEL_PMC_CORE) += intel_pmc_core.o
|
||||||
|
obj-$(CONFIG_MLX_CPLD_PLATFORM) += mlxcpld-hotplug.o
|
||||||
|
@ -355,6 +355,32 @@ static const struct dmi_system_id acer_blacklist[] __initconst = {
|
|||||||
{}
|
{}
|
||||||
};
|
};
|
||||||
|
|
||||||
|
static const struct dmi_system_id amw0_whitelist[] __initconst = {
|
||||||
|
{
|
||||||
|
.ident = "Acer",
|
||||||
|
.matches = {
|
||||||
|
DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
|
||||||
|
},
|
||||||
|
},
|
||||||
|
{
|
||||||
|
.ident = "Gateway",
|
||||||
|
.matches = {
|
||||||
|
DMI_MATCH(DMI_SYS_VENDOR, "Gateway"),
|
||||||
|
},
|
||||||
|
},
|
||||||
|
{
|
||||||
|
.ident = "Packard Bell",
|
||||||
|
.matches = {
|
||||||
|
DMI_MATCH(DMI_SYS_VENDOR, "Packard Bell"),
|
||||||
|
},
|
||||||
|
},
|
||||||
|
{}
|
||||||
|
};
|
||||||
|
|
||||||
|
/*
|
||||||
|
* This quirk table is only for Acer/Gateway/Packard Bell family
|
||||||
|
* that those machines are supported by acer-wmi driver.
|
||||||
|
*/
|
||||||
static const struct dmi_system_id acer_quirks[] __initconst = {
|
static const struct dmi_system_id acer_quirks[] __initconst = {
|
||||||
{
|
{
|
||||||
.callback = dmi_matched,
|
.callback = dmi_matched,
|
||||||
@ -464,6 +490,17 @@ static const struct dmi_system_id acer_quirks[] __initconst = {
|
|||||||
},
|
},
|
||||||
.driver_data = &quirk_acer_travelmate_2490,
|
.driver_data = &quirk_acer_travelmate_2490,
|
||||||
},
|
},
|
||||||
|
{}
|
||||||
|
};
|
||||||
|
|
||||||
|
/*
|
||||||
|
* This quirk list is for those non-acer machines that have AMW0_GUID1
|
||||||
|
* but supported by acer-wmi in past days. Keeping this quirk list here
|
||||||
|
* is only for backward compatible. Please do not add new machine to
|
||||||
|
* here anymore. Those non-acer machines should be supported by
|
||||||
|
* appropriate wmi drivers.
|
||||||
|
*/
|
||||||
|
static const struct dmi_system_id non_acer_quirks[] __initconst = {
|
||||||
{
|
{
|
||||||
.callback = dmi_matched,
|
.callback = dmi_matched,
|
||||||
.ident = "Fujitsu Siemens Amilo Li 1718",
|
.ident = "Fujitsu Siemens Amilo Li 1718",
|
||||||
@ -598,6 +635,7 @@ static void __init find_quirks(void)
|
|||||||
{
|
{
|
||||||
if (!force_series) {
|
if (!force_series) {
|
||||||
dmi_check_system(acer_quirks);
|
dmi_check_system(acer_quirks);
|
||||||
|
dmi_check_system(non_acer_quirks);
|
||||||
} else if (force_series == 2490) {
|
} else if (force_series == 2490) {
|
||||||
quirks = &quirk_acer_travelmate_2490;
|
quirks = &quirk_acer_travelmate_2490;
|
||||||
}
|
}
|
||||||
@ -2107,6 +2145,24 @@ static int __init acer_wmi_init(void)
|
|||||||
|
|
||||||
find_quirks();
|
find_quirks();
|
||||||
|
|
||||||
|
/*
|
||||||
|
* The AMW0_GUID1 wmi is not only found on Acer family but also other
|
||||||
|
* machines like Lenovo, Fujitsu and Medion. In the past days,
|
||||||
|
* acer-wmi driver handled those non-Acer machines by quirks list.
|
||||||
|
* But actually acer-wmi driver was loaded on any machines that have
|
||||||
|
* AMW0_GUID1. This behavior is strange because those machines should
|
||||||
|
* be supported by appropriate wmi drivers. e.g. fujitsu-laptop,
|
||||||
|
* ideapad-laptop. So, here checks the machine that has AMW0_GUID1
|
||||||
|
* should be in Acer/Gateway/Packard Bell white list, or it's already
|
||||||
|
* in the past quirk list.
|
||||||
|
*/
|
||||||
|
if (wmi_has_guid(AMW0_GUID1) &&
|
||||||
|
!dmi_check_system(amw0_whitelist) &&
|
||||||
|
quirks == &quirk_unknown) {
|
||||||
|
pr_err("Unsupported machine has AMW0_GUID1, unable to load\n");
|
||||||
|
return -ENODEV;
|
||||||
|
}
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Detect which ACPI-WMI interface we're using.
|
* Detect which ACPI-WMI interface we're using.
|
||||||
*/
|
*/
|
||||||
|
@ -116,8 +116,13 @@ static struct quirk_entry quirk_asus_ux303ub = {
|
|||||||
.wmi_backlight_native = true,
|
.wmi_backlight_native = true,
|
||||||
};
|
};
|
||||||
|
|
||||||
|
static struct quirk_entry quirk_asus_x550lb = {
|
||||||
|
.xusb2pr = 0x01D9,
|
||||||
|
};
|
||||||
|
|
||||||
static int dmi_matched(const struct dmi_system_id *dmi)
|
static int dmi_matched(const struct dmi_system_id *dmi)
|
||||||
{
|
{
|
||||||
|
pr_info("Identified laptop model '%s'\n", dmi->ident);
|
||||||
quirks = dmi->driver_data;
|
quirks = dmi->driver_data;
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
@ -173,6 +178,15 @@ static const struct dmi_system_id asus_quirks[] = {
|
|||||||
},
|
},
|
||||||
.driver_data = &quirk_asus_wapf4,
|
.driver_data = &quirk_asus_wapf4,
|
||||||
},
|
},
|
||||||
|
{
|
||||||
|
.callback = dmi_matched,
|
||||||
|
.ident = "ASUSTeK COMPUTER INC. X45U",
|
||||||
|
.matches = {
|
||||||
|
DMI_MATCH(DMI_SYS_VENDOR, "ASUSTeK COMPUTER INC."),
|
||||||
|
DMI_MATCH(DMI_PRODUCT_NAME, "X45U"),
|
||||||
|
},
|
||||||
|
.driver_data = &quirk_asus_wapf4,
|
||||||
|
},
|
||||||
{
|
{
|
||||||
.callback = dmi_matched,
|
.callback = dmi_matched,
|
||||||
.ident = "ASUSTeK COMPUTER INC. X456UA",
|
.ident = "ASUSTeK COMPUTER INC. X456UA",
|
||||||
@ -398,6 +412,15 @@ static const struct dmi_system_id asus_quirks[] = {
|
|||||||
},
|
},
|
||||||
.driver_data = &quirk_asus_ux303ub,
|
.driver_data = &quirk_asus_ux303ub,
|
||||||
},
|
},
|
||||||
|
{
|
||||||
|
.callback = dmi_matched,
|
||||||
|
.ident = "ASUSTeK COMPUTER INC. X550LB",
|
||||||
|
.matches = {
|
||||||
|
DMI_MATCH(DMI_SYS_VENDOR, "ASUSTeK COMPUTER INC."),
|
||||||
|
DMI_MATCH(DMI_PRODUCT_NAME, "X550LB"),
|
||||||
|
},
|
||||||
|
.driver_data = &quirk_asus_x550lb,
|
||||||
|
},
|
||||||
{},
|
{},
|
||||||
};
|
};
|
||||||
|
|
||||||
|
@ -156,6 +156,9 @@ MODULE_LICENSE("GPL");
|
|||||||
#define ASUS_FAN_CTRL_MANUAL 1
|
#define ASUS_FAN_CTRL_MANUAL 1
|
||||||
#define ASUS_FAN_CTRL_AUTO 2
|
#define ASUS_FAN_CTRL_AUTO 2
|
||||||
|
|
||||||
|
#define USB_INTEL_XUSB2PR 0xD0
|
||||||
|
#define PCI_DEVICE_ID_INTEL_LYNXPOINT_LP_XHCI 0x9c31
|
||||||
|
|
||||||
struct bios_args {
|
struct bios_args {
|
||||||
u32 arg0;
|
u32 arg0;
|
||||||
u32 arg1;
|
u32 arg1;
|
||||||
@ -1080,6 +1083,29 @@ static int asus_wmi_rfkill_init(struct asus_wmi *asus)
|
|||||||
return result;
|
return result;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static void asus_wmi_set_xusb2pr(struct asus_wmi *asus)
|
||||||
|
{
|
||||||
|
struct pci_dev *xhci_pdev;
|
||||||
|
u32 orig_ports_available;
|
||||||
|
u32 ports_available = asus->driver->quirks->xusb2pr;
|
||||||
|
|
||||||
|
xhci_pdev = pci_get_device(PCI_VENDOR_ID_INTEL,
|
||||||
|
PCI_DEVICE_ID_INTEL_LYNXPOINT_LP_XHCI,
|
||||||
|
NULL);
|
||||||
|
|
||||||
|
if (!xhci_pdev)
|
||||||
|
return;
|
||||||
|
|
||||||
|
pci_read_config_dword(xhci_pdev, USB_INTEL_XUSB2PR,
|
||||||
|
&orig_ports_available);
|
||||||
|
|
||||||
|
pci_write_config_dword(xhci_pdev, USB_INTEL_XUSB2PR,
|
||||||
|
cpu_to_le32(ports_available));
|
||||||
|
|
||||||
|
pr_info("set USB_INTEL_XUSB2PR old: 0x%04x, new: 0x%04x\n",
|
||||||
|
orig_ports_available, ports_available);
|
||||||
|
}
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Hwmon device
|
* Hwmon device
|
||||||
*/
|
*/
|
||||||
@ -2087,6 +2113,9 @@ static int asus_wmi_add(struct platform_device *pdev)
|
|||||||
if (asus->driver->quirks->wmi_backlight_native)
|
if (asus->driver->quirks->wmi_backlight_native)
|
||||||
acpi_video_set_dmi_backlight_type(acpi_backlight_native);
|
acpi_video_set_dmi_backlight_type(acpi_backlight_native);
|
||||||
|
|
||||||
|
if (asus->driver->quirks->xusb2pr)
|
||||||
|
asus_wmi_set_xusb2pr(asus);
|
||||||
|
|
||||||
if (acpi_video_get_backlight_type() == acpi_backlight_vendor) {
|
if (acpi_video_get_backlight_type() == acpi_backlight_vendor) {
|
||||||
err = asus_wmi_backlight_init(asus);
|
err = asus_wmi_backlight_init(asus);
|
||||||
if (err && err != -ENODEV)
|
if (err && err != -ENODEV)
|
||||||
|
@ -53,6 +53,7 @@ struct quirk_entry {
|
|||||||
* and let the ACPI interrupt to send out the key event.
|
* and let the ACPI interrupt to send out the key event.
|
||||||
*/
|
*/
|
||||||
int no_display_toggle;
|
int no_display_toggle;
|
||||||
|
u32 xusb2pr;
|
||||||
|
|
||||||
bool (*i8042_filter)(unsigned char data, unsigned char str,
|
bool (*i8042_filter)(unsigned char data, unsigned char str,
|
||||||
struct serio *serio);
|
struct serio *serio);
|
||||||
|
@ -1904,38 +1904,40 @@ static enum led_brightness kbd_led_level_get(struct led_classdev *led_cdev)
|
|||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
static void kbd_led_level_set(struct led_classdev *led_cdev,
|
static int kbd_led_level_set(struct led_classdev *led_cdev,
|
||||||
enum led_brightness value)
|
enum led_brightness value)
|
||||||
{
|
{
|
||||||
struct kbd_state state;
|
struct kbd_state state;
|
||||||
struct kbd_state new_state;
|
struct kbd_state new_state;
|
||||||
u16 num;
|
u16 num;
|
||||||
|
int ret;
|
||||||
|
|
||||||
if (kbd_get_max_level()) {
|
if (kbd_get_max_level()) {
|
||||||
if (kbd_get_state(&state))
|
ret = kbd_get_state(&state);
|
||||||
return;
|
if (ret)
|
||||||
|
return ret;
|
||||||
new_state = state;
|
new_state = state;
|
||||||
if (kbd_set_level(&new_state, value))
|
ret = kbd_set_level(&new_state, value);
|
||||||
return;
|
if (ret)
|
||||||
kbd_set_state_safe(&new_state, &state);
|
return ret;
|
||||||
return;
|
return kbd_set_state_safe(&new_state, &state);
|
||||||
}
|
}
|
||||||
|
|
||||||
if (kbd_get_valid_token_counts()) {
|
if (kbd_get_valid_token_counts()) {
|
||||||
for (num = kbd_token_bits; num != 0 && value > 0; --value)
|
for (num = kbd_token_bits; num != 0 && value > 0; --value)
|
||||||
num &= num - 1; /* clear the first bit set */
|
num &= num - 1; /* clear the first bit set */
|
||||||
if (num == 0)
|
if (num == 0)
|
||||||
return;
|
return 0;
|
||||||
kbd_set_token_bit(ffs(num) - 1);
|
return kbd_set_token_bit(ffs(num) - 1);
|
||||||
return;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
pr_warn("Keyboard brightness level control not supported\n");
|
pr_warn("Keyboard brightness level control not supported\n");
|
||||||
|
return -ENXIO;
|
||||||
}
|
}
|
||||||
|
|
||||||
static struct led_classdev kbd_led = {
|
static struct led_classdev kbd_led = {
|
||||||
.name = "dell::kbd_backlight",
|
.name = "dell::kbd_backlight",
|
||||||
.brightness_set = kbd_led_level_set,
|
.brightness_set_blocking = kbd_led_level_set,
|
||||||
.brightness_get = kbd_led_level_get,
|
.brightness_get = kbd_led_level_get,
|
||||||
.groups = kbd_led_groups,
|
.groups = kbd_led_groups,
|
||||||
};
|
};
|
||||||
|
@ -114,7 +114,7 @@ static const struct key_entry dell_wmi_keymap_type_0000[] __initconst = {
|
|||||||
{ KE_IGNORE, 0xe00e, { KEY_RESERVED } },
|
{ KE_IGNORE, 0xe00e, { KEY_RESERVED } },
|
||||||
|
|
||||||
/* Wifi Catcher */
|
/* Wifi Catcher */
|
||||||
{ KE_KEY, 0xe011, { KEY_PROG2 } },
|
{ KE_KEY, 0xe011, { KEY_WLAN } },
|
||||||
|
|
||||||
/* Ambient light sensor toggle */
|
/* Ambient light sensor toggle */
|
||||||
{ KE_IGNORE, 0xe013, { KEY_RESERVED } },
|
{ KE_IGNORE, 0xe013, { KEY_RESERVED } },
|
||||||
@ -274,6 +274,16 @@ static const struct key_entry dell_wmi_keymap_type_0010[] __initconst = {
|
|||||||
|
|
||||||
/* Stealth mode toggle */
|
/* Stealth mode toggle */
|
||||||
{ KE_IGNORE, 0x155, { KEY_RESERVED } },
|
{ KE_IGNORE, 0x155, { KEY_RESERVED } },
|
||||||
|
|
||||||
|
/* Rugged magnetic dock attach/detach events */
|
||||||
|
{ KE_IGNORE, 0x156, { KEY_RESERVED } },
|
||||||
|
{ KE_IGNORE, 0x157, { KEY_RESERVED } },
|
||||||
|
|
||||||
|
/* Rugged programmable (P1/P2/P3 keys) */
|
||||||
|
{ KE_KEY, 0x850, { KEY_PROG1 } },
|
||||||
|
{ KE_KEY, 0x851, { KEY_PROG2 } },
|
||||||
|
{ KE_KEY, 0x852, { KEY_PROG3 } },
|
||||||
|
|
||||||
};
|
};
|
||||||
|
|
||||||
/*
|
/*
|
||||||
|
@ -69,7 +69,7 @@ static int intel_hid_set_enable(struct device *device, int enable)
|
|||||||
|
|
||||||
arg0.integer.value = enable;
|
arg0.integer.value = enable;
|
||||||
status = acpi_evaluate_object(ACPI_HANDLE(device), "HDSM", &args, NULL);
|
status = acpi_evaluate_object(ACPI_HANDLE(device), "HDSM", &args, NULL);
|
||||||
if (!ACPI_SUCCESS(status)) {
|
if (ACPI_FAILURE(status)) {
|
||||||
dev_warn(device, "failed to %sable hotkeys\n",
|
dev_warn(device, "failed to %sable hotkeys\n",
|
||||||
enable ? "en" : "dis");
|
enable ? "en" : "dis");
|
||||||
return -EIO;
|
return -EIO;
|
||||||
@ -148,7 +148,7 @@ static void notify_handler(acpi_handle handle, u32 event, void *context)
|
|||||||
}
|
}
|
||||||
|
|
||||||
status = acpi_evaluate_integer(handle, "HDEM", NULL, &ev_index);
|
status = acpi_evaluate_integer(handle, "HDEM", NULL, &ev_index);
|
||||||
if (!ACPI_SUCCESS(status)) {
|
if (ACPI_FAILURE(status)) {
|
||||||
dev_warn(&device->dev, "failed to get event index\n");
|
dev_warn(&device->dev, "failed to get event index\n");
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
@ -167,7 +167,7 @@ static int intel_hid_probe(struct platform_device *device)
|
|||||||
int err;
|
int err;
|
||||||
|
|
||||||
status = acpi_evaluate_integer(handle, "HDMM", NULL, &mode);
|
status = acpi_evaluate_integer(handle, "HDMM", NULL, &mode);
|
||||||
if (!ACPI_SUCCESS(status)) {
|
if (ACPI_FAILURE(status)) {
|
||||||
dev_warn(&device->dev, "failed to read mode\n");
|
dev_warn(&device->dev, "failed to read mode\n");
|
||||||
return -ENODEV;
|
return -ENODEV;
|
||||||
}
|
}
|
||||||
|
@ -29,7 +29,7 @@ static int smartconnect_acpi_init(struct acpi_device *acpi)
|
|||||||
acpi_status status;
|
acpi_status status;
|
||||||
|
|
||||||
status = acpi_evaluate_integer(acpi->handle, "GAOS", NULL, &value);
|
status = acpi_evaluate_integer(acpi->handle, "GAOS", NULL, &value);
|
||||||
if (!ACPI_SUCCESS(status))
|
if (ACPI_FAILURE(status))
|
||||||
return -EINVAL;
|
return -EINVAL;
|
||||||
|
|
||||||
if (value & 0x1) {
|
if (value & 0x1) {
|
||||||
|
@ -49,34 +49,19 @@ static int intel_vbtn_input_setup(struct platform_device *device)
|
|||||||
struct intel_vbtn_priv *priv = dev_get_drvdata(&device->dev);
|
struct intel_vbtn_priv *priv = dev_get_drvdata(&device->dev);
|
||||||
int ret;
|
int ret;
|
||||||
|
|
||||||
priv->input_dev = input_allocate_device();
|
priv->input_dev = devm_input_allocate_device(&device->dev);
|
||||||
if (!priv->input_dev)
|
if (!priv->input_dev)
|
||||||
return -ENOMEM;
|
return -ENOMEM;
|
||||||
|
|
||||||
ret = sparse_keymap_setup(priv->input_dev, intel_vbtn_keymap, NULL);
|
ret = sparse_keymap_setup(priv->input_dev, intel_vbtn_keymap, NULL);
|
||||||
if (ret)
|
if (ret)
|
||||||
goto err_free_device;
|
return ret;
|
||||||
|
|
||||||
priv->input_dev->dev.parent = &device->dev;
|
priv->input_dev->dev.parent = &device->dev;
|
||||||
priv->input_dev->name = "Intel Virtual Button driver";
|
priv->input_dev->name = "Intel Virtual Button driver";
|
||||||
priv->input_dev->id.bustype = BUS_HOST;
|
priv->input_dev->id.bustype = BUS_HOST;
|
||||||
|
|
||||||
ret = input_register_device(priv->input_dev);
|
return input_register_device(priv->input_dev);
|
||||||
if (ret)
|
|
||||||
goto err_free_device;
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
|
|
||||||
err_free_device:
|
|
||||||
input_free_device(priv->input_dev);
|
|
||||||
return ret;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void intel_vbtn_input_destroy(struct platform_device *device)
|
|
||||||
{
|
|
||||||
struct intel_vbtn_priv *priv = dev_get_drvdata(&device->dev);
|
|
||||||
|
|
||||||
input_unregister_device(priv->input_dev);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static void notify_handler(acpi_handle handle, u32 event, void *context)
|
static void notify_handler(acpi_handle handle, u32 event, void *context)
|
||||||
@ -97,7 +82,7 @@ static int intel_vbtn_probe(struct platform_device *device)
|
|||||||
int err;
|
int err;
|
||||||
|
|
||||||
status = acpi_evaluate_object(handle, "VBDL", NULL, NULL);
|
status = acpi_evaluate_object(handle, "VBDL", NULL, NULL);
|
||||||
if (!ACPI_SUCCESS(status)) {
|
if (ACPI_FAILURE(status)) {
|
||||||
dev_warn(&device->dev, "failed to read Intel Virtual Button driver\n");
|
dev_warn(&device->dev, "failed to read Intel Virtual Button driver\n");
|
||||||
return -ENODEV;
|
return -ENODEV;
|
||||||
}
|
}
|
||||||
@ -117,24 +102,16 @@ static int intel_vbtn_probe(struct platform_device *device)
|
|||||||
ACPI_DEVICE_NOTIFY,
|
ACPI_DEVICE_NOTIFY,
|
||||||
notify_handler,
|
notify_handler,
|
||||||
device);
|
device);
|
||||||
if (ACPI_FAILURE(status)) {
|
if (ACPI_FAILURE(status))
|
||||||
err = -EBUSY;
|
return -EBUSY;
|
||||||
goto err_remove_input;
|
|
||||||
}
|
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
err_remove_input:
|
|
||||||
intel_vbtn_input_destroy(device);
|
|
||||||
|
|
||||||
return err;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static int intel_vbtn_remove(struct platform_device *device)
|
static int intel_vbtn_remove(struct platform_device *device)
|
||||||
{
|
{
|
||||||
acpi_handle handle = ACPI_HANDLE(&device->dev);
|
acpi_handle handle = ACPI_HANDLE(&device->dev);
|
||||||
|
|
||||||
intel_vbtn_input_destroy(device);
|
|
||||||
acpi_remove_notify_handler(handle, ACPI_DEVICE_NOTIFY, notify_handler);
|
acpi_remove_notify_handler(handle, ACPI_DEVICE_NOTIFY, notify_handler);
|
||||||
|
|
||||||
/*
|
/*
|
||||||
|
@ -415,6 +415,7 @@ static struct thermal_device_info *initialize_sensor(int index)
|
|||||||
return td_info;
|
return td_info;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#ifdef CONFIG_PM_SLEEP
|
||||||
/**
|
/**
|
||||||
* mid_thermal_resume - resume routine
|
* mid_thermal_resume - resume routine
|
||||||
* @dev: device structure
|
* @dev: device structure
|
||||||
@ -442,6 +443,7 @@ static int mid_thermal_suspend(struct device *dev)
|
|||||||
*/
|
*/
|
||||||
return configure_adc(0);
|
return configure_adc(0);
|
||||||
}
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
static SIMPLE_DEV_PM_OPS(mid_thermal_pm,
|
static SIMPLE_DEV_PM_OPS(mid_thermal_pm,
|
||||||
mid_thermal_suspend, mid_thermal_resume);
|
mid_thermal_suspend, mid_thermal_resume);
|
||||||
|
@ -19,10 +19,12 @@
|
|||||||
*/
|
*/
|
||||||
|
|
||||||
#include <linux/debugfs.h>
|
#include <linux/debugfs.h>
|
||||||
|
#include <linux/delay.h>
|
||||||
#include <linux/device.h>
|
#include <linux/device.h>
|
||||||
#include <linux/init.h>
|
#include <linux/init.h>
|
||||||
#include <linux/io.h>
|
#include <linux/io.h>
|
||||||
#include <linux/pci.h>
|
#include <linux/pci.h>
|
||||||
|
#include <linux/uaccess.h>
|
||||||
|
|
||||||
#include <asm/cpu_device_id.h>
|
#include <asm/cpu_device_id.h>
|
||||||
#include <asm/intel-family.h>
|
#include <asm/intel-family.h>
|
||||||
@ -32,16 +34,106 @@
|
|||||||
|
|
||||||
static struct pmc_dev pmc;
|
static struct pmc_dev pmc;
|
||||||
|
|
||||||
|
static const struct pmc_bit_map spt_pll_map[] = {
|
||||||
|
{"MIPI PLL", SPT_PMC_BIT_MPHY_CMN_LANE0},
|
||||||
|
{"GEN2 USB2PCIE2 PLL", SPT_PMC_BIT_MPHY_CMN_LANE1},
|
||||||
|
{"DMIPCIE3 PLL", SPT_PMC_BIT_MPHY_CMN_LANE2},
|
||||||
|
{"SATA PLL", SPT_PMC_BIT_MPHY_CMN_LANE3},
|
||||||
|
{},
|
||||||
|
};
|
||||||
|
|
||||||
|
static const struct pmc_bit_map spt_mphy_map[] = {
|
||||||
|
{"MPHY CORE LANE 0", SPT_PMC_BIT_MPHY_LANE0},
|
||||||
|
{"MPHY CORE LANE 1", SPT_PMC_BIT_MPHY_LANE1},
|
||||||
|
{"MPHY CORE LANE 2", SPT_PMC_BIT_MPHY_LANE2},
|
||||||
|
{"MPHY CORE LANE 3", SPT_PMC_BIT_MPHY_LANE3},
|
||||||
|
{"MPHY CORE LANE 4", SPT_PMC_BIT_MPHY_LANE4},
|
||||||
|
{"MPHY CORE LANE 5", SPT_PMC_BIT_MPHY_LANE5},
|
||||||
|
{"MPHY CORE LANE 6", SPT_PMC_BIT_MPHY_LANE6},
|
||||||
|
{"MPHY CORE LANE 7", SPT_PMC_BIT_MPHY_LANE7},
|
||||||
|
{"MPHY CORE LANE 8", SPT_PMC_BIT_MPHY_LANE8},
|
||||||
|
{"MPHY CORE LANE 9", SPT_PMC_BIT_MPHY_LANE9},
|
||||||
|
{"MPHY CORE LANE 10", SPT_PMC_BIT_MPHY_LANE10},
|
||||||
|
{"MPHY CORE LANE 11", SPT_PMC_BIT_MPHY_LANE11},
|
||||||
|
{"MPHY CORE LANE 12", SPT_PMC_BIT_MPHY_LANE12},
|
||||||
|
{"MPHY CORE LANE 13", SPT_PMC_BIT_MPHY_LANE13},
|
||||||
|
{"MPHY CORE LANE 14", SPT_PMC_BIT_MPHY_LANE14},
|
||||||
|
{"MPHY CORE LANE 15", SPT_PMC_BIT_MPHY_LANE15},
|
||||||
|
{},
|
||||||
|
};
|
||||||
|
|
||||||
|
static const struct pmc_bit_map spt_pfear_map[] = {
|
||||||
|
{"PMC", SPT_PMC_BIT_PMC},
|
||||||
|
{"OPI-DMI", SPT_PMC_BIT_OPI},
|
||||||
|
{"SPI / eSPI", SPT_PMC_BIT_SPI},
|
||||||
|
{"XHCI", SPT_PMC_BIT_XHCI},
|
||||||
|
{"SPA", SPT_PMC_BIT_SPA},
|
||||||
|
{"SPB", SPT_PMC_BIT_SPB},
|
||||||
|
{"SPC", SPT_PMC_BIT_SPC},
|
||||||
|
{"GBE", SPT_PMC_BIT_GBE},
|
||||||
|
{"SATA", SPT_PMC_BIT_SATA},
|
||||||
|
{"HDA-PGD0", SPT_PMC_BIT_HDA_PGD0},
|
||||||
|
{"HDA-PGD1", SPT_PMC_BIT_HDA_PGD1},
|
||||||
|
{"HDA-PGD2", SPT_PMC_BIT_HDA_PGD2},
|
||||||
|
{"HDA-PGD3", SPT_PMC_BIT_HDA_PGD3},
|
||||||
|
{"RSVD", SPT_PMC_BIT_RSVD_0B},
|
||||||
|
{"LPSS", SPT_PMC_BIT_LPSS},
|
||||||
|
{"LPC", SPT_PMC_BIT_LPC},
|
||||||
|
{"SMB", SPT_PMC_BIT_SMB},
|
||||||
|
{"ISH", SPT_PMC_BIT_ISH},
|
||||||
|
{"P2SB", SPT_PMC_BIT_P2SB},
|
||||||
|
{"DFX", SPT_PMC_BIT_DFX},
|
||||||
|
{"SCC", SPT_PMC_BIT_SCC},
|
||||||
|
{"RSVD", SPT_PMC_BIT_RSVD_0C},
|
||||||
|
{"FUSE", SPT_PMC_BIT_FUSE},
|
||||||
|
{"CAMERA", SPT_PMC_BIT_CAMREA},
|
||||||
|
{"RSVD", SPT_PMC_BIT_RSVD_0D},
|
||||||
|
{"USB3-OTG", SPT_PMC_BIT_USB3_OTG},
|
||||||
|
{"EXI", SPT_PMC_BIT_EXI},
|
||||||
|
{"CSE", SPT_PMC_BIT_CSE},
|
||||||
|
{"CSME_KVM", SPT_PMC_BIT_CSME_KVM},
|
||||||
|
{"CSME_PMT", SPT_PMC_BIT_CSME_PMT},
|
||||||
|
{"CSME_CLINK", SPT_PMC_BIT_CSME_CLINK},
|
||||||
|
{"CSME_PTIO", SPT_PMC_BIT_CSME_PTIO},
|
||||||
|
{"CSME_USBR", SPT_PMC_BIT_CSME_USBR},
|
||||||
|
{"CSME_SUSRAM", SPT_PMC_BIT_CSME_SUSRAM},
|
||||||
|
{"CSME_SMT", SPT_PMC_BIT_CSME_SMT},
|
||||||
|
{"RSVD", SPT_PMC_BIT_RSVD_1A},
|
||||||
|
{"CSME_SMS2", SPT_PMC_BIT_CSME_SMS2},
|
||||||
|
{"CSME_SMS1", SPT_PMC_BIT_CSME_SMS1},
|
||||||
|
{"CSME_RTC", SPT_PMC_BIT_CSME_RTC},
|
||||||
|
{"CSME_PSF", SPT_PMC_BIT_CSME_PSF},
|
||||||
|
{},
|
||||||
|
};
|
||||||
|
|
||||||
|
static const struct pmc_reg_map spt_reg_map = {
|
||||||
|
.pfear_sts = spt_pfear_map,
|
||||||
|
.mphy_sts = spt_mphy_map,
|
||||||
|
.pll_sts = spt_pll_map,
|
||||||
|
};
|
||||||
|
|
||||||
static const struct pci_device_id pmc_pci_ids[] = {
|
static const struct pci_device_id pmc_pci_ids[] = {
|
||||||
{ PCI_VDEVICE(INTEL, SPT_PMC_PCI_DEVICE_ID), (kernel_ulong_t)NULL },
|
{ PCI_VDEVICE(INTEL, SPT_PMC_PCI_DEVICE_ID),
|
||||||
|
(kernel_ulong_t)&spt_reg_map },
|
||||||
{ 0, },
|
{ 0, },
|
||||||
};
|
};
|
||||||
|
|
||||||
|
static inline u8 pmc_core_reg_read_byte(struct pmc_dev *pmcdev, int offset)
|
||||||
|
{
|
||||||
|
return readb(pmcdev->regbase + offset);
|
||||||
|
}
|
||||||
|
|
||||||
static inline u32 pmc_core_reg_read(struct pmc_dev *pmcdev, int reg_offset)
|
static inline u32 pmc_core_reg_read(struct pmc_dev *pmcdev, int reg_offset)
|
||||||
{
|
{
|
||||||
return readl(pmcdev->regbase + reg_offset);
|
return readl(pmcdev->regbase + reg_offset);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static inline void pmc_core_reg_write(struct pmc_dev *pmcdev, int
|
||||||
|
reg_offset, u32 val)
|
||||||
|
{
|
||||||
|
writel(val, pmcdev->regbase + reg_offset);
|
||||||
|
}
|
||||||
|
|
||||||
static inline u32 pmc_core_adjust_slp_s0_step(u32 value)
|
static inline u32 pmc_core_adjust_slp_s0_step(u32 value)
|
||||||
{
|
{
|
||||||
return value * SPT_PMC_SLP_S0_RES_COUNTER_STEP;
|
return value * SPT_PMC_SLP_S0_RES_COUNTER_STEP;
|
||||||
@ -90,6 +182,245 @@ static int pmc_core_dev_state_get(void *data, u64 *val)
|
|||||||
|
|
||||||
DEFINE_DEBUGFS_ATTRIBUTE(pmc_core_dev_state, pmc_core_dev_state_get, NULL, "%llu\n");
|
DEFINE_DEBUGFS_ATTRIBUTE(pmc_core_dev_state, pmc_core_dev_state_get, NULL, "%llu\n");
|
||||||
|
|
||||||
|
static int pmc_core_check_read_lock_bit(void)
|
||||||
|
{
|
||||||
|
struct pmc_dev *pmcdev = &pmc;
|
||||||
|
u32 value;
|
||||||
|
|
||||||
|
value = pmc_core_reg_read(pmcdev, SPT_PMC_PM_CFG_OFFSET);
|
||||||
|
return test_bit(SPT_PMC_READ_DISABLE_BIT,
|
||||||
|
(unsigned long *)&value);
|
||||||
|
}
|
||||||
|
|
||||||
|
#if IS_ENABLED(CONFIG_DEBUG_FS)
|
||||||
|
static void pmc_core_display_map(struct seq_file *s, int index,
|
||||||
|
u8 pf_reg, const struct pmc_bit_map *pf_map)
|
||||||
|
{
|
||||||
|
seq_printf(s, "PCH IP: %-2d - %-32s\tState: %s\n",
|
||||||
|
index, pf_map[index].name,
|
||||||
|
pf_map[index].bit_mask & pf_reg ? "Off" : "On");
|
||||||
|
}
|
||||||
|
|
||||||
|
static int pmc_core_ppfear_sts_show(struct seq_file *s, void *unused)
|
||||||
|
{
|
||||||
|
struct pmc_dev *pmcdev = s->private;
|
||||||
|
const struct pmc_bit_map *map = pmcdev->map->pfear_sts;
|
||||||
|
u8 pf_regs[NUM_ENTRIES];
|
||||||
|
int index, iter;
|
||||||
|
|
||||||
|
iter = SPT_PMC_XRAM_PPFEAR0A;
|
||||||
|
|
||||||
|
for (index = 0; index < NUM_ENTRIES; index++, iter++)
|
||||||
|
pf_regs[index] = pmc_core_reg_read_byte(pmcdev, iter);
|
||||||
|
|
||||||
|
for (index = 0; map[index].name; index++)
|
||||||
|
pmc_core_display_map(s, index, pf_regs[index / 8], map);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int pmc_core_ppfear_sts_open(struct inode *inode, struct file *file)
|
||||||
|
{
|
||||||
|
return single_open(file, pmc_core_ppfear_sts_show, inode->i_private);
|
||||||
|
}
|
||||||
|
|
||||||
|
static const struct file_operations pmc_core_ppfear_ops = {
|
||||||
|
.open = pmc_core_ppfear_sts_open,
|
||||||
|
.read = seq_read,
|
||||||
|
.llseek = seq_lseek,
|
||||||
|
.release = single_release,
|
||||||
|
};
|
||||||
|
|
||||||
|
/* This function should return link status, 0 means ready */
|
||||||
|
static int pmc_core_mtpmc_link_status(void)
|
||||||
|
{
|
||||||
|
struct pmc_dev *pmcdev = &pmc;
|
||||||
|
u32 value;
|
||||||
|
|
||||||
|
value = pmc_core_reg_read(pmcdev, SPT_PMC_PM_STS_OFFSET);
|
||||||
|
return test_bit(SPT_PMC_MSG_FULL_STS_BIT,
|
||||||
|
(unsigned long *)&value);
|
||||||
|
}
|
||||||
|
|
||||||
|
static int pmc_core_send_msg(u32 *addr_xram)
|
||||||
|
{
|
||||||
|
struct pmc_dev *pmcdev = &pmc;
|
||||||
|
u32 dest;
|
||||||
|
int timeout;
|
||||||
|
|
||||||
|
for (timeout = NUM_RETRIES; timeout > 0; timeout--) {
|
||||||
|
if (pmc_core_mtpmc_link_status() == 0)
|
||||||
|
break;
|
||||||
|
msleep(5);
|
||||||
|
}
|
||||||
|
|
||||||
|
if (timeout <= 0 && pmc_core_mtpmc_link_status())
|
||||||
|
return -EBUSY;
|
||||||
|
|
||||||
|
dest = (*addr_xram & MTPMC_MASK) | (1U << 1);
|
||||||
|
pmc_core_reg_write(pmcdev, SPT_PMC_MTPMC_OFFSET, dest);
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int pmc_core_mphy_pg_sts_show(struct seq_file *s, void *unused)
|
||||||
|
{
|
||||||
|
struct pmc_dev *pmcdev = s->private;
|
||||||
|
const struct pmc_bit_map *map = pmcdev->map->mphy_sts;
|
||||||
|
u32 mphy_core_reg_low, mphy_core_reg_high;
|
||||||
|
u32 val_low, val_high;
|
||||||
|
int index, err = 0;
|
||||||
|
|
||||||
|
if (pmcdev->pmc_xram_read_bit) {
|
||||||
|
seq_puts(s, "Access denied: please disable PMC_READ_DISABLE setting in BIOS.");
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
mphy_core_reg_low = (SPT_PMC_MPHY_CORE_STS_0 << 16);
|
||||||
|
mphy_core_reg_high = (SPT_PMC_MPHY_CORE_STS_1 << 16);
|
||||||
|
|
||||||
|
mutex_lock(&pmcdev->lock);
|
||||||
|
|
||||||
|
if (pmc_core_send_msg(&mphy_core_reg_low) != 0) {
|
||||||
|
err = -EBUSY;
|
||||||
|
goto out_unlock;
|
||||||
|
}
|
||||||
|
|
||||||
|
msleep(10);
|
||||||
|
val_low = pmc_core_reg_read(pmcdev, SPT_PMC_MFPMC_OFFSET);
|
||||||
|
|
||||||
|
if (pmc_core_send_msg(&mphy_core_reg_high) != 0) {
|
||||||
|
err = -EBUSY;
|
||||||
|
goto out_unlock;
|
||||||
|
}
|
||||||
|
|
||||||
|
msleep(10);
|
||||||
|
val_high = pmc_core_reg_read(pmcdev, SPT_PMC_MFPMC_OFFSET);
|
||||||
|
|
||||||
|
for (index = 0; map[index].name && index < 8; index++) {
|
||||||
|
seq_printf(s, "%-32s\tState: %s\n",
|
||||||
|
map[index].name,
|
||||||
|
map[index].bit_mask & val_low ? "Not power gated" :
|
||||||
|
"Power gated");
|
||||||
|
}
|
||||||
|
|
||||||
|
for (index = 8; map[index].name; index++) {
|
||||||
|
seq_printf(s, "%-32s\tState: %s\n",
|
||||||
|
map[index].name,
|
||||||
|
map[index].bit_mask & val_high ? "Not power gated" :
|
||||||
|
"Power gated");
|
||||||
|
}
|
||||||
|
|
||||||
|
out_unlock:
|
||||||
|
mutex_unlock(&pmcdev->lock);
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int pmc_core_mphy_pg_sts_open(struct inode *inode, struct file *file)
|
||||||
|
{
|
||||||
|
return single_open(file, pmc_core_mphy_pg_sts_show, inode->i_private);
|
||||||
|
}
|
||||||
|
|
||||||
|
static const struct file_operations pmc_core_mphy_pg_ops = {
|
||||||
|
.open = pmc_core_mphy_pg_sts_open,
|
||||||
|
.read = seq_read,
|
||||||
|
.llseek = seq_lseek,
|
||||||
|
.release = single_release,
|
||||||
|
};
|
||||||
|
|
||||||
|
static int pmc_core_pll_show(struct seq_file *s, void *unused)
|
||||||
|
{
|
||||||
|
struct pmc_dev *pmcdev = s->private;
|
||||||
|
const struct pmc_bit_map *map = pmcdev->map->pll_sts;
|
||||||
|
u32 mphy_common_reg, val;
|
||||||
|
int index, err = 0;
|
||||||
|
|
||||||
|
if (pmcdev->pmc_xram_read_bit) {
|
||||||
|
seq_puts(s, "Access denied: please disable PMC_READ_DISABLE setting in BIOS.");
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
mphy_common_reg = (SPT_PMC_MPHY_COM_STS_0 << 16);
|
||||||
|
mutex_lock(&pmcdev->lock);
|
||||||
|
|
||||||
|
if (pmc_core_send_msg(&mphy_common_reg) != 0) {
|
||||||
|
err = -EBUSY;
|
||||||
|
goto out_unlock;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Observed PMC HW response latency for MTPMC-MFPMC is ~10 ms */
|
||||||
|
msleep(10);
|
||||||
|
val = pmc_core_reg_read(pmcdev, SPT_PMC_MFPMC_OFFSET);
|
||||||
|
|
||||||
|
for (index = 0; map[index].name ; index++) {
|
||||||
|
seq_printf(s, "%-32s\tState: %s\n",
|
||||||
|
map[index].name,
|
||||||
|
map[index].bit_mask & val ? "Active" : "Idle");
|
||||||
|
}
|
||||||
|
|
||||||
|
out_unlock:
|
||||||
|
mutex_unlock(&pmcdev->lock);
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int pmc_core_pll_open(struct inode *inode, struct file *file)
|
||||||
|
{
|
||||||
|
return single_open(file, pmc_core_pll_show, inode->i_private);
|
||||||
|
}
|
||||||
|
|
||||||
|
static const struct file_operations pmc_core_pll_ops = {
|
||||||
|
.open = pmc_core_pll_open,
|
||||||
|
.read = seq_read,
|
||||||
|
.llseek = seq_lseek,
|
||||||
|
.release = single_release,
|
||||||
|
};
|
||||||
|
|
||||||
|
static ssize_t pmc_core_ltr_ignore_write(struct file *file, const char __user
|
||||||
|
*userbuf, size_t count, loff_t *ppos)
|
||||||
|
{
|
||||||
|
struct pmc_dev *pmcdev = &pmc;
|
||||||
|
u32 val, buf_size, fd;
|
||||||
|
int err = 0;
|
||||||
|
|
||||||
|
buf_size = count < 64 ? count : 64;
|
||||||
|
mutex_lock(&pmcdev->lock);
|
||||||
|
|
||||||
|
if (kstrtou32_from_user(userbuf, buf_size, 10, &val)) {
|
||||||
|
err = -EFAULT;
|
||||||
|
goto out_unlock;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (val > NUM_IP_IGN_ALLOWED) {
|
||||||
|
err = -EINVAL;
|
||||||
|
goto out_unlock;
|
||||||
|
}
|
||||||
|
|
||||||
|
fd = pmc_core_reg_read(pmcdev, SPT_PMC_LTR_IGNORE_OFFSET);
|
||||||
|
fd |= (1U << val);
|
||||||
|
pmc_core_reg_write(pmcdev, SPT_PMC_LTR_IGNORE_OFFSET, fd);
|
||||||
|
|
||||||
|
out_unlock:
|
||||||
|
mutex_unlock(&pmcdev->lock);
|
||||||
|
return err == 0 ? count : err;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int pmc_core_ltr_ignore_show(struct seq_file *s, void *unused)
|
||||||
|
{
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int pmc_core_ltr_ignore_open(struct inode *inode, struct file *file)
|
||||||
|
{
|
||||||
|
return single_open(file, pmc_core_ltr_ignore_show, inode->i_private);
|
||||||
|
}
|
||||||
|
|
||||||
|
static const struct file_operations pmc_core_ltr_ignore_ops = {
|
||||||
|
.open = pmc_core_ltr_ignore_open,
|
||||||
|
.read = seq_read,
|
||||||
|
.write = pmc_core_ltr_ignore_write,
|
||||||
|
.llseek = seq_lseek,
|
||||||
|
.release = single_release,
|
||||||
|
};
|
||||||
|
|
||||||
static void pmc_core_dbgfs_unregister(struct pmc_dev *pmcdev)
|
static void pmc_core_dbgfs_unregister(struct pmc_dev *pmcdev)
|
||||||
{
|
{
|
||||||
debugfs_remove_recursive(pmcdev->dbgfs_dir);
|
debugfs_remove_recursive(pmcdev->dbgfs_dir);
|
||||||
@ -106,20 +437,59 @@ static int pmc_core_dbgfs_register(struct pmc_dev *pmcdev)
|
|||||||
pmcdev->dbgfs_dir = dir;
|
pmcdev->dbgfs_dir = dir;
|
||||||
file = debugfs_create_file("slp_s0_residency_usec", S_IFREG | S_IRUGO,
|
file = debugfs_create_file("slp_s0_residency_usec", S_IFREG | S_IRUGO,
|
||||||
dir, pmcdev, &pmc_core_dev_state);
|
dir, pmcdev, &pmc_core_dev_state);
|
||||||
|
if (!file)
|
||||||
|
goto err;
|
||||||
|
|
||||||
if (!file) {
|
file = debugfs_create_file("pch_ip_power_gating_status",
|
||||||
pmc_core_dbgfs_unregister(pmcdev);
|
S_IFREG | S_IRUGO, dir, pmcdev,
|
||||||
return -ENODEV;
|
&pmc_core_ppfear_ops);
|
||||||
}
|
if (!file)
|
||||||
|
goto err;
|
||||||
|
|
||||||
|
file = debugfs_create_file("mphy_core_lanes_power_gating_status",
|
||||||
|
S_IFREG | S_IRUGO, dir, pmcdev,
|
||||||
|
&pmc_core_mphy_pg_ops);
|
||||||
|
if (!file)
|
||||||
|
goto err;
|
||||||
|
|
||||||
|
file = debugfs_create_file("pll_status",
|
||||||
|
S_IFREG | S_IRUGO, dir, pmcdev,
|
||||||
|
&pmc_core_pll_ops);
|
||||||
|
if (!file)
|
||||||
|
goto err;
|
||||||
|
|
||||||
|
file = debugfs_create_file("ltr_ignore",
|
||||||
|
S_IFREG | S_IRUGO, dir, pmcdev,
|
||||||
|
&pmc_core_ltr_ignore_ops);
|
||||||
|
|
||||||
|
if (!file)
|
||||||
|
goto err;
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
|
err:
|
||||||
|
pmc_core_dbgfs_unregister(pmcdev);
|
||||||
|
return -ENODEV;
|
||||||
}
|
}
|
||||||
|
#else
|
||||||
|
static inline int pmc_core_dbgfs_register(struct pmc_dev *pmcdev)
|
||||||
|
{
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline void pmc_core_dbgfs_unregister(struct pmc_dev *pmcdev)
|
||||||
|
{
|
||||||
|
}
|
||||||
|
#endif /* CONFIG_DEBUG_FS */
|
||||||
|
|
||||||
static const struct x86_cpu_id intel_pmc_core_ids[] = {
|
static const struct x86_cpu_id intel_pmc_core_ids[] = {
|
||||||
{ X86_VENDOR_INTEL, 6, INTEL_FAM6_SKYLAKE_MOBILE, X86_FEATURE_MWAIT,
|
{ X86_VENDOR_INTEL, 6, INTEL_FAM6_SKYLAKE_MOBILE, X86_FEATURE_MWAIT,
|
||||||
(kernel_ulong_t)NULL},
|
(kernel_ulong_t)NULL},
|
||||||
{ X86_VENDOR_INTEL, 6, INTEL_FAM6_SKYLAKE_DESKTOP, X86_FEATURE_MWAIT,
|
{ X86_VENDOR_INTEL, 6, INTEL_FAM6_SKYLAKE_DESKTOP, X86_FEATURE_MWAIT,
|
||||||
(kernel_ulong_t)NULL},
|
(kernel_ulong_t)NULL},
|
||||||
|
{ X86_VENDOR_INTEL, 6, INTEL_FAM6_KABYLAKE_MOBILE, X86_FEATURE_MWAIT,
|
||||||
|
(kernel_ulong_t)NULL},
|
||||||
|
{ X86_VENDOR_INTEL, 6, INTEL_FAM6_KABYLAKE_DESKTOP, X86_FEATURE_MWAIT,
|
||||||
|
(kernel_ulong_t)NULL},
|
||||||
{}
|
{}
|
||||||
};
|
};
|
||||||
|
|
||||||
@ -128,6 +498,7 @@ static int pmc_core_probe(struct pci_dev *dev, const struct pci_device_id *id)
|
|||||||
struct device *ptr_dev = &dev->dev;
|
struct device *ptr_dev = &dev->dev;
|
||||||
struct pmc_dev *pmcdev = &pmc;
|
struct pmc_dev *pmcdev = &pmc;
|
||||||
const struct x86_cpu_id *cpu_id;
|
const struct x86_cpu_id *cpu_id;
|
||||||
|
const struct pmc_reg_map *map = (struct pmc_reg_map *)id->driver_data;
|
||||||
int err;
|
int err;
|
||||||
|
|
||||||
cpu_id = x86_match_cpu(intel_pmc_core_ids);
|
cpu_id = x86_match_cpu(intel_pmc_core_ids);
|
||||||
@ -149,6 +520,7 @@ static int pmc_core_probe(struct pci_dev *dev, const struct pci_device_id *id)
|
|||||||
dev_dbg(&dev->dev, "PMC Core: failed to read PCI config space.\n");
|
dev_dbg(&dev->dev, "PMC Core: failed to read PCI config space.\n");
|
||||||
return err;
|
return err;
|
||||||
}
|
}
|
||||||
|
pmcdev->base_addr &= PMC_BASE_ADDR_MASK;
|
||||||
dev_dbg(&dev->dev, "PMC Core: PWRMBASE is %#x\n", pmcdev->base_addr);
|
dev_dbg(&dev->dev, "PMC Core: PWRMBASE is %#x\n", pmcdev->base_addr);
|
||||||
|
|
||||||
pmcdev->regbase = devm_ioremap_nocache(ptr_dev,
|
pmcdev->regbase = devm_ioremap_nocache(ptr_dev,
|
||||||
@ -159,6 +531,10 @@ static int pmc_core_probe(struct pci_dev *dev, const struct pci_device_id *id)
|
|||||||
return -ENOMEM;
|
return -ENOMEM;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
mutex_init(&pmcdev->lock);
|
||||||
|
pmcdev->pmc_xram_read_bit = pmc_core_check_read_lock_bit();
|
||||||
|
pmcdev->map = map;
|
||||||
|
|
||||||
err = pmc_core_dbgfs_register(pmcdev);
|
err = pmc_core_dbgfs_register(pmcdev);
|
||||||
if (err < 0)
|
if (err < 0)
|
||||||
dev_warn(&dev->dev, "PMC Core: debugfs register failed.\n");
|
dev_warn(&dev->dev, "PMC Core: debugfs register failed.\n");
|
||||||
|
@ -26,8 +26,111 @@
|
|||||||
|
|
||||||
#define SPT_PMC_BASE_ADDR_OFFSET 0x48
|
#define SPT_PMC_BASE_ADDR_OFFSET 0x48
|
||||||
#define SPT_PMC_SLP_S0_RES_COUNTER_OFFSET 0x13c
|
#define SPT_PMC_SLP_S0_RES_COUNTER_OFFSET 0x13c
|
||||||
#define SPT_PMC_MMIO_REG_LEN 0x100
|
#define SPT_PMC_PM_CFG_OFFSET 0x18
|
||||||
|
#define SPT_PMC_PM_STS_OFFSET 0x1c
|
||||||
|
#define SPT_PMC_MTPMC_OFFSET 0x20
|
||||||
|
#define SPT_PMC_MFPMC_OFFSET 0x38
|
||||||
|
#define SPT_PMC_LTR_IGNORE_OFFSET 0x30C
|
||||||
|
#define SPT_PMC_MPHY_CORE_STS_0 0x1143
|
||||||
|
#define SPT_PMC_MPHY_CORE_STS_1 0x1142
|
||||||
|
#define SPT_PMC_MPHY_COM_STS_0 0x1155
|
||||||
|
#define SPT_PMC_MMIO_REG_LEN 0x1000
|
||||||
#define SPT_PMC_SLP_S0_RES_COUNTER_STEP 0x64
|
#define SPT_PMC_SLP_S0_RES_COUNTER_STEP 0x64
|
||||||
|
#define PMC_BASE_ADDR_MASK ~(SPT_PMC_MMIO_REG_LEN - 1)
|
||||||
|
#define MTPMC_MASK 0xffff0000
|
||||||
|
#define NUM_ENTRIES 5
|
||||||
|
#define SPT_PMC_READ_DISABLE_BIT 0x16
|
||||||
|
#define SPT_PMC_MSG_FULL_STS_BIT 0x18
|
||||||
|
#define NUM_RETRIES 100
|
||||||
|
#define NUM_IP_IGN_ALLOWED 17
|
||||||
|
|
||||||
|
/* Sunrise Point: PGD PFET Enable Ack Status Registers */
|
||||||
|
enum ppfear_regs {
|
||||||
|
SPT_PMC_XRAM_PPFEAR0A = 0x590,
|
||||||
|
SPT_PMC_XRAM_PPFEAR0B,
|
||||||
|
SPT_PMC_XRAM_PPFEAR0C,
|
||||||
|
SPT_PMC_XRAM_PPFEAR0D,
|
||||||
|
SPT_PMC_XRAM_PPFEAR1A,
|
||||||
|
};
|
||||||
|
|
||||||
|
#define SPT_PMC_BIT_PMC BIT(0)
|
||||||
|
#define SPT_PMC_BIT_OPI BIT(1)
|
||||||
|
#define SPT_PMC_BIT_SPI BIT(2)
|
||||||
|
#define SPT_PMC_BIT_XHCI BIT(3)
|
||||||
|
#define SPT_PMC_BIT_SPA BIT(4)
|
||||||
|
#define SPT_PMC_BIT_SPB BIT(5)
|
||||||
|
#define SPT_PMC_BIT_SPC BIT(6)
|
||||||
|
#define SPT_PMC_BIT_GBE BIT(7)
|
||||||
|
|
||||||
|
#define SPT_PMC_BIT_SATA BIT(0)
|
||||||
|
#define SPT_PMC_BIT_HDA_PGD0 BIT(1)
|
||||||
|
#define SPT_PMC_BIT_HDA_PGD1 BIT(2)
|
||||||
|
#define SPT_PMC_BIT_HDA_PGD2 BIT(3)
|
||||||
|
#define SPT_PMC_BIT_HDA_PGD3 BIT(4)
|
||||||
|
#define SPT_PMC_BIT_RSVD_0B BIT(5)
|
||||||
|
#define SPT_PMC_BIT_LPSS BIT(6)
|
||||||
|
#define SPT_PMC_BIT_LPC BIT(7)
|
||||||
|
|
||||||
|
#define SPT_PMC_BIT_SMB BIT(0)
|
||||||
|
#define SPT_PMC_BIT_ISH BIT(1)
|
||||||
|
#define SPT_PMC_BIT_P2SB BIT(2)
|
||||||
|
#define SPT_PMC_BIT_DFX BIT(3)
|
||||||
|
#define SPT_PMC_BIT_SCC BIT(4)
|
||||||
|
#define SPT_PMC_BIT_RSVD_0C BIT(5)
|
||||||
|
#define SPT_PMC_BIT_FUSE BIT(6)
|
||||||
|
#define SPT_PMC_BIT_CAMREA BIT(7)
|
||||||
|
|
||||||
|
#define SPT_PMC_BIT_RSVD_0D BIT(0)
|
||||||
|
#define SPT_PMC_BIT_USB3_OTG BIT(1)
|
||||||
|
#define SPT_PMC_BIT_EXI BIT(2)
|
||||||
|
#define SPT_PMC_BIT_CSE BIT(3)
|
||||||
|
#define SPT_PMC_BIT_CSME_KVM BIT(4)
|
||||||
|
#define SPT_PMC_BIT_CSME_PMT BIT(5)
|
||||||
|
#define SPT_PMC_BIT_CSME_CLINK BIT(6)
|
||||||
|
#define SPT_PMC_BIT_CSME_PTIO BIT(7)
|
||||||
|
|
||||||
|
#define SPT_PMC_BIT_CSME_USBR BIT(0)
|
||||||
|
#define SPT_PMC_BIT_CSME_SUSRAM BIT(1)
|
||||||
|
#define SPT_PMC_BIT_CSME_SMT BIT(2)
|
||||||
|
#define SPT_PMC_BIT_RSVD_1A BIT(3)
|
||||||
|
#define SPT_PMC_BIT_CSME_SMS2 BIT(4)
|
||||||
|
#define SPT_PMC_BIT_CSME_SMS1 BIT(5)
|
||||||
|
#define SPT_PMC_BIT_CSME_RTC BIT(6)
|
||||||
|
#define SPT_PMC_BIT_CSME_PSF BIT(7)
|
||||||
|
|
||||||
|
#define SPT_PMC_BIT_MPHY_LANE0 BIT(0)
|
||||||
|
#define SPT_PMC_BIT_MPHY_LANE1 BIT(1)
|
||||||
|
#define SPT_PMC_BIT_MPHY_LANE2 BIT(2)
|
||||||
|
#define SPT_PMC_BIT_MPHY_LANE3 BIT(3)
|
||||||
|
#define SPT_PMC_BIT_MPHY_LANE4 BIT(4)
|
||||||
|
#define SPT_PMC_BIT_MPHY_LANE5 BIT(5)
|
||||||
|
#define SPT_PMC_BIT_MPHY_LANE6 BIT(6)
|
||||||
|
#define SPT_PMC_BIT_MPHY_LANE7 BIT(7)
|
||||||
|
|
||||||
|
#define SPT_PMC_BIT_MPHY_LANE8 BIT(0)
|
||||||
|
#define SPT_PMC_BIT_MPHY_LANE9 BIT(1)
|
||||||
|
#define SPT_PMC_BIT_MPHY_LANE10 BIT(2)
|
||||||
|
#define SPT_PMC_BIT_MPHY_LANE11 BIT(3)
|
||||||
|
#define SPT_PMC_BIT_MPHY_LANE12 BIT(4)
|
||||||
|
#define SPT_PMC_BIT_MPHY_LANE13 BIT(5)
|
||||||
|
#define SPT_PMC_BIT_MPHY_LANE14 BIT(6)
|
||||||
|
#define SPT_PMC_BIT_MPHY_LANE15 BIT(7)
|
||||||
|
|
||||||
|
#define SPT_PMC_BIT_MPHY_CMN_LANE0 BIT(0)
|
||||||
|
#define SPT_PMC_BIT_MPHY_CMN_LANE1 BIT(1)
|
||||||
|
#define SPT_PMC_BIT_MPHY_CMN_LANE2 BIT(2)
|
||||||
|
#define SPT_PMC_BIT_MPHY_CMN_LANE3 BIT(3)
|
||||||
|
|
||||||
|
struct pmc_bit_map {
|
||||||
|
const char *name;
|
||||||
|
u32 bit_mask;
|
||||||
|
};
|
||||||
|
|
||||||
|
struct pmc_reg_map {
|
||||||
|
const struct pmc_bit_map *pfear_sts;
|
||||||
|
const struct pmc_bit_map *mphy_sts;
|
||||||
|
const struct pmc_bit_map *pll_sts;
|
||||||
|
};
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* struct pmc_dev - pmc device structure
|
* struct pmc_dev - pmc device structure
|
||||||
@ -43,8 +146,13 @@
|
|||||||
struct pmc_dev {
|
struct pmc_dev {
|
||||||
u32 base_addr;
|
u32 base_addr;
|
||||||
void __iomem *regbase;
|
void __iomem *regbase;
|
||||||
|
const struct pmc_reg_map *map;
|
||||||
|
#if IS_ENABLED(CONFIG_DEBUG_FS)
|
||||||
struct dentry *dbgfs_dir;
|
struct dentry *dbgfs_dir;
|
||||||
|
#endif /* CONFIG_DEBUG_FS */
|
||||||
bool has_slp_s0_res;
|
bool has_slp_s0_res;
|
||||||
|
int pmc_xram_read_bit;
|
||||||
|
struct mutex lock; /* generic mutex lock for PMC Core */
|
||||||
};
|
};
|
||||||
|
|
||||||
#endif /* PMC_CORE_H */
|
#endif /* PMC_CORE_H */
|
||||||
|
515
drivers/platform/x86/mlxcpld-hotplug.c
Normal file
515
drivers/platform/x86/mlxcpld-hotplug.c
Normal file
@ -0,0 +1,515 @@
|
|||||||
|
/*
|
||||||
|
* drivers/platform/x86/mlxcpld-hotplug.c
|
||||||
|
* Copyright (c) 2016 Mellanox Technologies. All rights reserved.
|
||||||
|
* Copyright (c) 2016 Vadim Pasternak <vadimp@mellanox.com>
|
||||||
|
*
|
||||||
|
* Redistribution and use in source and binary forms, with or without
|
||||||
|
* modification, are permitted provided that the following conditions are met:
|
||||||
|
*
|
||||||
|
* 1. Redistributions of source code must retain the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer.
|
||||||
|
* 2. Redistributions in binary form must reproduce the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer in the
|
||||||
|
* documentation and/or other materials provided with the distribution.
|
||||||
|
* 3. Neither the names of the copyright holders nor the names of its
|
||||||
|
* contributors may be used to endorse or promote products derived from
|
||||||
|
* this software without specific prior written permission.
|
||||||
|
*
|
||||||
|
* Alternatively, this software may be distributed under the terms of the
|
||||||
|
* GNU General Public License ("GPL") version 2 as published by the Free
|
||||||
|
* Software Foundation.
|
||||||
|
*
|
||||||
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
|
||||||
|
* AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
||||||
|
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
||||||
|
* ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
|
||||||
|
* LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
||||||
|
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
||||||
|
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
|
||||||
|
* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
||||||
|
* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
|
||||||
|
* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
||||||
|
* POSSIBILITY OF SUCH DAMAGE.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include <linux/bitops.h>
|
||||||
|
#include <linux/device.h>
|
||||||
|
#include <linux/hwmon.h>
|
||||||
|
#include <linux/hwmon-sysfs.h>
|
||||||
|
#include <linux/i2c.h>
|
||||||
|
#include <linux/interrupt.h>
|
||||||
|
#include <linux/io.h>
|
||||||
|
#include <linux/module.h>
|
||||||
|
#include <linux/platform_data/mlxcpld-hotplug.h>
|
||||||
|
#include <linux/platform_device.h>
|
||||||
|
#include <linux/spinlock.h>
|
||||||
|
#include <linux/wait.h>
|
||||||
|
#include <linux/workqueue.h>
|
||||||
|
|
||||||
|
/* Offset of event and mask registers from status register */
|
||||||
|
#define MLXCPLD_HOTPLUG_EVENT_OFF 1
|
||||||
|
#define MLXCPLD_HOTPLUG_MASK_OFF 2
|
||||||
|
#define MLXCPLD_HOTPLUG_AGGR_MASK_OFF 1
|
||||||
|
|
||||||
|
#define MLXCPLD_HOTPLUG_ATTRS_NUM 8
|
||||||
|
|
||||||
|
/**
|
||||||
|
* enum mlxcpld_hotplug_attr_type - sysfs attributes for hotplug events:
|
||||||
|
* @MLXCPLD_HOTPLUG_ATTR_TYPE_PSU: power supply unit attribute;
|
||||||
|
* @MLXCPLD_HOTPLUG_ATTR_TYPE_PWR: power cable attribute;
|
||||||
|
* @MLXCPLD_HOTPLUG_ATTR_TYPE_FAN: FAN drawer attribute;
|
||||||
|
*/
|
||||||
|
enum mlxcpld_hotplug_attr_type {
|
||||||
|
MLXCPLD_HOTPLUG_ATTR_TYPE_PSU,
|
||||||
|
MLXCPLD_HOTPLUG_ATTR_TYPE_PWR,
|
||||||
|
MLXCPLD_HOTPLUG_ATTR_TYPE_FAN,
|
||||||
|
};
|
||||||
|
|
||||||
|
/**
|
||||||
|
* struct mlxcpld_hotplug_priv_data - platform private data:
|
||||||
|
* @irq: platform interrupt number;
|
||||||
|
* @pdev: platform device;
|
||||||
|
* @plat: platform data;
|
||||||
|
* @hwmon: hwmon device;
|
||||||
|
* @mlxcpld_hotplug_attr: sysfs attributes array;
|
||||||
|
* @mlxcpld_hotplug_dev_attr: sysfs sensor device attribute array;
|
||||||
|
* @group: sysfs attribute group;
|
||||||
|
* @groups: list of sysfs attribute group for hwmon registration;
|
||||||
|
* @dwork: delayed work template;
|
||||||
|
* @lock: spin lock;
|
||||||
|
* @aggr_cache: last value of aggregation register status;
|
||||||
|
* @psu_cache: last value of PSU register status;
|
||||||
|
* @pwr_cache: last value of power register status;
|
||||||
|
* @fan_cache: last value of FAN register status;
|
||||||
|
*/
|
||||||
|
struct mlxcpld_hotplug_priv_data {
|
||||||
|
int irq;
|
||||||
|
struct platform_device *pdev;
|
||||||
|
struct mlxcpld_hotplug_platform_data *plat;
|
||||||
|
struct device *hwmon;
|
||||||
|
struct attribute *mlxcpld_hotplug_attr[MLXCPLD_HOTPLUG_ATTRS_NUM + 1];
|
||||||
|
struct sensor_device_attribute_2
|
||||||
|
mlxcpld_hotplug_dev_attr[MLXCPLD_HOTPLUG_ATTRS_NUM];
|
||||||
|
struct attribute_group group;
|
||||||
|
const struct attribute_group *groups[2];
|
||||||
|
struct delayed_work dwork;
|
||||||
|
spinlock_t lock;
|
||||||
|
u8 aggr_cache;
|
||||||
|
u8 psu_cache;
|
||||||
|
u8 pwr_cache;
|
||||||
|
u8 fan_cache;
|
||||||
|
};
|
||||||
|
|
||||||
|
static ssize_t mlxcpld_hotplug_attr_show(struct device *dev,
|
||||||
|
struct device_attribute *attr,
|
||||||
|
char *buf)
|
||||||
|
{
|
||||||
|
struct platform_device *pdev = to_platform_device(dev);
|
||||||
|
struct mlxcpld_hotplug_priv_data *priv = platform_get_drvdata(pdev);
|
||||||
|
int index = to_sensor_dev_attr_2(attr)->index;
|
||||||
|
int nr = to_sensor_dev_attr_2(attr)->nr;
|
||||||
|
u8 reg_val = 0;
|
||||||
|
|
||||||
|
switch (nr) {
|
||||||
|
case MLXCPLD_HOTPLUG_ATTR_TYPE_PSU:
|
||||||
|
/* Bit = 0 : PSU is present. */
|
||||||
|
reg_val = !!!(inb(priv->plat->psu_reg_offset) & BIT(index));
|
||||||
|
break;
|
||||||
|
|
||||||
|
case MLXCPLD_HOTPLUG_ATTR_TYPE_PWR:
|
||||||
|
/* Bit = 1 : power cable is attached. */
|
||||||
|
reg_val = !!(inb(priv->plat->pwr_reg_offset) & BIT(index %
|
||||||
|
priv->plat->pwr_count));
|
||||||
|
break;
|
||||||
|
|
||||||
|
case MLXCPLD_HOTPLUG_ATTR_TYPE_FAN:
|
||||||
|
/* Bit = 0 : FAN is present. */
|
||||||
|
reg_val = !!!(inb(priv->plat->fan_reg_offset) & BIT(index %
|
||||||
|
priv->plat->fan_count));
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
return sprintf(buf, "%u\n", reg_val);
|
||||||
|
}
|
||||||
|
|
||||||
|
#define PRIV_ATTR(i) priv->mlxcpld_hotplug_attr[i]
|
||||||
|
#define PRIV_DEV_ATTR(i) priv->mlxcpld_hotplug_dev_attr[i]
|
||||||
|
static int mlxcpld_hotplug_attr_init(struct mlxcpld_hotplug_priv_data *priv)
|
||||||
|
{
|
||||||
|
int num_attrs = priv->plat->psu_count + priv->plat->pwr_count +
|
||||||
|
priv->plat->fan_count;
|
||||||
|
int i;
|
||||||
|
|
||||||
|
priv->group.attrs = devm_kzalloc(&priv->pdev->dev, num_attrs *
|
||||||
|
sizeof(struct attribute *),
|
||||||
|
GFP_KERNEL);
|
||||||
|
if (!priv->group.attrs)
|
||||||
|
return -ENOMEM;
|
||||||
|
|
||||||
|
for (i = 0; i < num_attrs; i++) {
|
||||||
|
PRIV_ATTR(i) = &PRIV_DEV_ATTR(i).dev_attr.attr;
|
||||||
|
|
||||||
|
if (i < priv->plat->psu_count) {
|
||||||
|
PRIV_ATTR(i)->name = devm_kasprintf(&priv->pdev->dev,
|
||||||
|
GFP_KERNEL, "psu%u", i + 1);
|
||||||
|
PRIV_DEV_ATTR(i).nr = MLXCPLD_HOTPLUG_ATTR_TYPE_PSU;
|
||||||
|
} else if (i < priv->plat->psu_count + priv->plat->pwr_count) {
|
||||||
|
PRIV_ATTR(i)->name = devm_kasprintf(&priv->pdev->dev,
|
||||||
|
GFP_KERNEL, "pwr%u", i %
|
||||||
|
priv->plat->pwr_count + 1);
|
||||||
|
PRIV_DEV_ATTR(i).nr = MLXCPLD_HOTPLUG_ATTR_TYPE_PWR;
|
||||||
|
} else {
|
||||||
|
PRIV_ATTR(i)->name = devm_kasprintf(&priv->pdev->dev,
|
||||||
|
GFP_KERNEL, "fan%u", i %
|
||||||
|
priv->plat->fan_count + 1);
|
||||||
|
PRIV_DEV_ATTR(i).nr = MLXCPLD_HOTPLUG_ATTR_TYPE_FAN;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (!PRIV_ATTR(i)->name) {
|
||||||
|
dev_err(&priv->pdev->dev, "Memory allocation failed for sysfs attribute %d.\n",
|
||||||
|
i + 1);
|
||||||
|
return -ENOMEM;
|
||||||
|
}
|
||||||
|
|
||||||
|
PRIV_DEV_ATTR(i).dev_attr.attr.name = PRIV_ATTR(i)->name;
|
||||||
|
PRIV_DEV_ATTR(i).dev_attr.attr.mode = S_IRUGO;
|
||||||
|
PRIV_DEV_ATTR(i).dev_attr.show = mlxcpld_hotplug_attr_show;
|
||||||
|
PRIV_DEV_ATTR(i).index = i;
|
||||||
|
sysfs_attr_init(&PRIV_DEV_ATTR(i).dev_attr.attr);
|
||||||
|
}
|
||||||
|
|
||||||
|
priv->group.attrs = priv->mlxcpld_hotplug_attr;
|
||||||
|
priv->groups[0] = &priv->group;
|
||||||
|
priv->groups[1] = NULL;
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int mlxcpld_hotplug_device_create(struct device *dev,
|
||||||
|
struct mlxcpld_hotplug_device *item)
|
||||||
|
{
|
||||||
|
item->adapter = i2c_get_adapter(item->bus);
|
||||||
|
if (!item->adapter) {
|
||||||
|
dev_err(dev, "Failed to get adapter for bus %d\n",
|
||||||
|
item->bus);
|
||||||
|
return -EFAULT;
|
||||||
|
}
|
||||||
|
|
||||||
|
item->client = i2c_new_device(item->adapter, &item->brdinfo);
|
||||||
|
if (!item->client) {
|
||||||
|
dev_err(dev, "Failed to create client %s at bus %d at addr 0x%02x\n",
|
||||||
|
item->brdinfo.type, item->bus, item->brdinfo.addr);
|
||||||
|
i2c_put_adapter(item->adapter);
|
||||||
|
item->adapter = NULL;
|
||||||
|
return -EFAULT;
|
||||||
|
}
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void mlxcpld_hotplug_device_destroy(struct mlxcpld_hotplug_device *item)
|
||||||
|
{
|
||||||
|
if (item->client) {
|
||||||
|
i2c_unregister_device(item->client);
|
||||||
|
item->client = NULL;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (item->adapter) {
|
||||||
|
i2c_put_adapter(item->adapter);
|
||||||
|
item->adapter = NULL;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline void
|
||||||
|
mlxcpld_hotplug_work_helper(struct device *dev,
|
||||||
|
struct mlxcpld_hotplug_device *item, u8 is_inverse,
|
||||||
|
u16 offset, u8 mask, u8 *cache)
|
||||||
|
{
|
||||||
|
u8 val, asserted;
|
||||||
|
int bit;
|
||||||
|
|
||||||
|
/* Mask event. */
|
||||||
|
outb(0, offset + MLXCPLD_HOTPLUG_MASK_OFF);
|
||||||
|
/* Read status. */
|
||||||
|
val = inb(offset) & mask;
|
||||||
|
asserted = *cache ^ val;
|
||||||
|
*cache = val;
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Validate if item related to received signal type is valid.
|
||||||
|
* It should never happen, excepted the situation when some
|
||||||
|
* piece of hardware is broken. In such situation just produce
|
||||||
|
* error message and return. Caller must continue to handle the
|
||||||
|
* signals from other devices if any.
|
||||||
|
*/
|
||||||
|
if (unlikely(!item)) {
|
||||||
|
dev_err(dev, "False signal is received: register at offset 0x%02x, mask 0x%02x.\n",
|
||||||
|
offset, mask);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
for_each_set_bit(bit, (unsigned long *)&asserted, 8) {
|
||||||
|
if (val & BIT(bit)) {
|
||||||
|
if (is_inverse)
|
||||||
|
mlxcpld_hotplug_device_destroy(item + bit);
|
||||||
|
else
|
||||||
|
mlxcpld_hotplug_device_create(dev, item + bit);
|
||||||
|
} else {
|
||||||
|
if (is_inverse)
|
||||||
|
mlxcpld_hotplug_device_create(dev, item + bit);
|
||||||
|
else
|
||||||
|
mlxcpld_hotplug_device_destroy(item + bit);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Acknowledge event. */
|
||||||
|
outb(0, offset + MLXCPLD_HOTPLUG_EVENT_OFF);
|
||||||
|
/* Unmask event. */
|
||||||
|
outb(mask, offset + MLXCPLD_HOTPLUG_MASK_OFF);
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* mlxcpld_hotplug_work_handler - performs traversing of CPLD interrupt
|
||||||
|
* registers according to the below hierarchy schema:
|
||||||
|
*
|
||||||
|
* Aggregation registers (status/mask)
|
||||||
|
* PSU registers: *---*
|
||||||
|
* *-----------------* | |
|
||||||
|
* |status/event/mask|----->| * |
|
||||||
|
* *-----------------* | |
|
||||||
|
* Power registers: | |
|
||||||
|
* *-----------------* | |
|
||||||
|
* |status/event/mask|----->| * |---> CPU
|
||||||
|
* *-----------------* | |
|
||||||
|
* FAN registers:
|
||||||
|
* *-----------------* | |
|
||||||
|
* |status/event/mask|----->| * |
|
||||||
|
* *-----------------* | |
|
||||||
|
* *---*
|
||||||
|
* In case some system changed are detected: FAN in/out, PSU in/out, power
|
||||||
|
* cable attached/detached, relevant device is created or destroyed.
|
||||||
|
*/
|
||||||
|
static void mlxcpld_hotplug_work_handler(struct work_struct *work)
|
||||||
|
{
|
||||||
|
struct mlxcpld_hotplug_priv_data *priv = container_of(work,
|
||||||
|
struct mlxcpld_hotplug_priv_data, dwork.work);
|
||||||
|
u8 val, aggr_asserted;
|
||||||
|
unsigned long flags;
|
||||||
|
|
||||||
|
/* Mask aggregation event. */
|
||||||
|
outb(0, priv->plat->top_aggr_offset + MLXCPLD_HOTPLUG_AGGR_MASK_OFF);
|
||||||
|
/* Read aggregation status. */
|
||||||
|
val = inb(priv->plat->top_aggr_offset) & priv->plat->top_aggr_mask;
|
||||||
|
aggr_asserted = priv->aggr_cache ^ val;
|
||||||
|
priv->aggr_cache = val;
|
||||||
|
|
||||||
|
/* Handle PSU configuration changes. */
|
||||||
|
if (aggr_asserted & priv->plat->top_aggr_psu_mask)
|
||||||
|
mlxcpld_hotplug_work_helper(&priv->pdev->dev, priv->plat->psu,
|
||||||
|
1, priv->plat->psu_reg_offset,
|
||||||
|
priv->plat->psu_mask,
|
||||||
|
&priv->psu_cache);
|
||||||
|
|
||||||
|
/* Handle power cable configuration changes. */
|
||||||
|
if (aggr_asserted & priv->plat->top_aggr_pwr_mask)
|
||||||
|
mlxcpld_hotplug_work_helper(&priv->pdev->dev, priv->plat->pwr,
|
||||||
|
0, priv->plat->pwr_reg_offset,
|
||||||
|
priv->plat->pwr_mask,
|
||||||
|
&priv->pwr_cache);
|
||||||
|
|
||||||
|
/* Handle FAN configuration changes. */
|
||||||
|
if (aggr_asserted & priv->plat->top_aggr_fan_mask)
|
||||||
|
mlxcpld_hotplug_work_helper(&priv->pdev->dev, priv->plat->fan,
|
||||||
|
1, priv->plat->fan_reg_offset,
|
||||||
|
priv->plat->fan_mask,
|
||||||
|
&priv->fan_cache);
|
||||||
|
|
||||||
|
if (aggr_asserted) {
|
||||||
|
spin_lock_irqsave(&priv->lock, flags);
|
||||||
|
|
||||||
|
/*
|
||||||
|
* It is possible, that some signals have been inserted, while
|
||||||
|
* interrupt has been masked by mlxcpld_hotplug_work_handler.
|
||||||
|
* In this case such signals will be missed. In order to handle
|
||||||
|
* these signals delayed work is canceled and work task
|
||||||
|
* re-scheduled for immediate execution. It allows to handle
|
||||||
|
* missed signals, if any. In other case work handler just
|
||||||
|
* validates that no new signals have been received during
|
||||||
|
* masking.
|
||||||
|
*/
|
||||||
|
cancel_delayed_work(&priv->dwork);
|
||||||
|
schedule_delayed_work(&priv->dwork, 0);
|
||||||
|
|
||||||
|
spin_unlock_irqrestore(&priv->lock, flags);
|
||||||
|
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Unmask aggregation event (no need acknowledge). */
|
||||||
|
outb(priv->plat->top_aggr_mask, priv->plat->top_aggr_offset +
|
||||||
|
MLXCPLD_HOTPLUG_AGGR_MASK_OFF);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void mlxcpld_hotplug_set_irq(struct mlxcpld_hotplug_priv_data *priv)
|
||||||
|
{
|
||||||
|
/* Clear psu presense event. */
|
||||||
|
outb(0, priv->plat->psu_reg_offset + MLXCPLD_HOTPLUG_EVENT_OFF);
|
||||||
|
/* Set psu initial status as mask and unmask psu event. */
|
||||||
|
priv->psu_cache = priv->plat->psu_mask;
|
||||||
|
outb(priv->plat->psu_mask, priv->plat->psu_reg_offset +
|
||||||
|
MLXCPLD_HOTPLUG_MASK_OFF);
|
||||||
|
|
||||||
|
/* Clear power cable event. */
|
||||||
|
outb(0, priv->plat->pwr_reg_offset + MLXCPLD_HOTPLUG_EVENT_OFF);
|
||||||
|
/* Keep power initial status as zero and unmask power event. */
|
||||||
|
outb(priv->plat->pwr_mask, priv->plat->pwr_reg_offset +
|
||||||
|
MLXCPLD_HOTPLUG_MASK_OFF);
|
||||||
|
|
||||||
|
/* Clear fan presense event. */
|
||||||
|
outb(0, priv->plat->fan_reg_offset + MLXCPLD_HOTPLUG_EVENT_OFF);
|
||||||
|
/* Set fan initial status as mask and unmask fan event. */
|
||||||
|
priv->fan_cache = priv->plat->fan_mask;
|
||||||
|
outb(priv->plat->fan_mask, priv->plat->fan_reg_offset +
|
||||||
|
MLXCPLD_HOTPLUG_MASK_OFF);
|
||||||
|
|
||||||
|
/* Keep aggregation initial status as zero and unmask events. */
|
||||||
|
outb(priv->plat->top_aggr_mask, priv->plat->top_aggr_offset +
|
||||||
|
MLXCPLD_HOTPLUG_AGGR_MASK_OFF);
|
||||||
|
|
||||||
|
/* Invoke work handler for initializing hot plug devices setting. */
|
||||||
|
mlxcpld_hotplug_work_handler(&priv->dwork.work);
|
||||||
|
|
||||||
|
enable_irq(priv->irq);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void mlxcpld_hotplug_unset_irq(struct mlxcpld_hotplug_priv_data *priv)
|
||||||
|
{
|
||||||
|
int i;
|
||||||
|
|
||||||
|
disable_irq(priv->irq);
|
||||||
|
cancel_delayed_work_sync(&priv->dwork);
|
||||||
|
|
||||||
|
/* Mask aggregation event. */
|
||||||
|
outb(0, priv->plat->top_aggr_offset + MLXCPLD_HOTPLUG_AGGR_MASK_OFF);
|
||||||
|
|
||||||
|
/* Mask psu presense event. */
|
||||||
|
outb(0, priv->plat->psu_reg_offset + MLXCPLD_HOTPLUG_MASK_OFF);
|
||||||
|
/* Clear psu presense event. */
|
||||||
|
outb(0, priv->plat->psu_reg_offset + MLXCPLD_HOTPLUG_EVENT_OFF);
|
||||||
|
|
||||||
|
/* Mask power cable event. */
|
||||||
|
outb(0, priv->plat->pwr_reg_offset + MLXCPLD_HOTPLUG_MASK_OFF);
|
||||||
|
/* Clear power cable event. */
|
||||||
|
outb(0, priv->plat->pwr_reg_offset + MLXCPLD_HOTPLUG_EVENT_OFF);
|
||||||
|
|
||||||
|
/* Mask fan presense event. */
|
||||||
|
outb(0, priv->plat->fan_reg_offset + MLXCPLD_HOTPLUG_MASK_OFF);
|
||||||
|
/* Clear fan presense event. */
|
||||||
|
outb(0, priv->plat->fan_reg_offset + MLXCPLD_HOTPLUG_EVENT_OFF);
|
||||||
|
|
||||||
|
/* Remove all the attached devices. */
|
||||||
|
for (i = 0; i < priv->plat->psu_count; i++)
|
||||||
|
mlxcpld_hotplug_device_destroy(priv->plat->psu + i);
|
||||||
|
|
||||||
|
for (i = 0; i < priv->plat->pwr_count; i++)
|
||||||
|
mlxcpld_hotplug_device_destroy(priv->plat->pwr + i);
|
||||||
|
|
||||||
|
for (i = 0; i < priv->plat->fan_count; i++)
|
||||||
|
mlxcpld_hotplug_device_destroy(priv->plat->fan + i);
|
||||||
|
}
|
||||||
|
|
||||||
|
static irqreturn_t mlxcpld_hotplug_irq_handler(int irq, void *dev)
|
||||||
|
{
|
||||||
|
struct mlxcpld_hotplug_priv_data *priv =
|
||||||
|
(struct mlxcpld_hotplug_priv_data *)dev;
|
||||||
|
|
||||||
|
/* Schedule work task for immediate execution.*/
|
||||||
|
schedule_delayed_work(&priv->dwork, 0);
|
||||||
|
|
||||||
|
return IRQ_HANDLED;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int mlxcpld_hotplug_probe(struct platform_device *pdev)
|
||||||
|
{
|
||||||
|
struct mlxcpld_hotplug_platform_data *pdata;
|
||||||
|
struct mlxcpld_hotplug_priv_data *priv;
|
||||||
|
int err;
|
||||||
|
|
||||||
|
pdata = dev_get_platdata(&pdev->dev);
|
||||||
|
if (!pdata) {
|
||||||
|
dev_err(&pdev->dev, "Failed to get platform data.\n");
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
|
||||||
|
priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
|
||||||
|
if (!priv)
|
||||||
|
return -ENOMEM;
|
||||||
|
|
||||||
|
priv->pdev = pdev;
|
||||||
|
priv->plat = pdata;
|
||||||
|
|
||||||
|
priv->irq = platform_get_irq(pdev, 0);
|
||||||
|
if (priv->irq < 0) {
|
||||||
|
dev_err(&pdev->dev, "Failed to get platform irq: %d\n",
|
||||||
|
priv->irq);
|
||||||
|
return priv->irq;
|
||||||
|
}
|
||||||
|
|
||||||
|
err = devm_request_irq(&pdev->dev, priv->irq,
|
||||||
|
mlxcpld_hotplug_irq_handler, 0, pdev->name,
|
||||||
|
priv);
|
||||||
|
if (err) {
|
||||||
|
dev_err(&pdev->dev, "Failed to request irq: %d\n", err);
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
disable_irq(priv->irq);
|
||||||
|
|
||||||
|
INIT_DELAYED_WORK(&priv->dwork, mlxcpld_hotplug_work_handler);
|
||||||
|
spin_lock_init(&priv->lock);
|
||||||
|
|
||||||
|
err = mlxcpld_hotplug_attr_init(priv);
|
||||||
|
if (err) {
|
||||||
|
dev_err(&pdev->dev, "Failed to allocate attributes: %d\n", err);
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
|
||||||
|
priv->hwmon = devm_hwmon_device_register_with_groups(&pdev->dev,
|
||||||
|
"mlxcpld_hotplug", priv, priv->groups);
|
||||||
|
if (IS_ERR(priv->hwmon)) {
|
||||||
|
dev_err(&pdev->dev, "Failed to register hwmon device %ld\n",
|
||||||
|
PTR_ERR(priv->hwmon));
|
||||||
|
return PTR_ERR(priv->hwmon);
|
||||||
|
}
|
||||||
|
|
||||||
|
platform_set_drvdata(pdev, priv);
|
||||||
|
|
||||||
|
/* Perform initial interrupts setup. */
|
||||||
|
mlxcpld_hotplug_set_irq(priv);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int mlxcpld_hotplug_remove(struct platform_device *pdev)
|
||||||
|
{
|
||||||
|
struct mlxcpld_hotplug_priv_data *priv = platform_get_drvdata(pdev);
|
||||||
|
|
||||||
|
/* Clean interrupts setup. */
|
||||||
|
mlxcpld_hotplug_unset_irq(priv);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static struct platform_driver mlxcpld_hotplug_driver = {
|
||||||
|
.driver = {
|
||||||
|
.name = "mlxcpld-hotplug",
|
||||||
|
},
|
||||||
|
.probe = mlxcpld_hotplug_probe,
|
||||||
|
.remove = mlxcpld_hotplug_remove,
|
||||||
|
};
|
||||||
|
|
||||||
|
module_platform_driver(mlxcpld_hotplug_driver);
|
||||||
|
|
||||||
|
MODULE_AUTHOR("Vadim Pasternak <vadimp@mellanox.com>");
|
||||||
|
MODULE_DESCRIPTION("Mellanox CPLD hotplug platform driver");
|
||||||
|
MODULE_LICENSE("Dual BSD/GPL");
|
||||||
|
MODULE_ALIAS("platform:mlxcpld-hotplug");
|
@ -458,7 +458,7 @@ static void acpi_pcc_generate_keyinput(struct pcc_acpi *pcc)
|
|||||||
|
|
||||||
rc = acpi_evaluate_integer(pcc->handle, METHOD_HKEY_QUERY,
|
rc = acpi_evaluate_integer(pcc->handle, METHOD_HKEY_QUERY,
|
||||||
NULL, &result);
|
NULL, &result);
|
||||||
if (!ACPI_SUCCESS(rc)) {
|
if (ACPI_FAILURE(rc)) {
|
||||||
ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
|
ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
|
||||||
"error getting hotkey status\n"));
|
"error getting hotkey status\n"));
|
||||||
return;
|
return;
|
||||||
|
@ -128,6 +128,7 @@ enum {
|
|||||||
/* ACPI HIDs */
|
/* ACPI HIDs */
|
||||||
#define TPACPI_ACPI_IBM_HKEY_HID "IBM0068"
|
#define TPACPI_ACPI_IBM_HKEY_HID "IBM0068"
|
||||||
#define TPACPI_ACPI_LENOVO_HKEY_HID "LEN0068"
|
#define TPACPI_ACPI_LENOVO_HKEY_HID "LEN0068"
|
||||||
|
#define TPACPI_ACPI_LENOVO_HKEY_V2_HID "LEN0268"
|
||||||
#define TPACPI_ACPI_EC_HID "PNP0C09"
|
#define TPACPI_ACPI_EC_HID "PNP0C09"
|
||||||
|
|
||||||
/* Input IDs */
|
/* Input IDs */
|
||||||
@ -190,6 +191,9 @@ enum tpacpi_hkey_event_t {
|
|||||||
TP_HKEY_EV_LID_OPEN = 0x5002, /* laptop lid opened */
|
TP_HKEY_EV_LID_OPEN = 0x5002, /* laptop lid opened */
|
||||||
TP_HKEY_EV_TABLET_TABLET = 0x5009, /* tablet swivel up */
|
TP_HKEY_EV_TABLET_TABLET = 0x5009, /* tablet swivel up */
|
||||||
TP_HKEY_EV_TABLET_NOTEBOOK = 0x500a, /* tablet swivel down */
|
TP_HKEY_EV_TABLET_NOTEBOOK = 0x500a, /* tablet swivel down */
|
||||||
|
TP_HKEY_EV_TABLET_CHANGED = 0x60c0, /* X1 Yoga (2016):
|
||||||
|
* enter/leave tablet mode
|
||||||
|
*/
|
||||||
TP_HKEY_EV_PEN_INSERTED = 0x500b, /* tablet pen inserted */
|
TP_HKEY_EV_PEN_INSERTED = 0x500b, /* tablet pen inserted */
|
||||||
TP_HKEY_EV_PEN_REMOVED = 0x500c, /* tablet pen removed */
|
TP_HKEY_EV_PEN_REMOVED = 0x500c, /* tablet pen removed */
|
||||||
TP_HKEY_EV_BRGHT_CHANGED = 0x5010, /* backlight control event */
|
TP_HKEY_EV_BRGHT_CHANGED = 0x5010, /* backlight control event */
|
||||||
@ -302,7 +306,12 @@ static struct {
|
|||||||
u32 hotkey:1;
|
u32 hotkey:1;
|
||||||
u32 hotkey_mask:1;
|
u32 hotkey_mask:1;
|
||||||
u32 hotkey_wlsw:1;
|
u32 hotkey_wlsw:1;
|
||||||
u32 hotkey_tablet:1;
|
enum {
|
||||||
|
TP_HOTKEY_TABLET_NONE = 0,
|
||||||
|
TP_HOTKEY_TABLET_USES_MHKG,
|
||||||
|
/* X1 Yoga 2016, seen on BIOS N1FET44W */
|
||||||
|
TP_HOTKEY_TABLET_USES_CMMD,
|
||||||
|
} hotkey_tablet;
|
||||||
u32 kbdlight:1;
|
u32 kbdlight:1;
|
||||||
u32 light:1;
|
u32 light:1;
|
||||||
u32 light_status:1;
|
u32 light_status:1;
|
||||||
@ -2059,6 +2068,8 @@ static void hotkey_poll_setup(const bool may_warn);
|
|||||||
|
|
||||||
/* HKEY.MHKG() return bits */
|
/* HKEY.MHKG() return bits */
|
||||||
#define TP_HOTKEY_TABLET_MASK (1 << 3)
|
#define TP_HOTKEY_TABLET_MASK (1 << 3)
|
||||||
|
/* ThinkPad X1 Yoga (2016) */
|
||||||
|
#define TP_EC_CMMD_TABLET_MODE 0x6
|
||||||
|
|
||||||
static int hotkey_get_wlsw(void)
|
static int hotkey_get_wlsw(void)
|
||||||
{
|
{
|
||||||
@ -2083,10 +2094,23 @@ static int hotkey_get_tablet_mode(int *status)
|
|||||||
{
|
{
|
||||||
int s;
|
int s;
|
||||||
|
|
||||||
if (!acpi_evalf(hkey_handle, &s, "MHKG", "d"))
|
switch (tp_features.hotkey_tablet) {
|
||||||
return -EIO;
|
case TP_HOTKEY_TABLET_USES_MHKG:
|
||||||
|
if (!acpi_evalf(hkey_handle, &s, "MHKG", "d"))
|
||||||
|
return -EIO;
|
||||||
|
|
||||||
|
*status = ((s & TP_HOTKEY_TABLET_MASK) != 0);
|
||||||
|
break;
|
||||||
|
case TP_HOTKEY_TABLET_USES_CMMD:
|
||||||
|
if (!acpi_evalf(ec_handle, &s, "CMMD", "d"))
|
||||||
|
return -EIO;
|
||||||
|
|
||||||
|
*status = (s == TP_EC_CMMD_TABLET_MODE);
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
*status = ((s & TP_HOTKEY_TABLET_MASK) != 0);
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -3117,6 +3141,37 @@ static const struct tpacpi_quirk tpacpi_hotkey_qtable[] __initconst = {
|
|||||||
typedef u16 tpacpi_keymap_entry_t;
|
typedef u16 tpacpi_keymap_entry_t;
|
||||||
typedef tpacpi_keymap_entry_t tpacpi_keymap_t[TPACPI_HOTKEY_MAP_LEN];
|
typedef tpacpi_keymap_entry_t tpacpi_keymap_t[TPACPI_HOTKEY_MAP_LEN];
|
||||||
|
|
||||||
|
static int hotkey_init_tablet_mode(void)
|
||||||
|
{
|
||||||
|
int in_tablet_mode = 0, res;
|
||||||
|
char *type = NULL;
|
||||||
|
|
||||||
|
if (acpi_evalf(hkey_handle, &res, "MHKG", "qd")) {
|
||||||
|
/* For X41t, X60t, X61t Tablets... */
|
||||||
|
tp_features.hotkey_tablet = TP_HOTKEY_TABLET_USES_MHKG;
|
||||||
|
in_tablet_mode = !!(res & TP_HOTKEY_TABLET_MASK);
|
||||||
|
type = "MHKG";
|
||||||
|
} else if (acpi_evalf(ec_handle, &res, "CMMD", "qd")) {
|
||||||
|
/* For X1 Yoga (2016) */
|
||||||
|
tp_features.hotkey_tablet = TP_HOTKEY_TABLET_USES_CMMD;
|
||||||
|
in_tablet_mode = res == TP_EC_CMMD_TABLET_MODE;
|
||||||
|
type = "CMMD";
|
||||||
|
}
|
||||||
|
|
||||||
|
if (!tp_features.hotkey_tablet)
|
||||||
|
return 0;
|
||||||
|
|
||||||
|
pr_info("Tablet mode switch found (type: %s), currently in %s mode\n",
|
||||||
|
type, in_tablet_mode ? "tablet" : "laptop");
|
||||||
|
|
||||||
|
res = add_to_attr_set(hotkey_dev_attributes,
|
||||||
|
&dev_attr_hotkey_tablet_mode.attr);
|
||||||
|
if (res)
|
||||||
|
return -1;
|
||||||
|
|
||||||
|
return in_tablet_mode;
|
||||||
|
}
|
||||||
|
|
||||||
static int __init hotkey_init(struct ibm_init_struct *iibm)
|
static int __init hotkey_init(struct ibm_init_struct *iibm)
|
||||||
{
|
{
|
||||||
/* Requirements for changing the default keymaps:
|
/* Requirements for changing the default keymaps:
|
||||||
@ -3464,21 +3519,14 @@ static int __init hotkey_init(struct ibm_init_struct *iibm)
|
|||||||
res = add_to_attr_set(hotkey_dev_attributes,
|
res = add_to_attr_set(hotkey_dev_attributes,
|
||||||
&dev_attr_hotkey_radio_sw.attr);
|
&dev_attr_hotkey_radio_sw.attr);
|
||||||
|
|
||||||
/* For X41t, X60t, X61t Tablets... */
|
res = hotkey_init_tablet_mode();
|
||||||
if (!res && acpi_evalf(hkey_handle, &status, "MHKG", "qd")) {
|
if (res < 0)
|
||||||
tp_features.hotkey_tablet = 1;
|
goto err_exit;
|
||||||
tabletsw_state = !!(status & TP_HOTKEY_TABLET_MASK);
|
|
||||||
pr_info("possible tablet mode switch found; "
|
|
||||||
"ThinkPad in %s mode\n",
|
|
||||||
(tabletsw_state) ? "tablet" : "laptop");
|
|
||||||
res = add_to_attr_set(hotkey_dev_attributes,
|
|
||||||
&dev_attr_hotkey_tablet_mode.attr);
|
|
||||||
}
|
|
||||||
|
|
||||||
if (!res)
|
tabletsw_state = res;
|
||||||
res = register_attr_set_with_sysfs(
|
|
||||||
hotkey_dev_attributes,
|
res = register_attr_set_with_sysfs(hotkey_dev_attributes,
|
||||||
&tpacpi_pdev->dev.kobj);
|
&tpacpi_pdev->dev.kobj);
|
||||||
if (res)
|
if (res)
|
||||||
goto err_exit;
|
goto err_exit;
|
||||||
|
|
||||||
@ -3899,6 +3947,12 @@ static bool hotkey_notify_6xxx(const u32 hkey,
|
|||||||
*ignore_acpi_ev = true;
|
*ignore_acpi_ev = true;
|
||||||
return true;
|
return true;
|
||||||
|
|
||||||
|
case TP_HKEY_EV_TABLET_CHANGED:
|
||||||
|
tpacpi_input_send_tabletsw();
|
||||||
|
hotkey_tablet_mode_notify_change();
|
||||||
|
*send_acpi_ev = false;
|
||||||
|
break;
|
||||||
|
|
||||||
default:
|
default:
|
||||||
pr_warn("unknown possible thermal alarm or keyboard event received\n");
|
pr_warn("unknown possible thermal alarm or keyboard event received\n");
|
||||||
known = false;
|
known = false;
|
||||||
@ -4143,6 +4197,7 @@ static int hotkey_write(char *buf)
|
|||||||
static const struct acpi_device_id ibm_htk_device_ids[] = {
|
static const struct acpi_device_id ibm_htk_device_ids[] = {
|
||||||
{TPACPI_ACPI_IBM_HKEY_HID, 0},
|
{TPACPI_ACPI_IBM_HKEY_HID, 0},
|
||||||
{TPACPI_ACPI_LENOVO_HKEY_HID, 0},
|
{TPACPI_ACPI_LENOVO_HKEY_HID, 0},
|
||||||
|
{TPACPI_ACPI_LENOVO_HKEY_V2_HID, 0},
|
||||||
{"", 0},
|
{"", 0},
|
||||||
};
|
};
|
||||||
|
|
||||||
@ -7716,7 +7771,7 @@ static struct ibm_struct volume_driver_data = {
|
|||||||
|
|
||||||
#define alsa_card NULL
|
#define alsa_card NULL
|
||||||
|
|
||||||
static void inline volume_alsa_notify_change(void)
|
static inline void volume_alsa_notify_change(void)
|
||||||
{
|
{
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -9018,7 +9073,7 @@ static int mute_led_on_off(struct tp_led_table *t, bool state)
|
|||||||
acpi_handle temp;
|
acpi_handle temp;
|
||||||
int output;
|
int output;
|
||||||
|
|
||||||
if (!ACPI_SUCCESS(acpi_get_handle(hkey_handle, t->name, &temp))) {
|
if (ACPI_FAILURE(acpi_get_handle(hkey_handle, t->name, &temp))) {
|
||||||
pr_warn("Thinkpad ACPI has no %s interface.\n", t->name);
|
pr_warn("Thinkpad ACPI has no %s interface.\n", t->name);
|
||||||
return -EIO;
|
return -EIO;
|
||||||
}
|
}
|
||||||
|
99
include/linux/platform_data/mlxcpld-hotplug.h
Normal file
99
include/linux/platform_data/mlxcpld-hotplug.h
Normal file
@ -0,0 +1,99 @@
|
|||||||
|
/*
|
||||||
|
* include/linux/platform_data/mlxcpld-hotplug.h
|
||||||
|
* Copyright (c) 2016 Mellanox Technologies. All rights reserved.
|
||||||
|
* Copyright (c) 2016 Vadim Pasternak <vadimp@mellanox.com>
|
||||||
|
*
|
||||||
|
* Redistribution and use in source and binary forms, with or without
|
||||||
|
* modification, are permitted provided that the following conditions are met:
|
||||||
|
*
|
||||||
|
* 1. Redistributions of source code must retain the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer.
|
||||||
|
* 2. Redistributions in binary form must reproduce the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer in the
|
||||||
|
* documentation and/or other materials provided with the distribution.
|
||||||
|
* 3. Neither the names of the copyright holders nor the names of its
|
||||||
|
* contributors may be used to endorse or promote products derived from
|
||||||
|
* this software without specific prior written permission.
|
||||||
|
*
|
||||||
|
* Alternatively, this software may be distributed under the terms of the
|
||||||
|
* GNU General Public License ("GPL") version 2 as published by the Free
|
||||||
|
* Software Foundation.
|
||||||
|
*
|
||||||
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
|
||||||
|
* AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
||||||
|
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
||||||
|
* ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
|
||||||
|
* LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
||||||
|
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
||||||
|
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
|
||||||
|
* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
||||||
|
* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
|
||||||
|
* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
||||||
|
* POSSIBILITY OF SUCH DAMAGE.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef __LINUX_PLATFORM_DATA_MLXCPLD_HOTPLUG_H
|
||||||
|
#define __LINUX_PLATFORM_DATA_MLXCPLD_HOTPLUG_H
|
||||||
|
|
||||||
|
/**
|
||||||
|
* struct mlxcpld_hotplug_device - I2C device data:
|
||||||
|
* @adapter: I2C device adapter;
|
||||||
|
* @client: I2C device client;
|
||||||
|
* @brdinfo: device board information;
|
||||||
|
* @bus: I2C bus, where device is attached;
|
||||||
|
*
|
||||||
|
* Structure represents I2C hotplug device static data (board topology) and
|
||||||
|
* dynamic data (related kernel objects handles).
|
||||||
|
*/
|
||||||
|
struct mlxcpld_hotplug_device {
|
||||||
|
struct i2c_adapter *adapter;
|
||||||
|
struct i2c_client *client;
|
||||||
|
struct i2c_board_info brdinfo;
|
||||||
|
u16 bus;
|
||||||
|
};
|
||||||
|
|
||||||
|
/**
|
||||||
|
* struct mlxcpld_hotplug_platform_data - device platform data:
|
||||||
|
* @top_aggr_offset: offset of top aggregation interrupt register;
|
||||||
|
* @top_aggr_mask: top aggregation interrupt common mask;
|
||||||
|
* @top_aggr_psu_mask: top aggregation interrupt PSU mask;
|
||||||
|
* @psu_reg_offset: offset of PSU interrupt register;
|
||||||
|
* @psu_mask: PSU interrupt mask;
|
||||||
|
* @psu_count: number of equipped replaceable PSUs;
|
||||||
|
* @psu: pointer to PSU devices data array;
|
||||||
|
* @top_aggr_pwr_mask: top aggregation interrupt power mask;
|
||||||
|
* @pwr_reg_offset: offset of power interrupt register
|
||||||
|
* @pwr_mask: power interrupt mask;
|
||||||
|
* @pwr_count: number of power sources;
|
||||||
|
* @pwr: pointer to power devices data array;
|
||||||
|
* @top_aggr_fan_mask: top aggregation interrupt FAN mask;
|
||||||
|
* @fan_reg_offset: offset of FAN interrupt register;
|
||||||
|
* @fan_mask: FAN interrupt mask;
|
||||||
|
* @fan_count: number of equipped replaceable FANs;
|
||||||
|
* @fan: pointer to FAN devices data array;
|
||||||
|
*
|
||||||
|
* Structure represents board platform data, related to system hotplug events,
|
||||||
|
* like FAN, PSU, power cable insertion and removing. This data provides the
|
||||||
|
* number of hot-pluggable devices and hardware description for event handling.
|
||||||
|
*/
|
||||||
|
struct mlxcpld_hotplug_platform_data {
|
||||||
|
u16 top_aggr_offset;
|
||||||
|
u8 top_aggr_mask;
|
||||||
|
u8 top_aggr_psu_mask;
|
||||||
|
u16 psu_reg_offset;
|
||||||
|
u8 psu_mask;
|
||||||
|
u8 psu_count;
|
||||||
|
struct mlxcpld_hotplug_device *psu;
|
||||||
|
u8 top_aggr_pwr_mask;
|
||||||
|
u16 pwr_reg_offset;
|
||||||
|
u8 pwr_mask;
|
||||||
|
u8 pwr_count;
|
||||||
|
struct mlxcpld_hotplug_device *pwr;
|
||||||
|
u8 top_aggr_fan_mask;
|
||||||
|
u16 fan_reg_offset;
|
||||||
|
u8 fan_mask;
|
||||||
|
u8 fan_count;
|
||||||
|
struct mlxcpld_hotplug_device *fan;
|
||||||
|
};
|
||||||
|
|
||||||
|
#endif /* __LINUX_PLATFORM_DATA_MLXCPLD_HOTPLUG_H */
|
Loading…
Reference in New Issue
Block a user