[linux-block.git] / drivers / platform / x86 / intel_menlow.c

// SPDX-License-Identifier: GPL-2.0
/*
 *  Intel menlow Driver for thermal management extension
 *
 *  Copyright (C) 2008 Intel Corp
 *  Copyright (C) 2008 Sujith Thomas <sujith.thomas@intel.com>
 *  Copyright (C) 2008 Zhang Rui <rui.zhang@intel.com>
 *
 *  This driver creates the sys I/F for programming the sensors.
 *  It also implements the driver for intel menlow memory controller (hardware
 *  id is INT0002) which makes use of the platform specific ACPI methods
 *  to get/set bandwidth.
 */

#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

#include <linux/acpi.h>
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/pci.h>
#include <linux/pm.h>
#include <linux/slab.h>
#include <linux/thermal.h>
#include <linux/types.h>

MODULE_AUTHOR("Thomas Sujith");
MODULE_AUTHOR("Zhang Rui");
MODULE_DESCRIPTION("Intel Menlow platform specific driver");
MODULE_LICENSE("GPL v2");

/*
 * Memory controller device control
 */

#define MEMORY_GET_BANDWIDTH "GTHS"
#define MEMORY_SET_BANDWIDTH "STHS"
#define MEMORY_ARG_CUR_BANDWIDTH 1
#define MEMORY_ARG_MAX_BANDWIDTH 0

static void intel_menlow_unregister_sensor(void);

/*
 * GTHS returning 'n' would mean that [0,n-1] states are supported
 * In that case max_cstate would be n-1
 * GTHS returning '0' would mean that no bandwidth control states are supported
 */
static int memory_get_max_bandwidth(struct thermal_cooling_device *cdev,
				    unsigned long *max_state)
{
	struct acpi_device *device = cdev->devdata;
	acpi_handle handle = device->handle;
	unsigned long long value;
	struct acpi_object_list arg_list;
	union acpi_object arg;
	acpi_status status = AE_OK;

	arg_list.count = 1;
	arg_list.pointer = &arg;
	arg.type = ACPI_TYPE_INTEGER;
	arg.integer.value = MEMORY_ARG_MAX_BANDWIDTH;
	status = acpi_evaluate_integer(handle, MEMORY_GET_BANDWIDTH,
				       &arg_list, &value);
	if (ACPI_FAILURE(status))
		return -EFAULT;

	if (!value)
		return -EINVAL;

	*max_state = value - 1;
	return 0;
}

static int memory_get_cur_bandwidth(struct thermal_cooling_device *cdev,
				    unsigned long *value)
{
	struct acpi_device *device = cdev->devdata;
	acpi_handle handle = device->handle;
	unsigned long long result;
	struct acpi_object_list arg_list;
	union acpi_object arg;
	acpi_status status = AE_OK;

	arg_list.count = 1;
	arg_list.pointer = &arg;
	arg.type = ACPI_TYPE_INTEGER;
	arg.integer.value = MEMORY_ARG_CUR_BANDWIDTH;
	status = acpi_evaluate_integer(handle, MEMORY_GET_BANDWIDTH,
				       &arg_list, &result);
	if (ACPI_FAILURE(status))
		return -EFAULT;

	*value = result;
	return 0;
}

static int memory_set_cur_bandwidth(struct thermal_cooling_device *cdev,
				    unsigned long state)
{
	struct acpi_device *device = cdev->devdata;
	acpi_handle handle = device->handle;
	struct acpi_object_list arg_list;
	union acpi_object arg;
	acpi_status status;
	unsigned long long temp;
	unsigned long max_state;

	if (memory_get_max_bandwidth(cdev, &max_state))
		return -EFAULT;

	if (state > max_state)
		return -EINVAL;

	arg_list.count = 1;
	arg_list.pointer = &arg;
	arg.type = ACPI_TYPE_INTEGER;
	arg.integer.value = state;

	status =
	    acpi_evaluate_integer(handle, MEMORY_SET_BANDWIDTH, &arg_list,
				  &temp);

	pr_info("Bandwidth value was %ld: status is %d\n", state, status);
	if (ACPI_FAILURE(status))
		return -EFAULT;

	return 0;
}

static const struct thermal_cooling_device_ops memory_cooling_ops = {
	.get_max_state = memory_get_max_bandwidth,
	.get_cur_state = memory_get_cur_bandwidth,
	.set_cur_state = memory_set_cur_bandwidth,
};

/*
 * Memory Device Management
 */
static int intel_menlow_memory_add(struct acpi_device *device)
{
	int result = -ENODEV;
	struct thermal_cooling_device *cdev;

	if (!device)
		return -EINVAL;

	if (!acpi_has_method(device->handle, MEMORY_GET_BANDWIDTH))
		goto end;

	if (!acpi_has_method(device->handle, MEMORY_SET_BANDWIDTH))
		goto end;

	cdev = thermal_cooling_device_register("Memory controller", device,
					       &memory_cooling_ops);
	if (IS_ERR(cdev)) {
		result = PTR_ERR(cdev);
		goto end;
	}

	device->driver_data = cdev;
	result = sysfs_create_link(&device->dev.kobj,
				&cdev->device.kobj, "thermal_cooling");
	if (result)
		goto unregister;

	result = sysfs_create_link(&cdev->device.kobj,
				&device->dev.kobj, "device");
	if (result) {
		sysfs_remove_link(&device->dev.kobj, "thermal_cooling");
		goto unregister;
	}

 end:
	return result;

 unregister:
	thermal_cooling_device_unregister(cdev);
	return result;

}

static int intel_menlow_memory_remove(struct acpi_device *device)
{
	struct thermal_cooling_device *cdev = acpi_driver_data(device);

	if (!device || !cdev)
		return -EINVAL;

	sysfs_remove_link(&device->dev.kobj, "thermal_cooling");
	sysfs_remove_link(&cdev->device.kobj, "device");
	thermal_cooling_device_unregister(cdev);

	return 0;
}

static const struct acpi_device_id intel_menlow_memory_ids[] = {
	{"INT0002", 0},
	{"", 0},
};

static struct acpi_driver intel_menlow_memory_driver = {
	.name = "intel_menlow_thermal_control",
	.ids = intel_menlow_memory_ids,
	.ops = {
		.add = intel_menlow_memory_add,
		.remove = intel_menlow_memory_remove,
		},
};

/*
 * Sensor control on menlow platform
 */

#define THERMAL_AUX0 0
#define THERMAL_AUX1 1
#define GET_AUX0 "GAX0"
#define GET_AUX1 "GAX1"
#define SET_AUX0 "SAX0"
#define SET_AUX1 "SAX1"

struct intel_menlow_attribute {
	struct device_attribute attr;
	struct device *device;
	acpi_handle handle;
	struct list_head node;
};

static LIST_HEAD(intel_menlow_attr_list);
static DEFINE_MUTEX(intel_menlow_attr_lock);

/*
 * sensor_get_auxtrip - get the current auxtrip value from sensor
 * @name: Thermalzone name
 * @auxtype : AUX0/AUX1
 * @buf: syfs buffer
 */
static int sensor_get_auxtrip(acpi_handle handle, int index,
							unsigned long long *value)
{
	acpi_status status;

	if ((index != 0 && index != 1) || !value)
		return -EINVAL;

	status = acpi_evaluate_integer(handle, index ? GET_AUX1 : GET_AUX0,
				       NULL, value);
	if (ACPI_FAILURE(status))
		return -EIO;

	return 0;
}

/*
 * sensor_set_auxtrip - set the new auxtrip value to sensor
 * @name: Thermalzone name
 * @auxtype : AUX0/AUX1
 * @buf: syfs buffer
 */
static int sensor_set_auxtrip(acpi_handle handle, int index, int value)
{
	acpi_status status;
	union acpi_object arg = {
		ACPI_TYPE_INTEGER
	};
	struct acpi_object_list args = {
		1, &arg
	};
	unsigned long long temp;

	if (index != 0 && index != 1)
		return -EINVAL;

	status = acpi_evaluate_integer(handle, index ? GET_AUX0 : GET_AUX1,
				       NULL, &temp);
	if (ACPI_FAILURE(status))
		return -EIO;
	if ((index && value < temp) || (!index && value > temp))
		return -EINVAL;

	arg.integer.value = value;
	status = acpi_evaluate_integer(handle, index ? SET_AUX1 : SET_AUX0,
				       &args, &temp);
	if (ACPI_FAILURE(status))
		return -EIO;

	/* do we need to check the return value of SAX0/SAX1 ? */

	return 0;
}

#define to_intel_menlow_attr(_attr)	\
	container_of(_attr, struct intel_menlow_attribute, attr)

static ssize_t aux_show(struct device *dev, struct device_attribute *dev_attr,
			char *buf, int idx)
{
	struct intel_menlow_attribute *attr = to_intel_menlow_attr(dev_attr);
	unsigned long long value;
	int result;

	result = sensor_get_auxtrip(attr->handle, idx, &value);

	return result ? result : sprintf(buf, "%lu", DECI_KELVIN_TO_CELSIUS(value));
}

static ssize_t aux0_show(struct device *dev,
			 struct device_attribute *dev_attr, char *buf)
{
	return aux_show(dev, dev_attr, buf, 0);
}

static ssize_t aux1_show(struct device *dev,
			 struct device_attribute *dev_attr, char *buf)
{
	return aux_show(dev, dev_attr, buf, 1);
}

static ssize_t aux_store(struct device *dev, struct device_attribute *dev_attr,
			 const char *buf, size_t count, int idx)
{
	struct intel_menlow_attribute *attr = to_intel_menlow_attr(dev_attr);
	int value;
	int result;

	/*Sanity check; should be a positive integer */
	if (!sscanf(buf, "%d", &value))
		return -EINVAL;

	if (value < 0)
		return -EINVAL;

	result = sensor_set_auxtrip(attr->handle, idx, 
				    CELSIUS_TO_DECI_KELVIN(value));
	return result ? result : count;
}

static ssize_t aux0_store(struct device *dev,
			  struct device_attribute *dev_attr,
			  const char *buf, size_t count)
{
	return aux_store(dev, dev_attr, buf, count, 0);
}

static ssize_t aux1_store(struct device *dev,
			  struct device_attribute *dev_attr,
			  const char *buf, size_t count)
{
	return aux_store(dev, dev_attr, buf, count, 1);
}

/* BIOS can enable/disable the thermal user application in dabney platform */
#define BIOS_ENABLED "\\_TZ.GSTS"
static ssize_t bios_enabled_show(struct device *dev,
				 struct device_attribute *attr, char *buf)
{
	acpi_status status;
	unsigned long long bios_enabled;

	status = acpi_evaluate_integer(NULL, BIOS_ENABLED, NULL, &bios_enabled);
	if (ACPI_FAILURE(status))
		return -ENODEV;

	return sprintf(buf, "%s\n", bios_enabled ? "enabled" : "disabled");
}

static int intel_menlow_add_one_attribute(char *name, umode_t mode, void *show,
					  void *store, struct device *dev,
					  acpi_handle handle)
{
	struct intel_menlow_attribute *attr;
	int result;

	attr = kzalloc(sizeof(struct intel_menlow_attribute), GFP_KERNEL);
	if (!attr)
		return -ENOMEM;

	sysfs_attr_init(&attr->attr.attr); /* That is consistent naming :D */
	attr->attr.attr.name = name;
	attr->attr.attr.mode = mode;
	attr->attr.show = show;
	attr->attr.store = store;
	attr->device = dev;
	attr->handle = handle;

	result = device_create_file(dev, &attr->attr);
	if (result) {
		kfree(attr);
		return result;
	}

	mutex_lock(&intel_menlow_attr_lock);
	list_add_tail(&attr->node, &intel_menlow_attr_list);
	mutex_unlock(&intel_menlow_attr_lock);

	return 0;
}

static acpi_status intel_menlow_register_sensor(acpi_handle handle, u32 lvl,
						void *context, void **rv)
{
	acpi_status status;
	acpi_handle dummy;
	struct thermal_zone_device *thermal;
	int result;

	result = acpi_bus_get_private_data(handle, (void **)&thermal);
	if (result)
		return 0;

	/* _TZ must have the AUX0/1 methods */
	status = acpi_get_handle(handle, GET_AUX0, &dummy);
	if (ACPI_FAILURE(status))
		return (status == AE_NOT_FOUND) ? AE_OK : status;

	status = acpi_get_handle(handle, SET_AUX0, &dummy);
	if (ACPI_FAILURE(status))
		return (status == AE_NOT_FOUND) ? AE_OK : status;

	result = intel_menlow_add_one_attribute("aux0", 0644,
						aux0_show, aux0_store,
						&thermal->device, handle);
	if (result)
		return AE_ERROR;

	status = acpi_get_handle(handle, GET_AUX1, &dummy);
	if (ACPI_FAILURE(status))
		goto aux1_not_found;

	status = acpi_get_handle(handle, SET_AUX1, &dummy);
	if (ACPI_FAILURE(status))
		goto aux1_not_found;

	result = intel_menlow_add_one_attribute("aux1", 0644,
						aux1_show, aux1_store,
						&thermal->device, handle);
	if (result) {
		intel_menlow_unregister_sensor();
		return AE_ERROR;
	}

	/*
	 * create the "dabney_enabled" attribute which means the user app
	 * should be loaded or not
	 */

	result = intel_menlow_add_one_attribute("bios_enabled", 0444,
						bios_enabled_show, NULL,
						&thermal->device, handle);
	if (result) {
		intel_menlow_unregister_sensor();
		return AE_ERROR;
	}

	return AE_OK;

 aux1_not_found:
	if (status == AE_NOT_FOUND)
		return AE_OK;

	intel_menlow_unregister_sensor();
	return status;
}

static void intel_menlow_unregister_sensor(void)
{
	struct intel_menlow_attribute *pos, *next;

	mutex_lock(&intel_menlow_attr_lock);
	list_for_each_entry_safe(pos, next, &intel_menlow_attr_list, node) {
		list_del(&pos->node);
		device_remove_file(pos->device, &pos->attr);
		kfree(pos);
	}
	mutex_unlock(&intel_menlow_attr_lock);

	return;
}

static int __init intel_menlow_module_init(void)
{
	int result = -ENODEV;
	acpi_status status;
	unsigned long long enable;

	if (acpi_disabled)
		return result;

	/* Looking for the \_TZ.GSTS method */
	status = acpi_evaluate_integer(NULL, BIOS_ENABLED, NULL, &enable);
	if (ACPI_FAILURE(status) || !enable)
		return -ENODEV;

	/* Looking for ACPI device MEM0 with hardware id INT0002 */
	result = acpi_bus_register_driver(&intel_menlow_memory_driver);
	if (result)
		return result;

	/* Looking for sensors in each ACPI thermal zone */
	status = acpi_walk_namespace(ACPI_TYPE_THERMAL, ACPI_ROOT_OBJECT,
				     ACPI_UINT32_MAX,
				     intel_menlow_register_sensor, NULL, NULL, NULL);
	if (ACPI_FAILURE(status)) {
		acpi_bus_unregister_driver(&intel_menlow_memory_driver);
		return -ENODEV;
	}

	return 0;
}

static void __exit intel_menlow_module_exit(void)
{
	acpi_bus_unregister_driver(&intel_menlow_memory_driver);
	intel_menlow_unregister_sensor();
}

module_init(intel_menlow_module_init);
module_exit(intel_menlow_module_exit);
Commit	Line	Data
0b5d9856	1	// SPDX-License-Identifier: GPL-2.0
cc0573b3	2	/*
0b5d9856	3	* Intel menlow Driver for thermal management extension
cc0573b3 TS	4	*
	5	* Copyright (C) 2008 Intel Corp
	6	* Copyright (C) 2008 Sujith Thomas <sujith.thomas@intel.com>
	7	* Copyright (C) 2008 Zhang Rui <rui.zhang@intel.com>
cc0573b3 TS	8	*
	9	* This driver creates the sys I/F for programming the sensors.
	10	* It also implements the driver for intel menlow memory controller (hardware
	11	* id is INT0002) which makes use of the platform specific ACPI methods
	12	* to get/set bandwidth.
	13	*/
	14
4686f6df JP	15	#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
4686f6df JP	16
8855ab3b	17	#include <linux/acpi.h>
cc0573b3 TS	18	#include <linux/kernel.h>
cc0573b3 TS	19	#include <linux/module.h>
cc0573b3 TS	20	#include <linux/pci.h>
cc0573b3 TS	21	#include <linux/pm.h>
8855ab3b	22	#include <linux/slab.h>
cc0573b3	23	#include <linux/thermal.h>
8855ab3b	24	#include <linux/types.h>
cc0573b3 TS	25
	26	MODULE_AUTHOR("Thomas Sujith");
	27	MODULE_AUTHOR("Zhang Rui");
	28	MODULE_DESCRIPTION("Intel Menlow platform specific driver");
0b5d9856	29	MODULE_LICENSE("GPL v2");
cc0573b3 TS	30
	31	/*
	32	* Memory controller device control
	33	*/
	34
	35	#define MEMORY_GET_BANDWIDTH "GTHS"
	36	#define MEMORY_SET_BANDWIDTH "STHS"
	37	#define MEMORY_ARG_CUR_BANDWIDTH 1
	38	#define MEMORY_ARG_MAX_BANDWIDTH 0
	39
4b30fbca AL	40	static void intel_menlow_unregister_sensor(void);
4b30fbca AL	41
d65dcdcf TS	42	/*
	43	* GTHS returning 'n' would mean that [0,n-1] states are supported
	44	* In that case max_cstate would be n-1
	45	* GTHS returning '0' would mean that no bandwidth control states are supported
	46	*/
6503e5df MG	47	static int memory_get_max_bandwidth(struct thermal_cooling_device *cdev,
6503e5df MG	48	unsigned long *max_state)
cc0573b3 TS	49	{
	50	struct acpi_device *device = cdev->devdata;
	51	acpi_handle handle = device->handle;
27663c58	52	unsigned long long value;
cc0573b3 TS	53	struct acpi_object_list arg_list;
	54	union acpi_object arg;
	55	acpi_status status = AE_OK;
	56
	57	arg_list.count = 1;
	58	arg_list.pointer = &arg;
	59	arg.type = ACPI_TYPE_INTEGER;
	60	arg.integer.value = MEMORY_ARG_MAX_BANDWIDTH;
	61	status = acpi_evaluate_integer(handle, MEMORY_GET_BANDWIDTH,
	62	&arg_list, &value);
	63	if (ACPI_FAILURE(status))
	64	return -EFAULT;
	65
c2d06fe3 ZR	66	if (!value)
	67	return -EINVAL;
	68
cc0573b3 TS	69	*max_state = value - 1;
	70	return 0;
	71	}
	72
cc0573b3	73	static int memory_get_cur_bandwidth(struct thermal_cooling_device *cdev,
6503e5df	74	unsigned long *value)
cc0573b3 TS	75	{
	76	struct acpi_device *device = cdev->devdata;
	77	acpi_handle handle = device->handle;
6503e5df	78	unsigned long long result;
cc0573b3 TS	79	struct acpi_object_list arg_list;
	80	union acpi_object arg;
	81	acpi_status status = AE_OK;
	82
	83	arg_list.count = 1;
	84	arg_list.pointer = &arg;
	85	arg.type = ACPI_TYPE_INTEGER;
	86	arg.integer.value = MEMORY_ARG_CUR_BANDWIDTH;
	87	status = acpi_evaluate_integer(handle, MEMORY_GET_BANDWIDTH,
6503e5df	88	&arg_list, &result);
cc0573b3 TS	89	if (ACPI_FAILURE(status))
	90	return -EFAULT;
	91
6503e5df MG	92	*value = result;
6503e5df MG	93	return 0;
cc0573b3 TS	94	}
	95
	96	static int memory_set_cur_bandwidth(struct thermal_cooling_device *cdev,
6503e5df	97	unsigned long state)
cc0573b3 TS	98	{
	99	struct acpi_device *device = cdev->devdata;
	100	acpi_handle handle = device->handle;
	101	struct acpi_object_list arg_list;
	102	union acpi_object arg;
	103	acpi_status status;
27663c58	104	unsigned long long temp;
cc0573b3 TS	105	unsigned long max_state;
cc0573b3 TS	106
6503e5df	107	if (memory_get_max_bandwidth(cdev, &max_state))
cc0573b3 TS	108	return -EFAULT;
cc0573b3 TS	109
c2d06fe3	110	if (state > max_state)
cc0573b3 TS	111	return -EINVAL;
	112
	113	arg_list.count = 1;
	114	arg_list.pointer = &arg;
	115	arg.type = ACPI_TYPE_INTEGER;
	116	arg.integer.value = state;
	117
	118	status =
	119	acpi_evaluate_integer(handle, MEMORY_SET_BANDWIDTH, &arg_list,
27663c58	120	&temp);
cc0573b3	121
4686f6df	122	pr_info("Bandwidth value was %ld: status is %d\n", state, status);
cc0573b3 TS	123	if (ACPI_FAILURE(status))
	124	return -EFAULT;
	125
	126	return 0;
	127	}
	128
20485a56	129	static const struct thermal_cooling_device_ops memory_cooling_ops = {
cc0573b3 TS	130	.get_max_state = memory_get_max_bandwidth,
	131	.get_cur_state = memory_get_cur_bandwidth,
	132	.set_cur_state = memory_set_cur_bandwidth,
	133	};
	134
	135	/*
	136	* Memory Device Management
	137	*/
	138	static int intel_menlow_memory_add(struct acpi_device *device)
	139	{
	140	int result = -ENODEV;
cc0573b3 TS	141	struct thermal_cooling_device *cdev;
	142
	143	if (!device)
	144	return -EINVAL;
	145
70122e3d	146	if (!acpi_has_method(device->handle, MEMORY_GET_BANDWIDTH))
cc0573b3 TS	147	goto end;
cc0573b3 TS	148
70122e3d	149	if (!acpi_has_method(device->handle, MEMORY_SET_BANDWIDTH))
cc0573b3 TS	150	goto end;
	151
	152	cdev = thermal_cooling_device_register("Memory controller", device,
	153	&memory_cooling_ops);
69f6b8dd TS	154	if (IS_ERR(cdev)) {
	155	result = PTR_ERR(cdev);
	156	goto end;
	157	}
	158
db89b4f0	159	device->driver_data = cdev;
3a8ca95e JL	160	result = sysfs_create_link(&device->dev.kobj,
	161	&cdev->device.kobj, "thermal_cooling");
	162	if (result)
	163	goto unregister;
	164
	165	result = sysfs_create_link(&cdev->device.kobj,
	166	&device->dev.kobj, "device");
	167	if (result) {
	168	sysfs_remove_link(&device->dev.kobj, "thermal_cooling");
	169	goto unregister;
cc0573b3 TS	170	}
	171
	172	end:
	173	return result;
	174
	175	unregister:
	176	thermal_cooling_device_unregister(cdev);
	177	return result;
	178
	179	}
	180
51fac838	181	static int intel_menlow_memory_remove(struct acpi_device *device)
cc0573b3 TS	182	{
	183	struct thermal_cooling_device *cdev = acpi_driver_data(device);
	184
	185	if (!device \|\| !cdev)
	186	return -EINVAL;
	187
	188	sysfs_remove_link(&device->dev.kobj, "thermal_cooling");
	189	sysfs_remove_link(&cdev->device.kobj, "device");
	190	thermal_cooling_device_unregister(cdev);
	191
	192	return 0;
	193	}
	194
f7e8dd50	195	static const struct acpi_device_id intel_menlow_memory_ids[] = {
cc0573b3 TS	196	{"INT0002", 0},
	197	{"", 0},
	198	};
	199
	200	static struct acpi_driver intel_menlow_memory_driver = {
	201	.name = "intel_menlow_thermal_control",
	202	.ids = intel_menlow_memory_ids,
	203	.ops = {
	204	.add = intel_menlow_memory_add,
	205	.remove = intel_menlow_memory_remove,
	206	},
	207	};
	208
	209	/*
	210	* Sensor control on menlow platform
	211	*/
	212
	213	#define THERMAL_AUX0 0
	214	#define THERMAL_AUX1 1
	215	#define GET_AUX0 "GAX0"
	216	#define GET_AUX1 "GAX1"
	217	#define SET_AUX0 "SAX0"
	218	#define SET_AUX1 "SAX1"
	219
	220	struct intel_menlow_attribute {
	221	struct device_attribute attr;
	222	struct device *device;
	223	acpi_handle handle;
	224	struct list_head node;
	225	};
	226
	227	static LIST_HEAD(intel_menlow_attr_list);
	228	static DEFINE_MUTEX(intel_menlow_attr_lock);
	229
	230	/*
	231	* sensor_get_auxtrip - get the current auxtrip value from sensor
	232	* @name: Thermalzone name
	233	* @auxtype : AUX0/AUX1
	234	* @buf: syfs buffer
	235	*/
27663c58 MW	236	static int sensor_get_auxtrip(acpi_handle handle, int index,
27663c58 MW	237	unsigned long long *value)
cc0573b3 TS	238	{
	239	acpi_status status;
	240
	241	if ((index != 0 && index != 1) \|\| !value)
	242	return -EINVAL;
	243
	244	status = acpi_evaluate_integer(handle, index ? GET_AUX1 : GET_AUX0,
27663c58	245	NULL, value);
cc0573b3 TS	246	if (ACPI_FAILURE(status))
	247	return -EIO;
	248
	249	return 0;
	250	}
	251
	252	/*
	253	* sensor_set_auxtrip - set the new auxtrip value to sensor
	254	* @name: Thermalzone name
	255	* @auxtype : AUX0/AUX1
	256	* @buf: syfs buffer
	257	*/
	258	static int sensor_set_auxtrip(acpi_handle handle, int index, int value)
	259	{
	260	acpi_status status;
	261	union acpi_object arg = {
	262	ACPI_TYPE_INTEGER
	263	};
	264	struct acpi_object_list args = {
	265	1, &arg
	266	};
27663c58	267	unsigned long long temp;
cc0573b3 TS	268
	269	if (index != 0 && index != 1)
	270	return -EINVAL;
	271
	272	status = acpi_evaluate_integer(handle, index ? GET_AUX0 : GET_AUX1,
27663c58	273	NULL, &temp);
cc0573b3 TS	274	if (ACPI_FAILURE(status))
	275	return -EIO;
	276	if ((index && value < temp) \|\| (!index && value > temp))
	277	return -EINVAL;
	278
	279	arg.integer.value = value;
	280	status = acpi_evaluate_integer(handle, index ? SET_AUX1 : SET_AUX0,
27663c58	281	&args, &temp);
cc0573b3 TS	282	if (ACPI_FAILURE(status))
	283	return -EIO;
	284
	285	/* do we need to check the return value of SAX0/SAX1 ? */
	286
	287	return 0;
	288	}
	289
	290	#define to_intel_menlow_attr(_attr) \
	291	container_of(_attr, struct intel_menlow_attribute, attr)
	292
a29ccf6f RV	293	static ssize_t aux_show(struct device dev, struct device_attribute dev_attr,
a29ccf6f RV	294	char *buf, int idx)
cc0573b3 TS	295	{
cc0573b3 TS	296	struct intel_menlow_attribute *attr = to_intel_menlow_attr(dev_attr);
27663c58	297	unsigned long long value;
cc0573b3 TS	298	int result;
cc0573b3 TS	299
a29ccf6f	300	result = sensor_get_auxtrip(attr->handle, idx, &value);
cc0573b3	301
e866a2e3	302	return result ? result : sprintf(buf, "%lu", DECI_KELVIN_TO_CELSIUS(value));
cc0573b3 TS	303	}
cc0573b3 TS	304
a29ccf6f	305	static ssize_t aux0_show(struct device *dev,
cc0573b3 TS	306	struct device_attribute dev_attr, char buf)
cc0573b3 TS	307	{
a29ccf6f RV	308	return aux_show(dev, dev_attr, buf, 0);
a29ccf6f RV	309	}
cc0573b3	310
a29ccf6f RV	311	static ssize_t aux1_show(struct device *dev,
	312	struct device_attribute dev_attr, char buf)
	313	{
	314	return aux_show(dev, dev_attr, buf, 1);
cc0573b3 TS	315	}
cc0573b3 TS	316
a29ccf6f RV	317	static ssize_t aux_store(struct device dev, struct device_attribute dev_attr,
a29ccf6f RV	318	const char *buf, size_t count, int idx)
cc0573b3 TS	319	{
	320	struct intel_menlow_attribute *attr = to_intel_menlow_attr(dev_attr);
	321	int value;
	322	int result;
	323
	324	/Sanity check; should be a positive integer /
	325	if (!sscanf(buf, "%d", &value))
	326	return -EINVAL;
	327
	328	if (value < 0)
	329	return -EINVAL;
	330
a29ccf6f RV	331	result = sensor_set_auxtrip(attr->handle, idx,
a29ccf6f RV	332	CELSIUS_TO_DECI_KELVIN(value));
cc0573b3 TS	333	return result ? result : count;
	334	}
	335
a29ccf6f	336	static ssize_t aux0_store(struct device *dev,
cc0573b3 TS	337	struct device_attribute *dev_attr,
	338	const char *buf, size_t count)
	339	{
a29ccf6f RV	340	return aux_store(dev, dev_attr, buf, count, 0);
a29ccf6f RV	341	}
cc0573b3	342
a29ccf6f RV	343	static ssize_t aux1_store(struct device *dev,
	344	struct device_attribute *dev_attr,
	345	const char *buf, size_t count)
	346	{
	347	return aux_store(dev, dev_attr, buf, count, 1);
cc0573b3 TS	348	}
	349
	350	/* BIOS can enable/disable the thermal user application in dabney platform */
	351	#define BIOS_ENABLED "\\_TZ.GSTS"
	352	static ssize_t bios_enabled_show(struct device *dev,
	353	struct device_attribute attr, char buf)
	354	{
	355	acpi_status status;
27663c58	356	unsigned long long bios_enabled;
cc0573b3 TS	357
	358	status = acpi_evaluate_integer(NULL, BIOS_ENABLED, NULL, &bios_enabled);
	359	if (ACPI_FAILURE(status))
	360	return -ENODEV;
	361
	362	return sprintf(buf, "%s\n", bios_enabled ? "enabled" : "disabled");
	363	}
	364
9104e427	365	static int intel_menlow_add_one_attribute(char name, umode_t mode, void show,
cc0573b3 TS	366	void store, struct device dev,
	367	acpi_handle handle)
	368	{
	369	struct intel_menlow_attribute *attr;
	370	int result;
	371
	372	attr = kzalloc(sizeof(struct intel_menlow_attribute), GFP_KERNEL);
	373	if (!attr)
	374	return -ENOMEM;
	375
12765517	376	sysfs_attr_init(&attr->attr.attr); /* That is consistent naming :D */
cc0573b3 TS	377	attr->attr.attr.name = name;
	378	attr->attr.attr.mode = mode;
	379	attr->attr.show = show;
	380	attr->attr.store = store;
	381	attr->device = dev;
	382	attr->handle = handle;
	383
	384	result = device_create_file(dev, &attr->attr);
4b30fbca AL	385	if (result) {
4b30fbca AL	386	kfree(attr);
cc0573b3	387	return result;
4b30fbca	388	}
cc0573b3 TS	389
	390	mutex_lock(&intel_menlow_attr_lock);
	391	list_add_tail(&attr->node, &intel_menlow_attr_list);
	392	mutex_unlock(&intel_menlow_attr_lock);
	393
	394	return 0;
	395	}
	396
	397	static acpi_status intel_menlow_register_sensor(acpi_handle handle, u32 lvl,
	398	void context, void *rv)
	399	{
	400	acpi_status status;
	401	acpi_handle dummy;
	402	struct thermal_zone_device *thermal;
	403	int result;
	404
	405	result = acpi_bus_get_private_data(handle, (void **)&thermal);
	406	if (result)
	407	return 0;
	408
	409	/* _TZ must have the AUX0/1 methods */
	410	status = acpi_get_handle(handle, GET_AUX0, &dummy);
	411	if (ACPI_FAILURE(status))
4b30fbca	412	return (status == AE_NOT_FOUND) ? AE_OK : status;
cc0573b3 TS	413
	414	status = acpi_get_handle(handle, SET_AUX0, &dummy);
	415	if (ACPI_FAILURE(status))
4b30fbca	416	return (status == AE_NOT_FOUND) ? AE_OK : status;
cc0573b3 TS	417
	418	result = intel_menlow_add_one_attribute("aux0", 0644,
	419	aux0_show, aux0_store,
	420	&thermal->device, handle);
	421	if (result)
	422	return AE_ERROR;
	423
	424	status = acpi_get_handle(handle, GET_AUX1, &dummy);
	425	if (ACPI_FAILURE(status))
4b30fbca	426	goto aux1_not_found;
cc0573b3 TS	427
	428	status = acpi_get_handle(handle, SET_AUX1, &dummy);
	429	if (ACPI_FAILURE(status))
4b30fbca	430	goto aux1_not_found;
cc0573b3 TS	431
	432	result = intel_menlow_add_one_attribute("aux1", 0644,
	433	aux1_show, aux1_store,
	434	&thermal->device, handle);
4b30fbca AL	435	if (result) {
4b30fbca AL	436	intel_menlow_unregister_sensor();
cc0573b3	437	return AE_ERROR;
4b30fbca	438	}
cc0573b3 TS	439
	440	/*
	441	* create the "dabney_enabled" attribute which means the user app
	442	* should be loaded or not
	443	*/
	444
	445	result = intel_menlow_add_one_attribute("bios_enabled", 0444,
	446	bios_enabled_show, NULL,
	447	&thermal->device, handle);
4b30fbca AL	448	if (result) {
4b30fbca AL	449	intel_menlow_unregister_sensor();
cc0573b3	450	return AE_ERROR;
4b30fbca	451	}
cc0573b3	452
c8bb2ebd AL	453	return AE_OK;
c8bb2ebd AL	454
4b30fbca	455	aux1_not_found:
cc0573b3 TS	456	if (status == AE_NOT_FOUND)
cc0573b3 TS	457	return AE_OK;
4b30fbca AL	458
	459	intel_menlow_unregister_sensor();
	460	return status;
cc0573b3 TS	461	}
	462
	463	static void intel_menlow_unregister_sensor(void)
	464	{
	465	struct intel_menlow_attribute pos, next;
	466
	467	mutex_lock(&intel_menlow_attr_lock);
	468	list_for_each_entry_safe(pos, next, &intel_menlow_attr_list, node) {
	469	list_del(&pos->node);
	470	device_remove_file(pos->device, &pos->attr);
	471	kfree(pos);
	472	}
	473	mutex_unlock(&intel_menlow_attr_lock);
	474
	475	return;
	476	}
	477
	478	static int __init intel_menlow_module_init(void)
	479	{
	480	int result = -ENODEV;
	481	acpi_status status;
27663c58	482	unsigned long long enable;
cc0573b3 TS	483
	484	if (acpi_disabled)
	485	return result;
	486
	487	/* Looking for the \_TZ.GSTS method */
	488	status = acpi_evaluate_integer(NULL, BIOS_ENABLED, NULL, &enable);
	489	if (ACPI_FAILURE(status) \|\| !enable)
	490	return -ENODEV;
	491
	492	/* Looking for ACPI device MEM0 with hardware id INT0002 */
	493	result = acpi_bus_register_driver(&intel_menlow_memory_driver);
	494	if (result)
	495	return result;
	496
	497	/* Looking for sensors in each ACPI thermal zone */
	498	status = acpi_walk_namespace(ACPI_TYPE_THERMAL, ACPI_ROOT_OBJECT,
	499	ACPI_UINT32_MAX,
2263576c	500	intel_menlow_register_sensor, NULL, NULL, NULL);
4b30fbca AL	501	if (ACPI_FAILURE(status)) {
4b30fbca AL	502	acpi_bus_unregister_driver(&intel_menlow_memory_driver);
cc0573b3	503	return -ENODEV;
4b30fbca	504	}
cc0573b3 TS	505
	506	return 0;
	507	}
	508
	509	static void __exit intel_menlow_module_exit(void)
	510	{
	511	acpi_bus_unregister_driver(&intel_menlow_memory_driver);
	512	intel_menlow_unregister_sensor();
	513	}
	514
	515	module_init(intel_menlow_module_init);
	516	module_exit(intel_menlow_module_exit);