[deliverable/linux.git] / drivers / thermal / intel_pch_thermal.c

/* intel_pch_thermal.c - Intel PCH Thermal driver
 *
 * Copyright (c) 2015, Intel Corporation.
 *
 * Authors:
 *     Tushar Dave <tushar.n.dave@intel.com>
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms and conditions of the GNU General Public License,
 * version 2, as published by the Free Software Foundation.
 *
 * This program is distributed in the hope 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.
 *
 */

#include <linux/module.h>
#include <linux/types.h>
#include <linux/init.h>
#include <linux/pci.h>
#include <linux/thermal.h>

/* Intel PCH thermal Device IDs */
#define PCH_THERMAL_DID_WPT	0x9CA4 /* Wildcat Point */
#define PCH_THERMAL_DID_SKL	0x9D31 /* Skylake PCH */

/* Wildcat Point-LP  PCH Thermal registers */
#define WPT_TEMP	0x0000	/* Temperature */
#define WPT_TSC	0x04	/* Thermal Sensor Control */
#define WPT_TSS	0x06	/* Thermal Sensor Status */
#define WPT_TSEL	0x08	/* Thermal Sensor Enable and Lock */
#define WPT_TSREL	0x0A	/* Thermal Sensor Report Enable and Lock */
#define WPT_TSMIC	0x0C	/* Thermal Sensor SMI Control */
#define WPT_CTT	0x0010	/* Catastrophic Trip Point */
#define WPT_TAHV	0x0014	/* Thermal Alert High Value */
#define WPT_TALV	0x0018	/* Thermal Alert Low Value */
#define WPT_TL		0x00000040	/* Throttle Value */
#define WPT_PHL	0x0060	/* PCH Hot Level */
#define WPT_PHLC	0x62	/* PHL Control */
#define WPT_TAS	0x80	/* Thermal Alert Status */
#define WPT_TSPIEN	0x82	/* PCI Interrupt Event Enables */
#define WPT_TSGPEN	0x84	/* General Purpose Event Enables */

/*  Wildcat Point-LP  PCH Thermal Register bit definitions */
#define WPT_TEMP_TSR	0x00ff	/* Temp TS Reading */
#define WPT_TSC_CPDE	0x01	/* Catastrophic Power-Down Enable */
#define WPT_TSS_TSDSS	0x10	/* Thermal Sensor Dynamic Shutdown Status */
#define WPT_TSS_GPES	0x08	/* GPE status */
#define WPT_TSEL_ETS	0x01    /* Enable TS */
#define WPT_TSEL_PLDB	0x80	/* TSEL Policy Lock-Down Bit */
#define WPT_TL_TOL	0x000001FF	/* T0 Level */
#define WPT_TL_T1L	0x1ff00000	/* T1 Level */
#define WPT_TL_TTEN	0x20000000	/* TT Enable */

static char driver_name[] = "Intel PCH thermal driver";

struct pch_thermal_device {
	void __iomem *hw_base;
	const struct pch_dev_ops *ops;
	struct pci_dev *pdev;
	struct thermal_zone_device *tzd;
	int crt_trip_id;
	unsigned long crt_temp;
	int hot_trip_id;
	unsigned long hot_temp;
};

static int pch_wpt_init(struct pch_thermal_device *ptd, int *nr_trips)
{
	u8 tsel;
	u16 trip_temp;

	*nr_trips = 0;

	/* Check if BIOS has already enabled thermal sensor */
	if (WPT_TSS_TSDSS & readb(ptd->hw_base + WPT_TSS))
		goto read_trips;

	tsel = readb(ptd->hw_base + WPT_TSEL);
	/*
	 * When TSEL's Policy Lock-Down bit is 1, TSEL become RO.
	 * If so, thermal sensor cannot enable. Bail out.
	 */
	if (tsel & WPT_TSEL_PLDB) {
		dev_err(&ptd->pdev->dev, "Sensor can't be enabled\n");
		return -ENODEV;
	}

	writeb(tsel|WPT_TSEL_ETS, ptd->hw_base + WPT_TSEL);
	if (!(WPT_TSS_TSDSS & readb(ptd->hw_base + WPT_TSS))) {
		dev_err(&ptd->pdev->dev, "Sensor can't be enabled\n");
		return -ENODEV;
	}

read_trips:
	ptd->crt_trip_id = -1;
	trip_temp = readw(ptd->hw_base + WPT_CTT);
	trip_temp &= 0x1FF;
	if (trip_temp) {
		/* Resolution of 1/2 degree C and an offset of -50C */
		ptd->crt_temp = trip_temp * 1000 / 2 - 50000;
		ptd->crt_trip_id = 0;
		++(*nr_trips);
	}

	ptd->hot_trip_id = -1;
	trip_temp = readw(ptd->hw_base + WPT_PHL);
	trip_temp &= 0x1FF;
	if (trip_temp) {
		/* Resolution of 1/2 degree C and an offset of -50C */
		ptd->hot_temp = trip_temp * 1000 / 2 - 50000;
		ptd->hot_trip_id = *nr_trips;
		++(*nr_trips);
	}

	return 0;
}

static int pch_wpt_get_temp(struct pch_thermal_device *ptd, int *temp)
{
	u8 wpt_temp;

	wpt_temp = WPT_TEMP_TSR & readl(ptd->hw_base + WPT_TEMP);

	/* Resolution of 1/2 degree C and an offset of -50C */
	*temp = (wpt_temp * 1000 / 2 - 50000);

	return 0;
}

struct pch_dev_ops {
	int (*hw_init)(struct pch_thermal_device *ptd, int *nr_trips);
	int (*get_temp)(struct pch_thermal_device *ptd, int *temp);
};


/* dev ops for Wildcat Point */
static const struct pch_dev_ops pch_dev_ops_wpt = {
	.hw_init = pch_wpt_init,
	.get_temp = pch_wpt_get_temp,
};

static int pch_thermal_get_temp(struct thermal_zone_device *tzd, int *temp)
{
	struct pch_thermal_device *ptd = tzd->devdata;

	return	ptd->ops->get_temp(ptd, temp);
}

static int pch_get_trip_type(struct thermal_zone_device *tzd, int trip,
			     enum thermal_trip_type *type)
{
	struct pch_thermal_device *ptd = tzd->devdata;

	if (ptd->crt_trip_id == trip)
		*type = THERMAL_TRIP_CRITICAL;
	else if (ptd->hot_trip_id == trip)
		*type = THERMAL_TRIP_HOT;
	else
		return -EINVAL;

	return 0;
}

static int pch_get_trip_temp(struct thermal_zone_device *tzd, int trip, int *temp)
{
	struct pch_thermal_device *ptd = tzd->devdata;

	if (ptd->crt_trip_id == trip)
		*temp = ptd->crt_temp;
	else if (ptd->hot_trip_id == trip)
		*temp = ptd->hot_temp;
	else
		return -EINVAL;

	return 0;
}

static struct thermal_zone_device_ops tzd_ops = {
	.get_temp = pch_thermal_get_temp,
	.get_trip_type = pch_get_trip_type,
	.get_trip_temp = pch_get_trip_temp,
};


static int intel_pch_thermal_probe(struct pci_dev *pdev,
				   const struct pci_device_id *id)
{
	struct pch_thermal_device *ptd;
	int err;
	int nr_trips;
	char *dev_name;

	ptd = devm_kzalloc(&pdev->dev, sizeof(*ptd), GFP_KERNEL);
	if (!ptd)
		return -ENOMEM;

	switch (pdev->device) {
	case PCH_THERMAL_DID_WPT:
		ptd->ops = &pch_dev_ops_wpt;
		dev_name = "pch_wildcat_point";
		break;
	case PCH_THERMAL_DID_SKL:
		ptd->ops = &pch_dev_ops_wpt;
		dev_name = "pch_skylake";
		break;
	default:
		dev_err(&pdev->dev, "unknown pch thermal device\n");
		return -ENODEV;
	}

	pci_set_drvdata(pdev, ptd);
	ptd->pdev = pdev;

	err = pci_enable_device(pdev);
	if (err) {
		dev_err(&pdev->dev, "failed to enable pci device\n");
		return err;
	}

	err = pci_request_regions(pdev, driver_name);
	if (err) {
		dev_err(&pdev->dev, "failed to request pci region\n");
		goto error_disable;
	}

	ptd->hw_base = pci_ioremap_bar(pdev, 0);
	if (!ptd->hw_base) {
		err = -ENOMEM;
		dev_err(&pdev->dev, "failed to map mem base\n");
		goto error_release;
	}

	err = ptd->ops->hw_init(ptd, &nr_trips);
	if (err)
		goto error_cleanup;

	ptd->tzd = thermal_zone_device_register(dev_name, nr_trips, 0, ptd,
						&tzd_ops, NULL, 0, 0);
	if (IS_ERR(ptd->tzd)) {
		dev_err(&pdev->dev, "Failed to register thermal zone %s\n",
			dev_name);
		err = PTR_ERR(ptd->tzd);
		goto error_cleanup;
	}

	return 0;

error_cleanup:
	iounmap(ptd->hw_base);
error_release:
	pci_release_regions(pdev);
error_disable:
	pci_disable_device(pdev);
	dev_err(&pdev->dev, "pci device failed to probe\n");
	return err;
}

static void intel_pch_thermal_remove(struct pci_dev *pdev)
{
	struct pch_thermal_device *ptd = pci_get_drvdata(pdev);

	thermal_zone_device_unregister(ptd->tzd);
	iounmap(ptd->hw_base);
	pci_set_drvdata(pdev, NULL);
	pci_release_region(pdev, 0);
	pci_disable_device(pdev);
}

static struct pci_device_id intel_pch_thermal_id[] = {
	{ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCH_THERMAL_DID_WPT) },
	{ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCH_THERMAL_DID_SKL) },
	{ 0, },
};
MODULE_DEVICE_TABLE(pci, intel_pch_thermal_id);

static struct pci_driver intel_pch_thermal_driver = {
	.name		= "intel_pch_thermal",
	.id_table	= intel_pch_thermal_id,
	.probe		= intel_pch_thermal_probe,
	.remove		= intel_pch_thermal_remove,
};

module_pci_driver(intel_pch_thermal_driver);

MODULE_LICENSE("GPL v2");
MODULE_DESCRIPTION("Intel PCH Thermal driver");
Commit	Line	Data
d0a12625 TD	1	/* intel_pch_thermal.c - Intel PCH Thermal driver
	2	*
	3	* Copyright (c) 2015, Intel Corporation.
	4	*
	5	* Authors:
	6	* Tushar Dave <tushar.n.dave@intel.com>
	7	*
	8	* This program is free software; you can redistribute it and/or modify it
	9	* under the terms and conditions of the GNU General Public License,
	10	* version 2, as published by the Free Software Foundation.
	11	*
	12	* This program is distributed in the hope it will be useful, but WITHOUT
	13	* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
	14	* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
	15	* more details.
	16	*
	17	*/
	18
	19	#include <linux/module.h>
	20	#include <linux/types.h>
	21	#include <linux/init.h>
	22	#include <linux/pci.h>
	23	#include <linux/thermal.h>
	24
	25	/* Intel PCH thermal Device IDs */
	26	#define PCH_THERMAL_DID_WPT 0x9CA4 /* Wildcat Point */
4cba7d23	27	#define PCH_THERMAL_DID_SKL 0x9D31 /* Skylake PCH */
d0a12625 TD	28
	29	/* Wildcat Point-LP PCH Thermal registers */
	30	#define WPT_TEMP 0x0000 /* Temperature */
	31	#define WPT_TSC 0x04 /* Thermal Sensor Control */
	32	#define WPT_TSS 0x06 /* Thermal Sensor Status */
	33	#define WPT_TSEL 0x08 /* Thermal Sensor Enable and Lock */
	34	#define WPT_TSREL 0x0A /* Thermal Sensor Report Enable and Lock */
	35	#define WPT_TSMIC 0x0C /* Thermal Sensor SMI Control */
	36	#define WPT_CTT 0x0010 /* Catastrophic Trip Point */
	37	#define WPT_TAHV 0x0014 /* Thermal Alert High Value */
	38	#define WPT_TALV 0x0018 /* Thermal Alert Low Value */
	39	#define WPT_TL 0x00000040 /* Throttle Value */
	40	#define WPT_PHL 0x0060 /* PCH Hot Level */
	41	#define WPT_PHLC 0x62 /* PHL Control */
	42	#define WPT_TAS 0x80 /* Thermal Alert Status */
	43	#define WPT_TSPIEN 0x82 /* PCI Interrupt Event Enables */
	44	#define WPT_TSGPEN 0x84 /* General Purpose Event Enables */
	45
	46	/* Wildcat Point-LP PCH Thermal Register bit definitions */
	47	#define WPT_TEMP_TSR 0x00ff /* Temp TS Reading */
	48	#define WPT_TSC_CPDE 0x01 /* Catastrophic Power-Down Enable */
	49	#define WPT_TSS_TSDSS 0x10 /* Thermal Sensor Dynamic Shutdown Status */
	50	#define WPT_TSS_GPES 0x08 /* GPE status */
	51	#define WPT_TSEL_ETS 0x01 /* Enable TS */
	52	#define WPT_TSEL_PLDB 0x80 /* TSEL Policy Lock-Down Bit */
	53	#define WPT_TL_TOL 0x000001FF /* T0 Level */
	54	#define WPT_TL_T1L 0x1ff00000 /* T1 Level */
	55	#define WPT_TL_TTEN 0x20000000 /* TT Enable */
	56
	57	static char driver_name[] = "Intel PCH thermal driver";
	58
	59	struct pch_thermal_device {
	60	void __iomem *hw_base;
	61	const struct pch_dev_ops *ops;
	62	struct pci_dev *pdev;
	63	struct thermal_zone_device *tzd;
	64	int crt_trip_id;
	65	unsigned long crt_temp;
	66	int hot_trip_id;
	67	unsigned long hot_temp;
	68	};
	69
	70	static int pch_wpt_init(struct pch_thermal_device ptd, int nr_trips)
	71	{
	72	u8 tsel;
	73	u16 trip_temp;
	74
	75	*nr_trips = 0;
	76
	77	/* Check if BIOS has already enabled thermal sensor */
	78	if (WPT_TSS_TSDSS & readb(ptd->hw_base + WPT_TSS))
	79	goto read_trips;
	80
	81	tsel = readb(ptd->hw_base + WPT_TSEL);
	82	/*
	83	* When TSEL's Policy Lock-Down bit is 1, TSEL become RO.
	84	* If so, thermal sensor cannot enable. Bail out.
	85	*/
	86	if (tsel & WPT_TSEL_PLDB) {
	87	dev_err(&ptd->pdev->dev, "Sensor can't be enabled\n");
	88	return -ENODEV;
	89	}
	90
	91	writeb(tsel\|WPT_TSEL_ETS, ptd->hw_base + WPT_TSEL);
92	if (!(WPT_TSS_TSDSS & readb(ptd->hw_base + WPT_TSS))) {
93	dev_err(&ptd->pdev->dev, "Sensor can't be enabled\n");
94	return -ENODEV;
95	}
96
97	read_trips:
98	ptd->crt_trip_id = -1;
99	trip_temp = readw(ptd->hw_base + WPT_CTT);
100	trip_temp &= 0x1FF;
101	if (trip_temp) {
102	/* Resolution of 1/2 degree C and an offset of -50C */
103	ptd->crt_temp = trip_temp * 1000 / 2 - 50000;
104	ptd->crt_trip_id = 0;
105	++(*nr_trips);
106	}
107
108	ptd->hot_trip_id = -1;
109	trip_temp = readw(ptd->hw_base + WPT_PHL);
110	trip_temp &= 0x1FF;
111	if (trip_temp) {
112	/* Resolution of 1/2 degree C and an offset of -50C */
113	ptd->hot_temp = trip_temp * 1000 / 2 - 50000;
114	ptd->hot_trip_id = *nr_trips;
115	++(*nr_trips);
116	}
117
118	return 0;
119	}
120
dfb22fc5	121	static int pch_wpt_get_temp(struct pch_thermal_device ptd, int temp)
d0a12625 TD	122	{
	123	u8 wpt_temp;
	124
	125	wpt_temp = WPT_TEMP_TSR & readl(ptd->hw_base + WPT_TEMP);
	126
	127	/* Resolution of 1/2 degree C and an offset of -50C */
	128	temp = (wpt_temp 1000 / 2 - 50000);
	129
	130	return 0;
	131	}
	132
	133	struct pch_dev_ops {
	134	int (hw_init)(struct pch_thermal_device ptd, int *nr_trips);
dfb22fc5	135	int (get_temp)(struct pch_thermal_device ptd, int *temp);
d0a12625 TD	136	};
	137
	138
	139	/* dev ops for Wildcat Point */
a96bedf1	140	static const struct pch_dev_ops pch_dev_ops_wpt = {
d0a12625 TD	141	.hw_init = pch_wpt_init,
	142	.get_temp = pch_wpt_get_temp,
	143	};
	144
dfb22fc5	145	static int pch_thermal_get_temp(struct thermal_zone_device tzd, int temp)
d0a12625 TD	146	{
	147	struct pch_thermal_device *ptd = tzd->devdata;
	148
	149	return ptd->ops->get_temp(ptd, temp);
	150	}
	151
	152	static int pch_get_trip_type(struct thermal_zone_device *tzd, int trip,
	153	enum thermal_trip_type *type)
	154	{
	155	struct pch_thermal_device *ptd = tzd->devdata;
	156
	157	if (ptd->crt_trip_id == trip)
	158	*type = THERMAL_TRIP_CRITICAL;
	159	else if (ptd->hot_trip_id == trip)
	160	*type = THERMAL_TRIP_HOT;
	161	else
	162	return -EINVAL;
	163
	164	return 0;
	165	}
	166
dfb22fc5	167	static int pch_get_trip_temp(struct thermal_zone_device tzd, int trip, int temp)
d0a12625 TD	168	{
	169	struct pch_thermal_device *ptd = tzd->devdata;
	170
	171	if (ptd->crt_trip_id == trip)
	172	*temp = ptd->crt_temp;
	173	else if (ptd->hot_trip_id == trip)
	174	*temp = ptd->hot_temp;
	175	else
	176	return -EINVAL;
	177
	178	return 0;
	179	}
	180
	181	static struct thermal_zone_device_ops tzd_ops = {
	182	.get_temp = pch_thermal_get_temp,
	183	.get_trip_type = pch_get_trip_type,
	184	.get_trip_temp = pch_get_trip_temp,
	185	};
	186
	187
	188	static int intel_pch_thermal_probe(struct pci_dev *pdev,
	189	const struct pci_device_id *id)
	190	{
	191	struct pch_thermal_device *ptd;
	192	int err;
	193	int nr_trips;
	194	char *dev_name;
	195
	196	ptd = devm_kzalloc(&pdev->dev, sizeof(*ptd), GFP_KERNEL);
	197	if (!ptd)
	198	return -ENOMEM;
	199
	200	switch (pdev->device) {
	201	case PCH_THERMAL_DID_WPT:
	202	ptd->ops = &pch_dev_ops_wpt;
	203	dev_name = "pch_wildcat_point";
	204	break;
4cba7d23 SP	205	case PCH_THERMAL_DID_SKL:
	206	ptd->ops = &pch_dev_ops_wpt;
	207	dev_name = "pch_skylake";
	208	break;
d0a12625 TD	209	default:
	210	dev_err(&pdev->dev, "unknown pch thermal device\n");
	211	return -ENODEV;
	212	}
	213
	214	pci_set_drvdata(pdev, ptd);
	215	ptd->pdev = pdev;
	216
	217	err = pci_enable_device(pdev);
	218	if (err) {
	219	dev_err(&pdev->dev, "failed to enable pci device\n");
	220	return err;
	221	}
	222
	223	err = pci_request_regions(pdev, driver_name);
	224	if (err) {
	225	dev_err(&pdev->dev, "failed to request pci region\n");
	226	goto error_disable;
	227	}
	228
	229	ptd->hw_base = pci_ioremap_bar(pdev, 0);
	230	if (!ptd->hw_base) {
	231	err = -ENOMEM;
	232	dev_err(&pdev->dev, "failed to map mem base\n");
	233	goto error_release;
	234	}
	235
	236	err = ptd->ops->hw_init(ptd, &nr_trips);
	237	if (err)
	238	goto error_cleanup;
	239
	240	ptd->tzd = thermal_zone_device_register(dev_name, nr_trips, 0, ptd,
	241	&tzd_ops, NULL, 0, 0);
	242	if (IS_ERR(ptd->tzd)) {
	243	dev_err(&pdev->dev, "Failed to register thermal zone %s\n",
	244	dev_name);
	245	err = PTR_ERR(ptd->tzd);
	246	goto error_cleanup;
	247	}
	248
	249	return 0;
	250
	251	error_cleanup:
	252	iounmap(ptd->hw_base);
	253	error_release:
	254	pci_release_regions(pdev);
	255	error_disable:
	256	pci_disable_device(pdev);
	257	dev_err(&pdev->dev, "pci device failed to probe\n");
	258	return err;
	259	}
	260
	261	static void intel_pch_thermal_remove(struct pci_dev *pdev)
	262	{
	263	struct pch_thermal_device *ptd = pci_get_drvdata(pdev);
	264
	265	thermal_zone_device_unregister(ptd->tzd);
	266	iounmap(ptd->hw_base);
	267	pci_set_drvdata(pdev, NULL);
	268	pci_release_region(pdev, 0);
	269	pci_disable_device(pdev);
	270	}
	271
	272	static struct pci_device_id intel_pch_thermal_id[] = {
273	{ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCH_THERMAL_DID_WPT) },
4cba7d23	274	{ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCH_THERMAL_DID_SKL) },
d0a12625 TD	275	{ 0, },
	276	};
	277	MODULE_DEVICE_TABLE(pci, intel_pch_thermal_id);
	278
	279	static struct pci_driver intel_pch_thermal_driver = {
	280	.name = "intel_pch_thermal",
	281	.id_table = intel_pch_thermal_id,
	282	.probe = intel_pch_thermal_probe,
	283	.remove = intel_pch_thermal_remove,
	284	};
	285
	286	module_pci_driver(intel_pch_thermal_driver);
	287
	288	MODULE_LICENSE("GPL v2");
	289	MODULE_DESCRIPTION("Intel PCH Thermal driver");