mirror of
https://github.com/AuxXxilium/linux_dsm_epyc7002.git
synced 2024-12-05 19:26:40 +07:00
81902d5f65
A platform_driver does not need to set an owner, it will be populated by the driver core. Signed-off-by: Wolfram Sang <wsa@the-dreams.de>
217 lines
5.3 KiB
C
217 lines
5.3 KiB
C
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
|
|
|
|
#include <linux/module.h>
|
|
|
|
#include <linux/platform_device.h>
|
|
#include <linux/err.h>
|
|
#include <linux/leds.h>
|
|
|
|
#include <linux/io.h>
|
|
#include <linux/dmi.h>
|
|
|
|
#include <linux/i8042.h>
|
|
|
|
#define CLEVO_MAIL_LED_OFF 0x0084
|
|
#define CLEVO_MAIL_LED_BLINK_1HZ 0x008A
|
|
#define CLEVO_MAIL_LED_BLINK_0_5HZ 0x0083
|
|
|
|
MODULE_AUTHOR("Márton Németh <nm127@freemail.hu>");
|
|
MODULE_DESCRIPTION("Clevo mail LED driver");
|
|
MODULE_LICENSE("GPL");
|
|
|
|
static bool nodetect;
|
|
module_param_named(nodetect, nodetect, bool, 0);
|
|
MODULE_PARM_DESC(nodetect, "Skip DMI hardware detection");
|
|
|
|
static struct platform_device *pdev;
|
|
|
|
static int __init clevo_mail_led_dmi_callback(const struct dmi_system_id *id)
|
|
{
|
|
pr_info("'%s' found\n", id->ident);
|
|
return 1;
|
|
}
|
|
|
|
/*
|
|
* struct clevo_mail_led_dmi_table - List of known good models
|
|
*
|
|
* Contains the known good models this driver is compatible with.
|
|
* When adding a new model try to be as strict as possible. This
|
|
* makes it possible to keep the false positives (the model is
|
|
* detected as working, but in reality it is not) as low as
|
|
* possible.
|
|
*/
|
|
static struct dmi_system_id clevo_mail_led_dmi_table[] __initdata = {
|
|
{
|
|
.callback = clevo_mail_led_dmi_callback,
|
|
.ident = "Clevo D410J",
|
|
.matches = {
|
|
DMI_MATCH(DMI_SYS_VENDOR, "VIA"),
|
|
DMI_MATCH(DMI_PRODUCT_NAME, "K8N800"),
|
|
DMI_MATCH(DMI_PRODUCT_VERSION, "VT8204B")
|
|
}
|
|
},
|
|
{
|
|
.callback = clevo_mail_led_dmi_callback,
|
|
.ident = "Clevo M5x0N",
|
|
.matches = {
|
|
DMI_MATCH(DMI_SYS_VENDOR, "CLEVO Co."),
|
|
DMI_MATCH(DMI_PRODUCT_NAME, "M5x0N")
|
|
}
|
|
},
|
|
{
|
|
.callback = clevo_mail_led_dmi_callback,
|
|
.ident = "Clevo M5x0V",
|
|
.matches = {
|
|
DMI_MATCH(DMI_BOARD_VENDOR, "CLEVO Co. "),
|
|
DMI_MATCH(DMI_BOARD_NAME, "M5X0V "),
|
|
DMI_MATCH(DMI_PRODUCT_VERSION, "VT6198")
|
|
}
|
|
},
|
|
{
|
|
.callback = clevo_mail_led_dmi_callback,
|
|
.ident = "Clevo D400P",
|
|
.matches = {
|
|
DMI_MATCH(DMI_BOARD_VENDOR, "Clevo"),
|
|
DMI_MATCH(DMI_BOARD_NAME, "D400P"),
|
|
DMI_MATCH(DMI_BOARD_VERSION, "Rev.A"),
|
|
DMI_MATCH(DMI_PRODUCT_VERSION, "0106")
|
|
}
|
|
},
|
|
{
|
|
.callback = clevo_mail_led_dmi_callback,
|
|
.ident = "Clevo D410V",
|
|
.matches = {
|
|
DMI_MATCH(DMI_BOARD_VENDOR, "Clevo, Co."),
|
|
DMI_MATCH(DMI_BOARD_NAME, "D400V/D470V"),
|
|
DMI_MATCH(DMI_BOARD_VERSION, "SS78B"),
|
|
DMI_MATCH(DMI_PRODUCT_VERSION, "Rev. A1")
|
|
}
|
|
},
|
|
{ }
|
|
};
|
|
MODULE_DEVICE_TABLE(dmi, clevo_mail_led_dmi_table);
|
|
|
|
static void clevo_mail_led_set(struct led_classdev *led_cdev,
|
|
enum led_brightness value)
|
|
{
|
|
i8042_lock_chip();
|
|
|
|
if (value == LED_OFF)
|
|
i8042_command(NULL, CLEVO_MAIL_LED_OFF);
|
|
else if (value <= LED_HALF)
|
|
i8042_command(NULL, CLEVO_MAIL_LED_BLINK_0_5HZ);
|
|
else
|
|
i8042_command(NULL, CLEVO_MAIL_LED_BLINK_1HZ);
|
|
|
|
i8042_unlock_chip();
|
|
|
|
}
|
|
|
|
static int clevo_mail_led_blink(struct led_classdev *led_cdev,
|
|
unsigned long *delay_on,
|
|
unsigned long *delay_off)
|
|
{
|
|
int status = -EINVAL;
|
|
|
|
i8042_lock_chip();
|
|
|
|
if (*delay_on == 0 /* ms */ && *delay_off == 0 /* ms */) {
|
|
/* Special case: the leds subsystem requested us to
|
|
* chose one user friendly blinking of the LED, and
|
|
* start it. Let's blink the led slowly (0.5Hz).
|
|
*/
|
|
*delay_on = 1000; /* ms */
|
|
*delay_off = 1000; /* ms */
|
|
i8042_command(NULL, CLEVO_MAIL_LED_BLINK_0_5HZ);
|
|
status = 0;
|
|
|
|
} else if (*delay_on == 500 /* ms */ && *delay_off == 500 /* ms */) {
|
|
/* blink the led with 1Hz */
|
|
i8042_command(NULL, CLEVO_MAIL_LED_BLINK_1HZ);
|
|
status = 0;
|
|
|
|
} else if (*delay_on == 1000 /* ms */ && *delay_off == 1000 /* ms */) {
|
|
/* blink the led with 0.5Hz */
|
|
i8042_command(NULL, CLEVO_MAIL_LED_BLINK_0_5HZ);
|
|
status = 0;
|
|
|
|
} else {
|
|
pr_debug("clevo_mail_led_blink(..., %lu, %lu),"
|
|
" returning -EINVAL (unsupported)\n",
|
|
*delay_on, *delay_off);
|
|
}
|
|
|
|
i8042_unlock_chip();
|
|
|
|
return status;
|
|
}
|
|
|
|
static struct led_classdev clevo_mail_led = {
|
|
.name = "clevo::mail",
|
|
.brightness_set = clevo_mail_led_set,
|
|
.blink_set = clevo_mail_led_blink,
|
|
.flags = LED_CORE_SUSPENDRESUME,
|
|
};
|
|
|
|
static int __init clevo_mail_led_probe(struct platform_device *pdev)
|
|
{
|
|
return led_classdev_register(&pdev->dev, &clevo_mail_led);
|
|
}
|
|
|
|
static int clevo_mail_led_remove(struct platform_device *pdev)
|
|
{
|
|
led_classdev_unregister(&clevo_mail_led);
|
|
return 0;
|
|
}
|
|
|
|
static struct platform_driver clevo_mail_led_driver = {
|
|
.remove = clevo_mail_led_remove,
|
|
.driver = {
|
|
.name = KBUILD_MODNAME,
|
|
},
|
|
};
|
|
|
|
static int __init clevo_mail_led_init(void)
|
|
{
|
|
int error = 0;
|
|
int count = 0;
|
|
|
|
/* Check with the help of DMI if we are running on supported hardware */
|
|
if (!nodetect) {
|
|
count = dmi_check_system(clevo_mail_led_dmi_table);
|
|
} else {
|
|
count = 1;
|
|
pr_err("Skipping DMI detection. "
|
|
"If the driver works on your hardware please "
|
|
"report model and the output of dmidecode in tracker "
|
|
"at http://sourceforge.net/projects/clevo-mailled/\n");
|
|
}
|
|
|
|
if (!count)
|
|
return -ENODEV;
|
|
|
|
pdev = platform_device_register_simple(KBUILD_MODNAME, -1, NULL, 0);
|
|
if (!IS_ERR(pdev)) {
|
|
error = platform_driver_probe(&clevo_mail_led_driver,
|
|
clevo_mail_led_probe);
|
|
if (error) {
|
|
pr_err("Can't probe platform driver\n");
|
|
platform_device_unregister(pdev);
|
|
}
|
|
} else
|
|
error = PTR_ERR(pdev);
|
|
|
|
return error;
|
|
}
|
|
|
|
static void __exit clevo_mail_led_exit(void)
|
|
{
|
|
platform_device_unregister(pdev);
|
|
platform_driver_unregister(&clevo_mail_led_driver);
|
|
|
|
clevo_mail_led_set(NULL, LED_OFF);
|
|
}
|
|
|
|
module_init(clevo_mail_led_init);
|
|
module_exit(clevo_mail_led_exit);
|