From patchwork Fri Feb 21 05:49:58 2025 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Chen Wang X-Patchwork-Id: 13984841 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 9C417C021AA for ; Fri, 21 Feb 2025 05:50:16 +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:To:From:Reply-To:Cc:Content-ID:Content-Description: Resent-Date:Resent-From:Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID: List-Owner; bh=+4QHgCZC44kVaRSwf2L5QuskiiiMFWHblxy+o2knIU4=; b=jPvUUPs/exxnsB Tc1Ce9m1IqofkeP3af2136SXwNwSBvNf+0surGIxaEWqjoZKm+2eNGhtxWYZexFb4FTduahL81nXk j5EcOoiajsTN9mJ75paReyKFjjjDIgcHQQQCbdbidCTsuSvTjvXn6FnFap//ccrescdX5TsAmaUus rowvDinwhOTKo8fXmwh46UZDEiklhDl5xpJiAbgh7kd9e5N/kut9N2VsJqdEAQVE1pWiN269Cm8YU oh/LqKJjBR5lHAl8S5m2Hf76N414Bt1gGXQnvA41r6Br/M1Dlf09Ad+gP6nxPD89ltUNx8VmPf7Dv GIosrUElcWDnPPeAI6Kw==; Received: from localhost ([::1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.98 #2 (Red Hat Linux)) id 1tlLvP-00000004HE5-15QY; Fri, 21 Feb 2025 05:50:11 +0000 Received: from mail-oo1-xc32.google.com ([2607:f8b0:4864:20::c32]) by bombadil.infradead.org with esmtps (Exim 4.98 #2 (Red Hat Linux)) id 1tlLvN-00000004HDF-0avE for linux-riscv@lists.infradead.org; Fri, 21 Feb 2025 05:50:10 +0000 Received: by mail-oo1-xc32.google.com with SMTP id 006d021491bc7-5fc447b03f2so436041eaf.0 for ; Thu, 20 Feb 2025 21:50:08 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20230601; t=1740117008; x=1740721808; darn=lists.infradead.org; h=content-transfer-encoding:mime-version:references:in-reply-to :message-id:date:subject:to:from:from:to:cc:subject:date:message-id :reply-to; bh=wIuCoBmmJbqWh/4IUDnMFO7CbsX53Ig+Rbn9kTn8z7k=; b=bLbon/HYM6ui42sOAcJbJFJeKFknSeCRwst+IquQpFlfgnmCnHKPC7ZYiUVUUnCnru mP2SJolJf3Xt+qBWl3JBtVCWkxKULvVBjukySSmkHT96grvV2448zorjbOjTsn5oQ6/1 Il3ok0S5Sg6gVxYLAZbfo3WzOriNotaqjyYBZOWdHcjJAz5/CzSvEQceWjLoidoXGB33 mNzwIKOiREiLliqE0EUWS5ReBG7ExWeMWD/GD6WWVpZElNlovDAwrIB58OPUsLjcYaKz jTc2IAPDbymS/LZzQLYH26g6D0H7MuMkOOOjqY10owobEC6kGgBsiMUcco4qjTTUEFjq kW2g== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20230601; t=1740117008; x=1740721808; h=content-transfer-encoding:mime-version:references:in-reply-to :message-id:date:subject:to:from:x-gm-message-state:from:to:cc :subject:date:message-id:reply-to; bh=wIuCoBmmJbqWh/4IUDnMFO7CbsX53Ig+Rbn9kTn8z7k=; b=HmNsdf0chdylSF+ogWENovcexiC5s3F5qt6mcKvUXDu7ZPbBPlRd/pHba42MFexnHY EbVRVUGjj0ik53RGfyHD2J8FMLOX4sOP3aTIyhQwYlZ6AgoEqUVWfh1crw6iZfYlVIIO BSPQyXPCOKAf6Lo0yt7BPzFesyt40qUrazqjljH1XckKfwX3lucMZsAWqte/DKGaIpJX GPLx8nSAC5D5TqqPJOEC0tNZSwKmTKyaDQGwcN3QXRkf/1/uLk7fnnwnsDr9SWpibNnw Vm6qkafHM9B4MrA1WPYmpmmfRFRYPVbfb3q+RScO2HjHa+zIdlIuNcgP44woED4x9vbm hAQg== X-Forwarded-Encrypted: i=1; AJvYcCUZcIXr2kDbKmD2BBYopkvelxAbiPoQkCNaARlVwgOIL8zT3PfLnRvfsYw+mOCjHutUSKIHCrwQtgESQw==@lists.infradead.org X-Gm-Message-State: AOJu0YxJHyAqSKN0lnYNw7qSX4BpY+NQdg8ftQ7pz1YgI/hxNtt24Duk QfKm9KNriJblhJO04Ng92il//GLpMXTuPMbPerwsVG7l+lzRVHou X-Gm-Gg: ASbGncvM58Tw1nwmG7pHQ7+tolAkQnRQM3uUJ8gP9Pd0owGQkZ5zS/KVDqJhFXd0Ag5 DLyfdW4bthLsRypgDr85Og3WZcBtCXSmKiaITvHtsDk/bjGxVtqkdIb/LKC2kqaSy96e3Md3H7J 2/gEZSsrzU4BKVBhvl61I1LCIWlRwV8N6v58sZVBdmkXA96TlNvgVfkUBYoU4mAe6psphzOwBJg J+xVYLaBD5a7L4f6OBukMCfnoZjN76btBiSVz7soNKueX8yO++HQz9HH75RuYLBmeQ49H8PJkFw OKpCgNOdcBw3zDZH14N7/XJ8nJWi81E2Qwet X-Google-Smtp-Source: AGHT+IE6qBeK9TsEn1fLuU8i6GxNLg8V4wjLi9MJTyltzbCchkV4pktYUBjug+y2v4gbUzIrXIxHKQ== X-Received: by 2002:a05:6808:80b1:b0:3f4:c2b:def7 with SMTP id 5614622812f47-3f4247e3c50mr1406598b6e.33.1740117008010; Thu, 20 Feb 2025 21:50:08 -0800 (PST) Received: from localhost.localdomain ([122.8.183.87]) by smtp.gmail.com with ESMTPSA id 5614622812f47-3f41bc57784sm550230b6e.32.2025.02.20.21.50.05 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Thu, 20 Feb 2025 21:50:06 -0800 (PST) From: Chen Wang To: u.kleine-koenig@baylibre.com, aou@eecs.berkeley.edu, arnd@arndb.de, unicorn_wang@outlook.com, conor+dt@kernel.org, guoren@kernel.org, inochiama@outlook.com, krzk+dt@kernel.org, palmer@dabbelt.com, paul.walmsley@sifive.com, robh@kernel.org, tglx@linutronix.de, devicetree@vger.kernel.org, linux-kernel@vger.kernel.org, linux-riscv@lists.infradead.org, chao.wei@sophgo.com, xiaoguang.xing@sophgo.com, fengchun.li@sophgo.com Subject: [PATCH v4 1/3] dt-bindings: interrupt-controller: Add Sophgo SG2042 MSI Date: Fri, 21 Feb 2025 13:49:58 +0800 Message-Id: <4967e01306c07908caebd60736f898579412765d.1740116190.git.unicorn_wang@outlook.com> X-Mailer: git-send-email 2.34.1 In-Reply-To: References: MIME-Version: 1.0 X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20250220_215009_180474_120ED90D X-CRM114-Status: GOOD ( 11.94 ) X-BeenThere: linux-riscv@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-riscv" Errors-To: linux-riscv-bounces+linux-riscv=archiver.kernel.org@lists.infradead.org From: Chen Wang Add binding for Sophgo SG2042 MSI controller. Signed-off-by: Chen Wang Reviewed-by: Rob Herring (Arm) --- .../sophgo,sg2042-msi.yaml | 61 +++++++++++++++++++ 1 file changed, 61 insertions(+) create mode 100644 Documentation/devicetree/bindings/interrupt-controller/sophgo,sg2042-msi.yaml diff --git a/Documentation/devicetree/bindings/interrupt-controller/sophgo,sg2042-msi.yaml b/Documentation/devicetree/bindings/interrupt-controller/sophgo,sg2042-msi.yaml new file mode 100644 index 000000000000..e1ffd55fa7bf --- /dev/null +++ b/Documentation/devicetree/bindings/interrupt-controller/sophgo,sg2042-msi.yaml @@ -0,0 +1,61 @@ +# SPDX-License-Identifier: (GPL-2.0 OR BSD-2-Clause) +%YAML 1.2 +--- +$id: http://devicetree.org/schemas/interrupt-controller/sophgo,sg2042-msi.yaml# +$schema: http://devicetree.org/meta-schemas/core.yaml# + +title: Sophgo SG2042 MSI Controller + +maintainers: + - Chen Wang + +description: + This interrupt controller is in Sophgo SG2042 for transforming interrupts from + PCIe MSI to PLIC interrupts. + +allOf: + - $ref: /schemas/interrupt-controller/msi-controller.yaml# + +properties: + compatible: + const: sophgo,sg2042-msi + + reg: + items: + - description: clear register + - description: msi doorbell address + + reg-names: + items: + - const: clr + - const: doorbell + + msi-controller: true + + msi-ranges: + maxItems: 1 + + "#msi-cells": + const: 0 + +required: + - compatible + - reg + - reg-names + - msi-controller + - msi-ranges + - "#msi-cells" + +unevaluatedProperties: false + +examples: + - | + #include + msi-controller@30000000 { + compatible = "sophgo,sg2042-msi"; + reg = <0x30000000 0x4>, <0x30000008 0x4>; + reg-names = "clr", "doorbell"; + msi-controller; + #msi-cells = <0>; + msi-ranges = <&plic 64 IRQ_TYPE_LEVEL_HIGH 32>; + }; From patchwork Fri Feb 21 05:50:19 2025 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Chen Wang X-Patchwork-Id: 13984842 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 377BCC021AA for ; Fri, 21 Feb 2025 05:50:37 +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:To:From:Reply-To:Cc:Content-ID:Content-Description: Resent-Date:Resent-From:Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID: List-Owner; bh=mBesqMWEnBAGeaUHTw0N10jWrRppa4qq75BQ1/LWE9M=; b=tSUoH7k/do0rdU JGMbjFbmHCTf6EKTy0dLR9EzBUQEBDZKunDUAcFWxykvlYFnOmEQo8INt19kGyBNz64Q/Sn5SGfrG eH911pdqhsFJcGzdS4AkWAyr41cfC1fEQLKUJ/TIaIqBfn4OytUg1EOgbzkqFRHvKwABbwf83hKqJ VSKEyk3XWhtknhwAUcAZcOfz55Eivgv/oFkyNLc3JJ4jJ1CkSkHD7/lATOtmNvm/lTlauyfj+m3i2 uGbdAI5ZtpPRJknFTfYXrWJCjxudVUPCsaR4OpZ+yDelommvnicKgGQWx5LHcC9hiIZwBzB2Czuqg ni5hc4Fj59ZclPukZ2tw==; Received: from localhost ([::1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.98 #2 (Red Hat Linux)) id 1tlLvj-00000004HM0-3p6u; Fri, 21 Feb 2025 05:50:31 +0000 Received: from mail-oi1-x22f.google.com ([2607:f8b0:4864:20::22f]) by bombadil.infradead.org with esmtps (Exim 4.98 #2 (Red Hat Linux)) id 1tlLvh-00000004HL0-0Jv5 for linux-riscv@lists.infradead.org; Fri, 21 Feb 2025 05:50:30 +0000 Received: by mail-oi1-x22f.google.com with SMTP id 5614622812f47-3f41091f7c5so933953b6e.3 for ; Thu, 20 Feb 2025 21:50:28 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20230601; t=1740117028; x=1740721828; darn=lists.infradead.org; h=content-transfer-encoding:mime-version:references:in-reply-to :message-id:date:subject:to:from:from:to:cc:subject:date:message-id :reply-to; bh=JQEtVB5peFkUVrk+VE9+6V14katRhVhojmMt1aZTL5s=; b=VWsl4EQFiZljqsixZ5wBse3YEPFaYG6QjMZvh7lEk99FBjsCg7BOMf/wJJ7F1722OF 1p+KsZsHpF1ud0TpAaNeIdCtrrrCKvpa0YBuQ/41FO5L8H1ikC2vHj9KuMxkoqhd6pll 2oqq8AkKWtIa1zfBQiBH+BVm6nKdUjLIgF/y7C1CYuC6BIIKzXLADuNSb8WNag3Dmn4n 1e07edjpV60QohkMsVybzmntCa4l3JdHHKkHTcS+VL2wTAOgof5c9rLz9fyUVL+g+CcY 1PT2fbHaXbzJjBCJLtuuEpbHRt/hBtgVxWNI/yJ6qGNuhDg9oCfdbb7ZMX7TxC7uzbET GEcQ== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20230601; t=1740117028; x=1740721828; h=content-transfer-encoding:mime-version:references:in-reply-to :message-id:date:subject:to:from:x-gm-message-state:from:to:cc :subject:date:message-id:reply-to; bh=JQEtVB5peFkUVrk+VE9+6V14katRhVhojmMt1aZTL5s=; b=GbuYnN4dcvUTA0ZpQO2Zb1S0JR69y9OYs4J6owZyZJ/pxnb8COEu5yjCg8fbu9Xlb7 6bt8LanqGP+vWxQOJqoBnkmdJteFTnh921rExLS6CDMLwI3iqpIwLm1M+EoaRgkqEoS2 0u9e1Zh2KYfQdknUrLhSOeFo4nXgbOiyE1HvZw/vXsiU22GKAChYhYVIa9HyM6qPbUYs 373gC5gcFqMAsA0PTTZBdAAYWjxo2TVkERh7Edd7yyMG13ZIY+lCoL+eQrqL3wkde3k/ QQYbZjadK1K8303VjJtaa44zgEEqB8tRcHZbCaMyLogOOrksdEBdzNPiv8NcuUHbgWM2 PijQ== X-Forwarded-Encrypted: i=1; AJvYcCW1XGXlLwrpOn5K9hsFBzCd8zkFxZuCuBDuMOxKwsbr3LaxNX2nGDwWznFvR57fWT6Ds8zvuAsnixpmXA==@lists.infradead.org X-Gm-Message-State: AOJu0YzAkpXGtlv03UBdi28AX8BVM9uoVF8qbAyED0auLOyqU8EOkosj lPdTty8B/EdfsuAiOGYG/q8uf2QntFt/MsEq8sWmi2K+KxR3tSWQ X-Gm-Gg: ASbGnctLAJRo9mOr5qE014yCs1bYYcGQMa3OZ2n2ww1ZMdY1P18Sg3hwfUpmX5QvJpj l0rxXVqwxQP+vwtqaudsAIpf76TFsvAa7QaQ9sVQzCLVIyAyGj6HEA+hcCbjGD6vrlhEsDY0HP4 Jg8UBB3MQwbpK69z+F3XBBdcI3/KVnf9O80DsrIdyYFZH9q9HHSXLt2who4BOrrX/hreeX3jraj mxwyBADgf2NRKr0wCth6aKWk4+NPPtQmWAX863fXNA64MbVeJFD4dtLMdyWXnNojEbRZRfo6AmA hL2qNhuGu0pafxhK6OBE0FDpwQuG5FiqbPRR X-Google-Smtp-Source: AGHT+IGJX0Wo5ZRHH1ezNQwtiBeWjkQ5e9atU+JTlNYEf9NYlannLDQH2oXTboVIc546GfKGuVVnZg== X-Received: by 2002:a05:6808:1392:b0:3f4:1dc8:f52e with SMTP id 5614622812f47-3f425bf28cemr1019954b6e.30.1740117027830; Thu, 20 Feb 2025 21:50:27 -0800 (PST) Received: from localhost.localdomain ([122.8.183.87]) by smtp.gmail.com with ESMTPSA id 5614622812f47-3f4120266e1sm1106369b6e.44.2025.02.20.21.50.24 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Thu, 20 Feb 2025 21:50:26 -0800 (PST) From: Chen Wang To: u.kleine-koenig@baylibre.com, aou@eecs.berkeley.edu, arnd@arndb.de, unicorn_wang@outlook.com, conor+dt@kernel.org, guoren@kernel.org, inochiama@outlook.com, krzk+dt@kernel.org, palmer@dabbelt.com, paul.walmsley@sifive.com, robh@kernel.org, tglx@linutronix.de, devicetree@vger.kernel.org, linux-kernel@vger.kernel.org, linux-riscv@lists.infradead.org, chao.wei@sophgo.com, xiaoguang.xing@sophgo.com, fengchun.li@sophgo.com Subject: [PATCH v4 2/3] irqchip: Add the Sophgo SG2042 MSI interrupt controller Date: Fri, 21 Feb 2025 13:50:19 +0800 Message-Id: X-Mailer: git-send-email 2.34.1 In-Reply-To: References: MIME-Version: 1.0 X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20250220_215029_152062_85F54E14 X-CRM114-Status: GOOD ( 25.64 ) X-BeenThere: linux-riscv@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-riscv" Errors-To: linux-riscv-bounces+linux-riscv=archiver.kernel.org@lists.infradead.org From: Chen Wang Add driver for Sophgo SG2042 MSI interrupt controller. Signed-off-by: Chen Wang Reviewed-by: Inochi Amaoto --- drivers/irqchip/Kconfig | 12 ++ drivers/irqchip/Makefile | 1 + drivers/irqchip/irq-sg2042-msi.c | 264 +++++++++++++++++++++++++++++++ 3 files changed, 277 insertions(+) create mode 100644 drivers/irqchip/irq-sg2042-msi.c diff --git a/drivers/irqchip/Kconfig b/drivers/irqchip/Kconfig index be063bfb50c4..cdb0accd826a 100644 --- a/drivers/irqchip/Kconfig +++ b/drivers/irqchip/Kconfig @@ -751,6 +751,18 @@ config MCHP_EIC help Support for Microchip External Interrupt Controller. +config SOPHGO_SG2042_MSI + bool "Sophgo SG2042 MSI Controller" + depends on ARCH_SOPHGO || COMPILE_TEST + depends on PCI + select IRQ_DOMAIN_HIERARCHY + select IRQ_MSI_LIB + select PCI_MSI + help + Support for the Sophgo SG2042 MSI Controller. + This on-chip interrupt controller enables MSI sources to be + routed to the primary PLIC controller on SoC. + config SUNPLUS_SP7021_INTC bool "Sunplus SP7021 interrupt controller" if COMPILE_TEST default SOC_SP7021 diff --git a/drivers/irqchip/Makefile b/drivers/irqchip/Makefile index 25e9ad29b8c4..dd60e597491d 100644 --- a/drivers/irqchip/Makefile +++ b/drivers/irqchip/Makefile @@ -128,4 +128,5 @@ obj-$(CONFIG_WPCM450_AIC) += irq-wpcm450-aic.o obj-$(CONFIG_IRQ_IDT3243X) += irq-idt3243x.o obj-$(CONFIG_APPLE_AIC) += irq-apple-aic.o obj-$(CONFIG_MCHP_EIC) += irq-mchp-eic.o +obj-$(CONFIG_SOPHGO_SG2042_MSI) += irq-sg2042-msi.o obj-$(CONFIG_SUNPLUS_SP7021_INTC) += irq-sp7021-intc.o diff --git a/drivers/irqchip/irq-sg2042-msi.c b/drivers/irqchip/irq-sg2042-msi.c new file mode 100644 index 000000000000..b7950872ed2e --- /dev/null +++ b/drivers/irqchip/irq-sg2042-msi.c @@ -0,0 +1,264 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * SG2042 MSI Controller + * + * Copyright (C) 2024 Sophgo Technology Inc. + * Copyright (C) 2024 Chen Wang + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "irq-msi-lib.h" + +#define SG2042_MAX_MSI_VECTOR 32 + +struct sg2042_msi_chipdata { + void __iomem *reg_clr; // clear reg, see TRM, 10.1.33, GP_INTR0_CLR + + phys_addr_t doorbell_addr; // see TRM, 10.1.32, GP_INTR0_SET + + u32 irq_first; // The vector number that MSIs starts + u32 num_irqs; // The number of vectors for MSIs + + DECLARE_BITMAP(msi_map, SG2042_MAX_MSI_VECTOR); + struct mutex msi_map_lock; // lock for msi_map +}; + +static int sg2042_msi_allocate_hwirq(struct sg2042_msi_chipdata *data, int num_req) +{ + int first; + + guard(mutex)(&data->msi_map_lock); + first = bitmap_find_free_region(data->msi_map, data->num_irqs, + get_count_order(num_req)); + return first >= 0 ? first : -ENOSPC; +} + +static void sg2042_msi_free_hwirq(struct sg2042_msi_chipdata *data, + int hwirq, int num_req) +{ + guard(mutex)(&data->msi_map_lock); + bitmap_release_region(data->msi_map, hwirq, get_count_order(num_req)); +} + +static void sg2042_msi_irq_ack(struct irq_data *d) +{ + struct sg2042_msi_chipdata *data = irq_data_get_irq_chip_data(d); + int bit_off = d->hwirq; + + writel(1 << bit_off, data->reg_clr); + + irq_chip_ack_parent(d); +} + +static void sg2042_msi_irq_compose_msi_msg(struct irq_data *d, + struct msi_msg *msg) +{ + struct sg2042_msi_chipdata *data = irq_data_get_irq_chip_data(d); + + msg->address_hi = upper_32_bits(data->doorbell_addr); + msg->address_lo = lower_32_bits(data->doorbell_addr); + msg->data = 1 << d->hwirq; +} + +static const struct irq_chip sg2042_msi_middle_irq_chip = { + .name = "SG2042 MSI", + .irq_ack = sg2042_msi_irq_ack, + .irq_mask = irq_chip_mask_parent, + .irq_unmask = irq_chip_unmask_parent, +#ifdef CONFIG_SMP + .irq_set_affinity = irq_chip_set_affinity_parent, +#endif + .irq_compose_msi_msg = sg2042_msi_irq_compose_msi_msg, +}; + +static int sg2042_msi_parent_domain_alloc(struct irq_domain *domain, + unsigned int virq, int hwirq) +{ + struct sg2042_msi_chipdata *data = domain->host_data; + struct irq_fwspec fwspec; + struct irq_data *d; + int ret; + + fwspec.fwnode = domain->parent->fwnode; + fwspec.param_count = 2; + fwspec.param[0] = data->irq_first + hwirq; + fwspec.param[1] = IRQ_TYPE_EDGE_RISING; + + ret = irq_domain_alloc_irqs_parent(domain, virq, 1, &fwspec); + if (ret) + return ret; + + d = irq_domain_get_irq_data(domain->parent, virq); + return d->chip->irq_set_type(d, IRQ_TYPE_EDGE_RISING); +} + +static int sg2042_msi_middle_domain_alloc(struct irq_domain *domain, + unsigned int virq, + unsigned int nr_irqs, void *args) +{ + struct sg2042_msi_chipdata *data = domain->host_data; + int hwirq, err, i; + + hwirq = sg2042_msi_allocate_hwirq(data, nr_irqs); + if (hwirq < 0) + return hwirq; + + for (i = 0; i < nr_irqs; i++) { + err = sg2042_msi_parent_domain_alloc(domain, virq + i, hwirq + i); + if (err) + goto err_hwirq; + + irq_domain_set_hwirq_and_chip(domain, virq + i, hwirq + i, + &sg2042_msi_middle_irq_chip, data); + } + + return 0; + +err_hwirq: + sg2042_msi_free_hwirq(data, hwirq, nr_irqs); + irq_domain_free_irqs_parent(domain, virq, i); + + return err; +} + +static void sg2042_msi_middle_domain_free(struct irq_domain *domain, + unsigned int virq, + unsigned int nr_irqs) +{ + struct irq_data *d = irq_domain_get_irq_data(domain, virq); + struct sg2042_msi_chipdata *data = irq_data_get_irq_chip_data(d); + + irq_domain_free_irqs_parent(domain, virq, nr_irqs); + sg2042_msi_free_hwirq(data, d->hwirq, nr_irqs); +} + +static const struct irq_domain_ops sg2042_msi_middle_domain_ops = { + .alloc = sg2042_msi_middle_domain_alloc, + .free = sg2042_msi_middle_domain_free, + .select = msi_lib_irq_domain_select, +}; + +#define SG2042_MSI_FLAGS_REQUIRED (MSI_FLAG_USE_DEF_DOM_OPS | \ + MSI_FLAG_USE_DEF_CHIP_OPS) + +#define SG2042_MSI_FLAGS_SUPPORTED MSI_GENERIC_FLAGS_MASK + +static const struct msi_parent_ops sg2042_msi_parent_ops = { + .required_flags = SG2042_MSI_FLAGS_REQUIRED, + .supported_flags = SG2042_MSI_FLAGS_SUPPORTED, + .bus_select_mask = MATCH_PCI_MSI, + .bus_select_token = DOMAIN_BUS_NEXUS, + .prefix = "SG2042-", + .init_dev_msi_info = msi_lib_init_dev_msi_info, +}; + +static int sg2042_msi_init_domains(struct sg2042_msi_chipdata *data, + struct device *dev) +{ + struct fwnode_handle *fwnode = dev_fwnode(dev); + struct irq_domain *plic_domain, *middle_domain; + struct fwnode_handle *plic_node; + + plic_node = fwnode_find_reference(fwnode, "msi-ranges", 0); + if (IS_ERR(plic_node)) { + pr_err("Failed to find the PLIC node!\n"); + return PTR_ERR(plic_node); + } + + plic_domain = irq_find_matching_fwnode(plic_node, DOMAIN_BUS_ANY); + fwnode_handle_put(plic_node); + if (!plic_domain) { + pr_err("Failed to find the PLIC domain\n"); + return -ENXIO; + } + + middle_domain = irq_domain_create_hierarchy(plic_domain, 0, data->num_irqs, + fwnode, + &sg2042_msi_middle_domain_ops, + data); + if (!middle_domain) { + pr_err("Failed to create the MSI middle domain\n"); + return -ENOMEM; + } + + irq_domain_update_bus_token(middle_domain, DOMAIN_BUS_NEXUS); + + middle_domain->flags |= IRQ_DOMAIN_FLAG_MSI_PARENT; + middle_domain->msi_parent_ops = &sg2042_msi_parent_ops; + + return 0; +} + +static int sg2042_msi_probe(struct platform_device *pdev) +{ + struct fwnode_reference_args args = {}; + struct sg2042_msi_chipdata *data; + struct device *dev = &pdev->dev; + struct resource *res; + int ret; + + data = devm_kzalloc(dev, sizeof(struct sg2042_msi_chipdata), GFP_KERNEL); + if (!data) + return -ENOMEM; + + data->reg_clr = devm_platform_ioremap_resource_byname(pdev, "clr"); + if (IS_ERR(data->reg_clr)) { + dev_err(dev, "Failed to map clear register\n"); + return PTR_ERR(data->reg_clr); + } + + res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "doorbell"); + if (!res) { + dev_err(dev, "Failed get resource from set\n"); + return -EINVAL; + } + data->doorbell_addr = res->start; + + ret = fwnode_property_get_reference_args(dev_fwnode(dev), "msi-ranges", + "#interrupt-cells", 0, 0, &args); + if (ret) { + dev_err(dev, "Unable to parse MSI vec base\n"); + return ret; + } + fwnode_handle_put(args.fwnode); + + ret = fwnode_property_get_reference_args(dev_fwnode(dev), "msi-ranges", + NULL, args.nargs + 1, + 0, &args); + if (ret) { + dev_err(dev, "Unable to parse MSI vec number\n"); + return ret; + } + fwnode_handle_put(args.fwnode); + + data->irq_first = (u32)args.args[0]; + data->num_irqs = (u32)args.args[args.nargs - 1]; + + mutex_init(&data->msi_map_lock); + + return sg2042_msi_init_domains(data, dev); +} + +static const struct of_device_id sg2042_msi_of_match[] = { + { .compatible = "sophgo,sg2042-msi" }, + {} +}; + +static struct platform_driver sg2042_msi_driver = { + .driver = { + .name = "sg2042-msi", + .of_match_table = sg2042_msi_of_match, + }, + .probe = sg2042_msi_probe, +}; +builtin_platform_driver(sg2042_msi_driver); From patchwork Fri Feb 21 05:50:38 2025 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Chen Wang X-Patchwork-Id: 13984843 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 E0380C021AA for ; Fri, 21 Feb 2025 05:50:56 +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:To:From:Reply-To:Cc:Content-ID:Content-Description: Resent-Date:Resent-From:Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID: List-Owner; bh=Q3JKRgPrniwYe7JQ6sa1SJLwbbYm901Cce1wq4WdSh4=; b=q3LbWAsEM1VqWD v5/Q7v9fEtCuMA1KsnLMRnqwCBhMlMEh6yHs9mEB5IbYfNqaUyDn9dL3q7SBsBjhLtHP4R7KLmglF DWU+5RClkbYlPm4bsOGQdI9DGrwjGId+YKhniFrzQ91O5u3MczQaT2EX1HLoS6iocRW8X6D3aWw8C ilbQw/hwlD4pAaFRshLFO/rqu/7cRIqPR2V7aoBDF5ie2ls/Em6AqdtFWmfNxQPS2ADJp8EIPIYZN zIcDLdc92BtUUwvB1Z9Yloffkd6YUq3K82jHEMMCjKOg5tJzUL5yLQnEKnqQBLxYw4C7FvqdA1kF1 kXjC/vDKcA97lt0bmG9w==; Received: from localhost ([::1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.98 #2 (Red Hat Linux)) id 1tlLw3-00000004HVL-2fGt; Fri, 21 Feb 2025 05:50:51 +0000 Received: from mail-oo1-xc2b.google.com ([2607:f8b0:4864:20::c2b]) by bombadil.infradead.org with esmtps (Exim 4.98 #2 (Red Hat Linux)) id 1tlLw1-00000004HUV-2qgE for linux-riscv@lists.infradead.org; Fri, 21 Feb 2025 05:50:50 +0000 Received: by mail-oo1-xc2b.google.com with SMTP id 006d021491bc7-5fcf21d7235so635416eaf.0 for ; Thu, 20 Feb 2025 21:50:49 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20230601; t=1740117049; x=1740721849; darn=lists.infradead.org; h=content-transfer-encoding:mime-version:references:in-reply-to :message-id:date:subject:to:from:from:to:cc:subject:date:message-id :reply-to; bh=KHGavz6z1XAW16p7P/7q7QGD5LUvtpVWO2vRaC4bQT4=; b=jr3WI7HGB1FHKagxJYUfbJaNcPDcfzwLF9ixK01XLhNFuGx2/JOTfkRVagOVhdnHTS JmuGAkNBZzJYawb9Ldm+vK678dgqQHvkHQIpaeRtd82L98zwskSwFR1y8lNKIliF1UiO cTMKe94SdP5m6SWOChw1IFJuXqCjMhpxRt88qDPRr9WW+TrOPU0IR4HW9BpZKza2Bhrz Usi6gHLLVeKCMYABc/cbKMkCzdn3yQo8v3HaSTABZ87CP3vAFigRg40VheAzFJskfGoY ezDc2pHfLoTF454eH9QX85dIxM5e1LUbmOJqlnEkZAiNd6t3FqquIdu2e56+UroGatva jtNQ== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20230601; t=1740117049; x=1740721849; h=content-transfer-encoding:mime-version:references:in-reply-to :message-id:date:subject:to:from:x-gm-message-state:from:to:cc :subject:date:message-id:reply-to; bh=KHGavz6z1XAW16p7P/7q7QGD5LUvtpVWO2vRaC4bQT4=; b=lBT02mJ4E4keaMDauxIRtF739wAwi/LhwpSrQXuy3Ufi7fLcj0NLZZqdtorbtYLlyO bSjIaRn6nRPXp+JcWZ0XvHjgoy9DGOgU1c/Bhhok452iXQGDoPIqalBZ5lhaFsFQTG09 Al0wrV1mtYEh03sW58TApV2+K7XXs3G6FdmBovj5DhH8IC102pIYwT6XRk58drEG6N7h nMGj1Mqd9KnZKaBynkaj9/sN4+qS43l++Ixw1vmSeGuqmSwELrZuQfN68YZxyn5vW+ji 6CUZAWHGDSrIfOKlt+uhDUIB2Cr8iUgBx0UMq9hKHX5b4dlUmQarA6JKgpJ4vts/esIc yjTQ== X-Forwarded-Encrypted: i=1; AJvYcCUEXk0OCbd+W9sczHz/DY+ZXtlka6OtRq/IlVhf58cj4oTM3Cvmuv9k+MgPQ4xupGV5/a4Hv8vOaKwc0g==@lists.infradead.org X-Gm-Message-State: AOJu0YyfYuNG3hkGY9EsLyhXxVCN5RI8nhgKn4duyytVO5k0Z3c/IzVz z/Tf0LSHKT1rHErqUMPg5+UtR0M7WA7BvnXNdm1qZ/YwUfJNnfmE X-Gm-Gg: ASbGncvXuKVHZqe155QVluP4S+ban6BkFqTJBQWFHGe8WXmGbr54Ypdwoi9TsNggKh8 4LJAXLtoor60djWB3LaWgy9MlzyYiwPmiKJCxuHJvJI6CZFPhkKykTYgOCz9wYvL1Q0K0O6NCxg 5YPKe5njvJMGCCx4xp8pNK+0L8vJUbji3bAqPQLCPpvPnUAlO045l0PAxWGOL9RrSqe3X1ZeBrj pKkfr3cB+iZ3VJKBgWFqkp/2ubmPny1UHccjglrMI5C1udGE7onJfrmH7NXEWA5zzpGs2gSlwtj 7xvUNb/xL0txxql+HZJsuUGHysTkiUC8V0TH X-Google-Smtp-Source: AGHT+IFwikgEbJWrEyp4vrUx8cx9RHZSejrAnFnvwxrUiLhFl9PU70edm1tzNRG0rhEUOQ1UVD5Lig== X-Received: by 2002:a05:6820:8cc:b0:5fc:f9b4:7f49 with SMTP id 006d021491bc7-5fd1a9ab7e8mr984921eaf.5.1740117048687; Thu, 20 Feb 2025 21:50:48 -0800 (PST) Received: from localhost.localdomain ([122.8.183.87]) by smtp.gmail.com with ESMTPSA id 006d021491bc7-5fcdca274ecsm2553301eaf.0.2025.02.20.21.50.45 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Thu, 20 Feb 2025 21:50:47 -0800 (PST) From: Chen Wang To: u.kleine-koenig@baylibre.com, aou@eecs.berkeley.edu, arnd@arndb.de, unicorn_wang@outlook.com, conor+dt@kernel.org, guoren@kernel.org, inochiama@outlook.com, krzk+dt@kernel.org, palmer@dabbelt.com, paul.walmsley@sifive.com, robh@kernel.org, tglx@linutronix.de, devicetree@vger.kernel.org, linux-kernel@vger.kernel.org, linux-riscv@lists.infradead.org, chao.wei@sophgo.com, xiaoguang.xing@sophgo.com, fengchun.li@sophgo.com Subject: [PATCH v4 3/3] riscv: sophgo: dts: add msi controller for SG2042 Date: Fri, 21 Feb 2025 13:50:38 +0800 Message-Id: <9706541bcb87fca5331a085dc8e5f9a921ed5918.1740116190.git.unicorn_wang@outlook.com> X-Mailer: git-send-email 2.34.1 In-Reply-To: References: MIME-Version: 1.0 X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20250220_215049_740384_29666F40 X-CRM114-Status: UNSURE ( 8.76 ) X-CRM114-Notice: Please train this message. X-BeenThere: linux-riscv@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-riscv" Errors-To: linux-riscv-bounces+linux-riscv=archiver.kernel.org@lists.infradead.org From: Chen Wang Add msi-controller node to dts for SG2042. Signed-off-by: Chen Wang --- arch/riscv/boot/dts/sophgo/sg2042.dtsi | 10 ++++++++++ 1 file changed, 10 insertions(+) diff --git a/arch/riscv/boot/dts/sophgo/sg2042.dtsi b/arch/riscv/boot/dts/sophgo/sg2042.dtsi index e62ac51ac55a..fef2a0e0f7a3 100644 --- a/arch/riscv/boot/dts/sophgo/sg2042.dtsi +++ b/arch/riscv/boot/dts/sophgo/sg2042.dtsi @@ -173,6 +173,16 @@ pllclk: clock-controller@70300100c0 { #clock-cells = <1>; }; + msi: msi-controller@7030010304 { + compatible = "sophgo,sg2042-msi"; + reg = <0x70 0x30010304 0x0 0x4>, + <0x70 0x30010300 0x0 0x4>; + reg-names = "clr", "doorbell"; + msi-controller; + #msi-cells = <0>; + msi-ranges = <&intc 64 IRQ_TYPE_LEVEL_HIGH 32>; + }; + rpgate: clock-controller@7030010368 { compatible = "sophgo,sg2042-rpgate"; reg = <0x70 0x30010368 0x0 0x98>;