Received: by 2002:ab2:6991:0:b0:1f7:f6c3:9cb1 with SMTP id v17csp316406lqo; Wed, 8 May 2024 00:00:32 -0700 (PDT) X-Forwarded-Encrypted: i=3; AJvYcCWzERddve5rO6rkdjHh1cO7ExAdTp+urk3Xmpqg5XNW8aU9nyREkejxGvwC9gHjkMN004QgAFBBqwoRAQarQvBkhVheAz3qNgNj4XkBKQ== X-Google-Smtp-Source: AGHT+IHEv8fMxGSNIjCXi6m7f0cbrrqCUhjSgcZQZUhg/migYXCrw0uH99NeAOhzzVnEpxAmrbx2 X-Received: by 2002:a05:6a00:4e47:b0:6f3:ef3d:60f3 with SMTP id d2e1a72fcca58-6f49c2bba60mr1889836b3a.29.1715151631928; Wed, 08 May 2024 00:00:31 -0700 (PDT) ARC-Seal: i=2; a=rsa-sha256; t=1715151631; cv=pass; d=google.com; s=arc-20160816; b=lSsYn58eM5CU4MoCk9l9EXFq5XgzYrZy6OepAxZTwlW5BkCHnmfOyin1421x7uVJqZ IB9cLU1BdzeWE94FmR1skOvD1bRtkJr7ubl27nKCtluD8LaWF+Lrae/nPAJcvp3LXi0Y seQ1lmF7DlKNJLDB0itrZQjSipkSVuClmCVcOvrHi76jGGMKI4cGnBEIevip+P8aVubA /WgcjMOXeOX1OuZKvLXtyKxiD7dqEDcg2KdHzOIXFBoV2VaMgaxF2mxd+FAlKoxios5c PZjLzpUzcfdP9aAM+KylXBwEqI5wVkuwtZ9iqoSVq3vwtQgooWncJB/2Snyg1Usu9FcG x4Zw== ARC-Message-Signature: i=2; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=content-transfer-encoding:content-language:in-reply-to:mime-version :list-unsubscribe:list-subscribe:list-id:precedence:user-agent:date :message-id:from:references:cc:to:subject; bh=jGBrFOrRmzmqw2eMcKYBN6RJV3/BpyyGTTzetFsQt28=; fh=WrA8K8eoj3aAKUgkDbiQNI0xhGzwWdRFVc5C1864xmk=; b=vMdM95dn3Sn/hnzArIkzCze9KG93ED58VUMeEvzDcuV6YZ6P5utM5ST4H4XTmDp+vx B/WiVZwo2+bBx1y3TIrKiZZWmQ6obnxep0hw1UfQ0m9IdgjYF9GQn8nKYpiNHQE/XuKD 9tpD29Nl5q4kb3fDWN0SnYfeR+osWQ37nHRCtMVuugPwQRgckQwwF56dKJYJhalBUZN5 NsHQdHYn8Y9aOVsvEijrUB88hyX5y+To8E1tDivhGjdpz7y41VpBB1B77vvqVp3zRPa+ hWm9x+racQLrEKIYI3+1eX0WkdC1DEGUVO8zE/L27zFQ5LI8ZvheJocmWh7N6XpT+5VI O4bw==; dara=google.com ARC-Authentication-Results: i=2; mx.google.com; arc=pass (i=1 spf=pass spfdomain=loongson.cn); spf=pass (google.com: domain of linux-kernel+bounces-172778-linux.lists.archive=gmail.com@vger.kernel.org designates 147.75.48.161 as permitted sender) smtp.mailfrom="linux-kernel+bounces-172778-linux.lists.archive=gmail.com@vger.kernel.org" Return-Path: Received: from sy.mirrors.kernel.org (sy.mirrors.kernel.org. [147.75.48.161]) by mx.google.com with ESMTPS id j6-20020aa78dc6000000b006f455203de4si8556246pfr.30.2024.05.08.00.00.31 for (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Wed, 08 May 2024 00:00:31 -0700 (PDT) Received-SPF: pass (google.com: domain of linux-kernel+bounces-172778-linux.lists.archive=gmail.com@vger.kernel.org designates 147.75.48.161 as permitted sender) client-ip=147.75.48.161; Authentication-Results: mx.google.com; arc=pass (i=1 spf=pass spfdomain=loongson.cn); spf=pass (google.com: domain of linux-kernel+bounces-172778-linux.lists.archive=gmail.com@vger.kernel.org designates 147.75.48.161 as permitted sender) smtp.mailfrom="linux-kernel+bounces-172778-linux.lists.archive=gmail.com@vger.kernel.org" Received: from smtp.subspace.kernel.org (wormhole.subspace.kernel.org [52.25.139.140]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by sy.mirrors.kernel.org (Postfix) with ESMTPS id 39D8AB223D9 for ; Wed, 8 May 2024 07:00:30 +0000 (UTC) Received: from localhost.localdomain (localhost.localdomain [127.0.0.1]) by smtp.subspace.kernel.org (Postfix) with ESMTP id 3FCD922301; Wed, 8 May 2024 07:00:23 +0000 (UTC) Received: from mail.loongson.cn (mail.loongson.cn [114.242.206.163]) by smtp.subspace.kernel.org (Postfix) with ESMTP id 2A8EB1A2C15; Wed, 8 May 2024 07:00:16 +0000 (UTC) Authentication-Results: smtp.subspace.kernel.org; arc=none smtp.client-ip=114.242.206.163 ARC-Seal:i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1715151621; cv=none; b=fLc+PMO+UYKUEvLslURbIWPpW/pMuWoN0DD3U7wAm1fKeTyHP7LtHPhGanHTydPTTc8LK3fxRVU4Rho9sm6kShHnewQCLLgs99r8UYwLE3zjRNSnbW2w2NB4V0s2b2e+wcxkbDqt0Uqm3ZPYcWEvf9GGxIPfaWPAGmWJiu0xAKE= ARC-Message-Signature:i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1715151621; c=relaxed/simple; bh=x41MsKxY249A36fkoWdLniDHK02+MF9GrYAxFRztLiE=; h=Subject:To:Cc:References:From:Message-ID:Date:MIME-Version: In-Reply-To:Content-Type; b=UVw1gUJCxlUzRu51NiAr/s9nVL3jnv+TLJz5mY7wKgzXzVql4jL9gVrw7jW1ADqnH8X1ia/NLBP8KXUmSnnFNp9DyN63kdU/T+CtH3Lwf5A40RsjMlOGMfbktTAbaktQn+H68Iq1i74BDZL/JA1Dt6fPQa6vubV/GLhYUBrA3Is= ARC-Authentication-Results:i=1; smtp.subspace.kernel.org; dmarc=none (p=none dis=none) header.from=loongson.cn; spf=pass smtp.mailfrom=loongson.cn; arc=none smtp.client-ip=114.242.206.163 Authentication-Results: smtp.subspace.kernel.org; dmarc=none (p=none dis=none) header.from=loongson.cn Authentication-Results: smtp.subspace.kernel.org; spf=pass smtp.mailfrom=loongson.cn Received: from loongson.cn (unknown [10.20.42.173]) by gateway (Coremail) with SMTP id _____8BxtOr_IjtmljwJAA--.12537S3; Wed, 08 May 2024 15:00:15 +0800 (CST) Received: from [10.20.42.173] (unknown [10.20.42.173]) by localhost.localdomain (Coremail) with SMTP id AQAAf8CxC977Ijtml0wVAA--.41437S3; Wed, 08 May 2024 15:00:13 +0800 (CST) Subject: Re: [PATCH 2/2] Loongarch:Support loongarch avec To: Tianyang Zhang , chenhuacai@kernel.org, kernel@xen0n.name, tglx@linutronix.de, jiaxun.yang@flygoat.com, gaoliang@loongson.cn, wangliupu@loongson.cn, lvjianmin@loongson.cn, yijun@loongson.cn, mhocko@suse.com, akpm@linux-foundation.org, dianders@chromium.org, xry111@xry111.site, zhaotianrui@loongson.cn, nathan@kernel.org, yangtiezhu@loongson.cn, zhoubinbin@loongson.cn Cc: loongarch@lists.linux.dev, linux-doc@vger.kernel.org, linux-kernel@vger.kernel.org References: <20240507125953.9117-1-zhangtianyang@loongson.cn> From: maobibo Message-ID: Date: Wed, 8 May 2024 15:00:09 +0800 User-Agent: Mozilla/5.0 (X11; Linux loongarch64; rv:68.0) Gecko/20100101 Thunderbird/68.7.0 Precedence: bulk X-Mailing-List: linux-kernel@vger.kernel.org List-Id: List-Subscribe: List-Unsubscribe: MIME-Version: 1.0 In-Reply-To: <20240507125953.9117-1-zhangtianyang@loongson.cn> Content-Type: text/plain; charset=utf-8; format=flowed Content-Language: en-US Content-Transfer-Encoding: 8bit X-CM-TRANSID:AQAAf8CxC977Ijtml0wVAA--.41437S3 X-CM-SenderInfo: xpdruxter6z05rqj20fqof0/ X-Coremail-Antispam: 1Uk129KBj9fXoWfXw4UCrWfJFWxKr1xurW3urX_yoW5Gw43to WfJFySvw1rGr17Cr98tw1qqFyYqr18ArWDAasrZFsY9F4UtrZ0kFW7Gw43tFWxG3WkKrZr Gay7WrZ7Xa97twnxl-sFpf9Il3svdjkaLaAFLSUrUUUUeb8apTn2vfkv8UJUUUU8wcxFpf 9Il3svdxBIdaVrn0xqx4xG64xvF2IEw4CE5I8CrVC2j2Jv73VFW2AGmfu7bjvjm3AaLaJ3 UjIYCTnIWjp_UUUOn7kC6x804xWl14x267AKxVWUJVW8JwAFc2x0x2IEx4CE42xK8VAvwI 8IcIk0rVWrJVCq3wAFIxvE14AKwVWUXVWUAwA2ocxC64kIII0Yj41l84x0c7CEw4AK67xG Y2AK021l84ACjcxK6xIIjxv20xvE14v26r1I6r4UM28EF7xvwVC0I7IYx2IY6xkF7I0E14 v26r1j6r4UM28EF7xvwVC2z280aVAFwI0_Gr1j6F4UJwA2z4x0Y4vEx4A2jsIEc7CjxVAF wI0_Gr1j6F4UJwAaw2AFwI0_JF0_Jw1le2I262IYc4CY6c8Ij28IcVAaY2xG8wAqjxCEc2 xF0cIa020Ex4CE44I27wAqx4xG64xvF2IEw4CE5I8CrVC2j2WlYx0E2Ix0cI8IcVAFwI0_ JF0_Jw1lYx0Ex4A2jsIE14v26r4j6F4UMcvjeVCFs4IE7xkEbVWUJVW8JwACjcxG0xvEwI xGrwCYjI0SjxkI62AI1cAE67vIY487MxkF7I0En4kS14v26r126r1DMxAIw28IcxkI7VAK I48JMxC20s026xCaFVCjc4AY6r1j6r4UMxCIbckI1I0E14v26r126r1DMI8I3I0E5I8CrV AFwI0_Jr0_Jr4lx2IqxVCjr7xvwVAFwI0_JrI_JrWlx4CE17CEb7AF67AKxVW8ZVWrXwCI c40Y0x0EwIxGrwCI42IY6xIIjxv20xvE14v26r1I6r4UMIIF0xvE2Ix0cI8IcVCY1x0267 AKxVWUJVW8JwCI42IY6xAIw20EY4v20xvaj40_Jr0_JF4lIxAIcVC2z280aVAFwI0_Gr0_ Cr1lIxAIcVC2z280aVCY1x0267AKxVW8JVW8JrUvcSsGvfC2KfnxnUUI43ZEXa7IU8uc_3 UUUUU== On 2024/5/7 下午8:59, Tianyang Zhang wrote: > From: zhangtianyang > > Introduce the advanced extended interrupt controllers, > This feature will allow each core to have an independent > 256 interrupt vectors, and MSI interrupts can be > independently routed to any vector on any CPU. Hi tianyang, Thanks for provide the patch. One simple question, can old kernel without this driver such as kernel 6.8 run in the new hardware with advanced extended interrupt controllers? > > Co-developed-by: Jianmin Lv > Signed-off-by: Jianmin Lv > Co-developed-by: Liupu Wang > Signed-off-by: Liupu Wang > Signed-off-by: Tianyang Zhang > --- > arch/loongarch/Kconfig | 1 + > arch/loongarch/include/asm/cpu-features.h | 1 + > arch/loongarch/include/asm/cpu.h | 2 + > arch/loongarch/include/asm/hw_irq.h | 10 + > arch/loongarch/include/asm/irq.h | 7 +- > arch/loongarch/include/asm/loongarch.h | 19 +- > arch/loongarch/include/asm/smp.h | 1 + > arch/loongarch/kernel/cpu-probe.c | 3 +- > arch/loongarch/kernel/smp.c | 3 + > drivers/irqchip/Makefile | 2 +- > drivers/irqchip/irq-loongarch-avec.c | 434 ++++++++++++++++++++++ > drivers/irqchip/irq-loongarch-cpu.c | 4 +- > drivers/irqchip/irq-loongson-eiointc.c | 3 + > drivers/irqchip/irq-loongson-pch-msi.c | 45 ++- > 14 files changed, 525 insertions(+), 10 deletions(-) > create mode 100644 drivers/irqchip/irq-loongarch-avec.c > > diff --git a/arch/loongarch/Kconfig b/arch/loongarch/Kconfig > index 10959e6c3583..71b8f19745e0 100644 > --- a/arch/loongarch/Kconfig > +++ b/arch/loongarch/Kconfig > @@ -76,6 +76,7 @@ config LOONGARCH > select GENERIC_ENTRY > select GENERIC_GETTIMEOFDAY > select GENERIC_IOREMAP if !ARCH_IOREMAP > + select GENERIC_IRQ_MATRIX_ALLOCATOR > select GENERIC_IRQ_MULTI_HANDLER > select GENERIC_IRQ_PROBE > select GENERIC_IRQ_SHOW > diff --git a/arch/loongarch/include/asm/cpu-features.h b/arch/loongarch/include/asm/cpu-features.h > index 2eafe6a6aca8..16a716f88a5c 100644 > --- a/arch/loongarch/include/asm/cpu-features.h > +++ b/arch/loongarch/include/asm/cpu-features.h > @@ -65,5 +65,6 @@ > #define cpu_has_guestid cpu_opt(LOONGARCH_CPU_GUESTID) > #define cpu_has_hypervisor cpu_opt(LOONGARCH_CPU_HYPERVISOR) > #define cpu_has_ptw cpu_opt(LOONGARCH_CPU_PTW) > +#define cpu_has_avecint cpu_opt(LOONGARCH_CPU_AVECINT) > > #endif /* __ASM_CPU_FEATURES_H */ > diff --git a/arch/loongarch/include/asm/cpu.h b/arch/loongarch/include/asm/cpu.h > index 48b9f7168bcc..843f9c4ec980 100644 > --- a/arch/loongarch/include/asm/cpu.h > +++ b/arch/loongarch/include/asm/cpu.h > @@ -99,6 +99,7 @@ enum cpu_type_enum { > #define CPU_FEATURE_GUESTID 24 /* CPU has GuestID feature */ > #define CPU_FEATURE_HYPERVISOR 25 /* CPU has hypervisor (running in VM) */ > #define CPU_FEATURE_PTW 26 /* CPU has hardware page table walker */ > +#define CPU_FEATURE_AVECINT 27 /* CPU has avec interrupt */ > > #define LOONGARCH_CPU_CPUCFG BIT_ULL(CPU_FEATURE_CPUCFG) > #define LOONGARCH_CPU_LAM BIT_ULL(CPU_FEATURE_LAM) > @@ -127,5 +128,6 @@ enum cpu_type_enum { > #define LOONGARCH_CPU_GUESTID BIT_ULL(CPU_FEATURE_GUESTID) > #define LOONGARCH_CPU_HYPERVISOR BIT_ULL(CPU_FEATURE_HYPERVISOR) > #define LOONGARCH_CPU_PTW BIT_ULL(CPU_FEATURE_PTW) > +#define LOONGARCH_CPU_AVECINT BIT_ULL(CPU_FEATURE_AVECINT) > > #endif /* _ASM_CPU_H */ > diff --git a/arch/loongarch/include/asm/hw_irq.h b/arch/loongarch/include/asm/hw_irq.h > index af4f4e8fbd85..521abce32135 100644 > --- a/arch/loongarch/include/asm/hw_irq.h > +++ b/arch/loongarch/include/asm/hw_irq.h > @@ -9,6 +9,16 @@ > > extern atomic_t irq_err_count; > > +/* > + * 256 vectors Map: > + * > + * 0 - 15: mapping legacy IPs, e.g. IP0-12. > + * 16 - 255: mapping a vector for external IRQ. > + * > + */ > +#define NR_VECTORS 256 > +#define IRQ_MATRIX_BITS NR_VECTORS > +#define NR_LEGACY_VECTORS 16 > /* > * interrupt-retrigger: NOP for now. This may not be appropriate for all > * machines, we'll see ... > diff --git a/arch/loongarch/include/asm/irq.h b/arch/loongarch/include/asm/irq.h > index 218b4da0ea90..e28bd96c6611 100644 > --- a/arch/loongarch/include/asm/irq.h > +++ b/arch/loongarch/include/asm/irq.h > @@ -65,7 +65,7 @@ extern struct acpi_vector_group msi_group[MAX_IO_PICS]; > #define LOONGSON_LPC_LAST_IRQ (LOONGSON_LPC_IRQ_BASE + 15) > > #define LOONGSON_CPU_IRQ_BASE 16 > -#define LOONGSON_CPU_LAST_IRQ (LOONGSON_CPU_IRQ_BASE + 14) > +#define LOONGSON_CPU_LAST_IRQ (LOONGSON_CPU_IRQ_BASE + 15) > > #define LOONGSON_PCH_IRQ_BASE 64 > #define LOONGSON_PCH_ACPI_IRQ (LOONGSON_PCH_IRQ_BASE + 47) > @@ -101,6 +101,11 @@ int pch_msi_acpi_init(struct irq_domain *parent, > struct acpi_madt_msi_pic *acpi_pchmsi); > int pch_pic_acpi_init(struct irq_domain *parent, > struct acpi_madt_bio_pic *acpi_pchpic); > +int __init pch_msi_acpi_init_v2(struct irq_domain *parent, > + struct acpi_madt_msi_pic *pch_msi_entry); > +int __init loongarch_avec_acpi_init(struct irq_domain *parent); > +void complete_irq_moving(int *restart); > + > int find_pch_pic(u32 gsi); > struct fwnode_handle *get_pch_msi_handle(int pci_segment); > > diff --git a/arch/loongarch/include/asm/loongarch.h b/arch/loongarch/include/asm/loongarch.h > index 46366e783c84..4d9a09861925 100644 > --- a/arch/loongarch/include/asm/loongarch.h > +++ b/arch/loongarch/include/asm/loongarch.h > @@ -72,7 +72,6 @@ > #define CPUCFG1_RPLV BIT(23) > #define CPUCFG1_HUGEPG BIT(24) > #define CPUCFG1_CRC32 BIT(25) > -#define CPUCFG1_MSGINT BIT(26) > > #define LOONGARCH_CPUCFG2 0x2 > #define CPUCFG2_FP BIT(0) > @@ -240,8 +239,8 @@ > #define CSR_ESTAT_EXC_WIDTH 6 > #define CSR_ESTAT_EXC (_ULCAST_(0x3f) << CSR_ESTAT_EXC_SHIFT) > #define CSR_ESTAT_IS_SHIFT 0 > -#define CSR_ESTAT_IS_WIDTH 14 > -#define CSR_ESTAT_IS (_ULCAST_(0x3fff) << CSR_ESTAT_IS_SHIFT) > +#define CSR_ESTAT_IS_WIDTH 15 > +#define CSR_ESTAT_IS (_ULCAST_(0x7fff) << CSR_ESTAT_IS_SHIFT) > > #define LOONGARCH_CSR_ERA 0x6 /* ERA */ > > @@ -987,10 +986,17 @@ > #define CSR_FWPC_SKIP_SHIFT 16 > #define CSR_FWPC_SKIP (_ULCAST_(1) << CSR_FWPC_SKIP_SHIFT) > > +#define LOONGARCH_CSR_IRR0 0xa0 > +#define LOONGARCH_CSR_IRR1 0xa1 > +#define LOONGARCH_CSR_IRR2 0xa2 > +#define LOONGARCH_CSR_IRR3 0xa3 > + > +#define LOONGARCH_CSR_ILR 0xa4 > + > /* > * CSR_ECFG IM > */ > -#define ECFG0_IM 0x00001fff > +#define ECFG0_IM 0x00005fff > #define ECFGB_SIP0 0 > #define ECFGF_SIP0 (_ULCAST_(1) << ECFGB_SIP0) > #define ECFGB_SIP1 1 > @@ -1033,6 +1039,7 @@ > #define IOCSRF_EIODECODE BIT_ULL(9) > #define IOCSRF_FLATMODE BIT_ULL(10) > #define IOCSRF_VM BIT_ULL(11) > +#define IOCSRF_AVEC BIT_ULL(15) > > #define LOONGARCH_IOCSR_VENDOR 0x10 > > @@ -1043,6 +1050,7 @@ > #define LOONGARCH_IOCSR_MISC_FUNC 0x420 > #define IOCSR_MISC_FUNC_TIMER_RESET BIT_ULL(21) > #define IOCSR_MISC_FUNC_EXT_IOI_EN BIT_ULL(48) > +#define IOCSR_MISC_FUNC_AVEC_EN BIT_ULL(51) > > #define LOONGARCH_IOCSR_CPUTEMP 0x428 > > @@ -1363,9 +1371,10 @@ __BUILD_CSR_OP(tlbidx) > #define INT_TI 11 /* Timer */ > #define INT_IPI 12 > #define INT_NMI 13 > +#define INT_AVEC 14 > > /* ExcCodes corresponding to interrupts */ > -#define EXCCODE_INT_NUM (INT_NMI + 1) > +#define EXCCODE_INT_NUM (INT_AVEC + 1) > #define EXCCODE_INT_START 64 > #define EXCCODE_INT_END (EXCCODE_INT_START + EXCCODE_INT_NUM - 1) > > diff --git a/arch/loongarch/include/asm/smp.h b/arch/loongarch/include/asm/smp.h > index f81e5f01d619..577f591c1c73 100644 > --- a/arch/loongarch/include/asm/smp.h > +++ b/arch/loongarch/include/asm/smp.h > @@ -62,6 +62,7 @@ extern int __cpu_logical_map[NR_CPUS]; > #define SMP_BOOT_CPU 0x1 > #define SMP_RESCHEDULE 0x2 > #define SMP_CALL_FUNCTION 0x4 > +#define SMP_CLEAR_VECT 0x8 > > struct secondary_data { > unsigned long stack; > diff --git a/arch/loongarch/kernel/cpu-probe.c b/arch/loongarch/kernel/cpu-probe.c > index 55320813ee08..3b2e72e8f9bd 100644 > --- a/arch/loongarch/kernel/cpu-probe.c > +++ b/arch/loongarch/kernel/cpu-probe.c > @@ -106,7 +106,6 @@ static void cpu_probe_common(struct cpuinfo_loongarch *c) > elf_hwcap |= HWCAP_LOONGARCH_CRC32; > } > > - > config = read_cpucfg(LOONGARCH_CPUCFG2); > if (config & CPUCFG2_LAM) { > c->options |= LOONGARCH_CPU_LAM; > @@ -176,6 +175,8 @@ static void cpu_probe_common(struct cpuinfo_loongarch *c) > c->options |= LOONGARCH_CPU_EIODECODE; > if (config & IOCSRF_VM) > c->options |= LOONGARCH_CPU_HYPERVISOR; > + if (config & IOCSRF_AVEC) > + c->options |= LOONGARCH_CPU_AVECINT; > > config = csr_read32(LOONGARCH_CSR_ASID); > config = (config & CSR_ASID_BIT) >> CSR_ASID_BIT_SHIFT; > diff --git a/arch/loongarch/kernel/smp.c b/arch/loongarch/kernel/smp.c > index a16e3dbe9f09..4fcf399a8b17 100644 > --- a/arch/loongarch/kernel/smp.c > +++ b/arch/loongarch/kernel/smp.c > @@ -176,6 +176,9 @@ irqreturn_t loongson_ipi_interrupt(int irq, void *dev) > per_cpu(irq_stat, cpu).ipi_irqs[IPI_CALL_FUNCTION]++; > } > > + if (action & SMP_CLEAR_VECT) > + complete_irq_moving(NULL); > + > return IRQ_HANDLED; > } > > diff --git a/drivers/irqchip/Makefile b/drivers/irqchip/Makefile > index ec4a18380998..398db4c3e264 100644 > --- a/drivers/irqchip/Makefile > +++ b/drivers/irqchip/Makefile > @@ -105,7 +105,7 @@ obj-$(CONFIG_LS1X_IRQ) += irq-ls1x.o > obj-$(CONFIG_TI_SCI_INTR_IRQCHIP) += irq-ti-sci-intr.o > obj-$(CONFIG_TI_SCI_INTA_IRQCHIP) += irq-ti-sci-inta.o > obj-$(CONFIG_TI_PRUSS_INTC) += irq-pruss-intc.o > -obj-$(CONFIG_IRQ_LOONGARCH_CPU) += irq-loongarch-cpu.o > +obj-$(CONFIG_IRQ_LOONGARCH_CPU) += irq-loongarch-cpu.o irq-loongarch-avec.o > obj-$(CONFIG_LOONGSON_LIOINTC) += irq-loongson-liointc.o > obj-$(CONFIG_LOONGSON_EIOINTC) += irq-loongson-eiointc.o > obj-$(CONFIG_LOONGSON_HTPIC) += irq-loongson-htpic.o > diff --git a/drivers/irqchip/irq-loongarch-avec.c b/drivers/irqchip/irq-loongarch-avec.c > new file mode 100644 > index 000000000000..71ce33db63db > --- /dev/null > +++ b/drivers/irqchip/irq-loongarch-avec.c > @@ -0,0 +1,434 @@ > +// SPDX-License-Identifier: GPL-2.0 > +/* > + * Copyright (C) 2020 Loongson Technologies, Inc. > + */ > + > +#include > +#include > +#include > +#include > +#include > +#include > +#include > +#include > +#include > +#include > +#include > + > +#include > +#include > + > +static phys_addr_t msi_base_v2; > + > +typedef struct irq_data *irq_map_t[NR_VECTORS]; > +DECLARE_PER_CPU(irq_map_t, irq_map); > +DEFINE_PER_CPU(irq_map_t, irq_map) = { > + [0 ... NR_VECTORS - 1] = NULL, > +}; > + > +struct pending_list { > + struct list_head head; > + raw_spinlock_t lock; > +}; > + > +DEFINE_PER_CPU(struct pending_list, pending_list); > + > +struct loongarch_avec_chip { > + struct fwnode_handle *fwnode; > + struct irq_domain *domain; > + struct irq_matrix *vector_matrix; > + raw_spinlock_t lock; > +} loongarch_avec; > + > +struct loongarch_avec_data { > + struct list_head entry; > + unsigned int cpu; > + unsigned int vec; > + unsigned int prev_cpu; > + unsigned int prev_vec; > +}; > + > +static int assign_irq_vector(struct irq_data *irqd, const struct cpumask *dest, > + unsigned int *cpu, int *vector) > +{ > + int ret; > + > + ret = irq_matrix_alloc(loongarch_avec.vector_matrix, dest, false, cpu); > + if (ret < 0) > + return ret; > + *vector = ret; > + > + return 0; > +} > + > +static inline void loongarch_avec_ack_irq(struct irq_data *d) > +{ > +} > + > +static inline void loongarch_avec_unmask_irq(struct irq_data *d) > +{ > +} > + > +static inline void loongarch_avec_mask_irq(struct irq_data *d) > +{ > +} > + > +static void loongarch_avec_sync(struct loongarch_avec_data *adata) > +{ > + struct loongarch_avec_data *data; > + struct pending_list *plist; > + > + if (cpu_online(adata->prev_cpu)) { > + plist = per_cpu_ptr(&pending_list, adata->prev_cpu); > + > + data = kmalloc(sizeof(struct loongarch_avec_data), GFP_KERNEL); > + if (!data) { > + pr_warn("NO space for clean data\n"); > + return; > + } > + memcpy(data, adata, sizeof(struct loongarch_avec_data)); > + INIT_LIST_HEAD(&data->entry); > + > + list_add_tail(&data->entry, &plist->head); > + loongson_send_ipi_single(adata->prev_cpu, SMP_CLEAR_VECT); > + } > + adata->prev_cpu = adata->cpu; > + adata->prev_vec = adata->vec; > +} > + > +static int loongarch_avec_set_affinity(struct irq_data *data, > + const struct cpumask *dest, bool force) > +{ > + struct cpumask intersect_mask; > + struct loongarch_avec_data *adata; > + unsigned int cpu, vector; > + unsigned long flags; > + int ret = 0; > + > + raw_spin_lock_irqsave(&loongarch_avec.lock, flags); > + adata = irq_data_get_irq_chip_data(data); > + > + if (adata->vec && cpu_online(adata->cpu) > + && cpumask_test_cpu(adata->cpu, dest)) { > + raw_spin_unlock_irqrestore(&loongarch_avec.lock, flags); > + return 0; > + } > + > + if (!cpumask_intersects(dest, cpu_online_mask)) { > + raw_spin_unlock_irqrestore(&loongarch_avec.lock, flags); > + return -EINVAL; > + } > + > + cpumask_and(&intersect_mask, dest, cpu_online_mask); > + > + ret = assign_irq_vector(data, &intersect_mask, &cpu, &vector); > + if (ret) { > + raw_spin_unlock_irqrestore(&loongarch_avec.lock, flags); > + return ret; > + } > + > + adata->cpu = cpu; > + adata->vec = vector; > + per_cpu_ptr(irq_map, adata->cpu)[adata->vec] = data; > + loongarch_avec_sync(adata); > + > + raw_spin_unlock_irqrestore(&loongarch_avec.lock, flags); > + irq_data_update_effective_affinity(data, cpumask_of(cpu)); > + > + return IRQ_SET_MASK_OK; > +} > + > +static void loongarch_avec_compose_msg(struct irq_data *d, > + struct msi_msg *msg) > +{ > + struct loongarch_avec_data *avec_data; > + > + avec_data = irq_data_get_irq_chip_data(d); > + > + msg->address_hi = 0x0; > + msg->address_lo = msi_base_v2 | ((avec_data->vec & 0xff) << 4) | > + ((cpu_logical_map(avec_data->cpu & 0xffff)) << 12); There is requirement for variable msi_base_v2 aligned with 1<< 28. Is that right? However there is no such checking in function pch_msi_parse_madt(). Also it will be better if there is some notations. > + msg->data = 0x0; > + > +} > + > +static struct irq_chip loongarch_avec_controller = { > + .name = "CORE_AVEC", > + .irq_ack = loongarch_avec_ack_irq, > + .irq_mask = loongarch_avec_mask_irq, > + .irq_unmask = loongarch_avec_unmask_irq, > + .irq_set_affinity = loongarch_avec_set_affinity, > + .irq_compose_msi_msg = loongarch_avec_compose_msg, > +}; > + > +void complete_irq_moving(int *restart) > +{ > + struct pending_list *plist = this_cpu_ptr(&pending_list); > + struct loongarch_avec_data *adata, *tmp; > + int cpu, vector; > + u32 bias; > + u64 irr; > + > + raw_spin_lock(&loongarch_avec.lock); > + > + list_for_each_entry_safe(adata, tmp, &plist->head, entry) { > + > + cpu = adata->prev_cpu; > + vector = adata->prev_vec; > + bias = vector/64; > + switch (bias) { > + case 0x0: > + irr = csr_read64(LOONGARCH_CSR_IRR0); > + break; > + case 0x1: > + irr = csr_read64(LOONGARCH_CSR_IRR1); > + break; > + case 0x2: > + irr = csr_read64(LOONGARCH_CSR_IRR2); > + break; > + case 0x3: > + irr = csr_read64(LOONGARCH_CSR_IRR3); > + break; > + default: > + return; > + } > + > + if (irr & (1UL << (vector % 64))) { > + loongson_send_ipi_single(cpu, SMP_CLEAR_VECT); It is strange that sending ipi to itself to clear MSI interrupt. It requires that there cannot be loop check in ipi interrupt handler, else ipi hanlder loop checking will find new IPI message again. Is it possible to do_irq() for MSI interrupt directly in ipi handler? d = raw_cpu_ptr(irq_map)[vector]; if (d) generic_handle_irq(d->irq); > + continue; > + } > + list_del(&adata->entry); > + irq_matrix_free(loongarch_avec.vector_matrix, cpu, vector, false); > + this_cpu_ptr(irq_map)[vector] = 0; > + kfree(adata); > + } > + raw_spin_unlock(&loongarch_avec.lock); > +} > + > +static void loongarch_avec_dispatch(struct irq_desc *desc) > +{ > + struct irq_chip *chip = irq_desc_get_chip(desc); > + struct irq_data *d; > + unsigned long vector; > + > + chained_irq_enter(chip, desc); > + vector = csr_read64(LOONGARCH_CSR_ILR); > + if (vector & 0x80000000) > + return; what is the meaning of 0x80000000? It had better be defined as macro. Regards Bibo Mao > + > + vector &= 0xff; > + > + d = raw_cpu_ptr(irq_map)[vector]; > + if (d) > + generic_handle_irq(d->irq); > + else > + pr_warn("IRQ ERROR:Unexpected irq occur on cpu %d[vector %d]\n", > + smp_processor_id(), vector); > + > + chained_irq_exit(chip, desc); > +} > + > +static int loongarch_avec_alloc(struct irq_domain *domain, unsigned int virq, > + unsigned int nr_irqs, void *arg) > +{ > + struct loongarch_avec_data *adata; > + struct irq_data *irqd; > + unsigned int cpu, vector; > + unsigned long flags; > + int i, err; > + > + raw_spin_lock_irqsave(&loongarch_avec.lock, flags); > + for (i = 0; i < nr_irqs; i++) { > + irqd = irq_domain_get_irq_data(domain, virq + i); > + adata = kzalloc(sizeof(*adata), GFP_KERNEL); > + if (!adata) { > + raw_spin_unlock_irqrestore(&loongarch_avec.lock, flags); > + return -ENOMEM; > + } > + err = assign_irq_vector(irqd, cpu_online_mask, &cpu, &vector); > + if (err) { > + raw_spin_unlock_irqrestore(&loongarch_avec.lock, flags); > + return err; > + } > + adata->prev_cpu = adata->cpu = cpu; > + adata->prev_vec = adata->vec = vector; > + > + per_cpu_ptr(irq_map, adata->cpu)[adata->vec] = irqd; > + irq_domain_set_info(domain, virq + i, virq, &loongarch_avec_controller, > + adata, handle_edge_irq, NULL, NULL); > + irqd_set_single_target(irqd); > + irqd_set_affinity_on_activate(irqd); > + } > + raw_spin_unlock_irqrestore(&loongarch_avec.lock, flags); > + > + return err; > +} > + > +static void loongarch_avec_free(struct irq_domain *domain, unsigned int virq, > + unsigned int nr_irqs) > +{ > + struct loongarch_avec_data *adata; > + struct irq_data *d; > + unsigned long flags; > + unsigned int i; > + > + raw_spin_lock_irqsave(&loongarch_avec.lock, flags); > + for (i = 0; i < nr_irqs; i++) { > + d = irq_domain_get_irq_data(domain, virq + i); > + adata = irq_data_get_irq_chip_data(d); > + if (d) { > + irq_matrix_free(loongarch_avec.vector_matrix, > + adata->cpu, > + adata->vec, false); > + irq_domain_reset_irq_data(d); > + } > + } > + > + raw_spin_unlock_irqrestore(&loongarch_avec.lock, flags); > +} > + > +static const struct irq_domain_ops loongarch_avec_domain_ops = { > + .alloc = loongarch_avec_alloc, > + .free = loongarch_avec_free, > +}; > + > +static int __init irq_matrix_init(void) > +{ > + int i; > + > + loongarch_avec.vector_matrix = irq_alloc_matrix(NR_VECTORS, 0, NR_VECTORS - 1); > + if (!loongarch_avec.vector_matrix) > + return -ENOMEM; > + for (i = 0; i < NR_LEGACY_VECTORS; i++) > + irq_matrix_assign_system(loongarch_avec.vector_matrix, i, false); > + > + irq_matrix_online(loongarch_avec.vector_matrix); > + > + return 0; > +} > + > +static int __init loongarch_avec_init(struct irq_domain *parent) > +{ > + int ret = 0, parent_irq; > + unsigned long tmp; > + > + tmp = iocsr_read64(LOONGARCH_IOCSR_MISC_FUNC); > + tmp |= IOCSR_MISC_FUNC_AVEC_EN; > + iocsr_write64(tmp, LOONGARCH_IOCSR_MISC_FUNC); > + > + raw_spin_lock_init(&loongarch_avec.lock); > + > + loongarch_avec.fwnode = irq_domain_alloc_named_fwnode("CORE_AVEC"); > + if (!loongarch_avec.fwnode) { > + pr_err("Unable to allocate domain handle\n"); > + ret = -ENOMEM; > + goto out; > + } > + > + loongarch_avec.domain = irq_domain_create_tree(loongarch_avec.fwnode, > + &loongarch_avec_domain_ops, NULL); > + if (!loongarch_avec.domain) { > + pr_err("core-vec: cannot create IRQ domain\n"); > + ret = -ENOMEM; > + goto out_free_handle; > + } > + > + parent_irq = irq_create_mapping(parent, INT_AVEC); > + if (!parent_irq) { > + pr_err("Failed to mapping hwirq\n"); > + ret = -EINVAL; > + goto out_remove_domain; > + } > + irq_set_chained_handler_and_data(parent_irq, loongarch_avec_dispatch, NULL); > + > + ret = irq_matrix_init(); > + if (ret) { > + pr_err("Failed to init irq matrix\n"); > + goto out_free_matrix; > + } > + > + return ret; > + > +out_free_matrix: > + kfree(loongarch_avec.vector_matrix); > +out_remove_domain: > + irq_domain_remove(loongarch_avec.domain); > +out_free_handle: > + irq_domain_free_fwnode(loongarch_avec.fwnode); > +out: > + return ret; > +} > + > +static int loongarch_avec_offline_cpu(unsigned int cpu) > +{ > + unsigned long flags; > + struct pending_list *plist = per_cpu_ptr(&pending_list, cpu); > + > + raw_spin_lock_irqsave(&loongarch_avec.lock, flags); > + if (list_empty(&plist->head)) { > + irq_matrix_offline(loongarch_avec.vector_matrix); > + } else { > + pr_warn("cpu %d advanced extioi is busy\n"); > + raw_spin_unlock_irqrestore(&loongarch_avec.lock, flags); > + return -EBUSY; > + } > + raw_spin_unlock_irqrestore(&loongarch_avec.lock, flags); > + return 0; > +} > + > +static int loongarch_avec_online_cpu(unsigned int cpu) > +{ > + struct pending_list *plist = per_cpu_ptr(&pending_list, cpu); > + unsigned long flags; > + > + raw_spin_lock_irqsave(&loongarch_avec.lock, flags); > + > + irq_matrix_online(loongarch_avec.vector_matrix); > + > + INIT_LIST_HEAD(&plist->head); > + > + raw_spin_unlock_irqrestore(&loongarch_avec.lock, flags); > + return 0; > +} > +#if defined(CONFIG_ACPI) > +static int __init pch_msi_parse_madt(union acpi_subtable_headers *header, > + const unsigned long end) > +{ > + struct acpi_madt_msi_pic *pchmsi_entry = (struct acpi_madt_msi_pic *)header; > + > + msi_base_v2 = pchmsi_entry->msg_address; > + return pch_msi_acpi_init_v2(loongarch_avec.domain, pchmsi_entry); > +} > + > +static inline int __init acpi_cascade_irqdomain_init(void) > +{ > + return acpi_table_parse_madt(ACPI_MADT_TYPE_MSI_PIC, pch_msi_parse_madt, 1); > +} > + > +int __init loongarch_avec_acpi_init(struct irq_domain *parent) > +{ > + int ret = 0; > + > + ret = loongarch_avec_init(parent); > + if (ret) { > + pr_err("Failed to init irq domain\n"); > + return ret; > + } > + > + ret = acpi_cascade_irqdomain_init(); > + if (ret) { > + pr_err("Failed to cascade IRQ domain\n"); > + return ret; > + } > + > + ret = cpuhp_setup_state_nocalls(CPUHP_AP_ONLINE_DYN, > + "loongarch_avec:online", > + loongarch_avec_online_cpu, loongarch_avec_offline_cpu); > + if (ret < 0) { > + pr_err("loongarch_avec: failed to register hotplug callbacks.\n"); > + return ret; > + } > + > + return ret; > +} > +#endif > diff --git a/drivers/irqchip/irq-loongarch-cpu.c b/drivers/irqchip/irq-loongarch-cpu.c > index 9d8f2c406043..1ecac59925c6 100644 > --- a/drivers/irqchip/irq-loongarch-cpu.c > +++ b/drivers/irqchip/irq-loongarch-cpu.c > @@ -138,7 +138,9 @@ static int __init acpi_cascade_irqdomain_init(void) > if (r < 0) > return r; > > - return 0; > + if (cpu_has_avecint) > + r = loongarch_avec_acpi_init(irq_domain); > + return r; > } > > static int __init cpuintc_acpi_init(union acpi_subtable_headers *header, > diff --git a/drivers/irqchip/irq-loongson-eiointc.c b/drivers/irqchip/irq-loongson-eiointc.c > index 405f622a26ad..39795241304e 100644 > --- a/drivers/irqchip/irq-loongson-eiointc.c > +++ b/drivers/irqchip/irq-loongson-eiointc.c > @@ -359,6 +359,9 @@ static int __init acpi_cascade_irqdomain_init(void) > if (r < 0) > return r; > > + if (cpu_has_avecint) > + return 0; > + > r = acpi_table_parse_madt(ACPI_MADT_TYPE_MSI_PIC, pch_msi_parse_madt, 1); > if (r < 0) > return r; > diff --git a/drivers/irqchip/irq-loongson-pch-msi.c b/drivers/irqchip/irq-loongson-pch-msi.c > index 6e1e1f011bb2..d1706080b4f4 100644 > --- a/drivers/irqchip/irq-loongson-pch-msi.c > +++ b/drivers/irqchip/irq-loongson-pch-msi.c > @@ -16,7 +16,6 @@ > #include > > static int nr_pics; > - > struct pch_msi_data { > struct mutex msi_map_lock; > phys_addr_t doorbell; > @@ -100,6 +99,17 @@ static struct irq_chip middle_irq_chip = { > .irq_compose_msi_msg = pch_msi_compose_msi_msg, > }; > > +static struct irq_chip pch_msi_irq_chip_v2 = { > + .name = "MSI", > + .irq_ack = irq_chip_ack_parent, > +}; > + > +static struct msi_domain_info pch_msi_domain_info_v2 = { > + .flags = MSI_FLAG_USE_DEF_DOM_OPS | MSI_FLAG_USE_DEF_CHIP_OPS | > + MSI_FLAG_MULTI_PCI_MSI | MSI_FLAG_PCI_MSIX, > + .chip = &pch_msi_irq_chip_v2, > +}; > + > static int pch_msi_parent_domain_alloc(struct irq_domain *domain, > unsigned int virq, int hwirq) > { > @@ -268,6 +278,9 @@ struct fwnode_handle *get_pch_msi_handle(int pci_segment) > { > int i; > > + if (cpu_has_avecint) > + return pch_msi_handle[0]; > + > for (i = 0; i < MAX_IO_PICS; i++) { > if (msi_group[i].pci_segment == pci_segment) > return pch_msi_handle[i]; > @@ -289,4 +302,34 @@ int __init pch_msi_acpi_init(struct irq_domain *parent, > > return ret; > } > + > +int __init pch_msi_acpi_init_v2(struct irq_domain *parent, > + struct acpi_madt_msi_pic *msi_entry) > +{ > + struct irq_domain *msi_domain; > + > + if (pch_msi_handle[0]) > + return 0; > + > + pch_msi_handle[0] = irq_domain_alloc_named_fwnode("msipic-v2"); > + if (!pch_msi_handle[0]) { > + pr_err("Unable to allocate domain handle\n"); > + kfree(pch_msi_handle[0]); > + return -ENOMEM; > + } > + > + msi_domain = pci_msi_create_irq_domain(pch_msi_handle[0], > + &pch_msi_domain_info_v2, > + parent); > + if (!msi_domain) { > + pr_err("Failed to create PCI MSI domain\n"); > + kfree(pch_msi_handle[0]); > + return -ENOMEM; > + } > + > + pr_info("IRQ domain MSIPIC-V2 init done.\n"); > + return 0; > +} > + > + > #endif >