/* acpi_thermal_rel.c driver for exporting ACPI thermal relationship * * Copyright (c) 2014 Intel Corp * * 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. * */ /* * Two functionalities included: * 1. Export _TRT, _ART, via misc device interface to the userspace. * 2. Provide parsing result to kernel drivers * */ #include #include #include #include #include #include #include #include #include #include "acpi_thermal_rel.h" static acpi_handle acpi_thermal_rel_handle; static DEFINE_SPINLOCK(acpi_thermal_rel_chrdev_lock); static int acpi_thermal_rel_chrdev_count; /* #times opened */ static int acpi_thermal_rel_chrdev_exclu; /* already open exclusive? */ static int acpi_thermal_rel_open(struct inode *inode, struct file *file) { spin_lock(&acpi_thermal_rel_chrdev_lock); if (acpi_thermal_rel_chrdev_exclu || (acpi_thermal_rel_chrdev_count && (file->f_flags & O_EXCL))) { spin_unlock(&acpi_thermal_rel_chrdev_lock); return -EBUSY; } if (file->f_flags & O_EXCL) acpi_thermal_rel_chrdev_exclu = 1; acpi_thermal_rel_chrdev_count++; spin_unlock(&acpi_thermal_rel_chrdev_lock); return nonseekable_open(inode, file); } static int acpi_thermal_rel_release(struct inode *inode, struct file *file) { spin_lock(&acpi_thermal_rel_chrdev_lock); acpi_thermal_rel_chrdev_count--; acpi_thermal_rel_chrdev_exclu = 0; spin_unlock(&acpi_thermal_rel_chrdev_lock); return 0; } /** * acpi_parse_trt - Thermal Relationship Table _TRT for passive cooling * * @handle: ACPI handle of the device contains _TRT * @art_count: the number of valid entries resulted from parsing _TRT * @artp: pointer to pointer of array of art entries in parsing result * @create_dev: whether to create platform devices for target and source * */ int acpi_parse_trt(acpi_handle handle, int *trt_count, struct trt **trtp, bool create_dev) { acpi_status status; int result = 0; int i; int nr_bad_entries = 0; struct trt *trts; 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; } *trt_count = p->package.count; trts = kzalloc(*trt_count * sizeof(struct trt), GFP_KERNEL); if (!trts) { result = -ENOMEM; goto end; } for (i = 0; i < *trt_count; i++) { struct trt *trt = &trts[i - nr_bad_entries]; element.length = sizeof(struct trt); element.pointer = trt; status = acpi_extract_package(&(p->package.elements[i]), &trt_format, &element); if (ACPI_FAILURE(status)) { nr_bad_entries++; pr_warn("_TRT package %d is invalid, ignored\n", i); continue; } if (!create_dev) continue; result = acpi_bus_get_device(trt->source, &adev); if (!result) acpi_create_platform_device(adev); 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); else pr_warn("Failed to get target ACPI device\n"); } *trtp = trts; /* don't count bad entries */ *trt_count -= nr_bad_entries; end: kfree(buffer.pointer); return result; } EXPORT_SYMBOL(acpi_parse_trt); /** * acpi_parse_art - Parse Active Relationship Table _ART * * @handle: ACPI handle of the device contains _ART * @art_count: the number of valid entries resulted from parsing _ART * @artp: pointer to pointer of array of art entries in parsing result * @create_dev: whether to create platform devices for target and source * */ int acpi_parse_art(acpi_handle handle, int *art_count, struct art **artp, bool create_dev) { acpi_status status; int result = 0; int i; int nr_bad_entries = 0; struct art *arts; 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 */ *art_count = p->package.count - 1; arts = kzalloc(*art_count * sizeof(struct art), GFP_KERNEL); if (!arts) { result = -ENOMEM; goto end; } for (i = 0; i < *art_count; i++) { struct art *art = &arts[i - nr_bad_entries]; 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_warn("_ART package %d is invalid, ignored", i); nr_bad_entries++; continue; } if (!create_dev) continue; if (art->source) { result = acpi_bus_get_device(art->source, &adev); if (!result) acpi_create_platform_device(adev); else pr_warn("Failed to get source ACPI device\n"); } if (art->target) { result = acpi_bus_get_device(art->target, &adev); if (!result) acpi_create_platform_device(adev); else pr_warn("Failed to get source ACPI device\n"); } } *artp = arts; /* don't count bad entries */ *art_count -= nr_bad_entries; end: kfree(buffer.pointer); return result; } EXPORT_SYMBOL(acpi_parse_art); /* get device name from acpi handle */ static void get_single_name(acpi_handle handle, char *name) { struct acpi_buffer buffer = {ACPI_ALLOCATE_BUFFER}; if (ACPI_FAILURE(acpi_get_name(handle, ACPI_SINGLE_NAME, &buffer))) pr_warn("Failed get name from handle\n"); else { memcpy(name, buffer.pointer, ACPI_NAME_SIZE); kfree(buffer.pointer); } } static int fill_art(char __user *ubuf) { int i; int ret; int count; int art_len; struct art *arts = NULL; union art_object *art_user; ret = acpi_parse_art(acpi_thermal_rel_handle, &count, &arts, false); if (ret) goto free_art; art_len = count * sizeof(union art_object); art_user = kzalloc(art_len, GFP_KERNEL); if (!art_user) { ret = -ENOMEM; goto free_art; } /* now fill in user art data */ for (i = 0; i < count; i++) { /* userspace art needs device name instead of acpi reference */ get_single_name(arts[i].source, art_user[i].source_device); get_single_name(arts[i].target, art_user[i].target_device); /* copy the rest int data in addition to source and target */ memcpy(&art_user[i].weight, &arts[i].weight, sizeof(u64) * (ACPI_NR_ART_ELEMENTS - 2)); } if (copy_to_user(ubuf, art_user, art_len)) ret = -EFAULT; kfree(art_user); free_art: kfree(arts); return ret; } static int fill_trt(char __user *ubuf) { int i; int ret; int count; int trt_len; struct trt *trts = NULL; union trt_object *trt_user; ret = acpi_parse_trt(acpi_thermal_rel_handle, &count, &trts, false); if (ret) goto free_trt; trt_len = count * sizeof(union trt_object); trt_user = kzalloc(trt_len, GFP_KERNEL); if (!trt_user) { ret = -ENOMEM; goto free_trt; } /* now fill in user trt data */ for (i = 0; i < count; i++) { /* userspace trt needs device name instead of acpi reference */ get_single_name(trts[i].source, trt_user[i].source_device); get_single_name(trts[i].target, trt_user[i].target_device); trt_user[i].sample_period = trts[i].sample_period; trt_user[i].influence = trts[i].influence; } if (copy_to_user(ubuf, trt_user, trt_len)) ret = -EFAULT; kfree(trt_user); free_trt: kfree(trts); return ret; } static long acpi_thermal_rel_ioctl(struct file *f, unsigned int cmd, unsigned long __arg) { int ret = 0; unsigned long length = 0; unsigned long count = 0; char __user *arg = (void __user *)__arg; struct trt *trts; struct art *arts; switch (cmd) { case ACPI_THERMAL_GET_TRT_COUNT: ret = acpi_parse_trt(acpi_thermal_rel_handle, (int *)&count, &trts, false); kfree(trts); if (!ret) return put_user(count, (unsigned long __user *)__arg); return ret; case ACPI_THERMAL_GET_TRT_LEN: ret = acpi_parse_trt(acpi_thermal_rel_handle, (int *)&count, &trts, false); kfree(trts); length = count * sizeof(union trt_object); if (!ret) return put_user(length, (unsigned long __user *)__arg); return ret; case ACPI_THERMAL_GET_TRT: return fill_trt(arg); case ACPI_THERMAL_GET_ART_COUNT: ret = acpi_parse_art(acpi_thermal_rel_handle, (int *)&count, &arts, false); kfree(arts); if (!ret) return put_user(count, (unsigned long __user *)__arg); return ret; case ACPI_THERMAL_GET_ART_LEN: ret = acpi_parse_art(acpi_thermal_rel_handle, (int *)&count, &arts, false); kfree(arts); length = count * sizeof(union art_object); if (!ret) return put_user(length, (unsigned long __user *)__arg); return ret; case ACPI_THERMAL_GET_ART: return fill_art(arg); default: return -ENOTTY; } } static const struct file_operations acpi_thermal_rel_fops = { .owner = THIS_MODULE, .open = acpi_thermal_rel_open, .release = acpi_thermal_rel_release, .unlocked_ioctl = acpi_thermal_rel_ioctl, .llseek = no_llseek, }; static struct miscdevice acpi_thermal_rel_misc_device = { .minor = MISC_DYNAMIC_MINOR, "acpi_thermal_rel", &acpi_thermal_rel_fops }; int acpi_thermal_rel_misc_device_add(acpi_handle handle) { acpi_thermal_rel_handle = handle; return misc_register(&acpi_thermal_rel_misc_device); } EXPORT_SYMBOL(acpi_thermal_rel_misc_device_add); int acpi_thermal_rel_misc_device_remove(acpi_handle handle) { misc_deregister(&acpi_thermal_rel_misc_device); return 0; } EXPORT_SYMBOL(acpi_thermal_rel_misc_device_remove); MODULE_AUTHOR("Zhang Rui "); MODULE_AUTHOR("Jacob Pan