On Mon, Jan 16, 2012 at 11:11:42PM -0600, Rob Lee wrote: > Arrrrgh, just noticed I sent the wrong patch. Here is the correct one: > > Adds support for temperature sensor readings, registers with common > thermal framework, and uses the new common cpu_cooling interface. > > Signed-off-by: Robert Lee <rob.lee@xxxxxxxxxx> > --- > arch/arm/boot/dts/imx6q.dtsi | 1 + > drivers/thermal/Kconfig | 6 + > drivers/thermal/Makefile | 1 + > drivers/thermal/imx6q_thermal.c | 547 +++++++++++++++++++++++++++++++++++++++ > 4 files changed, 555 insertions(+), 0 deletions(-) > create mode 100644 drivers/thermal/imx6q_thermal.c > > diff --git a/arch/arm/boot/dts/imx6q.dtsi b/arch/arm/boot/dts/imx6q.dtsi > index 7dda599..d62b88d 100644 > --- a/arch/arm/boot/dts/imx6q.dtsi > +++ b/arch/arm/boot/dts/imx6q.dtsi > @@ -508,6 +508,7 @@ > }; > > ocotp@021bc000 { > + compatible = "fsl,imx6q-ocotp"; > reg = <0x021bc000 0x4000>; > }; > > diff --git a/drivers/thermal/Kconfig b/drivers/thermal/Kconfig > index 298c1cd..dd8cede 100644 > --- a/drivers/thermal/Kconfig > +++ b/drivers/thermal/Kconfig > @@ -29,3 +29,9 @@ config CPU_THERMAL > This will be useful for platforms using the generic thermal interface > and not the ACPI interface. > If you want this support, you should say Y or M here. > + > +config IMX6Q_THERMAL > + bool "IMX6Q Thermal interface support" > + depends on THERMAL && CPU_THERMAL > + help > + Adds thermal management for IMX6Q. > diff --git a/drivers/thermal/Makefile b/drivers/thermal/Makefile > index 655cbc4..e2bcffe 100644 > --- a/drivers/thermal/Makefile > +++ b/drivers/thermal/Makefile > @@ -4,3 +4,4 @@ > > obj-$(CONFIG_THERMAL) += thermal_sys.o > obj-$(CONFIG_CPU_THERMAL) += cpu_cooling.o > +obj-$(CONFIG_IMX6Q_THERMAL) += imx6q_thermal.o > diff --git a/drivers/thermal/imx6q_thermal.c b/drivers/thermal/imx6q_thermal.c > new file mode 100644 > index 0000000..c7174b5 > --- /dev/null > +++ b/drivers/thermal/imx6q_thermal.c > @@ -0,0 +1,547 @@ > +/* > + * Copyright 2012 Freescale Semiconductor, Inc. > + * Copyright 2012 Linaro Ltd. > + * > + * The code contained herein is licensed under the GNU General Public > + * License. You may obtain a copy of the GNU General Public License > + * Version 2 or later at the following locations: > + * > + * http://www.opensource.org/licenses/gpl-license.html > + * http://www.gnu.org/copyleft/gpl.html > + */ > + > +/* i.MX6Q Thermal Implementation */ > + > +#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/thermal.h> > +#include <linux/io.h> > +#include <linux/syscalls.h> > +#include <linux/cpufreq.h> > +#include <linux/of.h> > +#include <linux/of_address.h> > +#include <linux/smp.h> > +#include <linux/cpu_cooling.h> > +#include <linux/platform_device.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 BM_ANADIG_ANA_MISC0_REFTOP_SELBIASOFF 0x00000008 > + > +#define HW_ANADIG_TEMPSENSE0 0x00000180 > +#define HW_ANADIG_TEMPSENSE0_SET 0x00000184 > +#define HW_ANADIG_TEMPSENSE0_CLR 0x00000188 > +#define HW_ANADIG_TEMPSENSE0_TOG 0x0000018c > + > +#define BP_ANADIG_TEMPSENSE0_TEMP_VALUE 8 > +#define BM_ANADIG_TEMPSENSE0_TEMP_VALUE 0x000FFF00 > +#define BM_ANADIG_TEMPSENSE0_FINISHED 0x00000004 > +#define BM_ANADIG_TEMPSENSE0_MEASURE_TEMP 0x00000002 > +#define BM_ANADIG_TEMPSENSE0_POWER_DOWN 0x00000001 > + > +#define HW_ANADIG_TEMPSENSE1 0x00000190 > +#define HW_ANADIG_TEMPSENSE1_SET 0x00000194 > +#define HW_ANADIG_TEMPSENSE1_CLR 0x00000198 > +#define BP_ANADIG_TEMPSENSE1_MEASURE_FREQ 0 > +#define BM_ANADIG_TEMPSENSE1_MEASURE_FREQ 0x0000FFFF > + > +#define HW_OCOTP_ANA1 0x000004E0 > + > +#define IMX6Q_THERMAL_POLLING_FREQUENCY_MS 10000 > +#define IMX6Q_THERMAL_ACT_TRP_PTS 3 > +/* assumption: always one critical trip point */ > +#define IMX6Q_THERMAL_TOTAL_TRP_PTS (IMX6Q_THERMAL_ACT_TRP_PTS + 1) > + > +struct th_sys_trip_point { > + u32 temp; /* in celcius */ > + enum thermal_trip_type type; > +}; > + > +struct imx6q_thermal_data { > + struct th_sys_trip_point trp_pts[IMX6Q_THERMAL_TOTAL_TRP_PTS]; > + struct freq_pctg_table freq_tab[IMX6Q_THERMAL_ACT_TRP_PTS]; > +}; > + > +struct imx6q_sensor_data { > + int c1, c2; > + char *name; > + bool was_suspended; > +}; > + > +struct imx6q_thermal_zone { > + struct thermal_zone_device *therm_dev; > + struct thermal_cooling_device *cool_dev; > + struct imx6q_sensor_data sensor_data; > + struct imx6q_thermal_data *thermal_data; > +}; > + > +/* > + * This data defines the various trip points that will trigger action > + * when crossed. > + */ > +static struct imx6q_thermal_data thermal_data = { > + .trp_pts[0] = { > + .temp = 85000, > + .type = THERMAL_TRIP_STATE_ACTIVE, > + }, > + .freq_tab[0] = { > + .freq_clip_pctg[0] = 25, > + }, > + .trp_pts[1] = { > + .temp = 90000, > + .type = THERMAL_TRIP_STATE_ACTIVE, > + }, > + .freq_tab[1] = { > + .freq_clip_pctg[0] = 65, > + }, > + .trp_pts[2] = { > + .temp = 95000, > + .type = THERMAL_TRIP_STATE_ACTIVE, > + }, > + .freq_tab[2] = { > + .freq_clip_pctg[0] = 99, > + }, > + .trp_pts[3] = { > + .temp = 100000, > + .type = THERMAL_TRIP_CRITICAL, > + }, > +}; > + > +static int th_sys_get_temp(struct thermal_zone_device *thermal, > + unsigned long *temp); > + > +static struct platform_device *dev; > +static struct imx6q_thermal_zone *th_zone; > +static void __iomem *anatop_base; > + > +static inline int imx6q_get_temp(int *temp) > +{ > + unsigned int n_meas; > + unsigned int reg; > + struct imx6q_sensor_data *p = &th_zone->sensor_data; > + > + /* > + * For now we only using single measure. Every time we measure > + * the temperature, we will power on/down the anadig module > + */ > + writel_relaxed(BM_ANADIG_TEMPSENSE0_POWER_DOWN, > + anatop_base + HW_ANADIG_TEMPSENSE0_CLR); > + > + writel_relaxed(BM_ANADIG_TEMPSENSE0_FINISHED, > + anatop_base + HW_ANADIG_TEMPSENSE0_CLR); > + > + p->was_suspended = false; > + > + writel_relaxed(BM_ANADIG_TEMPSENSE0_MEASURE_TEMP, > + anatop_base + HW_ANADIG_TEMPSENSE0_SET); > + > + /* > + * According to SoC designers, it may require up to ~17us to complete > + * a measurement. But we have a 'finished' status bit, so we > + * check it just in case the designers are liars. > + */ > + do { > + msleep(1); > + > + /* > + * if system was possibly suspended while measurement > + * was being taken, we take another measurement to make > + * sure the measurement is valid. > + */ > + if (p->was_suspended) { How can this ever be true? It is set to false above. Wait a minute, you are trying to synchronize with the suspend/resume callbacks below. No, please remove this. If your system suspends in the middle of this function it's the thermal framework that does something wrong. > + writel_relaxed(BM_ANADIG_TEMPSENSE0_MEASURE_TEMP, > + anatop_base + HW_ANADIG_TEMPSENSE0_CLR); > + > + writel_relaxed(BM_ANADIG_TEMPSENSE0_FINISHED, > + anatop_base + HW_ANADIG_TEMPSENSE0_CLR); > + > + p->was_suspended = false; > + > + writel_relaxed(BM_ANADIG_TEMPSENSE0_MEASURE_TEMP, > + anatop_base + HW_ANADIG_TEMPSENSE0_SET); > + > + continue; unnecessary continue > + } > + } while (!(readl_relaxed(anatop_base + HW_ANADIG_TEMPSENSE0) > + & BM_ANADIG_TEMPSENSE0_FINISHED)); > + > + reg = readl_relaxed(anatop_base + HW_ANADIG_TEMPSENSE0); > + > + n_meas = (reg & BM_ANADIG_TEMPSENSE0_TEMP_VALUE) > + >> BP_ANADIG_TEMPSENSE0_TEMP_VALUE; > + > + writel_relaxed(BM_ANADIG_TEMPSENSE0_MEASURE_TEMP, > + anatop_base + HW_ANADIG_TEMPSENSE0_CLR); > + > + writel_relaxed(BM_ANADIG_TEMPSENSE0_POWER_DOWN, > + anatop_base + HW_ANADIG_TEMPSENSE0_SET); > + > + /* See imx6q_thermal_process_fuse_data for forumla derivation. */ > + *temp = p->c2 + (p->c1 * n_meas); > + > + pr_debug("Temperature: %d\n", *temp / 1000); > + > + return 0; > +} > + > +static int th_sys_get_temp(struct thermal_zone_device *thermal, > + unsigned long *temp) > +{ > + int tmp = 0; > + > + imx6q_get_temp(&tmp); > + > + /* > + * The thermal framework code stores temperature in unsigned long. Also, > + * it has references to "millicelcius" which limits the lowest > + * temperature possible (compared to Kelvin). > + */ > + if (likely(tmp > 0)) Please no 'likely' in such slow pathes. > + *temp = tmp; > + else > + *temp = 0; > + > + return 0; > +} > + > +static int th_sys_get_mode(struct thermal_zone_device *thermal, > + enum thermal_device_mode *mode) > +{ > + *mode = THERMAL_DEVICE_ENABLED; > + return 0; > +} > + > +static int th_sys_get_trip_type(struct thermal_zone_device *thermal, int trip, > + enum thermal_trip_type *type) > +{ > + if (trip >= IMX6Q_THERMAL_TOTAL_TRP_PTS) > + return -EINVAL; > + > + *type = th_zone->thermal_data->trp_pts[trip].type; > + > + return 0; > +} > + > +static int th_sys_get_trip_temp(struct thermal_zone_device *thermal, int trip, > + unsigned long *temp) > +{ > + if (trip >= IMX6Q_THERMAL_TOTAL_TRP_PTS) > + return -EINVAL; > + > + *temp = th_zone->thermal_data->trp_pts[trip].temp; > + return 0; > +} > + > +static int th_sys_get_crit_temp(struct thermal_zone_device *thermal, > + unsigned long *temp) > +{ > + > + *temp = th_zone->thermal_data->trp_pts[ > + IMX6Q_THERMAL_TOTAL_TRP_PTS - 1].temp; > + return 0; > +} > + > +static int th_sys_bind(struct thermal_zone_device *thermal, > + struct thermal_cooling_device *cdev) > +{ > + int i; > + > + /* if the cooling device is the one from imx6 bind it */ > + if (cdev != th_zone->cool_dev) > + return 0; > + > + for (i = 0; i < IMX6Q_THERMAL_ACT_TRP_PTS; i++) { > + if (thermal_zone_bind_cooling_device(thermal, i, cdev)) { > + pr_err("error binding cooling dev\n"); > + return -EINVAL; > + } > + } > + > + return 0; > +} > + > +static int th_sys_unbind(struct thermal_zone_device *thermal, > + struct thermal_cooling_device *cdev) > +{ > + int i; > + > + if (cdev != th_zone->cool_dev) > + return 0; > + > + for (i = 0; i < IMX6Q_THERMAL_ACT_TRP_PTS; i++) { > + if (thermal_zone_unbind_cooling_device(thermal, i, cdev)) { > + pr_err("error unbinding cooling dev\n"); > + return -EINVAL; > + } > + } > + > + return 0; > +} > + > +static struct thermal_zone_device_ops imx6q_dev_ops = { > + .bind = th_sys_bind, > + .unbind = th_sys_unbind, > + .get_temp = th_sys_get_temp, > + .get_mode = th_sys_get_mode, > + .get_trip_type = th_sys_get_trip_type, > + .get_trip_temp = th_sys_get_trip_temp, > + .get_crit_temp = th_sys_get_crit_temp, > +}; > + > +static int imx6q_thermal_process_fuse_data(unsigned int fuse_data) > +{ > + int t1, t2, n1, n2; > + struct imx6q_sensor_data *p = &th_zone->sensor_data; > + > + if (fuse_data == 0 || fuse_data == 0xffffffff) > + return -EINVAL; > + > + /* > + * Fuse data layout: > + * [31:20] sensor value @ 25C > + * [19:8] sensor value of hot > + * [7:0] hot temperature value > + */ > + n1 = fuse_data >> 20; > + n2 = (fuse_data & 0xfff00) >> 8; > + t2 = fuse_data & 0xff; > + t1 = 25; /* t1 always 25C */ > + > + pr_debug(" -- temperature sensor calibration data --\n"); > + pr_debug("HW_OCOTP_ANA1: %x\n", fuse_data); > + pr_debug("n1: %d\nn2: %d\nt1: %d\nt2: %d\n", n1, n2, t1, t2); > + > + /* > + * From reference manual (derived from linear interpolation), > + * Tmeas = T2 + (Nmeas - N2) * (T1 - T2) / (N1 - N2) > + * We want to reduce this down to the minimum computation necessary > + * for each temperature read. Also, we want Tmeas in millicelcius > + * and we don't want to lose precision from integer division. So... > + * milli_Tmeas = 1000 * T2 + 1000 * (Nmeas - N2) * (T1 - T2) / (N1 - N2) > + * Let constant c1 = 1000 * (T1 - T2) / (N1 - N2) > + * milli_Tmeas = (1000 * T2) + c1 * (Nmeas - N2) > + * milli_Tmeas = (1000 * T2) + (c1 * Nmeas) - (c1 * N2) > + * Let constant c2 = (1000 * T2) - (c1 * N2) > + * milli_Tmeas = c2 + (c1 * Nmeas) > + */ > + p->c1 = (1000 * (t1 - t2)) / (n1 - n2); > + p->c2 = (1000 * t2) - (p->c1 * n2); > + > + pr_debug("c1: %i\n", p->c1); > + pr_debug("c2: %i\n", p->c2); > + > + return 0; > +} > + > + > +static int imx6q_thermal_probe(struct platform_device *pdev) > +{ > + return 0; > +} > + > +static int imx6q_thermal_remove(struct platform_device *pdev) > +{ > + return 0; > +} > + > +static int imx6q_thermal_suspend(struct platform_device *pdev, > + pm_message_t state) > +{ > + /* > + * according to imx6q thermal sensor designers, system problems will > + * not occur if low power modes are entered while temp_sensor is active, > + * so do nothing here. > + */ > + return 0; > +} > + > +static int imx6q_thermal_resume(struct platform_device *pdev) > +{ > + th_zone->sensor_data.was_suspended = true; > + return 0; > +} > + > +void imx6q_unregister_thermal(void) > +{ static > + if (th_zone && th_zone->cool_dev) > + cpufreq_cooling_unregister(); > + > + if (th_zone && th_zone->therm_dev) > + thermal_zone_device_unregister(th_zone->therm_dev); > + > + kfree(th_zone); > + > + pr_info("i.MX6Q: Kernel Thermal management unregistered\n"); > +} > + > +static int __init imx6q_thermal_register(void) > +{ > + void __iomem *ocotp_base; > + struct device_node *np; > + unsigned int fuse_data; > + int ret; > + > + np = of_find_compatible_node(NULL, NULL, "fsl,imx6q-ocotp"); > + ocotp_base = of_iomap(np, 0); Clean up after yourself. of_iomap has a corresponding of_iounmap. > + > + if (!ocotp_base) { > + pr_err("Could not retrieve ocotp-base\n"); > + ret = -EINVAL; > + goto err_unregister; > + } > + > + np = of_find_compatible_node(NULL, NULL, "fsl,imx6q-anatop"); > + anatop_base = of_iomap(np, 0); > + > + if (!anatop_base) { > + pr_err("Could not retrieve anantop-base\n"); > + ret = -EINVAL; > + goto err_unregister; > + } > + > + fuse_data = readl_relaxed(ocotp_base + HW_OCOTP_ANA1); > + > + th_zone = kzalloc(sizeof(struct imx6q_thermal_zone), GFP_KERNEL); > + > + if (!th_zone) { > + ret = -ENOMEM; > + goto err_unregister; > + } > + > + th_zone->sensor_data.name = "imx6q-temp_sens", > + > + ret = imx6q_thermal_process_fuse_data(fuse_data); > + > + if (ret) { > + pr_err("Invalid temperature calibration data.\n"); > + goto err_unregister; > + } > + > + /* Make sure sensor is in known good state for measurements */ > + writel_relaxed(BM_ANADIG_TEMPSENSE0_POWER_DOWN, > + anatop_base + HW_ANADIG_TEMPSENSE0_CLR); > + writel_relaxed(BM_ANADIG_TEMPSENSE0_MEASURE_TEMP, > + anatop_base + HW_ANADIG_TEMPSENSE0_CLR); > + writel_relaxed(BM_ANADIG_TEMPSENSE1_MEASURE_FREQ, > + anatop_base + HW_ANADIG_TEMPSENSE1_CLR); > + writel_relaxed(BM_ANADIG_ANA_MISC0_REFTOP_SELBIASOFF, > + anatop_base + HW_ANADIG_ANA_MISC0_SET); > + writel_relaxed(BM_ANADIG_TEMPSENSE0_POWER_DOWN, > + anatop_base + HW_ANADIG_TEMPSENSE0_SET); > + > + th_zone->thermal_data = &thermal_data; > + if (!th_zone->thermal_data) { > + pr_err("Temperature sensor data not initialised\n"); > + ret = -EINVAL; > + goto err_unregister; > + } > + > + th_zone->cool_dev = cpufreq_cooling_register( > + (struct freq_pctg_table *)th_zone->thermal_data->freq_tab, > + IMX6Q_THERMAL_ACT_TRP_PTS, cpumask_of(0)); > + > + if (IS_ERR(th_zone->cool_dev)) { > + pr_err("Failed to register cpufreq cooling device\n"); > + ret = -EINVAL; > + goto err_unregister; > + } > + > + th_zone->therm_dev = thermal_zone_device_register( > + th_zone->sensor_data.name, IMX6Q_THERMAL_TOTAL_TRP_PTS, > + NULL, The NULL pointer here is for your devdata. Use it instead of global variables. > &imx6q_dev_ops, 0, 0, 0, > + IMX6Q_THERMAL_POLLING_FREQUENCY_MS); > + > + if (IS_ERR(th_zone->therm_dev)) { > + pr_err("Failed to register thermal zone device\n"); > + ret = -EINVAL; > + goto err_unregister; > + } > + > + return 0; > + > +err_unregister: > + imx6q_unregister_thermal(); > + return ret; > +} > + > +static struct platform_driver imx6q_thermal_driver = { > + .probe = imx6q_thermal_probe, > + .remove = imx6q_thermal_remove, > + .suspend = imx6q_thermal_suspend, > + .resume = imx6q_thermal_resume, > + .driver = { > + .name = "imx6q-thermal", > + .owner = THIS_MODULE, > + }, > +}; > + > +static int imx6q_th_platform_register(void) > +{ > + int ret; > + > + ret = platform_driver_register(&imx6q_thermal_driver); > + if (ret) > + return ret; > + > + dev = platform_device_alloc("imx6q-thermal-cpu", -1); Now I understand your question what advantages it has to make this a real driver. If you register the device here in this driver it has no advantages at all. Of course the device has to be registered in the oftree or platform code where we know we are actually running on an i.MX6 SoC. Hint: just because i.MX6 support is compiled into the kernel does not mean we are actually running on such a SoC. > + > + if (!dev) { > + ret = -ENOMEM; > + goto err_device_alloc; > + } > + ret = platform_device_add(dev); > + if (ret) > + goto err_device_add; > + > + return ret; > + > +err_device_add: > + platform_device_put(dev); > +err_device_alloc: > + platform_driver_unregister(&imx6q_thermal_driver); > + > + return ret; > +} > + > +static int __init imx6q_thermal_init(void) > +{ > + int ret; > + > + ret = imx6q_th_platform_register(); > + if (ret) > + goto err; > + > + ret = imx6q_thermal_register(); > + if (ret) > + goto err; > + > + pr_info("i.MX Thermal management enabled.\n"); > + return ret; > + > +err: > + pr_info("WARNING: Thermal management NOT enabled due to errors.\n"); > + return ret; > +} > + > +static void __exit imx6q_thermal_driver_exit(void) > +{ > + imx6q_unregister_thermal(); > + platform_device_unregister(dev); > + platform_driver_unregister(&imx6q_thermal_driver); > +} > + > +module_init(imx6q_thermal_init); > +module_exit(imx6q_thermal_driver_exit); > + > +MODULE_AUTHOR("Freescale Semiconductor"); > +MODULE_DESCRIPTION("i.MX6Q SoC thermal driver"); > +MODULE_LICENSE("GPL"); > +MODULE_ALIAS("platform:imx6q-thermal"); > -- > 1.7.1 > > > ---------- Forwarded message ---------- > From: Rob Lee <rob.lee@xxxxxxxxxx> > Date: Mon, Jan 16, 2012 at 10:51 PM > Subject: Re: [RFC PATCH v2] ARM: imx: Add basic imx6q thermal management > To: linux@xxxxxxxxxxxxxxxx, s.hauer@xxxxxxxxxxxxxx, shawn.guo@xxxxxxxxxxxxx > Cc: amit.kachhap@xxxxxxxxxx, amit.kucheria@xxxxxxxxxx, > linux-arm-kernel@xxxxxxxxxxxxxxxxxxx, patches@xxxxxxxxxx, > linux-acpi@xxxxxxxxxxxxxxx, lenb@xxxxxxxxxx > > > link to v1 submission: > > http://www.spinics.net/lists/arm-kernel/msg155111.html > > Based on v3.2 plus recently submitted cpu_cooling functionality here: > > http://www.spinics.net/lists/linux-pm/msg26500.html > > Changes since v1: > 1. Cleaned up some style issue pointed out in v1 > 2. Made various other code cleanup and re-organizing > 3. Added temperature sensor calibration > 4. Created platform driver and device to hook into pm suspend. > > Performed some basic testing to ensure proper cooling operating. If > you want to test this, full testing requires imx6q cpufreq > implementation (not yet in v3.2) and requires an imx6q part that has > temperature sensor calibration fuse correctly burned. > -- Pengutronix e.K. | | Industrial Linux Solutions | http://www.pengutronix.de/ | Peiner Str. 6-8, 31137 Hildesheim, Germany | Phone: +49-5121-206917-0 | Amtsgericht Hildesheim, HRA 2686 | Fax: +49-5121-206917-5555 | -- To unsubscribe from this list: send the line "unsubscribe linux-acpi" in the body of a message to majordomo@xxxxxxxxxxxxxxx More majordomo info at http://vger.kernel.org/majordomo-info.html