linux-mips
[Top] [All Lists]

[PATCH v5 5/8] Loongson: YeeLoong: add hwmon driver

To: Ralf Baechle <ralf@linux-mips.org>
Subject: [PATCH v5 5/8] Loongson: YeeLoong: add hwmon driver
From: Wu Zhangjin <wuzhangjin@gmail.com>
Date: Sat, 28 Nov 2009 21:38:33 +0800
Cc: Dmitry Torokhov <dmitry.torokhov@gmail.com>, linux-mips@linux-mips.org, zhangfx@lemote.com, yanh@lemote.com, huhb@lemote.com, lm-sensors@lm-sensors.org, Wu Zhangjin <wuzhangjin@gmail.com>
Dkim-signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=gamma; h=domainkey-signature:received:received:from:to:cc:subject:date :message-id:x-mailer:in-reply-to:references; bh=vxxqdsG1viCulwYhCiii2Gn/jSaJOZbcm7aW5eFZIws=; b=ecGiYxnR563GsnCmKCJ/ce59TrlCR9fhBbtqhfcfhLOVnu2mUkmQYQrak8ad/zSe/Z 65Yy6X3J1fNSYXd5OJ7j7tc+8tHVMQP4elV9CzwDvmr84AtgNhE9fETBeyhIQYqAM0gC KI5Tg+UlG4ReDheuz1yHYENVSDhiT5H3iqu+A=
Domainkey-signature: a=rsa-sha1; c=nofws; d=gmail.com; s=gamma; h=from:to:cc:subject:date:message-id:x-mailer:in-reply-to:references; b=CnDhzNNo9+w3Egy1CgM72tk/Id+YyW84a3HwwDIuDiZNneQD8qYJvmnU9LG3uEaHG8 hZpGij28NQvuiEJbe8vblYRI06eAOcOKH5bhueUvQ9p0Gg7lktNcGElEZbgmZZOQ9Fx/ A3Ya2+ZzQTImXGiUGzPAYnGfhga1UgpiEzPwY=
In-reply-to: <cover.1259414649.git.wuzhangjin@gmail.com>
Original-recipient: rfc822;linux-mips@linux-mips.org
References: <cover.1259414649.git.wuzhangjin@gmail.com>
Sender: linux-mips-bounce@linux-mips.org
From: Wu Zhangjin <wuzhangjin@gmail.com>

This patch adds hwmon driver for managing the temperature of battery,
cpu and controlling the fan.

Signed-off-by: Wu Zhangjin <wuzhangjin@gmail.com>
---
 .../loongson/lemote-2f/yeeloong_laptop/Kconfig     |    9 +
 .../loongson/lemote-2f/yeeloong_laptop/Makefile    |    1 +
 .../lemote-2f/yeeloong_laptop/ec_kb3310b.h         |    3 +
 .../loongson/lemote-2f/yeeloong_laptop/hwmon.c     |  241 ++++++++++++++++++++
 4 files changed, 254 insertions(+), 0 deletions(-)
 create mode 100644 arch/mips/loongson/lemote-2f/yeeloong_laptop/hwmon.c

diff --git a/arch/mips/loongson/lemote-2f/yeeloong_laptop/Kconfig 
b/arch/mips/loongson/lemote-2f/yeeloong_laptop/Kconfig
index e284c91..56cb584 100644
--- a/arch/mips/loongson/lemote-2f/yeeloong_laptop/Kconfig
+++ b/arch/mips/loongson/lemote-2f/yeeloong_laptop/Kconfig
@@ -28,4 +28,13 @@ config YEELOONG_BATTERY
          This option adds APM emulated Battery Driver, which provides standard
          interface for user-space applications to manage the battery.
 
+config YEELOONG_HWMON
+       tristate "Hardware Monitor Driver"
+       select HWMON
+       default y
+       help
+         This option adds hardware monitor driver, which provides standard
+         interface for lm-sensors to monitor the temperatures of CPU and
+         battery, the PWM of fan, the current, voltage of battery.
+
 endif
diff --git a/arch/mips/loongson/lemote-2f/yeeloong_laptop/Makefile 
b/arch/mips/loongson/lemote-2f/yeeloong_laptop/Makefile
index 20fe0c6..73277a8 100644
--- a/arch/mips/loongson/lemote-2f/yeeloong_laptop/Makefile
+++ b/arch/mips/loongson/lemote-2f/yeeloong_laptop/Makefile
@@ -4,3 +4,4 @@ obj-y += ec_kb3310b.o
 
 obj-$(CONFIG_YEELOONG_BACKLIGHT) += backlight.o
 obj-$(CONFIG_YEELOONG_BATTERY) += battery.o
+obj-$(CONFIG_YEELOONG_HWMON) += hwmon.o
diff --git a/arch/mips/loongson/lemote-2f/yeeloong_laptop/ec_kb3310b.h 
b/arch/mips/loongson/lemote-2f/yeeloong_laptop/ec_kb3310b.h
index 0e3b5ad..674a543 100644
--- a/arch/mips/loongson/lemote-2f/yeeloong_laptop/ec_kb3310b.h
+++ b/arch/mips/loongson/lemote-2f/yeeloong_laptop/ec_kb3310b.h
@@ -22,6 +22,9 @@ extern int ec_get_event_num(void);
 typedef int (*sci_handler) (int status);
 extern sci_handler yeeloong_report_lid_status;
 
+extern void set_fan_pwm(int value);
+extern void set_fan_pwm_enable(int manual);
+
 #define SCI_IRQ_NUM 0x0A
 #define MAX_BRIGHTNESS 8
 
diff --git a/arch/mips/loongson/lemote-2f/yeeloong_laptop/hwmon.c 
b/arch/mips/loongson/lemote-2f/yeeloong_laptop/hwmon.c
new file mode 100644
index 0000000..22c5f1d
--- /dev/null
+++ b/arch/mips/loongson/lemote-2f/yeeloong_laptop/hwmon.c
@@ -0,0 +1,241 @@
+/*
+ * YeeLoong Hwmon Driver
+ *
+ *  Copyright (C) 2009 Lemote Inc.
+ *  Author: Wu Zhangjin <wuzj@lemote.com>
+ *
+ *  This program is free software; you can redistribute it and/or modify
+ *  it under the terms of the GNU General Public License version 2 as
+ *  published by the Free Software Foundation.
+ */
+#include <linux/err.h>
+#include <linux/hwmon.h>
+#include <linux/hwmon-sysfs.h>
+
+#include <asm/bootinfo.h>
+
+#include "ec_kb3310b.h"
+
+MODULE_AUTHOR("Wu Zhangjin <wuzj@lemote.com>");
+MODULE_DESCRIPTION("YeeLoong laptop hwmon driver");
+MODULE_LICENSE("GPL");
+
+/* pwm(auto/manual) enable or not */
+static int get_fan_pwm_enable(void)
+{
+       return ec_read(REG_FAN_AUTO_MAN_SWITCH);
+}
+
+void set_fan_pwm_enable(int manual)
+{
+       ec_write(REG_FAN_AUTO_MAN_SWITCH, !!manual);
+}
+EXPORT_SYMBOL(set_fan_pwm_enable);
+
+static int get_fan_pwm(void)
+{
+       return ec_read(REG_FAN_SPEED_LEVEL);
+}
+
+void set_fan_pwm(int value)
+{
+       int status;
+
+       value = SENSORS_LIMIT(value, 0, 3);
+
+       /* If value is not ZERO, We should ensure it is on */
+       if (value != 0) {
+               status = ec_read(REG_FAN_STATUS);
+               if (status == 0)
+                       ec_write(REG_FAN_CONTROL, BIT_FAN_CONTROL_ON);
+       }
+       ec_write(REG_FAN_SPEED_LEVEL, value);
+}
+EXPORT_SYMBOL(set_fan_pwm);
+
+static int get_fan_rpm(void)
+{
+       int value = 0;
+
+       value = FAN_SPEED_DIVIDER /
+           (((ec_read(REG_FAN_SPEED_HIGH) & 0x0f) << 8) |
+            ec_read(REG_FAN_SPEED_LOW));
+
+       return value;
+}
+
+static int get_cpu_temp(void)
+{
+       int value;
+
+       value = ec_read(REG_TEMPERATURE_VALUE);
+
+       if (value & (1 << 7))
+               value = (value & 0x7f) - 128;
+       else
+               value = value & 0xff;
+
+       return value * 1000;
+}
+
+static int get_battery_temp(void)
+{
+       int value;
+
+       value = (ec_read(REG_BAT_TEMPERATURE_HIGH) << 8) |
+               (ec_read(REG_BAT_TEMPERATURE_LOW));
+
+       return value * 1000;
+}
+
+static int get_battery_temp_alarm(void)
+{
+       int status;
+
+       status = (ec_read(REG_BAT_CHARGE_STATUS) &
+                       BIT_BAT_CHARGE_STATUS_OVERTEMP);
+
+       return !!status;
+}
+
+static int get_battery_current(void)
+{
+       int value;
+
+       value = (ec_read(REG_BAT_CURRENT_HIGH) << 8) |
+               (ec_read(REG_BAT_CURRENT_LOW));
+
+       if (value & 0x8000)
+               value = 0xffff - value;
+
+       return value;
+}
+
+static int get_battery_voltage(void)
+{
+       int value;
+
+       value = (ec_read(REG_BAT_VOLTAGE_HIGH) << 8) |
+               (ec_read(REG_BAT_VOLTAGE_LOW));
+
+       return value;
+}
+
+
+static int parse_arg(const char *buf, unsigned long count, int *val)
+{
+       if (!count)
+               return 0;
+       if (sscanf(buf, "%i", val) != 1)
+               return -EINVAL;
+       return count;
+}
+
+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 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);
+
+CREATE_SENSOR_ATTR(fan1_input, S_IRUGO, get_fan_rpm, NULL);
+CREATE_SENSOR_ATTR(pwm1, S_IRUGO | S_IWUSR, get_fan_pwm, set_fan_pwm);
+CREATE_SENSOR_ATTR(pwm1_enable, S_IRUGO | S_IWUSR, get_fan_pwm_enable,
+               set_fan_pwm_enable);
+CREATE_SENSOR_ATTR(temp1_input, S_IRUGO, get_cpu_temp, NULL);
+CREATE_SENSOR_ATTR(temp2_input, S_IRUGO, get_battery_temp, NULL);
+CREATE_SENSOR_ATTR(temp2_max_alarm, S_IRUGO, get_battery_temp_alarm, NULL);
+CREATE_SENSOR_ATTR(curr1_input, S_IRUGO, get_battery_current, NULL);
+CREATE_SENSOR_ATTR(in1_input, S_IRUGO, get_battery_voltage, NULL);
+
+static ssize_t
+show_name(struct device *dev, struct device_attribute *attr, char *buf)
+{
+       return sprintf(buf, "yeeloong\n");
+}
+
+static SENSOR_DEVICE_ATTR(name, S_IRUGO, show_name, NULL, 0);
+
+static struct attribute *hwmon_attributes[] = {
+       &sensor_dev_attr_pwm1.dev_attr.attr,
+       &sensor_dev_attr_pwm1_enable.dev_attr.attr,
+       &sensor_dev_attr_fan1_input.dev_attr.attr,
+       &sensor_dev_attr_temp1_input.dev_attr.attr,
+       &sensor_dev_attr_temp2_input.dev_attr.attr,
+       &sensor_dev_attr_temp2_max_alarm.dev_attr.attr,
+       &sensor_dev_attr_curr1_input.dev_attr.attr,
+       &sensor_dev_attr_in1_input.dev_attr.attr,
+       &sensor_dev_attr_name.dev_attr.attr,
+       NULL
+};
+
+static struct attribute_group hwmon_attribute_group = {
+       .attrs = hwmon_attributes
+};
+
+struct device *yeeloong_hwmon_dev;
+
+static int __init yeeloong_hwmon_init(void)
+{
+       int ret;
+
+       if (mips_machtype != MACH_LEMOTE_YL2F89) {
+               pr_err("This Driver is only for YeeLoong laptop\n");
+               return -EFAULT;
+       }
+
+       yeeloong_hwmon_dev = hwmon_device_register(NULL);
+       if (IS_ERR(yeeloong_hwmon_dev)) {
+               pr_err("Fail to register yeeloong hwmon device\n");
+               yeeloong_hwmon_dev = NULL;
+               return PTR_ERR(yeeloong_hwmon_dev);
+       }
+       ret = sysfs_create_group(&yeeloong_hwmon_dev->kobj,
+                                &hwmon_attribute_group);
+       if (ret) {
+               sysfs_remove_group(&yeeloong_hwmon_dev->kobj,
+                                  &hwmon_attribute_group);
+               hwmon_device_unregister(yeeloong_hwmon_dev);
+               yeeloong_hwmon_dev = NULL;
+       }
+       /* ensure fan is set to auto mode */
+       set_fan_pwm_enable(BIT_FAN_AUTO);
+
+       return 0;
+}
+
+static void __exit yeeloong_hwmon_exit(void)
+{
+       if (yeeloong_hwmon_dev) {
+               sysfs_remove_group(&yeeloong_hwmon_dev->kobj,
+                                  &hwmon_attribute_group);
+               hwmon_device_unregister(yeeloong_hwmon_dev);
+               yeeloong_hwmon_dev = NULL;
+       }
+}
+
+module_init(yeeloong_hwmon_init);
+module_exit(yeeloong_hwmon_exit);
-- 
1.6.2.1


<Prev in Thread] Current Thread [Next in Thread>