Message-Id: <1322925779-15556-2-git-send-email-paul.liu@linaro.org>
Date:	Sat,  3 Dec 2011 23:22:59 +0800
From:	"Ying-Chun Liu (PaulLiu)" <paul.liu@...aro.org>
To:	linaro-dev@...ts.linaro.org, linux-kernel@...r.kernel.org
Cc:	"Ying-Chun Liu (PaulLiu)" <paul.liu@...aro.org>,
	Anson Huang <b20788@...escale.com>
Subject: [PATCH] thermal: Add anatop thermal driver

From: "Ying-Chun Liu (PaulLiu)" <paul.liu@...aro.org>

Anatop thermal driver for Freescale imx6 system. This driver currently
supports basic temperature reading.

Signed-off-by: Anson Huang <b20788@...escale.com>
Signed-off-by: Ying-Chun Liu (PaulLiu) <paul.liu@...aro.org>
---
 drivers/thermal/Kconfig          |   11 +
 drivers/thermal/Makefile         |    1 +
 drivers/thermal/anatop_driver.h  |  146 +++++++
 drivers/thermal/anatop_thermal.c |  825 ++++++++++++++++++++++++++++++++++++++
 4 files changed, 983 insertions(+), 0 deletions(-)
 create mode 100644 drivers/thermal/anatop_driver.h
 create mode 100644 drivers/thermal/anatop_thermal.c

diff --git a/drivers/thermal/Kconfig b/drivers/thermal/Kconfig
index f7f71b2..792152e 100644
--- a/drivers/thermal/Kconfig
+++ b/drivers/thermal/Kconfig
@@ -18,3 +18,14 @@ config THERMAL_HWMON
 	depends on THERMAL
 	depends on HWMON=y || HWMON=THERMAL
 	default y
+
+config THERMAL_ANATOP
+	tristate "Anatop Thermal Zone"
+	depends on THERMAL
+	default y
+	help
+	  This driver supports ANATOP thermal zones. It is HIGHLY
+	  recommended that this option be enabled on MX6 platform, as
+	  your processor(s) may be damaged without it.
+
+	  To compile this driver as a module, choose M here.
diff --git a/drivers/thermal/Makefile b/drivers/thermal/Makefile
index 31108a0..2f88011 100644
--- a/drivers/thermal/Makefile
+++ b/drivers/thermal/Makefile
@@ -3,3 +3,4 @@
 #
 
 obj-$(CONFIG_THERMAL)		+= thermal_sys.o
+obj-$(CONFIG_THERMAL_ANATOP)	+= anatop_thermal.o
diff --git a/drivers/thermal/anatop_driver.h b/drivers/thermal/anatop_driver.h
new file mode 100644
index 0000000..5879fca
--- /dev/null
+++ b/drivers/thermal/anatop_driver.h
@@ -0,0 +1,146 @@
+/*
+ *  anatop_drivers.h
+ *
+ *  Copyright (C) 2001, 2002 Andy Grover <andrew.grover@...el.com>
+ *  Copyright (C) 2001, 2002 Paul Diefenbaugh <paul.s.diefenbaugh@...el.com>
+ *
+ *  Copyright (C) 2011 Freescale Semiconductor, Inc.
+ * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
+ *
+ *  This program is free software; you can redistribute it and/or modify
+ *  it under the terms of the GNU General Public License as published by
+ *  the Free Software Foundation; either version 2 of the License, or (at
+ *  your option) any later version.
+ *
+ *  This program is distributed in the hope that it will be useful, but
+ *  WITHOUT ANY WARRANTY; without even the implied warranty of
+ *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
+ *  General Public License for more details.
+ *
+ *  You should have received a copy of the GNU General Public License along
+ *  with this program; if not, write to the Free Software Foundation, Inc.,
+ *  59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
+ *
+ * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
+ */
+
+#ifndef __ANATOP_DRIVERS_H__
+#define __ANATOP_DRIVERS_H__
+
+/* Device */
+#define ANATOP_ACPI_MAX_HANDLES	10
+struct anatop_handle_list {
+	u32 count;
+	acpi_namespace_node * handles[ANATOP_ACPI_MAX_HANDLES];
+};
+
+struct anatop_device {
+	struct device dev;
+	acpi_namespace_node *handle;	/* no handle for fixed hardware */
+	char name[40];
+	int id;
+	void *driver_data;
+};
+struct anatop_device_id {
+	__u8 id[ACPI_ID_LEN];
+	kernel_ulong_t driver_data;
+};
+typedef int (*anatop_op_add) (struct anatop_device *device);
+typedef int (*anatop_op_remove) (struct anatop_device *device, int type);
+typedef int (*anatop_op_start) (struct anatop_device *device);
+typedef int (*anatop_op_suspend) (struct anatop_device *device,
+				pm_message_t state);
+typedef int (*anatop_op_resume) (struct anatop_device *device);
+typedef int (*anatop_op_bind) (struct anatop_device *device);
+typedef int (*anatop_op_unbind) (struct anatop_device *device);
+typedef void (*anatop_op_notify) (struct anatop_device *device, u32 event);
+
+struct anatop_ops {
+	u32 anatop_op_add:1;
+	u32 anatop_op_start:1;
+};
+
+struct anatop_device_ops {
+	anatop_op_add add;
+	anatop_op_remove remove;
+	anatop_op_start start;
+	anatop_op_suspend suspend;
+	anatop_op_resume resume;
+	anatop_op_bind bind;
+	anatop_op_unbind unbind;
+	anatop_op_notify notify;
+};
+
+struct anatop_driver {
+	char name[80];
+	char class[80];
+	const struct acpi_device_id *ids; /* Supported Hardware IDs */
+	unsigned int flags;
+	struct anatop_device_ops ops;
+	struct device_driver drv;
+	struct module *owner;
+};
+
+
+
+typedef u32 anatop_status;	/* All ANATOP Exceptions */
+
+#define AT_OK                   (anatop_status) 0x0000
+#define AT_ERROR                (anatop_status) 0x0001
+
+
+#define ANATOP_MAX_STRING			80
+
+/*
+ * Please update drivers/acpi/debug.c and Documentation/acpi/debug.txt
+ * if you add to this list.
+ */
+#define ANATOP_BUS_COMPONENT		0x00010000
+#define ANATOP_AC_COMPONENT		0x00020000
+#define ANATOP_BATTERY_COMPONENT		0x00040000
+#define ANATOP_BUTTON_COMPONENT		0x00080000
+#define ANATOP_SBS_COMPONENT		0x00100000
+#define ANATOP_FAN_COMPONENT		0x00200000
+#define ANATOP_PCI_COMPONENT		0x00400000
+#define ANATOP_POWER_COMPONENT		0x00800000
+#define ANATOP_CONTAINER_COMPONENT	0x01000000
+#define ANATOP_SYSTEM_COMPONENT		0x02000000
+#define ANATOP_THERMAL_COMPONENT		0x04000000
+#define ANATOP_MEMORY_DEVICE_COMPONENT	0x08000000
+#define ANATOP_VIDEO_COMPONENT		0x10000000
+#define ANATOP_PROCESSOR_COMPONENT	0x20000000
+
+/*
+ * _HID definitions
+ * HIDs must conform to ACPI spec(6.1.4)
+ * Linux specific HIDs do not apply to this and begin with LNX:
+ */
+
+#define ANATOP_POWER_HID			"LNXPOWER"
+#define ANATOP_PROCESSOR_OBJECT_HID	"LNXCPU"
+#define ANATOP_SYSTEM_HID			"LNXSYSTM"
+#define ANATOP_THERMAL_HID		"LNXTHERM"
+#define ANATOP_BUTTON_HID_POWERF		"LNXPWRBN"
+#define ANATOP_BUTTON_HID_SLEEPF		"LNXSLPBN"
+#define ANATOP_VIDEO_HID			"LNXVIDEO"
+#define ANATOP_BAY_HID			"LNXIOBAY"
+#define ANATOP_DOCK_HID			"LNXDOCK"
+/* Quirk for broken IBM BIOSes */
+#define ANATOP_SMBUS_IBM_HID		"SMBUSIBM"
+
+/*
+ * For fixed hardware buttons, we fabricate acpi_devices with HID
+ * ACPI_BUTTON_HID_POWERF or ACPI_BUTTON_HID_SLEEPF.  Fixed hardware
+ * signals only an event; it doesn't supply a notification value.
+ * To allow drivers to treat notifications from fixed hardware the
+ * same as those from real devices, we turn the events into this
+ * notification value.
+ */
+#define ANATOP_FIXED_HARDWARE_EVENT	0x100
+
+static inline void *anatop_driver_data(struct anatop_device *d)
+{
+	return d->driver_data;
+}
+
+#endif /*__ANATOP_DRIVERS_H__*/
diff --git a/drivers/thermal/anatop_thermal.c b/drivers/thermal/anatop_thermal.c
new file mode 100644
index 0000000..45d817a
--- /dev/null
+++ b/drivers/thermal/anatop_thermal.c
@@ -0,0 +1,825 @@
+/*
+ *  anatop_thermal.c - anatop Thermal Zone Driver
+ *
+ *  Copyright (C) 2001, 2002 Andy Grover <andrew.grover@...el.com>
+ *  Copyright (C) 2001, 2002 Paul Diefenbaugh <paul.s.diefenbaugh@...el.com>
+ *  Copyright (C) 2011 Freescale Semiconductor, Inc.
+ * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
+ *
+ *  This program is free software; you can redistribute it and/or modify
+ *  it under the terms of the GNU General Public License as published by
+ *  the Free Software Foundation; either version 2 of the License, or (at
+ *  your option) any later version.
+ *
+ *  This program is distributed in the hope that it will be useful, but
+ *  WITHOUT ANY WARRANTY; without even the implied warranty of
+ *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
+ *  General Public License for more details.
+ *
+ *  You should have received a copy of the GNU General Public License along
+ *  with this program; if not, write to the Free Software Foundation, Inc.,
+ *  59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
+ *
+ * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
+ *
+ *  This driver fully implements the anatop thermal policy as described in the
+ *  anatop 2.0 Specification.
+ *
+ *  TBD: 1. Implement passive cooling hysteresis.
+ *       2. Enhance passive cooling (CPU) states/limit interface to support
+ *          concepts of 'multiple limiters', upper/lower limits, etc.
+ *
+ */
+
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/dmi.h>
+#include <linux/init.h>
+#include <linux/slab.h>
+#include <linux/delay.h>
+#include <linux/types.h>
+#include <linux/jiffies.h>
+#include <linux/kmod.h>
+#include <linux/reboot.h>
+#include <linux/device.h>
+#include <linux/uaccess.h>
+#include <linux/thermal.h>
+#include <linux/platform_device.h>
+#include <linux/io.h>
+#include "anatop_driver.h"
+
+/* register define of anatop */
+#define HW_ANADIG_ANA_MISC0	(0x00000150)
+#define HW_ANADIG_ANA_MISC0_SET	(0x00000154)
+#define HW_ANADIG_ANA_MISC0_CLR	(0x00000158)
+#define HW_ANADIG_ANA_MISC0_TOG	(0x0000015c)
+
+#define HW_ANADIG_TEMPSENSE0	(0x00000180)
+#define HW_ANADIG_TEMPSENSE0_SET	(0x00000184)
+#define HW_ANADIG_TEMPSENSE0_CLR	(0x00000188)
+#define HW_ANADIG_TEMPSENSE0_TOG	(0x0000018c)
+
+#define HW_ANADIG_TEMPSENSE1	(0x00000190)
+#define HW_ANADIG_TEMPSENSE1_SET	(0x00000194)
+#define HW_ANADIG_TEMPSENSE1_CLR	(0x00000198)
+
+#define BM_ANADIG_ANA_MISC0_REFTOP_SELBIASOFF 0x00000008
+
+#define BP_ANADIG_TEMPSENSE0_TEMP_VALUE      8
+#define BM_ANADIG_TEMPSENSE0_TEMP_VALUE 0x000FFF00
+#define BF_ANADIG_TEMPSENSE0_TEMP_VALUE(v)  \
+	(((v) << 8) & BM_ANADIG_TEMPSENSE0_TEMP_VALUE)
+#define BM_ANADIG_TEMPSENSE0_RSVD0 0x00000080
+#define BM_ANADIG_TEMPSENSE0_TEST 0x00000040
+#define BP_ANADIG_TEMPSENSE0_VBGADJ      3
+#define BM_ANADIG_TEMPSENSE0_VBGADJ 0x00000038
+#define BF_ANADIG_TEMPSENSE0_VBGADJ(v)  \
+	(((v) << 3) & BM_ANADIG_TEMPSENSE0_VBGADJ)
+#define BM_ANADIG_TEMPSENSE0_FINISHED 0x00000004
+#define BM_ANADIG_TEMPSENSE0_MEASURE_TEMP 0x00000002
+#define BM_ANADIG_TEMPSENSE0_POWER_DOWN 0x00000001
+
+#define BP_ANADIG_TEMPSENSE1_RSVD0      16
+#define BM_ANADIG_TEMPSENSE1_RSVD0 0xFFFF0000
+#define BF_ANADIG_TEMPSENSE1_RSVD0(v) \
+	(((v) << 16) & BM_ANADIG_TEMPSENSE1_RSVD0)
+#define BP_ANADIG_TEMPSENSE1_MEASURE_FREQ      0
+#define BM_ANADIG_TEMPSENSE1_MEASURE_FREQ 0x0000FFFF
+#define BF_ANADIG_TEMPSENSE1_MEASURE_FREQ(v)  \
+	(((v) << 0) & BM_ANADIG_TEMPSENSE1_MEASURE_FREQ)
+
+
+#define PREFIX "ANATOP: "
+
+#define ANATOP_THERMAL_DRIVER_NAME	"Anatop Thermal"
+#define ANATOP_THERMAL_DEVICE_NAME	"Thermal Zone"
+#define ANATOP_THERMAL_FILE_STATE		"state"
+#define ANATOP_THERMAL_FILE_TEMPERATURE	"temperature"
+#define ANATOP_THERMAL_FILE_TRIP_POINTS	"trip_points"
+#define ANATOP_THERMAL_FILE_COOLING_MODE	"cooling_mode"
+#define ANATOP_THERMAL_FILE_POLLING_FREQ	"polling_frequency"
+#define ANATOP_THERMAL_NOTIFY_TEMPERATURE	0x80
+#define ANATOP_THERMAL_NOTIFY_THRESHOLDS	0x81
+#define ANATOP_THERMAL_NOTIFY_DEVICES	0x82
+#define ANATOP_THERMAL_NOTIFY_CRITICAL	0xF0
+#define ANATOP_THERMAL_NOTIFY_HOT		0xF1
+#define ANATOP_THERMAL_MODE_ACTIVE	0x00
+
+#define ANATOP_THERMAL_MAX_ACTIVE	10
+#define ANATOP_THERMAL_MAX_LIMIT_STR_LEN 65
+
+#define _COMPONENT		ANATOP_THERMAL_COMPONENT
+#define POLLING_FREQ		20
+#define TEMP_CRITICAL_SHUTDOWN	380
+#define TEMP_CRITICAL_SLEEP	360
+#define TEMP_PASSIVE		320
+#define MEASURE_FREQ		327  /* 327 RTC clocks delay, 10ms */
+#define CONVER_CONST		1413 /* rough value, need calibration */
+#define CONVER_DIV_1024		550  /* div value, need calibration */
+
+MODULE_AUTHOR("Anson Huang");
+MODULE_DESCRIPTION("ANATOP Thermal Zone Driver");
+MODULE_LICENSE("GPL");
+
+static int psv;
+unsigned long anatop_base;
+
+module_param(psv, int, 0644);
+MODULE_PARM_DESC(psv, "Disable or override all passive trip points.");
+
+static int anatop_thermal_add(struct anatop_device *device);
+static int anatop_thermal_remove(struct platform_device *pdev);
+static int anatop_thermal_resume(struct platform_device *pdev);
+/* static void anatop_thermal_notify(struct anatop_device *device,
+ * u32 event); */
+static int anatop_thermal_power_on(void);
+static int anatop_thermal_power_down(void);
+
+static const struct anatop_device_id thermal_device_ids[] = {
+	{ANATOP_THERMAL_HID, 0},
+	{"", 0},
+};
+MODULE_DEVICE_TABLE(anatop, thermal_device_ids);
+
+struct anatop_thermal_state {
+	u8 critical:1;
+	u8 hot:1;
+	u8 passive:1;
+	u8 active:1;
+	u8 reserved:4;
+	int active_index;
+};
+
+struct anatop_thermal_state_flags {
+	u8 valid:1;
+	u8 enabled:1;
+	u8 reserved:6;
+};
+
+struct anatop_thermal_critical {
+	struct anatop_thermal_state_flags flags;
+	unsigned long temperature;
+};
+
+struct anatop_thermal_hot {
+	struct anatop_thermal_state_flags flags;
+	unsigned long temperature;
+};
+
+struct anatop_thermal_passive {
+	struct anatop_thermal_state_flags flags;
+	unsigned long temperature;
+	unsigned long tc1;
+	unsigned long tc2;
+	unsigned long tsp;
+};
+
+struct anatop_thermal_active {
+	struct anatop_thermal_state_flags flags;
+	unsigned long temperature;
+};
+
+struct anatop_thermal_trips {
+	struct anatop_thermal_critical critical;
+	struct anatop_thermal_hot hot;
+	struct anatop_thermal_passive passive;
+	struct anatop_thermal_active active[ANATOP_THERMAL_MAX_ACTIVE];
+};
+
+struct anatop_thermal_flags {
+	u8 cooling_mode:1;	/* _SCP */
+	u8 devices:1;		/* _TZD */
+	u8 reserved:6;
+};
+
+struct anatop_thermal {
+	struct anatop_device *device;
+	unsigned long temperature;
+	unsigned long last_temperature;
+	unsigned long polling_frequency;
+	u8 zombie;
+	struct anatop_thermal_flags flags;
+	struct anatop_thermal_state state;
+	struct anatop_thermal_trips trips;
+	struct anatop_handle_list devices;
+	struct thermal_zone_device *thermal_zone;
+	int tz_enabled;
+	int kelvin_offset;
+	struct mutex lock;
+};
+
+/* ---------------------------------------------
+			Thermal Zone Management
+   --------------------------------------------- */
+static int anatop_dump_temperature_register(void)
+{
+	if (!anatop_base) {
+		pr_info("anatop_base is not initialized!!!\n");
+		return -EINVAL;
+	}
+
+	pr_info("HW_ANADIG_TEMPSENSE0 = 0x%x\n",
+			__raw_readl(anatop_base + HW_ANADIG_TEMPSENSE0));
+	pr_info("HW_ANADIG_TEMPSENSE1 = 0x%x\n",
+			__raw_readl(anatop_base + HW_ANADIG_TEMPSENSE1));
+}
+
+static int anatop_tempsense_value_to_dc(int val)
+{
+	int val_dc;
+	val_dc = (CONVER_CONST - val) * CONVER_DIV_1024 / 1024;
+
+	return val_dc;
+}
+
+static int anatop_thermal_get_temperature(struct anatop_thermal *tz)
+{
+	unsigned int tmp = 300;
+	unsigned int reg;
+	unsigned int i;
+	if (!tz)
+		return -EINVAL;
+
+	tz->last_temperature = tz->temperature;
+
+	/* now we only using single measure, every time we measure
+	the temperature, we will power on/down the anadig module*/
+	anatop_thermal_power_on();
+
+	/* write measure freq */
+	reg = __raw_readl(anatop_base + HW_ANADIG_TEMPSENSE1);
+	reg &= ~BM_ANADIG_TEMPSENSE1_MEASURE_FREQ;
+	reg |= MEASURE_FREQ;
+	__raw_writel(reg, anatop_base + HW_ANADIG_TEMPSENSE1);
+
+	__raw_writel(BM_ANADIG_TEMPSENSE0_MEASURE_TEMP,
+		anatop_base + HW_ANADIG_TEMPSENSE0_CLR);
+	__raw_writel(BM_ANADIG_TEMPSENSE0_FINISHED,
+		anatop_base + HW_ANADIG_TEMPSENSE0_CLR);
+	__raw_writel(BM_ANADIG_TEMPSENSE0_MEASURE_TEMP,
+		anatop_base + HW_ANADIG_TEMPSENSE0_SET);
+
+	tmp = 0;
+	/* read five times of temperature values to get average*/
+	for (i = 0; i < 5; i++) {
+		while ((__raw_readl(anatop_base + HW_ANADIG_TEMPSENSE0)
+			& BM_ANADIG_TEMPSENSE0_FINISHED) == 0)
+			msleep(20);
+		reg = __raw_readl(anatop_base + HW_ANADIG_TEMPSENSE0);
+		tmp += (reg & BM_ANADIG_TEMPSENSE0_TEMP_VALUE)
+				>> BP_ANADIG_TEMPSENSE0_TEMP_VALUE;
+		__raw_writel(BM_ANADIG_TEMPSENSE0_FINISHED,
+			anatop_base + HW_ANADIG_TEMPSENSE0_CLR);
+		/* anatop_dump_temperature_register(); */
+	}
+
+	tmp = tmp / 5;
+	tz->temperature = anatop_tempsense_value_to_dc(tmp);
+
+	pr_debug("Temperature is %lu C\n", tz->temperature);
+	anatop_thermal_power_down();
+
+	return 0;
+}
+
+static int anatop_thermal_get_polling_frequency(struct anatop_thermal *tz)
+{
+	/* treat the polling interval as freq */
+	tz->polling_frequency = POLLING_FREQ;
+
+	return 0;
+}
+
+static int anatop_thermal_set_cooling_mode(struct anatop_thermal *tz, int mode)
+{
+
+	return 0;
+}
+
+#define ANATOP_TRIPS_CRITICAL	0x01
+#define ANATOP_TRIPS_HOT		0x02
+#define ANATOP_TRIPS_PASSIVE	0x04
+#define ANATOP_TRIPS_ACTIVE	    0x08
+#define ANATOP_TRIPS_DEVICES	0x10
+
+#define ANATOP_TRIPS_INIT      (ANATOP_TRIPS_CRITICAL | \
+		ANATOP_TRIPS_HOT | ANATOP_TRIPS_PASSIVE)
+
+static int anatop_thermal_trips_update(struct anatop_thermal *tz, int flag)
+{
+	/* Critical Shutdown */
+	if (flag & ANATOP_TRIPS_CRITICAL) {
+		tz->trips.critical.temperature = TEMP_CRITICAL_SHUTDOWN;
+		tz->trips.critical.flags.valid = 1;
+
+	}
+
+	/* Critical Sleep(HOT) (optional) */
+	if (flag & ANATOP_TRIPS_HOT) {
+			tz->trips.hot.temperature = TEMP_CRITICAL_SLEEP;
+			tz->trips.hot.flags.valid = 1;
+
+	}
+
+	/* Passive (optional) */
+	if (flag & ANATOP_TRIPS_PASSIVE) {
+			tz->trips.passive.temperature = TEMP_PASSIVE;
+			tz->trips.passive.flags.valid = 1;
+	}
+
+	return 0;
+}
+
+static int anatop_thermal_get_trip_points(struct anatop_thermal *tz)
+{
+	int i, valid, ret = anatop_thermal_trips_update(tz, ANATOP_TRIPS_INIT);
+
+	if (ret)
+		return ret;
+
+	valid = tz->trips.critical.flags.valid |
+		tz->trips.hot.flags.valid |
+		tz->trips.passive.flags.valid;
+
+	for (i = 0; i < ANATOP_THERMAL_MAX_ACTIVE; i++)
+		valid |= tz->trips.active[i].flags.valid;
+
+	if (!valid) {
+		printk(KERN_WARNING FW_BUG "No valid trip found\n");
+		return -ENODEV;
+	}
+	return 0;
+}
+
+static void anatop_thermal_check(void *data)
+{
+	struct anatop_thermal *tz = data;
+
+	thermal_zone_device_update(tz->thermal_zone);
+}
+
+/* sys I/F for generic thermal sysfs support */
+#define KELVIN_TO_CEL(t, off) (((t) - (off)))
+
+static int thermal_get_temp(struct thermal_zone_device *thermal,
+			    unsigned long *temp)
+{
+	struct anatop_thermal *tz = thermal->devdata;
+	int result;
+
+	if (!tz)
+		return -EINVAL;
+	result = 0;
+	result = anatop_thermal_get_temperature(tz);
+	*temp = tz->temperature;
+	if (result)
+		return result;
+	else
+		return 0;
+}
+static const char enabled[] = "kernel";
+static const char disabled[] = "user";
+static int thermal_get_mode(struct thermal_zone_device *thermal,
+				enum thermal_device_mode *mode)
+{
+	struct anatop_thermal *tz = thermal->devdata;
+
+	if (!tz)
+		return -EINVAL;
+
+	*mode = tz->tz_enabled ? THERMAL_DEVICE_ENABLED :
+		THERMAL_DEVICE_DISABLED;
+
+	return 0;
+}
+
+static int thermal_set_mode(struct thermal_zone_device *thermal,
+				enum thermal_device_mode mode)
+{
+	struct anatop_thermal *tz = thermal->devdata;
+	int enable;
+
+	if (!tz)
+		return -EINVAL;
+
+	/* enable/disable thermal management from thermal driver */
+	if (mode == THERMAL_DEVICE_ENABLED)
+		enable = 1;
+	else if (mode == THERMAL_DEVICE_DISABLED)
+		enable = 0;
+	else
+		return -EINVAL;
+
+	if (enable != tz->tz_enabled) {
+		tz->tz_enabled = enable;
+		/*
+		printk((KERN_INFO,
+			"%s anatop thermal control\n",
+			tz->tz_enabled ? enabled : disabled));
+		*/
+		anatop_thermal_check(tz);
+	}
+	return 0;
+}
+
+static int thermal_get_trip_type(struct thermal_zone_device *thermal,
+				 int trip, enum thermal_trip_type *type)
+{
+	struct anatop_thermal *tz = thermal->devdata;
+	int i;
+
+	if (!tz || trip < 0)
+		return -EINVAL;
+
+	if (tz->trips.critical.flags.valid) {
+		if (!trip) {
+			*type = THERMAL_TRIP_CRITICAL;
+			return 0;
+		}
+		trip--;
+	}
+
+	if (tz->trips.hot.flags.valid) {
+		if (!trip) {
+			*type = THERMAL_TRIP_HOT;
+			return 0;
+		}
+		trip--;
+	}
+
+	if (tz->trips.passive.flags.valid) {
+		if (!trip) {
+			*type = THERMAL_TRIP_PASSIVE;
+			return 0;
+		}
+		trip--;
+	}
+
+	for (i = 0; i < ANATOP_THERMAL_MAX_ACTIVE &&
+		tz->trips.active[i].flags.valid; i++) {
+		if (!trip) {
+			*type = THERMAL_TRIP_ACTIVE;
+			return 0;
+		}
+		trip--;
+	}
+
+	return -EINVAL;
+}
+
+static int thermal_get_trip_temp(struct thermal_zone_device *thermal,
+				 int trip, unsigned long *temp)
+{
+	struct anatop_thermal *tz = thermal->devdata;
+	int i;
+
+	if (!tz || trip < 0)
+		return -EINVAL;
+	if (tz->trips.critical.flags.valid) {
+		if (!trip) {
+			*temp = KELVIN_TO_CEL(
+				tz->trips.critical.temperature,
+				tz->kelvin_offset);
+			return 0;
+		}
+		trip--;
+	}
+
+	if (tz->trips.hot.flags.valid) {
+		if (!trip) {
+			*temp = KELVIN_TO_CEL(
+				tz->trips.hot.temperature,
+				tz->kelvin_offset);
+			return 0;
+		}
+		trip--;
+	}
+
+	if (tz->trips.passive.flags.valid) {
+		if (!trip) {
+			*temp = KELVIN_TO_CEL(
+				tz->trips.passive.temperature,
+				tz->kelvin_offset);
+			return 0;
+		}
+		trip--;
+	}
+
+	for (i = 0; i < ANATOP_THERMAL_MAX_ACTIVE &&
+		tz->trips.active[i].flags.valid; i++) {
+		if (!trip) {
+			*temp = KELVIN_TO_CEL(
+				tz->trips.active[i].temperature,
+				tz->kelvin_offset);
+			return 0;
+		}
+		trip--;
+	}
+
+	return -EINVAL;
+}
+
+static int thermal_get_crit_temp(struct thermal_zone_device *thermal,
+				unsigned long *temperature) {
+	struct anatop_thermal *tz = thermal->devdata;
+
+	if (tz->trips.critical.flags.valid) {
+		*temperature = KELVIN_TO_CEL(
+				tz->trips.critical.temperature,
+				tz->kelvin_offset);
+		return 0;
+	} else
+		return -EINVAL;
+}
+
+static int thermal_notify(struct thermal_zone_device *thermal, int trip,
+			   enum thermal_trip_type trip_type)
+{
+	u8 type = 0;
+	/* struct anatop_thermal *tz = thermal->devdata; */
+
+	if (trip_type == THERMAL_TRIP_CRITICAL)
+		type = ANATOP_THERMAL_NOTIFY_CRITICAL;
+	else if (trip_type == THERMAL_TRIP_HOT)
+		type = ANATOP_THERMAL_NOTIFY_HOT;
+	else
+		return 0;
+/*
+	if (trip_type == THERMAL_TRIP_CRITICAL && nocrt)
+		return 1;
+*/
+	return 0;
+}
+
+typedef int (*cb)(struct thermal_zone_device *, int,
+		  struct thermal_cooling_device *);
+static int anatop_thermal_cooling_device_cb(struct thermal_zone_device *thermal,
+					struct thermal_cooling_device *cdev,
+					cb action)
+{
+	/* struct anatop_thermal *tz = thermal->devdata; */
+
+	int result = 0;
+
+	return result;
+}
+
+static int
+anatop_thermal_bind_cooling_device(struct thermal_zone_device *thermal,
+					struct thermal_cooling_device *cdev)
+{
+	return anatop_thermal_cooling_device_cb(thermal, cdev,
+				thermal_zone_bind_cooling_device);
+}
+
+static int
+anatop_thermal_unbind_cooling_device(struct thermal_zone_device *thermal,
+					struct thermal_cooling_device *cdev)
+{
+	return anatop_thermal_cooling_device_cb(thermal, cdev,
+				thermal_zone_unbind_cooling_device);
+}
+
+static struct thermal_zone_device_ops anatop_thermal_zone_ops = {
+	.bind = anatop_thermal_bind_cooling_device,
+	.unbind	= anatop_thermal_unbind_cooling_device,
+	.get_temp = thermal_get_temp,
+	.get_mode = thermal_get_mode,
+	.set_mode = thermal_set_mode,
+	.get_trip_type = thermal_get_trip_type,
+	.get_trip_temp = thermal_get_trip_temp,
+	.get_crit_temp = thermal_get_crit_temp,
+	.notify = thermal_notify,
+};
+
+static int anatop_thermal_register_thermal_zone(struct anatop_thermal *tz)
+{
+	int trips = 0;
+	int i;
+
+	if (tz->trips.critical.flags.valid)
+		trips++;
+
+	if (tz->trips.hot.flags.valid)
+		trips++;
+
+	if (tz->trips.passive.flags.valid)
+		trips++;
+
+	for (i = 0; i < ANATOP_THERMAL_MAX_ACTIVE
+			&& tz->trips.active[i].flags.valid; i++, trips++)
+		;
+
+	if (tz->trips.passive.flags.valid)
+		tz->thermal_zone =
+			thermal_zone_device_register("anatoptz", trips, tz,
+						     &anatop_thermal_zone_ops,
+						     tz->trips.passive.tc1,
+						     tz->trips.passive.tc2,
+						     tz->trips.passive.tsp*100,
+						     tz->polling_frequency*100);
+	else
+		tz->thermal_zone =
+			thermal_zone_device_register("anatoptz", trips, tz,
+						     &anatop_thermal_zone_ops,
+						     0, 0, 0,
+						     tz->polling_frequency*100);
+#if 0
+	result = sysfs_create_link(&tz->device->dev.kobj,
+				&tz->thermal_zone->device.kobj, "thermal_zone");
+	if (result)
+		return result;
+
+	result = sysfs_create_link(&tz->thermal_zone->device.kobj,
+				   &tz->device->dev.kobj, "device");
+	if (result)
+		return result;
+#endif
+
+	tz->tz_enabled = 1;
+
+	dev_info(&tz->device->dev, "registered as thermal_zone%d\n",
+		 tz->thermal_zone->id);
+	return 0;
+}
+/*
+static void anatop_thermal_unregister_thermal_zone(struct anatop_thermal *tz)
+{
+	sysfs_remove_link(&tz->device->dev.kobj, "thermal_zone");
+	sysfs_remove_link(&tz->thermal_zone->device.kobj, "device");
+	thermal_zone_device_unregister(tz->thermal_zone);
+	tz->thermal_zone = NULL;
+}
+*/
+
+/* --------------------------------------------------------------
+						Driver Interface
+   ------------------------------------------------------------- */
+static int anatop_thermal_get_info(struct anatop_thermal *tz)
+{
+	int result = 0;
+
+	if (!tz)
+		return -EINVAL;
+
+	/* Get temperature [_TMP] (required) */
+	result = anatop_thermal_get_temperature(tz);
+	if (result)
+		return result;
+
+	/* Get trip points [_CRT, _PSV, etc.] (required) */
+	result = anatop_thermal_get_trip_points(tz);
+	if (result)
+		return result;
+
+	/* Set the cooling mode [_SCP] to active cooling (default) */
+	result = anatop_thermal_set_cooling_mode(tz,
+			ANATOP_THERMAL_MODE_ACTIVE);
+	if (!result)
+		tz->flags.cooling_mode = 1;
+
+	/* Get default polling frequency [_TZP] (optional) */
+	anatop_thermal_get_polling_frequency(tz);
+
+	return 0;
+}
+
+static void anatop_thermal_guess_offset(struct anatop_thermal *tz)
+{
+	tz->kelvin_offset = 273;
+}
+
+static int anatop_thermal_add(struct anatop_device *device)
+{
+	int result = 0;
+	struct anatop_thermal *tz = NULL;
+	if (!device)
+		return -EINVAL;
+
+	tz = kzalloc(sizeof(struct anatop_thermal), GFP_KERNEL);
+	if (!tz)
+		return -ENOMEM;
+
+	tz->device = device;
+	strcpy(device->name, ANATOP_THERMAL_DEVICE_NAME);
+	device->driver_data = tz;
+	mutex_init(&tz->lock);
+
+	result = anatop_thermal_get_info(tz);
+	if (result)
+		goto free_memory;
+
+	anatop_thermal_guess_offset(tz);
+
+	result = anatop_thermal_register_thermal_zone(tz);
+	if (result)
+		goto free_memory;
+
+	goto end;
+
+free_memory:
+	kfree(tz);
+end:
+	return result;
+}
+static int anatop_thermal_remove(struct platform_device *pdev)
+{
+	/* struct anatop_device *device = platform_get_drvdata(pdev); */
+	return 0;
+}
+
+static int anatop_thermal_resume(struct platform_device *pdev)
+{
+
+	return 0;
+}
+static int anatop_thermal_power_on(void)
+{
+	__raw_writel(BM_ANADIG_TEMPSENSE0_POWER_DOWN,
+			anatop_base + HW_ANADIG_TEMPSENSE0_CLR);
+
+	__raw_writel(BM_ANADIG_ANA_MISC0_REFTOP_SELBIASOFF,
+			anatop_base + HW_ANADIG_ANA_MISC0_SET);
+	return 0;
+}
+
+static int anatop_thermal_power_down(void)
+{
+	__raw_writel(BM_ANADIG_TEMPSENSE0_POWER_DOWN,
+			anatop_base + HW_ANADIG_TEMPSENSE0_SET);
+
+	__raw_writel(BM_ANADIG_ANA_MISC0_REFTOP_SELBIASOFF,
+			anatop_base + HW_ANADIG_ANA_MISC0_CLR);
+	return 0;
+}
+
+static int anatop_thermal_probe(struct platform_device *pdev)
+{
+	int retval = 0;
+	struct resource *res;
+	void __iomem *base;
+
+	struct anatop_device *device;
+	device = kzalloc(sizeof(*device), GFP_KERNEL);
+	if (!device) {
+		retval = -ENOMEM;
+		goto device_alloc_failed;
+	}
+
+	platform_set_drvdata(pdev, device);
+
+	/* ioremap the base address */
+	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
+	if (res == NULL) {
+		dev_err(&pdev->dev, "No anatop base address provided\n");
+		goto anatop_failed;
+	}
+
+	base = ioremap(res->start, res->end - res->start);
+	if (base == NULL) {
+		dev_err(&pdev->dev, "failed to rebase anatop base address\n");
+		goto anatop_failed;
+	}
+	anatop_base = (unsigned long)base;
+
+	anatop_thermal_add(device);
+
+	goto success;
+anatop_failed:
+	kfree(device);
+device_alloc_failed:
+success:
+	pr_info("%s\n", __func__);
+	return retval;
+}
+static int anatop_thermal_suspend(struct platform_device *pdev,
+				  pm_message_t state)
+{
+	return 0;
+}
+
+static struct platform_driver anatop_thermal_driver_ldm = {
+	.driver = {
+		   .name = "anatop_thermal",
+		   .bus = &platform_bus_type,
+		   },
+	.probe = anatop_thermal_probe,
+	.remove = anatop_thermal_remove,
+	.suspend = anatop_thermal_suspend,
+	.resume = anatop_thermal_resume,
+};
+
+static int __init anatop_thermal_init(void)
+{
+	pr_debug("Anatop Thermal driver loading\n");
+	return platform_driver_register(&anatop_thermal_driver_ldm);
+}
+
+static void __exit anatop_thermal_exit(void)
+{
+	platform_driver_unregister(&anatop_thermal_driver_ldm);
+	pr_debug("Anatop Thermal driver successfully unloaded\n");
+}
+
+module_init(anatop_thermal_init);
+module_exit(anatop_thermal_exit);
-- 
1.7.7.3

--
To unsubscribe from this list: send the line "unsubscribe linux-kernel" in
the body of a message to majordomo@...r.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html
Please read the FAQ at  http://www.tux.org/lkml/

Powered by blists - more mailing lists