Thermal: int3400_thermal: use acpi_thermal_rel parsing APIs

ACPI _TRT and _ART parsing code has been moved to acpi_thermal_rel such
that it can be used by other devices in the future. Use the parsing APIs
in acpi_thermal_rel.c instead.

Signed-off-by: Jacob Pan <jacob.jun.pan@linux.intel.com>
Signed-off-by: Zhang Rui <rui.zhang@intel.com>
This commit is contained in:
Jacob Pan 2014-06-12 08:08:07 -07:00 committed by Zhang Rui
parent 52b1c69d7e
commit 6306e68a63
1 changed files with 13 additions and 159 deletions

View File

@ -14,33 +14,7 @@
#include <linux/platform_device.h>
#include <linux/acpi.h>
#include <linux/thermal.h>
struct art {
acpi_handle source;
acpi_handle target;
u64 weight;
u64 ac0_max;
u64 ac1_max;
u64 ac2_max;
u64 ac3_max;
u64 ac4_max;
u64 ac5_max;
u64 ac6_max;
u64 ac7_max;
u64 ac8_max;
u64 ac9_max;
};
struct trt {
acpi_handle source;
acpi_handle target;
u64 influence;
u64 sampling_period;
u64 reverved1;
u64 reverved2;
u64 reverved3;
u64 reverved4;
};
#include "acpi_thermal_rel.h"
enum int3400_thermal_uuid {
INT3400_THERMAL_PASSIVE_1,
@ -68,6 +42,7 @@ struct int3400_thermal_priv {
int trt_count;
struct trt *trts;
u8 uuid_bitmap;
int rel_misc_dev_res;
};
static int int3400_thermal_get_uuids(struct int3400_thermal_priv *priv)
@ -146,136 +121,6 @@ static int int3400_thermal_run_osc(acpi_handle handle,
return result;
}
static int parse_art(struct int3400_thermal_priv *priv)
{
acpi_handle handle = priv->adev->handle;
acpi_status status;
int result = 0;
int i;
struct acpi_device *adev;
union acpi_object *p;
struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
struct acpi_buffer element = { 0, NULL };
struct acpi_buffer art_format = {
sizeof("RRNNNNNNNNNNN"), "RRNNNNNNNNNNN" };
if (!acpi_has_method(handle, "_ART"))
return 0;
status = acpi_evaluate_object(handle, "_ART", NULL, &buffer);
if (ACPI_FAILURE(status))
return -ENODEV;
p = buffer.pointer;
if (!p || (p->type != ACPI_TYPE_PACKAGE)) {
pr_err("Invalid _ART data\n");
result = -EFAULT;
goto end;
}
/* ignore p->package.elements[0], as this is _ART Revision field */
priv->art_count = p->package.count - 1;
priv->arts = kzalloc(sizeof(struct art) * priv->art_count, GFP_KERNEL);
if (!priv->arts) {
result = -ENOMEM;
goto end;
}
for (i = 0; i < priv->art_count; i++) {
struct art *art = &(priv->arts[i]);
element.length = sizeof(struct art);
element.pointer = art;
status = acpi_extract_package(&(p->package.elements[i + 1]),
&art_format, &element);
if (ACPI_FAILURE(status)) {
pr_err("Invalid _ART data");
result = -EFAULT;
kfree(priv->arts);
goto end;
}
result = acpi_bus_get_device(art->source, &adev);
if (!result)
acpi_create_platform_device(adev, NULL);
else
pr_warn("Failed to get source ACPI device\n");
result = acpi_bus_get_device(art->target, &adev);
if (!result)
acpi_create_platform_device(adev, NULL);
else
pr_warn("Failed to get source ACPI device\n");
}
end:
kfree(buffer.pointer);
return result;
}
static int parse_trt(struct int3400_thermal_priv *priv)
{
acpi_handle handle = priv->adev->handle;
acpi_status status;
int result = 0;
int i;
struct acpi_device *adev;
union acpi_object *p;
struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
struct acpi_buffer element = { 0, NULL };
struct acpi_buffer trt_format = { sizeof("RRNNNNNN"), "RRNNNNNN" };
if (!acpi_has_method(handle, "_TRT"))
return 0;
status = acpi_evaluate_object(handle, "_TRT", NULL, &buffer);
if (ACPI_FAILURE(status))
return -ENODEV;
p = buffer.pointer;
if (!p || (p->type != ACPI_TYPE_PACKAGE)) {
pr_err("Invalid _TRT data\n");
result = -EFAULT;
goto end;
}
priv->trt_count = p->package.count;
priv->trts = kzalloc(sizeof(struct trt) * priv->trt_count, GFP_KERNEL);
if (!priv->trts) {
result = -ENOMEM;
goto end;
}
for (i = 0; i < priv->trt_count; i++) {
struct trt *trt = &(priv->trts[i]);
element.length = sizeof(struct trt);
element.pointer = trt;
status = acpi_extract_package(&(p->package.elements[i]),
&trt_format, &element);
if (ACPI_FAILURE(status)) {
pr_err("Invalid _ART data");
result = -EFAULT;
kfree(priv->trts);
goto end;
}
result = acpi_bus_get_device(trt->source, &adev);
if (!result)
acpi_create_platform_device(adev, NULL);
else
pr_warn("Failed to get source ACPI device\n");
result = acpi_bus_get_device(trt->target, &adev);
if (!result)
acpi_create_platform_device(adev, NULL);
else
pr_warn("Failed to get target ACPI device\n");
}
end:
kfree(buffer.pointer);
return result;
}
static int int3400_thermal_get_temp(struct thermal_zone_device *thermal,
unsigned long *temp)
{
@ -350,11 +195,14 @@ static int int3400_thermal_probe(struct platform_device *pdev)
if (result)
goto free_priv;
result = parse_art(priv);
result = acpi_parse_art(priv->adev->handle, &priv->art_count,
&priv->arts, true);
if (result)
goto free_priv;
result = parse_trt(priv);
result = acpi_parse_trt(priv->adev->handle, &priv->trt_count,
&priv->trts, true);
if (result)
goto free_art;
@ -372,6 +220,9 @@ static int int3400_thermal_probe(struct platform_device *pdev)
goto free_trt;
}
priv->rel_misc_dev_res = acpi_thermal_rel_misc_device_add(
priv->adev->handle);
return 0;
free_trt:
kfree(priv->trts);
@ -386,6 +237,9 @@ static int int3400_thermal_remove(struct platform_device *pdev)
{
struct int3400_thermal_priv *priv = platform_get_drvdata(pdev);
if (!priv->rel_misc_dev_res)
acpi_thermal_rel_misc_device_remove(priv->adev->handle);
thermal_zone_device_unregister(priv->thermal);
kfree(priv->trts);
kfree(priv->arts);