From patchwork Wed Nov 25 15:09:45 2015 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Javi Merino X-Patchwork-Id: 7700021 X-Patchwork-Delegate: eduardo.valentin@ti.com Return-Path: X-Original-To: patchwork-linux-pm@patchwork.kernel.org Delivered-To: patchwork-parsemail@patchwork2.web.kernel.org Received: from mail.kernel.org (mail.kernel.org [198.145.29.136]) by patchwork2.web.kernel.org (Postfix) with ESMTP id 0783BBF90C for ; Wed, 25 Nov 2015 15:11:58 +0000 (UTC) Received: from mail.kernel.org (localhost [127.0.0.1]) by mail.kernel.org (Postfix) with ESMTP id 1B7A12088B for ; Wed, 25 Nov 2015 15:11:57 +0000 (UTC) Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by mail.kernel.org (Postfix) with ESMTP id 172F620877 for ; Wed, 25 Nov 2015 15:11:56 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1753314AbbKYPKq (ORCPT ); Wed, 25 Nov 2015 10:10:46 -0500 Received: from foss.arm.com ([217.140.101.70]:40288 "EHLO foss.arm.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1753304AbbKYPKo (ORCPT ); Wed, 25 Nov 2015 10:10:44 -0500 Received: from usa-sjc-imap-foss1.foss.arm.com (unknown [10.72.51.249]) by usa-sjc-mx-foss1.foss.arm.com (Postfix) with ESMTP id 3201C3A8; Wed, 25 Nov 2015 07:10:26 -0800 (PST) Received: from e104805-lin.cambridge.arm.com (e104805-lin.cambridge.arm.com [10.1.205.32]) by usa-sjc-imap-foss1.foss.arm.com (Postfix) with ESMTPA id C40523F2E5; Wed, 25 Nov 2015 07:10:42 -0800 (PST) From: Javi Merino To: linux-pm@vger.kernel.org Cc: linux-kernel@vger.kernel.org, rui.zang@intel.com, edubezval@gmail.com, Javi Merino , Zhang Rui Subject: [PATCH v3 3/4] thermal: of: parse stacked thermal zones from device tree Date: Wed, 25 Nov 2015 15:09:45 +0000 Message-Id: <1448464186-26289-4-git-send-email-javi.merino@arm.com> X-Mailer: git-send-email 1.9.1 In-Reply-To: <1448464186-26289-1-git-send-email-javi.merino@arm.com> References: <1448464186-26289-1-git-send-email-javi.merino@arm.com> Sender: linux-pm-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-pm@vger.kernel.org X-Spam-Status: No, score=-7.5 required=5.0 tests=BAYES_00, RCVD_IN_DNSWL_HI, RP_MATCHES_RCVD, UNPARSEABLE_RELAY autolearn=unavailable version=3.3.1 X-Spam-Checker-Version: SpamAssassin 3.3.1 (2010-03-16) on mail.kernel.org X-Virus-Scanned: ClamAV using ClamSMTP Now that devicetree specifies how to create a hierarchy of thermal zones, let of-thermal parse it. Cc: Zhang Rui Cc: Eduardo Valentin Signed-off-by: Javi Merino --- drivers/thermal/of-thermal.c | 100 +++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 100 insertions(+) diff --git a/drivers/thermal/of-thermal.c b/drivers/thermal/of-thermal.c index 42b7d4253b94..7bbc0c32ee59 100644 --- a/drivers/thermal/of-thermal.c +++ b/drivers/thermal/of-thermal.c @@ -166,6 +166,27 @@ of_thermal_get_trip_points(struct thermal_zone_device *tz) EXPORT_SYMBOL_GPL(of_thermal_get_trip_points); /** + * of_thermal_is_thermal_zone - check that a device node corresponds to a thermal zone + * @np: the device node + * + * Valid thermal zone device nodes must provide the + * polling-delay-passive and polling-delay properties. This function + * checks if @np is thermal-zone node. + * + * Return: true if @np is a valid device for a thermal zone. + */ +static bool of_thermal_is_thermal_zone(struct device_node *np) +{ + u32 out; + + if ((of_property_read_u32(np, "polling-delay-passive", &out)) || + (of_property_read_u32(np, "polling-delay", &out))) + return false; + + return true; +} + +/** * of_thermal_set_emul_temp - function to set emulated temperature * * @tz: pointer to a thermal zone @@ -858,6 +879,82 @@ static inline void of_thermal_free_zone(struct __thermal_zone *tz) } /** + * link_stacked_thermal_zones - link thermal zones that are a superset of thermal zones + * @np: device node for the root of the thermal zones + * + * A thermal zone can specify other thermal zones as its input using + * the thermal-sensors property of device tree. This function parses + * all the thermal zones in dt and adds the thermal zones in their + * thermal-sensors as sub-thermalzones. + */ +static void link_stacked_thermal_zones(struct device_node *np) +{ + struct device_node *child; + + for_each_child_of_node(np, child) { + int i, num_sensors; + struct thermal_zone_device *tz; + + num_sensors = of_count_phandle_with_args(child, + "thermal-sensors", + "#thermal-sensor-cells"); + if (num_sensors <= 0) + continue; + + tz = thermal_zone_get_zone_by_name(child->name); + if (IS_ERR_OR_NULL(tz)) { + /* + * If the tz is available we should have added + * it in of_parse_thermal_zones() + */ + WARN(of_device_is_available(child), + "Couldn't find thermal zone for %s\n", + of_node_full_name(child)); + continue; + } + + for (i = 0; i < num_sensors; i++) { + struct of_phandle_args sensor_specs; + struct thermal_zone_device *subtz; + int ret; + + ret = of_parse_phandle_with_args(child, + "thermal-sensors", + "#thermal-sensor-cells", + i, &sensor_specs); + if (ret) { + pr_warn("Failed to parse thermal-sensors of %s: %d\n", + of_node_full_name(child), ret); + of_node_put(sensor_specs.np); + continue; + } + + if (!of_thermal_is_thermal_zone(sensor_specs.np)) { + of_node_put(sensor_specs.np); + continue; + } + + subtz = thermal_zone_get_zone_by_name( + sensor_specs.np->name); + if (IS_ERR_OR_NULL(subtz)) { + pr_warn("Couldn't find thermal zone for %s, is it disabled?\n", + of_node_full_name(sensor_specs.np)); + of_node_put(sensor_specs.np); + continue; + } + + ret = thermal_zone_add_subtz(tz, subtz, + THERMAL_WEIGHT_DEFAULT); + if (ret) + pr_warn("Failed to add thermal zone %s to %s: %d\n", + subtz->type, tz->type, ret); + + of_node_put(sensor_specs.np); + } + } +} + +/** * of_parse_thermal_zones - parse device tree thermal data * * Initialization function that can be called by machine initialization @@ -936,6 +1033,9 @@ int __init of_parse_thermal_zones(void) /* attempting to build remaining zones still */ } } + + link_stacked_thermal_zones(np); + of_node_put(np); return 0;