eeepc-laptop: add hwmon fan control

Adds an hwmon interface to control the fan.

Signed-off-by: Corentin Chary <corentincj@iksaif.net>
Signed-off-by: Len Brown <len.brown@intel.com>
This commit is contained in:
Corentin Chary 2008-03-13 12:57:18 +01:00 committed by Len Brown
parent a5fa429b4b
commit e1faa9da28
2 changed files with 148 additions and 0 deletions

View File

@ -356,6 +356,7 @@ config EEEPC_LAPTOP
depends on X86
depends on ACPI
depends on BACKLIGHT_CLASS_DEVICE
depends on HWMON
depends on EXPERIMENTAL
---help---
This driver supports the Fn-Fx keys on Eee PC laptops.

View File

@ -23,6 +23,8 @@
#include <linux/platform_device.h>
#include <linux/backlight.h>
#include <linux/fb.h>
#include <linux/hwmon.h>
#include <linux/hwmon-sysfs.h>
#include <acpi/acpi_drivers.h>
#include <acpi/acpi_bus.h>
#include <linux/uaccess.h>
@ -103,6 +105,15 @@ const char *cm_setv[] = {
"CRDS", NULL
};
#define EEEPC_EC "\\_SB.PCI0.SBRG.EC0."
#define EEEPC_EC_FAN_PWM EEEPC_EC "SC02" /* Fan PWM duty cycle (%) */
#define EEEPC_EC_SC02 0x63
#define EEEPC_EC_FAN_HRPM EEEPC_EC "SC05" /* High byte, fan speed (RPM) */
#define EEEPC_EC_FAN_LRPM EEEPC_EC "SC06" /* Low byte, fan speed (RPM) */
#define EEEPC_EC_FAN_CTRL EEEPC_EC "SFB3" /* Byte containing SF25 */
#define EEEPC_EC_SFB3 0xD3
/*
* This is the main structure, we can use it to store useful information
* about the hotk device
@ -154,6 +165,9 @@ static struct acpi_driver eeepc_hotk_driver = {
/* The backlight device /sys/class/backlight */
static struct backlight_device *eeepc_backlight_device;
/* The hwmon device */
static struct device *eeepc_hwmon_device;
/*
* The backlight class declaration
*/
@ -428,6 +442,100 @@ static int eeepc_hotk_remove(struct acpi_device *device, int type)
return 0;
}
/*
* Hwmon
*/
static int eeepc_get_fan_pwm(void)
{
int value = 0;
read_acpi_int(NULL, EEEPC_EC_FAN_PWM, &value);
return (value);
}
static void eeepc_set_fan_pwm(int value)
{
value = SENSORS_LIMIT(value, 0, 100);
ec_write(EEEPC_EC_SC02, value);
}
static int eeepc_get_fan_rpm(void)
{
int high = 0;
int low = 0;
read_acpi_int(NULL, EEEPC_EC_FAN_HRPM, &high);
read_acpi_int(NULL, EEEPC_EC_FAN_LRPM, &low);
return (high << 8 | low);
}
static int eeepc_get_fan_ctrl(void)
{
int value = 0;
read_acpi_int(NULL, EEEPC_EC_FAN_CTRL, &value);
return ((value & 0x02 ? 1 : 0));
}
static void eeepc_set_fan_ctrl(int manual)
{
int value = 0;
read_acpi_int(NULL, EEEPC_EC_FAN_CTRL, &value);
if (manual)
value |= 0x02;
else
value &= ~0x02;
ec_write(EEEPC_EC_SFB3, value);
}
static ssize_t store_sys_hwmon(void (*set)(int), const char *buf, size_t count)
{
int rv, value;
rv = parse_arg(buf, count, &value);
if (rv > 0)
set(value);
return rv;
}
static ssize_t show_sys_hwmon(int (*get)(void), char *buf)
{
return sprintf(buf, "%d\n", get());
}
#define EEEPC_CREATE_SENSOR_ATTR(_name, _mode, _set, _get) \
static ssize_t show_##_name(struct device *dev, \
struct device_attribute *attr, \
char *buf) \
{ \
return show_sys_hwmon(_set, buf); \
} \
static ssize_t store_##_name(struct device *dev, \
struct device_attribute *attr, \
const char *buf, size_t count) \
{ \
return store_sys_hwmon(_get, buf, count); \
} \
static SENSOR_DEVICE_ATTR(_name, _mode, show_##_name, store_##_name, 0);
EEEPC_CREATE_SENSOR_ATTR(fan1_input, S_IRUGO, eeepc_get_fan_rpm, NULL);
EEEPC_CREATE_SENSOR_ATTR(fan1_pwm, S_IRUGO | S_IWUSR,
eeepc_get_fan_pwm, eeepc_set_fan_pwm);
EEEPC_CREATE_SENSOR_ATTR(pwm1_enable, S_IRUGO | S_IWUSR,
eeepc_get_fan_ctrl, eeepc_set_fan_ctrl);
static struct attribute *hwmon_attributes[] = {
&sensor_dev_attr_fan1_pwm.dev_attr.attr,
&sensor_dev_attr_fan1_input.dev_attr.attr,
&sensor_dev_attr_pwm1_enable.dev_attr.attr,
NULL
};
static struct attribute_group hwmon_attribute_group = {
.attrs = hwmon_attributes
};
/*
* exit/init
*/
@ -438,9 +546,23 @@ static void eeepc_backlight_exit(void)
eeepc_backlight_device = NULL;
}
static void eeepc_hwmon_exit(void)
{
struct device *hwmon;
hwmon = eeepc_hwmon_device;
if (!hwmon)
return ;
hwmon_device_unregister(hwmon);
sysfs_remove_group(&hwmon->kobj,
&hwmon_attribute_group);
eeepc_hwmon_device = NULL;
}
static void __exit eeepc_laptop_exit(void)
{
eeepc_backlight_exit();
eeepc_hwmon_exit();
acpi_bus_unregister_driver(&eeepc_hotk_driver);
sysfs_remove_group(&platform_device->dev.kobj,
&platform_attribute_group);
@ -468,6 +590,26 @@ static int eeepc_backlight_init(struct device *dev)
return 0;
}
static int eeepc_hwmon_init(struct device *dev)
{
struct device *hwmon;
int result;
hwmon = hwmon_device_register(dev);
if (IS_ERR(hwmon)) {
printk(EEEPC_ERR
"Could not register eeepc hwmon device\n");
eeepc_hwmon_device = NULL;
return PTR_ERR(hwmon);
}
eeepc_hwmon_device = hwmon;
result = sysfs_create_group(&hwmon->kobj,
&hwmon_attribute_group);
if (result)
eeepc_hwmon_exit();
return result;
}
static int __init eeepc_laptop_init(void)
{
struct device *dev;
@ -486,6 +628,9 @@ static int __init eeepc_laptop_init(void)
result = eeepc_backlight_init(dev);
if (result)
goto fail_backlight;
result = eeepc_hwmon_init(dev);
if (result)
goto fail_hwmon;
/* Register platform stuff */
result = platform_driver_register(&platform_driver);
if (result)
@ -510,6 +655,8 @@ static int __init eeepc_laptop_init(void)
fail_platform_device1:
platform_driver_unregister(&platform_driver);
fail_platform_driver:
eeepc_hwmon_exit();
fail_hwmon:
eeepc_backlight_exit();
fail_backlight:
return result;