[mirror_ubuntu-zesty-kernel.git] / drivers / acpi / fan.c

/*
 *  acpi_fan.c - ACPI Fan Driver ($Revision: 29 $)
 *
 *  Copyright (C) 2001, 2002 Andy Grover <andrew.grover@intel.com>
 *  Copyright (C) 2001, 2002 Paul Diefenbaugh <paul.s.diefenbaugh@intel.com>
 *
 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
 *
 *  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.
 *
 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
 */

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/types.h>
#include <linux/uaccess.h>
#include <linux/thermal.h>
#include <linux/acpi.h>
#include <linux/platform_device.h>
#include <linux/sort.h>

MODULE_AUTHOR("Paul Diefenbaugh");
MODULE_DESCRIPTION("ACPI Fan Driver");
MODULE_LICENSE("GPL");

static int acpi_fan_probe(struct platform_device *pdev);
static int acpi_fan_remove(struct platform_device *pdev);

static const struct acpi_device_id fan_device_ids[] = {
	{"PNP0C0B", 0},
	{"INT3404", 0},
	{"", 0},
};
MODULE_DEVICE_TABLE(acpi, fan_device_ids);

#ifdef CONFIG_PM_SLEEP
static int acpi_fan_suspend(struct device *dev);
static int acpi_fan_resume(struct device *dev);
static const struct dev_pm_ops acpi_fan_pm = {
	.resume = acpi_fan_resume,
	.freeze = acpi_fan_suspend,
	.thaw = acpi_fan_resume,
	.restore = acpi_fan_resume,
};
#define FAN_PM_OPS_PTR (&acpi_fan_pm)
#else
#define FAN_PM_OPS_PTR NULL
#endif

struct acpi_fan_fps {
	u64 control;
	u64 trip_point;
	u64 speed;
	u64 noise_level;
	u64 power;
};

struct acpi_fan_fif {
	u64 revision;
	u64 fine_grain_ctrl;
	u64 step_size;
	u64 low_speed_notification;
};

struct acpi_fan {
	bool acpi4;
	struct acpi_fan_fif fif;
	struct acpi_fan_fps *fps;
	int fps_count;
	struct thermal_cooling_device *cdev;
};

static struct platform_driver acpi_fan_driver = {
	.probe = acpi_fan_probe,
	.remove = acpi_fan_remove,
	.driver = {
		.name = "acpi-fan",
		.acpi_match_table = fan_device_ids,
		.pm = FAN_PM_OPS_PTR,
	},
};

/* thermal cooling device callbacks */
static int fan_get_max_state(struct thermal_cooling_device *cdev, unsigned long
			     *state)
{
	struct acpi_device *device = cdev->devdata;
	struct acpi_fan *fan = acpi_driver_data(device);

	if (fan->acpi4)
		*state = fan->fps_count - 1;
	else
		*state = 1;
	return 0;
}

static int fan_get_state_acpi4(struct acpi_device *device, unsigned long *state)
{
	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
	struct acpi_fan *fan = acpi_driver_data(device);
	union acpi_object *obj;
	acpi_status status;
	int control, i;

	status = acpi_evaluate_object(device->handle, "_FST", NULL, &buffer);
	if (ACPI_FAILURE(status)) {
		dev_err(&device->dev, "Get fan state failed\n");
		return status;
	}

	obj = buffer.pointer;
	if (!obj || obj->type != ACPI_TYPE_PACKAGE ||
	    obj->package.count != 3 ||
	    obj->package.elements[1].type != ACPI_TYPE_INTEGER) {
		dev_err(&device->dev, "Invalid _FST data\n");
		status = -EINVAL;
		goto err;
	}

	control = obj->package.elements[1].integer.value;
	for (i = 0; i < fan->fps_count; i++) {
		/*
		 * When Fine Grain Control is set, return the state
		 * corresponding to maximum fan->fps[i].control
		 * value compared to the current speed. Here the
		 * fan->fps[] is sorted array with increasing speed.
		 */
		if (fan->fif.fine_grain_ctrl && control < fan->fps[i].control) {
			i = (i > 0) ? i - 1 : 0;
			break;
		} else if (control == fan->fps[i].control) {
			break;
		}
	}
	if (i == fan->fps_count) {
		dev_dbg(&device->dev, "Invalid control value returned\n");
		status = -EINVAL;
		goto err;
	}

	*state = i;

err:
	kfree(obj);
	return status;
}

static int fan_get_state(struct acpi_device *device, unsigned long *state)
{
	int result;
	int acpi_state = ACPI_STATE_D0;

	result = acpi_device_update_power(device, &acpi_state);
	if (result)
		return result;

	*state = acpi_state == ACPI_STATE_D3_COLD
			|| acpi_state == ACPI_STATE_D3_HOT ?
		0 : (acpi_state == ACPI_STATE_D0 ? 1 : -1);
	return 0;
}

static int fan_get_cur_state(struct thermal_cooling_device *cdev, unsigned long
			     *state)
{
	struct acpi_device *device = cdev->devdata;
	struct acpi_fan *fan = acpi_driver_data(device);

	if (fan->acpi4)
		return fan_get_state_acpi4(device, state);
	else
		return fan_get_state(device, state);
}

static int fan_set_state(struct acpi_device *device, unsigned long state)
{
	if (state != 0 && state != 1)
		return -EINVAL;

	return acpi_device_set_power(device,
				     state ? ACPI_STATE_D0 : ACPI_STATE_D3_COLD);
}

static int fan_set_state_acpi4(struct acpi_device *device, unsigned long state)
{
	struct acpi_fan *fan = acpi_driver_data(device);
	acpi_status status;

	if (state >= fan->fps_count)
		return -EINVAL;

	status = acpi_execute_simple_method(device->handle, "_FSL",
					    fan->fps[state].control);
	if (ACPI_FAILURE(status)) {
		dev_dbg(&device->dev, "Failed to set state by _FSL\n");
		return status;
	}

	return 0;
}

static int
fan_set_cur_state(struct thermal_cooling_device *cdev, unsigned long state)
{
	struct acpi_device *device = cdev->devdata;
	struct acpi_fan *fan = acpi_driver_data(device);

	if (fan->acpi4)
		return fan_set_state_acpi4(device, state);
	else
		return fan_set_state(device, state);
 }

static const struct thermal_cooling_device_ops fan_cooling_ops = {
	.get_max_state = fan_get_max_state,
	.get_cur_state = fan_get_cur_state,
	.set_cur_state = fan_set_cur_state,
};

/* --------------------------------------------------------------------------
 *                               Driver Interface
 * --------------------------------------------------------------------------
*/

static bool acpi_fan_is_acpi4(struct acpi_device *device)
{
	return acpi_has_method(device->handle, "_FIF") &&
	       acpi_has_method(device->handle, "_FPS") &&
	       acpi_has_method(device->handle, "_FSL") &&
	       acpi_has_method(device->handle, "_FST");
}

static int acpi_fan_get_fif(struct acpi_device *device)
{
	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
	struct acpi_fan *fan = acpi_driver_data(device);
	struct acpi_buffer format = { sizeof("NNNN"), "NNNN" };
	struct acpi_buffer fif = { sizeof(fan->fif), &fan->fif };
	union acpi_object *obj;
	acpi_status status;

	status = acpi_evaluate_object(device->handle, "_FIF", NULL, &buffer);
	if (ACPI_FAILURE(status))
		return status;

	obj = buffer.pointer;
	if (!obj || obj->type != ACPI_TYPE_PACKAGE) {
		dev_err(&device->dev, "Invalid _FIF data\n");
		status = -EINVAL;
		goto err;
	}

	status = acpi_extract_package(obj, &format, &fif);
	if (ACPI_FAILURE(status)) {
		dev_err(&device->dev, "Invalid _FIF element\n");
		status = -EINVAL;
	}

err:
	kfree(obj);
	return status;
}

static int acpi_fan_speed_cmp(const void *a, const void *b)
{
	const struct acpi_fan_fps *fps1 = a;
	const struct acpi_fan_fps *fps2 = b;
	return fps1->speed - fps2->speed;
}

static int acpi_fan_get_fps(struct acpi_device *device)
{
	struct acpi_fan *fan = acpi_driver_data(device);
	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
	union acpi_object *obj;
	acpi_status status;
	int i;

	status = acpi_evaluate_object(device->handle, "_FPS", NULL, &buffer);
	if (ACPI_FAILURE(status))
		return status;

	obj = buffer.pointer;
	if (!obj || obj->type != ACPI_TYPE_PACKAGE || obj->package.count < 2) {
		dev_err(&device->dev, "Invalid _FPS data\n");
		status = -EINVAL;
		goto err;
	}

	fan->fps_count = obj->package.count - 1; /* minus revision field */
	fan->fps = devm_kzalloc(&device->dev,
				fan->fps_count * sizeof(struct acpi_fan_fps),
				GFP_KERNEL);
	if (!fan->fps) {
		dev_err(&device->dev, "Not enough memory\n");
		status = -ENOMEM;
		goto err;
	}
	for (i = 0; i < fan->fps_count; i++) {
		struct acpi_buffer format = { sizeof("NNNNN"), "NNNNN" };
		struct acpi_buffer fps = { sizeof(fan->fps[i]), &fan->fps[i] };
		status = acpi_extract_package(&obj->package.elements[i + 1],
					      &format, &fps);
		if (ACPI_FAILURE(status)) {
			dev_err(&device->dev, "Invalid _FPS element\n");
			break;
		}
	}

	/* sort the state array according to fan speed in increase order */
	sort(fan->fps, fan->fps_count, sizeof(*fan->fps),
	     acpi_fan_speed_cmp, NULL);

err:
	kfree(obj);
	return status;
}

static int acpi_fan_probe(struct platform_device *pdev)
{
	int result = 0;
	struct thermal_cooling_device *cdev;
	struct acpi_fan *fan;
	struct acpi_device *device = ACPI_COMPANION(&pdev->dev);
	char *name;

	fan = devm_kzalloc(&pdev->dev, sizeof(*fan), GFP_KERNEL);
	if (!fan) {
		dev_err(&device->dev, "No memory for fan\n");
		return -ENOMEM;
	}
	device->driver_data = fan;
	platform_set_drvdata(pdev, fan);

	if (acpi_fan_is_acpi4(device)) {
		if (acpi_fan_get_fif(device) || acpi_fan_get_fps(device))
			goto end;
		fan->acpi4 = true;
	} else {
		result = acpi_device_update_power(device, NULL);
		if (result) {
			dev_err(&device->dev, "Failed to set initial power state\n");
			goto end;
		}
	}

	if (!strncmp(pdev->name, "PNP0C0B", strlen("PNP0C0B")))
		name = "Fan";
	else
		name = acpi_device_bid(device);

	cdev = thermal_cooling_device_register(name, device,
						&fan_cooling_ops);
	if (IS_ERR(cdev)) {
		result = PTR_ERR(cdev);
		goto end;
	}

	dev_dbg(&pdev->dev, "registered as cooling_device%d\n", cdev->id);

	fan->cdev = cdev;
	result = sysfs_create_link(&pdev->dev.kobj,
				   &cdev->device.kobj,
				   "thermal_cooling");
	if (result)
		dev_err(&pdev->dev, "Failed to create sysfs link 'thermal_cooling'\n");

	result = sysfs_create_link(&cdev->device.kobj,
				   &pdev->dev.kobj,
				   "device");
	if (result)
		dev_err(&pdev->dev, "Failed to create sysfs link 'device'\n");

end:
	return result;
}

static int acpi_fan_remove(struct platform_device *pdev)
{
	struct acpi_fan *fan = platform_get_drvdata(pdev);

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

	return 0;
}

#ifdef CONFIG_PM_SLEEP
static int acpi_fan_suspend(struct device *dev)
{
	struct acpi_fan *fan = dev_get_drvdata(dev);
	if (fan->acpi4)
		return 0;

	acpi_device_set_power(ACPI_COMPANION(dev), ACPI_STATE_D0);

	return AE_OK;
}

static int acpi_fan_resume(struct device *dev)
{
	int result;
	struct acpi_fan *fan = dev_get_drvdata(dev);

	if (fan->acpi4)
		return 0;

	result = acpi_device_update_power(ACPI_COMPANION(dev), NULL);
	if (result)
		dev_err(dev, "Error updating fan power state\n");

	return result;
}
#endif

module_platform_driver(acpi_fan_driver);
Commit	Line	Data
1da177e4 LT	1	/*
	2	* acpi_fan.c - ACPI Fan Driver ($Revision: 29 $)
	3	*
	4	* Copyright (C) 2001, 2002 Andy Grover <andrew.grover@intel.com>
	5	* Copyright (C) 2001, 2002 Paul Diefenbaugh <paul.s.diefenbaugh@intel.com>
	6	*
	7	* ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
	8	*
	9	* This program is free software; you can redistribute it and/or modify
	10	* it under the terms of the GNU General Public License as published by
	11	* the Free Software Foundation; either version 2 of the License, or (at
	12	* your option) any later version.
	13	*
	14	* This program is distributed in the hope that it will be useful, but
	15	* WITHOUT ANY WARRANTY; without even the implied warranty of
	16	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
	17	* General Public License for more details.
	18	*
1da177e4 LT	19	* ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
	20	*/
	21
	22	#include <linux/kernel.h>
	23	#include <linux/module.h>
	24	#include <linux/init.h>
	25	#include <linux/types.h>
88989fd2	26	#include <linux/uaccess.h>
05a83d97	27	#include <linux/thermal.h>
8b48463f	28	#include <linux/acpi.h>
19593a1f	29	#include <linux/platform_device.h>
9519a635	30	#include <linux/sort.h>
1da177e4	31
f52fd66d	32	MODULE_AUTHOR("Paul Diefenbaugh");
7cda93e0	33	MODULE_DESCRIPTION("ACPI Fan Driver");
1da177e4 LT	34	MODULE_LICENSE("GPL");
1da177e4 LT	35
19593a1f AL	36	static int acpi_fan_probe(struct platform_device *pdev);
19593a1f AL	37	static int acpi_fan_remove(struct platform_device *pdev);
1da177e4	38
1ba90e3a TR	39	static const struct acpi_device_id fan_device_ids[] = {
1ba90e3a TR	40	{"PNP0C0B", 0},
d806c6e9	41	{"INT3404", 0},
1ba90e3a TR	42	{"", 0},
	43	};
	44	MODULE_DEVICE_TABLE(acpi, fan_device_ids);
	45
90692404	46	#ifdef CONFIG_PM_SLEEP
62fcbdd9 RW	47	static int acpi_fan_suspend(struct device *dev);
62fcbdd9 RW	48	static int acpi_fan_resume(struct device *dev);
1d751584	49	static const struct dev_pm_ops acpi_fan_pm = {
b9b8515f AL	50	.resume = acpi_fan_resume,
	51	.freeze = acpi_fan_suspend,
	52	.thaw = acpi_fan_resume,
	53	.restore = acpi_fan_resume,
	54	};
	55	#define FAN_PM_OPS_PTR (&acpi_fan_pm)
b108e0ea	56	#else
b9b8515f	57	#define FAN_PM_OPS_PTR NULL
90692404	58	#endif
62fcbdd9	59
9519a635 AL	60	struct acpi_fan_fps {
	61	u64 control;
	62	u64 trip_point;
	63	u64 speed;
	64	u64 noise_level;
	65	u64 power;
	66	};
	67
	68	struct acpi_fan_fif {
	69	u64 revision;
	70	u64 fine_grain_ctrl;
	71	u64 step_size;
	72	u64 low_speed_notification;
	73	};
	74
	75	struct acpi_fan {
	76	bool acpi4;
	77	struct acpi_fan_fif fif;
	78	struct acpi_fan_fps *fps;
	79	int fps_count;
	80	struct thermal_cooling_device *cdev;
	81	};
	82
19593a1f AL	83	static struct platform_driver acpi_fan_driver = {
	84	.probe = acpi_fan_probe,
	85	.remove = acpi_fan_remove,
	86	.driver = {
	87	.name = "acpi-fan",
	88	.acpi_match_table = fan_device_ids,
	89	.pm = FAN_PM_OPS_PTR,
	90	},
1da177e4 LT	91	};
1da177e4 LT	92
05a83d97	93	/* thermal cooling device callbacks */
6503e5df MG	94	static int fan_get_max_state(struct thermal_cooling_device *cdev, unsigned long
6503e5df MG	95	*state)
05a83d97	96	{
9519a635 AL	97	struct acpi_device *device = cdev->devdata;
	98	struct acpi_fan *fan = acpi_driver_data(device);
	99
	100	if (fan->acpi4)
	101	*state = fan->fps_count - 1;
	102	else
	103	*state = 1;
6503e5df	104	return 0;
05a83d97 ZR	105	}
05a83d97 ZR	106
9519a635 AL	107	static int fan_get_state_acpi4(struct acpi_device device, unsigned long state)
	108	{
	109	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
	110	struct acpi_fan *fan = acpi_driver_data(device);
	111	union acpi_object *obj;
	112	acpi_status status;
	113	int control, i;
	114
	115	status = acpi_evaluate_object(device->handle, "_FST", NULL, &buffer);
	116	if (ACPI_FAILURE(status)) {
	117	dev_err(&device->dev, "Get fan state failed\n");
	118	return status;
	119	}
	120
	121	obj = buffer.pointer;
	122	if (!obj \|\| obj->type != ACPI_TYPE_PACKAGE \|\|
	123	obj->package.count != 3 \|\|
	124	obj->package.elements[1].type != ACPI_TYPE_INTEGER) {
	125	dev_err(&device->dev, "Invalid _FST data\n");
	126	status = -EINVAL;
	127	goto err;
	128	}
	129
	130	control = obj->package.elements[1].integer.value;
	131	for (i = 0; i < fan->fps_count; i++) {
84baf172 SP	132	/*
	133	* When Fine Grain Control is set, return the state
	134	* corresponding to maximum fan->fps[i].control
	135	* value compared to the current speed. Here the
	136	* fan->fps[] is sorted array with increasing speed.
	137	*/
	138	if (fan->fif.fine_grain_ctrl && control < fan->fps[i].control) {
	139	i = (i > 0) ? i - 1 : 0;
9519a635	140	break;
84baf172 SP	141	} else if (control == fan->fps[i].control) {
	142	break;
	143	}
9519a635 AL	144	}
	145	if (i == fan->fps_count) {
	146	dev_dbg(&device->dev, "Invalid control value returned\n");
	147	status = -EINVAL;
	148	goto err;
	149	}
	150
	151	*state = i;
	152
	153	err:
	154	kfree(obj);
	155	return status;
	156	}
	157
	158	static int fan_get_state(struct acpi_device device, unsigned long state)
05a83d97	159	{
05a83d97	160	int result;
85eb9827	161	int acpi_state = ACPI_STATE_D0;
05a83d97	162
2bb3a2bf	163	result = acpi_device_update_power(device, &acpi_state);
05a83d97 ZR	164	if (result)
	165	return result;
	166
20dacb71 RW	167	*state = acpi_state == ACPI_STATE_D3_COLD
	168	\|\| acpi_state == ACPI_STATE_D3_HOT ?
	169	0 : (acpi_state == ACPI_STATE_D0 ? 1 : -1);
6503e5df	170	return 0;
05a83d97 ZR	171	}
05a83d97 ZR	172
9519a635 AL	173	static int fan_get_cur_state(struct thermal_cooling_device *cdev, unsigned long
9519a635 AL	174	*state)
05a83d97 ZR	175	{
05a83d97 ZR	176	struct acpi_device *device = cdev->devdata;
9519a635	177	struct acpi_fan *fan = acpi_driver_data(device);
05a83d97	178
9519a635 AL	179	if (fan->acpi4)
	180	return fan_get_state_acpi4(device, state);
	181	else
	182	return fan_get_state(device, state);
	183	}
05a83d97	184
9519a635 AL	185	static int fan_set_state(struct acpi_device *device, unsigned long state)
	186	{
	187	if (state != 0 && state != 1)
05a83d97 ZR	188	return -EINVAL;
05a83d97 ZR	189
9519a635 AL	190	return acpi_device_set_power(device,
	191	state ? ACPI_STATE_D0 : ACPI_STATE_D3_COLD);
	192	}
05a83d97	193
9519a635 AL	194	static int fan_set_state_acpi4(struct acpi_device *device, unsigned long state)
	195	{
	196	struct acpi_fan *fan = acpi_driver_data(device);
	197	acpi_status status;
	198
	199	if (state >= fan->fps_count)
	200	return -EINVAL;
	201
	202	status = acpi_execute_simple_method(device->handle, "_FSL",
	203	fan->fps[state].control);
	204	if (ACPI_FAILURE(status)) {
	205	dev_dbg(&device->dev, "Failed to set state by _FSL\n");
	206	return status;
	207	}
	208
	209	return 0;
05a83d97 ZR	210	}
05a83d97 ZR	211
9519a635 AL	212	static int
	213	fan_set_cur_state(struct thermal_cooling_device *cdev, unsigned long state)
	214	{
	215	struct acpi_device *device = cdev->devdata;
	216	struct acpi_fan *fan = acpi_driver_data(device);
	217
	218	if (fan->acpi4)
	219	return fan_set_state_acpi4(device, state);
	220	else
	221	return fan_set_state(device, state);
	222	}
	223
9c8b04be	224	static const struct thermal_cooling_device_ops fan_cooling_ops = {
05a83d97 ZR	225	.get_max_state = fan_get_max_state,
	226	.get_cur_state = fan_get_cur_state,
	227	.set_cur_state = fan_set_cur_state,
	228	};
	229
1da177e4	230	/* --------------------------------------------------------------------------
88989fd2 SM	231	* Driver Interface
	232	* --------------------------------------------------------------------------
	233	*/
1da177e4	234
9519a635	235	static bool acpi_fan_is_acpi4(struct acpi_device *device)
1da177e4	236	{
9519a635 AL	237	return acpi_has_method(device->handle, "_FIF") &&
	238	acpi_has_method(device->handle, "_FPS") &&
	239	acpi_has_method(device->handle, "_FSL") &&
	240	acpi_has_method(device->handle, "_FST");
	241	}
1da177e4	242
9519a635 AL	243	static int acpi_fan_get_fif(struct acpi_device *device)
	244	{
	245	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
	246	struct acpi_fan *fan = acpi_driver_data(device);
	247	struct acpi_buffer format = { sizeof("NNNN"), "NNNN" };
	248	struct acpi_buffer fif = { sizeof(fan->fif), &fan->fif };
	249	union acpi_object *obj;
	250	acpi_status status;
	251
	252	status = acpi_evaluate_object(device->handle, "_FIF", NULL, &buffer);
	253	if (ACPI_FAILURE(status))
	254	return status;
	255
	256	obj = buffer.pointer;
	257	if (!obj \|\| obj->type != ACPI_TYPE_PACKAGE) {
	258	dev_err(&device->dev, "Invalid _FIF data\n");
	259	status = -EINVAL;
	260	goto err;
	261	}
1da177e4	262
9519a635 AL	263	status = acpi_extract_package(obj, &format, &fif);
	264	if (ACPI_FAILURE(status)) {
	265	dev_err(&device->dev, "Invalid _FIF element\n");
	266	status = -EINVAL;
	267	}
1da177e4	268
9519a635 AL	269	err:
	270	kfree(obj);
	271	return status;
	272	}
	273
	274	static int acpi_fan_speed_cmp(const void a, const void b)
	275	{
	276	const struct acpi_fan_fps *fps1 = a;
	277	const struct acpi_fan_fps *fps2 = b;
	278	return fps1->speed - fps2->speed;
	279	}
	280
	281	static int acpi_fan_get_fps(struct acpi_device *device)
	282	{
	283	struct acpi_fan *fan = acpi_driver_data(device);
	284	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
	285	union acpi_object *obj;
	286	acpi_status status;
	287	int i;
	288
	289	status = acpi_evaluate_object(device->handle, "_FPS", NULL, &buffer);
	290	if (ACPI_FAILURE(status))
	291	return status;
	292
	293	obj = buffer.pointer;
	294	if (!obj \|\| obj->type != ACPI_TYPE_PACKAGE \|\| obj->package.count < 2) {
	295	dev_err(&device->dev, "Invalid _FPS data\n");
	296	status = -EINVAL;
	297	goto err;
	298	}
	299
	300	fan->fps_count = obj->package.count - 1; /* minus revision field */
	301	fan->fps = devm_kzalloc(&device->dev,
	302	fan->fps_count * sizeof(struct acpi_fan_fps),
	303	GFP_KERNEL);
	304	if (!fan->fps) {
	305	dev_err(&device->dev, "Not enough memory\n");
	306	status = -ENOMEM;
	307	goto err;
	308	}
	309	for (i = 0; i < fan->fps_count; i++) {
	310	struct acpi_buffer format = { sizeof("NNNNN"), "NNNNN" };
	311	struct acpi_buffer fps = { sizeof(fan->fps[i]), &fan->fps[i] };
	312	status = acpi_extract_package(&obj->package.elements[i + 1],
	313	&format, &fps);
	314	if (ACPI_FAILURE(status)) {
	315	dev_err(&device->dev, "Invalid _FPS element\n");
	316	break;
	317	}
	318	}
	319
	320	/* sort the state array according to fan speed in increase order */
	321	sort(fan->fps, fan->fps_count, sizeof(*fan->fps),
	322	acpi_fan_speed_cmp, NULL);
	323
	324	err:
	325	kfree(obj);
	326	return status;
	327	}
	328
19593a1f	329	static int acpi_fan_probe(struct platform_device *pdev)
1da177e4	330	{
4be44fcd	331	int result = 0;
05a83d97	332	struct thermal_cooling_device *cdev;
9519a635	333	struct acpi_fan *fan;
19593a1f	334	struct acpi_device *device = ACPI_COMPANION(&pdev->dev);
bbb16fef	335	char *name;
1da177e4	336
9519a635 AL	337	fan = devm_kzalloc(&pdev->dev, sizeof(*fan), GFP_KERNEL);
	338	if (!fan) {
	339	dev_err(&device->dev, "No memory for fan\n");
	340	return -ENOMEM;
	341	}
	342	device->driver_data = fan;
	343	platform_set_drvdata(pdev, fan);
	344
	345	if (acpi_fan_is_acpi4(device)) {
	346	if (acpi_fan_get_fif(device) \|\| acpi_fan_get_fps(device))
	347	goto end;
	348	fan->acpi4 = true;
	349	} else {
	350	result = acpi_device_update_power(device, NULL);
	351	if (result) {
f9727999	352	dev_err(&device->dev, "Failed to set initial power state\n");
9519a635 AL	353	goto end;
9519a635 AL	354	}
1da177e4 LT	355	}
1da177e4 LT	356
bbb16fef SP	357	if (!strncmp(pdev->name, "PNP0C0B", strlen("PNP0C0B")))
	358	name = "Fan";
	359	else
	360	name = acpi_device_bid(device);
	361
	362	cdev = thermal_cooling_device_register(name, device,
05a83d97	363	&fan_cooling_ops);
19b36780 TS	364	if (IS_ERR(cdev)) {
	365	result = PTR_ERR(cdev);
	366	goto end;
	367	}
9030062f	368
19593a1f	369	dev_dbg(&pdev->dev, "registered as cooling_device%d\n", cdev->id);
9030062f	370
9519a635	371	fan->cdev = cdev;
19593a1f	372	result = sysfs_create_link(&pdev->dev.kobj,
9030062f JL	373	&cdev->device.kobj,
	374	"thermal_cooling");
	375	if (result)
8264fce6	376	dev_err(&pdev->dev, "Failed to create sysfs link 'thermal_cooling'\n");
9030062f JL	377
9030062f JL	378	result = sysfs_create_link(&cdev->device.kobj,
19593a1f	379	&pdev->dev.kobj,
9030062f JL	380	"device");
9030062f JL	381	if (result)
8264fce6	382	dev_err(&pdev->dev, "Failed to create sysfs link 'device'\n");
1da177e4	383
568b6ad8	384	end:
d550d98d	385	return result;
1da177e4 LT	386	}
1da177e4 LT	387
19593a1f	388	static int acpi_fan_remove(struct platform_device *pdev)
1da177e4	389	{
9519a635	390	struct acpi_fan *fan = platform_get_drvdata(pdev);
1da177e4	391
19593a1f	392	sysfs_remove_link(&pdev->dev.kobj, "thermal_cooling");
9519a635 AL	393	sysfs_remove_link(&fan->cdev->device.kobj, "device");
9519a635 AL	394	thermal_cooling_device_unregister(fan->cdev);
1da177e4	395
d550d98d	396	return 0;
1da177e4 LT	397	}
1da177e4 LT	398
90692404	399	#ifdef CONFIG_PM_SLEEP
62fcbdd9	400	static int acpi_fan_suspend(struct device *dev)
ec68373c	401	{
9519a635 AL	402	struct acpi_fan *fan = dev_get_drvdata(dev);
	403	if (fan->acpi4)
	404	return 0;
ec68373c	405
19593a1f	406	acpi_device_set_power(ACPI_COMPANION(dev), ACPI_STATE_D0);
ec68373c LB	407
	408	return AE_OK;
	409	}
	410
62fcbdd9	411	static int acpi_fan_resume(struct device *dev)
ec68373c	412	{
488a76c5	413	int result;
9519a635	414	struct acpi_fan *fan = dev_get_drvdata(dev);
ec68373c	415
9519a635 AL	416	if (fan->acpi4)
9519a635 AL	417	return 0;
ec68373c	418
19593a1f	419	result = acpi_device_update_power(ACPI_COMPANION(dev), NULL);
488a76c5	420	if (result)
88989fd2	421	dev_err(dev, "Error updating fan power state\n");
ec68373c LB	422
	423	return result;
	424	}
90692404	425	#endif
ec68373c	426
19593a1f	427	module_platform_driver(acpi_fan_driver);