From patchwork Tue Mar 29 05:24:31 2022 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Li-hao Kuo X-Patchwork-Id: 555476 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org Received: from vger.kernel.org (vger.kernel.org [23.128.96.18]) by smtp.lore.kernel.org (Postfix) with ESMTP id B2461C433F5 for ; Tue, 29 Mar 2022 05:24:48 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S230313AbiC2F02 (ORCPT ); Tue, 29 Mar 2022 01:26:28 -0400 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:56376 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S232422AbiC2F01 (ORCPT ); Tue, 29 Mar 2022 01:26:27 -0400 Received: from mail-pj1-x1032.google.com (mail-pj1-x1032.google.com [IPv6:2607:f8b0:4864:20::1032]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id 9F90E1C4061; Mon, 28 Mar 2022 22:24:45 -0700 (PDT) Received: by mail-pj1-x1032.google.com with SMTP id p4-20020a17090ad30400b001c7ca87c05bso1160279pju.1; Mon, 28 Mar 2022 22:24:45 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20210112; h=from:to:cc:subject:date:message-id:in-reply-to:references :in-reply-to:references; bh=A6ZyruNs918MR7958+w3XSYWERAlbmdG1AziOxbDaNk=; b=gfa+M59leqOS14pNrIxtJDyMczml7xSiFz+osL/c/ANsFWp9G9flfuNs/oqei5X9uT 4fNMXByXM6M2ErGibfjPjqHdjIWIsr75utB1zBD4GElFWaLn8LMcicMbcpoGvq7DJOao HPwsfqbvWf8SlAKJ8gnL+LdLGiIQRUuxZU2+Lk2W0FPRBPWQU1xgPyzj0b4l0yPZBOKy vdN9nh4ldgBNAwoR98ZGEvxjHsyDV2f0Il6cF+IAv0ZBTht8GXyUmK8XVWIdCN3Dp9kI 11uOawsFZ8L64jQ5QrXAt+/oXmrZCLS6Vr3Zlga4qp9WTF0vZvRoEPxuyy+nxxym9w7H 3uZw== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20210112; h=x-gm-message-state:from:to:cc:subject:date:message-id:in-reply-to :references:in-reply-to:references; bh=A6ZyruNs918MR7958+w3XSYWERAlbmdG1AziOxbDaNk=; b=mTepBTV0U6j5hFwy9r0d4Qy593lk8G/JCQN55qSPlStxIExA2meeAl3fNSY4kBzqTp eeh2xEKDiE9MpYyxqgWK1RuFHJlpnohgQAvSkWAHMwyQOo9Q3A/d48kl1MEBh/YlcxVG 0/y4CmXBjzbynhQdedhf5P2oQQunLy/+hWoRn8VzZyIWRs2ImslbsQG2Iq7YWudz62uN RbTlwKfb5zzFCnvglU2N5fEq0cil16vJRSH6wei/Iy+b3SQjDe1AIXurKnZVHH6Bl3fh XAOOfn4WBsQuo4C9EW6Cdm+I++EL9h2nqYXJo+2lHcqbInd7uu8vMkZZJSAcM2MM7Mgj BdnQ== X-Gm-Message-State: AOAM533BICA4tfO0CAIlYROSwXpmpAuKkSd8vF2jzrixo7Lmr4NzU3Xu FjjydAvXxFz++7fP11cAGTE= X-Google-Smtp-Source: ABdhPJw8bJ832u0XhTN1H+UQtLFj2hMQNS5ZJuwUEI7vginpd1k/91FAWisYw9pPUkBpGZV1bhjVKA== X-Received: by 2002:a17:90a:ab08:b0:1b9:c59:82c3 with SMTP id m8-20020a17090aab0800b001b90c5982c3mr2726516pjq.95.1648531485064; Mon, 28 Mar 2022 22:24:45 -0700 (PDT) Received: from scdiu3.sunplus.com ([113.196.136.192]) by smtp.googlemail.com with ESMTPSA id cn9-20020a056a00340900b004fad845e9besm16690335pfb.57.2022.03.28.22.24.42 (version=TLS1_2 cipher=ECDHE-ECDSA-AES128-GCM-SHA256 bits=128/128); Mon, 28 Mar 2022 22:24:44 -0700 (PDT) From: Li-hao Kuo To: krzysztof.kozlowski@canonical.com, rafael@kernel.org, daniel.lezcano@linaro.org, amitk@kernel.org, rui.zhang@intel.com, robh+dt@kernel.org, linux-pm@vger.kernel.org, devicetree@vger.kernel.org, linux-kernel@vger.kernel.org Cc: wells.lu@sunplus.com, lh.kuo@sunplus.com, Li-hao Kuo Subject: [PATCH v6 1/2] thermal: Add thermal driver for Sunplus SP7021 Date: Tue, 29 Mar 2022 13:24:31 +0800 Message-Id: <1ea323ebcec41184a0d906dd4c64bfef5ac8b7d3.1648531197.git.lhjeff911@gmail.com> X-Mailer: git-send-email 2.7.4 In-Reply-To: References: In-Reply-To: References: Precedence: bulk List-ID: X-Mailing-List: linux-pm@vger.kernel.org Add thermal driver for Sunplus SP7021. Signed-off-by: Li-hao Kuo --- Changes in v6: - Modify yaml file. - Addressed comments from Mr. Krzysztof Kozlowski MAINTAINERS | 6 ++ drivers/thermal/Kconfig | 10 +++ drivers/thermal/Makefile | 1 + drivers/thermal/sunplus_thermal.c | 139 ++++++++++++++++++++++++++++++++++++++ 4 files changed, 156 insertions(+) create mode 100644 drivers/thermal/sunplus_thermal.c diff --git a/MAINTAINERS b/MAINTAINERS index 237046f..4096763 100644 --- a/MAINTAINERS +++ b/MAINTAINERS @@ -18860,6 +18860,12 @@ S: Maintained F: Documentation/devicetree/bindings/spi/spi-sunplus-sp7021.yaml F: drivers/spi/spi-sunplus-sp7021.c +SUNPLUS THERMAL DRIVER +M: Li-hao Kuo +L: linux-pm@vger.kernel.org +S: Maintained +F: drivers/thermal/sunplus_thermal.c + SUNPLUS UART DRIVER M: Hammer Hsieh S: Maintained diff --git a/drivers/thermal/Kconfig b/drivers/thermal/Kconfig index e37691e..66316c3 100644 --- a/drivers/thermal/Kconfig +++ b/drivers/thermal/Kconfig @@ -502,4 +502,14 @@ 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 SUNPLUS_THERMAL + tristate "Sunplus thermal drivers" + depends on SOC_SP7021 || COMPILE_TEST + help + This the Sunplus SP7021 thermal driver, which supports the primitive + temperature sensor embedded in Sunplus SP7021 SoC. + + If you have a Sunplus SP7021 platform say Y here and enable this option + to have support for thermal management + endif diff --git a/drivers/thermal/Makefile b/drivers/thermal/Makefile index f0c36a1..38a76f9 100644 --- a/drivers/thermal/Makefile +++ b/drivers/thermal/Makefile @@ -61,3 +61,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_SUNPLUS_THERMAL) += sunplus_thermal.o diff --git a/drivers/thermal/sunplus_thermal.c b/drivers/thermal/sunplus_thermal.c new file mode 100644 index 0000000..9a9b348 --- /dev/null +++ b/drivers/thermal/sunplus_thermal.c @@ -0,0 +1,139 @@ +// SPDX-License-Identifier: GPL-2.0-only +/* + * Copyright (c) Sunplus Inc. + * Author: Li-hao Kuo + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#define DISABLE_THERMAL (BIT(31) | BIT(15)) +#define ENABLE_THERMAL BIT(31) +#define SP_THERMAL_MASK GENMASK(10, 0) +#define SP_TCODE_HIGH_MASK GENMASK(10, 8) +#define SP_TCODE_LOW_MASK GENMASK(7, 0) + +#define TEMP_RATE 608 +#define TEMP_BASE 3500 +#define TEMP_OTP_BASE 1518 + +#define SP_THERMAL_CTL0_REG 0x0000 +#define SP_THERMAL_STS0_REG 0x0030 + +/* common data structures */ +struct sp_thermal_data { + struct thermal_zone_device *pcb_tz; + struct platform_device *pdev; + enum thermal_device_mode mode; + void __iomem *regs; + int otp_temp0; + u32 id; +}; + +static int sp7021_get_otp_temp_coef(struct sp_thermal_data *sp_data, struct device *dev) +{ + struct nvmem_cell *cell; + ssize_t otp_l; + char *otp_v; + + cell = nvmem_cell_get(dev, "calib"); + if (IS_ERR(cell)) + return PTR_ERR(cell); + + otp_v = nvmem_cell_read(cell, &otp_l); + nvmem_cell_put(cell); + + if (otp_l < 3) + return -EINVAL; + sp_data->otp_temp0 = FIELD_PREP(SP_TCODE_LOW_MASK, otp_v[0]) | + FIELD_PREP(SP_TCODE_HIGH_MASK, otp_v[1]); + if (sp_data->otp_temp0 == 0) + sp_data->otp_temp0 = TEMP_OTP_BASE; + return 0; +} + +/* + *When remanufacturing, the 35 degree T_CODE will be read and stored in nvcell. + *TEMP_RATE is the SP7021 temperature slope. + *T_CODE : 11 digits in total + */ + +static int sp_thermal_get_sensor_temp(void *data, int *temp) +{ + struct sp_thermal_data *sp_data = data; + int t_code; + + t_code = readl(sp_data->regs + SP_THERMAL_STS0_REG); + t_code = FIELD_GET(SP_THERMAL_MASK, t_code); + *temp = ((sp_data->otp_temp0 - t_code) * 10000 / TEMP_RATE) + TEMP_BASE; + *temp *= 10; + return 0; +} + +static const struct thermal_zone_of_device_ops sp_of_thermal_ops = { + .get_temp = sp_thermal_get_sensor_temp, +}; + +static int sp_thermal_register_sensor(struct platform_device *pdev, + struct sp_thermal_data *data, int index) +{ + data->id = index; + data->pcb_tz = devm_thermal_zone_of_sensor_register(&pdev->dev, + data->id, + data, &sp_of_thermal_ops); + if (IS_ERR_OR_NULL(data->pcb_tz)) + return PTR_ERR(data->pcb_tz); + return 0; +} + +static int sp7021_thermal_probe(struct platform_device *pdev) +{ + struct sp_thermal_data *sp_data; + struct resource *res; + int ret; + + sp_data = devm_kzalloc(&pdev->dev, sizeof(*sp_data), GFP_KERNEL); + if (!sp_data) + return -ENOMEM; + + sp_data->regs = devm_platform_ioremap_resource(pdev, 0); + if (IS_ERR(sp_data->regs)) { + dev_err(&pdev->dev, "resource get fail\n"); + return PTR_ERR(sp_data->regs); + } + + writel(ENABLE_THERMAL, sp_data->regs + SP_THERMAL_CTL0_REG); + + platform_set_drvdata(pdev, sp_data); + ret = sp7021_get_otp_temp_coef(sp_data, &pdev->dev); + if (ret) + return ret; + ret = sp_thermal_register_sensor(pdev, sp_data, 0); + return ret; +} + +static const struct of_device_id of_sp7021_thermal_ids[] = { + { .compatible = "sunplus,sp7021-thermal" }, + { /* sentinel */ } +}; +MODULE_DEVICE_TABLE(of, of_sp7021_thermal_ids); + +static struct platform_driver sp7021_thermal_driver = { + .probe = sp7021_thermal_probe, + .driver = { + .name = "sp7021-thermal", + .of_match_table = of_sp7021_thermal_ids, + }, +}; +module_platform_driver(sp7021_thermal_driver); + +MODULE_AUTHOR("Li-hao Kuo "); +MODULE_DESCRIPTION("Thermal driver for SP7021 SoC"); +MODULE_LICENSE("GPL");