Received: by 2002:a6b:500f:0:0:0:0:0 with SMTP id e15csp616541iob; Wed, 18 May 2022 09:13:07 -0700 (PDT) X-Google-Smtp-Source: ABdhPJzvnE25VOlcli/5JpC95eS44xG9jWE/FXoeWi2DY4uYb8SIFRsWw8SjTUH0aR7ZpzTavyc/ X-Received: by 2002:a63:f844:0:b0:3f5:d437:3129 with SMTP id v4-20020a63f844000000b003f5d4373129mr212459pgj.142.1652890386926; Wed, 18 May 2022 09:13:06 -0700 (PDT) ARC-Seal: i=1; a=rsa-sha256; t=1652890386; cv=none; d=google.com; s=arc-20160816; b=WzbKiBwnDn9J0TirB5u/TtfVB1dTuhWs6zwwpVzX/kaNeIvNMGJktgPRTaRJtxJhk9 uEkw0I5kT75q2MkyfHdOa9I5UjmXA6dm767t43MjVIS+1dAG4qYakkfMpOr+DV80Wqyo TxIoWLDXZph6z0pMdX5r2fSyDfrwPGbj6HpBPMBwHS9utlvekQ+ca6bY21HXFF2GhuBK FtGq8TI6iG8FE0RKDNlcNjBmcKr8DsQPbi9IY6v2zxdaWeJaFPL4IPUBhEbaMuH+Zie0 n0Ktl3O3SNwEURVIMh6PNwyusLIR+8TkuPbUmzSyUTaaDX1RXs0Mg62Ktj0A3q5TzADZ UsXg== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=list-id:precedence:content-transfer-encoding:cc:to:subject :message-id:date:from:in-reply-to:references:mime-version :dkim-signature; bh=a8y0e8c2L7hgPII16VYHf9bqToDWEXHPjnMQeUSEefE=; b=jeKX9S23V2M0Ec2wxAub/3wKxRSohggeMGW97A+xNqxuIFEa2OrQ4RtGmxAEbR9RZI ksKHYskUiYDjw4j47NIbLGGsWlH6SDkvf13quRUj0xwPgSKUOCd4F9CeH4hdS6+x8Yfn S4RR32Le6YVgh3wBpKmmCRYd6XQJH6J6IGHgjwWwtzdszxt5rRZ2YzHqa5B8xkfva/4i XE3ADwM6ZmEdJFuMzlYtAp1iFpcffhtf14a0t1RXF0U6zVCLZ2GPZApMgAlfk5pG76+Z 1y2VEP1P2b0xhu1M5XmY0XaEFb3uD1KOsKFMBwJD4HLtm7CZshbufBXJgk3+rzeYXonh u1Ew== ARC-Authentication-Results: i=1; mx.google.com; dkim=pass header.i=@gmail.com header.s=20210112 header.b="Cz54/4PJ"; spf=pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::1:18 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=pass (p=NONE sp=QUARANTINE dis=NONE) header.from=gmail.com Return-Path: Received: from lindbergh.monkeyblade.net (lindbergh.monkeyblade.net. [2620:137:e000::1:18]) by mx.google.com with ESMTPS id d9-20020a170902cec900b00161a548df6fsi3369544plg.147.2022.05.18.09.13.01 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Wed, 18 May 2022 09:13:06 -0700 (PDT) Received-SPF: pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::1:18 as permitted sender) client-ip=2620:137:e000::1:18; Authentication-Results: mx.google.com; dkim=pass header.i=@gmail.com header.s=20210112 header.b="Cz54/4PJ"; spf=pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::1:18 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=pass (p=NONE sp=QUARANTINE dis=NONE) header.from=gmail.com Received: from vger.kernel.org (vger.kernel.org [23.128.96.18]) by lindbergh.monkeyblade.net (Postfix) with ESMTP id 4B7991D8649; Wed, 18 May 2022 09:09:44 -0700 (PDT) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S239873AbiERQJA (ORCPT + 99 others); Wed, 18 May 2022 12:09:00 -0400 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:55896 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S239851AbiERQI4 (ORCPT ); Wed, 18 May 2022 12:08:56 -0400 Received: from mail-ua1-x934.google.com (mail-ua1-x934.google.com [IPv6:2607:f8b0:4864:20::934]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id 83F3A1C5F90; Wed, 18 May 2022 09:08:52 -0700 (PDT) Received: by mail-ua1-x934.google.com with SMTP id x11so1015915uao.2; Wed, 18 May 2022 09:08:52 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20210112; h=mime-version:references:in-reply-to:from:date:message-id:subject:to :cc:content-transfer-encoding; bh=a8y0e8c2L7hgPII16VYHf9bqToDWEXHPjnMQeUSEefE=; b=Cz54/4PJ4ONLJa6q41k034M7QiCbBV3lPaN85KA153lL8Vp6gXTnlLGWco01OYFUwa EQKQ0qQjlxb0WDO+GUnXzo6vXm64z/7LdjjSxuGM9kd6PqXOQ8N4F/mKX6ycZikRsCvg nRvQcC2UL8qL5a1HgxkIgo9nc3cWa3sylT/wLu9oO5QwQMoe19+D3JsNJ6L41X845i2n FspYdYqrQpqJUiaUptDU/g9e4BW4UzJjIu+nXp0h4twF6uG9DNWUgu53pN5OCb5Yo0yM K8LJlLyG4FPADrN7hOkhls3qLDD54eAKP02iyfKu832NQKfCiu9FS1pyAZn+gV7DH52j gRZA== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20210112; h=x-gm-message-state:mime-version:references:in-reply-to:from:date :message-id:subject:to:cc:content-transfer-encoding; bh=a8y0e8c2L7hgPII16VYHf9bqToDWEXHPjnMQeUSEefE=; b=w9UlpysrV7Gjlpmmr8hQmjjXELHAoPT8AD+2slwa0BpWjo19HNCSOXF0q4kYthChb0 nz9Lc7gcym3Lun59oBMS5Tf3FwC9hi2RiXgKi1OB2xkzSnb/IH6F8CYZN4HpZhRs7Vcg DHV6XZ0+kcB6Lcue1JudHhsEbsBwsQ77/OIewS8dJ2X8qXWpk3Xy7nRYVju0wbaBuW3g o7zobfVIxNZIbq6ug3dtOFw9tA1Ih+SOm9QiurQrueofgWVJQQkDHC7vLcMRyYX7eSiJ 1C7GNpJHcE2hyuL58ifeeH8HoOoxCxGERKjjfHRoFTePgEJ16LofD7+hfz2LD+XzaIoc 6n9w== X-Gm-Message-State: AOAM532GOu3jh7pczhkTBbysFQca//+DKi5hwqtLYBAONQR82nBIxhEb Ww8YfF2bWfJroCXjrt5k/KH67meDaIQicaU3ngc= X-Received: by 2002:a9f:354f:0:b0:368:c2c0:f2b5 with SMTP id o73-20020a9f354f000000b00368c2c0f2b5mr280639uao.96.1652890129426; Wed, 18 May 2022 09:08:49 -0700 (PDT) MIME-Version: 1.0 References: <20220518092619.1269111-1-chenhuacai@loongson.cn> <20220518092619.1269111-10-chenhuacai@loongson.cn> <682359f1-c210-6658-ab13-9b9c27c9a761@xen0n.name> In-Reply-To: <682359f1-c210-6658-ab13-9b9c27c9a761@xen0n.name> From: Huacai Chen Date: Thu, 19 May 2022 00:08:34 +0800 Message-ID: Subject: Re: [PATCH V11 09/22] LoongArch: Add boot and setup routines To: WANG Xuerui Cc: Huacai Chen , Arnd Bergmann , Andy Lutomirski , Thomas Gleixner , Peter Zijlstra , Andrew Morton , David Airlie , Jonathan Corbet , Linus Torvalds , linux-arch , "open list:DOCUMENTATION" , LKML , Xuefeng Li , Yanteng Si , Guo Ren , Jiaxun Yang , Stephen Rothwell , linux-efi , Ard Biesheuvel Content-Type: text/plain; charset="UTF-8" Content-Transfer-Encoding: quoted-printable X-Spam-Status: No, score=-1.7 required=5.0 tests=BAYES_00,DKIM_SIGNED, DKIM_VALID,DKIM_VALID_AU,FREEMAIL_FORGED_FROMDOMAIN,FREEMAIL_FROM, HEADER_FROM_DIFFERENT_DOMAINS,MAILING_LIST_MULTI,RDNS_NONE, SPF_HELO_NONE,T_SCC_BODY_TEXT_LINE autolearn=no 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: X-Mailing-List: linux-kernel@vger.kernel.org Hi, Xuerui, On Wed, May 18, 2022 at 11:18 PM WANG Xuerui wrote: > > On 5/18/22 17:26, Huacai Chen wrote: > > Add basic boot, setup and reset routines for LoongArch. Now, LoongArch > > machines use UEFI-based firmware. The firmware passes configuration > > information to the kernel via ACPI and DMI/SMBIOS. > > > > Currently an existing interface between the kernel and the bootloader > > is implemented. Kernel gets 2 values from the bootloader, passed in > Nit: one extra space after "is". OK, thanks. > > registers a0 and a1; a0 is an "EFI boot flag" distinguishing UEFI and > > non-UEFI firmware, while a1 is a pointer to an FDT with systable, > > memmap, cmdline and initrd information. > > > > This interface is used by existing bootloaders for booting kernels in > > raw ELF format. However, the standard UEFI boot protocol (EFISTUB) is > > preferred. > > > > ECR for adding LoongArch support in ACPI: > > https://mantis.uefi.org/mantis/view.php?id=3D2203 > > > > ECR for adding LoongArch support in ACPI (version update): > > https://mantis.uefi.org/mantis/view.php?id=3D2268 > > > > ECR for adding LoongArch support in UEFI: > > https://mantis.uefi.org/mantis/view.php?id=3D2313 > > > > ACPI changes of LoongArch have been approved in the last year, but the > > new version of ACPI SPEC hasn't been made public yet. And UEFI changes > > of LoongArch are under review now. > > > > Cc: linux-efi@vger.kernel.org > > Cc: Ard Biesheuvel > > Signed-off-by: Huacai Chen > > --- > > arch/loongarch/include/asm/acenv.h | 18 + > > arch/loongarch/include/asm/acpi.h | 38 ++ > > arch/loongarch/include/asm/bootinfo.h | 41 +++ > > arch/loongarch/include/asm/dmi.h | 24 ++ > > arch/loongarch/include/asm/efi.h | 41 +++ > > arch/loongarch/include/asm/reboot.h | 10 + > > arch/loongarch/include/asm/setup.h | 21 ++ > > arch/loongarch/kernel/acpi.c | 338 +++++++++++++++++ > > arch/loongarch/kernel/cacheinfo.c | 122 ++++++ > > arch/loongarch/kernel/cpu-probe.c | 292 +++++++++++++++ > > arch/loongarch/kernel/efi-header.S | 100 +++++ > > arch/loongarch/kernel/efi.c | 229 ++++++++++++ > > arch/loongarch/kernel/env.c | 70 ++++ > > arch/loongarch/kernel/head.S | 101 +++++ > > arch/loongarch/kernel/image-vars.h | 29 ++ > > arch/loongarch/kernel/mem.c | 64 ++++ > > arch/loongarch/kernel/reset.c | 90 +++++ > > arch/loongarch/kernel/setup.c | 348 +++++++++++++++++= + > > arch/loongarch/kernel/time.c | 220 +++++++++++ > > arch/loongarch/kernel/topology.c | 13 + > > drivers/firmware/efi/Kconfig | 2 +- > > drivers/firmware/efi/libstub/Makefile | 10 + > > .../firmware/efi/libstub/efi-stub-helper.c | 2 +- > > drivers/firmware/efi/libstub/efi-stub.c | 2 +- > > drivers/firmware/efi/libstub/loongarch-stub.c | 87 +++++ > > include/linux/efi.h | 1 + > > include/linux/pe.h | 1 + > > 27 files changed, 2311 insertions(+), 3 deletions(-) > > create mode 100644 arch/loongarch/include/asm/acenv.h > > create mode 100644 arch/loongarch/include/asm/acpi.h > > create mode 100644 arch/loongarch/include/asm/bootinfo.h > > create mode 100644 arch/loongarch/include/asm/dmi.h > > create mode 100644 arch/loongarch/include/asm/efi.h > > create mode 100644 arch/loongarch/include/asm/reboot.h > > create mode 100644 arch/loongarch/include/asm/setup.h > > create mode 100644 arch/loongarch/kernel/acpi.c > > create mode 100644 arch/loongarch/kernel/cacheinfo.c > > create mode 100644 arch/loongarch/kernel/cpu-probe.c > > create mode 100644 arch/loongarch/kernel/efi-header.S > > create mode 100644 arch/loongarch/kernel/efi.c > > create mode 100644 arch/loongarch/kernel/env.c > > create mode 100644 arch/loongarch/kernel/head.S > > create mode 100644 arch/loongarch/kernel/image-vars.h > > create mode 100644 arch/loongarch/kernel/mem.c > > create mode 100644 arch/loongarch/kernel/reset.c > > create mode 100644 arch/loongarch/kernel/setup.c > > create mode 100644 arch/loongarch/kernel/time.c > > create mode 100644 arch/loongarch/kernel/topology.c > > create mode 100644 drivers/firmware/efi/libstub/loongarch-stub.c > > > > diff --git a/arch/loongarch/include/asm/acenv.h b/arch/loongarch/includ= e/asm/acenv.h > > new file mode 100644 > > index 000000000000..52f298f7293b > > --- /dev/null > > +++ b/arch/loongarch/include/asm/acenv.h > > @@ -0,0 +1,18 @@ > > +/* SPDX-License-Identifier: GPL-2.0 */ > > +/* > > + * LoongArch specific ACPICA environments and implementation > > + * > > + * Author: Jianmin Lv > > + * Huacai Chen > > + * Copyright (C) 2020-2022 Loongson Technology Corporation Limited > > + */ > > + > > +#ifndef _ASM_LOONGARCH_ACENV_H > > +#define _ASM_LOONGARCH_ACENV_H > > + > > +/* > > + * This header is required by ACPI core, but we have nothing to fill i= n > > + * right now. Will be updated later when needed. > > + */ > > + > > +#endif /* _ASM_LOONGARCH_ACENV_H */ > > diff --git a/arch/loongarch/include/asm/acpi.h b/arch/loongarch/include= /asm/acpi.h > > new file mode 100644 > > index 000000000000..62044cd5b7bc > > --- /dev/null > > +++ b/arch/loongarch/include/asm/acpi.h > > @@ -0,0 +1,38 @@ > > +/* SPDX-License-Identifier: GPL-2.0 */ > > +/* > > + * Author: Jianmin Lv > > + * Huacai Chen > > + * Copyright (C) 2020-2022 Loongson Technology Corporation Limited > > + */ > > + > > +#ifndef _ASM_LOONGARCH_ACPI_H > > +#define _ASM_LOONGARCH_ACPI_H > > + > > +#ifdef CONFIG_ACPI > > +extern int acpi_strict; > > +extern int acpi_disabled; > > +extern int acpi_pci_disabled; > > +extern int acpi_noirq; > > + > > +#define acpi_os_ioremap acpi_os_ioremap > > +void __init __iomem *acpi_os_ioremap(acpi_physical_address phys, acpi_= size size); > > + > > +static inline void disable_acpi(void) > > +{ > > + acpi_disabled =3D 1; > > + acpi_pci_disabled =3D 1; > > + acpi_noirq =3D 1; > > +} > > + > > +static inline bool acpi_has_cpu_in_madt(void) > > +{ > > + return true; > > +} > > + > > +extern struct list_head acpi_wakeup_device_list; > > + > > +#endif /* !CONFIG_ACPI */ > > + > > +#define ACPI_TABLE_UPGRADE_MAX_PHYS ARCH_LOW_ADDRESS_LIMIT > > + > > +#endif /* _ASM_LOONGARCH_ACPI_H */ > > diff --git a/arch/loongarch/include/asm/bootinfo.h b/arch/loongarch/inc= lude/asm/bootinfo.h > > new file mode 100644 > > index 000000000000..0076a9e1a817 > > --- /dev/null > > +++ b/arch/loongarch/include/asm/bootinfo.h > > @@ -0,0 +1,41 @@ > > +/* SPDX-License-Identifier: GPL-2.0 */ > > +/* > > + * Copyright (C) 2020-2022 Loongson Technology Corporation Limited > > + */ > > +#ifndef _ASM_BOOTINFO_H > > +#define _ASM_BOOTINFO_H > > + > > +#include > > +#include > > + > > +const char *get_system_type(void); > > + > > +extern void init_environ(void); > > +extern void memblock_init(void); > > +extern void platform_init(void); > > + > > +struct loongson_board_info { > > + int bios_size; > > + char *bios_vendor; > > + char *bios_version; > > + char *bios_release_date; > > + char *board_name; > > + char *board_vendor; > > +}; > > + > > +struct loongson_system_configuration { > > + int nr_cpus; > > + int nr_nodes; > > + int nr_io_pics; > > + int boot_cpu_id; > > + int cores_per_node; > > + int cores_per_package; > > + char *cpuname; > > +}; > > + > > +extern u64 efi_system_table; > > +extern struct loongson_board_info b_info; > > +extern struct loongson_system_configuration loongson_sysconf; > > +extern unsigned long fw_arg0, fw_arg1, fw_arg2; > fw_arg2 isn't being used in this revision, so we can just remove it. OK, will be removed. > > + > > +#endif /* _ASM_BOOTINFO_H */ > > diff --git a/arch/loongarch/include/asm/dmi.h b/arch/loongarch/include/= asm/dmi.h > > new file mode 100644 > > index 000000000000..605493417753 > > --- /dev/null > > +++ b/arch/loongarch/include/asm/dmi.h > > @@ -0,0 +1,24 @@ > > +/* SPDX-License-Identifier: GPL-2.0 */ > > +/* > > + * Copyright (C) 2020-2022 Loongson Technology Corporation Limited > > + */ > > +#ifndef _ASM_DMI_H > > +#define _ASM_DMI_H > > + > > +#include > > +#include > > + > > +#define dmi_early_remap(x, l) dmi_remap(x, l) > > +#define dmi_early_unmap(x, l) dmi_unmap(x) > > +#define dmi_alloc(l) memblock_alloc(l, PAGE_SIZE) > > + > > +static inline void *dmi_remap(u64 phys_addr, unsigned long size) > > +{ > > + return ((void *)TO_CACHE(phys_addr)); > > +} > > + > > +static inline void dmi_unmap(void *addr) > > +{ > > +} > > + > > +#endif /* _ASM_DMI_H */ > > diff --git a/arch/loongarch/include/asm/efi.h b/arch/loongarch/include/= asm/efi.h > > new file mode 100644 > > index 000000000000..0127d84d5e1d > > --- /dev/null > > +++ b/arch/loongarch/include/asm/efi.h > > @@ -0,0 +1,41 @@ > > +/* SPDX-License-Identifier: GPL-2.0 */ > > +/* > > + * Copyright (C) 2020-2022 Loongson Technology Corporation Limited > > + */ > > +#ifndef _ASM_LOONGARCH_EFI_H > > +#define _ASM_LOONGARCH_EFI_H > > + > > +#include > > + > > +void __init efi_init(void); > > +void __init efi_runtime_init(void); > > +void efifb_setup_from_dmi(struct screen_info *si, const char *opt); > > + > > +#define ARCH_EFI_IRQ_FLAGS_MASK 0x00000004 /* Bit 2: CSR.CRMD.IE */ > > + > > +#define arch_efi_call_virt_setup() \ > > +({ \ > > +}) > > + > > +#define arch_efi_call_virt(p, f, args...) \ > > +({ \ > > + efi_##f##_t * __f; \ > > + __f =3D p->f; \ > > + __f(args); \ > > +}) > > + > > +#define arch_efi_call_virt_teardown() \ > > +({ \ > > +}) > > + > > +#define EFI_ALLOC_ALIGN SZ_64K > > + > > +struct screen_info *alloc_screen_info(void); > > +void free_screen_info(struct screen_info *si); > > + > > +static inline unsigned long efi_get_max_initrd_addr(unsigned long imag= e_addr) > > +{ > > + return ULONG_MAX; > > +} > > + > > +#endif /* _ASM_LOONGARCH_EFI_H */ > > diff --git a/arch/loongarch/include/asm/reboot.h b/arch/loongarch/inclu= de/asm/reboot.h > > new file mode 100644 > > index 000000000000..51151749d8f0 > > --- /dev/null > > +++ b/arch/loongarch/include/asm/reboot.h > > @@ -0,0 +1,10 @@ > > +/* SPDX-License-Identifier: GPL-2.0 */ > > +/* > > + * Copyright (C) 2020-2022 Loongson Technology Corporation Limited > > + */ > > +#ifndef _ASM_REBOOT_H > > +#define _ASM_REBOOT_H > > + > > +extern void (*pm_restart)(void); > > + > > +#endif /* _ASM_REBOOT_H */ > > diff --git a/arch/loongarch/include/asm/setup.h b/arch/loongarch/includ= e/asm/setup.h > > new file mode 100644 > > index 000000000000..6d7d2a3e23dd > > --- /dev/null > > +++ b/arch/loongarch/include/asm/setup.h > > @@ -0,0 +1,21 @@ > > +/* SPDX-License-Identifier: GPL-2.0 */ > > +/* > > + * Copyright (C) 2020-2022 Loongson Technology Corporation Limited > > + */ > > + > > +#ifndef _LOONGARCH_SETUP_H > > +#define _LOONGARCH_SETUP_H > > + > > +#include > > +#include > > + > > +#define VECSIZE 0x200 > > + > > +extern unsigned long eentry; > > +extern unsigned long tlbrentry; > > +extern void cpu_cache_init(void); > > +extern void per_cpu_trap_init(int cpu); > > +extern void set_handler(unsigned long offset, void *addr, unsigned lon= g len); > > +extern void set_merr_handler(unsigned long offset, void *addr, unsigne= d long len); > > + > > +#endif /* __SETUP_H */ > > diff --git a/arch/loongarch/kernel/acpi.c b/arch/loongarch/kernel/acpi.= c > > new file mode 100644 > > index 000000000000..506ab9912c51 > > --- /dev/null > > +++ b/arch/loongarch/kernel/acpi.c > > @@ -0,0 +1,338 @@ > > +// SPDX-License-Identifier: GPL-2.0 > > +/* > > + * acpi.c - Architecture-Specific Low-Level ACPI Boot Support > > + * > > + * Author: Jianmin Lv > > + * Huacai Chen > > + * Copyright (C) 2020-2022 Loongson Technology Corporation Limited > > + */ > > + > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > + > > +int acpi_disabled; > > +EXPORT_SYMBOL(acpi_disabled); > > +int acpi_noirq; > > +int acpi_pci_disabled; > > +EXPORT_SYMBOL(acpi_pci_disabled); > > +int acpi_strict =3D 1; /* We have no workarounds on LoongArch */ > > +int num_processors; > > +int disabled_cpus; > > +enum acpi_irq_model_id acpi_irq_model =3D ACPI_IRQ_MODEL_PLATFORM; > > + > > +u64 acpi_saved_sp; > > + > > +#define MAX_CORE_PIC 256 > > + > > +#define PREFIX "ACPI: " > > + > > +int acpi_gsi_to_irq(u32 gsi, unsigned int *irqp) > > +{ > > + if (irqp !=3D NULL) > > + *irqp =3D acpi_register_gsi(NULL, gsi, -1, -1); > > + return (*irqp >=3D 0) ? 0 : -EINVAL; > > +} > > +EXPORT_SYMBOL_GPL(acpi_gsi_to_irq); > > + > > +int acpi_isa_irq_to_gsi(unsigned int isa_irq, u32 *gsi) > > +{ > > + if (gsi) > > + *gsi =3D isa_irq; > > + return 0; > > +} > > + > > +/* > > + * success: return IRQ number (>=3D0) > > + * failure: return < 0 > > + */ > > +int acpi_register_gsi(struct device *dev, u32 gsi, int trigger, int po= larity) > > +{ > > + int id; > > + struct irq_fwspec fwspec; > > + > > + switch (gsi) { > > + case GSI_MIN_CPU_IRQ ... GSI_MAX_CPU_IRQ: > > + fwspec.fwnode =3D liointc_domain->fwnode; > > + fwspec.param[0] =3D gsi - GSI_MIN_CPU_IRQ; > > + fwspec.param_count =3D 1; > > + > > + return irq_create_fwspec_mapping(&fwspec); > > + > > + case GSI_MIN_LPC_IRQ ... GSI_MAX_LPC_IRQ: > > + if (!pch_lpc_domain) > > + return -EINVAL; > > + > > + fwspec.fwnode =3D pch_lpc_domain->fwnode; > > + fwspec.param[0] =3D gsi - GSI_MIN_LPC_IRQ; > > + fwspec.param[1] =3D acpi_dev_get_irq_type(trigger, polari= ty); > > + fwspec.param_count =3D 2; > > + > > + return irq_create_fwspec_mapping(&fwspec); > > + > > + case GSI_MIN_PCH_IRQ ... GSI_MAX_PCH_IRQ: > > + id =3D find_pch_pic(gsi); > > + if (id < 0) > > + return -EINVAL; > > + > > + fwspec.fwnode =3D pch_pic_domain[id]->fwnode; > > + fwspec.param[0] =3D gsi - acpi_pchpic[id]->gsi_base; > > + fwspec.param[1] =3D IRQ_TYPE_LEVEL_HIGH; > > + fwspec.param_count =3D 2; > > + > > + return irq_create_fwspec_mapping(&fwspec); > > + } > > + > > + return -EINVAL; > > +} > > +EXPORT_SYMBOL_GPL(acpi_register_gsi); > > + > > +void acpi_unregister_gsi(u32 gsi) > > +{ > > + > > +} > > +EXPORT_SYMBOL_GPL(acpi_unregister_gsi); > > + > > +void __init __iomem * __acpi_map_table(unsigned long phys, unsigned lo= ng size) > > +{ > > + > > + if (!phys || !size) > > + return NULL; > > + > > + return early_memremap(phys, size); > > +} > > +void __init __acpi_unmap_table(void __iomem *map, unsigned long size) > > +{ > > + if (!map || !size) > > + return; > > + > > + early_memunmap(map, size); > > +} > > + > > +void __init __iomem *acpi_os_ioremap(acpi_physical_address phys, acpi_= size size) > > +{ > > + if (!memblock_is_memory(phys)) > > + return ioremap(phys, size); > > + else > > + return ioremap_cache(phys, size); > > +} > > + > > +void __init acpi_boot_table_init(void) > > +{ > > + /* > > + * If acpi_disabled, bail out > > + */ > > + if (acpi_disabled) > > + return; > > + > > + /* > > + * Initialize the ACPI boot-time table parser. > > + */ > > + if (acpi_table_init()) { > > + disable_acpi(); > > + return; > > + } > > +} > > + > > +static int __init > > +acpi_parse_cpuintc(union acpi_subtable_headers *header, const unsigned= long end) > > +{ > > + struct acpi_madt_core_pic *processor =3D NULL; > > + > > + processor =3D (struct acpi_madt_core_pic *)header; > > + if (BAD_MADT_ENTRY(processor, end)) > > + return -EINVAL; > > + > > + acpi_table_print_madt_entry(&header->common); > > + > > + return 0; > > +} > > + > > +static int __init > > +acpi_parse_liointc(union acpi_subtable_headers *header, const unsigned= long end) > > +{ > > + struct acpi_madt_lio_pic *liointc =3D NULL; > > + > > + liointc =3D (struct acpi_madt_lio_pic *)header; > > + > > + if (BAD_MADT_ENTRY(liointc, end)) > > + return -EINVAL; > > + > > + acpi_liointc =3D liointc; > > + > > + return 0; > > +} > > + > > +static int __init > > +acpi_parse_eiointc(union acpi_subtable_headers *header, const unsigned= long end) > > +{ > > + static int id =3D 0; > > + struct acpi_madt_eio_pic *eiointc =3D NULL; > > + > > + eiointc =3D (struct acpi_madt_eio_pic *)header; > > + > > + if (BAD_MADT_ENTRY(eiointc, end)) > > + return -EINVAL; > > + > > + acpi_eiointc[id++] =3D eiointc; > > + loongson_sysconf.nr_io_pics =3D id; > > + > > + return 0; > > +} > > + > > +static int __init > > +acpi_parse_htintc(union acpi_subtable_headers *header, const unsigned = long end) > > +{ > > + struct acpi_madt_ht_pic *htintc =3D NULL; > > + > > + htintc =3D (struct acpi_madt_ht_pic *)header; > > + > > + if (BAD_MADT_ENTRY(htintc, end)) > > + return -EINVAL; > > + > > + acpi_htintc =3D htintc; > > + loongson_sysconf.nr_io_pics =3D 1; > > + > > + return 0; > > +} > > + > > +static int __init > > +acpi_parse_pch_pic(union acpi_subtable_headers *header, const unsigned= long end) > > +{ > > + static int id =3D 0; > > + struct acpi_madt_bio_pic *pchpic =3D NULL; > > + > > + pchpic =3D (struct acpi_madt_bio_pic *)header; > > + > > + if (BAD_MADT_ENTRY(pchpic, end)) > > + return -EINVAL; > > + > > + acpi_pchpic[id++] =3D pchpic; > > + > > + return 0; > > +} > > + > > +static int __init > > +acpi_parse_pch_msi(union acpi_subtable_headers *header, const unsigned= long end) > > +{ > > + static int id =3D 0; > > + struct acpi_madt_msi_pic *pchmsi =3D NULL; > > + > > + pchmsi =3D (struct acpi_madt_msi_pic *)header; > > + > > + if (BAD_MADT_ENTRY(pchmsi, end)) > > + return -EINVAL; > > + > > + acpi_pchmsi[id++] =3D pchmsi; > > + > > + return 0; > > +} > > + > > +static int __init > > +acpi_parse_pch_lpc(union acpi_subtable_headers *header, const unsigned= long end) > > +{ > > + struct acpi_madt_lpc_pic *pchlpc =3D NULL; > > + > > + pchlpc =3D (struct acpi_madt_lpc_pic *)header; > > + > > + if (BAD_MADT_ENTRY(pchlpc, end)) > > + return -EINVAL; > > + > > + acpi_pchlpc =3D pchlpc; > > + > > + return 0; > > +} > > + > > +static void __init acpi_process_madt(void) > > +{ > > + int error; > > + > > + /* Parse MADT CPUINTC entries */ > > + error =3D acpi_table_parse_madt(ACPI_MADT_TYPE_CORE_PIC, acpi_par= se_cpuintc, MAX_CORE_PIC); > > + if (error < 0) { > > + disable_acpi(); > > + pr_err(PREFIX "Invalid BIOS MADT (CPUINTC entries), ACPI = disabled\n"); > > + return; > > + } > > + > > + loongson_sysconf.nr_cpus =3D num_processors; > > + > > + /* Parse MADT LIOINTC entries */ > > + error =3D acpi_table_parse_madt(ACPI_MADT_TYPE_LIO_PIC, acpi_pars= e_liointc, 1); > > + if (error < 0) { > > + disable_acpi(); > > + pr_err(PREFIX "Invalid BIOS MADT (LIOINTC entries), ACPI = disabled\n"); > > + return; > > + } > > + > > + /* Parse MADT EIOINTC entries */ > > + error =3D acpi_table_parse_madt(ACPI_MADT_TYPE_EIO_PIC, acpi_pars= e_eiointc, MAX_IO_PICS); > > + if (error < 0) { > > + disable_acpi(); > > + pr_err(PREFIX "Invalid BIOS MADT (EIOINTC entries), ACPI = disabled\n"); > > + return; > > + } > > + > > + /* Parse MADT HTVEC entries */ > > + error =3D acpi_table_parse_madt(ACPI_MADT_TYPE_HT_PIC, acpi_parse= _htintc, 1); > > + if (error < 0) { > > + disable_acpi(); > > + pr_err(PREFIX "Invalid BIOS MADT (HTVEC entries), ACPI di= sabled\n"); > > + return; > > + } > > + > > + /* Parse MADT PCHPIC entries */ > > + error =3D acpi_table_parse_madt(ACPI_MADT_TYPE_BIO_PIC, acpi_pars= e_pch_pic, MAX_IO_PICS); > > + if (error < 0) { > > + disable_acpi(); > > + pr_err(PREFIX "Invalid BIOS MADT (PCHPIC entries), ACPI d= isabled\n"); > > + return; > > + } > > + > > + /* Parse MADT PCHMSI entries */ > > + error =3D acpi_table_parse_madt(ACPI_MADT_TYPE_MSI_PIC, acpi_pars= e_pch_msi, MAX_IO_PICS); > > + if (error < 0) { > > + disable_acpi(); > > + pr_err(PREFIX "Invalid BIOS MADT (PCHMSI entries), ACPI d= isabled\n"); > > + return; > > + } > > + > > + /* Parse MADT PCHLPC entries */ > > + error =3D acpi_table_parse_madt(ACPI_MADT_TYPE_LPC_PIC, acpi_pars= e_pch_lpc, 1); > > + if (error < 0) { > > + disable_acpi(); > > + pr_err(PREFIX "Invalid BIOS MADT (PCHLPC entries), ACPI d= isabled\n"); > > + return; > > + } > > +} > > + > > +int __init acpi_boot_init(void) > > +{ > > + /* > > + * If acpi_disabled, bail out > > + */ > > + if (acpi_disabled) > > + return -1; > > + > > + loongson_sysconf.boot_cpu_id =3D read_csr_cpuid(); > > + > > + /* > > + * Process the Multiple APIC Description Table (MADT), if present > > + */ > > + acpi_process_madt(); > > + > > + /* Do not enable ACPI SPCR console by default */ > > + acpi_parse_spcr(earlycon_acpi_spcr_enable, false); > > + > > + return 0; > > +} > > + > > +void __init arch_reserve_mem_area(acpi_physical_address addr, size_t s= ize) > > +{ > > + memblock_reserve(addr, size); > > +} > > diff --git a/arch/loongarch/kernel/cacheinfo.c b/arch/loongarch/kernel/= cacheinfo.c > > new file mode 100644 > > index 000000000000..8c9fe29e98f0 > > --- /dev/null > > +++ b/arch/loongarch/kernel/cacheinfo.c > > @@ -0,0 +1,122 @@ > > +// SPDX-License-Identifier: GPL-2.0-only > > +/* > > + * LoongArch cacheinfo support > > + * > > + * Copyright (C) 2020-2022 Loongson Technology Corporation Limited > > + */ > > +#include > > + > > +/* Populates leaf and increments to next leaf */ > > +#define populate_cache(cache, leaf, c_level, c_type) \ > > +do { \ > > + leaf->type =3D c_type; \ > > + leaf->level =3D c_level; \ > > + leaf->coherency_line_size =3D c->cache.linesz; \ > > + leaf->number_of_sets =3D c->cache.sets; \ > > + leaf->ways_of_associativity =3D c->cache.ways; \ > > + leaf->size =3D c->cache.linesz * c->cache.sets * \ > > + c->cache.ways; \ > > + leaf++; \ > > +} while (0) > > + > > +int init_cache_level(unsigned int cpu) > > +{ > > + struct cpuinfo_loongarch *c =3D ¤t_cpu_data; > > + struct cpu_cacheinfo *this_cpu_ci =3D get_cpu_cacheinfo(cpu); > > + int levels =3D 0, leaves =3D 0; > > + > > + /* > > + * If Dcache is not set, we assume the cache structures > > + * are not properly initialized. > > + */ > > + if (c->dcache.waysize) > > + levels +=3D 1; > > + else > > + return -ENOENT; > > + > > + > > + leaves +=3D (c->icache.waysize) ? 2 : 1; > > + > > + if (c->vcache.waysize) { > > + levels++; > > + leaves++; > > + } > > + > > + if (c->scache.waysize) { > > + levels++; > > + leaves++; > > + } > > + > > + if (c->tcache.waysize) { > > + levels++; > > + leaves++; > > + } > > + > > + this_cpu_ci->num_levels =3D levels; > > + this_cpu_ci->num_leaves =3D leaves; > > + return 0; > > +} > > + > > +static inline bool cache_leaves_are_shared(struct cacheinfo *this_leaf= , > > + struct cacheinfo *sib_leaf) > > +{ > > + return !((this_leaf->level =3D=3D 1) || (this_leaf->level =3D=3D = 2)); > > +} > > + > > +static void cache_cpumap_setup(unsigned int cpu) > > +{ > > + struct cpu_cacheinfo *this_cpu_ci =3D get_cpu_cacheinfo(cpu); > > + struct cacheinfo *this_leaf, *sib_leaf; > > + unsigned int index; > > + > > + for (index =3D 0; index < this_cpu_ci->num_leaves; index++) { > > + unsigned int i; > > + > > + this_leaf =3D this_cpu_ci->info_list + index; > > + /* skip if shared_cpu_map is already populated */ > > + if (!cpumask_empty(&this_leaf->shared_cpu_map)) > > + continue; > > + > > + cpumask_set_cpu(cpu, &this_leaf->shared_cpu_map); > > + for_each_online_cpu(i) { > > + struct cpu_cacheinfo *sib_cpu_ci =3D get_cpu_cach= einfo(i); > > + > > + if (i =3D=3D cpu || !sib_cpu_ci->info_list) > > + continue;/* skip if itself or no cacheinf= o */ > > + sib_leaf =3D sib_cpu_ci->info_list + index; > > + if (cache_leaves_are_shared(this_leaf, sib_leaf))= { > > + cpumask_set_cpu(cpu, &sib_leaf->shared_cp= u_map); > > + cpumask_set_cpu(i, &this_leaf->shared_cpu= _map); > > + } > > + } > > + } > > +} > > + > > +int populate_cache_leaves(unsigned int cpu) > > +{ > > + int level =3D 1; > > + struct cpuinfo_loongarch *c =3D ¤t_cpu_data; > > + struct cpu_cacheinfo *this_cpu_ci =3D get_cpu_cacheinfo(cpu); > > + struct cacheinfo *this_leaf =3D this_cpu_ci->info_list; > > + > > + if (c->icache.waysize) { > > + populate_cache(dcache, this_leaf, level, CACHE_TYPE_DATA)= ; > > + populate_cache(icache, this_leaf, level++, CACHE_TYPE_INS= T); > > + } else { > > + populate_cache(dcache, this_leaf, level++, CACHE_TYPE_UNI= FIED); > > + } > > + > > + if (c->vcache.waysize) > > + populate_cache(vcache, this_leaf, level++, CACHE_TYPE_UNI= FIED); > > + > > + if (c->scache.waysize) > > + populate_cache(scache, this_leaf, level++, CACHE_TYPE_UNI= FIED); > > + > > + if (c->tcache.waysize) > > + populate_cache(tcache, this_leaf, level++, CACHE_TYPE_UNI= FIED); > > + > > + cache_cpumap_setup(cpu); > > + this_cpu_ci->cpu_map_populated =3D true; > > + > > + return 0; > > +} > > diff --git a/arch/loongarch/kernel/cpu-probe.c b/arch/loongarch/kernel/= cpu-probe.c > > new file mode 100644 > > index 000000000000..5a33c03ccc2d > > --- /dev/null > > +++ b/arch/loongarch/kernel/cpu-probe.c > > @@ -0,0 +1,292 @@ > > +// SPDX-License-Identifier: GPL-2.0 > > +/* > > + * Processor capabilities determination functions. > > + * > > + * Copyright (C) 2020-2022 Loongson Technology Corporation Limited > > + */ > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > + > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > + > > +/* Hardware capabilities */ > > +unsigned int elf_hwcap __read_mostly; > > +EXPORT_SYMBOL_GPL(elf_hwcap); > > + > > +/* > > + * Determine the FCSR mask for FPU hardware. > > + */ > > +static inline void cpu_set_fpu_fcsr_mask(struct cpuinfo_loongarch *c) > > +{ > > + unsigned long sr, mask, fcsr, fcsr0, fcsr1; > > + > > + fcsr =3D c->fpu_csr0; > > + mask =3D FPU_CSR_ALL_X | FPU_CSR_ALL_E | FPU_CSR_ALL_S | FPU_CSR_= RM; > > + > > + sr =3D read_csr_euen(); > > + enable_fpu(); > > + > > + fcsr0 =3D fcsr & mask; > > + write_fcsr(LOONGARCH_FCSR0, fcsr0); > > + fcsr0 =3D read_fcsr(LOONGARCH_FCSR0); > > + > > + fcsr1 =3D fcsr | ~mask; > > + write_fcsr(LOONGARCH_FCSR0, fcsr1); > > + fcsr1 =3D read_fcsr(LOONGARCH_FCSR0); > > + > > + write_fcsr(LOONGARCH_FCSR0, fcsr); > > + > > + write_csr_euen(sr); > > + > > + c->fpu_mask =3D ~(fcsr0 ^ fcsr1) & ~mask; > > +} > > + > > +static inline void set_elf_platform(int cpu, const char *plat) > > +{ > > + if (cpu =3D=3D 0) > > + __elf_platform =3D plat; > > +} > > + > > +/* MAP BASE */ > > +unsigned long vm_map_base; > > +EXPORT_SYMBOL_GPL(vm_map_base); > > + > > +static void cpu_probe_addrbits(struct cpuinfo_loongarch *c) > > +{ > > +#ifdef __NEED_ADDRBITS_PROBE > > + c->pabits =3D (read_cpucfg(LOONGARCH_CPUCFG1) & CPUCFG1_PABITS) >= > 4; > > + c->vabits =3D (read_cpucfg(LOONGARCH_CPUCFG1) & CPUCFG1_VABITS) >= > 12; > > + vm_map_base =3D 0UL - (1UL << c->vabits); > > +#endif > > +} > > + > > +static void set_isa(struct cpuinfo_loongarch *c, unsigned int isa) > > +{ > > + switch (isa) { > > + case LOONGARCH_CPU_ISA_LA64: > > + c->isa_level |=3D LOONGARCH_CPU_ISA_LA64; > > + fallthrough; > > + case LOONGARCH_CPU_ISA_LA32S: > > + c->isa_level |=3D LOONGARCH_CPU_ISA_LA32S; > > + fallthrough; > > + case LOONGARCH_CPU_ISA_LA32R: > > + c->isa_level |=3D LOONGARCH_CPU_ISA_LA32R; > > + break; > > + } > > +} > > + > > +static void cpu_probe_common(struct cpuinfo_loongarch *c) > > +{ > > + unsigned int config; > > + unsigned long asid_mask; > > + > > + c->options =3D LOONGARCH_CPU_CPUCFG | LOONGARCH_CPU_CSR | > > + LOONGARCH_CPU_TLB | LOONGARCH_CPU_VINT | LOONGARCH_C= PU_WATCH; > > + > > + elf_hwcap |=3D HWCAP_LOONGARCH_CRC32; > > + > > + config =3D read_cpucfg(LOONGARCH_CPUCFG1); > > + if (config & CPUCFG1_UAL) { > > + c->options |=3D LOONGARCH_CPU_UAL; > > + elf_hwcap |=3D HWCAP_LOONGARCH_UAL; > > + } > > + > > + config =3D read_cpucfg(LOONGARCH_CPUCFG2); > > + if (config & CPUCFG2_LAM) { > > + c->options |=3D LOONGARCH_CPU_LAM; > > + elf_hwcap |=3D HWCAP_LOONGARCH_LAM; > > + } > > + if (config & CPUCFG2_FP) { > > + c->options |=3D LOONGARCH_CPU_FPU; > > + elf_hwcap |=3D HWCAP_LOONGARCH_FPU; > > + } > > + if (config & CPUCFG2_COMPLEX) { > > + c->options |=3D LOONGARCH_CPU_COMPLEX; > > + elf_hwcap |=3D HWCAP_LOONGARCH_COMPLEX; > > + } > > + if (config & CPUCFG2_CRYPTO) { > > + c->options |=3D LOONGARCH_CPU_CRYPTO; > > + elf_hwcap |=3D HWCAP_LOONGARCH_CRYPTO; > > + } > > + if (config & CPUCFG2_LVZP) { > > + c->options |=3D LOONGARCH_CPU_LVZ; > > + elf_hwcap |=3D HWCAP_LOONGARCH_LVZ; > > + } > > + > > + config =3D read_cpucfg(LOONGARCH_CPUCFG6); > > + if (config & CPUCFG6_PMP) > > + c->options |=3D LOONGARCH_CPU_PMP; > > + > > + config =3D iocsr_readl(LOONGARCH_IOCSR_FEATURES); > > + if (config & IOCSRF_CSRIPI) > > + c->options |=3D LOONGARCH_CPU_CSRIPI; > > + if (config & IOCSRF_EXTIOI) > > + c->options |=3D LOONGARCH_CPU_EXTIOI; > > + if (config & IOCSRF_FREQSCALE) > > + c->options |=3D LOONGARCH_CPU_SCALEFREQ; > > + if (config & IOCSRF_FLATMODE) > > + c->options |=3D LOONGARCH_CPU_FLATMODE; > > + if (config & IOCSRF_EIODECODE) > > + c->options |=3D LOONGARCH_CPU_EIODECODE; > > + if (config & IOCSRF_VM) > > + c->options |=3D LOONGARCH_CPU_HYPERVISOR; > > + > > + config =3D csr_readl(LOONGARCH_CSR_ASID); > > + config =3D (config & CSR_ASID_BIT) >> CSR_ASID_BIT_SHIFT; > > + asid_mask =3D GENMASK(config - 1, 0); > > + set_cpu_asid_mask(c, asid_mask); > > + > > + config =3D read_csr_prcfg1(); > > + c->ksave_mask =3D GENMASK((config & CSR_CONF1_KSNUM) - 1, 0); > > + c->ksave_mask &=3D ~(EXC_KSAVE_MASK | PERCPU_KSAVE_MASK | KVM_KSA= VE_MASK); > > + > > + config =3D read_csr_prcfg3(); > > + switch (config & CSR_CONF3_TLBTYPE) { > > + case 0: > > + c->tlbsizemtlb =3D 0; > > + c->tlbsizestlbsets =3D 0; > > + c->tlbsizestlbways =3D 0; > > + c->tlbsize =3D 0; > > + break; > > + case 1: > > + c->tlbsizemtlb =3D ((config & CSR_CONF3_MTLBSIZE) >> CSR_= CONF3_MTLBSIZE_SHIFT) + 1; > > + c->tlbsizestlbsets =3D 0; > > + c->tlbsizestlbways =3D 0; > > + c->tlbsize =3D c->tlbsizemtlb + c->tlbsizestlbsets * c->t= lbsizestlbways; > > + break; > > + case 2: > > + c->tlbsizemtlb =3D ((config & CSR_CONF3_MTLBSIZE) >> CSR_= CONF3_MTLBSIZE_SHIFT) + 1; > > + c->tlbsizestlbsets =3D 1 << ((config & CSR_CONF3_STLBIDX)= >> CSR_CONF3_STLBIDX_SHIFT); > > + c->tlbsizestlbways =3D ((config & CSR_CONF3_STLBWAYS) >> = CSR_CONF3_STLBWAYS_SHIFT) + 1; > > + c->tlbsize =3D c->tlbsizemtlb + c->tlbsizestlbsets * c->t= lbsizestlbways; > > + break; > > + default: > > + pr_warn("Warning: unknown TLB type\n"); > > + } > > +} > > + > > +#define MAX_NAME_LEN 32 > > +#define VENDOR_OFFSET 0 > > +#define CPUNAME_OFFSET 9 > > + > > +static char cpu_full_name[MAX_NAME_LEN] =3D " - "; > > + > > +static inline void cpu_probe_loongson(struct cpuinfo_loongarch *c, uns= igned int cpu) > > +{ > > + uint64_t *vendor =3D (void *)(&cpu_full_name[VENDOR_OFFSET]); > > + uint64_t *cpuname =3D (void *)(&cpu_full_name[CPUNAME_OFFSET]); > > + > > + __cpu_full_name[cpu] =3D cpu_full_name; > > + *vendor =3D iocsr_readq(LOONGARCH_IOCSR_VENDOR); > > + *cpuname =3D iocsr_readq(LOONGARCH_IOCSR_CPUNAME); > > + > > + switch (c->processor_id & PRID_SERIES_MASK) { > > + case PRID_SERIES_LA132: > > + c->cputype =3D CPU_LOONGSON32; > > + set_isa(c, LOONGARCH_CPU_ISA_LA32S); > > + __cpu_family[cpu] =3D "Loongson-32bit"; > > + pr_info("32-bit Loongson Processor probed (LA132 Core)\n"= ); > > + break; > > + case PRID_SERIES_LA264: > > + c->cputype =3D CPU_LOONGSON64; > > + set_isa(c, LOONGARCH_CPU_ISA_LA64); > > + __cpu_family[cpu] =3D "Loongson-64bit"; > > + pr_info("64-bit Loongson Processor probed (LA264 Core)\n"= ); > > + break; > > + case PRID_SERIES_LA364: > > + c->cputype =3D CPU_LOONGSON64; > > + set_isa(c, LOONGARCH_CPU_ISA_LA64); > > + __cpu_family[cpu] =3D "Loongson-64bit"; > > + pr_info("64-bit Loongson Processor probed (LA364 Core)\n"= ); > > + break; > > + case PRID_SERIES_LA464: > > + c->cputype =3D CPU_LOONGSON64; > > + set_isa(c, LOONGARCH_CPU_ISA_LA64); > > + __cpu_family[cpu] =3D "Loongson-64bit"; > > + pr_info("64-bit Loongson Processor probed (LA464 Core)\n"= ); > > + break; > > + case PRID_SERIES_LA664: > > + c->cputype =3D CPU_LOONGSON64; > > + set_isa(c, LOONGARCH_CPU_ISA_LA64); > > + __cpu_family[cpu] =3D "Loongson-64bit"; > > + pr_info("64-bit Loongson Processor probed (LA664 Core)\n"= ); > > + break; > > + default: /* Default to 64 bit */ > > + c->cputype =3D CPU_LOONGSON64; > > + set_isa(c, LOONGARCH_CPU_ISA_LA64); > > + __cpu_family[cpu] =3D "Loongson-64bit"; > > + pr_info("64-bit Loongson Processor probed (Unknown Core)\= n"); > > + } > > +} > > + > > +#ifdef CONFIG_64BIT > > +/* For use by uaccess.h */ > > +u64 __ua_limit; > > +EXPORT_SYMBOL(__ua_limit); > > +#endif > > + > > +const char *__cpu_family[NR_CPUS]; > > +const char *__cpu_full_name[NR_CPUS]; > > +const char *__elf_platform; > > + > > +static void cpu_report(void) > > +{ > > + struct cpuinfo_loongarch *c =3D ¤t_cpu_data; > > + > > + pr_info("CPU%d revision is: %08x (%s)\n", > > + smp_processor_id(), c->processor_id, cpu_family_string())= ; > > + if (c->options & LOONGARCH_CPU_FPU) > > + pr_info("FPU%d revision is: %08x\n", smp_processor_id(), = c->fpu_vers); > > +} > > + > > +void cpu_probe(void) > > +{ > > + unsigned int cpu =3D smp_processor_id(); > > + struct cpuinfo_loongarch *c =3D ¤t_cpu_data; > > + > > + /* > > + * Set a default ELF platform, cpu probe may later > > + * overwrite it with a more precise value > > + */ > > + set_elf_platform(cpu, "loongarch"); > > + > > + c->cputype =3D CPU_UNKNOWN; > > + c->processor_id =3D read_cpucfg(LOONGARCH_CPUCFG0); > > + c->fpu_vers =3D (read_cpucfg(LOONGARCH_CPUCFG2) >> 3) & 0x3; > > + > > + c->fpu_csr0 =3D FPU_CSR_RN; > > + c->fpu_mask =3D FPU_CSR_RSVD; > > + > > + cpu_probe_common(c); > > + > > + per_cpu_trap_init(cpu); > > + > > + switch (c->processor_id & PRID_COMP_MASK) { > > + case PRID_COMP_LOONGSON: > > + cpu_probe_loongson(c, cpu); > > + break; > > + } > > + > > + BUG_ON(!__cpu_family[cpu]); > > + BUG_ON(c->cputype =3D=3D CPU_UNKNOWN); > > + > > + cpu_probe_addrbits(c); > > + > > +#ifdef CONFIG_64BIT > > + if (cpu =3D=3D 0) > > + __ua_limit =3D ~((1ull << cpu_vabits) - 1); > > +#endif > > + > > + cpu_report(); > > +} > > diff --git a/arch/loongarch/kernel/efi-header.S b/arch/loongarch/kernel= /efi-header.S > > new file mode 100644 > > index 000000000000..d299cac4e691 > > --- /dev/null > > +++ b/arch/loongarch/kernel/efi-header.S > > @@ -0,0 +1,100 @@ > > +/* SPDX-License-Identifier: GPL-2.0 */ > > +/* > > + * Copyright (C) 2020-2022 Loongson Technology Corporation Limited > > + */ > > + > > +#include > > +#include > > + > > + .macro __EFI_PE_HEADER > > + .long PE_MAGIC > > +.Lcoff_header: > > + .short IMAGE_FILE_MACHINE_LOONGARCH /* Machine */ > > + .short .Lsection_count /* NumberOfSectio= ns */ > > + .long 0 /* TimeDateStamp = */ > > + .long 0 /* PointerToSymbo= lTable */ > > + .long 0 /* NumberOfSymbol= s */ > > + .short .Lsection_table - .Loptional_header /* SizeOfOptional= Header */ > > + .short IMAGE_FILE_DEBUG_STRIPPED | \ > > + IMAGE_FILE_EXECUTABLE_IMAGE | \ > > + IMAGE_FILE_LINE_NUMS_STRIPPED /* Characteristic= s */ > > + > > +.Loptional_header: > > + .short PE_OPT_MAGIC_PE32PLUS /* PE32+ format *= / > > + .byte 0x02 /* MajorLinkerVer= sion */ > > + .byte 0x14 /* MinorLinkerVer= sion */ > > + .long __inittext_end - .Lefi_header_end /* SizeOfCode */ > > + .long _end - __initdata_begin /* SizeOfInitiali= zedData */ > > + .long 0 /* SizeOfUninitia= lizedData */ > > + .long __efistub_efi_pe_entry - _head /* AddressOfEntry= Point */ > > + .long .Lefi_header_end - _head /* BaseOfCode */ > > + > > +.Lextra_header_fields: > > + .quad 0 /* ImageBase */ > > + .long PECOFF_SEGMENT_ALIGN /* SectionAlignme= nt */ > > + .long PECOFF_FILE_ALIGN /* FileAlignment = */ > > + .short 0 /* MajorOperating= SystemVersion */ > > + .short 0 /* MinorOperating= SystemVersion */ > > + .short LINUX_EFISTUB_MAJOR_VERSION /* MajorImageVers= ion */ > > + .short LINUX_EFISTUB_MINOR_VERSION /* MinorImageVers= ion */ > > + .short 0 /* MajorSubsystem= Version */ > > + .short 0 /* MinorSubsystem= Version */ > > + .long 0 /* Win32VersionVa= lue */ > > + > > + .long _end - _head /* SizeOfImage */ > > + > > + /* Everything before the kernel image is considered part of the h= eader */ > > + .long .Lefi_header_end - _head /* SizeOfHeaders = */ > > + .long 0 /* CheckSum */ > > + .short IMAGE_SUBSYSTEM_EFI_APPLICATION /* Subsystem */ > > + .short 0 /* DllCharacteris= tics */ > > + .quad 0 /* SizeOfStackRes= erve */ > > + .quad 0 /* SizeOfStackCom= mit */ > > + .quad 0 /* SizeOfHeapRese= rve */ > > + .quad 0 /* SizeOfHeapComm= it */ > > + .long 0 /* LoaderFlags */ > > + .long (.Lsection_table - .) / 8 /* NumberOfRvaAnd= Sizes */ > > + > > + .quad 0 /* ExportTable */ > > + .quad 0 /* ImportTable */ > > + .quad 0 /* ResourceTable = */ > > + .quad 0 /* ExceptionTable= */ > > + .quad 0 /* CertificationT= able */ > > + .quad 0 /* BaseRelocation= Table */ > > + > > + /* Section table */ > > +.Lsection_table: > > + .ascii ".text\0\0\0" > > + .long __inittext_end - .Lefi_header_end /* VirtualSize */ > > + .long .Lefi_header_end - _head /* VirtualAddress= */ > > + .long __inittext_end - .Lefi_header_end /* SizeOfRawData = */ > > + .long .Lefi_header_end - _head /* PointerToRawDa= ta */ > > + > > + .long 0 /* PointerToReloc= ations */ > > + .long 0 /* PointerToLineN= umbers */ > > + .short 0 /* NumberOfReloca= tions */ > > + .short 0 /* NumberOfLineNu= mbers */ > > + .long IMAGE_SCN_CNT_CODE | \ > > + IMAGE_SCN_MEM_READ | \ > > + IMAGE_SCN_MEM_EXECUTE /* Characteristic= s */ > > + > > + .ascii ".data\0\0\0" > > + .long _end - __initdata_begin /* VirtualSize */ > > + .long __initdata_begin - _head /* VirtualAddress= */ > > + .long _edata - __initdata_begin /* SizeOfRawData = */ > > + .long __initdata_begin - _head /* PointerToRawDa= ta */ > > + > > + .long 0 /* PointerToReloc= ations */ > > + .long 0 /* PointerToLineN= umbers */ > > + .short 0 /* NumberOfReloca= tions */ > > + .short 0 /* NumberOfLineNu= mbers */ > > + .long IMAGE_SCN_CNT_INITIALIZED_DATA | \ > > + IMAGE_SCN_MEM_READ | \ > > + IMAGE_SCN_MEM_WRITE /* Characteristic= s */ > > + > > + .org 0x20e > > + .word kernel_version - 512 - _head > > + > > + .set .Lsection_count, (. - .Lsection_table) / 40 > > +.Lefi_header_end: > > + .endm > > diff --git a/arch/loongarch/kernel/efi.c b/arch/loongarch/kernel/efi.c > > new file mode 100644 > > index 000000000000..69ebdd4220ec > > --- /dev/null > > +++ b/arch/loongarch/kernel/efi.c > > @@ -0,0 +1,229 @@ > > +// SPDX-License-Identifier: GPL-2.0 > > +/* > > + * EFI initialization > > + * > > + * Author: Jianmin Lv > > + * Huacai Chen > > + * > > + * Copyright (C) 2020-2022 Loongson Technology Corporation Limited > > + */ > > + > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > + > > +#include > > +#include > > +#include > > +#include > > + > > +static unsigned long efi_nr_tables; > > +static unsigned long efi_config_table; > > +static unsigned long screen_info_table __initdata =3D EFI_INVALID_TABL= E_ADDR; > > + > > +static efi_system_table_t *efi_systab; > > +static efi_config_table_type_t arch_tables[] __initdata =3D { > > + {LINUX_EFI_LARCH_SCREEN_INFO_TABLE_GUID, &screen_info_table, "SIN= FO"}, > > + {}, > > +}; > > + > > +static void __init init_screen_info(void) > > +{ > > + struct screen_info *si; > > + > > + if (screen_info_table =3D=3D EFI_INVALID_TABLE_ADDR) > > + return; > > + > > + si =3D early_memremap_ro(screen_info_table, sizeof(*si)); > > + if (!si) { > > + pr_err("Could not map screen_info config table\n"); > > + return; > > + } > > + screen_info =3D *si; > > + early_memunmap(si, sizeof(*si)); > > + > > + if (screen_info.orig_video_isVGA =3D=3D VIDEO_TYPE_EFI) > > + memblock_reserve(screen_info.lfb_base, screen_info.lfb_si= ze); > > +} > > + > > +static void __init create_tlb(u32 index, u64 vppn, u32 ps, u32 mat) > > +{ > > + unsigned long tlblo0, tlblo1; > > + > > + write_csr_pagesize(ps); > > + > > + tlblo0 =3D vppn | CSR_TLBLO0_V | CSR_TLBLO0_WE | > > + CSR_TLBLO0_GLOBAL | (mat << CSR_TLBLO0_CCA_SHIFT); > > + tlblo1 =3D tlblo0 + (1 << ps); > > + > > + csr_writeq(vppn, LOONGARCH_CSR_TLBEHI); > > + csr_writeq(tlblo0, LOONGARCH_CSR_TLBELO0); > > + csr_writeq(tlblo1, LOONGARCH_CSR_TLBELO1); > > + csr_xchgl(0, CSR_TLBIDX_EHINV, LOONGARCH_CSR_TLBIDX); > > + csr_xchgl(index, CSR_TLBIDX_IDX, LOONGARCH_CSR_TLBIDX); > > + > > + tlb_write_indexed(); > > +} > > + > > +#define MTLB_ENTRY_INDEX 0x800 > > + > > +/* Create VA =3D=3D PA mapping as UEFI */ > > +static void __init fix_efi_mapping(void) > > +{ > > + unsigned int index =3D MTLB_ENTRY_INDEX; > > + unsigned int tlbnr =3D boot_cpu_data.tlbsizemtlb - 2; > > + unsigned long i, vppn; > > + > > + /* Low Memory, Cached */ > > + create_tlb(index++, 0x00000000, PS_128M, 1); > > + /* MMIO Registers, Uncached */ > > + create_tlb(index++, 0x10000000, PS_128M, 0); > > + > > + /* High Memory, Cached */ > > + for (i =3D 0; i < tlbnr; i++) { > > + vppn =3D 0x80000000ULL + (i * SZ_2G); > > + create_tlb(index++, vppn, PS_1G, 1); > > + } > > +} > > + > > +/* > > + * set_virtual_map() - create a virtual mapping for the EFI memory map= and call > > + * efi_set_virtual_address_map enter virtual for runtime service > > + * > > + * This function populates the virt_addr fields of all memory region d= escriptors > > + * in @memory_map whose EFI_MEMORY_RUNTIME attribute is set. Those des= criptors > > + * are also copied to @runtime_map, and their total count is returned = in @count. > > + */ > > +static unsigned int __init set_virtual_map(void) > > +{ > > + int count =3D 0; > > + unsigned int size; > > + unsigned long attr; > > + efi_status_t status; > > + efi_runtime_services_t *rt; > > + efi_set_virtual_address_map_t *svam; > > + efi_memory_desc_t *in, runtime_map[32]; > > + > > + size =3D sizeof(efi_memory_desc_t); > > + > > + for_each_efi_memory_desc(in) { > > + attr =3D in->attribute; > > + if (!(attr & EFI_MEMORY_RUNTIME)) > > + continue; > > + > > + if (attr & (EFI_MEMORY_WB | EFI_MEMORY_WT)) > > + in->virt_addr =3D TO_CACHE(in->phys_addr); > > + else > > + in->virt_addr =3D TO_UNCACHE(in->phys_addr); > > + > > + memcpy(&runtime_map[count++], in, size); > > + } > > + > > + rt =3D early_memremap_ro((unsigned long)efi_systab->runtime, size= of(*rt)); > > + > > + /* Install the new virtual address map */ > > + svam =3D rt->set_virtual_address_map; > > + > > + fix_efi_mapping(); > > + > > + status =3D svam(size * count, size, efi.memmap.desc_version, > > + (efi_memory_desc_t *)TO_PHYS((unsigned long)runti= me_map)); > > + > > + local_flush_tlb_all(); > > + write_csr_pagesize(PS_DEFAULT_SIZE); > > + > > + if (status !=3D EFI_SUCCESS) > > + return -1; > > + > > + return 0; > > +} > > + > > +void __init efi_runtime_init(void) > > +{ > > + efi_status_t status; > > + > > + if (!efi_enabled(EFI_BOOT)) > > + return; > > + > > + if (!efi_systab->runtime) > > + return; > > + > > + status =3D set_virtual_map(); > > + if (status < 0) > > + return; > > + > > + if (efi_runtime_disabled()) { > > + pr_info("EFI runtime services will be disabled.\n"); > > + return; > > + } > > + > > + efi.runtime =3D (efi_runtime_services_t *)efi_systab->runtime; > > + efi.runtime_version =3D (unsigned int)efi.runtime->hdr.revision; > > + > > + efi_native_runtime_setup(); > > + set_bit(EFI_RUNTIME_SERVICES, &efi.flags); > > +} > > + > > +void __init efi_init(void) > > +{ > > + int size; > > + void *config_tables; > > + > > + if (!efi_system_table) > > + return; > > + > > + efi_systab =3D (efi_system_table_t *)early_memremap_ro(efi_system= _table, sizeof(efi_systab)); > > + if (!efi_systab) { > > + pr_err("Can't find EFI system table.\n"); > > + return; > > + } > > + > > + set_bit(EFI_64BIT, &efi.flags); > > + efi_nr_tables =3D efi_systab->nr_tables; > > + efi_config_table =3D (unsigned long)efi_systab->tables; > > + > > + size =3D sizeof(efi_config_table_t); > > + config_tables =3D early_memremap(efi_config_table, efi_nr_tables = * size); > > + efi_config_parse_tables(config_tables, efi_systab->nr_tables, arc= h_tables); > > + early_memunmap(config_tables, efi_nr_tables * size); > > + > > + init_screen_info(); > > +} > > + > > +static ssize_t boardinfo_show(struct kobject *kobj, > > + struct kobj_attribute *attr, char *buf) > > +{ > > + return sprintf(buf, > > + "BIOS Information\n" > > + "Vendor\t\t\t: %s\n" > > + "Version\t\t\t: %s\n" > > + "ROM Size\t\t: %d KB\n" > > + "Release Date\t\t: %s\n\n" > > + "Board Information\n" > > + "Manufacturer\t\t: %s\n" > > + "Board Name\t\t: %s\n" > > + "Family\t\t\t: LOONGSON64\n\n", > > + b_info.bios_vendor, b_info.bios_version, > > + b_info.bios_size, b_info.bios_release_date, > > + b_info.board_vendor, b_info.board_name); > > +} > > + > > +static struct kobj_attribute boardinfo_attr =3D __ATTR(boardinfo, 0444= , > > + boardinfo_show, NULL= ); > > + > > +static int __init boardinfo_init(void) > > +{ > > + if (!efi_kobj) > > + return -EINVAL; > > + > > + return sysfs_create_file(efi_kobj, &boardinfo_attr.attr); > > +} > > +late_initcall(boardinfo_init); > > diff --git a/arch/loongarch/kernel/env.c b/arch/loongarch/kernel/env.c > > new file mode 100644 > > index 000000000000..bf2593f1e536 > > --- /dev/null > > +++ b/arch/loongarch/kernel/env.c > > @@ -0,0 +1,70 @@ > > +// SPDX-License-Identifier: GPL-2.0 > > +/* > > + * Author: Huacai Chen > > + * > > + * Copyright (C) 2020-2022 Loongson Technology Corporation Limited > > + */ > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > + > > +u64 efi_system_table; > > +struct loongson_system_configuration loongson_sysconf; > > +EXPORT_SYMBOL(loongson_sysconf); > > + > > +u64 loongson_chipcfg[MAX_PACKAGES]; > > +u64 loongson_chiptemp[MAX_PACKAGES]; > > +u64 loongson_freqctrl[MAX_PACKAGES]; > > +unsigned long long smp_group[MAX_PACKAGES]; > > + > > +static void __init register_addrs_set(u64 *registers, const u64 addr, = int num) > > +{ > > + u64 i; > > + > > + for (i =3D 0; i < num; i++) { > > + *registers =3D (i << 44) | addr; > > + registers++; > > + } > > +} > > + > > +void __init init_environ(void) > > +{ > > + int efi_boot =3D fw_arg0; > > + struct efi_memory_map_data data; > > + void *fdt_ptr =3D early_memremap_ro(fw_arg1, SZ_64K); > > + > > + if (efi_boot) > > + set_bit(EFI_BOOT, &efi.flags); > > + else > > + clear_bit(EFI_BOOT, &efi.flags); > > + > > + early_init_dt_scan(fdt_ptr); > > + early_init_fdt_reserve_self(); > > + efi_system_table =3D efi_get_fdt_params(&data); > > + > > + efi_memmap_init_early(&data); > Why not die in case efi_get_fdt_params or efi_memmap_init_early fails? I > know in these cases it'll still die afterwards, because we're so early > there's little room for error, but panicking seems more clear. At least, no systemtable and no efi_mmap is acceptable for full FDT system (non-ACPI system). And for ACPI system, systemtable and efi_mmap do exist. Huacai > > + memblock_reserve(data.phys_map & PAGE_MASK, > > + PAGE_ALIGN(data.size + (data.phys_map & ~PAGE_MA= SK))); > > + > > + register_addrs_set(smp_group, TO_UNCACHE(0x1fe01000), 16); > > + register_addrs_set(loongson_chipcfg, TO_UNCACHE(0x1fe00180), 16); > > + register_addrs_set(loongson_chiptemp, TO_UNCACHE(0x1fe0019c), 16)= ; > > + register_addrs_set(loongson_freqctrl, TO_UNCACHE(0x1fe001d0), 16)= ; > > +} > > + > > +static int __init init_cpu_fullname(void) > > +{ > > + int cpu; > > + > > + if (loongson_sysconf.cpuname && !strncmp(loongson_sysconf.cpuname= , "Loongson", 8)) { > > + for (cpu =3D 0; cpu < NR_CPUS; cpu++) > > + __cpu_full_name[cpu] =3D loongson_sysconf.cpuname= ; > > + } > > + return 0; > > +} > > +arch_initcall(init_cpu_fullname); > > diff --git a/arch/loongarch/kernel/head.S b/arch/loongarch/kernel/head.= S > > new file mode 100644 > > index 000000000000..a5b4940c98fe > > --- /dev/null > > +++ b/arch/loongarch/kernel/head.S > > @@ -0,0 +1,101 @@ > > +/* SPDX-License-Identifier: GPL-2.0 */ > > +/* > > + * Copyright (C) 2020-2022 Loongson Technology Corporation Limited > > + */ > > +#include > > +#include > > + > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > + > > +#ifdef CONFIG_EFI_STUB > > + > > +#include "efi-header.S" > > + > > + __HEAD > > + > > +_head: > > + .word MZ_MAGIC /* "MZ", MS-DOS header */ > > + .org 0x38 > > +#ifdef CONFIG_32BIT > > + .ascii "LA32" /* Magic number for BootLoader */ > > +#else > > + .ascii "LA64" /* Magic number for BootLoader */ > > +#endif > > So this is just the *dullest* suggestion from my comment on v10; seems > we have to live with a lack of sense of humor. =C2=AF\_(=E3=83=84)_/=C2= =AF > > Anyway, bottom line is "don't create yet another image header format", > and this revision fixed the problem in v10. So I have no further problem > with this. > > > + .org 0x3c > > + .long pe_header - _head /* Offset to the PE header */ > > + > > +pe_header: > > + __EFI_PE_HEADER > > + > > +SYM_DATA(kernel_asize, .long _end - _text); > > +SYM_DATA(kernel_fsize, .long _edata - _text); > > +SYM_DATA(kernel_offset, .long kernel_offset - _text); > > + > > +kernel_version: > > + .ascii UTS_RELEASE " (" LINUX_COMPILE_BY "@" LINUX_COMPILE_HOST = ") " UTS_VERSION "\0" > > + > > +#endif > > + > > + __REF > > + > > +SYM_ENTRY(_stext, SYM_L_GLOBAL, SYM_A_NONE) > > + > > +SYM_CODE_START(kernel_entry) # kernel entry point > > + > > + /* Config direct window and set PG */ > > + li.d t0, CSR_DMW0_INIT # UC, PLV0, 0x8000 xxxx x= xxx xxxx > > + csrwr t0, LOONGARCH_CSR_DMWIN0 > > + li.d t0, CSR_DMW1_INIT # CA, PLV0, 0x9000 xxxx x= xxx xxxx > > + csrwr t0, LOONGARCH_CSR_DMWIN1 > > + /* Enable PG */ > > + li.w t0, 0xb0 # PLV=3D0, IE=3D0, PG=3D1 > > + csrwr t0, LOONGARCH_CSR_CRMD > > + li.w t0, 0x04 # PLV=3D0, PIE=3D1, PWE= =3D0 > > + csrwr t0, LOONGARCH_CSR_PRMD > > + li.w t0, 0x00 # FPE=3D0, SXE=3D0, ASXE= =3D0, BTE=3D0 > > + csrwr t0, LOONGARCH_CSR_EUEN > > + > > + /* We might not get launched at the address the kernel is linked = to, > > + so we jump there. */ > > + la.abs t0, 0f > > + jirl zero, t0, 0 > > +0: > > + la t0, __bss_start # clear .bss > > + st.d zero, t0, 0 > > + la t1, __bss_stop - LONGSIZE > > +1: > > + addi.d t0, t0, LONGSIZE > > + st.d zero, t0, 0 > > + bne t0, t1, 1b > > + > > + la t0, fw_arg0 > > + st.d a0, t0, 0 # firmware arguments > > + la t0, fw_arg1 > > + st.d a1, t0, 0 > > + la t0, fw_arg2 > > + st.d a2, t0, 0 > > + > > + /* KSave3 used for percpu base, initialized as 0 */ > > + csrwr zero, PERCPU_BASE_KS > > + /* GPR21 used for percpu base (runtime), initialized as 0 */ > > + or u0, zero, zero > > + > > + la tp, init_thread_union > > + /* Set the SP after an empty pt_regs. */ > > + PTR_LI sp, (_THREAD_SIZE - 32 - PT_SIZE) > > + PTR_ADD sp, sp, tp > > + set_saved_sp sp, t0, t1 > > + PTR_ADDI sp, sp, -4 * SZREG # init stack pointer > > + > > + bl start_kernel > > + > > +SYM_CODE_END(kernel_entry) > > + > > +SYM_ENTRY(kernel_entry_end, SYM_L_GLOBAL, SYM_A_NONE) > > diff --git a/arch/loongarch/kernel/image-vars.h b/arch/loongarch/kernel= /image-vars.h > > new file mode 100644 > > index 000000000000..104e9f0e97fe > > --- /dev/null > > +++ b/arch/loongarch/kernel/image-vars.h > > @@ -0,0 +1,29 @@ > > +/* SPDX-License-Identifier: GPL-2.0-only */ > > +/* > > + * Copyright (C) 2020-2022 Loongson Technology Corporation Limited > > + */ > > +#ifndef __LOONGARCH_KERNEL_IMAGE_VARS_H > > +#define __LOONGARCH_KERNEL_IMAGE_VARS_H > > + > > +#ifdef CONFIG_EFI_STUB > > + > > +__efistub_memcmp =3D memcmp; > > +__efistub_memchr =3D memchr; > > +__efistub_memcpy =3D memcpy; > > +__efistub_memmove =3D memmove; > > +__efistub_memset =3D memset; > > +__efistub_strcat =3D strcat; > > +__efistub_strcmp =3D strcmp; > > +__efistub_strlen =3D strlen; > > +__efistub_strncat =3D strncat; > > +__efistub_strnstr =3D strnstr; > > +__efistub_strnlen =3D strnlen; > > +__efistub_strrchr =3D strrchr; > > +__efistub_kernel_entry =3D kernel_entry; > > +__efistub_kernel_asize =3D kernel_asize; > > +__efistub_kernel_fsize =3D kernel_fsize; > > +__efistub_kernel_offset =3D kernel_offset; > > + > > +#endif > > + > > +#endif /* __LOONGARCH_KERNEL_IMAGE_VARS_H */ > > diff --git a/arch/loongarch/kernel/mem.c b/arch/loongarch/kernel/mem.c > > new file mode 100644 > > index 000000000000..7423361b0ebc > > --- /dev/null > > +++ b/arch/loongarch/kernel/mem.c > > @@ -0,0 +1,64 @@ > > +// SPDX-License-Identifier: GPL-2.0-or-later > > +/* > > + * Copyright (C) 2020-2022 Loongson Technology Corporation Limited > > + */ > > +#include > > +#include > > +#include > > + > > +#include > > +#include > > +#include > > + > > +void __init memblock_init(void) > > +{ > > + u32 mem_type; > > + u64 mem_start, mem_end, mem_size; > > + efi_memory_desc_t *md; > > + > > + /* Parse memory information */ > > + for_each_efi_memory_desc(md) { > > + mem_type =3D md->type; > > + mem_start =3D md->phys_addr; > > + mem_size =3D md->num_pages << EFI_PAGE_SHIFT; > > + mem_end =3D mem_start + mem_size; > > + > > + switch (mem_type) { > > + case EFI_LOADER_CODE: > > + case EFI_LOADER_DATA: > > + case EFI_BOOT_SERVICES_CODE: > > + case EFI_BOOT_SERVICES_DATA: > > + case EFI_PERSISTENT_MEMORY: > > + case EFI_CONVENTIONAL_MEMORY: > > + memblock_add(mem_start, mem_size); > > + if (max_low_pfn < (mem_end >> PAGE_SHIFT)) > > + max_low_pfn =3D mem_end >> PAGE_SHIFT; > > + break; > > + case EFI_PAL_CODE: > > + case EFI_UNUSABLE_MEMORY: > > + case EFI_ACPI_RECLAIM_MEMORY: > > + memblock_add(mem_start, mem_size); > > + fallthrough; > > + case EFI_RESERVED_TYPE: > > + case EFI_RUNTIME_SERVICES_CODE: > > + case EFI_RUNTIME_SERVICES_DATA: > > + case EFI_MEMORY_MAPPED_IO: > > + case EFI_MEMORY_MAPPED_IO_PORT_SPACE: > > + memblock_reserve(mem_start, mem_size); > > + break; > > + } > > + } > > + > > + memblock_set_current_limit(PFN_PHYS(max_low_pfn)); > > + memblock_set_node(0, PHYS_ADDR_MAX, &memblock.memory, 0); > > + > > + /* Reserve the first 2MB */ > > + memblock_reserve(PHYS_OFFSET, 0x200000); > > + > > + /* Reserve the kernel text/data/bss */ > > + memblock_reserve(__pa_symbol(&_text), > > + __pa_symbol(&_end) - __pa_symbol(&_text)); > > + > > + /* Reserve the initrd */ > > + reserve_initrd_mem(); > > +} > > diff --git a/arch/loongarch/kernel/reset.c b/arch/loongarch/kernel/rese= t.c > > new file mode 100644 > > index 000000000000..ef484ce43c5c > > --- /dev/null > > +++ b/arch/loongarch/kernel/reset.c > > @@ -0,0 +1,90 @@ > > +// SPDX-License-Identifier: GPL-2.0 > > +/* > > + * Copyright (C) 2020-2022 Loongson Technology Corporation Limited > > + */ > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > + > > +#include > > +#include > > +#include > > +#include > > +#include > > + > > +static void default_halt(void) > > +{ > > + local_irq_disable(); > > + clear_csr_ecfg(ECFG0_IM); > > + > > + pr_notice("\n\n** You can safely turn off the power now **\n\n"); > > + console_flush_on_panic(CONSOLE_FLUSH_PENDING); > > + > > + while (true) { > > + __arch_cpu_idle(); > > + } > > +} > > + > > +static void default_poweroff(void) > > +{ > > +#ifdef CONFIG_EFI > > + efi.reset_system(EFI_RESET_SHUTDOWN, EFI_SUCCESS, 0, NULL); > > +#endif > > + while (true) { > > + __arch_cpu_idle(); > > + } > > +} > > + > > +static void default_restart(void) > > +{ > > +#ifdef CONFIG_EFI > > + if (efi_capsule_pending(NULL)) > > + efi_reboot(REBOOT_WARM, NULL); > > + else > > + efi_reboot(REBOOT_COLD, NULL); > > +#endif > > + if (!acpi_disabled) > > + acpi_reboot(); > > + > > + while (true) { > > + __arch_cpu_idle(); > > + } > > +} > > + > > +void (*pm_restart)(void); > > +EXPORT_SYMBOL(pm_restart); > > + > > +void (*pm_power_off)(void); > > +EXPORT_SYMBOL(pm_power_off); > > + > > +void machine_halt(void) > > +{ > > + default_halt(); > > +} > > + > > +void machine_power_off(void) > > +{ > > + pm_power_off(); > > +} > > + > > +void machine_restart(char *command) > > +{ > > + do_kernel_restart(command); > > + pm_restart(); > > +} > > + > > +static int __init loongarch_reboot_setup(void) > > +{ > > + pm_restart =3D default_restart; > > + pm_power_off =3D default_poweroff; > > + > > + return 0; > > +} > > + > > +arch_initcall(loongarch_reboot_setup); > > diff --git a/arch/loongarch/kernel/setup.c b/arch/loongarch/kernel/setu= p.c > > new file mode 100644 > > index 000000000000..827d07204e62 > > --- /dev/null > > +++ b/arch/loongarch/kernel/setup.c > > @@ -0,0 +1,348 @@ > > +// SPDX-License-Identifier: GPL-2.0 > > +/* > > + * Copyright (C) 2020-2022 Loongson Technology Corporation Limited > > + * > > + * Derived from MIPS: > > + * Copyright (C) 1995 Linus Torvalds > > + * Copyright (C) 1995 Waldorf Electronics > > + * Copyright (C) 1994, 95, 96, 97, 98, 99, 2000, 01, 02, 03 Ralf Baec= hle > > + * Copyright (C) 1996 Stoned Elipot > > + * Copyright (C) 1999 Silicon Graphics, Inc. > > + * Copyright (C) 2000, 2001, 2002, 2007 Maciej W. Rozycki > > + */ > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > + > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > + > > +#define SMBIOS_BIOSSIZE_OFFSET 0x09 > > +#define SMBIOS_BIOSEXTERN_OFFSET 0x13 > > +#define SMBIOS_FREQLOW_OFFSET 0x16 > > +#define SMBIOS_FREQHIGH_OFFSET 0x17 > > +#define SMBIOS_FREQLOW_MASK 0xFF > > +#define SMBIOS_CORE_PACKAGE_OFFSET 0x23 > > +#define LOONGSON_EFI_ENABLE (1 << 3) > > + > > +#ifdef CONFIG_VT > > +struct screen_info screen_info; > > +#endif > > + > > +DEFINE_PER_CPU(unsigned long, kernelsp); > > +unsigned long fw_arg0, fw_arg1, fw_arg2; > > +struct cpuinfo_loongarch cpu_data[NR_CPUS] __read_mostly; > > + > > +EXPORT_SYMBOL(cpu_data); > > + > > +struct loongson_board_info b_info; > > +static const char dmi_empty_string[] =3D " "; > > + > > +/* > > + * Setup information > > + * > > + * These are initialized so they are in the .data section > > + */ > > + > > +static int num_standard_resources; > > +static struct resource *standard_resources; > > + > > +static struct resource code_resource =3D { .name =3D "Kernel code", }; > > +static struct resource data_resource =3D { .name =3D "Kernel data", }; > > +static struct resource bss_resource =3D { .name =3D "Kernel bss", }; > > + > > +const char *get_system_type(void) > > +{ > > + return "generic-loongson-machine"; > > +} > > + > > +static const char *dmi_string_parse(const struct dmi_header *dm, u8 s) > > +{ > > + const u8 *bp =3D ((u8 *) dm) + dm->length; > > + > > + if (s) { > > + s--; > > + while (s > 0 && *bp) { > > + bp +=3D strlen(bp) + 1; > > + s--; > > + } > > + > > + if (*bp !=3D 0) { > > + size_t len =3D strlen(bp)+1; > > + size_t cmp_len =3D len > 8 ? 8 : len; > > + > > + if (!memcmp(bp, dmi_empty_string, cmp_len)) > > + return dmi_empty_string; > > + > > + return bp; > > + } > > + } > > + > > + return ""; > > +} > > + > > +static void __init parse_cpu_table(const struct dmi_header *dm) > > +{ > > + long freq_temp =3D 0; > > + char *dmi_data =3D (char *)dm; > > + > > + freq_temp =3D ((*(dmi_data + SMBIOS_FREQHIGH_OFFSET) << 8) + > > + ((*(dmi_data + SMBIOS_FREQLOW_OFFSET)) & SMBIOS_F= REQLOW_MASK)); > > + cpu_clock_freq =3D freq_temp * 1000000; > > + > > + loongson_sysconf.cpuname =3D (void *)dmi_string_parse(dm, dmi_dat= a[16]); > > + loongson_sysconf.cores_per_package =3D *(dmi_data + SMBIOS_CORE_P= ACKAGE_OFFSET); > > + > > + pr_info("CpuClock =3D %llu\n", cpu_clock_freq); > > +} > > + > > +static void __init parse_bios_table(const struct dmi_header *dm) > > +{ > > + int bios_extern; > > + char *dmi_data =3D (char *)dm; > > + > > + bios_extern =3D *(dmi_data + SMBIOS_BIOSEXTERN_OFFSET); > > + b_info.bios_size =3D *(dmi_data + SMBIOS_BIOSSIZE_OFFSET); > > + > > + if (bios_extern & LOONGSON_EFI_ENABLE) > > + set_bit(EFI_BOOT, &efi.flags); > > + else > > + clear_bit(EFI_BOOT, &efi.flags); > > +} > > + > > +static void __init find_tokens(const struct dmi_header *dm, void *dumm= y) > > +{ > > + switch (dm->type) { > > + case 0x0: /* Extern BIOS */ > > + parse_bios_table(dm); > > + break; > > + case 0x4: /* Calling interface */ > > + parse_cpu_table(dm); > > + break; > > + } > > +} > > +static void __init smbios_parse(void) > > +{ > > + b_info.bios_vendor =3D (void *)dmi_get_system_info(DMI_BIOS_VENDO= R); > > + b_info.bios_version =3D (void *)dmi_get_system_info(DMI_BIOS_VERS= ION); > > + b_info.bios_release_date =3D (void *)dmi_get_system_info(DMI_BIOS= _DATE); > > + b_info.board_vendor =3D (void *)dmi_get_system_info(DMI_BOARD_VEN= DOR); > > + b_info.board_name =3D (void *)dmi_get_system_info(DMI_BOARD_NAME)= ; > > + dmi_walk(find_tokens, NULL); > > +} > > + > > +static int usermem __initdata; > > + > > +static int __init early_parse_mem(char *p) > > +{ > > + phys_addr_t start, size; > > + > > + /* > > + * If a user specifies memory size, we > > + * blow away any automatically generated > > + * size. > > + */ > > + if (usermem =3D=3D 0) { > > + usermem =3D 1; > > + memblock_remove(memblock_start_of_DRAM(), > > + memblock_end_of_DRAM() - memblock_start_of_DRAM()= ); > > + } > > + start =3D 0; > > + size =3D memparse(p, &p); > > + if (*p =3D=3D '@') > > + start =3D memparse(p + 1, &p); > > + else { > > + pr_err("Invalid format!\n"); > > + return -EINVAL; > > + } > > + > > + memblock_add(start, size); > > + > > + return 0; > > +} > > +early_param("mem", early_parse_mem); > > + > > +void __init platform_init(void) > > +{ > > + efi_init(); > > +#ifdef CONFIG_ACPI_TABLE_UPGRADE > > + acpi_table_upgrade(); > > +#endif > > +#ifdef CONFIG_ACPI > > + acpi_gbl_use_default_register_widths =3D false; > > + acpi_boot_table_init(); > > + acpi_boot_init(); > > +#endif > > + > > + dmi_setup(); > > + smbios_parse(); > > + pr_info("The BIOS Version: %s\n", b_info.bios_version); > > + > > + efi_runtime_init(); > > +} > > + > > +static void __init check_kernel_sections_mem(void) > > +{ > > + phys_addr_t start =3D __pa_symbol(&_text); > > + phys_addr_t size =3D __pa_symbol(&_end) - start; > > + > > + if (!memblock_is_region_memory(start, size)) { > > + pr_info("Kernel sections are not in the memory maps\n"); > > + memblock_add(start, size); > > + } > > +} > > + > > +/* > > + * arch_mem_init - initialize memory management subsystem > > + */ > > +static void __init arch_mem_init(char **cmdline_p) > > +{ > > + if (usermem) > > + pr_info("User-defined physical RAM map overwrite\n"); > > + > > + check_kernel_sections_mem(); > > + > > + /* > > + * In order to reduce the possibility of kernel panic when failed= to > > + * get IO TLB memory under CONFIG_SWIOTLB, it is better to alloca= te > > + * low memory as small as possible before plat_swiotlb_setup(), s= o > > + * make sparse_init() using top-down allocation. > > + */ > > + memblock_set_bottom_up(false); > > + sparse_init(); > > + memblock_set_bottom_up(true); > > + > > + swiotlb_init(1); > > + > > + dma_contiguous_reserve(PFN_PHYS(max_low_pfn)); > > + > > + memblock_dump_all(); > > + > > + early_memtest(PFN_PHYS(ARCH_PFN_OFFSET), PFN_PHYS(max_low_pfn)); > > +} > > + > > +static void __init resource_init(void) > > +{ > > + long i =3D 0; > > + size_t res_size; > > + struct resource *res; > > + struct memblock_region *region; > > + > > + code_resource.start =3D __pa_symbol(&_text); > > + code_resource.end =3D __pa_symbol(&_etext) - 1; > > + data_resource.start =3D __pa_symbol(&_etext); > > + data_resource.end =3D __pa_symbol(&_edata) - 1; > > + bss_resource.start =3D __pa_symbol(&__bss_start); > > + bss_resource.end =3D __pa_symbol(&__bss_stop) - 1; > > + > > + num_standard_resources =3D memblock.memory.cnt; > > + res_size =3D num_standard_resources * sizeof(*standard_resources)= ; > > + standard_resources =3D memblock_alloc(res_size, SMP_CACHE_BYTES); > > + > > + for_each_mem_region(region) { > > + res =3D &standard_resources[i++]; > > + if (!memblock_is_nomap(region)) { > > + res->name =3D "System RAM"; > > + res->flags =3D IORESOURCE_SYSTEM_RAM | IORESOURCE= _BUSY; > > + res->start =3D __pfn_to_phys(memblock_region_memo= ry_base_pfn(region)); > > + res->end =3D __pfn_to_phys(memblock_region_memory= _end_pfn(region)) - 1; > > + } else { > > + res->name =3D "Reserved"; > > + res->flags =3D IORESOURCE_MEM; > > + res->start =3D __pfn_to_phys(memblock_region_rese= rved_base_pfn(region)); > > + res->end =3D __pfn_to_phys(memblock_region_reserv= ed_end_pfn(region)) - 1; > > + } > > + > > + request_resource(&iomem_resource, res); > > + > > + /* > > + * We don't know which RAM region contains kernel data, > > + * so we try it repeatedly and let the resource manager > > + * test it. > > + */ > > + request_resource(res, &code_resource); > > + request_resource(res, &data_resource); > > + request_resource(res, &bss_resource); > > + } > > +} > > + > > +static int __init reserve_memblock_reserved_regions(void) > > +{ > > + u64 i, j; > > + > > + for (i =3D 0; i < num_standard_resources; ++i) { > > + struct resource *mem =3D &standard_resources[i]; > > + phys_addr_t r_start, r_end, mem_size =3D resource_size(me= m); > > + > > + if (!memblock_is_region_reserved(mem->start, mem_size)) > > + continue; > > + > > + for_each_reserved_mem_range(j, &r_start, &r_end) { > > + resource_size_t start, end; > > + > > + start =3D max(PFN_PHYS(PFN_DOWN(r_start)), mem->s= tart); > > + end =3D min(PFN_PHYS(PFN_UP(r_end)) - 1, mem->end= ); > > + > > + if (start > mem->end || end < mem->start) > > + continue; > > + > > + reserve_region_with_split(mem, start, end, "Reser= ved"); > > + } > > + } > > + > > + return 0; > > +} > > +arch_initcall(reserve_memblock_reserved_regions); > > + > > +void __init setup_arch(char **cmdline_p) > > +{ > > + cpu_probe(); > > + *cmdline_p =3D boot_command_line; > > + > > + init_environ(); > > + memblock_init(); > > + parse_early_param(); > > + > > + platform_init(); > > + pagetable_init(); > > + arch_mem_init(cmdline_p); > > + > > + resource_init(); > > + > > + paging_init(); > > +} > > + > > +static int __init register_gop_device(void) > > +{ > > + void *pd; > > + > > + if (screen_info.orig_video_isVGA !=3D VIDEO_TYPE_EFI) > > + return 0; > > + pd =3D platform_device_register_data(NULL, "efi-framebuffer", 0, > > + &screen_info, sizeof(screen_info)); > > + return PTR_ERR_OR_ZERO(pd); > > +} > > +subsys_initcall(register_gop_device); > > diff --git a/arch/loongarch/kernel/time.c b/arch/loongarch/kernel/time.= c > > new file mode 100644 > > index 000000000000..5d2b2c6712bc > > --- /dev/null > > +++ b/arch/loongarch/kernel/time.c > > @@ -0,0 +1,220 @@ > > +// SPDX-License-Identifier: GPL-2.0 > > +/* > > + * Common time service routines for LoongArch machines. > > + * > > + * Copyright (C) 2020-2022 Loongson Technology Corporation Limited > > + */ > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > +#include > > + > > +#include > > +#include > > +#include > > + > > +u64 cpu_clock_freq; > > +EXPORT_SYMBOL(cpu_clock_freq); > > +u64 const_clock_freq; > > +EXPORT_SYMBOL(const_clock_freq); > > + > > +static DEFINE_RAW_SPINLOCK(state_lock); > > +static DEFINE_PER_CPU(struct clock_event_device, constant_clockevent_d= evice); > > + > > +static void constant_event_handler(struct clock_event_device *dev) > > +{ > > +} > > + > > +irqreturn_t constant_timer_interrupt(int irq, void *data) > > +{ > > + int cpu =3D smp_processor_id(); > > + struct clock_event_device *cd; > > + > > + /* Clear Timer Interrupt */ > > + write_csr_tintclear(CSR_TINTCLR_TI); > > + cd =3D &per_cpu(constant_clockevent_device, cpu); > > + cd->event_handler(cd); > > + > > + return IRQ_HANDLED; > > +} > > + > > +static int constant_set_state_oneshot(struct clock_event_device *evt) > > +{ > > + unsigned long timer_config; > > + > > + raw_spin_lock(&state_lock); > > + > > + timer_config =3D csr_readq(LOONGARCH_CSR_TCFG); > > + timer_config |=3D CSR_TCFG_EN; > > + timer_config &=3D ~CSR_TCFG_PERIOD; > > + csr_writeq(timer_config, LOONGARCH_CSR_TCFG); > > + > > + raw_spin_unlock(&state_lock); > > + > > + return 0; > > +} > > + > > +static int constant_set_state_oneshot_stopped(struct clock_event_devic= e *evt) > > +{ > > + unsigned long timer_config; > > + > > + raw_spin_lock(&state_lock); > > + > > + timer_config =3D csr_readq(LOONGARCH_CSR_TCFG); > > + timer_config &=3D ~CSR_TCFG_EN; > > + csr_writeq(timer_config, LOONGARCH_CSR_TCFG); > > + > > + raw_spin_unlock(&state_lock); > > + > > + return 0; > > +} > > + > > +static int constant_set_state_periodic(struct clock_event_device *evt) > > +{ > > + unsigned long period; > > + unsigned long timer_config; > > + > > + raw_spin_lock(&state_lock); > > + > > + period =3D const_clock_freq / HZ; > > + timer_config =3D period & CSR_TCFG_VAL; > > + timer_config |=3D (CSR_TCFG_PERIOD | CSR_TCFG_EN); > > + csr_writeq(timer_config, LOONGARCH_CSR_TCFG); > > + > > + raw_spin_unlock(&state_lock); > > + > > + return 0; > > +} > > + > > +static int constant_set_state_shutdown(struct clock_event_device *evt) > > +{ > > + return 0; > > +} > > + > > +static int constant_timer_next_event(unsigned long delta, struct clock= _event_device *evt) > > +{ > > + unsigned long timer_config; > > + > > + delta &=3D CSR_TCFG_VAL; > > + timer_config =3D delta | CSR_TCFG_EN; > > + csr_writeq(timer_config, LOONGARCH_CSR_TCFG); > > + > > + return 0; > > +} > > + > > +static unsigned long __init get_loops_per_jiffy(void) > > +{ > > + unsigned long lpj =3D (unsigned long)const_clock_freq; > > + > > + do_div(lpj, HZ); > > + > > + return lpj; > > +} > > + > > +static long init_timeval; > > + > > +void sync_counter(void) > > +{ > > + /* Ensure counter begin at 0 */ > > + csr_writeq(-init_timeval, LOONGARCH_CSR_CNTC); > > +} > > + > > +int constant_clockevent_init(void) > > +{ > > + unsigned int irq; > > + unsigned int cpu =3D smp_processor_id(); > > + unsigned long min_delta =3D 0x600; > > + unsigned long max_delta =3D (1UL << 48) - 1; > > + struct clock_event_device *cd; > > + static int timer_irq_installed =3D 0; > > + > > + irq =3D get_timer_irq(); > > + > > + cd =3D &per_cpu(constant_clockevent_device, cpu); > > + > > + cd->name =3D "Constant"; > > + cd->features =3D CLOCK_EVT_FEAT_ONESHOT | CLOCK_EVT_FEAT_PERIODIC= | CLOCK_EVT_FEAT_PERCPU; > > + > > + cd->irq =3D irq; > > + cd->rating =3D 320; > > + cd->cpumask =3D cpumask_of(cpu); > > + cd->set_state_oneshot =3D constant_set_state_oneshot; > > + cd->set_state_oneshot_stopped =3D constant_set_state_oneshot_stop= ped; > > + cd->set_state_periodic =3D constant_set_state_periodic; > > + cd->set_state_shutdown =3D constant_set_state_shutdown; > > + cd->set_next_event =3D constant_timer_next_event; > > + cd->event_handler =3D constant_event_handler; > > + > > + clockevents_config_and_register(cd, const_clock_freq, min_delta, = max_delta); > > + > > + if (timer_irq_installed) > > + return 0; > > + > > + timer_irq_installed =3D 1; > > + > > + sync_counter(); > > + > > + if (request_irq(irq, constant_timer_interrupt, IRQF_PERCPU | IRQF= _TIMER, "timer", NULL)) > > + pr_err("Failed to request irq %d (timer)\n", irq); > > + > > + lpj_fine =3D get_loops_per_jiffy(); > > + pr_info("Constant clock event device register\n"); > > + > > + return 0; > > +} > > + > > +static u64 read_const_counter(struct clocksource *clk) > > +{ > > + return drdtime(); > > +} > > + > > +static u64 native_sched_clock(void) > > +{ > > + return read_const_counter(NULL); > > +} > > + > > +static struct clocksource clocksource_const =3D { > > + .name =3D "Constant", > > + .rating =3D 400, > > + .read =3D read_const_counter, > > + .mask =3D CLOCKSOURCE_MASK(64), > > + .flags =3D CLOCK_SOURCE_IS_CONTINUOUS, > > + .mult =3D 0, > > + .shift =3D 10, > > +}; > > + > > +int __init constant_clocksource_init(void) > > +{ > > + int res; > > + unsigned long freq; > > + > > + freq =3D const_clock_freq; > > + > > + clocksource_const.mult =3D > > + clocksource_hz2mult(freq, clocksource_const.shift); > > + > > + res =3D clocksource_register_hz(&clocksource_const, freq); > > + > > + sched_clock_register(native_sched_clock, 64, freq); > > + > > + pr_info("Constant clock source device register\n"); > > + > > + return res; > > +} > > + > > +void __init time_init(void) > > +{ > > + if (!cpu_has_cpucfg) > > + const_clock_freq =3D cpu_clock_freq; > > + else > > + const_clock_freq =3D calc_const_freq(); > > + > > + init_timeval =3D drdtime() - csr_readq(LOONGARCH_CSR_CNTC); > > + > > + constant_clockevent_init(); > > + constant_clocksource_init(); > > +} > > diff --git a/arch/loongarch/kernel/topology.c b/arch/loongarch/kernel/t= opology.c > > new file mode 100644 > > index 000000000000..3b2cbb95875b > > --- /dev/null > > +++ b/arch/loongarch/kernel/topology.c > > @@ -0,0 +1,13 @@ > > +// SPDX-License-Identifier: GPL-2.0 > > +#include > > +#include > > +#include > > + > > +static struct cpu cpu_device; > > + > > +static int __init topology_init(void) > > +{ > > + return register_cpu(&cpu_device, 0); > > +} > > + > > +subsys_initcall(topology_init); > > diff --git a/drivers/firmware/efi/Kconfig b/drivers/firmware/efi/Kconfi= g > > index 2c3dac5ecb36..c47fa1ef9387 100644 > > --- a/drivers/firmware/efi/Kconfig > > +++ b/drivers/firmware/efi/Kconfig > > @@ -106,7 +106,7 @@ config EFI_GENERIC_STUB > > > > config EFI_ARMSTUB_DTB_LOADER > > bool "Enable the DTB loader" > > - depends on EFI_GENERIC_STUB && !RISCV > > + depends on EFI_GENERIC_STUB && !RISCV && !LOONGARCH > > default y > > help > > Select this config option to add support for the dtb=3D command > > diff --git a/drivers/firmware/efi/libstub/Makefile b/drivers/firmware/e= fi/libstub/Makefile > > index d0537573501e..1588c61939e7 100644 > > --- a/drivers/firmware/efi/libstub/Makefile > > +++ b/drivers/firmware/efi/libstub/Makefile > > @@ -26,6 +26,8 @@ cflags-$(CONFIG_ARM) :=3D $(subst $(CC= _FLAGS_FTRACE),,$(KBUILD_CFLAGS)) \ > > $(call cc-option,-mno-single-pic-base) > > cflags-$(CONFIG_RISCV) :=3D $(subst $(CC_FLAGS_FTRACE),,= $(KBUILD_CFLAGS)) \ > > -fpic > > +cflags-$(CONFIG_LOONGARCH) :=3D $(subst $(CC_FLAGS_FTRACE),,$(KBUILD= _CFLAGS)) \ > > + -fpic > > > > cflags-$(CONFIG_EFI_GENERIC_STUB) +=3D -I$(srctree)/scripts/dtc/libfd= t > > > > @@ -70,6 +72,8 @@ lib-$(CONFIG_ARM) +=3D arm32-stub.o > > lib-$(CONFIG_ARM64) +=3D arm64-stub.o > > lib-$(CONFIG_X86) +=3D x86-stub.o > > lib-$(CONFIG_RISCV) +=3D riscv-stub.o > > +lib-$(CONFIG_LOONGARCH) +=3D loongarch-stub.o > > + > > CFLAGS_arm32-stub.o :=3D -DTEXT_OFFSET=3D$(TEXT_OFFSET) > > > > # Even when -mbranch-protection=3Dnone is set, Clang will generate a > > @@ -125,6 +129,12 @@ STUBCOPY_FLAGS-$(CONFIG_RISCV) +=3D --prefix-all= oc-sections=3D.init \ > > --prefix-symbols=3D__efistub_ > > STUBCOPY_RELOC-$(CONFIG_RISCV) :=3D R_RISCV_HI20 > > > > +# For LoongArch, keep all the symbols in .init section and make sure t= hat no > > +# absolute symbols references doesn't exist. > > +STUBCOPY_FLAGS-$(CONFIG_LOONGARCH) +=3D --prefix-alloc-sections=3D.i= nit \ > > + --prefix-symbols=3D__efistub_ > > +STUBCOPY_RELOC-$(CONFIG_LOONGARCH) :=3D R_LARCH_MARK_LA > > + > > $(obj)/%.stub.o: $(obj)/%.o FORCE > > $(call if_changed,stubcopy) > > > > diff --git a/drivers/firmware/efi/libstub/efi-stub-helper.c b/drivers/f= irmware/efi/libstub/efi-stub-helper.c > > index 3d972061c1b0..f612cfceda22 100644 > > --- a/drivers/firmware/efi/libstub/efi-stub-helper.c > > +++ b/drivers/firmware/efi/libstub/efi-stub-helper.c > > @@ -21,7 +21,7 @@ > > bool efi_nochunk; > > bool efi_nokaslr =3D !IS_ENABLED(CONFIG_RANDOMIZE_BASE); > > int efi_loglevel =3D CONSOLE_LOGLEVEL_DEFAULT; > > -bool efi_novamap; > > +bool efi_novamap =3D IS_ENABLED(CONFIG_LOONGARCH); /* LoongArch call s= vam() in kernel */ > > > > static bool efi_noinitrd; > > static bool efi_nosoftreserve; > > diff --git a/drivers/firmware/efi/libstub/efi-stub.c b/drivers/firmware= /efi/libstub/efi-stub.c > > index da93864d7abc..ffc02880a344 100644 > > --- a/drivers/firmware/efi/libstub/efi-stub.c > > +++ b/drivers/firmware/efi/libstub/efi-stub.c > > @@ -40,7 +40,7 @@ > > > > #ifdef CONFIG_ARM64 > > # define EFI_RT_VIRTUAL_LIMIT DEFAULT_MAP_WINDOW_64 > > -#elif defined(CONFIG_RISCV) > > +#elif defined(CONFIG_RISCV) || defined(CONFIG_LOONGARCH) > > # define EFI_RT_VIRTUAL_LIMIT TASK_SIZE_MIN > > #else > > # define EFI_RT_VIRTUAL_LIMIT TASK_SIZE > > diff --git a/drivers/firmware/efi/libstub/loongarch-stub.c b/drivers/fi= rmware/efi/libstub/loongarch-stub.c > > new file mode 100644 > > index 000000000000..25bf7f8ff00c > > --- /dev/null > > +++ b/drivers/firmware/efi/libstub/loongarch-stub.c > > @@ -0,0 +1,87 @@ > > +// SPDX-License-Identifier: GPL-2.0 > > +/* > > + * Author: Yun Liu > > + * Huacai Chen > > + * Copyright (C) 2020-2022 Loongson Technology Corporation Limited > > + */ > > + > > +#include > > +#include > > +#include > > +#include "efistub.h" > > + > > +typedef void __noreturn (*kernel_entry_t)(bool efi, unsigned long fdt)= ; > > + > > +extern int kernel_asize; > > +extern int kernel_fsize; > > +extern int kernel_offset; > > +extern kernel_entry_t kernel_entry; > > + > > +static efi_guid_t screen_info_guid =3D LINUX_EFI_LARCH_SCREEN_INFO_TAB= LE_GUID; > > + > > +struct screen_info *alloc_screen_info(void) > > +{ > > + efi_status_t status; > > + struct screen_info *si; > > + > > + status =3D efi_bs_call(allocate_pool, > > + EFI_RUNTIME_SERVICES_DATA, sizeof(*si), (void **)= &si); > > + if (status !=3D EFI_SUCCESS) > > + return NULL; > > + > > + status =3D efi_bs_call(install_configuration_table, &screen_info_= guid, si); > > + if (status =3D=3D EFI_SUCCESS) > > + return si; > > + > > + efi_bs_call(free_pool, si); > > + > > + return NULL; > > +} > > + > > +void free_screen_info(struct screen_info *si) > > +{ > > + if (!si) > > + return; > > + > > + efi_bs_call(install_configuration_table, &screen_info_guid, NULL)= ; > > + efi_bs_call(free_pool, si); > > +} > > + > > +efi_status_t check_platform_features(void) > > +{ > > + /* Config Direct Mapping */ > > + csr_writeq(CSR_DMW0_INIT, LOONGARCH_CSR_DMWIN0); > > + csr_writeq(CSR_DMW1_INIT, LOONGARCH_CSR_DMWIN1); > > + > > + return EFI_SUCCESS; > > +} > > + > > +efi_status_t handle_kernel_image(unsigned long *image_addr, > > + unsigned long *image_size, > > + unsigned long *reserve_addr, > > + unsigned long *reserve_size, > > + efi_loaded_image_t *image) > > +{ > > + efi_status_t status; > > + unsigned long kernel_addr =3D 0; > > + > > + kernel_addr =3D (unsigned long)&kernel_offset - kernel_offset; > > + > > + status =3D efi_relocate_kernel(&kernel_addr, kernel_fsize, kernel= _asize, > > + PHYSADDR(VMLINUX_LOAD_ADDRESS), SZ_2= M, 0x0); > > + > > + *image_addr =3D kernel_addr; > > + *image_size =3D kernel_asize; > > + > > + return status; > > +} > > + > > +void __noreturn efi_enter_kernel(unsigned long entrypoint, unsigned lo= ng fdt, unsigned long fdt_size) > > +{ > > + kernel_entry_t real_kernel_entry; > > + > > + real_kernel_entry =3D (kernel_entry_t) > > + ((unsigned long)&kernel_entry - entrypoint + VMLINUX_LOAD= _ADDRESS); > > + > > + real_kernel_entry(true, fdt); > > +} > > diff --git a/include/linux/efi.h b/include/linux/efi.h > > index ccd4d3f91c98..559fabdb6b7d 100644 > > --- a/include/linux/efi.h > > +++ b/include/linux/efi.h > > @@ -397,6 +397,7 @@ void efi_native_runtime_setup(void); > > * associated with ConOut > > */ > > #define LINUX_EFI_ARM_SCREEN_INFO_TABLE_GUID EFI_GUID(0xe03fc2= 0a, 0x85dc, 0x406e, 0xb9, 0x0e, 0x4a, 0xb5, 0x02, 0x37, 0x1d, 0x95) > > +#define LINUX_EFI_LARCH_SCREEN_INFO_TABLE_GUID EFI_GUID(0x07fd51= a6, 0x9532, 0x926f, 0x51, 0xdc, 0x6a, 0x63, 0x60, 0x2f, 0x84, 0xb4) > > #define LINUX_EFI_ARM_CPU_STATE_TABLE_GUID EFI_GUID(0xef79e4aa, 0x3c= 3d, 0x4989, 0xb9, 0x02, 0x07, 0xa9, 0x43, 0xe5, 0x50, 0xd2) > > #define LINUX_EFI_LOADER_ENTRY_GUID EFI_GUID(0x4a67b082, 0x0a= 4c, 0x41cf, 0xb6, 0xc7, 0x44, 0x0b, 0x29, 0xbb, 0x8c, 0x4f) > > #define LINUX_EFI_RANDOM_SEED_TABLE_GUID EFI_GUID(0x1ce1e5bc, 0x7c= eb, 0x42f2, 0x81, 0xe5, 0x8a, 0xad, 0xf1, 0x80, 0xf5, 0x7b) > > diff --git a/include/linux/pe.h b/include/linux/pe.h > > index daf09ffffe38..f4bb0b6a416d 100644 > > --- a/include/linux/pe.h > > +++ b/include/linux/pe.h > > @@ -65,6 +65,7 @@ > > #define IMAGE_FILE_MACHINE_SH5 0x01a8 > > #define IMAGE_FILE_MACHINE_THUMB 0x01c2 > > #define IMAGE_FILE_MACHINE_WCEMIPSV2 0x0169 > > +#define IMAGE_FILE_MACHINE_LOONGARCH 0x6264 > > This should be IMAGE_FILE_MACHINE_LOONGARCH64, as shown in the PE format > spec [1]. You may or may not want add IMAGE_FILE_MACHINE_LOONGARCH32 too. > > [1]: https://docs.microsoft.com/en-us/windows/win32/debug/pe-format > > > > > /* flags */ > > #define IMAGE_FILE_RELOCS_STRIPPED 0x0001 > > So all of this mostly look good, except that I can't test the patch > (actually, the series) because no compatible firmware nor emulator is > available. I've contacted the Loongson people working on QEMU though, > and they might have something to share in the following days. > > With the minor points above addressed: > > Reviewed-by: WANG Xuerui >