From patchwork Wed Apr 20 13:05:24 2022 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: =?utf-8?b?UmV4LUJDIENoZW4gKOmZs+afj+i+sCk=?= X-Patchwork-Id: 12820239 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 bombadil.infradead.org (bombadil.infradead.org [198.137.202.133]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by smtp.lore.kernel.org (Postfix) with ESMTPS id 4ECA0C4332F for ; Wed, 20 Apr 2022 13:18:42 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=lists.infradead.org; s=bombadil.20210309; h=Sender: Content-Transfer-Encoding:Content-Type:List-Subscribe:List-Help:List-Post: List-Archive:List-Unsubscribe:List-Id:MIME-Version:References:In-Reply-To: Message-ID:Date:Subject:CC:To:From:Reply-To:Content-ID:Content-Description: Resent-Date:Resent-From:Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID: List-Owner; bh=omTui9N9TQee7accOKxW50an6zRLMuXuTtQIxDQfKLw=; b=FMDhGJTf1hfRXq wRA0RO3IHTNb0BnfgB5s0wQ5pw0Sa6H1u76W2gSGD9IABUXqpsuUWpdTybOVLCX0SB9jbs+5JcFiR 0Z9hiha4biI75HCvdrwuiUcaRmH3PHL3lQqG/MT7l7SJPvpXjyU9JxIcKDBomtQbMo5qUYtmZS0C5 CIo6HYUBuGo0MSbsOJ/L4SHMOGzFdXU6SCxHfjIdlPRgVnEqaiFJify/gUqHwNyuuxzRXLewuR29T mN8eHjDJJjEcF4mMR/GoM3SM9RH3Sv3+vIcX/5S85LPu1V2Gv9Nf5zo7WU7nerK/VEII++ndOJA1y BqCw+q7HlOAn2Z70Pinw==; Received: from localhost ([::1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.94.2 #2 (Red Hat Linux)) id 1nhAE8-0099VK-3R; Wed, 20 Apr 2022 13:18:36 +0000 Received: from mailgw01.mediatek.com ([216.200.240.184]) by bombadil.infradead.org with esmtps (Exim 4.94.2 #2 (Red Hat Linux)) id 1nhABM-0098HJ-9z; Wed, 20 Apr 2022 13:15:45 +0000 X-UUID: bb34963c7d754bcbaca2855ff7ebaaf4-20220420 X-CID-P-RULE: Release_Ham X-CID-O-INFO: VERSION:1.1.4, REQID:cb818ee4-0bde-483e-b4ac-4c0e777421ff, OB:0, LO B:0,IP:0,URL:8,TC:0,Content:-20,EDM:0,RT:0,SF:0,FILE:0,RULE:Release_Ham,AC TION:release,TS:-12 X-CID-META: VersionHash:faefae9, CLOUDID:f9135df0-da02-41b4-b6df-58f4ccd36682, C OID:IGNORED,Recheck:0,SF:nil,TC:nil,Content:0,EDM:-3,File:nil,QS:0,BEC:nil X-UUID: bb34963c7d754bcbaca2855ff7ebaaf4-20220420 Received: from mtkcas66.mediatek.inc [(172.29.193.44)] by mailgw01.mediatek.com (envelope-from ) (musrelay.mediatek.com ESMTP with TLSv1.2 ECDHE-RSA-AES256-SHA384 256/256) with ESMTP id 1398031451; Wed, 20 Apr 2022 06:15:38 -0700 Received: from mtkexhb01.mediatek.inc (172.21.101.102) by MTKMBS62N1.mediatek.inc (172.29.193.41) with Microsoft SMTP Server (TLS) id 15.0.1497.2; Wed, 20 Apr 2022 06:05:40 -0700 Received: from mtkcas10.mediatek.inc (172.21.101.39) by mtkexhb01.mediatek.inc (172.21.101.102) with Microsoft SMTP Server (TLS) id 15.0.1497.2; Wed, 20 Apr 2022 21:05:30 +0800 Received: from mtksdccf07.mediatek.inc (172.21.84.99) by mtkcas10.mediatek.inc (172.21.101.73) with Microsoft SMTP Server id 15.0.1497.2 via Frontend Transport; Wed, 20 Apr 2022 21:05:30 +0800 From: Rex-BC Chen To: , CC: , , , , , , , , , , , , Rex-BC Chen Subject: [PATCH V2 09/12] clk: mediatek: reset: Add support for input offset and bit from DT Date: Wed, 20 Apr 2022 21:05:24 +0800 Message-ID: <20220420130527.23200-10-rex-bc.chen@mediatek.com> X-Mailer: git-send-email 2.18.0 In-Reply-To: <20220420130527.23200-1-rex-bc.chen@mediatek.com> References: <20220420130527.23200-1-rex-bc.chen@mediatek.com> MIME-Version: 1.0 X-MTK: N X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20220420_061544_407927_C2C90107 X-CRM114-Status: GOOD ( 14.85 ) X-BeenThere: linux-mediatek@lists.infradead.org X-Mailman-Version: 2.1.34 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Sender: "Linux-mediatek" Errors-To: linux-mediatek-bounces+linux-mediatek=archiver.kernel.org@lists.infradead.org To use the clock reset function easier, we implement the of_xlate. This function is only adopted in version MTK_SET_CLR because of the method of id calculation. There is no impact for original use. If the argument number is not larger than 1, it will return original id. With this implementation if we want to set offset 0x120 and bit 16, we can just write something like "resets = <&infra_rst 0x120 16>;". Signed-off-by: Rex-BC Chen --- drivers/clk/mediatek/reset.c | 24 ++++++++++++++++++++++++ drivers/clk/mediatek/reset.h | 1 + 2 files changed, 25 insertions(+) diff --git a/drivers/clk/mediatek/reset.c b/drivers/clk/mediatek/reset.c index 1173111af3ab..dbe812062bf5 100644 --- a/drivers/clk/mediatek/reset.c +++ b/drivers/clk/mediatek/reset.c @@ -59,6 +59,20 @@ static const struct reset_control_ops mtk_reset_ops_set_clr = { .reset = mtk_reset_set_clr, }; +static int reset_xlate(struct reset_controller_dev *rcdev, + const struct of_phandle_args *reset_spec) +{ + unsigned int offset, bit; + + if (reset_spec->args_count <= 1) + return reset_spec->args[0]; + + offset = reset_spec->args[0]; + bit = reset_spec->args[1]; + + return (offset >> 4) * 32 + bit; +} + static const struct reset_control_ops *rst_op[MTK_RST_MAX] = { [MTK_RST_SIMPLE] = &reset_simple_ops, [MTK_RST_SET_CLR] = &mtk_reset_ops_set_clr, @@ -98,6 +112,11 @@ int mtk_clk_register_rst_ctrl(struct device_node *np, data->rcdev.ops = rst_op[desc->version]; data->rcdev.of_node = np; + if (desc->version == MTK_RST_SET_CLR) { + data->rcdev.of_reset_n_cells = max(desc->reset_n_cells, 1); + data->rcdev.of_xlate = reset_xlate; + } + ret = reset_controller_register(&data->rcdev); if (ret) { pr_err("could not register reset controller: %d\n", ret); @@ -143,6 +162,11 @@ int mtk_clk_register_rst_ctrl_with_dev(struct device *dev, data->rcdev.of_node = np; data->rcdev.dev = dev; + if (desc->version == MTK_RST_SET_CLR) { + data->rcdev.of_reset_n_cells = max(desc->reset_n_cells, 1); + data->rcdev.of_xlate = reset_xlate; + } + ret = devm_reset_controller_register(dev, &data->rcdev); if (ret) dev_err(dev, "could not register reset controller: %d\n", ret); diff --git a/drivers/clk/mediatek/reset.h b/drivers/clk/mediatek/reset.h index 30559bf45f7e..4cfc281fc50d 100644 --- a/drivers/clk/mediatek/reset.h +++ b/drivers/clk/mediatek/reset.h @@ -19,6 +19,7 @@ struct mtk_clk_rst_desc { u8 version; u32 reg_num; u16 reg_ofs; + int reset_n_cells; }; struct mtk_clk_rst_data {