/* * INT3400 thermal driver * * Copyright (C) 2014, Intel Corporation * Authors: Zhang Rui * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as * published by the Free Software Foundation. * */ #include #include #include #include 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; }; enum int3400_thermal_uuid { INT3400_THERMAL_PASSIVE_1, INT3400_THERMAL_PASSIVE_2, INT3400_THERMAL_ACTIVE, INT3400_THERMAL_CRITICAL, INT3400_THERMAL_COOLING_MODE, INT3400_THERMAL_MAXIMUM_UUID, }; static u8 *int3400_thermal_uuids[INT3400_THERMAL_MAXIMUM_UUID] = { "42A441D6-AE6A-462b-A84B-4A8CE79027D3", "9E04115A-AE87-4D1C-9500-0F3E340BFE75", "3A95C389-E4B8-4629-A526-C52C88626BAE", "97C68AE7-15FA-499c-B8C9-5DA81D606E0A", "16CAF1B7-DD38-40ed-B1C1-1B8A1913D531", }; struct int3400_thermal_priv { struct acpi_device *adev; struct thermal_zone_device *thermal; int mode; int art_count; struct art *arts; int trt_count; struct trt *trts; u8 uuid_bitmap; }; static int int3400_thermal_get_uuids(struct int3400_thermal_priv *priv) { struct acpi_buffer buf = { ACPI_ALLOCATE_BUFFER, NULL}; union acpi_object *obja, *objb; int i, j; int result = 0; acpi_status status; status = acpi_evaluate_object(priv->adev->handle, "IDSP", NULL, &buf); if (ACPI_FAILURE(status)) return -ENODEV; obja = (union acpi_object *)buf.pointer; if (obja->type != ACPI_TYPE_PACKAGE) { result = -EINVAL; goto end; } for (i = 0; i < obja->package.count; i++) { objb = &obja->package.elements[i]; if (objb->type != ACPI_TYPE_BUFFER) { result = -EINVAL; goto end; } /* UUID must be 16 bytes */ if (objb->buffer.length != 16) { result = -EINVAL; goto end; } for (j = 0; j < INT3400_THERMAL_MAXIMUM_UUID; j++) { u8 uuid[16]; acpi_str_to_uuid(int3400_thermal_uuids[j], uuid); if (!strncmp(uuid, objb->buffer.pointer, 16)) { priv->uuid_bitmap |= (1 << j); break; } } } end: kfree(buf.pointer); return result; } static int int3400_thermal_run_osc(acpi_handle handle, enum int3400_thermal_uuid uuid, bool enable) { u32 ret, buf[2]; acpi_status status; int result = 0; struct acpi_osc_context context = { .uuid_str = int3400_thermal_uuids[uuid], .rev = 1, .cap.length = 8, }; buf[OSC_QUERY_DWORD] = 0; buf[OSC_SUPPORT_DWORD] = enable; context.cap.pointer = buf; status = acpi_run_osc(handle, &context); if (ACPI_SUCCESS(status)) { ret = *((u32 *)(context.ret.pointer + 4)); if (ret != enable) result = -EPERM; } else result = -EPERM; kfree(context.ret.pointer); 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) { *temp = 20 * 1000; /* faked temp sensor with 20C */ return 0; } static int int3400_thermal_get_mode(struct thermal_zone_device *thermal, enum thermal_device_mode *mode) { struct int3400_thermal_priv *priv = thermal->devdata; if (!priv) return -EINVAL; *mode = priv->mode; return 0; } static int int3400_thermal_set_mode(struct thermal_zone_device *thermal, enum thermal_device_mode mode) { struct int3400_thermal_priv *priv = thermal->devdata; bool enable; int result = 0; if (!priv) return -EINVAL; if (mode == THERMAL_DEVICE_ENABLED) enable = true; else if (mode == THERMAL_DEVICE_DISABLED) enable = false; else return -EINVAL; if (enable != priv->mode) { priv->mode = enable; /* currently, only PASSIVE COOLING is supported */ result = int3400_thermal_run_osc(priv->adev->handle, INT3400_THERMAL_PASSIVE_1, enable); } return result; } static struct thermal_zone_device_ops int3400_thermal_ops = { .get_temp = int3400_thermal_get_temp, }; static struct thermal_zone_params int3400_thermal_params = { .governor_name = "user_space", .no_hwmon = true, }; static int int3400_thermal_probe(struct platform_device *pdev) { struct acpi_device *adev = ACPI_COMPANION(&pdev->dev); struct int3400_thermal_priv *priv; int result; if (!adev) return -ENODEV; priv = kzalloc(sizeof(struct int3400_thermal_priv), GFP_KERNEL); if (!priv) return -ENOMEM; priv->adev = adev; result = int3400_thermal_get_uuids(priv); if (result) goto free_priv; result = parse_art(priv); if (result) goto free_priv; result = parse_trt(priv); if (result) goto free_art; platform_set_drvdata(pdev, priv); if (priv->uuid_bitmap & 1 << INT3400_THERMAL_PASSIVE_1) { int3400_thermal_ops.get_mode = int3400_thermal_get_mode; int3400_thermal_ops.set_mode = int3400_thermal_set_mode; } priv->thermal = thermal_zone_device_register("INT3400 Thermal", 0, 0, priv, &int3400_thermal_ops, &int3400_thermal_params, 0, 0); if (IS_ERR(priv->thermal)) { result = PTR_ERR(priv->thermal); goto free_trt; } return 0; free_trt: kfree(priv->trts); free_art: kfree(priv->arts); free_priv: kfree(priv); return result; } static int int3400_thermal_remove(struct platform_device *pdev) { struct int3400_thermal_priv *priv = platform_get_drvdata(pdev); thermal_zone_device_unregister(priv->thermal); kfree(priv->trts); kfree(priv->arts); kfree(priv); return 0; } static const struct acpi_device_id int3400_thermal_match[] = { {"INT3400", 0}, {} }; MODULE_DEVICE_TABLE(acpi, int3400_thermal_match); static struct platform_driver int3400_thermal_driver = { .probe = int3400_thermal_probe, .remove = int3400_thermal_remove, .driver = { .name = "int3400 thermal", .owner = THIS_MODULE, .acpi_match_table = ACPI_PTR(int3400_thermal_match), }, }; module_platform_driver(int3400_thermal_driver); MODULE_DESCRIPTION("INT3400 Thermal driver"); MODULE_AUTHOR("Zhang Rui "); MODULE_LICENSE("GPL");