Message ID | 20230426062018.19755-1-zhuyinbo@loongson.cn |
---|---|
State | New |
Headers |
Return-Path: <linux-kernel-owner@vger.kernel.org> Delivered-To: ouuuleilei@gmail.com Received: by 2002:a59:b0ea:0:b0:3b6:4342:cba0 with SMTP id b10csp38141vqo; Tue, 25 Apr 2023 23:26:36 -0700 (PDT) X-Google-Smtp-Source: AKy350YMjBfmJzy4gD0iTav9sSVvZJqcxvN/x3a39T/h+N9l4SEuP/7BrGx1gpZ6D+V78K8CwLsA X-Received: by 2002:a17:902:dac7:b0:1a9:5c78:8fdf with SMTP id q7-20020a170902dac700b001a95c788fdfmr17719572plx.36.1682490396333; Tue, 25 Apr 2023 23:26:36 -0700 (PDT) ARC-Seal: i=1; a=rsa-sha256; t=1682490396; cv=none; d=google.com; s=arc-20160816; b=kn1DhEHuyJ9tzvmmXCa/aLVpOBDdshaZ94h24kpn+ZnTfsMWbT/dn9uA0ygpm8ffjt o1ihrRt9ku9Z2Uv3hkv6bq7DXjcG3/61GrsDB8Bbe7/DtB1GeN3YzwhnuyhTOy06LkzW 7dfI4Hrt2gIjOCI/4SfeD4mC27xkfETdK84ib5WJPuBEmXSJ+ArtLACYG+PzGsH5x+tG 6Uo0+FegTWM9DbaDiqNudU+69j6kt3bdLX8yWq/P06I6hDaSmOjIjCQ4fg+sdOYJFEM0 yqhzF9CLls/5TwZSwcifh/cWjPfLFAwdqwUIb7VvJAt9WM65ipA9XhBUhNBUOihBJtWg Uguw== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=list-id:precedence:content-transfer-encoding:mime-version :message-id:date:subject:cc:to:from; bh=3upqxKE3G4lvbhep5t0+SrZs1VUIel4odzm0/pSuAJk=; b=DpnAvZnKqWMTWViA0Sy9k1DTO4xi7PO6NtLE+2NMYoUreSu9ZXJ1H4QdNguvYgY9+4 mQU9abdqnyEVlAuZzJLcIZgMKPt9yVKQfQICdlA9rHwj5R/US0q4a8L+lQ9NieB9/kxj syzAGrRY2ts4zVYbCH+10KSqEHnS0UtW+8IQEZuAPem43LApYcGXh9JcvsxgpGWMvRki 5syxJUAVv6IW/oqi06r7ok3PAfDo03Fda6pnpcMoGeoodFEiX4r0RQaktZh7kkgRfuG7 bLUhGLgcIW/qcdON98uFUnCMbGdNKSg9tpUq1fOw2HiMccCTU3IBsvPSmHgp3Co1mVNc riyQ== ARC-Authentication-Results: i=1; mx.google.com; spf=pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::1:20 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org Received: from out1.vger.email (out1.vger.email. [2620:137:e000::1:20]) by mx.google.com with ESMTP id e15-20020a17090301cf00b001a6d4ec7c89si16670973plh.222.2023.04.25.23.26.18; Tue, 25 Apr 2023 23:26:36 -0700 (PDT) Received-SPF: pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::1:20 as permitted sender) client-ip=2620:137:e000::1:20; Authentication-Results: mx.google.com; spf=pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::1:20 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S239530AbjDZGUh (ORCPT <rfc822;zxc52fgh@gmail.com> + 99 others); Wed, 26 Apr 2023 02:20:37 -0400 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:42874 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S239340AbjDZGUe (ORCPT <rfc822;linux-kernel@vger.kernel.org>); Wed, 26 Apr 2023 02:20:34 -0400 Received: from loongson.cn (mail.loongson.cn [114.242.206.163]) by lindbergh.monkeyblade.net (Postfix) with ESMTP id 385952134; Tue, 25 Apr 2023 23:20:31 -0700 (PDT) Received: from loongson.cn (unknown [10.20.42.35]) by gateway (Coremail) with SMTP id _____8BxrOqtwkhkIOcAAA--.1526S3; Wed, 26 Apr 2023 14:20:29 +0800 (CST) Received: from user-pc.202.106.0.20 (unknown [10.20.42.35]) by localhost.localdomain (Coremail) with SMTP id AQAAf8DxfbOkwkhk7FE8AA--.16273S2; Wed, 26 Apr 2023 14:20:26 +0800 (CST) From: Yinbo Zhu <zhuyinbo@loongson.cn> To: "Rafael J . Wysocki" <rafael@kernel.org>, Daniel Lezcano <daniel.lezcano@linaro.org>, Amit Kucheria <amitk@kernel.org>, Zhang Rui <rui.zhang@intel.com>, Rob Herring <robh+dt@kernel.org>, Krzysztof Kozlowski <krzysztof.kozlowski+dt@linaro.org>, linux-pm@vger.kernel.org, devicetree@vger.kernel.org, linux-kernel@vger.kernel.org Cc: Jianmin Lv <lvjianmin@loongson.cn>, wanghongliang@loongson.cn, Liu Peibao <liupeibao@loongson.cn>, loongson-kernel@lists.loongnix.cn, zhanghongchen <zhanghongchen@loongson.cn>, Yinbo Zhu <zhuyinbo@loongson.cn> Subject: [PATCH v14 1/2] thermal: loongson-2: add thermal management support Date: Wed, 26 Apr 2023 14:20:17 +0800 Message-Id: <20230426062018.19755-1-zhuyinbo@loongson.cn> X-Mailer: git-send-email 2.20.1 MIME-Version: 1.0 Content-Transfer-Encoding: 8bit X-CM-TRANSID: AQAAf8DxfbOkwkhk7FE8AA--.16273S2 X-CM-SenderInfo: 52kx5xhqerqz5rrqw2lrqou0/ X-Coremail-Antispam: 1Uk129KBjvJXoW3Zr1xur1DXr4xKr45ZFyrJFb_yoWDAryDpF W3Ca98GrsrJFsru3Z8ArW8AFs0y3WayFy7XF4xGw1Y9rZ8J343WryktFy8AryxCFyUGFW7 ZF98KrWUCFWDZ3DanT9S1TB71UUUUjUqnTZGkaVYY2UrUUUUj1kv1TuYvTs0mT0YCTnIWj qI5I8CrVACY4xI64kE6c02F40Ex7xfYxn0WfASr-VFAUDa7-sFnT9fnUUIcSsGvfJTRUUU bfxFc2x0x2IEx4CE42xK8VAvwI8IcIk0rVWrJVCq3wAFIxvE14AKwVWUXVWUAwA2ocxC64 kIII0Yj41l84x0c7CEw4AK67xGY2AK021l84ACjcxK6xIIjxv20xvE14v26r1I6r4UM28E F7xvwVC0I7IYx2IY6xkF7I0E14v26r4j6F4UM28EF7xvwVC2z280aVAFwI0_Gr1j6F4UJw A2z4x0Y4vEx4A2jsIEc7CjxVAFwI0_Gr1j6F4UJwAaw2AFwI0_Jrv_JF1le2I262IYc4CY 6c8Ij28IcVAaY2xG8wAqjxCEc2xF0cIa020Ex4CE44I27wAqx4xG64xvF2IEw4CE5I8CrV C2j2WlYx0E2Ix0cI8IcVAFwI0_JF0_Jw1lYx0Ex4A2jsIE14v26r1j6r4UMcvjeVCFs4IE 7xkEbVWUJVW8JwACjcxG0xvY0x0EwIxGrwCY1x0262kKe7AKxVWUAVWUtwCF04k20xvY0x 0EwIxGrwCF04k20xvE74AGY7Cv6cx26rWl4I8I3I0E4IkC6x0Yz7v_Jr0_Gr1l4IxYO2xF xVAFwI0_Jrv_JF1lx2IqxVAqx4xG67AKxVWUJVWUGwC20s026x8GjcxK67AKxVWUGVWUWw C2zVAF1VAY17CE14v26r1q6r43MIIYrxkI7VAKI48JMIIF0xvE2Ix0cI8IcVAFwI0_Jr0_ JF4lIxAIcVC0I7IYx2IY6xkF7I0E14v26r1j6r4UMIIF0xvE42xK8VAvwI8IcIk0rVWUJV WUCwCI42IY6I8E87Iv67AKxVWUJVW8JwCI42IY6I8E87Iv6xkF7I0E14v26r1j6r4UYxBI daVFxhVjvjDU0xZFpf9x07jn73kUUUUU= X-Spam-Status: No, score=-1.9 required=5.0 tests=BAYES_00,SPF_HELO_PASS, SPF_PASS,T_SCC_BODY_TEXT_LINE autolearn=ham autolearn_force=no version=3.4.6 X-Spam-Checker-Version: SpamAssassin 3.4.6 (2021-04-09) on lindbergh.monkeyblade.net Precedence: bulk List-ID: <linux-kernel.vger.kernel.org> X-Mailing-List: linux-kernel@vger.kernel.org X-getmail-retrieved-from-mailbox: =?utf-8?q?INBOX?= X-GMAIL-THRID: =?utf-8?q?1764219049873689229?= X-GMAIL-MSGID: =?utf-8?q?1764219049873689229?= |
Series |
[v14,1/2] thermal: loongson-2: add thermal management support
|
|
Commit Message
Yinbo Zhu
April 26, 2023, 6:20 a.m. UTC
This patch adds the support for Loongson-2 thermal sensor controller, which can support maximum 4 sensors, each sensor contains a sampling register and a control register. The sampling register is used to obtain the temperature in real time, the control register GATE field is used to set the threshold of high or low temperature, when the input temperature is higher than the high temperature threshold or lower than the low temperature threshold, an interrupt will occur. Signed-off-by: zhanghongchen <zhanghongchen@loongson.cn> Signed-off-by: Yinbo Zhu <zhuyinbo@loongson.cn> --- Change in v14: 1. Add back depends on COMPILE_TEST. 2. The implementation of devm_thermal_add_hwmon_sysfs has changed in recent community code that cause compile fail issue and this verison add a dev args in devm_thermal_add_hwmon_sysfs to fix compile issue. Change in v13: 1. Add a description about that how works the sensor. 2. Drop the COMPILE_TEST. 3. Rework the help prograph in LOONGSON2_THERMAL Kconfig. 4. Drop the 'tzd' 'irq' and 'pdev' element in loongson2_thermal_data. 5. Drop the reset of variable in loongson2_thermal_set. 6. Drop the function loongson2_thermal_get_sensor_id. 7. Drop the function loongson2_thermal_alarm_irq. 8. Rework the devm_thermal_of_zone_register. 9. Pass 'tzd' instead of 'data' in devm_request_threaded_irq. 10. Drop the "data->tzd->tzp->no_hwmon = false". 11. Drop the loongson2_thermal_remove. 12. Add the sensor id in the of_device_id data field. 13. Drop the save and restore function. Change in v12: 1. Fixup it about min and max. 2. Use dev_err_probe replace dev_err in devm_request_threaded_irq context. Change in v11: 1. Add min() and max() to replace related code in function loongson2_thermal_set. 2. Add dev_err_probe to to replace related code for function return value use devm_thermal_of_zone_register. 3. Replace thermal_add_hwmon_sysfs with devm_thermal_add_hwmon_sysfs and use dev_warn replace dev_err in this context. Change in v10: 1. Add all history change log information. Change in v9: 1. Switch new API that use devm_thermal_of_zone_register to replace previous interfaces. 2. Add depend on LOONGARCH || COMPILE_TEST. Change in v8: 1. Replace string loongson2/Loongson2/LOONGSON2 with loongson-2/ Loongson-2/LOONGSON-2 in Kconfig and commit log and MAINTAINERS files. Change in v7: 1. Split the modification of patch 3 and merge it into this patch. 2. Remove the unless code annotation to fix the compile warning when compile C code with W=1. Change in v6: 1. NO change, but other patch in this series of patches set has changes. Change in v5: 1. NO change, but other patch in this series of patches set has changes. Change in v4: 1. Fixup the compatible. Change in v3: 1. Add a function to gain sensor id an remove dts id. Change in v2: 1. Remove error msg printing when addr ioremap has error. 2. Make loongson2 thermal driver was built-in by default. 3. Replace ls2k with loongson2. 4. Remove CONFIG_PM_SLEEP and set pm function type was __maybe_unused. MAINTAINERS | 7 ++ drivers/thermal/Kconfig | 12 ++ drivers/thermal/Makefile | 1 + drivers/thermal/loongson2_thermal.c | 166 ++++++++++++++++++++++++++++ 4 files changed, 186 insertions(+) create mode 100644 drivers/thermal/loongson2_thermal.c
Comments
Friendly ping ? 在 2023/4/26 下午2:20, Yinbo Zhu 写道: > This patch adds the support for Loongson-2 thermal sensor controller, > which can support maximum 4 sensors, each sensor contains a sampling > register and a control register. The sampling register is used to obtain > the temperature in real time, the control register GATE field is used to > set the threshold of high or low temperature, when the input temperature > is higher than the high temperature threshold or lower than the low > temperature threshold, an interrupt will occur. > > Signed-off-by: zhanghongchen <zhanghongchen@loongson.cn> > Signed-off-by: Yinbo Zhu <zhuyinbo@loongson.cn> > --- > Change in v14: > 1. Add back depends on COMPILE_TEST. > 2. The implementation of devm_thermal_add_hwmon_sysfs has changed in > recent community code that cause compile fail issue and this verison > add a dev args in devm_thermal_add_hwmon_sysfs to fix compile issue. > Change in v13: > 1. Add a description about that how works the sensor. > 2. Drop the COMPILE_TEST. > 3. Rework the help prograph in LOONGSON2_THERMAL Kconfig. > 4. Drop the 'tzd' 'irq' and 'pdev' element in loongson2_thermal_data. > 5. Drop the reset of variable in loongson2_thermal_set. > 6. Drop the function loongson2_thermal_get_sensor_id. > 7. Drop the function loongson2_thermal_alarm_irq. > 8. Rework the devm_thermal_of_zone_register. > 9. Pass 'tzd' instead of 'data' in devm_request_threaded_irq. > 10. Drop the "data->tzd->tzp->no_hwmon = false". > 11. Drop the loongson2_thermal_remove. > 12. Add the sensor id in the of_device_id data field. > 13. Drop the save and restore function. > Change in v12: > 1. Fixup it about min and max. > 2. Use dev_err_probe replace dev_err in devm_request_threaded_irq context. > Change in v11: > 1. Add min() and max() to replace related code in function > loongson2_thermal_set. > 2. Add dev_err_probe to to replace related code for function > return value use devm_thermal_of_zone_register. > 3. Replace thermal_add_hwmon_sysfs with devm_thermal_add_hwmon_sysfs > and use dev_warn replace dev_err in this context. > Change in v10: > 1. Add all history change log information. > Change in v9: > 1. Switch new API that use devm_thermal_of_zone_register > to replace previous interfaces. > 2. Add depend on LOONGARCH || COMPILE_TEST. > Change in v8: > 1. Replace string loongson2/Loongson2/LOONGSON2 with loongson-2/ > Loongson-2/LOONGSON-2 in Kconfig and commit log and MAINTAINERS > files. > Change in v7: > 1. Split the modification of patch 3 and merge it into this patch. > 2. Remove the unless code annotation to fix the compile warning > when compile C code with W=1. > Change in v6: > 1. NO change, but other patch in this series of patches set has > changes. > Change in v5: > 1. NO change, but other patch in this series of patches set has > changes. > Change in v4: > 1. Fixup the compatible. > Change in v3: > 1. Add a function to gain sensor id an remove dts id. > Change in v2: > 1. Remove error msg printing when addr ioremap has error. > 2. Make loongson2 thermal driver was built-in by default. > 3. Replace ls2k with loongson2. > 4. Remove CONFIG_PM_SLEEP and set pm function type was > __maybe_unused. > > MAINTAINERS | 7 ++ > drivers/thermal/Kconfig | 12 ++ > drivers/thermal/Makefile | 1 + > drivers/thermal/loongson2_thermal.c | 166 ++++++++++++++++++++++++++++ > 4 files changed, 186 insertions(+) > create mode 100644 drivers/thermal/loongson2_thermal.c > > diff --git a/MAINTAINERS b/MAINTAINERS > index 25a0981c74b6..b3a76acd2caf 100644 > --- a/MAINTAINERS > +++ b/MAINTAINERS > @@ -12143,6 +12143,13 @@ S: Maintained > F: Documentation/devicetree/bindings/pinctrl/loongson,ls2k-pinctrl.yaml > F: drivers/pinctrl/pinctrl-loongson2.c > > +LOONGSON-2 SOC SERIES THERMAL DRIVER > +M: zhanghongchen <zhanghongchen@loongson.cn> > +M: Yinbo Zhu <zhuyinbo@loongson.cn> > +L: linux-pm@vger.kernel.org > +S: Maintained > +F: drivers/thermal/loongson2_thermal.c > + > LOONGSON GPIO DRIVER > M: Yinbo Zhu <zhuyinbo@loongson.cn> > L: linux-gpio@vger.kernel.org > diff --git a/drivers/thermal/Kconfig b/drivers/thermal/Kconfig > index 4cd7ab707315..c4de94e972f4 100644 > --- a/drivers/thermal/Kconfig > +++ b/drivers/thermal/Kconfig > @@ -502,4 +502,16 @@ config KHADAS_MCU_FAN_THERMAL > If you say yes here you get support for the FAN controlled > by the Microcontroller found on the Khadas VIM boards. > > +config LOONGSON2_THERMAL > + tristate "Loongson-2 SoC series thermal driver" > + depends on LOONGARCH || COMPILE_TEST > + depends on OF > + help > + Support for Thermal driver found on Loongson-2 SoC series platforms. > + The thermal driver realizes get_temp and set_trips function, which > + are used to obtain the temperature of the current node and set the > + temperature range to trigger the interrupt. When the input temperature > + is higher than the high temperature threshold or lower than the low > + temperature threshold, the interrupt will occur. > + > endif > diff --git a/drivers/thermal/Makefile b/drivers/thermal/Makefile > index eed300e83d48..4edde4df647b 100644 > --- a/drivers/thermal/Makefile > +++ b/drivers/thermal/Makefile > @@ -62,3 +62,4 @@ obj-$(CONFIG_UNIPHIER_THERMAL) += uniphier_thermal.o > obj-$(CONFIG_AMLOGIC_THERMAL) += amlogic_thermal.o > obj-$(CONFIG_SPRD_THERMAL) += sprd_thermal.o > obj-$(CONFIG_KHADAS_MCU_FAN_THERMAL) += khadas_mcu_fan.o > +obj-$(CONFIG_LOONGSON2_THERMAL) += loongson2_thermal.o > diff --git a/drivers/thermal/loongson2_thermal.c b/drivers/thermal/loongson2_thermal.c > new file mode 100644 > index 000000000000..6a338e6e490e > --- /dev/null > +++ b/drivers/thermal/loongson2_thermal.c > @@ -0,0 +1,166 @@ > +// SPDX-License-Identifier: GPL-2.0+ > +/* > + * Author: zhanghongchen <zhanghongchen@loongson.cn> > + * Yinbo Zhu <zhuyinbo@loongson.cn> > + * Copyright (C) 2022-2023 Loongson Technology Corporation Limited > + */ > + > +#include <linux/cpufreq.h> > +#include <linux/delay.h> > +#include <linux/interrupt.h> > +#include <linux/module.h> > +#include <linux/platform_device.h> > +#include <linux/io.h> > +#include <linux/of_device.h> > +#include <linux/thermal.h> > +#include "thermal_hwmon.h" > + > +#define LOONGSON2_SOC_MAX_SENSOR_NUM 4 > + > +#define LOONGSON2_TSENSOR_CTRL_HI 0x0 > +#define LOONGSON2_TSENSOR_CTRL_LO 0x8 > +#define LOONGSON2_TSENSOR_STATUS 0x10 > +#define LOONGSON2_TSENSOR_OUT 0x14 > + > +struct loongson2_thermal_data { > + int id; > + void __iomem *regs; > +}; > + > +static int loongson2_thermal_set(struct loongson2_thermal_data *data, > + int low, int high, bool enable) > +{ > + u64 reg_ctrl = 0; > + int reg_off = data->id * 2; > + > + if (low > high) > + return -EINVAL; > + > + low = max(low, -40); > + high = min(high, 125); > + > + low += 100; > + high += 100; > + > + reg_ctrl = low; > + reg_ctrl |= enable ? 0x100 : 0; > + writew(reg_ctrl, data->regs + LOONGSON2_TSENSOR_CTRL_LO + reg_off); > + > + reg_ctrl = high; > + reg_ctrl |= enable ? 0x100 : 0; > + writew(reg_ctrl, data->regs + LOONGSON2_TSENSOR_CTRL_HI + reg_off); > + > + return 0; > +} > + > +static int loongson2_thermal_get_temp(struct thermal_zone_device *tz, int *temp) > +{ > + u32 reg_val; > + struct loongson2_thermal_data *data = tz->devdata; > + > + reg_val = readl(data->regs + LOONGSON2_TSENSOR_OUT); > + *temp = ((reg_val & 0xff) - 100) * 1000; > + > + return 0; > +} > + > +static irqreturn_t loongson2_thermal_irq_thread(int irq, void *dev) > +{ > + struct thermal_zone_device *tzd = dev; > + struct loongson2_thermal_data *data = tzd->devdata; > + > + /* clear interrupt */ > + writeb(0x3, data->regs + LOONGSON2_TSENSOR_STATUS); > + > + thermal_zone_device_update(tzd, THERMAL_EVENT_UNSPECIFIED); > + > + return IRQ_HANDLED; > +} > + > +static int loongson2_thermal_set_trips(struct thermal_zone_device *tz, int low, int high) > +{ > + struct loongson2_thermal_data *data = tz->devdata; > + > + return loongson2_thermal_set(data, low/1000, high/1000, true); > +} > + > +static const struct thermal_zone_device_ops loongson2_of_thermal_ops = { > + .get_temp = loongson2_thermal_get_temp, > + .set_trips = loongson2_thermal_set_trips, > +}; > + > +static int loongson2_thermal_probe(struct platform_device *pdev) > +{ > + struct device *dev = &pdev->dev; > + struct resource *res; > + struct loongson2_thermal_data *data; > + struct thermal_zone_device *tzd; > + int ret, irq, i; > + > + data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL); > + if (!data) > + return -ENOMEM; > + > + data->id = (uintptr_t)device_get_match_data(dev); > + > + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); > + data->regs = devm_ioremap(dev, res->start, resource_size(res)); > + if (IS_ERR(data->regs)) > + return PTR_ERR(data->regs); > + > + /* get irq */ > + irq = platform_get_irq(pdev, 0); > + if (irq < 0) > + return irq; > + > + if (data->id > LOONGSON2_SOC_MAX_SENSOR_NUM - 1 || data->id < 0) { > + dev_err(dev, "sensor id error,must be in <0 ~ %d>\n", > + LOONGSON2_SOC_MAX_SENSOR_NUM - 1); > + return -EINVAL; > + } > + > + writeb(0xff, data->regs + LOONGSON2_TSENSOR_STATUS); > + > + loongson2_thermal_set(data, 0, 0, false); > + > + for (i = 0; i < LOONGSON2_SOC_MAX_SENSOR_NUM; i++) { > + tzd = devm_thermal_of_zone_register(dev, i, data, > + &loongson2_of_thermal_ops); > + > + if (!IS_ERR(tzd)) > + break; > + > + if (PTR_ERR(tzd) != ENODEV) > + continue; > + > + return dev_err_probe(dev, PTR_ERR(tzd), "failed to register"); > + } > + > + ret = devm_request_threaded_irq(dev, irq, NULL, loongson2_thermal_irq_thread, > + IRQF_ONESHOT, "loongson2_thermal", tzd); > + if (ret < 0) > + return dev_err_probe(dev, ret, "failed to request alarm irq\n"); > + > + if (devm_thermal_add_hwmon_sysfs(dev, tzd)) > + dev_warn(dev, "Failed to add hwmon sysfs attributes\n"); > + > + return 0; > +} > + > +static const struct of_device_id of_loongson2_thermal_match[] = { > + { .compatible = "loongson,ls2k-thermal", .data = (const void *)0}, > + { /* end */ } > +}; > +MODULE_DEVICE_TABLE(of, of_loongson2_thermal_match); > + > +static struct platform_driver loongson2_thermal_driver = { > + .driver = { > + .name = "loongson2_thermal", > + .of_match_table = of_loongson2_thermal_match, > + }, > + .probe = loongson2_thermal_probe, > +}; > +module_platform_driver(loongson2_thermal_driver); > + > +MODULE_DESCRIPTION("Loongson2 thermal driver"); > +MODULE_LICENSE("GPL"); >
On 26/04/2023 08:20, Yinbo Zhu wrote: > This patch adds the support for Loongson-2 thermal sensor controller, > which can support maximum 4 sensors, each sensor contains a sampling > register and a control register. The sampling register is used to obtain > the temperature in real time, the control register GATE field is used to > set the threshold of high or low temperature, when the input temperature > is higher than the high temperature threshold or lower than the low > temperature threshold, an interrupt will occur. > > Signed-off-by: zhanghongchen <zhanghongchen@loongson.cn> > Signed-off-by: Yinbo Zhu <zhuyinbo@loongson.cn> > --- > Change in v14: > 1. Add back depends on COMPILE_TEST. > 2. The implementation of devm_thermal_add_hwmon_sysfs has changed in > recent community code that cause compile fail issue and this verison > add a dev args in devm_thermal_add_hwmon_sysfs to fix compile issue. > Change in v13: > 1. Add a description about that how works the sensor. > 2. Drop the COMPILE_TEST. > 3. Rework the help prograph in LOONGSON2_THERMAL Kconfig. > 4. Drop the 'tzd' 'irq' and 'pdev' element in loongson2_thermal_data. > 5. Drop the reset of variable in loongson2_thermal_set. > 6. Drop the function loongson2_thermal_get_sensor_id. > 7. Drop the function loongson2_thermal_alarm_irq. > 8. Rework the devm_thermal_of_zone_register. > 9. Pass 'tzd' instead of 'data' in devm_request_threaded_irq. > 10. Drop the "data->tzd->tzp->no_hwmon = false". > 11. Drop the loongson2_thermal_remove. > 12. Add the sensor id in the of_device_id data field. > 13. Drop the save and restore function. > Change in v12: > 1. Fixup it about min and max. > 2. Use dev_err_probe replace dev_err in devm_request_threaded_irq context. > Change in v11: > 1. Add min() and max() to replace related code in function > loongson2_thermal_set. > 2. Add dev_err_probe to to replace related code for function > return value use devm_thermal_of_zone_register. > 3. Replace thermal_add_hwmon_sysfs with devm_thermal_add_hwmon_sysfs > and use dev_warn replace dev_err in this context. > Change in v10: > 1. Add all history change log information. > Change in v9: > 1. Switch new API that use devm_thermal_of_zone_register > to replace previous interfaces. > 2. Add depend on LOONGARCH || COMPILE_TEST. > Change in v8: > 1. Replace string loongson2/Loongson2/LOONGSON2 with loongson-2/ > Loongson-2/LOONGSON-2 in Kconfig and commit log and MAINTAINERS > files. > Change in v7: > 1. Split the modification of patch 3 and merge it into this patch. > 2. Remove the unless code annotation to fix the compile warning > when compile C code with W=1. > Change in v6: > 1. NO change, but other patch in this series of patches set has > changes. > Change in v5: > 1. NO change, but other patch in this series of patches set has > changes. > Change in v4: > 1. Fixup the compatible. > Change in v3: > 1. Add a function to gain sensor id an remove dts id. > Change in v2: > 1. Remove error msg printing when addr ioremap has error. > 2. Make loongson2 thermal driver was built-in by default. > 3. Replace ls2k with loongson2. > 4. Remove CONFIG_PM_SLEEP and set pm function type was > __maybe_unused. > > MAINTAINERS | 7 ++ > drivers/thermal/Kconfig | 12 ++ > drivers/thermal/Makefile | 1 + > drivers/thermal/loongson2_thermal.c | 166 ++++++++++++++++++++++++++++ > 4 files changed, 186 insertions(+) > create mode 100644 drivers/thermal/loongson2_thermal.c > > diff --git a/MAINTAINERS b/MAINTAINERS > index 25a0981c74b6..b3a76acd2caf 100644 > --- a/MAINTAINERS > +++ b/MAINTAINERS > @@ -12143,6 +12143,13 @@ S: Maintained > F: Documentation/devicetree/bindings/pinctrl/loongson,ls2k-pinctrl.yaml > F: drivers/pinctrl/pinctrl-loongson2.c > > +LOONGSON-2 SOC SERIES THERMAL DRIVER > +M: zhanghongchen <zhanghongchen@loongson.cn> > +M: Yinbo Zhu <zhuyinbo@loongson.cn> > +L: linux-pm@vger.kernel.org > +S: Maintained > +F: drivers/thermal/loongson2_thermal.c > + > LOONGSON GPIO DRIVER > M: Yinbo Zhu <zhuyinbo@loongson.cn> > L: linux-gpio@vger.kernel.org > diff --git a/drivers/thermal/Kconfig b/drivers/thermal/Kconfig > index 4cd7ab707315..c4de94e972f4 100644 > --- a/drivers/thermal/Kconfig > +++ b/drivers/thermal/Kconfig > @@ -502,4 +502,16 @@ config KHADAS_MCU_FAN_THERMAL > If you say yes here you get support for the FAN controlled > by the Microcontroller found on the Khadas VIM boards. > > +config LOONGSON2_THERMAL > + tristate "Loongson-2 SoC series thermal driver" > + depends on LOONGARCH || COMPILE_TEST > + depends on OF > + help > + Support for Thermal driver found on Loongson-2 SoC series platforms. > + The thermal driver realizes get_temp and set_trips function, which > + are used to obtain the temperature of the current node and set the > + temperature range to trigger the interrupt. When the input temperature > + is higher than the high temperature threshold or lower than the low > + temperature threshold, the interrupt will occur. > + > endif > diff --git a/drivers/thermal/Makefile b/drivers/thermal/Makefile > index eed300e83d48..4edde4df647b 100644 > --- a/drivers/thermal/Makefile > +++ b/drivers/thermal/Makefile > @@ -62,3 +62,4 @@ obj-$(CONFIG_UNIPHIER_THERMAL) += uniphier_thermal.o > obj-$(CONFIG_AMLOGIC_THERMAL) += amlogic_thermal.o > obj-$(CONFIG_SPRD_THERMAL) += sprd_thermal.o > obj-$(CONFIG_KHADAS_MCU_FAN_THERMAL) += khadas_mcu_fan.o > +obj-$(CONFIG_LOONGSON2_THERMAL) += loongson2_thermal.o > diff --git a/drivers/thermal/loongson2_thermal.c b/drivers/thermal/loongson2_thermal.c > new file mode 100644 > index 000000000000..6a338e6e490e > --- /dev/null > +++ b/drivers/thermal/loongson2_thermal.c > @@ -0,0 +1,166 @@ > +// SPDX-License-Identifier: GPL-2.0+ > +/* > + * Author: zhanghongchen <zhanghongchen@loongson.cn> > + * Yinbo Zhu <zhuyinbo@loongson.cn> > + * Copyright (C) 2022-2023 Loongson Technology Corporation Limited > + */ > + > +#include <linux/cpufreq.h> Is it really needed ? > +#include <linux/delay.h> Is it really needed ? > +#include <linux/interrupt.h> > +#include <linux/module.h> > +#include <linux/platform_device.h> > +#include <linux/io.h> > +#include <linux/of_device.h> > +#include <linux/thermal.h> > +#include "thermal_hwmon.h" > > +#define LOONGSON2_SOC_MAX_SENSOR_NUM 4 > + > +#define LOONGSON2_TSENSOR_CTRL_HI 0x0 > +#define LOONGSON2_TSENSOR_CTRL_LO 0x8 > +#define LOONGSON2_TSENSOR_STATUS 0x10 > +#define LOONGSON2_TSENSOR_OUT 0x14 Please use BIT() macros > +struct loongson2_thermal_data { > + int id; > + void __iomem *regs; > +}; It would make sense to replace the id by the precomputed register offset value. > +static int loongson2_thermal_set(struct loongson2_thermal_data *data, > + int low, int high, bool enable) > +{ > + u64 reg_ctrl = 0; > + int reg_off = data->id * 2; > + > + if (low > high) > + return -EINVAL; I don't think this is supposed to happen > + low = max(low, -40); > + high = min(high, 125); You can use clamp() alternatively (your call) > + > + low += 100; > + high += 100; > + > + reg_ctrl = low; > + reg_ctrl |= enable ? 0x100 : 0; > + writew(reg_ctrl, data->regs + LOONGSON2_TSENSOR_CTRL_LO + reg_off); > + > + reg_ctrl = high; > + reg_ctrl |= enable ? 0x100 : 0; > + writew(reg_ctrl, data->regs + LOONGSON2_TSENSOR_CTRL_HI + reg_off); Is the 'enable' boolean really useful? Wouldn't be the sensor trip points disabled by default at reset time? If it is the case then we can get ride of this variable and make the routine simpler > + return 0; > +} > + > +static int loongson2_thermal_get_temp(struct thermal_zone_device *tz, int *temp) > +{ > + u32 reg_val; > + struct loongson2_thermal_data *data = tz->devdata; > + > + reg_val = readl(data->regs + LOONGSON2_TSENSOR_OUT); Seems like there is no offset for the sensor id here ? > + *temp = ((reg_val & 0xff) - 100) * 1000; Please use macros in units.h for conversion and change literals by macro > + return 0; > +} > + > +static irqreturn_t loongson2_thermal_irq_thread(int irq, void *dev) > +{ > + struct thermal_zone_device *tzd = dev; > + struct loongson2_thermal_data *data = tzd->devdata; The init function tells me whatever the sensor triggering the interrupt we update the same thermal zone, not necessarily the one which reach the trip point. > + /* clear interrupt */ > + writeb(0x3, data->regs + LOONGSON2_TSENSOR_STATUS); Replace the literal value by a macro. > + thermal_zone_device_update(tzd, THERMAL_EVENT_UNSPECIFIED); > + > + return IRQ_HANDLED; > +} > + > +static int loongson2_thermal_set_trips(struct thermal_zone_device *tz, int low, int high) > +{ > + struct loongson2_thermal_data *data = tz->devdata; > + > + return loongson2_thermal_set(data, low/1000, high/1000, true); Please use macros in units.h for conversion > +} > + > +static const struct thermal_zone_device_ops loongson2_of_thermal_ops = { > + .get_temp = loongson2_thermal_get_temp, > + .set_trips = loongson2_thermal_set_trips, > +}; > + > +static int loongson2_thermal_probe(struct platform_device *pdev) > +{ > + struct device *dev = &pdev->dev; > + struct resource *res; > + struct loongson2_thermal_data *data; > + struct thermal_zone_device *tzd; > + int ret, irq, i; > + > + data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL); > + if (!data) > + return -ENOMEM; > + > + data->id = (uintptr_t)device_get_match_data(dev); The changelog says there is up to 4 sensors on the controller but the initialization code seems to handle only one. Either you skip this data at all and let the loop to fill the id when the thermal zone successfully registered or you add a eg. a mask with the sensor (eg. 0x3 for sensor 0 and 1) and use those value in the loop. > + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); > + data->regs = devm_ioremap(dev, res->start, resource_size(res)); > + if (IS_ERR(data->regs)) > + return PTR_ERR(data->regs); > + > + /* get irq */ > + irq = platform_get_irq(pdev, 0); > + if (irq < 0) > + return irq; > + > + if (data->id > LOONGSON2_SOC_MAX_SENSOR_NUM - 1 || data->id < 0) { > + dev_err(dev, "sensor id error,must be in <0 ~ %d>\n", > + LOONGSON2_SOC_MAX_SENSOR_NUM - 1); > + return -EINVAL; > + } As this is coming from a static initialization, this test is not needed. > + writeb(0xff, data->regs + LOONGSON2_TSENSOR_STATUS); Replace the literal value by a macro > + loongson2_thermal_set(data, 0, 0, false); > + > + for (i = 0; i < LOONGSON2_SOC_MAX_SENSOR_NUM; i++) { > + tzd = devm_thermal_of_zone_register(dev, i, data, > + &loongson2_of_thermal_ops); > + > + if (!IS_ERR(tzd)) > + break; Assuming the loop aims to register all the supported thermal zones, the conditions should be inverted. > + if (PTR_ERR(tzd) != ENODEV) > + continue; > > + return dev_err_probe(dev, PTR_ERR(tzd), "failed to register"); > + } > + > + ret = devm_request_threaded_irq(dev, irq, NULL, loongson2_thermal_irq_thread, > + IRQF_ONESHOT, "loongson2_thermal", tzd); > + if (ret < 0) > + return dev_err_probe(dev, ret, "failed to request alarm irq\n") So there is one interrupt but 4 sensors. I assume there is one interrupt per controller but I don't see in the interrupt handler routine the code to figure out which sensor triggered the interrupt. > + if (devm_thermal_add_hwmon_sysfs(dev, tzd)) > + dev_warn(dev, "Failed to add hwmon sysfs attributes\n"); > + > + return 0; > +} > + > +static const struct of_device_id of_loongson2_thermal_match[] = { > + { .compatible = "loongson,ls2k-thermal", .data = (const void *)0}, May be better to replace that with a structure pointer but it is up to you to decide > + { /* end */ } > +}; > +MODULE_DEVICE_TABLE(of, of_loongson2_thermal_match); > + > +static struct platform_driver loongson2_thermal_driver = { > + .driver = { > + .name = "loongson2_thermal", > + .of_match_table = of_loongson2_thermal_match, > + }, > + .probe = loongson2_thermal_probe, > +}; > +module_platform_driver(loongson2_thermal_driver); > + > +MODULE_DESCRIPTION("Loongson2 thermal driver"); > +MODULE_LICENSE("GPL");
Hi Daniel, Thank you very much for your feedback and suggestions. Below, I have some comments, please review. 在 2023/6/12 下午10:22, Daniel Lezcano 写道: > On 26/04/2023 08:20, Yinbo Zhu wrote: >> This patch adds the support for Loongson-2 thermal sensor controller, >> which can support maximum 4 sensors, each sensor contains a sampling >> register and a control register. The sampling register is used to obtain >> the temperature in real time, the control register GATE field is used to >> set the threshold of high or low temperature, when the input temperature >> is higher than the high temperature threshold or lower than the low >> temperature threshold, an interrupt will occur. >> >> Signed-off-by: zhanghongchen <zhanghongchen@loongson.cn> >> Signed-off-by: Yinbo Zhu <zhuyinbo@loongson.cn> >> --- >> Change in v14: >> 1. Add back depends on COMPILE_TEST. >> 2. The implementation of devm_thermal_add_hwmon_sysfs has >> changed in >> recent community code that cause compile fail issue and >> this verison >> add a dev args in devm_thermal_add_hwmon_sysfs to fix >> compile issue. >> Change in v13: >> 1. Add a description about that how works the sensor. >> 2. Drop the COMPILE_TEST. >> 3. Rework the help prograph in LOONGSON2_THERMAL Kconfig. >> 4. Drop the 'tzd' 'irq' and 'pdev' element in >> loongson2_thermal_data. >> 5. Drop the reset of variable in loongson2_thermal_set. >> 6. Drop the function loongson2_thermal_get_sensor_id. >> 7. Drop the function loongson2_thermal_alarm_irq. >> 8. Rework the devm_thermal_of_zone_register. >> 9. Pass 'tzd' instead of 'data' in devm_request_threaded_irq. >> 10. Drop the "data->tzd->tzp->no_hwmon = false". >> 11. Drop the loongson2_thermal_remove. >> 12. Add the sensor id in the of_device_id data field. >> 13. Drop the save and restore function. >> Change in v12: >> 1. Fixup it about min and max. >> 2. Use dev_err_probe replace dev_err in >> devm_request_threaded_irq context. >> Change in v11: >> 1. Add min() and max() to replace related code in function >> loongson2_thermal_set. >> 2. Add dev_err_probe to to replace related code for function >> return value use devm_thermal_of_zone_register. >> 3. Replace thermal_add_hwmon_sysfs with >> devm_thermal_add_hwmon_sysfs >> and use dev_warn replace dev_err in this context. >> Change in v10: >> 1. Add all history change log information. >> Change in v9: >> 1. Switch new API that use devm_thermal_of_zone_register >> to replace previous interfaces. >> 2. Add depend on LOONGARCH || COMPILE_TEST. >> Change in v8: >> 1. Replace string loongson2/Loongson2/LOONGSON2 with >> loongson-2/ >> Loongson-2/LOONGSON-2 in Kconfig and commit log >> and MAINTAINERS >> files. >> Change in v7: >> 1. Split the modification of patch 3 and merge it into this >> patch. >> 2. Remove the unless code annotation to fix the compile warning >> when compile C code with W=1. >> Change in v6: >> 1. NO change, but other patch in this series of patches set has >> changes. >> Change in v5: >> 1. NO change, but other patch in this series of patches set has >> changes. >> Change in v4: >> 1. Fixup the compatible. >> Change in v3: >> 1. Add a function to gain sensor id an remove dts id. >> Change in v2: >> 1. Remove error msg printing when addr ioremap has error. >> 2. Make loongson2 thermal driver was built-in by default. >> 3. Replace ls2k with loongson2. >> 4. Remove CONFIG_PM_SLEEP and set pm function type was >> __maybe_unused. >> >> MAINTAINERS | 7 ++ >> drivers/thermal/Kconfig | 12 ++ >> drivers/thermal/Makefile | 1 + >> drivers/thermal/loongson2_thermal.c | 166 ++++++++++++++++++++++++++++ >> 4 files changed, 186 insertions(+) >> create mode 100644 drivers/thermal/loongson2_thermal.c >> >> diff --git a/MAINTAINERS b/MAINTAINERS >> index 25a0981c74b6..b3a76acd2caf 100644 >> --- a/MAINTAINERS >> +++ b/MAINTAINERS >> @@ -12143,6 +12143,13 @@ S: Maintained >> F: >> Documentation/devicetree/bindings/pinctrl/loongson,ls2k-pinctrl.yaml >> F: drivers/pinctrl/pinctrl-loongson2.c >> +LOONGSON-2 SOC SERIES THERMAL DRIVER >> +M: zhanghongchen <zhanghongchen@loongson.cn> >> +M: Yinbo Zhu <zhuyinbo@loongson.cn> >> +L: linux-pm@vger.kernel.org >> +S: Maintained >> +F: drivers/thermal/loongson2_thermal.c >> + >> LOONGSON GPIO DRIVER >> M: Yinbo Zhu <zhuyinbo@loongson.cn> >> L: linux-gpio@vger.kernel.org >> diff --git a/drivers/thermal/Kconfig b/drivers/thermal/Kconfig >> index 4cd7ab707315..c4de94e972f4 100644 >> --- a/drivers/thermal/Kconfig >> +++ b/drivers/thermal/Kconfig >> @@ -502,4 +502,16 @@ config KHADAS_MCU_FAN_THERMAL >> If you say yes here you get support for the FAN controlled >> by the Microcontroller found on the Khadas VIM boards. >> +config LOONGSON2_THERMAL >> + tristate "Loongson-2 SoC series thermal driver" >> + depends on LOONGARCH || COMPILE_TEST >> + depends on OF >> + help >> + Support for Thermal driver found on Loongson-2 SoC series >> platforms. >> + The thermal driver realizes get_temp and set_trips function, which >> + are used to obtain the temperature of the current node and set the >> + temperature range to trigger the interrupt. When the input >> temperature >> + is higher than the high temperature threshold or lower than the >> low >> + temperature threshold, the interrupt will occur. >> + >> endif >> diff --git a/drivers/thermal/Makefile b/drivers/thermal/Makefile >> index eed300e83d48..4edde4df647b 100644 >> --- a/drivers/thermal/Makefile >> +++ b/drivers/thermal/Makefile >> @@ -62,3 +62,4 @@ obj-$(CONFIG_UNIPHIER_THERMAL) += uniphier_thermal.o >> obj-$(CONFIG_AMLOGIC_THERMAL) += amlogic_thermal.o >> obj-$(CONFIG_SPRD_THERMAL) += sprd_thermal.o >> obj-$(CONFIG_KHADAS_MCU_FAN_THERMAL) += khadas_mcu_fan.o >> +obj-$(CONFIG_LOONGSON2_THERMAL) += loongson2_thermal.o >> diff --git a/drivers/thermal/loongson2_thermal.c >> b/drivers/thermal/loongson2_thermal.c >> new file mode 100644 >> index 000000000000..6a338e6e490e >> --- /dev/null >> +++ b/drivers/thermal/loongson2_thermal.c >> @@ -0,0 +1,166 @@ >> +// SPDX-License-Identifier: GPL-2.0+ >> +/* >> + * Author: zhanghongchen <zhanghongchen@loongson.cn> >> + * Yinbo Zhu <zhuyinbo@loongson.cn> >> + * Copyright (C) 2022-2023 Loongson Technology Corporation Limited >> + */ >> + >> +#include <linux/cpufreq.h> > > Is it really needed ? okay, I will check it. > >> +#include <linux/delay.h> > > Is it really needed ? okay, I will check it. > >> +#include <linux/interrupt.h> >> +#include <linux/module.h> >> +#include <linux/platform_device.h> >> +#include <linux/io.h> >> +#include <linux/of_device.h> >> +#include <linux/thermal.h> >> +#include "thermal_hwmon.h" >> >> +#define LOONGSON2_SOC_MAX_SENSOR_NUM 4 >> + >> +#define LOONGSON2_TSENSOR_CTRL_HI 0x0 >> +#define LOONGSON2_TSENSOR_CTRL_LO 0x8 >> +#define LOONGSON2_TSENSOR_STATUS 0x10 >> +#define LOONGSON2_TSENSOR_OUT 0x14 > > Please use BIT() macros okay, I got it. > >> +struct loongson2_thermal_data { >> + int id; >> + void __iomem *regs; >> +}; > > It would make sense to replace the id by the precomputed register offset > value. > >> +static int loongson2_thermal_set(struct loongson2_thermal_data *data, >> + int low, int high, bool enable) >> +{ >> + u64 reg_ctrl = 0; >> + int reg_off = data->id * 2; >> + >> + if (low > high) >> + return -EINVAL; > > I don't think this is supposed to happen okay, I will remove it. > >> + low = max(low, -40); >> + high = min(high, 125); > > You can use clamp() alternatively (your call) okay, I got it, I will use it. > >> + >> + low += 100; >> + high += 100; >> + >> + reg_ctrl = low; >> + reg_ctrl |= enable ? 0x100 : 0; >> + writew(reg_ctrl, data->regs + LOONGSON2_TSENSOR_CTRL_LO + reg_off); >> + >> + reg_ctrl = high; >> + reg_ctrl |= enable ? 0x100 : 0; >> + writew(reg_ctrl, data->regs + LOONGSON2_TSENSOR_CTRL_HI + reg_off); > > Is the 'enable' boolean really useful? Yes, this 'enable' was to enable thermal irq. > > Wouldn't be the sensor trip points disabled by default at reset time? > Only here will thermal irq be enabled throughout the entire driver, and actual testing has shown that interrupts are valid, so this is meaningful. > If it is the case then we can get ride of this variable and make the > routine simpler > >> + return 0; >> +} >> + >> +static int loongson2_thermal_get_temp(struct thermal_zone_device *tz, >> int *temp) >> +{ >> + u32 reg_val; >> + struct loongson2_thermal_data *data = tz->devdata; >> + >> + reg_val = readl(data->regs + LOONGSON2_TSENSOR_OUT); > > Seems like there is no offset for the sensor id here ? There is no need for a sensor ID here. There are some things that I didn't describe clearly, which made you misunderstand. Actually, the temperature sensor of 2K1000 is like this: There are 4 sets of temperature interrupt controllers, only one set of temperature sampling registers. a sets of temperature interrupt controllers was considered a sensor, which sensor include 3 register as follows, where "SEL" represents which sensor is referenced, In 2k1000 datasheet, which "SEL" must be 0. 1) GATE: 2) EN: 3) SEL: > >> + *temp = ((reg_val & 0xff) - 100) * 1000; > > Please use macros in units.h for conversion and change literals by macro okay, I got it. > >> + return 0; >> +} >> + >> +static irqreturn_t loongson2_thermal_irq_thread(int irq, void *dev) >> +{ >> + struct thermal_zone_device *tzd = dev; >> + struct loongson2_thermal_data *data = tzd->devdata; > > The init function tells me whatever the sensor triggering the interrupt > we update the same thermal zone, not necessarily the one which reach the > trip point. Although there are four sets of registers, but, only one set temperature interrupt controllers was valid in 2k1000. and the condition for interruption is that the temperature reaches trip point. > >> + /* clear interrupt */ >> + writeb(0x3, data->regs + LOONGSON2_TSENSOR_STATUS); > > Replace the literal value by a macro. okay, I got it . > >> + thermal_zone_device_update(tzd, THERMAL_EVENT_UNSPECIFIED); >> + >> + return IRQ_HANDLED; >> +} >> + >> +static int loongson2_thermal_set_trips(struct thermal_zone_device >> *tz, int low, int high) >> +{ >> + struct loongson2_thermal_data *data = tz->devdata; >> + >> + return loongson2_thermal_set(data, low/1000, high/1000, true); > > Please use macros in units.h for conversion okay, I got it. > >> +} >> + >> +static const struct thermal_zone_device_ops loongson2_of_thermal_ops = { >> + .get_temp = loongson2_thermal_get_temp, >> + .set_trips = loongson2_thermal_set_trips, >> +}; >> + >> +static int loongson2_thermal_probe(struct platform_device *pdev) >> +{ >> + struct device *dev = &pdev->dev; >> + struct resource *res; >> + struct loongson2_thermal_data *data; >> + struct thermal_zone_device *tzd; >> + int ret, irq, i; >> + >> + data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL); >> + if (!data) >> + return -ENOMEM; >> + >> + data->id = (uintptr_t)device_get_match_data(dev); > > The changelog says there is up to 4 sensors on the controller but the > initialization code seems to handle only one. > > Either you skip this data at all and let the loop to fill the id when > the thermal zone successfully registered or you add a eg. a mask with > the sensor (eg. 0x3 for sensor 0 and 1) and use those value in the loop. At present, this code seems appropriate because although 2k1000 has four sets of temperature interrupt controllers, only the 0th set is valid. > > >> + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); >> + data->regs = devm_ioremap(dev, res->start, resource_size(res)); >> + if (IS_ERR(data->regs)) >> + return PTR_ERR(data->regs); >> + >> + /* get irq */ >> + irq = platform_get_irq(pdev, 0); >> + if (irq < 0) >> + return irq; >> + >> + if (data->id > LOONGSON2_SOC_MAX_SENSOR_NUM - 1 || data->id < 0) { >> + dev_err(dev, "sensor id error,must be in <0 ~ %d>\n", >> + LOONGSON2_SOC_MAX_SENSOR_NUM - 1); >> + return -EINVAL; >> + } > > As this is coming from a static initialization, this test is not needed. okay, I got it. > >> + writeb(0xff, data->regs + LOONGSON2_TSENSOR_STATUS); > > Replace the literal value by a macro okay, I got it. > >> + loongson2_thermal_set(data, 0, 0, false); >> + >> + for (i = 0; i < LOONGSON2_SOC_MAX_SENSOR_NUM; i++) { >> + tzd = devm_thermal_of_zone_register(dev, i, data, >> + &loongson2_of_thermal_ops); >> + >> + if (!IS_ERR(tzd)) >> + break; > > Assuming the loop aims to register all the supported thermal zones, the > conditions should be inverted. This code seems appropriate, the reason is as above. > >> + if (PTR_ERR(tzd) != ENODEV) >> + continue; > > >> + return dev_err_probe(dev, PTR_ERR(tzd), "failed to register"); >> + } >> + >> + ret = devm_request_threaded_irq(dev, irq, NULL, >> loongson2_thermal_irq_thread, >> + IRQF_ONESHOT, "loongson2_thermal", tzd); >> + if (ret < 0) >> + return dev_err_probe(dev, ret, "failed to request alarm irq\n") > > So there is one interrupt but 4 sensors. I assume there is one interrupt > per controller but I don't see in the interrupt handler routine the code > to figure out which sensor triggered the interrupt. This code seems appropriate, the reason is as above. > >> + if (devm_thermal_add_hwmon_sysfs(dev, tzd)) >> + dev_warn(dev, "Failed to add hwmon sysfs attributes\n"); >> + >> + return 0; >> +} >> + >> +static const struct of_device_id of_loongson2_thermal_match[] = { >> + { .compatible = "loongson,ls2k-thermal", .data = (const void *)0}, > > May be better to replace that with a structure pointer but it is up to > you to decide okay, I got it. Thanks, Yinbo
Hi Yinbo, On 14/06/2023 10:03, zhuyinbo wrote: > > Hi Daniel, > > Thank you very much for your feedback and suggestions. Below, I have > some comments, please review. [ ... ] >>> + >>> + low += 100; >>> + high += 100; Literals -> macros >>> + reg_ctrl = low; >>> + reg_ctrl |= enable ? 0x100 : 0; >>> + writew(reg_ctrl, data->regs + LOONGSON2_TSENSOR_CTRL_LO + reg_off); >>> + >>> + reg_ctrl = high; >>> + reg_ctrl |= enable ? 0x100 : 0; >>> + writew(reg_ctrl, data->regs + LOONGSON2_TSENSOR_CTRL_HI + reg_off); >> >> Is the 'enable' boolean really useful? > > > Yes, this 'enable' was to enable thermal irq. > >> >> Wouldn't be the sensor trip points disabled by default at reset time? >> > > > Only here will thermal irq be enabled throughout the entire driver, and > actual testing has shown that interrupts are valid, so this is > meaningful. Ok. >> If it is the case then we can get ride of this variable and make the >> routine simpler >> >>> + return 0; >>> +} >>> + >>> +static int loongson2_thermal_get_temp(struct thermal_zone_device >>> *tz, int *temp) >>> +{ >>> + u32 reg_val; >>> + struct loongson2_thermal_data *data = tz->devdata; >>> + >>> + reg_val = readl(data->regs + LOONGSON2_TSENSOR_OUT); >> >> Seems like there is no offset for the sensor id here ? > > > There is no need for a sensor ID here. > > There are some things that I didn't describe clearly, which made you > misunderstand. Actually, the temperature sensor of 2K1000 is like this: > > There are 4 sets of temperature interrupt controllers, only one set of > temperature sampling registers. a sets of temperature interrupt > controllers was considered a sensor, which sensor include 3 register as > follows, where "SEL" represents which sensor is referenced, In 2k1000 > datasheet, which "SEL" must be 0. I'm not sure to understand. Let me rephrase it and know what is wrong. 1. The thermal controller has 4 sensors. The interrupt can be set for these 4 sensors. 2. When reading a temperature, we have to select the sensor via the 'SEL' register. 3. The 2k1000 has one sensor with an id = 0. 4. In the future, more Loongson platform can be submitted with more than one sensor If this is correct, then my comments are about the inconsistency of the proposed changes. Guessing in the future Loongson board there will be more than one sensor, the existing code mixes support for one and multiple sensors as well as assuming id is 0. So if you add in the of_loongson2_thermal_match table a new platform with several sensors, the current code will be broken because: - the initialization loop does exit when the first thermal zone registration succeed - the interrupt handler does not figure out which sensor crossed the low/high limit - the get_temp is not selecting the right sensor That is my point: - write the code to support one sensor with id=0 only *or* - write the code to support multiple sensors If I'm not wrong the code is closer to support multiple sensors ;) Let me know if these deductions are correct -- Daniel ps : is there an English translation for the 2k1000 datasheet ?
Hi Daniel, 在 2023/6/14 下午6:59, Daniel Lezcano 写道: > > Hi Yinbo, > > > On 14/06/2023 10:03, zhuyinbo wrote: >> >> Hi Daniel, >> >> Thank you very much for your feedback and suggestions. Below, I have >> some comments, please review. > > [ ... ] > >>>> + >>>> + low += 100; >>>> + high += 100; > > Literals -> macros okay, I got it. > >>>> + reg_ctrl = low; >>>> + reg_ctrl |= enable ? 0x100 : 0; >>>> + writew(reg_ctrl, data->regs + LOONGSON2_TSENSOR_CTRL_LO + >>>> reg_off); >>>> + >>>> + reg_ctrl = high; >>>> + reg_ctrl |= enable ? 0x100 : 0; >>>> + writew(reg_ctrl, data->regs + LOONGSON2_TSENSOR_CTRL_HI + >>>> reg_off); >>> >>> Is the 'enable' boolean really useful? >> >> >> Yes, this 'enable' was to enable thermal irq. >> >>> >>> Wouldn't be the sensor trip points disabled by default at reset time? >>> >> >> >> Only here will thermal irq be enabled throughout the entire driver, and >> actual testing has shown that interrupts are valid, so this is >> meaningful. > > Ok. > >>> If it is the case then we can get ride of this variable and make the >>> routine simpler >>> >>>> + return 0; >>>> +} >>>> + >>>> +static int loongson2_thermal_get_temp(struct thermal_zone_device >>>> *tz, int *temp) >>>> +{ >>>> + u32 reg_val; >>>> + struct loongson2_thermal_data *data = tz->devdata; >>>> + >>>> + reg_val = readl(data->regs + LOONGSON2_TSENSOR_OUT); >>> >>> Seems like there is no offset for the sensor id here ? >> >> >> There is no need for a sensor ID here. >> >> There are some things that I didn't describe clearly, which made you >> misunderstand. Actually, the temperature sensor of 2K1000 is like this: >> >> There are 4 sets of temperature interrupt controllers, only one set of >> temperature sampling registers. a sets of temperature interrupt >> controllers was considered a sensor, which sensor include 3 register as >> follows, where "SEL" represents which sensor is referenced, In 2k1000 >> datasheet, which "SEL" must be 0. > > I'm not sure to understand. Let me rephrase it and know what is wrong. > > 1. The thermal controller has 4 sensors. The interrupt can be set for > these 4 sensors. You can think it's actually a sensor, but the thermal sensor include a set of status register and four sets of control register in loongson-2k series (2k1000 /2k2000), but the control register only select a group register by set "SEL". > > 2. When reading a temperature, we have to select the sensor via the > 'SEL' register. The 'SEL' was to select thermal control register set, that reading a tempearure was to thermal status register set. thermal status register set only one and no no other choice. The function of 'SEL' is actually to select which temperature sensor collects the temperature as input. > > 3. The 2k1000 has one sensor with an id = 0. Yes, the future 2k series product may still be a sensor, but the ID may not be 0, it may be 1 or 2 or 3. > > 4. In the future, more Loongson platform can be submitted with more than > one sensor From the current situation of the 2k series (2k1000/2k2000), it seems that there will always be only one sensor, but 'SEL' can be used to select which sensor. (0th, 1th, 2th, 3th). If there are really special circumstances in the future, add appropriate modifications at that time. > > If this is correct, then my comments are about the inconsistency of the > proposed changes. Guessing in the future Loongson board there will be > more than one sensor, the existing code mixes support for one and > multiple sensors as well as assuming id is 0. > > So if you add in the of_loongson2_thermal_match table a new platform > with several sensors, the current code will be broken because: > > - the initialization loop does exit when the first thermal zone > registration succeed > > - the interrupt handler does not figure out which sensor crossed the > low/high limit > > - the get_temp is not selecting the right sensor Yes, but currently this code does not support the requirement for multiple sensors. > > > That is my point: > > - write the code to support one sensor with id=0 only > > *or* > > - write the code to support multiple sensors > > If I'm not wrong the code is closer to support multiple sensors ;) In fact, my code is more inclined to support one sensor, but it can determine which sensor to use based on the ID. (id = 0, 1, 2, 3) > > Let me know if these deductions are correct > > -- Daniel > > ps : is there an English translation for the 2k1000 datasheet ? Sorry, there seems to be no English version available at the moment. Thanks, Yinbo.
On 16/06/2023 16:34, Daniel Lezcano wrote: > The thermal zone device won't be accessible directly anymore. > > Use the private data accessor. To be folded with your next version Thanks > Cc: zhuyinbo <zhuyinbo@loongson.cn> > Cc: Yinbo Zhu <zhuyinbo@loongson.cn> > Signed-off-by: Daniel Lezcano <daniel.lezcano@linaro.org> > --- > drivers/thermal/loongson2_thermal.c | 6 +++--- > 1 file changed, 3 insertions(+), 3 deletions(-) > > diff --git a/drivers/thermal/loongson2_thermal.c b/drivers/thermal/loongson2_thermal.c > index 6a338e6e490e..9a07409c3bd2 100644 > --- a/drivers/thermal/loongson2_thermal.c > +++ b/drivers/thermal/loongson2_thermal.c > @@ -56,7 +56,7 @@ static int loongson2_thermal_set(struct loongson2_thermal_data *data, > static int loongson2_thermal_get_temp(struct thermal_zone_device *tz, int *temp) > { > u32 reg_val; > - struct loongson2_thermal_data *data = tz->devdata; > + struct loongson2_thermal_data *data = thermal_zone_device_priv(tz); > > reg_val = readl(data->regs + LOONGSON2_TSENSOR_OUT); > *temp = ((reg_val & 0xff) - 100) * 1000; > @@ -67,7 +67,7 @@ static int loongson2_thermal_get_temp(struct thermal_zone_device *tz, int *temp) > static irqreturn_t loongson2_thermal_irq_thread(int irq, void *dev) > { > struct thermal_zone_device *tzd = dev; > - struct loongson2_thermal_data *data = tzd->devdata; > + struct loongson2_thermal_data *data = thermal_zone_device_priv(tzd); > > /* clear interrupt */ > writeb(0x3, data->regs + LOONGSON2_TSENSOR_STATUS); > @@ -79,7 +79,7 @@ static irqreturn_t loongson2_thermal_irq_thread(int irq, void *dev) > > static int loongson2_thermal_set_trips(struct thermal_zone_device *tz, int low, int high) > { > - struct loongson2_thermal_data *data = tz->devdata; > + struct loongson2_thermal_data *data = thermal_zone_device_priv(tz); > > return loongson2_thermal_set(data, low/1000, high/1000, true); > }
在 2023/6/16 下午10:35, Daniel Lezcano 写道: > On 16/06/2023 16:34, Daniel Lezcano wrote: >> The thermal zone device won't be accessible directly anymore. >> >> Use the private data accessor. > > To be folded with your next version > okay, If I understand correctly, I will make this patch as a independent [3/3] patch of the v15 series patch. Thanks, Yinbo
Hi Daniel, 在 2023/6/12 下午10:22, Daniel Lezcano 写道: ... >> >> +#define LOONGSON2_SOC_MAX_SENSOR_NUM 4 >> + >> +#define LOONGSON2_TSENSOR_CTRL_HI 0x0 >> +#define LOONGSON2_TSENSOR_CTRL_LO 0x8 >> +#define LOONGSON2_TSENSOR_STATUS 0x10 >> +#define LOONGSON2_TSENSOR_OUT 0x14 > > Please use BIT() macros I learn about that BIT() is generally used to describe the functional bit or control bit or status bits of a register, but these register was some different register offset and not some control bit or status bit So using BIT() here seems a bit inappropriate, Do you think so? Thanks, Yinbo
On 17/06/2023 03:52, zhuyinbo wrote: > > > 在 2023/6/16 下午10:35, Daniel Lezcano 写道: >> On 16/06/2023 16:34, Daniel Lezcano wrote: >>> The thermal zone device won't be accessible directly anymore. >>> >>> Use the private data accessor. >> >> To be folded with your next version >> > > > okay, If I understand correctly, I will make this patch as a independent > [3/3] patch of the v15 series patch. It is better to merge it with your patch 2 in order to prevent a git bisecting error (no need to add a my signoff or whatever)
On 17/06/2023 05:25, zhuyinbo wrote: > > Hi Daniel, > > 在 2023/6/12 下午10:22, Daniel Lezcano 写道: > > ... > >>> >>> +#define LOONGSON2_SOC_MAX_SENSOR_NUM 4 >>> + >>> +#define LOONGSON2_TSENSOR_CTRL_HI 0x0 >>> +#define LOONGSON2_TSENSOR_CTRL_LO 0x8 >>> +#define LOONGSON2_TSENSOR_STATUS 0x10 >>> +#define LOONGSON2_TSENSOR_OUT 0x14 >> >> Please use BIT() macros > > > I learn about that BIT() is generally used to describe the functional > bit or control bit or status bits of a register, but these register was > some different register offset and not some control bit or status bit > So using BIT() here seems a bit inappropriate, Do you think so? Yes, you are right
在 2023/6/17 下午3:12, Daniel Lezcano 写道: > On 17/06/2023 03:52, zhuyinbo wrote: >> >> >> 在 2023/6/16 下午10:35, Daniel Lezcano 写道: >>> On 16/06/2023 16:34, Daniel Lezcano wrote: >>>> The thermal zone device won't be accessible directly anymore. >>>> >>>> Use the private data accessor. >>> >>> To be folded with your next version >>> >> >> >> okay, If I understand correctly, I will make this patch as a independent >> [3/3] patch of the v15 series patch. > > It is better to merge it with your patch 2 in order to prevent a git > bisecting error (no need to add a my signoff or whatever) okay, I got it. Thanks, Yinbo >
在 2023/6/17 下午3:15, Daniel Lezcano 写道: > On 17/06/2023 05:25, zhuyinbo wrote: >> >> Hi Daniel, >> >> 在 2023/6/12 下午10:22, Daniel Lezcano 写道: >> >> ... >> >>>> >>>> +#define LOONGSON2_SOC_MAX_SENSOR_NUM 4 >>>> + >>>> +#define LOONGSON2_TSENSOR_CTRL_HI 0x0 >>>> +#define LOONGSON2_TSENSOR_CTRL_LO 0x8 >>>> +#define LOONGSON2_TSENSOR_STATUS 0x10 >>>> +#define LOONGSON2_TSENSOR_OUT 0x14 >>> >>> Please use BIT() macros >> >> >> I learn about that BIT() is generally used to describe the functional >> bit or control bit or status bits of a register, but these register was >> some different register offset and not some control bit or status bit >> So using BIT() here seems a bit inappropriate, Do you think so? > > Yes, you are right okay, I got it. Thanks, Yinbo
diff --git a/MAINTAINERS b/MAINTAINERS index 25a0981c74b6..b3a76acd2caf 100644 --- a/MAINTAINERS +++ b/MAINTAINERS @@ -12143,6 +12143,13 @@ S: Maintained F: Documentation/devicetree/bindings/pinctrl/loongson,ls2k-pinctrl.yaml F: drivers/pinctrl/pinctrl-loongson2.c +LOONGSON-2 SOC SERIES THERMAL DRIVER +M: zhanghongchen <zhanghongchen@loongson.cn> +M: Yinbo Zhu <zhuyinbo@loongson.cn> +L: linux-pm@vger.kernel.org +S: Maintained +F: drivers/thermal/loongson2_thermal.c + LOONGSON GPIO DRIVER M: Yinbo Zhu <zhuyinbo@loongson.cn> L: linux-gpio@vger.kernel.org diff --git a/drivers/thermal/Kconfig b/drivers/thermal/Kconfig index 4cd7ab707315..c4de94e972f4 100644 --- a/drivers/thermal/Kconfig +++ b/drivers/thermal/Kconfig @@ -502,4 +502,16 @@ config KHADAS_MCU_FAN_THERMAL If you say yes here you get support for the FAN controlled by the Microcontroller found on the Khadas VIM boards. +config LOONGSON2_THERMAL + tristate "Loongson-2 SoC series thermal driver" + depends on LOONGARCH || COMPILE_TEST + depends on OF + help + Support for Thermal driver found on Loongson-2 SoC series platforms. + The thermal driver realizes get_temp and set_trips function, which + are used to obtain the temperature of the current node and set the + temperature range to trigger the interrupt. When the input temperature + is higher than the high temperature threshold or lower than the low + temperature threshold, the interrupt will occur. + endif diff --git a/drivers/thermal/Makefile b/drivers/thermal/Makefile index eed300e83d48..4edde4df647b 100644 --- a/drivers/thermal/Makefile +++ b/drivers/thermal/Makefile @@ -62,3 +62,4 @@ obj-$(CONFIG_UNIPHIER_THERMAL) += uniphier_thermal.o obj-$(CONFIG_AMLOGIC_THERMAL) += amlogic_thermal.o obj-$(CONFIG_SPRD_THERMAL) += sprd_thermal.o obj-$(CONFIG_KHADAS_MCU_FAN_THERMAL) += khadas_mcu_fan.o +obj-$(CONFIG_LOONGSON2_THERMAL) += loongson2_thermal.o diff --git a/drivers/thermal/loongson2_thermal.c b/drivers/thermal/loongson2_thermal.c new file mode 100644 index 000000000000..6a338e6e490e --- /dev/null +++ b/drivers/thermal/loongson2_thermal.c @@ -0,0 +1,166 @@ +// SPDX-License-Identifier: GPL-2.0+ +/* + * Author: zhanghongchen <zhanghongchen@loongson.cn> + * Yinbo Zhu <zhuyinbo@loongson.cn> + * Copyright (C) 2022-2023 Loongson Technology Corporation Limited + */ + +#include <linux/cpufreq.h> +#include <linux/delay.h> +#include <linux/interrupt.h> +#include <linux/module.h> +#include <linux/platform_device.h> +#include <linux/io.h> +#include <linux/of_device.h> +#include <linux/thermal.h> +#include "thermal_hwmon.h" + +#define LOONGSON2_SOC_MAX_SENSOR_NUM 4 + +#define LOONGSON2_TSENSOR_CTRL_HI 0x0 +#define LOONGSON2_TSENSOR_CTRL_LO 0x8 +#define LOONGSON2_TSENSOR_STATUS 0x10 +#define LOONGSON2_TSENSOR_OUT 0x14 + +struct loongson2_thermal_data { + int id; + void __iomem *regs; +}; + +static int loongson2_thermal_set(struct loongson2_thermal_data *data, + int low, int high, bool enable) +{ + u64 reg_ctrl = 0; + int reg_off = data->id * 2; + + if (low > high) + return -EINVAL; + + low = max(low, -40); + high = min(high, 125); + + low += 100; + high += 100; + + reg_ctrl = low; + reg_ctrl |= enable ? 0x100 : 0; + writew(reg_ctrl, data->regs + LOONGSON2_TSENSOR_CTRL_LO + reg_off); + + reg_ctrl = high; + reg_ctrl |= enable ? 0x100 : 0; + writew(reg_ctrl, data->regs + LOONGSON2_TSENSOR_CTRL_HI + reg_off); + + return 0; +} + +static int loongson2_thermal_get_temp(struct thermal_zone_device *tz, int *temp) +{ + u32 reg_val; + struct loongson2_thermal_data *data = tz->devdata; + + reg_val = readl(data->regs + LOONGSON2_TSENSOR_OUT); + *temp = ((reg_val & 0xff) - 100) * 1000; + + return 0; +} + +static irqreturn_t loongson2_thermal_irq_thread(int irq, void *dev) +{ + struct thermal_zone_device *tzd = dev; + struct loongson2_thermal_data *data = tzd->devdata; + + /* clear interrupt */ + writeb(0x3, data->regs + LOONGSON2_TSENSOR_STATUS); + + thermal_zone_device_update(tzd, THERMAL_EVENT_UNSPECIFIED); + + return IRQ_HANDLED; +} + +static int loongson2_thermal_set_trips(struct thermal_zone_device *tz, int low, int high) +{ + struct loongson2_thermal_data *data = tz->devdata; + + return loongson2_thermal_set(data, low/1000, high/1000, true); +} + +static const struct thermal_zone_device_ops loongson2_of_thermal_ops = { + .get_temp = loongson2_thermal_get_temp, + .set_trips = loongson2_thermal_set_trips, +}; + +static int loongson2_thermal_probe(struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + struct resource *res; + struct loongson2_thermal_data *data; + struct thermal_zone_device *tzd; + int ret, irq, i; + + data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL); + if (!data) + return -ENOMEM; + + data->id = (uintptr_t)device_get_match_data(dev); + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + data->regs = devm_ioremap(dev, res->start, resource_size(res)); + if (IS_ERR(data->regs)) + return PTR_ERR(data->regs); + + /* get irq */ + irq = platform_get_irq(pdev, 0); + if (irq < 0) + return irq; + + if (data->id > LOONGSON2_SOC_MAX_SENSOR_NUM - 1 || data->id < 0) { + dev_err(dev, "sensor id error,must be in <0 ~ %d>\n", + LOONGSON2_SOC_MAX_SENSOR_NUM - 1); + return -EINVAL; + } + + writeb(0xff, data->regs + LOONGSON2_TSENSOR_STATUS); + + loongson2_thermal_set(data, 0, 0, false); + + for (i = 0; i < LOONGSON2_SOC_MAX_SENSOR_NUM; i++) { + tzd = devm_thermal_of_zone_register(dev, i, data, + &loongson2_of_thermal_ops); + + if (!IS_ERR(tzd)) + break; + + if (PTR_ERR(tzd) != ENODEV) + continue; + + return dev_err_probe(dev, PTR_ERR(tzd), "failed to register"); + } + + ret = devm_request_threaded_irq(dev, irq, NULL, loongson2_thermal_irq_thread, + IRQF_ONESHOT, "loongson2_thermal", tzd); + if (ret < 0) + return dev_err_probe(dev, ret, "failed to request alarm irq\n"); + + if (devm_thermal_add_hwmon_sysfs(dev, tzd)) + dev_warn(dev, "Failed to add hwmon sysfs attributes\n"); + + return 0; +} + +static const struct of_device_id of_loongson2_thermal_match[] = { + { .compatible = "loongson,ls2k-thermal", .data = (const void *)0}, + { /* end */ } +}; +MODULE_DEVICE_TABLE(of, of_loongson2_thermal_match); + +static struct platform_driver loongson2_thermal_driver = { + .driver = { + .name = "loongson2_thermal", + .of_match_table = of_loongson2_thermal_match, + }, + .probe = loongson2_thermal_probe, +}; +module_platform_driver(loongson2_thermal_driver); + +MODULE_DESCRIPTION("Loongson2 thermal driver"); +MODULE_LICENSE("GPL");