uboot-mediatek: add support for MT798x platforms

Import pending patches to support the upcoming Filogic platforms. Signed-off-by: Daniel Golle <daniel@makrotopia.org>
2022-07-12 03:41:30 +01:00
parent a4933cdd12
commit c09eb08dad
36 changed files with 12173 additions and 6 deletions
--- a/package/boot/uboot-mediatek/Makefile
+++ b/package/boot/uboot-mediatek/Makefile
@@ -175,6 +175,14 @@ define U-Boot/mt7629_rfb
  UBOOT_CONFIG:=mt7629_rfb
 endef
 define U-Boot/mt7986_rfb
  NAME:=MT7986 Reference Board
  BUILD_SUBTARGET:=filogic
  BUILD_DEVICES:=mediatek_mt7986-rfb
  UBOOT_CONFIG:=mt7986_rfb
  UBOOT_IMAGE:=u-boot.bin
 endef
 UBOOT_TARGETS := \
 	mt7620_mt7530_rfb \
 	mt7620_rfb \
@@ -190,7 +198,8 @@ UBOOT_TARGETS := \
 	mt7623a_unielec_u7623 \
 	mt7628_rfb \
 	ravpower_rp-wd009 \
-	mt7629_rfb
+	mt7629_rfb \
 	mt7986_rfb
 ifdef CONFIG_TARGET_mediatek
 UBOOT_MAKE_FLAGS += $(UBOOT_IMAGE:.fip=.bin)
--- a/package/boot/uboot-mediatek/patches/002-0001-arm-mediatek-add-support-for-MediaTek-MT7986-SoC.patch
+++ b/package/boot/uboot-mediatek/patches/002-0001-arm-mediatek-add-support-for-MediaTek-MT7986-SoC.patch
@@ -0,0 +1,552 @@
 From a299de45833df13d4ec28092201ea5fec0ba24fe Mon Sep 17 00:00:00 2001
 From: Weijie Gao <weijie.gao@mediatek.com>
 Date: Fri, 29 Jul 2022 15:17:58 +0800
 Subject: [PATCH 01/31] arm: mediatek: add support for MediaTek MT7986 SoC
 This patch adds basic support for MediaTek MT7986 SoC.
 This include the file that will initialize the SoC after boot and its
 device tree.
 Signed-off-by: Weijie Gao <weijie.gao@mediatek.com>
 ---
 arch/arm/dts/mt7986-u-boot.dtsi               |  33 ++
 arch/arm/dts/mt7986.dtsi                      | 341 ++++++++++++++++++
 arch/arm/mach-mediatek/Kconfig                |  11 +
 arch/arm/mach-mediatek/Makefile               |   1 +
 arch/arm/mach-mediatek/mt7986/Makefile        |   4 +
 arch/arm/mach-mediatek/mt7986/init.c          |  51 +++
 arch/arm/mach-mediatek/mt7986/lowlevel_init.S |  32 ++
 7 files changed, 473 insertions(+)
 create mode 100644 arch/arm/dts/mt7986-u-boot.dtsi
 create mode 100644 arch/arm/dts/mt7986.dtsi
 create mode 100644 arch/arm/mach-mediatek/mt7986/Makefile
 create mode 100644 arch/arm/mach-mediatek/mt7986/init.c
 create mode 100644 arch/arm/mach-mediatek/mt7986/lowlevel_init.S
 --- /dev/null
 +++ b/arch/arm/dts/mt7986-u-boot.dtsi
@@ -0,0 +1,33 @@
 +// SPDX-License-Identifier: GPL-2.0
 +/*
 + * Copyright (c) 2022 MediaTek Inc.
 + * Author: Sam Shih <sam.shih@mediatek.com>
 + */
 +
 +&topckgen {
 +	u-boot,dm-pre-reloc;
 +};
 +
 +&pericfg {
 +	u-boot,dm-pre-reloc;
 +};
 +
 +&apmixedsys {
 +	u-boot,dm-pre-reloc;
 +};
 +
 +&timer0 {
 +	u-boot,dm-pre-reloc;
 +};
 +
 +&uart0 {
 +	u-boot,dm-pre-reloc;
 +};
 +
 +&snand {
 +	u-boot,dm-pre-reloc;
 +};
 +
 +&pinctrl {
 +	u-boot,dm-pre-reloc;
 +};
 --- /dev/null
 +++ b/arch/arm/dts/mt7986.dtsi
@@ -0,0 +1,341 @@
 +// SPDX-License-Identifier: GPL-2.0
 +/*
 + * Copyright (c) 2022 MediaTek Inc.
 + * Author: Sam Shih <sam.shih@mediatek.com>
 + */
 +
 +#include <dt-bindings/interrupt-controller/irq.h>
 +#include <dt-bindings/interrupt-controller/arm-gic.h>
 +#include <dt-bindings/phy/phy.h>
 +#include <dt-bindings/clock/mt7986-clk.h>
 +#include <dt-bindings/reset/mt7629-reset.h>
 +#include <dt-bindings/pinctrl/mt65xx.h>
 +
 +/ {
 +	compatible = "mediatek,mt7986";
 +	interrupt-parent = <&gic>;
 +	#address-cells = <1>;
 +	#size-cells = <1>;
 +
 +	config {
 +		u-boot,mmc-env-partition = "u-boot-env";
 +	};
 +
 +	cpus {
 +		#address-cells = <1>;
 +		#size-cells = <0>;
 +		cpu0: cpu@0 {
 +			device_type = "cpu";
 +			compatible = "arm,cortex-a53";
 +			reg = <0x0>;
 +		};
 +		cpu1: cpu@1 {
 +			device_type = "cpu";
 +			compatible = "arm,cortex-a53";
 +			reg = <0x1>;
 +		};
 +		cpu2: cpu@2 {
 +			device_type = "cpu";
 +			compatible = "arm,cortex-a53";
 +			reg = <0x1>;
 +		};
 +		cpu3: cpu@3 {
 +			device_type = "cpu";
 +			compatible = "arm,cortex-a53";
 +			reg = <0x1>;
 +		};
 +	};
 +
 +	dummy_clk: dummy12m {
 +		compatible = "fixed-clock";
 +		clock-frequency = <12000000>;
 +		#clock-cells = <0>;
 +		/* must need this line, or uart uanable to get dummy_clk */
 +		u-boot,dm-pre-reloc;
 +	};
 +
 +	timer {
 +		compatible = "arm,armv8-timer";
 +		interrupt-parent = <&gic>;
 +		clock-frequency = <13000000>;
 +		interrupts = <GIC_PPI 13 IRQ_TYPE_LEVEL_LOW>,
 +			     <GIC_PPI 14 IRQ_TYPE_LEVEL_LOW>,
 +			     <GIC_PPI 11 IRQ_TYPE_LEVEL_LOW>,
 +			     <GIC_PPI 10 IRQ_TYPE_LEVEL_LOW>;
 +		arm,cpu-registers-not-fw-configured;
 +	};
 +
 +	timer0: timer@10008000 {
 +		compatible = "mediatek,mt7986-timer";
 +		reg = <0x10008000 0x1000>;
 +		interrupts = <GIC_SPI 130 IRQ_TYPE_LEVEL_HIGH>;
 +		clocks = <&infracfg CK_INFRA_CK_F26M>;
 +		clock-names = "gpt-clk";
 +		u-boot,dm-pre-reloc;
 +	};
 +
 +	watchdog: watchdog@1001c000 {
 +		compatible = "mediatek,mt7986-wdt";
 +		reg = <0x1001c000 0x1000>;
 +		interrupts = <GIC_SPI 110 IRQ_TYPE_LEVEL_HIGH>;
 +		#reset-cells = <1>;
 +		status = "disabled";
 +	};
 +
 +	gic: interrupt-controller@c000000 {
 +		compatible = "arm,gic-v3";
 +		#interrupt-cells = <3>;
 +		interrupt-parent = <&gic>;
 +		interrupt-controller;
 +		reg = <0x0c000000 0x40000>,  /* GICD */
 +		      <0x0c080000 0x200000>; /* GICR */
 +
 +		interrupts = <GIC_PPI 9 IRQ_TYPE_LEVEL_HIGH>;
 +	};
 +
 +	fixed_plls: apmixedsys@1001E000 {
 +		compatible = "mediatek,mt7986-fixed-plls";
 +		reg = <0x1001E000 0x1000>;
 +		#clock-cells = <1>;
 +	};
 +
 +	topckgen: topckgen@1001B000 {
 +		compatible = "mediatek,mt7986-topckgen";
 +		reg = <0x1001B000 0x1000>;
 +		clock-parent = <&fixed_plls>;
 +		#clock-cells = <1>;
 +	};
 +
 +	infracfg_ao: infracfg_ao@10001000 {
 +		compatible = "mediatek,mt7986-infracfg_ao";
 +		reg = <0x10001000 0x68>;
 +		clock-parent = <&infracfg>;
 +		#clock-cells = <1>;
 +	};
 +
 +	infracfg: infracfg@10001040 {
 +		compatible = "mediatek,mt7986-infracfg";
 +		reg = <0x10001000 0x1000>;
 +		clock-parent = <&topckgen>;
 +		#clock-cells = <1>;
 +	};
 +
 +	pinctrl: pinctrl@1001f000 {
 +		compatible = "mediatek,mt7986-pinctrl";
 +		reg = <0x1001f000 0x1000>,
 +		      <0x11c30000 0x1000>,
 +		      <0x11c40000 0x1000>,
 +		      <0x11e20000 0x1000>,
 +		      <0x11e30000 0x1000>,
 +		      <0x11f00000 0x1000>,
 +		      <0x11f10000 0x1000>,
 +		      <0x1000b000 0x1000>;
 +		reg-names = "gpio_base", "iocfg_rt_base", "iocfg_rb_base",
 +			    "iocfg_lt_base", "iocfg_lb_base", "iocfg_tr_base",
 +			    "iocfg_tl_base", "eint";
 +		gpio: gpio-controller {
 +			gpio-controller;
 +			#gpio-cells = <2>;
 +		};
 +	};
 +
 +	pwm: pwm@10048000 {
 +		compatible = "mediatek,mt7986-pwm";
 +		reg = <0x10048000 0x1000>;
 +		#clock-cells = <1>;
 +		#pwm-cells = <2>;
 +		interrupts = <GIC_SPI 137 IRQ_TYPE_LEVEL_HIGH>;
 +		clocks = <&infracfg CK_INFRA_PWM>,
 +			 <&infracfg_ao CK_INFRA_PWM_BSEL>,
 +			 <&infracfg_ao CK_INFRA_PWM1_CK>,
 +			 <&infracfg_ao CK_INFRA_PWM2_CK>;
 +		assigned-clocks = <&topckgen CK_TOP_PWM_SEL>,
 +				  <&infracfg CK_INFRA_PWM_BSEL>,
 +				  <&infracfg CK_INFRA_PWM1_SEL>,
 +				  <&infracfg CK_INFRA_PWM2_SEL>;
 +		assigned-clock-parents = <&topckgen CK_TOP_CB_M_D4>,
 +					 <&infracfg CK_INFRA_PWM>,
 +					 <&infracfg CK_INFRA_PWM>,
 +					 <&infracfg CK_INFRA_PWM>;
 +		clock-names = "top", "main", "pwm1", "pwm2";
 +		status = "disabled";
 +		u-boot,dm-pre-reloc;
 +	};
 +
 +	uart0: serial@11002000 {
 +		compatible = "mediatek,hsuart";
 +		reg = <0x11002000 0x400>;
 +		interrupts = <GIC_SPI 123 IRQ_TYPE_LEVEL_HIGH>;
 +		clocks = <&infracfg_ao CK_INFRA_UART0_CK>;
 +		assigned-clocks = <&topckgen CK_TOP_UART_SEL>,
 +				  <&infracfg_ao CK_INFRA_UART0_SEL>;
 +		assigned-clock-parents = <&topckgen CK_TOP_CB_CKSQ_40M>,
 +					 <&infracfg CK_INFRA_UART>;
 +		mediatek,force-highspeed;
 +		status = "disabled";
 +		u-boot,dm-pre-reloc;
 +	};
 +
 +	uart1: serial@11003000 {
 +		compatible = "mediatek,hsuart";
 +		reg = <0x11003000 0x400>;
 +		interrupts = <GIC_SPI 124 IRQ_TYPE_LEVEL_HIGH>;
 +		clocks = <&infracfg_ao CK_INFRA_UART1_CK>;
 +		assigned-clocks = <&infracfg CK_INFRA_UART1_SEL>;
 +		assigned-clock-parents = <&infracfg CK_INFRA_CK_F26M>;
 +		mediatek,force-highspeed;
 +		status = "disabled";
 +	};
 +
 +	uart2: serial@11004000 {
 +		compatible = "mediatek,hsuart";
 +		reg = <0x11004000 0x400>;
 +		interrupts = <GIC_SPI 124 IRQ_TYPE_LEVEL_HIGH>;
 +		clocks = <&infracfg_ao CK_INFRA_UART2_CK>;
 +		assigned-clocks = <&infracfg CK_INFRA_UART2_SEL>;
 +		assigned-clock-parents = <&infracfg CK_INFRA_CK_F26M>;
 +		mediatek,force-highspeed;
 +		status = "disabled";
 +	};
 +
 +	snand: snand@11005000 {
 +		compatible = "mediatek,mt7986-snand";
 +		reg = <0x11005000 0x1000>,
 +		      <0x11006000 0x1000>;
 +		reg-names = "nfi", "ecc";
 +		clocks = <&infracfg_ao CK_INFRA_SPINFI1_CK>,
 +			 <&infracfg_ao CK_INFRA_NFI1_CK>,
 +			 <&infracfg_ao CK_INFRA_NFI_HCK_CK>;
 +		clock-names = "pad_clk", "nfi_clk", "nfi_hclk";
 +		assigned-clocks = <&topckgen CK_TOP_SPINFI_SEL>,
 +				  <&topckgen CK_TOP_NFI1X_SEL>;
 +		assigned-clock-parents = <&topckgen CK_TOP_CB_M_D8>,
 +					 <&topckgen CK_TOP_CB_M_D8>;
 +		status = "disabled";
 +	};
 +
 +	ethsys: syscon@15000000 {
 +		compatible = "mediatek,mt7986-ethsys", "syscon";
 +		reg = <0x15000000 0x1000>;
 +		clock-parent = <&topckgen>;
 +		#clock-cells = <1>;
 +		#reset-cells = <1>;
 +	};
 +
 +	eth: ethernet@15100000 {
 +		compatible = "mediatek,mt7986-eth", "syscon";
 +		reg = <0x15100000 0x20000>;
 +		resets = <&ethsys ETHSYS_FE_RST>;
 +		reset-names = "fe";
 +		mediatek,ethsys = <&ethsys>;
 +		mediatek,sgmiisys = <&sgmiisys0>;
 +		#address-cells = <1>;
 +		#size-cells = <0>;
 +		status = "disabled";
 +	};
 +
 +	sgmiisys0: syscon@10060000 {
 +		compatible = "mediatek,mt7986-sgmiisys", "syscon";
 +		reg = <0x10060000 0x1000>;
 +		#clock-cells = <1>;
 +	};
 +
 +	sgmiisys1: syscon@10070000 {
 +		compatible = "mediatek,mt7986-sgmiisys", "syscon";
 +		reg = <0x10070000 0x1000>;
 +		#clock-cells = <1>;
 +	};
 +
 +	spi0: spi@1100a000 {
 +		compatible = "mediatek,ipm-spi";
 +		reg = <0x1100a000 0x100>;
 +		clocks = <&infracfg_ao CK_INFRA_SPI0_CK>,
 +			 <&topckgen CK_TOP_SPI_SEL>;
 +		assigned-clocks = <&topckgen CK_TOP_SPI_SEL>,
 +				  <&infracfg CK_INFRA_SPI0_SEL>;
 +		assigned-clock-parents = <&topckgen CK_TOP_CB_M_D2>,
 +					 <&topckgen CK_INFRA_ISPI0>;
 +		clock-names = "sel-clk", "spi-clk";
 +		interrupts = <GIC_SPI 140 IRQ_TYPE_LEVEL_HIGH>;
 +		status = "disabled";
 +	};
 +
 +	spi1: spi@1100b000 {
 +		compatible = "mediatek,ipm-spi";
 +		reg = <0x1100b000 0x100>;
 +		interrupts = <GIC_SPI 141 IRQ_TYPE_LEVEL_HIGH>;
 +		status = "disabled";
 +	};
 +
 +	mmc0: mmc@11230000 {
 +		compatible = "mediatek,mt7986-mmc";
 +		reg = <0x11230000 0x1000>,
 +		      <0x11C20000 0x1000>;
 +		interrupts = <GIC_SPI 143 IRQ_TYPE_LEVEL_HIGH>;
 +		clocks = <&topckgen CK_TOP_EMMC_416M>,
 +			<&topckgen CK_TOP_EMMC_250M>,
 +			<&infracfg_ao CK_INFRA_MSDC_CK>;
 +		assigned-clocks = <&topckgen CK_TOP_EMMC_416M_SEL>,
 +				  <&topckgen CK_TOP_EMMC_250M_SEL>;
 +		assigned-clock-parents = <&topckgen CK_TOP_CB_M_416M>,
 +					 <&topckgen CK_TOP_NET1_D5_D2>;
 +		clock-names = "source", "hclk", "source_cg";
 +		status = "disabled";
 +	};
 +
 +	xhci: xhci@11200000 {
 +		compatible = "mediatek,mt7986-xhci",
 +			     "mediatek,mtk-xhci";
 +		reg = <0x11200000 0x2e00>,
 +		      <0x11203e00 0x0100>;
 +		reg-names = "mac", "ippc";
 +		interrupts = <GIC_SPI 173 IRQ_TYPE_LEVEL_HIGH>;
 +		phys = <&u2port0 PHY_TYPE_USB2>,
 +		       <&u3port0 PHY_TYPE_USB3>,
 +		       <&u2port1 PHY_TYPE_USB2>;
 +		clocks = <&dummy_clk>,
 +			 <&dummy_clk>,
 +			 <&dummy_clk>,
 +			 <&dummy_clk>,
 +			 <&dummy_clk>;
 +		clock-names = "sys_ck",
 +			      "xhci_ck",
 +			      "ref_ck",
 +			      "mcu_ck",
 +			      "dma_ck";
 +		tpl-support;
 +		status = "okay";
 +	};
 +
 +	usbtphy: usb-phy@11e10000 {
 +		compatible = "mediatek,mt7986",
 +			     "mediatek,generic-tphy-v2";
 +		#address-cells = <1>;
 +		#size-cells = <1>;
 +		status = "okay";
 +
 +		u2port0: usb-phy@11e10000 {
 +			reg = <0x11e10000 0x700>;
 +			clocks = <&dummy_clk>;
 +			clock-names = "ref";
 +			#phy-cells = <1>;
 +			status = "okay";
 +		};
 +
 +		u3port0: usb-phy@11e10700 {
 +			reg = <0x11e10700 0x900>;
 +			clocks = <&dummy_clk>;
 +			clock-names = "ref";
 +			#phy-cells = <1>;
 +			status = "okay";
 +		};
 +
 +		u2port1: usb-phy@11e11000 {
 +			reg = <0x11e11000 0x700>;
 +			clocks = <&dummy_clk>;
 +			clock-names = "ref";
 +			#phy-cells = <1>;
 +			status = "okay";
 +		};
 +	};
 +};
 --- a/arch/arm/mach-mediatek/Kconfig
 +++ b/arch/arm/mach-mediatek/Kconfig
@@ -40,6 +40,14 @@ config TARGET_MT7629
 	  including DDR3, crypto engine, 3x3 11n/ac Wi-Fi, Gigabit Ethernet,
 	  switch, USB3.0, PCIe, UART, SPI, I2C and PWM.
 +config TARGET_MT7986
 +	bool "MediaTek MT7986 SoC"
 +	select ARM64
 +	help
 +	  The MediaTek MT7986 is a ARM64-based SoC with a quad-core Cortex-A53.
 +	  including UART, SPI, SPI flash, USB3.0, MMC, NAND, SNFI, PWM, PCIe,
 +	  Gigabit Ethernet, I2C, built-in 4x4 Wi-Fi, and PCIe.
 +
 config TARGET_MT8183
 	bool "MediaTek MT8183 SoC"
 	select ARM64
@@ -84,6 +92,7 @@ config SYS_BOARD
 	default "mt7622" if TARGET_MT7622
 	default "mt7623" if TARGET_MT7623
 	default "mt7629" if TARGET_MT7629
 +	default "mt7986" if TARGET_MT7986
 	default "mt8183" if TARGET_MT8183
 	default "mt8512" if TARGET_MT8512
 	default "mt8516" if TARGET_MT8516
@@ -99,6 +108,7 @@ config SYS_CONFIG_NAME
 	default "mt7622" if TARGET_MT7622
 	default "mt7623" if TARGET_MT7623
 	default "mt7629" if TARGET_MT7629
 +	default "mt7986" if TARGET_MT7986
 	default "mt8183" if TARGET_MT8183
 	default "mt8512" if TARGET_MT8512
 	default "mt8516" if TARGET_MT8516
@@ -113,6 +123,7 @@ config MTK_BROM_HEADER_INFO
 	string
 	default "media=nor" if TARGET_MT8518 || TARGET_MT8512 || TARGET_MT7629 || TARGET_MT7622
 	default "media=emmc" if TARGET_MT8516 || TARGET_MT8365 || TARGET_MT8183
 +	default "media=snand;nandinfo=2k+64" if TARGET_MT7986
 	default "lk=1" if TARGET_MT7623
 endif
 --- a/arch/arm/mach-mediatek/Makefile
 +++ b/arch/arm/mach-mediatek/Makefile
@@ -7,6 +7,7 @@ obj-$(CONFIG_MT8512) += mt8512/
 obj-$(CONFIG_TARGET_MT7622) += mt7622/
 obj-$(CONFIG_TARGET_MT7623) += mt7623/
 obj-$(CONFIG_TARGET_MT7629) += mt7629/
 +obj-$(CONFIG_TARGET_MT7986) += mt7986/
 obj-$(CONFIG_TARGET_MT8183) += mt8183/
 obj-$(CONFIG_TARGET_MT8516) += mt8516/
 obj-$(CONFIG_TARGET_MT8518) += mt8518/
 --- /dev/null
 +++ b/arch/arm/mach-mediatek/mt7986/Makefile
@@ -0,0 +1,4 @@
 +# SPDX-License-Identifier:	GPL-2.0
 +
 +obj-y += init.o
 +obj-y += lowlevel_init.o
 --- /dev/null
 +++ b/arch/arm/mach-mediatek/mt7986/init.c
@@ -0,0 +1,51 @@
 +// SPDX-License-Identifier: GPL-2.0
 +/*
 + * Copyright (C) 2022 MediaTek Inc.
 + * Author: Sam Shih <sam.shih@mediatek.com>
 + */
 +
 +#include <init.h>
 +#include <asm/armv8/mmu.h>
 +#include <asm/system.h>
 +#include <asm/global_data.h>
 +
 +DECLARE_GLOBAL_DATA_PTR;
 +
 +int print_cpuinfo(void)
 +{
 +	printf("CPU:   MediaTek MT7986\n");
 +	return 0;
 +}
 +
 +int dram_init(void)
 +{
 +	gd->ram_size = get_ram_size((void *)CONFIG_SYS_SDRAM_BASE, SZ_2G);
 +
 +	return 0;
 +}
 +
 +void reset_cpu(ulong addr)
 +{
 +	psci_system_reset();
 +}
 +
 +static struct mm_region mt7986_mem_map[] = {
 +	{
 +		/* DDR */
 +		.virt = 0x40000000UL,
 +		.phys = 0x40000000UL,
 +		.size = 0x80000000UL,
 +		.attrs = PTE_BLOCK_MEMTYPE(MT_NORMAL) | PTE_BLOCK_OUTER_SHARE,
 +	}, {
 +		.virt = 0x00000000UL,
 +		.phys = 0x00000000UL,
 +		.size = 0x40000000UL,
 +		.attrs = PTE_BLOCK_MEMTYPE(MT_DEVICE_NGNRNE) |
 +			 PTE_BLOCK_NON_SHARE |
 +			 PTE_BLOCK_PXN | PTE_BLOCK_UXN
 +	}, {
 +		0,
 +	}
 +};
 +
 +struct mm_region *mem_map = mt7986_mem_map;
 --- /dev/null
 +++ b/arch/arm/mach-mediatek/mt7986/lowlevel_init.S
@@ -0,0 +1,32 @@
 +/* SPDX-License-Identifier: GPL-2.0 */
 +/*
 + * Copyright (C) 2022 MediaTek Inc.
 + * Author: Sam Shih <sam.shih@mediatek.com>
 + */
 +
 +/*
 + * Switch from AArch64 EL2 to AArch32 EL2
 + * @param inputs:
 + * x0: argument, zero
 + * x1: machine nr
 + * x2: fdt address
 + * x3: input argument
 + * x4: kernel entry point
 + * @param outputs for secure firmware:
 + * x0: function id
 + * x1: kernel entry point
 + * x2: machine nr
 + * x3: fdt address
 + *
 + * [1] https://git.trustedfirmware.org/TF-A/trusted-firmware-a.git/tree/plat/mediatek/common/mtk_sip_svc.c
 +*/
 +
 +.global armv8_el2_to_aarch32
 +armv8_el2_to_aarch32:
 +	mov	x3, x2
 +	mov	x2, x1
 +	mov	x1, x4
 +	mov	x4, #0
 +	ldr	x0, =0x82000200	/* MTK_SIP_KERNEL_BOOT_AARCH32 */
 +	SMC	#0
 +	ret
--- a/package/boot/uboot-mediatek/patches/002-0002-arm-mediatek-add-support-for-MediaTek-MT7981-SoC.patch
+++ b/package/boot/uboot-mediatek/patches/002-0002-arm-mediatek-add-support-for-MediaTek-MT7981-SoC.patch
@@ -0,0 +1,462 @@
 From 38faebb811868f9e6734dea7894d0fa5a61f3a22 Mon Sep 17 00:00:00 2001
 From: Weijie Gao <weijie.gao@mediatek.com>
 Date: Fri, 29 Jul 2022 15:58:11 +0800
 Subject: [PATCH 02/31] arm: mediatek: add support for MediaTek MT7981 SoC
 This patch adds basic support for MediaTek MT7981 SoC.
 This include the file that will initialize the SoC after boot and its
 device tree.
 Signed-off-by: Weijie Gao <weijie.gao@mediatek.com>
 ---
 arch/arm/dts/mt7981.dtsi                      | 288 ++++++++++++++++++
 arch/arm/mach-mediatek/Kconfig                |  12 +-
 arch/arm/mach-mediatek/Makefile               |   1 +
 arch/arm/mach-mediatek/mt7981/Makefile        |   4 +
 arch/arm/mach-mediatek/mt7981/init.c          |  51 ++++
 arch/arm/mach-mediatek/mt7981/lowlevel_init.S |  32 ++
 6 files changed, 387 insertions(+), 1 deletion(-)
 create mode 100644 arch/arm/dts/mt7981.dtsi
 create mode 100644 arch/arm/mach-mediatek/mt7981/Makefile
 create mode 100644 arch/arm/mach-mediatek/mt7981/init.c
 create mode 100644 arch/arm/mach-mediatek/mt7981/lowlevel_init.S
 --- /dev/null
 +++ b/arch/arm/dts/mt7981.dtsi
@@ -0,0 +1,288 @@
 +// SPDX-License-Identifier: GPL-2.0
 +/*
 + * Copyright (c) 2022 MediaTek Inc.
 + * Author: Sam Shih <sam.shih@mediatek.com>
 + */
 +
 +#include <dt-bindings/interrupt-controller/irq.h>
 +#include <dt-bindings/interrupt-controller/arm-gic.h>
 +#include <dt-bindings/clock/mt7981-clk.h>
 +#include <dt-bindings/reset/mt7629-reset.h>
 +#include <dt-bindings/pinctrl/mt65xx.h>
 +
 +/ {
 +	compatible = "mediatek,mt7981";
 +	interrupt-parent = <&gic>;
 +	#address-cells = <1>;
 +	#size-cells = <1>;
 +	cpus {
 +		#address-cells = <1>;
 +		#size-cells = <0>;
 +		cpu0: cpu@0 {
 +			device_type = "cpu";
 +			compatible = "arm,cortex-a53";
 +			reg = <0x0>;
 +		};
 +		cpu1: cpu@1 {
 +			device_type = "cpu";
 +			compatible = "arm,cortex-a53";
 +			reg = <0x1>;
 +		};
 +	};
 +
 +	gpt_clk: gpt_dummy20m {
 +		compatible = "fixed-clock";
 +		clock-frequency = <13000000>;
 +		#clock-cells = <0>;
 +		u-boot,dm-pre-reloc;
 +	};
 +
 +	timer {
 +		compatible = "arm,armv8-timer";
 +		interrupt-parent = <&gic>;
 +		clock-frequency = <13000000>;
 +		interrupts = <GIC_PPI 13 IRQ_TYPE_LEVEL_LOW>,
 +			     <GIC_PPI 14 IRQ_TYPE_LEVEL_LOW>,
 +			     <GIC_PPI 11 IRQ_TYPE_LEVEL_LOW>,
 +			     <GIC_PPI 10 IRQ_TYPE_LEVEL_LOW>;
 +		arm,cpu-registers-not-fw-configured;
 +	};
 +
 +	timer0: timer@10008000 {
 +		compatible = "mediatek,mt7986-timer";
 +		reg = <0x10008000 0x1000>;
 +		interrupts = <GIC_SPI 130 IRQ_TYPE_LEVEL_HIGH>;
 +		clocks = <&gpt_clk>;
 +		clock-names = "gpt-clk";
 +		u-boot,dm-pre-reloc;
 +	};
 +
 +	watchdog: watchdog@1001c000 {
 +		compatible = "mediatek,mt7986-wdt";
 +		reg = <0x1001c000 0x1000>;
 +		interrupts = <GIC_SPI 110 IRQ_TYPE_LEVEL_HIGH>;
 +		#reset-cells = <1>;
 +		status = "disabled";
 +	};
 +
 +	gic: interrupt-controller@c000000 {
 +		compatible = "arm,gic-v3";
 +		#interrupt-cells = <3>;
 +		interrupt-parent = <&gic>;
 +		interrupt-controller;
 +		reg = <0x0c000000 0x40000>,  /* GICD */
 +		      <0x0c080000 0x200000>; /* GICR */
 +
 +		interrupts = <GIC_PPI 9 IRQ_TYPE_LEVEL_HIGH>;
 +	};
 +
 +	fixed_plls: apmixedsys@1001e000 {
 +		compatible = "mediatek,mt7981-fixed-plls";
 +		reg = <0x1001e000 0x1000>;
 +		#clock-cells = <1>;
 +		u-boot,dm-pre-reloc;
 +	};
 +
 +	topckgen: topckgen@1001b000 {
 +		compatible = "mediatek,mt7981-topckgen";
 +		reg = <0x1001b000 0x1000>;
 +		clock-parent = <&fixed_plls>;
 +		#clock-cells = <1>;
 +		u-boot,dm-pre-reloc;
 +	};
 +
 +	infracfg_ao: infracfg_ao@10001000 {
 +		compatible = "mediatek,mt7981-infracfg_ao";
 +		reg = <0x10001000 0x80>;
 +		clock-parent = <&infracfg>;
 +		#clock-cells = <1>;
 +		u-boot,dm-pre-reloc;
 +	};
 +
 +	infracfg: infracfg@10001000 {
 +		compatible = "mediatek,mt7981-infracfg";
 +		reg = <0x10001000 0x30>;
 +		clock-parent = <&topckgen>;
 +		#clock-cells = <1>;
 +		u-boot,dm-pre-reloc;
 +	};
 +
 +	pinctrl: pinctrl@11d00000 {
 +		compatible = "mediatek,mt7981-pinctrl";
 +		reg = <0x11d00000 0x1000>,
 +		      <0x11c00000 0x1000>,
 +		      <0x11c10000 0x1000>,
 +		      <0x11d20000 0x1000>,
 +		      <0x11e00000 0x1000>,
 +		      <0x11e20000 0x1000>,
 +		      <0x11f00000 0x1000>,
 +		      <0x11f10000 0x1000>,
 +		      <0x1000b000 0x1000>;
 +		reg-names = "gpio_base", "iocfg_rt_base", "iocfg_rm_base",
 +			    "iocfg_rb_base", "iocfg_lb_base", "iocfg_bl_base",
 +			    "iocfg_tm_base", "iocfg_tl_base", "eint";
 +		gpio: gpio-controller {
 +			gpio-controller;
 +			#gpio-cells = <2>;
 +		};
 +	};
 +
 +	pwm: pwm@10048000 {
 +		compatible = "mediatek,mt7981-pwm";
 +		reg = <0x10048000 0x1000>;
 +		#clock-cells = <1>;
 +		#pwm-cells = <2>;
 +		interrupts = <GIC_SPI 137 IRQ_TYPE_LEVEL_HIGH>;
 +		clocks = <&infracfg CK_INFRA_PWM>,
 +			 <&infracfg_ao CK_INFRA_PWM_BSEL>,
 +			 <&infracfg_ao CK_INFRA_PWM1_CK>,
 +			 <&infracfg_ao CK_INFRA_PWM2_CK>,
 +			 /* FIXME */
 +			 <&infracfg_ao CK_INFRA_PWM2_CK>;
 +		assigned-clocks = <&topckgen CK_TOP_PWM_SEL>;
 +		assigned-clock-parents = <&topckgen CK_TOP_CB_CKSQ_40M>;
 +		clock-names = "top", "main", "pwm1", "pwm2", "pwm3";
 +		status = "disabled";
 +	};
 +
 +	uart0: serial@11002000 {
 +		compatible = "mediatek,hsuart";
 +		reg = <0x11002000 0x400>;
 +		interrupts = <GIC_SPI 123 IRQ_TYPE_LEVEL_HIGH>;
 +		clocks = <&infracfg_ao CK_INFRA_UART0_CK>;
 +		assigned-clocks = <&topckgen CK_TOP_UART_SEL>,
 +				  <&infracfg_ao CK_INFRA_UART0_SEL>;
 +		assigned-clock-parents = <&topckgen CK_TOP_CB_CKSQ_40M>,
 +					 <&infracfg CK_INFRA_UART>;
 +		mediatek,force-highspeed;
 +		status = "disabled";
 +		u-boot,dm-pre-reloc;
 +	};
 +
 +	uart1: serial@11003000 {
 +		compatible = "mediatek,hsuart";
 +		reg = <0x11003000 0x400>;
 +		interrupts = <GIC_SPI 124 IRQ_TYPE_LEVEL_HIGH>;
 +		clocks = <&infracfg_ao CK_INFRA_UART1_CK>;
 +		assigned-clocks = <&topckgen CK_TOP_UART_SEL>,
 +				  <&infracfg_ao CK_INFRA_UART1_SEL>;
 +		assigned-clock-parents = <&topckgen CK_TOP_CB_CKSQ_40M>,
 +					 <&infracfg CK_INFRA_UART>;
 +		mediatek,force-highspeed;
 +		status = "disabled";
 +	};
 +
 +	uart2: serial@11004000 {
 +		compatible = "mediatek,hsuart";
 +		reg = <0x11004000 0x400>;
 +		interrupts = <GIC_SPI 124 IRQ_TYPE_LEVEL_HIGH>;
 +		clocks = <&infracfg_ao CK_INFRA_UART2_CK>;
 +		assigned-clocks = <&topckgen CK_TOP_UART_SEL>,
 +				  <&infracfg_ao CK_INFRA_UART2_SEL>;
 +		assigned-clock-parents = <&topckgen CK_TOP_CB_CKSQ_40M>,
 +					 <&infracfg CK_INFRA_UART>;
 +		mediatek,force-highspeed;
 +		status = "disabled";
 +	};
 +
 +	snand: snand@11005000 {
 +		compatible = "mediatek,mt7986-snand";
 +		reg = <0x11005000 0x1000>,
 +		      <0x11006000 0x1000>;
 +		reg-names = "nfi", "ecc";
 +		clocks = <&infracfg_ao CK_INFRA_SPINFI1_CK>,
 +			 <&infracfg_ao CK_INFRA_NFI1_CK>,
 +			 <&infracfg_ao CK_INFRA_NFI_HCK_CK>;
 +		clock-names = "pad_clk", "nfi_clk", "nfi_hclk";
 +		assigned-clocks = <&topckgen CK_TOP_SPINFI_SEL>,
 +				  <&topckgen CK_TOP_NFI1X_SEL>;
 +		assigned-clock-parents = <&topckgen CK_TOP_CB_M_D8>,
 +					 <&topckgen CK_TOP_CB_M_D8>;
 +		status = "disabled";
 +	};
 +
 +	ethsys: syscon@15000000 {
 +		compatible = "mediatek,mt7981-ethsys", "syscon";
 +		reg = <0x15000000 0x1000>;
 +		clock-parent = <&topckgen>;
 +		#clock-cells = <1>;
 +		#reset-cells = <1>;
 +	};
 +
 +	eth: ethernet@15100000 {
 +		compatible = "mediatek,mt7981-eth", "syscon";
 +		reg = <0x15100000 0x20000>;
 +		resets = <&ethsys ETHSYS_FE_RST>;
 +		reset-names = "fe";
 +		mediatek,ethsys = <&ethsys>;
 +		mediatek,sgmiisys = <&sgmiisys0>;
 +		#address-cells = <1>;
 +		#size-cells = <0>;
 +		status = "disabled";
 +	};
 +
 +	sgmiisys0: syscon@10060000 {
 +		compatible = "mediatek,mt7986-sgmiisys", "syscon";
 +		reg = <0x10060000 0x1000>;
 +		pn_swap;
 +		#clock-cells = <1>;
 +	};
 +
 +	sgmiisys1: syscon@10070000 {
 +		compatible = "mediatek,mt7986-sgmiisys", "syscon";
 +		reg = <0x10070000 0x1000>;
 +		#clock-cells = <1>;
 +	};
 +
 +	spi0: spi@1100a000 {
 +		compatible = "mediatek,ipm-spi";
 +		reg = <0x1100a000 0x100>;
 +		clocks = <&infracfg_ao CK_INFRA_SPI0_CK>,
 +			 <&topckgen CK_TOP_SPI_SEL>;
 +		assigned-clocks = <&topckgen CK_TOP_SPI_SEL>,
 +				  <&infracfg CK_INFRA_SPI0_SEL>;
 +		assigned-clock-parents = <&topckgen CK_TOP_CB_M_D2>,
 +					 <&topckgen CK_INFRA_ISPI0>;
 +		clock-names = "sel-clk", "spi-clk";
 +		interrupts = <GIC_SPI 140 IRQ_TYPE_LEVEL_HIGH>;
 +		status = "disabled";
 +	};
 +
 +	spi1: spi@1100b000 {
 +		compatible = "mediatek,ipm-spi";
 +		reg = <0x1100b000 0x100>;
 +		interrupts = <GIC_SPI 141 IRQ_TYPE_LEVEL_HIGH>;
 +		status = "disabled";
 +	};
 +
 +	spi2: spi@11009000 {
 +		compatible = "mediatek,ipm-spi";
 +		reg = <0x11009000 0x100>;
 +		clocks = <&infracfg_ao CK_INFRA_SPI0_CK>,
 +			 <&topckgen CK_TOP_SPI_SEL>;
 +		assigned-clocks = <&topckgen CK_TOP_SPI_SEL>,
 +				  <&infracfg CK_INFRA_SPI0_SEL>;
 +		assigned-clock-parents = <&topckgen CK_TOP_CB_M_D2>,
 +					 <&topckgen CK_INFRA_ISPI0>;
 +		clock-names = "sel-clk", "spi-clk";
 +		interrupts = <GIC_SPI 142 IRQ_TYPE_LEVEL_HIGH>;
 +		status = "disabled";
 +	};
 +
 +	mmc0: mmc@11230000 {
 +		compatible = "mediatek,mt7981-mmc";
 +		reg = <0x11230000 0x1000>,
 +		      <0x11C20000 0x1000>;
 +		interrupts = <GIC_SPI 143 IRQ_TYPE_LEVEL_HIGH>;
 +		clocks = <&topckgen CK_TOP_EMMC_400M>,
 +			 <&topckgen CK_TOP_EMMC_208M>,
 +			 <&infracfg_ao CK_INFRA_MSDC_CK>;
 +		assigned-clocks = <&topckgen CK_TOP_EMMC_400M_SEL>,
 +				  <&topckgen CK_TOP_EMMC_208M_SEL>;
 +		assigned-clock-parents = <&topckgen CK_TOP_CB_NET2_D2>,
 +					 <&topckgen CK_TOP_CB_M_D2>;
 +		clock-names = "source", "hclk", "source_cg";
 +		status = "disabled";
 +	};
 +
 +};
 --- a/arch/arm/mach-mediatek/Kconfig
 +++ b/arch/arm/mach-mediatek/Kconfig
@@ -40,6 +40,14 @@ config TARGET_MT7629
 	  including DDR3, crypto engine, 3x3 11n/ac Wi-Fi, Gigabit Ethernet,
 	  switch, USB3.0, PCIe, UART, SPI, I2C and PWM.
 +config TARGET_MT7981
 +	bool "MediaTek MT7981 SoC"
 +	select ARM64
 +	help
 +	  The MediaTek MT7981 is a ARM64-based SoC with a dual-core Cortex-A53.
 +	  including UART, SPI, USB, NAND, SNFI, PWM, Gigabit Ethernet, I2C,
 +          built-in Wi-Fi, and PCIe.
 +
 config TARGET_MT7986
 	bool "MediaTek MT7986 SoC"
 	select ARM64
@@ -92,6 +100,7 @@ config SYS_BOARD
 	default "mt7622" if TARGET_MT7622
 	default "mt7623" if TARGET_MT7623
 	default "mt7629" if TARGET_MT7629
 +	default "mt7981" if TARGET_MT7981
 	default "mt7986" if TARGET_MT7986
 	default "mt8183" if TARGET_MT8183
 	default "mt8512" if TARGET_MT8512
@@ -108,6 +117,7 @@ config SYS_CONFIG_NAME
 	default "mt7622" if TARGET_MT7622
 	default "mt7623" if TARGET_MT7623
 	default "mt7629" if TARGET_MT7629
 +	default "mt7981" if TARGET_MT7981
 	default "mt7986" if TARGET_MT7986
 	default "mt8183" if TARGET_MT8183
 	default "mt8512" if TARGET_MT8512
@@ -123,7 +133,7 @@ config MTK_BROM_HEADER_INFO
 	string
 	default "media=nor" if TARGET_MT8518 || TARGET_MT8512 || TARGET_MT7629 || TARGET_MT7622
 	default "media=emmc" if TARGET_MT8516 || TARGET_MT8365 || TARGET_MT8183
 -	default "media=snand;nandinfo=2k+64" if TARGET_MT7986
 +	default "media=snand;nandinfo=2k+64" if TARGET_MT7981 || TARGET_MT7986
 	default "lk=1" if TARGET_MT7623
 endif
 --- a/arch/arm/mach-mediatek/Makefile
 +++ b/arch/arm/mach-mediatek/Makefile
@@ -7,6 +7,7 @@ obj-$(CONFIG_MT8512) += mt8512/
 obj-$(CONFIG_TARGET_MT7622) += mt7622/
 obj-$(CONFIG_TARGET_MT7623) += mt7623/
 obj-$(CONFIG_TARGET_MT7629) += mt7629/
 +obj-$(CONFIG_TARGET_MT7981) += mt7981/
 obj-$(CONFIG_TARGET_MT7986) += mt7986/
 obj-$(CONFIG_TARGET_MT8183) += mt8183/
 obj-$(CONFIG_TARGET_MT8516) += mt8516/
 --- /dev/null
 +++ b/arch/arm/mach-mediatek/mt7981/Makefile
@@ -0,0 +1,4 @@
 +# SPDX-License-Identifier:	GPL-2.0
 +
 +obj-y += init.o
 +obj-y += lowlevel_init.o
 --- /dev/null
 +++ b/arch/arm/mach-mediatek/mt7981/init.c
@@ -0,0 +1,51 @@
 +// SPDX-License-Identifier: GPL-2.0
 +/*
 + * Copyright (C) 2022 MediaTek Inc.
 + * Author: Sam Shih <sam.shih@mediatek.com>
 + */
 +
 +#include <init.h>
 +#include <asm/armv8/mmu.h>
 +#include <asm/system.h>
 +#include <asm/global_data.h>
 +
 +DECLARE_GLOBAL_DATA_PTR;
 +
 +int print_cpuinfo(void)
 +{
 +	printf("CPU:   MediaTek MT7981\n");
 +	return 0;
 +}
 +
 +int dram_init(void)
 +{
 +	gd->ram_size = get_ram_size((void *)CONFIG_SYS_SDRAM_BASE, SZ_2G);
 +
 +	return 0;
 +}
 +
 +void reset_cpu(ulong addr)
 +{
 +	psci_system_reset();
 +}
 +
 +static struct mm_region mt7981_mem_map[] = {
 +	{
 +		/* DDR */
 +		.virt = 0x40000000UL,
 +		.phys = 0x40000000UL,
 +		.size = 0x80000000UL,
 +		.attrs = PTE_BLOCK_MEMTYPE(MT_NORMAL) | PTE_BLOCK_OUTER_SHARE,
 +	}, {
 +		.virt = 0x00000000UL,
 +		.phys = 0x00000000UL,
 +		.size = 0x40000000UL,
 +		.attrs = PTE_BLOCK_MEMTYPE(MT_DEVICE_NGNRNE) |
 +			 PTE_BLOCK_NON_SHARE |
 +			 PTE_BLOCK_PXN | PTE_BLOCK_UXN
 +	}, {
 +		0,
 +	}
 +};
 +
 +struct mm_region *mem_map = mt7981_mem_map;
 --- /dev/null
 +++ b/arch/arm/mach-mediatek/mt7981/lowlevel_init.S
@@ -0,0 +1,32 @@
 +/* SPDX-License-Identifier: GPL-2.0 */
 +/*
 + * Copyright (C) 2022 MediaTek Inc.
 + * Author: Sam Shih <sam.shih@mediatek.com>
 + */
 +
 +/*
 + * Switch from AArch64 EL2 to AArch32 EL2
 + * @param inputs:
 + * x0: argument, zero
 + * x1: machine nr
 + * x2: fdt address
 + * x3: input argument
 + * x4: kernel entry point
 + * @param outputs for secure firmware:
 + * x0: function id
 + * x1: kernel entry point
 + * x2: machine nr
 + * x3: fdt address
 + *
 + * [1] https://git.trustedfirmware.org/TF-A/trusted-firmware-a.git/tree/plat/mediatek/common/mtk_sip_svc.c
 +*/
 +
 +.global armv8_el2_to_aarch32
 +armv8_el2_to_aarch32:
 +	mov	x3, x2
 +	mov	x2, x1
 +	mov	x1, x4
 +	mov	x4, #0
 +	ldr	x0, =0x82000200	/* MTK_SIP_KERNEL_BOOT_AARCH32 */
 +	SMC	#0
 +	ret
--- a/package/boot/uboot-mediatek/patches/002-0003-board-mediatek-add-MT7986-reference-boards.patch
+++ b/package/boot/uboot-mediatek/patches/002-0003-board-mediatek-add-MT7986-reference-boards.patch
--- a/package/boot/uboot-mediatek/patches/002-0004-board-mediatek-add-MT7981-reference-boards.patch
+++ b/package/boot/uboot-mediatek/patches/002-0004-board-mediatek-add-MT7981-reference-boards.patch
@@ -0,0 +1,779 @@
 From 89a31bfa05c384a2b4e56ddb9814633325b7feab Mon Sep 17 00:00:00 2001
 From: Weijie Gao <weijie.gao@mediatek.com>
 Date: Fri, 29 Jul 2022 16:02:37 +0800
 Subject: [PATCH 04/31] board: mediatek: add MT7981 reference boards
 This patch adds general board files based on MT7981 SoCs.
 MT7981 uses one mmc controller for booting from both SD and eMMC, and the
 pins of mmc controller are also shared with spi controller.
 So three configs are need for these boot types:
 1. mt7981_rfb_defconfig - SPI-NOR and SPI-NAND
 2. mt7981_emmc_rfb_defconfig - eMMC only
 3. mt7981_sd_rfb_defconfig - SD only
 Signed-off-by: Weijie Gao <weijie.gao@mediatek.com>
 ---
 arch/arm/dts/Makefile              |   3 +
 arch/arm/dts/mt7981-emmc-rfb.dts   | 139 +++++++++++++++++++++++
 arch/arm/dts/mt7981-rfb.dts        | 173 +++++++++++++++++++++++++++++
 arch/arm/dts/mt7981-sd-rfb.dts     | 139 +++++++++++++++++++++++
 board/mediatek/mt7981/MAINTAINERS  |  10 ++
 board/mediatek/mt7981/Makefile     |   3 +
 board/mediatek/mt7981/mt7981_rfb.c |  10 ++
 configs/mt7981_emmc_rfb_defconfig  |  64 +++++++++++
 configs/mt7981_rfb_defconfig       |  69 ++++++++++++
 configs/mt7981_sd_rfb_defconfig    |  64 +++++++++++
 include/configs/mt7981.h           |  26 +++++
 11 files changed, 700 insertions(+)
 create mode 100644 arch/arm/dts/mt7981-emmc-rfb.dts
 create mode 100644 arch/arm/dts/mt7981-rfb.dts
 create mode 100644 arch/arm/dts/mt7981-sd-rfb.dts
 create mode 100644 board/mediatek/mt7981/MAINTAINERS
 create mode 100644 board/mediatek/mt7981/Makefile
 create mode 100644 board/mediatek/mt7981/mt7981_rfb.c
 create mode 100644 configs/mt7981_emmc_rfb_defconfig
 create mode 100644 configs/mt7981_rfb_defconfig
 create mode 100644 configs/mt7981_sd_rfb_defconfig
 create mode 100644 include/configs/mt7981.h
 --- a/arch/arm/dts/Makefile
 +++ b/arch/arm/dts/Makefile
@@ -1205,6 +1205,9 @@ dtb-$(CONFIG_ARCH_MEDIATEK) += \
 	mt7622-bananapi-bpi-r64.dtb \
 	mt7623n-bananapi-bpi-r2.dtb \
 	mt7629-rfb.dtb \
 +	mt7981-rfb.dtb \
 +	mt7981-emmc-rfb.dtb \
 +	mt7981-sd-rfb.dtb \
 	mt7986a-rfb.dtb \
 	mt7986b-rfb.dtb \
 	mt7986a-sd-rfb.dtb \
 --- /dev/null
 +++ b/arch/arm/dts/mt7981-emmc-rfb.dts
@@ -0,0 +1,139 @@
 +// SPDX-License-Identifier: GPL-2.0
 +/*
 + * Copyright (c) 2022 MediaTek Inc.
 + * Author: Sam Shih <sam.shih@mediatek.com>
 + */
 +
 +/dts-v1/;
 +#include "mt7981.dtsi"
 +#include <dt-bindings/gpio/gpio.h>
 +
 +/ {
 +	#address-cells = <1>;
 +	#size-cells = <1>;
 +	model = "mt7981-rfb";
 +	compatible = "mediatek,mt7981", "mediatek,mt7981-rfb";
 +	chosen {
 +		stdout-path = &uart0;
 +		tick-timer = &timer0;
 +	};
 +
 +	reg_3p3v: regulator-3p3v {
 +		  compatible = "regulator-fixed";
 +		  regulator-name = "fixed-3.3V";
 +		  regulator-min-microvolt = <3300000>;
 +		  regulator-max-microvolt = <3300000>;
 +		  regulator-boot-on;
 +		  regulator-always-on;
 +	};
 +};
 +
 +&uart0 {
 +	status = "okay";
 +};
 +
 +&uart1 {
 +	pinctrl-names = "default";
 +	pinctrl-0 = <&uart1_pins>;
 +	status = "disabled";
 +};
 +
 +&eth {
 +	status = "okay";
 +	mediatek,gmac-id = <0>;
 +	phy-mode = "sgmii";
 +	mediatek,switch = "mt7531";
 +	reset-gpios = <&gpio 39 GPIO_ACTIVE_HIGH>;
 +
 +	fixed-link {
 +		speed = <1000>;
 +		full-duplex;
 +	};
 +};
 +
 +&pinctrl {
 +	spic_pins: spi1-pins-func-1 {
 +		mux {
 +			function = "spi";
 +			groups = "spi1_1";
 +		};
 +	};
 +
 +	uart1_pins: spi1-pins-func-3 {
 +		mux {
 +			function = "uart";
 +			groups = "uart1_2";
 +		};
 +	};
 +
 +	/* pin15 as pwm0 */
 +	one_pwm_pins: one-pwm-pins {
 +		mux {
 +			function = "pwm";
 +			groups = "pwm0_1";
 +		};
 +	};
 +
 +	/* pin15 as pwm0 and pin14 as pwm1 */
 +	two_pwm_pins: two-pwm-pins {
 +		mux {
 +			function = "pwm";
 +			groups = "pwm0_1", "pwm1_0";
 +		};
 +	};
 +
 +	/* pin15 as pwm0, pin14 as pwm1, pin7 as pwm2 */
 +	three_pwm_pins: three-pwm-pins {
 +		mux {
 +			function = "pwm";
 +			groups = "pwm0_1", "pwm1_0", "pwm2";
 +		};
 +	};
 +
 +	mmc0_pins_default: mmc0default {
 +		mux {
 +			function = "flash";
 +			groups =  "emmc_45";
 +		};
 +		conf-cmd-dat {
 +			pins = "SPI0_CLK", "SPI0_MOSI", "SPI0_MISO",
 +				"SPI0_CS",  "SPI0_HOLD", "SPI0_WP",
 +				"SPI1_CLK", "SPI1_MOSI", "SPI1_MISO";
 +			input-enable;
 +			drive-strength = <MTK_DRIVE_4mA>;
 +			bias-pull-up = <MTK_PUPD_SET_R1R0_01>;
 +		};
 +		conf-clk {
 +			pins = "SPI1_CS";
 +			drive-strength = <MTK_DRIVE_6mA>;
 +			bias-pull-down = <MTK_PUPD_SET_R1R0_10>;
 +		};
 +		conf-rst {
 +			pins = "PWM0";
 +			drive-strength = <MTK_DRIVE_4mA>;
 +			bias-pull-up = <MTK_PUPD_SET_R1R0_01>;
 +		};
 +	};
 +};
 +
 +&pwm {
 +	pinctrl-names = "default";
 +	pinctrl-0 = <&two_pwm_pins>;
 +	status = "okay";
 +};
 +
 +&watchdog {
 +	status = "disabled";
 +};
 +
 +&mmc0 {
 +	pinctrl-names = "default";
 +	pinctrl-0 = <&mmc0_pins_default>;
 +	bus-width = <8>;
 +	max-frequency = <52000000>;
 +	cap-mmc-highspeed;
 +	cap-mmc-hw-reset;
 +	vmmc-supply = <&reg_3p3v>;
 +	non-removable;
 +	status = "okay";
 +};
 --- /dev/null
 +++ b/arch/arm/dts/mt7981-rfb.dts
@@ -0,0 +1,173 @@
 +// SPDX-License-Identifier: GPL-2.0
 +/*
 + * Copyright (c) 2022 MediaTek Inc.
 + * Author: Sam Shih <sam.shih@mediatek.com>
 + */
 +
 +/dts-v1/;
 +#include "mt7981.dtsi"
 +#include <dt-bindings/gpio/gpio.h>
 +
 +/ {
 +	#address-cells = <1>;
 +	#size-cells = <1>;
 +	model = "mt7981-rfb";
 +	compatible = "mediatek,mt7981", "mediatek,mt7981-rfb";
 +	chosen {
 +		stdout-path = &uart0;
 +		tick-timer = &timer0;
 +	};
 +};
 +
 +&uart0 {
 +	status = "okay";
 +};
 +
 +&uart1 {
 +	pinctrl-names = "default";
 +	pinctrl-0 = <&uart1_pins>;
 +	status = "disabled";
 +};
 +
 +&eth {
 +	status = "okay";
 +	mediatek,gmac-id = <0>;
 +	phy-mode = "sgmii";
 +	mediatek,switch = "mt7531";
 +	reset-gpios = <&gpio 39 GPIO_ACTIVE_HIGH>;
 +
 +	fixed-link {
 +		speed = <1000>;
 +		full-duplex;
 +	};
 +};
 +
 +&pinctrl {
 +	spi_flash_pins: spi0-pins-func-1 {
 +		mux {
 +			function = "flash";
 +			groups = "spi0", "spi0_wp_hold";
 +		};
 +
 +		conf-pu {
 +			pins = "SPI0_CS", "SPI0_HOLD", "SPI0_WP";
 +			drive-strength = <MTK_DRIVE_8mA>;
 +			bias-pull-up = <MTK_PUPD_SET_R1R0_11>;
 +		};
 +
 +		conf-pd {
 +			pins = "SPI0_CLK", "SPI0_MOSI", "SPI0_MISO";
 +			drive-strength = <MTK_DRIVE_8mA>;
 +			bias-pull-down = <MTK_PUPD_SET_R1R0_11>;
 +		};
 +	};
 +
 +	spi2_flash_pins: spi2-spi2-pins {
 +		mux {
 +			function = "spi";
 +			groups = "spi2", "spi2_wp_hold";
 +		};
 +
 +		conf-pu {
 +			pins = "SPI2_CS", "SPI2_HOLD", "SPI2_WP";
 +			drive-strength = <MTK_DRIVE_8mA>;
 +			bias-pull-down = <MTK_PUPD_SET_R1R0_00>;
 +		};
 +
 +		conf-pd {
 +			pins = "SPI2_CLK", "SPI2_MOSI", "SPI2_MISO";
 +			drive-strength = <MTK_DRIVE_8mA>;
 +			bias-pull-down = <MTK_PUPD_SET_R1R0_00>;
 +		};
 +	};
 +
 +	spic_pins: spi1-pins-func-1 {
 +		mux {
 +			function = "spi";
 +			groups = "spi1_1";
 +		};
 +	};
 +
 +	uart1_pins: spi1-pins-func-3 {
 +		mux {
 +			function = "uart";
 +			groups = "uart1_2";
 +		};
 +	};
 +
 +	/* pin15 as pwm0 */
 +	one_pwm_pins: one-pwm-pins {
 +		mux {
 +			function = "pwm";
 +			groups = "pwm0_1";
 +		};
 +	};
 +
 +	/* pin15 as pwm0 and pin14 as pwm1 */
 +	two_pwm_pins: two-pwm-pins {
 +		mux {
 +			function = "pwm";
 +			groups = "pwm0_1", "pwm1_0";
 +		};
 +	};
 +
 +	/* pin15 as pwm0, pin14 as pwm1, pin7 as pwm2 */
 +	three_pwm_pins: three-pwm-pins {
 +		mux {
 +			function = "pwm";
 +			groups = "pwm0_1", "pwm1_0", "pwm2";
 +		};
 +	};
 +};
 +
 +&spi0 {
 +	#address-cells = <1>;
 +	#size-cells = <0>;
 +	pinctrl-names = "default";
 +	pinctrl-0 = <&spi_flash_pins>;
 +	status = "okay";
 +	must_tx;
 +	enhance_timing;
 +	dma_ext;
 +	ipm_design;
 +	support_quad;
 +	tick_dly = <2>;
 +	sample_sel = <0>;
 +
 +	spi_nand@0 {
 +		compatible = "spi-nand";
 +		reg = <0>;
 +		spi-max-frequency = <52000000>;
 +	};
 +};
 +
 +&spi2 {
 +	#address-cells = <1>;
 +	#size-cells = <0>;
 +	pinctrl-names = "default";
 +	pinctrl-0 = <&spi2_flash_pins>;
 +	status = "okay";
 +	must_tx;
 +	enhance_timing;
 +	dma_ext;
 +	ipm_design;
 +	support_quad;
 +	tick_dly = <2>;
 +	sample_sel = <0>;
 +
 +	spi_nor@0 {
 +		compatible = "jedec,spi-nor";
 +		reg = <0>;
 +		spi-max-frequency = <52000000>;
 +	};
 +};
 +
 +&pwm {
 +	pinctrl-names = "default";
 +	pinctrl-0 = <&two_pwm_pins>;
 +	status = "okay";
 +};
 +
 +&watchdog {
 +	status = "disabled";
 +};
 --- /dev/null
 +++ b/arch/arm/dts/mt7981-sd-rfb.dts
@@ -0,0 +1,139 @@
 +// SPDX-License-Identifier: GPL-2.0
 +/*
 + * Copyright (c) 2022 MediaTek Inc.
 + * Author: Sam Shih <sam.shih@mediatek.com>
 + */
 +
 +/dts-v1/;
 +#include "mt7981.dtsi"
 +#include <dt-bindings/gpio/gpio.h>
 +
 +/ {
 +	#address-cells = <1>;
 +	#size-cells = <1>;
 +	model = "mt7981-rfb";
 +	compatible = "mediatek,mt7981", "mediatek,mt7981-sd-rfb";
 +	chosen {
 +		stdout-path = &uart0;
 +		tick-timer = &timer0;
 +	};
 +
 +	reg_3p3v: regulator-3p3v {
 +		  compatible = "regulator-fixed";
 +		  regulator-name = "fixed-3.3V";
 +		  regulator-min-microvolt = <3300000>;
 +		  regulator-max-microvolt = <3300000>;
 +		  regulator-boot-on;
 +		  regulator-always-on;
 +	};
 +};
 +
 +&uart0 {
 +	status = "okay";
 +};
 +
 +&uart1 {
 +	pinctrl-names = "default";
 +	pinctrl-0 = <&uart1_pins>;
 +	status = "disabled";
 +};
 +
 +&eth {
 +	status = "okay";
 +	mediatek,gmac-id = <0>;
 +	phy-mode = "sgmii";
 +	mediatek,switch = "mt7531";
 +	reset-gpios = <&gpio 39 GPIO_ACTIVE_HIGH>;
 +
 +	fixed-link {
 +		speed = <1000>;
 +		full-duplex;
 +	};
 +};
 +
 +&pinctrl {
 +	spic_pins: spi1-pins-func-1 {
 +		mux {
 +			function = "spi";
 +			groups = "spi1_1";
 +		};
 +	};
 +
 +	uart1_pins: spi1-pins-func-3 {
 +		mux {
 +			function = "uart";
 +			groups = "uart1_2";
 +		};
 +	};
 +
 +	/* pin15 as pwm0 */
 +	one_pwm_pins: one-pwm-pins {
 +		mux {
 +			function = "pwm";
 +			groups = "pwm0_1";
 +		};
 +	};
 +
 +	/* pin15 as pwm0 and pin14 as pwm1 */
 +	two_pwm_pins: two-pwm-pins {
 +		mux {
 +			function = "pwm";
 +			groups = "pwm0_1", "pwm1_0";
 +		};
 +	};
 +
 +	/* pin15 as pwm0, pin14 as pwm1, pin7 as pwm2 */
 +	three_pwm_pins: three-pwm-pins {
 +		mux {
 +			function = "pwm";
 +			groups = "pwm0_1", "pwm1_0", "pwm2";
 +		};
 +	};
 +
 +	mmc0_pins_default: mmc0default {
 +		mux {
 +			function = "flash";
 +			groups =  "emmc_45";
 +		};
 +		conf-cmd-dat {
 +			pins = "SPI0_CLK", "SPI0_MOSI", "SPI0_MISO",
 +				"SPI0_CS",  "SPI0_HOLD", "SPI0_WP",
 +				"SPI1_CLK", "SPI1_MOSI", "SPI1_MISO";
 +			input-enable;
 +			drive-strength = <MTK_DRIVE_4mA>;
 +			bias-pull-up = <MTK_PUPD_SET_R1R0_01>;
 +		};
 +		conf-clk {
 +			pins = "SPI1_CS";
 +			drive-strength = <MTK_DRIVE_6mA>;
 +			bias-pull-down = <MTK_PUPD_SET_R1R0_10>;
 +		};
 +		conf-rst {
 +			pins = "PWM0";
 +			drive-strength = <MTK_DRIVE_4mA>;
 +			bias-pull-up = <MTK_PUPD_SET_R1R0_01>;
 +		};
 +	};
 +};
 +
 +&pwm {
 +	pinctrl-names = "default";
 +	pinctrl-0 = <&two_pwm_pins>;
 +	status = "okay";
 +};
 +
 +&watchdog {
 +	status = "disabled";
 +};
 +
 +&mmc0 {
 +	pinctrl-names = "default";
 +	pinctrl-0 = <&mmc0_pins_default>;
 +	bus-width = <4>;
 +	max-frequency = <52000000>;
 +	cap-sd-highspeed;
 +	r_smpl = <0>;
 +	vmmc-supply = <&reg_3p3v>;
 +	vqmmc-supply = <&reg_3p3v>;
 +	status = "okay";
 +};
 --- /dev/null
 +++ b/board/mediatek/mt7981/MAINTAINERS
@@ -0,0 +1,10 @@
 +MT7981
 +M:	Sam Shih <sam.shih@mediatek.com>
 +S:	Maintained
 +F:	board/mediatek/mt7981
 +F:	include/configs/mt7981.h
 +F:	configs/mt7981_emmc_rfb_defconfig
 +F:	configs/mt7981_rfb_defconfig
 +F:	configs/mt7981_sd_rfb_defconfig
 +F:	configs/mt7981_spim_nand_rfb_defconfig
 +F:	configs/mt7981_spim_nor_rfb_defconfig
 --- /dev/null
 +++ b/board/mediatek/mt7981/Makefile
@@ -0,0 +1,3 @@
 +# SPDX-License-Identifier:	GPL-2.0
 +
 +obj-y	+= mt7981_rfb.o
 --- /dev/null
 +++ b/board/mediatek/mt7981/mt7981_rfb.c
@@ -0,0 +1,10 @@
 +// SPDX-License-Identifier: GPL-2.0
 +/*
 + * Copyright (C) 2022 MediaTek Inc.
 + * Author: Sam Shih <sam.shih@mediatek.com>
 + */
 +
 +int board_init(void)
 +{
 +	return 0;
 +}
 --- /dev/null
 +++ b/configs/mt7981_emmc_rfb_defconfig
@@ -0,0 +1,64 @@
 +CONFIG_ARM=y
 +CONFIG_POSITION_INDEPENDENT=y
 +CONFIG_ARCH_MEDIATEK=y
 +CONFIG_SYS_TEXT_BASE=0x41e00000
 +CONFIG_SYS_MALLOC_F_LEN=0x4000
 +CONFIG_NR_DRAM_BANKS=1
 +CONFIG_ENV_SIZE=0x80000
 +CONFIG_ENV_OFFSET=0x300000
 +CONFIG_DEFAULT_DEVICE_TREE="mt7981-emmc-rfb"
 +CONFIG_TARGET_MT7981=y
 +CONFIG_DEBUG_UART_BASE=0x11002000
 +CONFIG_DEBUG_UART_CLOCK=40000000
 +CONFIG_SYS_LOAD_ADDR=0x46000000
 +CONFIG_DEBUG_UART=y
 +# CONFIG_AUTOBOOT is not set
 +CONFIG_DEFAULT_FDT_FILE="mt7981-emmc-rfb"
 +CONFIG_LOGLEVEL=7
 +CONFIG_LOG=y
 +CONFIG_SYS_PROMPT="MT7981> "
 +CONFIG_SYS_CBSIZE=512
 +CONFIG_SYS_PBSIZE=1049
 +# CONFIG_BOOTM_NETBSD is not set
 +# CONFIG_BOOTM_PLAN9 is not set
 +# CONFIG_BOOTM_RTEMS is not set
 +# CONFIG_BOOTM_VXWORKS is not set
 +# CONFIG_CMD_ELF is not set
 +# CONFIG_CMD_UNLZ4 is not set
 +# CONFIG_CMD_UNZIP is not set
 +CONFIG_CMD_GPIO=y
 +CONFIG_CMD_GPT=y
 +CONFIG_CMD_GPT_RENAME=y
 +CONFIG_CMD_LSBLK=y
 +CONFIG_CMD_MMC=y
 +CONFIG_CMD_PART=y
 +CONFIG_CMD_READ=y
 +CONFIG_CMD_PING=y
 +CONFIG_CMD_SMC=y
 +CONFIG_CMD_FAT=y
 +CONFIG_CMD_FS_GENERIC=y
 +CONFIG_PARTITION_TYPE_GUID=y
 +CONFIG_ENV_OVERWRITE=y
 +CONFIG_ENV_IS_IN_MMC=y
 +CONFIG_ENV_VARS_UBOOT_RUNTIME_CONFIG=y
 +CONFIG_NET_RANDOM_ETHADDR=y
 +CONFIG_REGMAP=y
 +CONFIG_SYSCON=y
 +CONFIG_CLK=y
 +CONFIG_MMC_HS200_SUPPORT=y
 +CONFIG_MMC_MTK=y
 +CONFIG_PHY_FIXED=y
 +CONFIG_DM_ETH=y
 +CONFIG_MEDIATEK_ETH=y
 +CONFIG_PINCTRL=y
 +CONFIG_PINCONF=y
 +CONFIG_PINCTRL_MT7981=y
 +CONFIG_POWER_DOMAIN=y
 +CONFIG_MTK_POWER_DOMAIN=y
 +CONFIG_DM_REGULATOR=y
 +CONFIG_DM_REGULATOR_FIXED=y
 +CONFIG_DM_SERIAL=y
 +CONFIG_MTK_SERIAL=y
 +CONFIG_FAT_WRITE=y
 +CONFIG_HEXDUMP=y
 +# CONFIG_EFI_LOADER is not set
 --- /dev/null
 +++ b/configs/mt7981_rfb_defconfig
@@ -0,0 +1,69 @@
 +CONFIG_ARM=y
 +CONFIG_POSITION_INDEPENDENT=y
 +CONFIG_ARCH_MEDIATEK=y
 +CONFIG_SYS_TEXT_BASE=0x41e00000
 +CONFIG_SYS_MALLOC_F_LEN=0x4000
 +CONFIG_NR_DRAM_BANKS=1
 +CONFIG_DEFAULT_DEVICE_TREE="mt7981-rfb"
 +CONFIG_TARGET_MT7981=y
 +CONFIG_DEBUG_UART_BASE=0x11002000
 +CONFIG_DEBUG_UART_CLOCK=40000000
 +CONFIG_SYS_LOAD_ADDR=0x46000000
 +CONFIG_DEBUG_UART=y
 +# CONFIG_AUTOBOOT is not set
 +CONFIG_DEFAULT_FDT_FILE="mt7981-rfb"
 +CONFIG_LOGLEVEL=7
 +CONFIG_LOG=y
 +CONFIG_SYS_PROMPT="MT7981> "
 +CONFIG_SYS_CBSIZE=512
 +CONFIG_SYS_PBSIZE=1049
 +# CONFIG_BOOTM_NETBSD is not set
 +# CONFIG_BOOTM_PLAN9 is not set
 +# CONFIG_BOOTM_RTEMS is not set
 +# CONFIG_BOOTM_VXWORKS is not set
 +# CONFIG_CMD_ELF is not set
 +# CONFIG_CMD_UNLZ4 is not set
 +# CONFIG_CMD_UNZIP is not set
 +CONFIG_CMD_GPIO=y
 +CONFIG_CMD_MTD=y
 +CONFIG_CMD_SF_TEST=y
 +CONFIG_CMD_PING=y
 +CONFIG_CMD_SMC=y
 +CONFIG_ENV_VARS_UBOOT_RUNTIME_CONFIG=y
 +CONFIG_NET_RANDOM_ETHADDR=y
 +CONFIG_REGMAP=y
 +CONFIG_SYSCON=y
 +CONFIG_BLK=y
 +CONFIG_HAVE_BLOCK_DEVICE=y
 +CONFIG_CLK=y
 +# CONFIG_MMC is not set
 +CONFIG_MTD=y
 +CONFIG_DM_MTD=y
 +CONFIG_MTD_SPI_NAND=y
 +CONFIG_DM_SPI_FLASH=y
 +CONFIG_SPI_FLASH_SFDP_SUPPORT=y
 +CONFIG_SPI_FLASH_EON=y
 +CONFIG_SPI_FLASH_GIGADEVICE=y
 +CONFIG_SPI_FLASH_ISSI=y
 +CONFIG_SPI_FLASH_MACRONIX=y
 +CONFIG_SPI_FLASH_SPANSION=y
 +CONFIG_SPI_FLASH_STMICRO=y
 +CONFIG_SPI_FLASH_WINBOND=y
 +CONFIG_SPI_FLASH_XMC=y
 +CONFIG_SPI_FLASH_XTX=y
 +CONFIG_SPI_FLASH_MTD=y
 +CONFIG_PHY_FIXED=y
 +CONFIG_DM_ETH=y
 +CONFIG_MEDIATEK_ETH=y
 +CONFIG_PINCTRL=y
 +CONFIG_PINCONF=y
 +CONFIG_PINCTRL_MT7981=y
 +CONFIG_POWER_DOMAIN=y
 +CONFIG_MTK_POWER_DOMAIN=y
 +CONFIG_DM_SERIAL=y
 +CONFIG_MTK_SERIAL=y
 +CONFIG_SPI=y
 +CONFIG_DM_SPI=y
 +CONFIG_MTK_SPIM=y
 +CONFIG_HEXDUMP=y
 +# CONFIG_EFI_LOADER is not set
 --- /dev/null
 +++ b/configs/mt7981_sd_rfb_defconfig
@@ -0,0 +1,64 @@
 +CONFIG_ARM=y
 +CONFIG_POSITION_INDEPENDENT=y
 +CONFIG_ARCH_MEDIATEK=y
 +CONFIG_SYS_TEXT_BASE=0x41e00000
 +CONFIG_SYS_MALLOC_F_LEN=0x4000
 +CONFIG_NR_DRAM_BANKS=1
 +CONFIG_ENV_SIZE=0x80000
 +CONFIG_ENV_OFFSET=0x300000
 +CONFIG_DEFAULT_DEVICE_TREE="mt7981-sd-rfb"
 +CONFIG_TARGET_MT7981=y
 +CONFIG_DEBUG_UART_BASE=0x11002000
 +CONFIG_DEBUG_UART_CLOCK=40000000
 +CONFIG_SYS_LOAD_ADDR=0x46000000
 +CONFIG_DEBUG_UART=y
 +# CONFIG_AUTOBOOT is not set
 +CONFIG_DEFAULT_FDT_FILE="mt7981-sd-rfb"
 +CONFIG_LOGLEVEL=7
 +CONFIG_LOG=y
 +CONFIG_SYS_PROMPT="MT7981> "
 +CONFIG_SYS_CBSIZE=512
 +CONFIG_SYS_PBSIZE=1049
 +# CONFIG_BOOTM_NETBSD is not set
 +# CONFIG_BOOTM_PLAN9 is not set
 +# CONFIG_BOOTM_RTEMS is not set
 +# CONFIG_BOOTM_VXWORKS is not set
 +# CONFIG_CMD_ELF is not set
 +# CONFIG_CMD_UNLZ4 is not set
 +# CONFIG_CMD_UNZIP is not set
 +CONFIG_CMD_GPIO=y
 +CONFIG_CMD_GPT=y
 +CONFIG_CMD_GPT_RENAME=y
 +CONFIG_CMD_LSBLK=y
 +CONFIG_CMD_MMC=y
 +CONFIG_CMD_PART=y
 +CONFIG_CMD_READ=y
 +CONFIG_CMD_PING=y
 +CONFIG_CMD_SMC=y
 +CONFIG_CMD_FAT=y
 +CONFIG_CMD_FS_GENERIC=y
 +CONFIG_PARTITION_TYPE_GUID=y
 +CONFIG_ENV_OVERWRITE=y
 +CONFIG_ENV_IS_IN_MMC=y
 +CONFIG_ENV_VARS_UBOOT_RUNTIME_CONFIG=y
 +CONFIG_NET_RANDOM_ETHADDR=y
 +CONFIG_REGMAP=y
 +CONFIG_SYSCON=y
 +CONFIG_CLK=y
 +CONFIG_MMC_HS200_SUPPORT=y
 +CONFIG_MMC_MTK=y
 +CONFIG_PHY_FIXED=y
 +CONFIG_DM_ETH=y
 +CONFIG_MEDIATEK_ETH=y
 +CONFIG_PINCTRL=y
 +CONFIG_PINCONF=y
 +CONFIG_PINCTRL_MT7981=y
 +CONFIG_POWER_DOMAIN=y
 +CONFIG_MTK_POWER_DOMAIN=y
 +CONFIG_DM_REGULATOR=y
 +CONFIG_DM_REGULATOR_FIXED=y
 +CONFIG_DM_SERIAL=y
 +CONFIG_MTK_SERIAL=y
 +CONFIG_FAT_WRITE=y
 +CONFIG_HEXDUMP=y
 +# CONFIG_EFI_LOADER is not set
 --- /dev/null
 +++ b/include/configs/mt7981.h
@@ -0,0 +1,26 @@
 +/* SPDX-License-Identifier: GPL-2.0 */
 +/*
 + * Configuration for MediaTek MT7981 SoC
 + *
 + * Copyright (C) 2022 MediaTek Inc.
 + * Author: Sam Shih <sam.shih@mediatek.com>
 + */
 +
 +#ifndef __MT7981_H
 +#define __MT7981_H
 +
 +#include <linux/sizes.h>
 +
 +#define CONFIG_SYS_NONCACHED_MEMORY	SZ_1M
 +#define CONFIG_SYS_MMC_ENV_DEV		0
 +
 +/* Uboot definition */
 +#define CONFIG_SYS_UBOOT_BASE		CONFIG_SYS_TEXT_BASE
 +
 +/* SPL -> Uboot */
 +#define CONFIG_SYS_UBOOT_START		CONFIG_SYS_TEXT_BASE
 +
 +/* DRAM */
 +#define CONFIG_SYS_SDRAM_BASE		0x40000000
 +
 +#endif
--- a/package/boot/uboot-mediatek/patches/002-0005-mmc-mediatek-add-support-for-MediaTek-MT7891-MT7986-.patch
+++ b/package/boot/uboot-mediatek/patches/002-0005-mmc-mediatek-add-support-for-MediaTek-MT7891-MT7986-.patch
@@ -0,0 +1,132 @@
 From 3831266fedf14ef415791a93dd03a9e637eb8b5e Mon Sep 17 00:00:00 2001
 From: Weijie Gao <weijie.gao@mediatek.com>
 Date: Tue, 26 Jul 2022 09:24:13 +0800
 Subject: [PATCH 05/31] mmc: mediatek: add support for MediaTek MT7891/MT7986
 SoCs
 Add eMMC and SDXC support for MediaTek MT7981/MT7986 SoCs
 Both chips support SDXC and eMMC 4.5. MT7986A supports eMMC 5.1.
 Reviewed-by: Jaehoon Chung <jh80.chung@samsung.com>
 Reviewed-by: Simon Glass <sjg@chromium.org>
 Signed-off-by: Weijie Gao <weijie.gao@mediatek.com>
 ---
 drivers/mmc/mtk-sd.c | 68 ++++++++++++++++++++++++++++++++++----------
 1 file changed, 53 insertions(+), 15 deletions(-)
 --- a/drivers/mmc/mtk-sd.c
 +++ b/drivers/mmc/mtk-sd.c
@@ -1496,7 +1496,12 @@ static void msdc_init_hw(struct msdc_hos
 	/* Enable data & cmd interrupts */
 	writel(DATA_INTS_MASK | CMD_INTS_MASK, &host->base->msdc_inten);
 -	writel(0, tune_reg);
 +	if (host->top_base) {
 +		writel(0, &host->top_base->emmc_top_control);
 +		writel(0, &host->top_base->emmc_top_cmd);
 +	} else {
 +		writel(0, tune_reg);
 +	}
 	writel(0, &host->base->msdc_iocon);
 	if (host->r_smpl)
@@ -1507,9 +1512,14 @@ static void msdc_init_hw(struct msdc_hos
 	writel(0x403c0046, &host->base->patch_bit0);
 	writel(0xffff4089, &host->base->patch_bit1);
 -	if (host->dev_comp->stop_clk_fix)
 +	if (host->dev_comp->stop_clk_fix) {
 		clrsetbits_le32(&host->base->patch_bit1, MSDC_PB1_STOP_DLY_M,
 				3 << MSDC_PB1_STOP_DLY_S);
 +		clrbits_le32(&host->base->sdc_fifo_cfg,
 +			     SDC_FIFO_CFG_WRVALIDSEL);
 +		clrbits_le32(&host->base->sdc_fifo_cfg,
 +			     SDC_FIFO_CFG_RDVALIDSEL);
 +	}
 	if (host->dev_comp->busy_check)
 		clrbits_le32(&host->base->patch_bit1, (1 << 7));
@@ -1544,15 +1554,28 @@ static void msdc_init_hw(struct msdc_hos
 	}
 	if (host->dev_comp->data_tune) {
 -		setbits_le32(tune_reg,
 -			     MSDC_PAD_TUNE_RD_SEL | MSDC_PAD_TUNE_CMD_SEL);
 -		clrsetbits_le32(&host->base->patch_bit0,
 -				MSDC_INT_DAT_LATCH_CK_SEL_M,
 -				host->latch_ck <<
 -				MSDC_INT_DAT_LATCH_CK_SEL_S);
 +		if (host->top_base) {
 +			setbits_le32(&host->top_base->emmc_top_control,
 +				     PAD_DAT_RD_RXDLY_SEL);
 +			clrbits_le32(&host->top_base->emmc_top_control,
 +				     DATA_K_VALUE_SEL);
 +			setbits_le32(&host->top_base->emmc_top_cmd,
 +				     PAD_CMD_RD_RXDLY_SEL);
 +		} else {
 +			setbits_le32(tune_reg,
 +				     MSDC_PAD_TUNE_RD_SEL | MSDC_PAD_TUNE_CMD_SEL);
 +			clrsetbits_le32(&host->base->patch_bit0,
 +					MSDC_INT_DAT_LATCH_CK_SEL_M,
 +					host->latch_ck <<
 +					MSDC_INT_DAT_LATCH_CK_SEL_S);
 +		}
 	} else {
 		/* choose clock tune */
 -		setbits_le32(tune_reg, MSDC_PAD_TUNE_RXDLYSEL);
 +		if (host->top_base)
 +			setbits_le32(&host->top_base->emmc_top_control,
 +				     PAD_RXDLY_SEL);
 +		else
 +			setbits_le32(tune_reg, MSDC_PAD_TUNE_RXDLYSEL);
 	}
 	if (host->dev_comp->builtin_pad_ctrl) {
@@ -1604,12 +1627,6 @@ static void msdc_init_hw(struct msdc_hos
 	clrsetbits_le32(&host->base->sdc_cfg, SDC_CFG_DTOC_M,
 			3 << SDC_CFG_DTOC_S);
 -	if (host->dev_comp->stop_clk_fix) {
 -		clrbits_le32(&host->base->sdc_fifo_cfg,
 -			     SDC_FIFO_CFG_WRVALIDSEL);
 -		clrbits_le32(&host->base->sdc_fifo_cfg,
 -			     SDC_FIFO_CFG_RDVALIDSEL);
 -	}
 	host->def_tune_para.iocon = readl(&host->base->msdc_iocon);
 	host->def_tune_para.pad_tune = readl(&host->base->pad_tune);
@@ -1792,6 +1809,25 @@ static const struct msdc_compatible mt76
 	.enhance_rx = false
 };
 +static const struct msdc_compatible mt7986_compat = {
 +	.clk_div_bits = 12,
 +	.pad_tune0 = true,
 +	.async_fifo = true,
 +	.data_tune = true,
 +	.busy_check = true,
 +	.stop_clk_fix = true,
 +	.enhance_rx = true,
 +};
 +
 +static const struct msdc_compatible mt7981_compat = {
 +	.clk_div_bits = 12,
 +	.pad_tune0 = true,
 +	.async_fifo = true,
 +	.data_tune = true,
 +	.busy_check = true,
 +	.stop_clk_fix = true,
 +};
 +
 static const struct msdc_compatible mt8512_compat = {
 	.clk_div_bits = 12,
 	.pad_tune0 = true,
@@ -1824,6 +1860,8 @@ static const struct udevice_id msdc_ids[
 	{ .compatible = "mediatek,mt7621-mmc", .data = (ulong)&mt7621_compat },
 	{ .compatible = "mediatek,mt7622-mmc", .data = (ulong)&mt7622_compat },
 	{ .compatible = "mediatek,mt7623-mmc", .data = (ulong)&mt7623_compat },
 +	{ .compatible = "mediatek,mt7986-mmc", .data = (ulong)&mt7986_compat },
 +	{ .compatible = "mediatek,mt7981-mmc", .data = (ulong)&mt7981_compat },
 	{ .compatible = "mediatek,mt8512-mmc", .data = (ulong)&mt8512_compat },
 	{ .compatible = "mediatek,mt8516-mmc", .data = (ulong)&mt8516_compat },
 	{ .compatible = "mediatek,mt8183-mmc", .data = (ulong)&mt8183_compat },
--- a/package/boot/uboot-mediatek/patches/002-0006-net-mediatek-use-a-struct-to-cover-variations-of-all.patch
+++ b/package/boot/uboot-mediatek/patches/002-0006-net-mediatek-use-a-struct-to-cover-variations-of-all.patch
@@ -0,0 +1,163 @@
 From 5c5af768c4cceaa9d7497c3e5bfbc9d1ea8b279c Mon Sep 17 00:00:00 2001
 From: Weijie Gao <weijie.gao@mediatek.com>
 Date: Tue, 26 Jul 2022 10:44:57 +0800
 Subject: [PATCH 06/31] net: mediatek: use a struct to cover variations of all
 SoCs
 Using a single soc id to control different initialization and TX/RX flow
 for all SoCs is not extensible if more hardware variations are added in
 the future.
 This patch introduces a struct to replace the original mtk_soc to allow
 the driver be able handle newer hardwares.
 Reviewed-by: Simon Glass <sjg@chromium.org>
 Signed-off-by: Weijie Gao <weijie.gao@mediatek.com>
 ---
 drivers/net/mtk_eth.c | 56 ++++++++++++++++++++++++++++++-------------
 drivers/net/mtk_eth.h | 25 ++++++++++++++++++-
 2 files changed, 64 insertions(+), 17 deletions(-)
 --- a/drivers/net/mtk_eth.c
 +++ b/drivers/net/mtk_eth.c
@@ -142,11 +142,15 @@ enum mtk_switch {
 	SW_MT7531
 };
 -enum mtk_soc {
 -	SOC_MT7623,
 -	SOC_MT7629,
 -	SOC_MT7622,
 -	SOC_MT7621
 +/* struct mtk_soc_data -	This is the structure holding all differences
 + *				among various plaforms
 + * @caps			Flags shown the extra capability for the SoC
 + * @ana_rgc3:			The offset for register ANA_RGC3 related to
 + *				sgmiisys syscon
 + */
 +struct mtk_soc_data {
 +	u32 caps;
 +	u32 ana_rgc3;
 };
 struct mtk_eth_priv {
@@ -171,7 +175,7 @@ struct mtk_eth_priv {
 	int (*mmd_write)(struct mtk_eth_priv *priv, u8 addr, u8 devad, u16 reg,
 			 u16 val);
 -	enum mtk_soc soc;
 +	const struct mtk_soc_data *soc;
 	int gmac_id;
 	int force_mode;
 	int speed;
@@ -679,7 +683,7 @@ static int mt7530_setup(struct mtk_eth_p
 	u32 val, txdrv;
 	int i;
 -	if (priv->soc != SOC_MT7621) {
 +	if (!MTK_HAS_CAPS(priv->soc->caps, MTK_TRGMII_MT7621_CLK)) {
 		/* Select 250MHz clk for RGMII mode */
 		mtk_ethsys_rmw(priv, ETHSYS_CLKCFG0_REG,
 			       ETHSYS_TRGMII_CLK_SEL362_5, 0);
@@ -1108,9 +1112,8 @@ static int mtk_phy_probe(struct udevice
 static void mtk_sgmii_init(struct mtk_eth_priv *priv)
 {
 	/* Set SGMII GEN2 speed(2.5G) */
 -	clrsetbits_le32(priv->sgmii_base + ((priv->soc == SOC_MT7622) ?
 -			SGMSYS_GEN2_SPEED : SGMSYS_GEN2_SPEED_V2),
 -			SGMSYS_SPEED_2500, SGMSYS_SPEED_2500);
 +	setbits_le32(priv->sgmii_base + priv->soc->ana_rgc3,
 +		     SGMSYS_SPEED_2500);
 	/* Disable SGMII AN */
 	clrsetbits_le32(priv->sgmii_base + SGMSYS_PCS_CONTROL_1,
@@ -1182,7 +1185,8 @@ static void mtk_mac_init(struct mtk_eth_
 		mtk_gmac_write(priv, GMAC_PORT_MCR(priv->gmac_id), mcr);
 	}
 -	if (priv->soc == SOC_MT7623) {
 +	if (MTK_HAS_CAPS(priv->soc->caps, MTK_GMAC1_TRGMII) &&
 +	    !MTK_HAS_CAPS(priv->soc->caps, MTK_TRGMII_MT7621_CLK)) {
 		/* Lower Tx Driving for TRGMII path */
 		for (i = 0 ; i < NUM_TRGMII_CTRL; i++)
 			mtk_gmac_write(priv, GMAC_TRGMII_TD_ODT(i),
@@ -1431,7 +1435,11 @@ static int mtk_eth_of_to_plat(struct ude
 	ofnode subnode;
 	int ret;
 -	priv->soc = dev_get_driver_data(dev);
 +	priv->soc = (const struct mtk_soc_data *)dev_get_driver_data(dev);
 +	if (!priv->soc) {
 +		dev_err(dev, "missing soc compatible data\n");
 +		return -EINVAL;
 +	}
 	pdata->iobase = (phys_addr_t)dev_remap_addr(dev);
@@ -1544,11 +1552,27 @@ static int mtk_eth_of_to_plat(struct ude
 	return 0;
 }
 +static const struct mtk_soc_data mt7629_data = {
 +	.ana_rgc3 = 0x128,
 +};
 +
 +static const struct mtk_soc_data mt7623_data = {
 +	.caps = MT7623_CAPS,
 +};
 +
 +static const struct mtk_soc_data mt7622_data = {
 +	.ana_rgc3 = 0x2028,
 +};
 +
 +static const struct mtk_soc_data mt7621_data = {
 +	.caps = MT7621_CAPS,
 +};
 +
 static const struct udevice_id mtk_eth_ids[] = {
 -	{ .compatible = "mediatek,mt7629-eth", .data = SOC_MT7629 },
 -	{ .compatible = "mediatek,mt7623-eth", .data = SOC_MT7623 },
 -	{ .compatible = "mediatek,mt7622-eth", .data = SOC_MT7622 },
 -	{ .compatible = "mediatek,mt7621-eth", .data = SOC_MT7621 },
 +	{ .compatible = "mediatek,mt7629-eth", .data = (ulong)&mt7629_data },
 +	{ .compatible = "mediatek,mt7623-eth", .data = (ulong)&mt7623_data },
 +	{ .compatible = "mediatek,mt7622-eth", .data = (ulong)&mt7622_data },
 +	{ .compatible = "mediatek,mt7621-eth", .data = (ulong)&mt7621_data },
 	{}
 };
 --- a/drivers/net/mtk_eth.h
 +++ b/drivers/net/mtk_eth.h
@@ -9,8 +9,31 @@
 #ifndef _MTK_ETH_H_
 #define _MTK_ETH_H_
 -/* Frame Engine Register Bases */
 #include <linux/bitops.h>
 +
 +enum mkt_eth_capabilities {
 +	MTK_TRGMII_BIT,
 +	MTK_TRGMII_MT7621_CLK_BIT,
 +
 +	/* PATH BITS */
 +	MTK_ETH_PATH_GMAC1_TRGMII_BIT,
 +};
 +
 +#define MTK_TRGMII			BIT(MTK_TRGMII_BIT)
 +#define MTK_TRGMII_MT7621_CLK		BIT(MTK_TRGMII_MT7621_CLK_BIT)
 +
 +/* Supported path present on SoCs */
 +#define MTK_ETH_PATH_GMAC1_TRGMII	BIT(MTK_ETH_PATH_GMAC1_TRGMII_BIT)
 +
 +#define MTK_GMAC1_TRGMII	(MTK_ETH_PATH_GMAC1_TRGMII | MTK_TRGMII)
 +
 +#define MTK_HAS_CAPS(caps, _x)		(((caps) & (_x)) == (_x))
 +
 +#define MT7621_CAPS  (MTK_GMAC1_TRGMII | MTK_TRGMII_MT7621_CLK)
 +
 +#define MT7623_CAPS  (MTK_GMAC1_TRGMII)
 +
 +/* Frame Engine Register Bases */
 #define PDMA_BASE			0x0800
 #define GDMA1_BASE			0x0500
 #define GDMA2_BASE			0x1500
--- a/package/boot/uboot-mediatek/patches/002-0007-net-mediatek-stop-using-bitfileds-for-DMA-descriptor.patch
+++ b/package/boot/uboot-mediatek/patches/002-0007-net-mediatek-stop-using-bitfileds-for-DMA-descriptor.patch
@@ -0,0 +1,317 @@
 From b978c067075fddbac341bf551ebef29e78767b75 Mon Sep 17 00:00:00 2001
 From: Weijie Gao <weijie.gao@mediatek.com>
 Date: Wed, 27 Jul 2022 09:32:29 +0800
 Subject: [PATCH 07/31] net: mediatek: stop using bitfileds for DMA descriptors
 This patch is a preparation for adding a new version of PDMA of which the
 DMA descriptor fields has changed. Using bitfields will result in a complex
 modification. Convert bitfields to u32 units can solve this problem easily.
 Reviewed-by: Simon Glass <sjg@chromium.org>
 Signed-off-by: Weijie Gao <weijie.gao@mediatek.com>
 ---
 drivers/net/mtk_eth.c | 144 ++++++++++++++----------------------------
 drivers/net/mtk_eth.h |  32 ++++++++++
 2 files changed, 80 insertions(+), 96 deletions(-)
 --- a/drivers/net/mtk_eth.c
 +++ b/drivers/net/mtk_eth.c
@@ -65,77 +65,6 @@
 	(DP_DISCARD << MC_DP_S) | \
 	(DP_DISCARD << UN_DP_S))
 -struct pdma_rxd_info1 {
 -	u32 PDP0;
 -};
 -
 -struct pdma_rxd_info2 {
 -	u32 PLEN1 : 14;
 -	u32 LS1 : 1;
 -	u32 UN_USED : 1;
 -	u32 PLEN0 : 14;
 -	u32 LS0 : 1;
 -	u32 DDONE : 1;
 -};
 -
 -struct pdma_rxd_info3 {
 -	u32 PDP1;
 -};
 -
 -struct pdma_rxd_info4 {
 -	u32 FOE_ENTRY : 14;
 -	u32 CRSN : 5;
 -	u32 SP : 3;
 -	u32 L4F : 1;
 -	u32 L4VLD : 1;
 -	u32 TACK : 1;
 -	u32 IP4F : 1;
 -	u32 IP4 : 1;
 -	u32 IP6 : 1;
 -	u32 UN_USED : 4;
 -};
 -
 -struct pdma_rxdesc {
 -	struct pdma_rxd_info1 rxd_info1;
 -	struct pdma_rxd_info2 rxd_info2;
 -	struct pdma_rxd_info3 rxd_info3;
 -	struct pdma_rxd_info4 rxd_info4;
 -};
 -
 -struct pdma_txd_info1 {
 -	u32 SDP0;
 -};
 -
 -struct pdma_txd_info2 {
 -	u32 SDL1 : 14;
 -	u32 LS1 : 1;
 -	u32 BURST : 1;
 -	u32 SDL0 : 14;
 -	u32 LS0 : 1;
 -	u32 DDONE : 1;
 -};
 -
 -struct pdma_txd_info3 {
 -	u32 SDP1;
 -};
 -
 -struct pdma_txd_info4 {
 -	u32 VLAN_TAG : 16;
 -	u32 INS : 1;
 -	u32 RESV : 2;
 -	u32 UDF : 6;
 -	u32 FPORT : 3;
 -	u32 TSO : 1;
 -	u32 TUI_CO : 3;
 -};
 -
 -struct pdma_txdesc {
 -	struct pdma_txd_info1 txd_info1;
 -	struct pdma_txd_info2 txd_info2;
 -	struct pdma_txd_info3 txd_info3;
 -	struct pdma_txd_info4 txd_info4;
 -};
 -
 enum mtk_switch {
 	SW_NONE,
 	SW_MT7530,
@@ -151,13 +80,15 @@ enum mtk_switch {
 struct mtk_soc_data {
 	u32 caps;
 	u32 ana_rgc3;
 +	u32 txd_size;
 +	u32 rxd_size;
 };
 struct mtk_eth_priv {
 	char pkt_pool[TOTAL_PKT_BUF_SIZE] __aligned(ARCH_DMA_MINALIGN);
 -	struct pdma_txdesc *tx_ring_noc;
 -	struct pdma_rxdesc *rx_ring_noc;
 +	void *tx_ring_noc;
 +	void *rx_ring_noc;
 	int rx_dma_owner_idx0;
 	int tx_cpu_owner_idx0;
@@ -1202,14 +1133,16 @@ static void mtk_mac_init(struct mtk_eth_
 static void mtk_eth_fifo_init(struct mtk_eth_priv *priv)
 {
 	char *pkt_base = priv->pkt_pool;
 +	struct mtk_tx_dma *txd;
 +	struct mtk_rx_dma *rxd;
 	int i;
 	mtk_pdma_rmw(priv, PDMA_GLO_CFG_REG, 0xffff0000, 0);
 	udelay(500);
 -	memset(priv->tx_ring_noc, 0, NUM_TX_DESC * sizeof(struct pdma_txdesc));
 -	memset(priv->rx_ring_noc, 0, NUM_RX_DESC * sizeof(struct pdma_rxdesc));
 -	memset(priv->pkt_pool, 0, TOTAL_PKT_BUF_SIZE);
 +	memset(priv->tx_ring_noc, 0, NUM_TX_DESC * priv->soc->txd_size);
 +	memset(priv->rx_ring_noc, 0, NUM_RX_DESC * priv->soc->rxd_size);
 +	memset(priv->pkt_pool, 0xff, TOTAL_PKT_BUF_SIZE);
 	flush_dcache_range((ulong)pkt_base,
 			   (ulong)(pkt_base + TOTAL_PKT_BUF_SIZE));
@@ -1218,17 +1151,21 @@ static void mtk_eth_fifo_init(struct mtk
 	priv->tx_cpu_owner_idx0 = 0;
 	for (i = 0; i < NUM_TX_DESC; i++) {
 -		priv->tx_ring_noc[i].txd_info2.LS0 = 1;
 -		priv->tx_ring_noc[i].txd_info2.DDONE = 1;
 -		priv->tx_ring_noc[i].txd_info4.FPORT = priv->gmac_id + 1;
 +		txd = priv->tx_ring_noc + i * priv->soc->txd_size;
 +
 +		txd->txd1 = virt_to_phys(pkt_base);
 +		txd->txd2 = PDMA_TXD2_DDONE | PDMA_TXD2_LS0;
 +		txd->txd4 = PDMA_TXD4_FPORT_SET(priv->gmac_id + 1);
 -		priv->tx_ring_noc[i].txd_info1.SDP0 = virt_to_phys(pkt_base);
 		pkt_base += PKTSIZE_ALIGN;
 	}
 	for (i = 0; i < NUM_RX_DESC; i++) {
 -		priv->rx_ring_noc[i].rxd_info2.PLEN0 = PKTSIZE_ALIGN;
 -		priv->rx_ring_noc[i].rxd_info1.PDP0 = virt_to_phys(pkt_base);
 +		rxd = priv->rx_ring_noc + i * priv->soc->rxd_size;
 +
 +		rxd->rxd1 = virt_to_phys(pkt_base);
 +		rxd->rxd2 = PDMA_RXD2_PLEN0_SET(PKTSIZE_ALIGN);
 +
 		pkt_base += PKTSIZE_ALIGN;
 	}
@@ -1315,20 +1252,22 @@ static int mtk_eth_send(struct udevice *
 {
 	struct mtk_eth_priv *priv = dev_get_priv(dev);
 	u32 idx = priv->tx_cpu_owner_idx0;
 +	struct mtk_tx_dma *txd;
 	void *pkt_base;
 -	if (!priv->tx_ring_noc[idx].txd_info2.DDONE) {
 +	txd = priv->tx_ring_noc + idx * priv->soc->txd_size;
 +
 +	if (!(txd->txd2 & PDMA_TXD2_DDONE)) {
 		debug("mtk-eth: TX DMA descriptor ring is full\n");
 		return -EPERM;
 	}
 -	pkt_base = (void *)phys_to_virt(priv->tx_ring_noc[idx].txd_info1.SDP0);
 +	pkt_base = (void *)phys_to_virt(txd->txd1);
 	memcpy(pkt_base, packet, length);
 	flush_dcache_range((ulong)pkt_base, (ulong)pkt_base +
 			   roundup(length, ARCH_DMA_MINALIGN));
 -	priv->tx_ring_noc[idx].txd_info2.SDL0 = length;
 -	priv->tx_ring_noc[idx].txd_info2.DDONE = 0;
 +	txd->txd2 = PDMA_TXD2_LS0 | PDMA_TXD2_SDL0_SET(length);
 	priv->tx_cpu_owner_idx0 = (priv->tx_cpu_owner_idx0 + 1) % NUM_TX_DESC;
 	mtk_pdma_write(priv, TX_CTX_IDX_REG(0), priv->tx_cpu_owner_idx0);
@@ -1340,16 +1279,20 @@ static int mtk_eth_recv(struct udevice *
 {
 	struct mtk_eth_priv *priv = dev_get_priv(dev);
 	u32 idx = priv->rx_dma_owner_idx0;
 +	struct mtk_rx_dma *rxd;
 	uchar *pkt_base;
 	u32 length;
 -	if (!priv->rx_ring_noc[idx].rxd_info2.DDONE) {
 +	rxd = priv->rx_ring_noc + idx * priv->soc->rxd_size;
 +
 +	if (!(rxd->rxd2 & PDMA_RXD2_DDONE)) {
 		debug("mtk-eth: RX DMA descriptor ring is empty\n");
 		return -EAGAIN;
 	}
 -	length = priv->rx_ring_noc[idx].rxd_info2.PLEN0;
 -	pkt_base = (void *)phys_to_virt(priv->rx_ring_noc[idx].rxd_info1.PDP0);
 +	length = PDMA_RXD2_PLEN0_GET(rxd->rxd2);
 +
 +	pkt_base = (void *)phys_to_virt(rxd->rxd1);
 	invalidate_dcache_range((ulong)pkt_base, (ulong)pkt_base +
 				roundup(length, ARCH_DMA_MINALIGN));
@@ -1363,10 +1306,11 @@ static int mtk_eth_free_pkt(struct udevi
 {
 	struct mtk_eth_priv *priv = dev_get_priv(dev);
 	u32 idx = priv->rx_dma_owner_idx0;
 +	struct mtk_rx_dma *rxd;
 +
 +	rxd = priv->rx_ring_noc + idx * priv->soc->rxd_size;
 -	priv->rx_ring_noc[idx].rxd_info2.DDONE = 0;
 -	priv->rx_ring_noc[idx].rxd_info2.LS0 = 0;
 -	priv->rx_ring_noc[idx].rxd_info2.PLEN0 = PKTSIZE_ALIGN;
 +	rxd->rxd2 = PDMA_RXD2_PLEN0_SET(PKTSIZE_ALIGN);
 	mtk_pdma_write(priv, RX_CRX_IDX_REG(0), idx);
 	priv->rx_dma_owner_idx0 = (priv->rx_dma_owner_idx0 + 1) % NUM_RX_DESC;
@@ -1393,11 +1337,11 @@ static int mtk_eth_probe(struct udevice
 		return ret;
 	/* Prepare for tx/rx rings */
 -	priv->tx_ring_noc = (struct pdma_txdesc *)
 -		noncached_alloc(sizeof(struct pdma_txdesc) * NUM_TX_DESC,
 +	priv->tx_ring_noc = (void *)
 +		noncached_alloc(priv->soc->txd_size * NUM_TX_DESC,
 				ARCH_DMA_MINALIGN);
 -	priv->rx_ring_noc = (struct pdma_rxdesc *)
 -		noncached_alloc(sizeof(struct pdma_rxdesc) * NUM_RX_DESC,
 +	priv->rx_ring_noc = (void *)
 +		noncached_alloc(priv->soc->rxd_size * NUM_RX_DESC,
 				ARCH_DMA_MINALIGN);
 	/* Set MAC mode */
@@ -1554,18 +1498,26 @@ static int mtk_eth_of_to_plat(struct ude
 static const struct mtk_soc_data mt7629_data = {
 	.ana_rgc3 = 0x128,
 +	.txd_size = sizeof(struct mtk_tx_dma),
 +	.rxd_size = sizeof(struct mtk_rx_dma),
 };
 static const struct mtk_soc_data mt7623_data = {
 	.caps = MT7623_CAPS,
 +	.txd_size = sizeof(struct mtk_tx_dma),
 +	.rxd_size = sizeof(struct mtk_rx_dma),
 };
 static const struct mtk_soc_data mt7622_data = {
 	.ana_rgc3 = 0x2028,
 +	.txd_size = sizeof(struct mtk_tx_dma),
 +	.rxd_size = sizeof(struct mtk_rx_dma),
 };
 static const struct mtk_soc_data mt7621_data = {
 	.caps = MT7621_CAPS,
 +	.txd_size = sizeof(struct mtk_tx_dma),
 +	.rxd_size = sizeof(struct mtk_rx_dma),
 };
 static const struct udevice_id mtk_eth_ids[] = {
 --- a/drivers/net/mtk_eth.h
 +++ b/drivers/net/mtk_eth.h
@@ -10,6 +10,7 @@
 #define _MTK_ETH_H_
 #include <linux/bitops.h>
 +#include <linux/bitfield.h>
 enum mkt_eth_capabilities {
 	MTK_TRGMII_BIT,
@@ -435,4 +436,35 @@ enum mkt_eth_capabilities {
 #define PHY_POWER_SAVING_M		0x300
 #define PHY_POWER_SAVING_TX		0x0
 +/* PDMA descriptors */
 +struct mtk_rx_dma {
 +	unsigned int rxd1;
 +	unsigned int rxd2;
 +	unsigned int rxd3;
 +	unsigned int rxd4;
 +} __packed __aligned(4);
 +
 +struct mtk_tx_dma {
 +	unsigned int txd1;
 +	unsigned int txd2;
 +	unsigned int txd3;
 +	unsigned int txd4;
 +} __packed __aligned(4);
 +
 +/* PDMA TXD fields */
 +#define PDMA_TXD2_DDONE			BIT(31)
 +#define PDMA_TXD2_LS0			BIT(30)
 +#define PDMA_TXD2_SDL0_M		GENMASK(29, 16)
 +#define PDMA_TXD2_SDL0_SET(_v)	FIELD_PREP(PDMA_TXD2_SDL0_M, (_v))
 +
 +#define PDMA_TXD4_FPORT_M		GENMASK(27, 25)
 +#define PDMA_TXD4_FPORT_SET(_v)	FIELD_PREP(PDMA_TXD4_FPORT_M, (_v))
 +
 +/* PDMA RXD fields */
 +#define PDMA_RXD2_DDONE			BIT(31)
 +#define PDMA_RXD2_LS0			BIT(30)
 +#define PDMA_RXD2_PLEN0_M		GENMASK(29, 16)
 +#define PDMA_RXD2_PLEN0_GET(_v)	FIELD_GET(PDMA_RXD2_PLEN0_M, (_v))
 +#define PDMA_RXD2_PLEN0_SET(_v)	FIELD_PREP(PDMA_RXD2_PLEN0_M, (_v))
 +
 #endif /* _MTK_ETH_H_ */
--- a/package/boot/uboot-mediatek/patches/002-0008-net-mediatek-add-support-for-PDMA-v2.patch
+++ b/package/boot/uboot-mediatek/patches/002-0008-net-mediatek-add-support-for-PDMA-v2.patch
@@ -0,0 +1,298 @@
 From 2f53795aac940d960bc5f3b08a730c4d480fc5f6 Mon Sep 17 00:00:00 2001
 From: Weijie Gao <weijie.gao@mediatek.com>
 Date: Wed, 27 Jul 2022 09:56:30 +0800
 Subject: [PATCH 08/31] net: mediatek: add support for PDMA v2
 This patch adds support for PDMA v2 hardware. The PDMA v2 has extended the
 DMA descriptor to 8-words, and some of its fields have changed comparing
 to the v1 hardware.
 Reviewed-by: Ramon Fried <rfried.dev@gmail.com>
 Reviewed-by: Simon Glass <sjg@chromium.org>
 Signed-off-by: Weijie Gao <weijie.gao@mediatek.com>
 ---
 drivers/net/mtk_eth.c | 54 ++++++++++++++++++++++++++++++++-----------
 drivers/net/mtk_eth.h | 53 +++++++++++++++++++++++++++++++++++-------
 2 files changed, 86 insertions(+), 21 deletions(-)
 --- a/drivers/net/mtk_eth.c
 +++ b/drivers/net/mtk_eth.c
@@ -76,10 +76,14 @@ enum mtk_switch {
  * @caps			Flags shown the extra capability for the SoC
  * @ana_rgc3:			The offset for register ANA_RGC3 related to
  *				sgmiisys syscon
 + * @pdma_base:			Register base of PDMA block
 + * @txd_size:			Tx DMA descriptor size.
 + * @rxd_size:			Rx DMA descriptor size.
  */
 struct mtk_soc_data {
 	u32 caps;
 	u32 ana_rgc3;
 +	u32 pdma_base;
 	u32 txd_size;
 	u32 rxd_size;
 };
@@ -130,13 +134,13 @@ struct mtk_eth_priv {
 static void mtk_pdma_write(struct mtk_eth_priv *priv, u32 reg, u32 val)
 {
 -	writel(val, priv->fe_base + PDMA_BASE + reg);
 +	writel(val, priv->fe_base + priv->soc->pdma_base + reg);
 }
 static void mtk_pdma_rmw(struct mtk_eth_priv *priv, u32 reg, u32 clr,
 			 u32 set)
 {
 -	clrsetbits_le32(priv->fe_base + PDMA_BASE + reg, clr, set);
 +	clrsetbits_le32(priv->fe_base + priv->soc->pdma_base + reg, clr, set);
 }
 static void mtk_gdma_write(struct mtk_eth_priv *priv, int no, u32 reg,
@@ -1133,8 +1137,8 @@ static void mtk_mac_init(struct mtk_eth_
 static void mtk_eth_fifo_init(struct mtk_eth_priv *priv)
 {
 	char *pkt_base = priv->pkt_pool;
 -	struct mtk_tx_dma *txd;
 -	struct mtk_rx_dma *rxd;
 +	struct mtk_tx_dma_v2 *txd;
 +	struct mtk_rx_dma_v2 *rxd;
 	int i;
 	mtk_pdma_rmw(priv, PDMA_GLO_CFG_REG, 0xffff0000, 0);
@@ -1155,7 +1159,11 @@ static void mtk_eth_fifo_init(struct mtk
 		txd->txd1 = virt_to_phys(pkt_base);
 		txd->txd2 = PDMA_TXD2_DDONE | PDMA_TXD2_LS0;
 -		txd->txd4 = PDMA_TXD4_FPORT_SET(priv->gmac_id + 1);
 +
 +		if (MTK_HAS_CAPS(priv->soc->caps, MTK_NETSYS_V2))
 +			txd->txd5 = PDMA_V2_TXD5_FPORT_SET(priv->gmac_id + 1);
 +		else
 +			txd->txd4 = PDMA_V1_TXD4_FPORT_SET(priv->gmac_id + 1);
 		pkt_base += PKTSIZE_ALIGN;
 	}
@@ -1164,7 +1172,11 @@ static void mtk_eth_fifo_init(struct mtk
 		rxd = priv->rx_ring_noc + i * priv->soc->rxd_size;
 		rxd->rxd1 = virt_to_phys(pkt_base);
 -		rxd->rxd2 = PDMA_RXD2_PLEN0_SET(PKTSIZE_ALIGN);
 +
 +		if (MTK_HAS_CAPS(priv->soc->caps, MTK_NETSYS_V2))
 +			rxd->rxd2 = PDMA_V2_RXD2_PLEN0_SET(PKTSIZE_ALIGN);
 +		else
 +			rxd->rxd2 = PDMA_V1_RXD2_PLEN0_SET(PKTSIZE_ALIGN);
 		pkt_base += PKTSIZE_ALIGN;
 	}
@@ -1193,6 +1205,9 @@ static int mtk_eth_start(struct udevice
 	reset_deassert(&priv->rst_fe);
 	mdelay(10);
 +	if (MTK_HAS_CAPS(priv->soc->caps, MTK_NETSYS_V2))
 +		setbits_le32(priv->fe_base + FE_GLO_MISC_REG, PDMA_VER_V2);
 +
 	/* Packets forward to PDMA */
 	mtk_gdma_write(priv, priv->gmac_id, GDMA_IG_CTRL_REG, GDMA_FWD_TO_CPU);
@@ -1227,7 +1242,7 @@ static void mtk_eth_stop(struct udevice
 		     TX_WB_DDONE | RX_DMA_EN | TX_DMA_EN, 0);
 	udelay(500);
 -	wait_for_bit_le32(priv->fe_base + PDMA_BASE + PDMA_GLO_CFG_REG,
 +	wait_for_bit_le32(priv->fe_base + priv->soc->pdma_base + PDMA_GLO_CFG_REG,
 			  RX_DMA_BUSY | TX_DMA_BUSY, 0, 5000, 0);
 }
@@ -1252,7 +1267,7 @@ static int mtk_eth_send(struct udevice *
 {
 	struct mtk_eth_priv *priv = dev_get_priv(dev);
 	u32 idx = priv->tx_cpu_owner_idx0;
 -	struct mtk_tx_dma *txd;
 +	struct mtk_tx_dma_v2 *txd;
 	void *pkt_base;
 	txd = priv->tx_ring_noc + idx * priv->soc->txd_size;
@@ -1267,7 +1282,10 @@ static int mtk_eth_send(struct udevice *
 	flush_dcache_range((ulong)pkt_base, (ulong)pkt_base +
 			   roundup(length, ARCH_DMA_MINALIGN));
 -	txd->txd2 = PDMA_TXD2_LS0 | PDMA_TXD2_SDL0_SET(length);
 +	if (MTK_HAS_CAPS(priv->soc->caps, MTK_NETSYS_V2))
 +		txd->txd2 = PDMA_TXD2_LS0 | PDMA_V2_TXD2_SDL0_SET(length);
 +	else
 +		txd->txd2 = PDMA_TXD2_LS0 | PDMA_V1_TXD2_SDL0_SET(length);
 	priv->tx_cpu_owner_idx0 = (priv->tx_cpu_owner_idx0 + 1) % NUM_TX_DESC;
 	mtk_pdma_write(priv, TX_CTX_IDX_REG(0), priv->tx_cpu_owner_idx0);
@@ -1279,7 +1297,7 @@ static int mtk_eth_recv(struct udevice *
 {
 	struct mtk_eth_priv *priv = dev_get_priv(dev);
 	u32 idx = priv->rx_dma_owner_idx0;
 -	struct mtk_rx_dma *rxd;
 +	struct mtk_rx_dma_v2 *rxd;
 	uchar *pkt_base;
 	u32 length;
@@ -1290,7 +1308,10 @@ static int mtk_eth_recv(struct udevice *
 		return -EAGAIN;
 	}
 -	length = PDMA_RXD2_PLEN0_GET(rxd->rxd2);
 +	if (MTK_HAS_CAPS(priv->soc->caps, MTK_NETSYS_V2))
 +		length = PDMA_V2_RXD2_PLEN0_GET(rxd->rxd2);
 +	else
 +		length = PDMA_V1_RXD2_PLEN0_GET(rxd->rxd2);
 	pkt_base = (void *)phys_to_virt(rxd->rxd1);
 	invalidate_dcache_range((ulong)pkt_base, (ulong)pkt_base +
@@ -1306,11 +1327,14 @@ static int mtk_eth_free_pkt(struct udevi
 {
 	struct mtk_eth_priv *priv = dev_get_priv(dev);
 	u32 idx = priv->rx_dma_owner_idx0;
 -	struct mtk_rx_dma *rxd;
 +	struct mtk_rx_dma_v2 *rxd;
 	rxd = priv->rx_ring_noc + idx * priv->soc->rxd_size;
 -	rxd->rxd2 = PDMA_RXD2_PLEN0_SET(PKTSIZE_ALIGN);
 +	if (MTK_HAS_CAPS(priv->soc->caps, MTK_NETSYS_V2))
 +		rxd->rxd2 = PDMA_V2_RXD2_PLEN0_SET(PKTSIZE_ALIGN);
 +	else
 +		rxd->rxd2 = PDMA_V1_RXD2_PLEN0_SET(PKTSIZE_ALIGN);
 	mtk_pdma_write(priv, RX_CRX_IDX_REG(0), idx);
 	priv->rx_dma_owner_idx0 = (priv->rx_dma_owner_idx0 + 1) % NUM_RX_DESC;
@@ -1498,24 +1522,28 @@ static int mtk_eth_of_to_plat(struct ude
 static const struct mtk_soc_data mt7629_data = {
 	.ana_rgc3 = 0x128,
 +	.pdma_base = PDMA_V1_BASE,
 	.txd_size = sizeof(struct mtk_tx_dma),
 	.rxd_size = sizeof(struct mtk_rx_dma),
 };
 static const struct mtk_soc_data mt7623_data = {
 	.caps = MT7623_CAPS,
 +	.pdma_base = PDMA_V1_BASE,
 	.txd_size = sizeof(struct mtk_tx_dma),
 	.rxd_size = sizeof(struct mtk_rx_dma),
 };
 static const struct mtk_soc_data mt7622_data = {
 	.ana_rgc3 = 0x2028,
 +	.pdma_base = PDMA_V1_BASE,
 	.txd_size = sizeof(struct mtk_tx_dma),
 	.rxd_size = sizeof(struct mtk_rx_dma),
 };
 static const struct mtk_soc_data mt7621_data = {
 	.caps = MT7621_CAPS,
 +	.pdma_base = PDMA_V1_BASE,
 	.txd_size = sizeof(struct mtk_tx_dma),
 	.rxd_size = sizeof(struct mtk_rx_dma),
 };
 --- a/drivers/net/mtk_eth.h
 +++ b/drivers/net/mtk_eth.h
@@ -15,6 +15,7 @@
 enum mkt_eth_capabilities {
 	MTK_TRGMII_BIT,
 	MTK_TRGMII_MT7621_CLK_BIT,
 +	MTK_NETSYS_V2_BIT,
 	/* PATH BITS */
 	MTK_ETH_PATH_GMAC1_TRGMII_BIT,
@@ -22,6 +23,7 @@ enum mkt_eth_capabilities {
 #define MTK_TRGMII			BIT(MTK_TRGMII_BIT)
 #define MTK_TRGMII_MT7621_CLK		BIT(MTK_TRGMII_MT7621_CLK_BIT)
 +#define MTK_NETSYS_V2			BIT(MTK_NETSYS_V2_BIT)
 /* Supported path present on SoCs */
 #define MTK_ETH_PATH_GMAC1_TRGMII	BIT(MTK_ETH_PATH_GMAC1_TRGMII_BIT)
@@ -35,7 +37,8 @@ enum mkt_eth_capabilities {
 #define MT7623_CAPS  (MTK_GMAC1_TRGMII)
 /* Frame Engine Register Bases */
 -#define PDMA_BASE			0x0800
 +#define PDMA_V1_BASE			0x0800
 +#define PDMA_V2_BASE			0x6000
 #define GDMA1_BASE			0x0500
 #define GDMA2_BASE			0x1500
 #define GMAC_BASE			0x10000
@@ -74,6 +77,8 @@ enum mkt_eth_capabilities {
 #define SGMSYS_SPEED_2500		BIT(2)
 /* Frame Engine Registers */
 +#define FE_GLO_MISC_REG			0x124
 +#define PDMA_VER_V2			BIT(4)
 /* PDMA */
 #define TX_BASE_PTR_REG(n)		(0x000 + (n) * 0x10)
@@ -444,6 +449,17 @@ struct mtk_rx_dma {
 	unsigned int rxd4;
 } __packed __aligned(4);
 +struct mtk_rx_dma_v2 {
 +	unsigned int rxd1;
 +	unsigned int rxd2;
 +	unsigned int rxd3;
 +	unsigned int rxd4;
 +	unsigned int rxd5;
 +	unsigned int rxd6;
 +	unsigned int rxd7;
 +	unsigned int rxd8;
 +} __packed __aligned(4);
 +
 struct mtk_tx_dma {
 	unsigned int txd1;
 	unsigned int txd2;
@@ -451,20 +467,41 @@ struct mtk_tx_dma {
 	unsigned int txd4;
 } __packed __aligned(4);
 +struct mtk_tx_dma_v2 {
 +	unsigned int txd1;
 +	unsigned int txd2;
 +	unsigned int txd3;
 +	unsigned int txd4;
 +	unsigned int txd5;
 +	unsigned int txd6;
 +	unsigned int txd7;
 +	unsigned int txd8;
 +} __packed __aligned(4);
 +
 /* PDMA TXD fields */
 #define PDMA_TXD2_DDONE			BIT(31)
 #define PDMA_TXD2_LS0			BIT(30)
 -#define PDMA_TXD2_SDL0_M		GENMASK(29, 16)
 -#define PDMA_TXD2_SDL0_SET(_v)	FIELD_PREP(PDMA_TXD2_SDL0_M, (_v))
 +#define PDMA_V1_TXD2_SDL0_M		GENMASK(29, 16)
 +#define PDMA_V1_TXD2_SDL0_SET(_v)	FIELD_PREP(PDMA_V1_TXD2_SDL0_M, (_v))
 +#define PDMA_V2_TXD2_SDL0_M		GENMASK(23, 8)
 +#define PDMA_V2_TXD2_SDL0_SET(_v)	FIELD_PREP(PDMA_V2_TXD2_SDL0_M, (_v))
 +
 +#define PDMA_V1_TXD4_FPORT_M		GENMASK(27, 25)
 +#define PDMA_V1_TXD4_FPORT_SET(_v)	FIELD_PREP(PDMA_V1_TXD4_FPORT_M, (_v))
 +#define PDMA_V2_TXD4_FPORT_M		GENMASK(27, 24)
 +#define PDMA_V2_TXD4_FPORT_SET(_v)	FIELD_PREP(PDMA_V2_TXD4_FPORT_M, (_v))
 -#define PDMA_TXD4_FPORT_M		GENMASK(27, 25)
 -#define PDMA_TXD4_FPORT_SET(_v)	FIELD_PREP(PDMA_TXD4_FPORT_M, (_v))
 +#define PDMA_V2_TXD5_FPORT_M		GENMASK(19, 16)
 +#define PDMA_V2_TXD5_FPORT_SET(_v)	FIELD_PREP(PDMA_V2_TXD5_FPORT_M, (_v))
 /* PDMA RXD fields */
 #define PDMA_RXD2_DDONE			BIT(31)
 #define PDMA_RXD2_LS0			BIT(30)
 -#define PDMA_RXD2_PLEN0_M		GENMASK(29, 16)
 -#define PDMA_RXD2_PLEN0_GET(_v)	FIELD_GET(PDMA_RXD2_PLEN0_M, (_v))
 -#define PDMA_RXD2_PLEN0_SET(_v)	FIELD_PREP(PDMA_RXD2_PLEN0_M, (_v))
 +#define PDMA_V1_RXD2_PLEN0_M		GENMASK(29, 16)
 +#define PDMA_V1_RXD2_PLEN0_GET(_v)	FIELD_GET(PDMA_V1_RXD2_PLEN0_M, (_v))
 +#define PDMA_V1_RXD2_PLEN0_SET(_v)	FIELD_PREP(PDMA_V1_RXD2_PLEN0_M, (_v))
 +#define PDMA_V2_RXD2_PLEN0_M		GENMASK(23, 8)
 +#define PDMA_V2_RXD2_PLEN0_GET(_v)	FIELD_GET(PDMA_V2_RXD2_PLEN0_M, (_v))
 +#define PDMA_V2_RXD2_PLEN0_SET(_v)	FIELD_PREP(PDMA_V2_RXD2_PLEN0_M, (_v))
 #endif /* _MTK_ETH_H_ */
--- a/package/boot/uboot-mediatek/patches/002-0009-net-mediatek-add-support-for-MediaTek-MT7981-MT7986.patch
+++ b/package/boot/uboot-mediatek/patches/002-0009-net-mediatek-add-support-for-MediaTek-MT7981-MT7986.patch
@@ -0,0 +1,100 @@
 From 5e06e9a78bbc81f64fdb4c8502a8e7175d8b6216 Mon Sep 17 00:00:00 2001
 From: Weijie Gao <weijie.gao@mediatek.com>
 Date: Wed, 27 Jul 2022 10:03:17 +0800
 Subject: [PATCH 09/31] net: mediatek: add support for MediaTek MT7981/MT7986
 This patch adds support for MediaTek MT7981 and MT7986. Both chips uses
 PDMA v2.
 Reviewed-by: Ramon Fried <rfried.dev@gmail.com>
 Signed-off-by: Weijie Gao <weijie.gao@mediatek.com>
 ---
 drivers/net/mtk_eth.c | 27 +++++++++++++++++++++++++++
 drivers/net/mtk_eth.h |  5 +++++
 2 files changed, 32 insertions(+)
 --- a/drivers/net/mtk_eth.c
 +++ b/drivers/net/mtk_eth.c
@@ -115,6 +115,7 @@ struct mtk_eth_priv {
 	int force_mode;
 	int speed;
 	int duplex;
 +	bool pn_swap;
 	struct phy_device *phydev;
 	int phy_interface;
@@ -1057,6 +1058,12 @@ static void mtk_sgmii_init(struct mtk_et
 	/* SGMII force mode setting */
 	writel(SGMII_FORCE_MODE, priv->sgmii_base + SGMSYS_SGMII_MODE);
 +	/* SGMII PN SWAP setting */
 +	if (priv->pn_swap) {
 +		setbits_le32(priv->sgmii_base + SGMSYS_QPHY_WRAP_CTRL,
 +			     SGMII_PN_SWAP_TX_RX);
 +	}
 +
 	/* Release PHYA power down state */
 	clrsetbits_le32(priv->sgmii_base + SGMSYS_QPHY_PWR_STATE_CTRL,
 			SGMII_PHYA_PWD, 0);
@@ -1470,6 +1477,8 @@ static int mtk_eth_of_to_plat(struct ude
 			dev_err(dev, "Unable to find sgmii\n");
 			return -ENODEV;
 		}
 +
 +		priv->pn_swap = ofnode_read_bool(args.node, "pn_swap");
 	}
 	/* check for switch first, otherwise phy will be used */
@@ -1520,6 +1529,22 @@ static int mtk_eth_of_to_plat(struct ude
 	return 0;
 }
 +static const struct mtk_soc_data mt7986_data = {
 +	.caps = MT7986_CAPS,
 +	.ana_rgc3 = 0x128,
 +	.pdma_base = PDMA_V2_BASE,
 +	.txd_size = sizeof(struct mtk_tx_dma_v2),
 +	.rxd_size = sizeof(struct mtk_rx_dma_v2),
 +};
 +
 +static const struct mtk_soc_data mt7981_data = {
 +	.caps = MT7986_CAPS,
 +	.ana_rgc3 = 0x128,
 +	.pdma_base = PDMA_V2_BASE,
 +	.txd_size = sizeof(struct mtk_tx_dma_v2),
 +	.rxd_size = sizeof(struct mtk_rx_dma_v2),
 +};
 +
 static const struct mtk_soc_data mt7629_data = {
 	.ana_rgc3 = 0x128,
 	.pdma_base = PDMA_V1_BASE,
@@ -1549,6 +1574,8 @@ static const struct mtk_soc_data mt7621_
 };
 static const struct udevice_id mtk_eth_ids[] = {
 +	{ .compatible = "mediatek,mt7986-eth", .data = (ulong)&mt7986_data },
 +	{ .compatible = "mediatek,mt7981-eth", .data = (ulong)&mt7981_data },
 	{ .compatible = "mediatek,mt7629-eth", .data = (ulong)&mt7629_data },
 	{ .compatible = "mediatek,mt7623-eth", .data = (ulong)&mt7623_data },
 	{ .compatible = "mediatek,mt7622-eth", .data = (ulong)&mt7622_data },
 --- a/drivers/net/mtk_eth.h
 +++ b/drivers/net/mtk_eth.h
@@ -36,6 +36,8 @@ enum mkt_eth_capabilities {
 #define MT7623_CAPS  (MTK_GMAC1_TRGMII)
 +#define MT7986_CAPS  (MTK_NETSYS_V2)
 +
 /* Frame Engine Register Bases */
 #define PDMA_V1_BASE			0x0800
 #define PDMA_V2_BASE			0x6000
@@ -72,6 +74,9 @@ enum mkt_eth_capabilities {
 #define SGMSYS_QPHY_PWR_STATE_CTRL	0xe8
 #define SGMII_PHYA_PWD			BIT(4)
 +#define SGMSYS_QPHY_WRAP_CTRL		0xec
 +#define SGMII_PN_SWAP_TX_RX		0x03
 +
 #define SGMSYS_GEN2_SPEED		0x2028
 #define SGMSYS_GEN2_SPEED_V2		0x128
 #define SGMSYS_SPEED_2500		BIT(2)
--- a/package/boot/uboot-mediatek/patches/002-0010-serial-mtk-add-support-for-using-dynamic-baud-clock-.patch
+++ b/package/boot/uboot-mediatek/patches/002-0010-serial-mtk-add-support-for-using-dynamic-baud-clock-.patch
@@ -0,0 +1,202 @@
 From 55ed87efb110d13fce6d1a7ee6cb04fac1a2c08a Mon Sep 17 00:00:00 2001
 From: Weijie Gao <weijie.gao@mediatek.com>
 Date: Wed, 27 Jul 2022 10:28:05 +0800
 Subject: [PATCH 10/31] serial: mtk: add support for using dynamic baud clock
 souce
 The baud clock on some platform may change due to assigned-clock-parent
 set in DT. In current flow the baud clock is only retrieved during probe
 stage. If the parent of the source clock changes after probe stage, the
 setbrg will set wrong baudrate.
 To get the right clock rate, this patch records the baud clk struct to the
 driver's priv, and changes the driver's flow to get the clock rate before
 calling _mtk_serial_setbrg().
 Reviewed-by: Simon Glass <sjg@chromium.org>
 Signed-off-by: Weijie Gao <weijie.gao@mediatek.com>
 ---
 drivers/serial/serial_mtk.c | 80 ++++++++++++++++++++++---------------
 1 file changed, 47 insertions(+), 33 deletions(-)
 --- a/drivers/serial/serial_mtk.c
 +++ b/drivers/serial/serial_mtk.c
@@ -10,6 +10,7 @@
 #include <common.h>
 #include <div64.h>
 #include <dm.h>
 +#include <dm/device_compat.h>
 #include <errno.h>
 #include <log.h>
 #include <serial.h>
@@ -70,27 +71,37 @@ struct mtk_serial_regs {
 #define BAUD_ALLOW_MAX(baud)	((baud) + (baud) * 3 / 100)
 #define BAUD_ALLOW_MIX(baud)	((baud) - (baud) * 3 / 100)
 +/* struct mtk_serial_priv -	Structure holding all information used by the
 + *				driver
 + * @regs:			Register base of the serial port
 + * @clk:			The baud clock device
 + * @fixed_clk_rate:		Fallback fixed baud clock rate if baud clock
 + *				device is not specified
 + * @force_highspeed:		Force using high-speed mode
 + */
 struct mtk_serial_priv {
 	struct mtk_serial_regs __iomem *regs;
 -	u32 clock;
 +	struct clk clk;
 +	u32 fixed_clk_rate;
 	bool force_highspeed;
 };
 -static void _mtk_serial_setbrg(struct mtk_serial_priv *priv, int baud)
 +static void _mtk_serial_setbrg(struct mtk_serial_priv *priv, int baud,
 +			       uint clk_rate)
 {
 	u32 quot, realbaud, samplecount = 1;
 	/* Special case for low baud clock */
 -	if (baud <= 115200 && priv->clock <= 12000000) {
 +	if (baud <= 115200 && clk_rate == 12000000) {
 		writel(3, &priv->regs->highspeed);
 -		quot = DIV_ROUND_CLOSEST(priv->clock, 256 * baud);
 +		quot = DIV_ROUND_CLOSEST(clk_rate, 256 * baud);
 		if (quot == 0)
 			quot = 1;
 -		samplecount = DIV_ROUND_CLOSEST(priv->clock, quot * baud);
 +		samplecount = DIV_ROUND_CLOSEST(clk_rate, quot * baud);
 -		realbaud = priv->clock / samplecount / quot;
 +		realbaud = clk_rate / samplecount / quot;
 		if (realbaud > BAUD_ALLOW_MAX(baud) ||
 		    realbaud < BAUD_ALLOW_MIX(baud)) {
 			pr_info("baud %d can't be handled\n", baud);
@@ -104,7 +115,7 @@ static void _mtk_serial_setbrg(struct mt
 	if (baud <= 115200) {
 		writel(0, &priv->regs->highspeed);
 -		quot = DIV_ROUND_CLOSEST(priv->clock, 16 * baud);
 +		quot = DIV_ROUND_CLOSEST(clk_rate, 16 * baud);
 	} else if (baud <= 576000) {
 		writel(2, &priv->regs->highspeed);
@@ -112,13 +123,13 @@ static void _mtk_serial_setbrg(struct mt
 		if ((baud == 500000) || (baud == 576000))
 			baud = 460800;
 -		quot = DIV_ROUND_UP(priv->clock, 4 * baud);
 +		quot = DIV_ROUND_UP(clk_rate, 4 * baud);
 	} else {
 use_hs3:
 		writel(3, &priv->regs->highspeed);
 -		quot = DIV_ROUND_UP(priv->clock, 256 * baud);
 -		samplecount = DIV_ROUND_CLOSEST(priv->clock, quot * baud);
 +		quot = DIV_ROUND_UP(clk_rate, 256 * baud);
 +		samplecount = DIV_ROUND_CLOSEST(clk_rate, quot * baud);
 	}
 set_baud:
@@ -167,8 +178,13 @@ static int _mtk_serial_pending(struct mt
 static int mtk_serial_setbrg(struct udevice *dev, int baudrate)
 {
 	struct mtk_serial_priv *priv = dev_get_priv(dev);
 +	u32 clk_rate;
 +
 +	clk_rate = clk_get_rate(&priv->clk);
 +	if (IS_ERR_VALUE(clk_rate) || clk_rate == 0)
 +		clk_rate = priv->fixed_clk_rate;
 -	_mtk_serial_setbrg(priv, baudrate);
 +	_mtk_serial_setbrg(priv, baudrate, clk_rate);
 	return 0;
 }
@@ -211,7 +227,6 @@ static int mtk_serial_of_to_plat(struct
 {
 	struct mtk_serial_priv *priv = dev_get_priv(dev);
 	fdt_addr_t addr;
 -	struct clk clk;
 	int err;
 	addr = dev_read_addr(dev);
@@ -220,22 +235,19 @@ static int mtk_serial_of_to_plat(struct
 	priv->regs = map_physmem(addr, 0, MAP_NOCACHE);
 -	err = clk_get_by_index(dev, 0, &clk);
 -	if (!err) {
 -		err = clk_get_rate(&clk);
 -		if (!IS_ERR_VALUE(err))
 -			priv->clock = err;
 -	} else if (err != -ENOENT && err != -ENODEV && err != -ENOSYS) {
 -		debug("mtk_serial: failed to get clock\n");
 -		return err;
 -	}
 -
 -	if (!priv->clock)
 -		priv->clock = dev_read_u32_default(dev, "clock-frequency", 0);
 -
 -	if (!priv->clock) {
 -		debug("mtk_serial: clock not defined\n");
 -		return -EINVAL;
 +	err = clk_get_by_index(dev, 0, &priv->clk);
 +	if (err) {
 +		err = dev_read_u32(dev, "clock-frequency", &priv->fixed_clk_rate);
 +		if (err) {
 +			dev_err(dev, "baud clock not defined\n");
 +			return -EINVAL;
 +		}
 +	} else {
 +		err = clk_get_rate(&priv->clk);
 +		if (IS_ERR_VALUE(err)) {
 +			dev_err(dev, "invalid baud clock\n");
 +			return -EINVAL;
 +		}
 	}
 	priv->force_highspeed = dev_read_bool(dev, "mediatek,force-highspeed");
@@ -273,7 +285,7 @@ DECLARE_GLOBAL_DATA_PTR;
 #define DECLARE_HSUART_PRIV(port) \
 	static struct mtk_serial_priv mtk_hsuart##port = { \
 	.regs = (struct mtk_serial_regs *)CONFIG_SYS_NS16550_COM##port, \
 -	.clock = CONFIG_SYS_NS16550_CLK \
 +	.fixed_clk_rate = CONFIG_SYS_NS16550_CLK \
 };
 #define DECLARE_HSUART_FUNCTIONS(port) \
@@ -282,12 +294,14 @@ DECLARE_GLOBAL_DATA_PTR;
 		writel(0, &mtk_hsuart##port.regs->ier); \
 		writel(UART_MCRVAL, &mtk_hsuart##port.regs->mcr); \
 		writel(UART_FCRVAL, &mtk_hsuart##port.regs->fcr); \
 -		_mtk_serial_setbrg(&mtk_hsuart##port, gd->baudrate); \
 +		_mtk_serial_setbrg(&mtk_hsuart##port, gd->baudrate, \
 +				   mtk_hsuart##port.fixed_clk_rate); \
 		return 0 ; \
 	} \
 	static void mtk_serial##port##_setbrg(void) \
 	{ \
 -		_mtk_serial_setbrg(&mtk_hsuart##port, gd->baudrate); \
 +		_mtk_serial_setbrg(&mtk_hsuart##port, gd->baudrate, \
 +				   mtk_hsuart##port.fixed_clk_rate); \
 	} \
 	static int mtk_serial##port##_getc(void) \
 	{ \
@@ -427,13 +441,13 @@ static inline void _debug_uart_init(void
 	struct mtk_serial_priv priv;
 	priv.regs = (void *) CONFIG_DEBUG_UART_BASE;
 -	priv.clock = CONFIG_DEBUG_UART_CLOCK;
 +	priv.fixed_clk_rate = CONFIG_DEBUG_UART_CLOCK;
 	writel(0, &priv.regs->ier);
 	writel(UART_MCRVAL, &priv.regs->mcr);
 	writel(UART_FCRVAL, &priv.regs->fcr);
 -	_mtk_serial_setbrg(&priv, CONFIG_BAUDRATE);
 +	_mtk_serial_setbrg(&priv, CONFIG_BAUDRATE, priv.fixed_clk_rate);
 }
 static inline void _debug_uart_putc(int ch)
--- a/package/boot/uboot-mediatek/patches/002-0011-arm-dts-mt7622-force-high-speed-mode-for-uart.patch
+++ b/package/boot/uboot-mediatek/patches/002-0011-arm-dts-mt7622-force-high-speed-mode-for-uart.patch
@@ -0,0 +1,26 @@
 From 893368e64049fd770e55fffcc8758d2619dc337d Mon Sep 17 00:00:00 2001
 From: Weijie Gao <weijie.gao@mediatek.com>
 Date: Mon, 25 Jul 2022 16:33:13 +0800
 Subject: [PATCH 11/31] arm: dts: mt7622: force high-speed mode for uart
 The input clock for uart is too slow (25MHz) which introduces frequent data
 error on both receiving and transmitting even if the baudrate is 115200.
 Using high-speed can significantly solve this issue.
 Reviewed-by: Simon Glass <sjg@chromium.org>
 Signed-off-by: Weijie Gao <weijie.gao@mediatek.com>
 ---
 arch/arm/dts/mt7622.dtsi | 1 +
 1 file changed, 1 insertion(+)
 --- a/arch/arm/dts/mt7622.dtsi
 +++ b/arch/arm/dts/mt7622.dtsi
@@ -191,6 +191,7 @@
 		status = "disabled";
 		assigned-clocks = <&topckgen CLK_TOP_AXI_SEL>;
 		assigned-clock-parents = <&topckgen CLK_TOP_SYSPLL1_D2>;
 +		mediatek,force-highspeed;
 	};
 	mmc0: mmc@11230000 {
--- a/package/boot/uboot-mediatek/patches/002-0012-pwm-mtk-add-support-for-MediaTek-MT7986-SoC.patch
+++ b/package/boot/uboot-mediatek/patches/002-0012-pwm-mtk-add-support-for-MediaTek-MT7986-SoC.patch
@@ -0,0 +1,32 @@
 From 63acbf4ffe328809ca479e5c7d344882810d412c Mon Sep 17 00:00:00 2001
 From: Weijie Gao <weijie.gao@mediatek.com>
 Date: Wed, 27 Jul 2022 11:00:15 +0800
 Subject: [PATCH 12/31] pwm: mtk: add support for MediaTek MT7986 SoC
 This patch adds PWM support for MediaTek MT7986 SoC.
 Reviewed-by: Simon Glass <sjg@chromium.org>
 Signed-off-by: Weijie Gao <weijie.gao@mediatek.com>
 ---
 drivers/pwm/pwm-mtk.c | 6 ++++++
 1 file changed, 6 insertions(+)
 --- a/drivers/pwm/pwm-mtk.c
 +++ b/drivers/pwm/pwm-mtk.c
@@ -171,10 +171,16 @@ static const struct mtk_pwm_soc mt7629_d
 	.pwm45_fixup = false,
 };
 +static const struct mtk_pwm_soc mt7986_data = {
 +	.num_pwms = 2,
 +	.pwm45_fixup = false,
 +};
 +
 static const struct udevice_id mtk_pwm_ids[] = {
 	{ .compatible = "mediatek,mt7622-pwm", .data = (ulong)&mt7622_data },
 	{ .compatible = "mediatek,mt7623-pwm", .data = (ulong)&mt7623_data },
 	{ .compatible = "mediatek,mt7629-pwm", .data = (ulong)&mt7629_data },
 +	{ .compatible = "mediatek,mt7986-pwm", .data = (ulong)&mt7986_data },
 	{ }
 };
--- a/package/boot/uboot-mediatek/patches/002-0013-pwm-mtk-add-support-for-MediaTek-MT7981-SoC.patch
+++ b/package/boot/uboot-mediatek/patches/002-0013-pwm-mtk-add-support-for-MediaTek-MT7981-SoC.patch
@@ -0,0 +1,99 @@
 From 4569ef02981f20b236a8cdc3a57b4d27fbdbc22e Mon Sep 17 00:00:00 2001
 From: Weijie Gao <weijie.gao@mediatek.com>
 Date: Wed, 27 Jul 2022 11:01:34 +0800
 Subject: [PATCH 13/31] pwm: mtk: add support for MediaTek MT7981 SoC
 This patch adds PWM support for MediaTek MT7981 SoC.
 MT7981 uses a different register offset so we have to add a version field
 to indicate the IP core version.
 Reviewed-by: Simon Glass <sjg@chromium.org>
 Signed-off-by: Weijie Gao <weijie.gao@mediatek.com>
 ---
 drivers/pwm/pwm-mtk.c | 34 ++++++++++++++++++++++++++++++++--
 1 file changed, 32 insertions(+), 2 deletions(-)
 --- a/drivers/pwm/pwm-mtk.c
 +++ b/drivers/pwm/pwm-mtk.c
@@ -29,13 +29,23 @@
 #define NSEC_PER_SEC 1000000000L
 -static const unsigned int mtk_pwm_reg_offset[] = {
 +enum mtk_pwm_reg_ver {
 +	PWM_REG_V1,
 +	PWM_REG_V2,
 +};
 +
 +static const unsigned int mtk_pwm_reg_offset_v1[] = {
 	0x0010, 0x0050, 0x0090, 0x00d0, 0x0110, 0x0150, 0x0190, 0x0220
 };
 +static const unsigned int mtk_pwm_reg_offset_v2[] = {
 +	0x0080, 0x00c0, 0x0100, 0x0140, 0x0180, 0x01c0, 0x0200, 0x0240
 +};
 +
 struct mtk_pwm_soc {
 	unsigned int num_pwms;
 	bool pwm45_fixup;
 +	enum mtk_pwm_reg_ver reg_ver;
 };
 struct mtk_pwm_priv {
@@ -49,7 +59,16 @@ struct mtk_pwm_priv {
 static void mtk_pwm_w32(struct udevice *dev, uint channel, uint reg, uint val)
 {
 	struct mtk_pwm_priv *priv = dev_get_priv(dev);
 -	u32 offset = mtk_pwm_reg_offset[channel];
 +	u32 offset;
 +
 +	switch (priv->soc->reg_ver) {
 +	case PWM_REG_V2:
 +		offset = mtk_pwm_reg_offset_v2[channel];
 +		break;
 +
 +	default:
 +		offset = mtk_pwm_reg_offset_v1[channel];
 +	}
 	writel(val, priv->base + offset + reg);
 }
@@ -159,27 +178,38 @@ static const struct pwm_ops mtk_pwm_ops
 static const struct mtk_pwm_soc mt7622_data = {
 	.num_pwms = 6,
 	.pwm45_fixup = false,
 +	.reg_ver = PWM_REG_V1,
 };
 static const struct mtk_pwm_soc mt7623_data = {
 	.num_pwms = 5,
 	.pwm45_fixup = true,
 +	.reg_ver = PWM_REG_V1,
 };
 static const struct mtk_pwm_soc mt7629_data = {
 	.num_pwms = 1,
 	.pwm45_fixup = false,
 +	.reg_ver = PWM_REG_V1,
 +};
 +
 +static const struct mtk_pwm_soc mt7981_data = {
 +	.num_pwms = 2,
 +	.pwm45_fixup = false,
 +	.reg_ver = PWM_REG_V2,
 };
 static const struct mtk_pwm_soc mt7986_data = {
 	.num_pwms = 2,
 	.pwm45_fixup = false,
 +	.reg_ver = PWM_REG_V1,
 };
 static const struct udevice_id mtk_pwm_ids[] = {
 	{ .compatible = "mediatek,mt7622-pwm", .data = (ulong)&mt7622_data },
 	{ .compatible = "mediatek,mt7623-pwm", .data = (ulong)&mt7623_data },
 	{ .compatible = "mediatek,mt7629-pwm", .data = (ulong)&mt7629_data },
 +	{ .compatible = "mediatek,mt7981-pwm", .data = (ulong)&mt7981_data },
 	{ .compatible = "mediatek,mt7986-pwm", .data = (ulong)&mt7986_data },
 	{ }
 };
--- a/package/boot/uboot-mediatek/patches/002-0014-timer-mtk-add-support-for-MediaTek-MT7981-MT7986-SoC.patch
+++ b/package/boot/uboot-mediatek/patches/002-0014-timer-mtk-add-support-for-MediaTek-MT7981-MT7986-SoC.patch
@@ -0,0 +1,119 @@
 From 7860bc58c43dfa939d2664be518c28aea591aeef Mon Sep 17 00:00:00 2001
 From: Weijie Gao <weijie.gao@mediatek.com>
 Date: Wed, 27 Jul 2022 11:38:33 +0800
 Subject: [PATCH 14/31] timer: mtk: add support for MediaTek MT7981/MT7986 SoCs
 This patch add general-purpose timer support for MediaTek MT7981/MT7986.
 These two SoCs uses a newer version of timer with its register definition
 slightly changed.
 Reviewed-by: Simon Glass <sjg@chromium.org>
 Signed-off-by: Weijie Gao <weijie.gao@mediatek.com>
 ---
 drivers/timer/mtk_timer.c | 59 ++++++++++++++++++++++++---------------
 1 file changed, 37 insertions(+), 22 deletions(-)
 --- a/drivers/timer/mtk_timer.c
 +++ b/drivers/timer/mtk_timer.c
@@ -13,24 +13,32 @@
 #include <asm/io.h>
 #include <linux/bitops.h>
 -#define MTK_GPT4_CTRL	0x40
 -#define MTK_GPT4_CLK	0x44
 -#define MTK_GPT4_CNT	0x48
 -
 -#define GPT4_ENABLE	BIT(0)
 -#define GPT4_CLEAR	BIT(1)
 -#define GPT4_FREERUN	GENMASK(5, 4)
 -#define GPT4_CLK_SYS	0x0
 -#define GPT4_CLK_DIV1	0x0
 +#define MTK_GPT4_OFFSET_V1	0x40
 +#define MTK_GPT4_OFFSET_V2	0x80
 +
 +#define MTK_GPT_CON		0x0
 +#define MTK_GPT_V1_CLK		0x4
 +#define MTK_GPT_CNT		0x8
 +
 +#define GPT_ENABLE		BIT(0)
 +#define GPT_CLEAR		BIT(1)
 +#define GPT_V1_FREERUN		GENMASK(5, 4)
 +#define GPT_V2_FREERUN		GENMASK(6, 5)
 +
 +enum mtk_gpt_ver {
 +	MTK_GPT_V1,
 +	MTK_GPT_V2
 +};
 struct mtk_timer_priv {
 	void __iomem *base;
 +	unsigned int gpt4_offset;
 };
 static u64 mtk_timer_get_count(struct udevice *dev)
 {
 	struct mtk_timer_priv *priv = dev_get_priv(dev);
 -	u32 val = readl(priv->base + MTK_GPT4_CNT);
 +	u32 val = readl(priv->base + priv->gpt4_offset + MTK_GPT_CNT);
 	return timer_conv_64(val);
 }
@@ -40,12 +48,27 @@ static int mtk_timer_probe(struct udevic
 	struct timer_dev_priv *uc_priv = dev_get_uclass_priv(dev);
 	struct mtk_timer_priv *priv = dev_get_priv(dev);
 	struct clk clk, parent;
 -	int ret;
 +	int ret, gpt_ver;
 	priv->base = dev_read_addr_ptr(dev);
 +	gpt_ver = dev_get_driver_data(dev);
 +
 	if (!priv->base)
 		return -ENOENT;
 +	if (gpt_ver == MTK_GPT_V2) {
 +		priv->gpt4_offset = MTK_GPT4_OFFSET_V2;
 +
 +		writel(GPT_V2_FREERUN | GPT_CLEAR | GPT_ENABLE,
 +		       priv->base + priv->gpt4_offset + MTK_GPT_CON);
 +	} else {
 +		priv->gpt4_offset = MTK_GPT4_OFFSET_V1;
 +
 +		writel(GPT_V1_FREERUN | GPT_CLEAR | GPT_ENABLE,
 +		       priv->base + priv->gpt4_offset + MTK_GPT_CON);
 +		writel(0, priv->base + priv->gpt4_offset + MTK_GPT_V1_CLK);
 +	}
 +
 	ret = clk_get_by_index(dev, 0, &clk);
 	if (ret)
 		return ret;
@@ -61,16 +84,6 @@ static int mtk_timer_probe(struct udevic
 	if (!uc_priv->clock_rate)
 		return -EINVAL;
 -	/*
 -	 * Initialize the timer:
 -	 * 1. set clock source to system clock with clock divider setting to 1
 -	 * 2. set timer mode to free running
 -	 * 3. reset timer counter to 0 then enable the timer
 -	 */
 -	writel(GPT4_CLK_SYS | GPT4_CLK_DIV1, priv->base + MTK_GPT4_CLK);
 -	writel(GPT4_FREERUN | GPT4_CLEAR | GPT4_ENABLE,
 -	       priv->base + MTK_GPT4_CTRL);
 -
 	return 0;
 }
@@ -79,8 +92,10 @@ static const struct timer_ops mtk_timer_
 };
 static const struct udevice_id mtk_timer_ids[] = {
 -	{ .compatible = "mediatek,timer" },
 -	{ .compatible = "mediatek,mt6577-timer" },
 +	{ .compatible = "mediatek,timer", .data = MTK_GPT_V1 },
 +	{ .compatible = "mediatek,mt6577-timer", .data = MTK_GPT_V1 },
 +	{ .compatible = "mediatek,mt7981-timer", .data = MTK_GPT_V2 },
 +	{ .compatible = "mediatek,mt7986-timer", .data = MTK_GPT_V2 },
 	{ }
 };
--- a/package/boot/uboot-mediatek/patches/002-0015-watchdog-mediatek-add-support-for-MediaTek-MT7986-So.patch
+++ b/package/boot/uboot-mediatek/patches/002-0015-watchdog-mediatek-add-support-for-MediaTek-MT7986-So.patch
@@ -0,0 +1,23 @@
 From ec7e5d3e4d6e9239f3d7ac861f07ca4a52bec9fa Mon Sep 17 00:00:00 2001
 From: Weijie Gao <weijie.gao@mediatek.com>
 Date: Wed, 27 Jul 2022 11:47:50 +0800
 Subject: [PATCH 15/31] watchdog: mediatek: add support for MediaTek MT7986 SoC
 Add watchdog support for MediaTek MT7986 SoC
 Reviewed-by: Simon Glass <sjg@chromium.org>
 Signed-off-by: Weijie Gao <weijie.gao@mediatek.com>
 ---
 drivers/watchdog/mtk_wdt.c | 1 +
 1 file changed, 1 insertion(+)
 --- a/drivers/watchdog/mtk_wdt.c
 +++ b/drivers/watchdog/mtk_wdt.c
@@ -145,6 +145,7 @@ static const struct wdt_ops mtk_wdt_ops
 static const struct udevice_id mtk_wdt_ids[] = {
 	{ .compatible = "mediatek,wdt"},
 	{ .compatible = "mediatek,mt6589-wdt"},
 +	{ .compatible = "mediatek,mt7986-wdt" },
 	{}
 };
--- a/package/boot/uboot-mediatek/patches/002-0016-spi-add-support-for-MediaTek-spi-mem-controller.patch
+++ b/package/boot/uboot-mediatek/patches/002-0016-spi-add-support-for-MediaTek-spi-mem-controller.patch
@@ -0,0 +1,748 @@
 From f85493e3c2d1e4fd411061540b4f4943c09114df Mon Sep 17 00:00:00 2001
 From: Weijie Gao <weijie.gao@mediatek.com>
 Date: Wed, 27 Jul 2022 16:58:38 +0800
 Subject: [PATCH 16/31] spi: add support for MediaTek spi-mem controller
 This patch adds support for spi-mem controller found on newer MediaTek SoCs
 This controller supports Single/Dual/Quad SPI mode.
 Reviewed-by: Simon Glass <sjg@chromium.org>
 Signed-off-by: SkyLake.Huang <skylake.huang@mediatek.com>
 ---
 drivers/spi/Kconfig    |   8 +
 drivers/spi/Makefile   |   1 +
 drivers/spi/mtk_spim.c | 701 +++++++++++++++++++++++++++++++++++++++++
 3 files changed, 710 insertions(+)
 create mode 100644 drivers/spi/mtk_spim.c
 --- a/drivers/spi/Kconfig
 +++ b/drivers/spi/Kconfig
@@ -262,6 +262,14 @@ config MTK_SNFI_SPI
 	  used to access SPI memory devices like SPI-NOR or SPI-NAND on
 	  platforms embedding this IP core, like MT7622/M7629.
 +config MTK_SPIM
 +	bool "Mediatek SPI-MEM master controller driver"
 +	depends on SPI_MEM
 +	help
 +	  Enable MediaTek SPI-MEM master controller driver. This driver mainly
 +	  supports SPI flashes. You can use single, dual or quad mode
 +	  transmission on this controller.
 +
 config MVEBU_A3700_SPI
 	bool "Marvell Armada 3700 SPI driver"
 	select CLK_ARMADA_3720
 --- a/drivers/spi/Makefile
 +++ b/drivers/spi/Makefile
@@ -41,6 +41,7 @@ obj-$(CONFIG_MPC8XX_SPI) += mpc8xx_spi.o
 obj-$(CONFIG_MPC8XXX_SPI) += mpc8xxx_spi.o
 obj-$(CONFIG_MTK_SNFI_SPI) += mtk_snfi_spi.o
 obj-$(CONFIG_MTK_SNOR) += mtk_snor.o
 +obj-$(CONFIG_MTK_SPIM) += mtk_spim.o
 obj-$(CONFIG_MT7620_SPI) += mt7620_spi.o
 obj-$(CONFIG_MT7621_SPI) += mt7621_spi.o
 obj-$(CONFIG_MSCC_BB_SPI) += mscc_bb_spi.o
 --- /dev/null
 +++ b/drivers/spi/mtk_spim.c
@@ -0,0 +1,701 @@
 +// SPDX-License-Identifier: GPL-2.0
 +/*
 + * Copyright (C) 2022 MediaTek Inc. All Rights Reserved.
 + *
 + * Author: SkyLake.Huang <skylake.huang@mediatek.com>
 + */
 +
 +#include <clk.h>
 +#include <cpu_func.h>
 +#include <div64.h>
 +#include <dm.h>
 +#include <spi.h>
 +#include <spi-mem.h>
 +#include <stdbool.h>
 +#include <watchdog.h>
 +#include <dm/device.h>
 +#include <dm/device_compat.h>
 +#include <dm/devres.h>
 +#include <dm/pinctrl.h>
 +#include <linux/bitops.h>
 +#include <linux/completion.h>
 +#include <linux/dma-mapping.h>
 +#include <linux/io.h>
 +#include <linux/iopoll.h>
 +
 +#define SPI_CFG0_REG				0x0000
 +#define SPI_CFG1_REG				0x0004
 +#define SPI_TX_SRC_REG				0x0008
 +#define SPI_RX_DST_REG				0x000c
 +#define SPI_TX_DATA_REG				0x0010
 +#define SPI_RX_DATA_REG				0x0014
 +#define SPI_CMD_REG				0x0018
 +#define SPI_IRQ_REG				0x001c
 +#define SPI_STATUS_REG				0x0020
 +#define SPI_PAD_SEL_REG				0x0024
 +#define SPI_CFG2_REG				0x0028
 +#define SPI_TX_SRC_REG_64			0x002c
 +#define SPI_RX_DST_REG_64			0x0030
 +#define SPI_CFG3_IPM_REG			0x0040
 +
 +#define SPI_CFG0_SCK_HIGH_OFFSET		0
 +#define SPI_CFG0_SCK_LOW_OFFSET			8
 +#define SPI_CFG0_CS_HOLD_OFFSET			16
 +#define SPI_CFG0_CS_SETUP_OFFSET		24
 +#define SPI_ADJUST_CFG0_CS_HOLD_OFFSET		0
 +#define SPI_ADJUST_CFG0_CS_SETUP_OFFSET		16
 +
 +#define SPI_CFG1_CS_IDLE_OFFSET			0
 +#define SPI_CFG1_PACKET_LOOP_OFFSET		8
 +#define SPI_CFG1_PACKET_LENGTH_OFFSET		16
 +#define SPI_CFG1_GET_TICKDLY_OFFSET		29
 +
 +#define SPI_CFG1_GET_TICKDLY_MASK		GENMASK(31, 29)
 +#define SPI_CFG1_CS_IDLE_MASK			0xff
 +#define SPI_CFG1_PACKET_LOOP_MASK		0xff00
 +#define SPI_CFG1_PACKET_LENGTH_MASK		0x3ff0000
 +#define SPI_CFG1_IPM_PACKET_LENGTH_MASK		GENMASK(31, 16)
 +#define SPI_CFG2_SCK_HIGH_OFFSET		0
 +#define SPI_CFG2_SCK_LOW_OFFSET			16
 +#define SPI_CFG2_SCK_HIGH_MASK			GENMASK(15, 0)
 +#define SPI_CFG2_SCK_LOW_MASK			GENMASK(31, 16)
 +
 +#define SPI_CMD_ACT				BIT(0)
 +#define SPI_CMD_RESUME				BIT(1)
 +#define SPI_CMD_RST				BIT(2)
 +#define SPI_CMD_PAUSE_EN			BIT(4)
 +#define SPI_CMD_DEASSERT			BIT(5)
 +#define SPI_CMD_SAMPLE_SEL			BIT(6)
 +#define SPI_CMD_CS_POL				BIT(7)
 +#define SPI_CMD_CPHA				BIT(8)
 +#define SPI_CMD_CPOL				BIT(9)
 +#define SPI_CMD_RX_DMA				BIT(10)
 +#define SPI_CMD_TX_DMA				BIT(11)
 +#define SPI_CMD_TXMSBF				BIT(12)
 +#define SPI_CMD_RXMSBF				BIT(13)
 +#define SPI_CMD_RX_ENDIAN			BIT(14)
 +#define SPI_CMD_TX_ENDIAN			BIT(15)
 +#define SPI_CMD_FINISH_IE			BIT(16)
 +#define SPI_CMD_PAUSE_IE			BIT(17)
 +#define SPI_CMD_IPM_NONIDLE_MODE		BIT(19)
 +#define SPI_CMD_IPM_SPIM_LOOP			BIT(21)
 +#define SPI_CMD_IPM_GET_TICKDLY_OFFSET		22
 +
 +#define SPI_CMD_IPM_GET_TICKDLY_MASK		GENMASK(24, 22)
 +
 +#define PIN_MODE_CFG(x)				((x) / 2)
 +
 +#define SPI_CFG3_IPM_PIN_MODE_OFFSET		0
 +#define SPI_CFG3_IPM_HALF_DUPLEX_DIR		BIT(2)
 +#define SPI_CFG3_IPM_HALF_DUPLEX_EN		BIT(3)
 +#define SPI_CFG3_IPM_XMODE_EN			BIT(4)
 +#define SPI_CFG3_IPM_NODATA_FLAG		BIT(5)
 +#define SPI_CFG3_IPM_CMD_BYTELEN_OFFSET		8
 +#define SPI_CFG3_IPM_ADDR_BYTELEN_OFFSET	12
 +#define SPI_CFG3_IPM_DUMMY_BYTELEN_OFFSET	16
 +
 +#define SPI_CFG3_IPM_CMD_PIN_MODE_MASK		GENMASK(1, 0)
 +#define SPI_CFG3_IPM_CMD_BYTELEN_MASK		GENMASK(11, 8)
 +#define SPI_CFG3_IPM_ADDR_BYTELEN_MASK		GENMASK(15, 12)
 +#define SPI_CFG3_IPM_DUMMY_BYTELEN_MASK		GENMASK(19, 16)
 +
 +#define MT8173_SPI_MAX_PAD_SEL			3
 +
 +#define MTK_SPI_PAUSE_INT_STATUS		0x2
 +
 +#define MTK_SPI_IDLE				0
 +#define MTK_SPI_PAUSED				1
 +
 +#define MTK_SPI_MAX_FIFO_SIZE			32U
 +#define MTK_SPI_PACKET_SIZE			1024
 +#define MTK_SPI_IPM_PACKET_SIZE			SZ_64K
 +#define MTK_SPI_IPM_PACKET_LOOP			SZ_256
 +
 +#define MTK_SPI_32BITS_MASK			0xffffffff
 +
 +#define DMA_ADDR_EXT_BITS			36
 +#define DMA_ADDR_DEF_BITS			32
 +
 +#define CLK_TO_US(freq, clkcnt) DIV_ROUND_UP((clkcnt), (freq) / 1000000)
 +
 +/* struct mtk_spim_capability
 + * @enhance_timing:	Some IC design adjust cfg register to enhance time accuracy
 + * @dma_ext:		Some IC support DMA addr extension
 + * @ipm_design:		The IPM IP design improves some features, and supports dual/quad mode
 + * @support_quad:	Whether quad mode is supported
 + */
 +struct mtk_spim_capability {
 +	bool enhance_timing;
 +	bool dma_ext;
 +	bool ipm_design;
 +	bool support_quad;
 +};
 +
 +/* struct mtk_spim_priv
 + * @base:		Base address of the spi controller
 + * @state:		Controller state
 + * @sel_clk:		Pad clock
 + * @spi_clk:		Core clock
 + * @xfer_len:		Current length of data for transfer
 + * @hw_cap:		Controller capabilities
 + * @tick_dly:		Used to postpone SPI sampling time
 + * @sample_sel:		Sample edge of MISO
 + * @dev:		udevice of this spi controller
 + * @tx_dma:		Tx DMA address
 + * @rx_dma:		Rx DMA address
 + */
 +struct mtk_spim_priv {
 +	void __iomem *base;
 +	u32 state;
 +	struct clk sel_clk, spi_clk;
 +	u32 xfer_len;
 +	struct mtk_spim_capability hw_cap;
 +	u32 tick_dly;
 +	u32 sample_sel;
 +
 +	struct device *dev;
 +	dma_addr_t tx_dma;
 +	dma_addr_t rx_dma;
 +};
 +
 +static void mtk_spim_reset(struct mtk_spim_priv *priv)
 +{
 +	/* set the software reset bit in SPI_CMD_REG. */
 +	setbits_le32(priv->base + SPI_CMD_REG, SPI_CMD_RST);
 +	clrbits_le32(priv->base + SPI_CMD_REG, SPI_CMD_RST);
 +}
 +
 +static int mtk_spim_hw_init(struct spi_slave *slave)
 +{
 +	struct udevice *bus = dev_get_parent(slave->dev);
 +	struct mtk_spim_priv *priv = dev_get_priv(bus);
 +	u16 cpha, cpol;
 +	u32 reg_val;
 +
 +	cpha = slave->mode & SPI_CPHA ? 1 : 0;
 +	cpol = slave->mode & SPI_CPOL ? 1 : 0;
 +
 +	if (priv->hw_cap.enhance_timing) {
 +		if (priv->hw_cap.ipm_design) {
 +			/* CFG3 reg only used for spi-mem,
 +			 * here write to default value
 +			 */
 +			writel(0x0, priv->base + SPI_CFG3_IPM_REG);
 +			clrsetbits_le32(priv->base + SPI_CMD_REG,
 +					SPI_CMD_IPM_GET_TICKDLY_MASK,
 +					priv->tick_dly <<
 +					SPI_CMD_IPM_GET_TICKDLY_OFFSET);
 +		} else {
 +			clrsetbits_le32(priv->base + SPI_CFG1_REG,
 +					SPI_CFG1_GET_TICKDLY_MASK,
 +					priv->tick_dly <<
 +					SPI_CFG1_GET_TICKDLY_OFFSET);
 +		}
 +	}
 +
 +	reg_val = readl(priv->base + SPI_CMD_REG);
 +	if (priv->hw_cap.ipm_design) {
 +		/* SPI transfer without idle time until packet length done */
 +		reg_val |= SPI_CMD_IPM_NONIDLE_MODE;
 +		if (slave->mode & SPI_LOOP)
 +			reg_val |= SPI_CMD_IPM_SPIM_LOOP;
 +		else
 +			reg_val &= ~SPI_CMD_IPM_SPIM_LOOP;
 +	}
 +
 +	if (cpha)
 +		reg_val |= SPI_CMD_CPHA;
 +	else
 +		reg_val &= ~SPI_CMD_CPHA;
 +	if (cpol)
 +		reg_val |= SPI_CMD_CPOL;
 +	else
 +		reg_val &= ~SPI_CMD_CPOL;
 +
 +	/* set the mlsbx and mlsbtx */
 +	if (slave->mode & SPI_LSB_FIRST) {
 +		reg_val &= ~SPI_CMD_TXMSBF;
 +		reg_val &= ~SPI_CMD_RXMSBF;
 +	} else {
 +		reg_val |= SPI_CMD_TXMSBF;
 +		reg_val |= SPI_CMD_RXMSBF;
 +	}
 +
 +	/* do not reverse tx/rx endian */
 +	reg_val &= ~SPI_CMD_TX_ENDIAN;
 +	reg_val &= ~SPI_CMD_RX_ENDIAN;
 +
 +	if (priv->hw_cap.enhance_timing) {
 +		/* set CS polarity */
 +		if (slave->mode & SPI_CS_HIGH)
 +			reg_val |= SPI_CMD_CS_POL;
 +		else
 +			reg_val &= ~SPI_CMD_CS_POL;
 +
 +		if (priv->sample_sel)
 +			reg_val |= SPI_CMD_SAMPLE_SEL;
 +		else
 +			reg_val &= ~SPI_CMD_SAMPLE_SEL;
 +	}
 +
 +	/* disable dma mode */
 +	reg_val &= ~(SPI_CMD_TX_DMA | SPI_CMD_RX_DMA);
 +
 +	/* disable deassert mode */
 +	reg_val &= ~SPI_CMD_DEASSERT;
 +
 +	writel(reg_val, priv->base + SPI_CMD_REG);
 +
 +	return 0;
 +}
 +
 +static void mtk_spim_prepare_transfer(struct mtk_spim_priv *priv,
 +				      u32 speed_hz)
 +{
 +	u32 spi_clk_hz, div, sck_time, cs_time, reg_val;
 +
 +	spi_clk_hz = clk_get_rate(&priv->spi_clk);
 +	if (speed_hz <= spi_clk_hz / 4)
 +		div = DIV_ROUND_UP(spi_clk_hz, speed_hz);
 +	else
 +		div = 4;
 +
 +	sck_time = (div + 1) / 2;
 +	cs_time = sck_time * 2;
 +
 +	if (priv->hw_cap.enhance_timing) {
 +		reg_val = ((sck_time - 1) & 0xffff)
 +			   << SPI_CFG2_SCK_HIGH_OFFSET;
 +		reg_val |= ((sck_time - 1) & 0xffff)
 +			   << SPI_CFG2_SCK_LOW_OFFSET;
 +		writel(reg_val, priv->base + SPI_CFG2_REG);
 +
 +		reg_val = ((cs_time - 1) & 0xffff)
 +			   << SPI_ADJUST_CFG0_CS_HOLD_OFFSET;
 +		reg_val |= ((cs_time - 1) & 0xffff)
 +			   << SPI_ADJUST_CFG0_CS_SETUP_OFFSET;
 +		writel(reg_val, priv->base + SPI_CFG0_REG);
 +	} else {
 +		reg_val = ((sck_time - 1) & 0xff)
 +			   << SPI_CFG0_SCK_HIGH_OFFSET;
 +		reg_val |= ((sck_time - 1) & 0xff) << SPI_CFG0_SCK_LOW_OFFSET;
 +		reg_val |= ((cs_time - 1) & 0xff) << SPI_CFG0_CS_HOLD_OFFSET;
 +		reg_val |= ((cs_time - 1) & 0xff) << SPI_CFG0_CS_SETUP_OFFSET;
 +		writel(reg_val, priv->base + SPI_CFG0_REG);
 +	}
 +
 +	reg_val = readl(priv->base + SPI_CFG1_REG);
 +	reg_val &= ~SPI_CFG1_CS_IDLE_MASK;
 +	reg_val |= ((cs_time - 1) & 0xff) << SPI_CFG1_CS_IDLE_OFFSET;
 +	writel(reg_val, priv->base + SPI_CFG1_REG);
 +}
 +
 +/**
 + * mtk_spim_setup_packet() - setup packet format.
 + * @priv:	controller priv
 + *
 + * This controller sents/receives data in packets. The packet size is
 + * configurable.
 + *
 + * This function calculates the maximum packet size available for current
 + * data, and calculates the number of packets required to sent/receive data
 + * as much as possible.
 + */
 +static void mtk_spim_setup_packet(struct mtk_spim_priv *priv)
 +{
 +	u32 packet_size, packet_loop, reg_val;
 +
 +	/* Calculate maximum packet size */
 +	if (priv->hw_cap.ipm_design)
 +		packet_size = min_t(u32,
 +				    priv->xfer_len,
 +				    MTK_SPI_IPM_PACKET_SIZE);
 +	else
 +		packet_size = min_t(u32,
 +				    priv->xfer_len,
 +				    MTK_SPI_PACKET_SIZE);
 +
 +	/* Calculates number of packets to sent/receive */
 +	packet_loop = priv->xfer_len / packet_size;
 +
 +	reg_val = readl(priv->base + SPI_CFG1_REG);
 +	if (priv->hw_cap.ipm_design)
 +		reg_val &= ~SPI_CFG1_IPM_PACKET_LENGTH_MASK;
 +	else
 +		reg_val &= ~SPI_CFG1_PACKET_LENGTH_MASK;
 +
 +	reg_val |= (packet_size - 1) << SPI_CFG1_PACKET_LENGTH_OFFSET;
 +
 +	reg_val &= ~SPI_CFG1_PACKET_LOOP_MASK;
 +
 +	reg_val |= (packet_loop - 1) << SPI_CFG1_PACKET_LOOP_OFFSET;
 +
 +	writel(reg_val, priv->base + SPI_CFG1_REG);
 +}
 +
 +static void mtk_spim_enable_transfer(struct mtk_spim_priv *priv)
 +{
 +	u32 cmd;
 +
 +	cmd = readl(priv->base + SPI_CMD_REG);
 +	if (priv->state == MTK_SPI_IDLE)
 +		cmd |= SPI_CMD_ACT;
 +	else
 +		cmd |= SPI_CMD_RESUME;
 +	writel(cmd, priv->base + SPI_CMD_REG);
 +}
 +
 +static bool mtk_spim_supports_op(struct spi_slave *slave,
 +				 const struct spi_mem_op *op)
 +{
 +	struct udevice *bus = dev_get_parent(slave->dev);
 +	struct mtk_spim_priv *priv = dev_get_priv(bus);
 +
 +	if (op->cmd.buswidth == 0 || op->cmd.buswidth > 4 ||
 +	    op->addr.buswidth > 4 || op->dummy.buswidth > 4 ||
 +	    op->data.buswidth > 4)
 +		return false;
 +
 +	if (!priv->hw_cap.support_quad && (op->cmd.buswidth > 2 ||
 +	    op->addr.buswidth > 2 || op->dummy.buswidth > 2 ||
 +	    op->data.buswidth > 2))
 +		return false;
 +
 +	if (op->addr.nbytes && op->dummy.nbytes &&
 +	    op->addr.buswidth != op->dummy.buswidth)
 +		return false;
 +
 +	if (op->addr.nbytes + op->dummy.nbytes > 16)
 +		return false;
 +
 +	if (op->data.nbytes > MTK_SPI_IPM_PACKET_SIZE) {
 +		if (op->data.nbytes / MTK_SPI_IPM_PACKET_SIZE >
 +		    MTK_SPI_IPM_PACKET_LOOP ||
 +		    op->data.nbytes % MTK_SPI_IPM_PACKET_SIZE != 0)
 +			return false;
 +	}
 +
 +	return true;
 +}
 +
 +static void mtk_spim_setup_dma_xfer(struct mtk_spim_priv *priv,
 +				    const struct spi_mem_op *op)
 +{
 +	writel((u32)(priv->tx_dma & MTK_SPI_32BITS_MASK),
 +	       priv->base + SPI_TX_SRC_REG);
 +
 +	if (priv->hw_cap.dma_ext)
 +		writel((u32)(priv->tx_dma >> 32),
 +		       priv->base + SPI_TX_SRC_REG_64);
 +
 +	if (op->data.dir == SPI_MEM_DATA_IN) {
 +		writel((u32)(priv->rx_dma & MTK_SPI_32BITS_MASK),
 +		       priv->base + SPI_RX_DST_REG);
 +
 +		if (priv->hw_cap.dma_ext)
 +			writel((u32)(priv->rx_dma >> 32),
 +			       priv->base + SPI_RX_DST_REG_64);
 +	}
 +}
 +
 +static int mtk_spim_transfer_wait(struct spi_slave *slave,
 +				  const struct spi_mem_op *op)
 +{
 +	struct udevice *bus = dev_get_parent(slave->dev);
 +	struct mtk_spim_priv *priv = dev_get_priv(bus);
 +	u32 sck_l, sck_h, spi_bus_clk, clk_count, reg;
 +	ulong us = 1;
 +	int ret = 0;
 +
 +	if (op->data.dir == SPI_MEM_NO_DATA)
 +		clk_count = 32;
 +	else
 +		clk_count = op->data.nbytes;
 +
 +	spi_bus_clk = clk_get_rate(&priv->spi_clk);
 +	sck_l = readl(priv->base + SPI_CFG2_REG) >> SPI_CFG2_SCK_LOW_OFFSET;
 +	sck_h = readl(priv->base + SPI_CFG2_REG) & SPI_CFG2_SCK_HIGH_MASK;
 +	do_div(spi_bus_clk, sck_l + sck_h + 2);
 +
 +	us = CLK_TO_US(spi_bus_clk, clk_count * 8);
 +	us += 1000 * 1000; /* 1s tolerance */
 +
 +	if (us > UINT_MAX)
 +		us = UINT_MAX;
 +
 +	ret = readl_poll_timeout(priv->base + SPI_STATUS_REG, reg,
 +				 reg & 0x1, us);
 +	if (ret < 0) {
 +		dev_err(priv->dev, "transfer timeout, val: 0x%lx\n", us);
 +		return -ETIMEDOUT;
 +	}
 +
 +	return 0;
 +}
 +
 +static int mtk_spim_exec_op(struct spi_slave *slave,
 +			    const struct spi_mem_op *op)
 +{
 +	struct udevice *bus = dev_get_parent(slave->dev);
 +	struct mtk_spim_priv *priv = dev_get_priv(bus);
 +	u32 reg_val, nio = 1, tx_size;
 +	char *tx_tmp_buf;
 +	char *rx_tmp_buf;
 +	int i, ret = 0;
 +
 +	mtk_spim_reset(priv);
 +	mtk_spim_hw_init(slave);
 +	mtk_spim_prepare_transfer(priv, slave->max_hz);
 +
 +	reg_val = readl(priv->base + SPI_CFG3_IPM_REG);
 +	/* opcode byte len */
 +	reg_val &= ~SPI_CFG3_IPM_CMD_BYTELEN_MASK;
 +	reg_val |= 1 << SPI_CFG3_IPM_CMD_BYTELEN_OFFSET;
 +
 +	/* addr & dummy byte len */
 +	if (op->addr.nbytes || op->dummy.nbytes)
 +		reg_val |= (op->addr.nbytes + op->dummy.nbytes) <<
 +			    SPI_CFG3_IPM_ADDR_BYTELEN_OFFSET;
 +
 +	/* data byte len */
 +	if (!op->data.nbytes) {
 +		reg_val |= SPI_CFG3_IPM_NODATA_FLAG;
 +		writel(0, priv->base + SPI_CFG1_REG);
 +	} else {
 +		reg_val &= ~SPI_CFG3_IPM_NODATA_FLAG;
 +		priv->xfer_len = op->data.nbytes;
 +		mtk_spim_setup_packet(priv);
 +	}
 +
 +	if (op->addr.nbytes || op->dummy.nbytes) {
 +		if (op->addr.buswidth == 1 || op->dummy.buswidth == 1)
 +			reg_val |= SPI_CFG3_IPM_XMODE_EN;
 +		else
 +			reg_val &= ~SPI_CFG3_IPM_XMODE_EN;
 +	}
 +
 +	if (op->addr.buswidth == 2 ||
 +	    op->dummy.buswidth == 2 ||
 +	    op->data.buswidth == 2)
 +		nio = 2;
 +	else if (op->addr.buswidth == 4 ||
 +		 op->dummy.buswidth == 4 ||
 +		 op->data.buswidth == 4)
 +		nio = 4;
 +
 +	reg_val &= ~SPI_CFG3_IPM_CMD_PIN_MODE_MASK;
 +	reg_val |= PIN_MODE_CFG(nio) << SPI_CFG3_IPM_PIN_MODE_OFFSET;
 +
 +	reg_val |= SPI_CFG3_IPM_HALF_DUPLEX_EN;
 +	if (op->data.dir == SPI_MEM_DATA_IN)
 +		reg_val |= SPI_CFG3_IPM_HALF_DUPLEX_DIR;
 +	else
 +		reg_val &= ~SPI_CFG3_IPM_HALF_DUPLEX_DIR;
 +	writel(reg_val, priv->base + SPI_CFG3_IPM_REG);
 +
 +	tx_size = 1 + op->addr.nbytes + op->dummy.nbytes;
 +	if (op->data.dir == SPI_MEM_DATA_OUT)
 +		tx_size += op->data.nbytes;
 +
 +	tx_size = max(tx_size, (u32)32);
 +
 +	/* Fill up tx data */
 +	tx_tmp_buf = kzalloc(tx_size, GFP_KERNEL);
 +	if (!tx_tmp_buf) {
 +		ret = -ENOMEM;
 +		goto exit;
 +	}
 +
 +	tx_tmp_buf[0] = op->cmd.opcode;
 +
 +	if (op->addr.nbytes) {
 +		for (i = 0; i < op->addr.nbytes; i++)
 +			tx_tmp_buf[i + 1] = op->addr.val >>
 +					(8 * (op->addr.nbytes - i - 1));
 +	}
 +
 +	if (op->dummy.nbytes)
 +		memset(tx_tmp_buf + op->addr.nbytes + 1, 0xff,
 +		       op->dummy.nbytes);
 +
 +	if (op->data.nbytes && op->data.dir == SPI_MEM_DATA_OUT)
 +		memcpy(tx_tmp_buf + op->dummy.nbytes + op->addr.nbytes + 1,
 +		       op->data.buf.out, op->data.nbytes);
 +	/* Finish filling up tx data */
 +
 +	priv->tx_dma = dma_map_single(tx_tmp_buf, tx_size, DMA_TO_DEVICE);
 +	if (dma_mapping_error(priv->dev, priv->tx_dma)) {
 +		ret = -ENOMEM;
 +		goto tx_free;
 +	}
 +
 +	if (op->data.dir == SPI_MEM_DATA_IN) {
 +		if (!IS_ALIGNED((size_t)op->data.buf.in, 4)) {
 +			rx_tmp_buf = kzalloc(op->data.nbytes, GFP_KERNEL);
 +			if (!rx_tmp_buf) {
 +				ret = -ENOMEM;
 +				goto tx_unmap;
 +			}
 +		} else {
 +			rx_tmp_buf = op->data.buf.in;
 +		}
 +
 +		priv->rx_dma = dma_map_single(rx_tmp_buf, op->data.nbytes,
 +					      DMA_FROM_DEVICE);
 +		if (dma_mapping_error(priv->dev, priv->rx_dma)) {
 +			ret = -ENOMEM;
 +			goto rx_free;
 +		}
 +	}
 +
 +	reg_val = readl(priv->base + SPI_CMD_REG);
 +	reg_val |= SPI_CMD_TX_DMA;
 +	if (op->data.dir == SPI_MEM_DATA_IN)
 +		reg_val |= SPI_CMD_RX_DMA;
 +
 +	writel(reg_val, priv->base + SPI_CMD_REG);
 +
 +	mtk_spim_setup_dma_xfer(priv, op);
 +
 +	mtk_spim_enable_transfer(priv);
 +
 +	/* Wait for the interrupt. */
 +	ret = mtk_spim_transfer_wait(slave, op);
 +	if (ret)
 +		goto rx_unmap;
 +
 +	if (op->data.dir == SPI_MEM_DATA_IN &&
 +	    !IS_ALIGNED((size_t)op->data.buf.in, 4))
 +		memcpy(op->data.buf.in, rx_tmp_buf, op->data.nbytes);
 +
 +rx_unmap:
 +	/* spi disable dma */
 +	reg_val = readl(priv->base + SPI_CMD_REG);
 +	reg_val &= ~SPI_CMD_TX_DMA;
 +	if (op->data.dir == SPI_MEM_DATA_IN)
 +		reg_val &= ~SPI_CMD_RX_DMA;
 +	writel(reg_val, priv->base + SPI_CMD_REG);
 +
 +	writel(0, priv->base + SPI_TX_SRC_REG);
 +	writel(0, priv->base + SPI_RX_DST_REG);
 +
 +	if (op->data.dir == SPI_MEM_DATA_IN)
 +		dma_unmap_single(priv->rx_dma,
 +				 op->data.nbytes, DMA_FROM_DEVICE);
 +rx_free:
 +	if (op->data.dir == SPI_MEM_DATA_IN &&
 +	    !IS_ALIGNED((size_t)op->data.buf.in, 4))
 +		kfree(rx_tmp_buf);
 +tx_unmap:
 +	dma_unmap_single(priv->tx_dma,
 +			 tx_size, DMA_TO_DEVICE);
 +tx_free:
 +	kfree(tx_tmp_buf);
 +exit:
 +	return ret;
 +}
 +
 +static int mtk_spim_adjust_op_size(struct spi_slave *slave,
 +				   struct spi_mem_op *op)
 +{
 +	int opcode_len;
 +
 +	if (!op->data.nbytes)
 +		return 0;
 +
 +	if (op->data.dir != SPI_MEM_NO_DATA) {
 +		opcode_len = 1 + op->addr.nbytes + op->dummy.nbytes;
 +		if (opcode_len + op->data.nbytes > MTK_SPI_IPM_PACKET_SIZE) {
 +			op->data.nbytes = MTK_SPI_IPM_PACKET_SIZE - opcode_len;
 +			/* force data buffer dma-aligned. */
 +			op->data.nbytes -= op->data.nbytes % 4;
 +		}
 +	}
 +
 +	return 0;
 +}
 +
 +static int mtk_spim_get_attr(struct mtk_spim_priv *priv, struct udevice *dev)
 +{
 +	int ret;
 +
 +	priv->hw_cap.enhance_timing = dev_read_bool(dev, "enhance_timing");
 +	priv->hw_cap.dma_ext = dev_read_bool(dev, "dma_ext");
 +	priv->hw_cap.ipm_design = dev_read_bool(dev, "ipm_design");
 +	priv->hw_cap.support_quad = dev_read_bool(dev, "support_quad");
 +
 +	ret = dev_read_u32(dev, "tick_dly", &priv->tick_dly);
 +	if (ret < 0)
 +		dev_err(priv->dev, "tick dly not set.\n");
 +
 +	ret = dev_read_u32(dev, "sample_sel", &priv->sample_sel);
 +	if (ret < 0)
 +		dev_err(priv->dev, "sample sel not set.\n");
 +
 +	return ret;
 +}
 +
 +static int mtk_spim_probe(struct udevice *dev)
 +{
 +	struct mtk_spim_priv *priv = dev_get_priv(dev);
 +	int ret;
 +
 +	priv->base = (void __iomem *)devfdt_get_addr(dev);
 +	if (!priv->base)
 +		return -EINVAL;
 +
 +	mtk_spim_get_attr(priv, dev);
 +
 +	ret = clk_get_by_name(dev, "sel-clk", &priv->sel_clk);
 +	if (ret < 0) {
 +		dev_err(dev, "failed to get sel-clk\n");
 +		return ret;
 +	}
 +
 +	ret = clk_get_by_name(dev, "spi-clk", &priv->spi_clk);
 +	if (ret < 0) {
 +		dev_err(dev, "failed to get spi-clk\n");
 +		return ret;
 +	}
 +
 +	clk_enable(&priv->sel_clk);
 +	clk_enable(&priv->spi_clk);
 +
 +	return 0;
 +}
 +
 +static int mtk_spim_set_speed(struct udevice *dev, uint speed)
 +{
 +	return 0;
 +}
 +
 +static int mtk_spim_set_mode(struct udevice *dev, uint mode)
 +{
 +	return 0;
 +}
 +
 +static const struct spi_controller_mem_ops mtk_spim_mem_ops = {
 +	.adjust_op_size = mtk_spim_adjust_op_size,
 +	.supports_op = mtk_spim_supports_op,
 +	.exec_op = mtk_spim_exec_op
 +};
 +
 +static const struct dm_spi_ops mtk_spim_ops = {
 +	.mem_ops = &mtk_spim_mem_ops,
 +	.set_speed = mtk_spim_set_speed,
 +	.set_mode = mtk_spim_set_mode,
 +};
 +
 +static const struct udevice_id mtk_spim_ids[] = {
 +	{ .compatible = "mediatek,ipm-spi" },
 +	{}
 +};
 +
 +U_BOOT_DRIVER(mtk_spim) = {
 +	.name = "mtk_spim",
 +	.id = UCLASS_SPI,
 +	.of_match = mtk_spim_ids,
 +	.ops = &mtk_spim_ops,
 +	.priv_auto = sizeof(struct mtk_spim_priv),
 +	.probe = mtk_spim_probe,
 +};
--- a/package/boot/uboot-mediatek/patches/002-0017-i2c-add-support-for-MediaTek-I2C-interface.patch
+++ b/package/boot/uboot-mediatek/patches/002-0017-i2c-add-support-for-MediaTek-I2C-interface.patch
@@ -0,0 +1,870 @@
 From de6f2293ab087f405dbcf7b8df45d1f9b03fc091 Mon Sep 17 00:00:00 2001
 From: Weijie Gao <weijie.gao@mediatek.com>
 Date: Wed, 27 Jul 2022 17:16:38 +0800
 Subject: [PATCH 17/31] i2c: add support for MediaTek I2C interface
 This patch adds support for MediaTek I2C interface
 Reviewed-by: Heiko Schocher <hs@denx.de>
 Reviewed-by: Simon Glass <sjg@chromium.org>
 Signed-off-by: Weijie Gao <weijie.gao@mediatek.com>
 ---
 drivers/i2c/Kconfig   |   9 +
 drivers/i2c/Makefile  |   1 +
 drivers/i2c/mtk_i2c.c | 822 ++++++++++++++++++++++++++++++++++++++++++
 3 files changed, 832 insertions(+)
 create mode 100644 drivers/i2c/mtk_i2c.c
 --- a/drivers/i2c/Kconfig
 +++ b/drivers/i2c/Kconfig
@@ -261,6 +261,15 @@ config SYS_I2C_MESON
 	  internal buffer holding up to 8 bytes for transfers and supports
 	  both 7-bit and 10-bit addresses.
 +config SYS_I2C_MTK
 +	bool "MediaTek I2C driver"
 +	help
 +	  This selects the MediaTek Integrated Inter Circuit bus driver.
 +	  The I2C bus adapter is the base for some other I2C client,
 +	  eg: touch, sensors.
 +	  If you want to use MediaTek I2C interface, say Y here.
 +	  If unsure, say N.
 +
 config SYS_I2C_MICROCHIP
 	bool "Microchip I2C driver"
 	help
 --- a/drivers/i2c/Makefile
 +++ b/drivers/i2c/Makefile
@@ -32,6 +32,7 @@ obj-$(CONFIG_SYS_I2C_MICROCHIP) += i2c-m
 obj-$(CONFIG_SYS_I2C_MV) += mv_i2c.o
 obj-$(CONFIG_SYS_I2C_MVTWSI) += mvtwsi.o
 obj-$(CONFIG_SYS_I2C_MXC) += mxc_i2c.o
 +obj-$(CONFIG_SYS_I2C_MTK) += mtk_i2c.o
 obj-$(CONFIG_SYS_I2C_NEXELL) += nx_i2c.o
 obj-$(CONFIG_SYS_I2C_OCORES) += ocores_i2c.o
 obj-$(CONFIG_SYS_I2C_OCTEON) += octeon_i2c.o
 --- /dev/null
 +++ b/drivers/i2c/mtk_i2c.c
@@ -0,0 +1,822 @@
 +// SPDX-License-Identifier: GPL-2.0+
 +/*
 + * Copyright (C) 2022 MediaTek Inc. All Rights Reserved.
 + *
 + * Author: Mingming Lee <Mingming.Lee@mediatek.com>
 + *
 + * MediaTek I2C Interface driver
 + */
 +
 +#include <clk.h>
 +#include <cpu_func.h>
 +#include <dm.h>
 +#include <i2c.h>
 +#include <log.h>
 +#include <asm/cache.h>
 +#include <asm/io.h>
 +#include <linux/delay.h>
 +#include <linux/errno.h>
 +
 +#define I2C_RS_TRANSFER			BIT(4)
 +#define I2C_HS_NACKERR			BIT(2)
 +#define I2C_ACKERR			BIT(1)
 +#define I2C_TRANSAC_COMP		BIT(0)
 +#define I2C_TRANSAC_START		BIT(0)
 +#define I2C_RS_MUL_CNFG			BIT(15)
 +#define I2C_RS_MUL_TRIG			BIT(14)
 +#define I2C_DCM_DISABLE			0x0000
 +#define I2C_IO_CONFIG_OPEN_DRAIN	0x0003
 +#define I2C_IO_CONFIG_PUSH_PULL		0x0000
 +#define I2C_SOFT_RST			0x0001
 +#define I2C_FIFO_ADDR_CLR		0x0001
 +#define I2C_DELAY_LEN			0x0002
 +#define I2C_ST_START_CON		0x8001
 +#define I2C_FS_START_CON		0x1800
 +#define I2C_TIME_CLR_VALUE		0x0000
 +#define I2C_TIME_DEFAULT_VALUE		0x0003
 +#define I2C_WRRD_TRANAC_VALUE		0x0002
 +#define I2C_RD_TRANAC_VALUE		0x0001
 +
 +#define I2C_DMA_CON_TX			0x0000
 +#define I2C_DMA_CON_RX			0x0001
 +#define I2C_DMA_START_EN		0x0001
 +#define I2C_DMA_INT_FLAG_NONE		0x0000
 +#define I2C_DMA_CLR_FLAG		0x0000
 +#define I2C_DMA_TX_RX			0x0000
 +#define I2C_DMA_HARD_RST		0x0002
 +
 +#define MAX_ST_MODE_SPEED		100000
 +#define MAX_FS_MODE_SPEED		400000
 +#define MAX_HS_MODE_SPEED		3400000
 +#define MAX_SAMPLE_CNT_DIV		8
 +#define MAX_STEP_CNT_DIV		64
 +#define MAX_HS_STEP_CNT_DIV		8
 +#define I2C_DEFAULT_CLK_DIV		4
 +
 +#define MAX_I2C_ADDR			0x7f
 +#define MAX_I2C_LEN			0xff
 +#define TRANS_ADDR_ONLY			BIT(8)
 +#define TRANSFER_TIMEOUT		50000  /* us */
 +#define I2C_FIFO_STAT1_MASK		0x001f
 +#define TIMING_SAMPLE_OFFSET		8
 +#define HS_SAMPLE_OFFSET		12
 +#define HS_STEP_OFFSET			8
 +
 +#define I2C_CONTROL_WRAPPER		BIT(0)
 +#define I2C_CONTROL_RS			BIT(1)
 +#define I2C_CONTROL_DMA_EN		BIT(2)
 +#define I2C_CONTROL_CLK_EXT_EN		BIT(3)
 +#define I2C_CONTROL_DIR_CHANGE		BIT(4)
 +#define I2C_CONTROL_ACKERR_DET_EN	BIT(5)
 +#define I2C_CONTROL_TRANSFER_LEN_CHANGE BIT(6)
 +#define I2C_CONTROL_DMAACK		BIT(8)
 +#define I2C_CONTROL_ASYNC		BIT(9)
 +
 +#define I2C_MASTER_WR			BIT(0)
 +#define I2C_MASTER_RD			BIT(1)
 +#define I2C_MASTER_WRRD			(I2C_MASTER_WR | I2C_MASTER_RD)
 +
 +enum I2C_REGS_OFFSET {
 +	REG_PORT,
 +	REG_SLAVE_ADDR,
 +	REG_INTR_MASK,
 +	REG_INTR_STAT,
 +	REG_CONTROL,
 +	REG_TRANSFER_LEN,
 +	REG_TRANSAC_LEN,
 +	REG_DELAY_LEN,
 +	REG_TIMING,
 +	REG_START,
 +	REG_EXT_CONF,
 +	REG_FIFO_STAT1,
 +	REG_LTIMING,
 +	REG_FIFO_STAT,
 +	REG_FIFO_THRESH,
 +	REG_FIFO_ADDR_CLR,
 +	REG_IO_CONFIG,
 +	REG_RSV_DEBUG,
 +	REG_HS,
 +	REG_SOFTRESET,
 +	REG_DCM_EN,
 +	REG_PATH_DIR,
 +	REG_DEBUGSTAT,
 +	REG_DEBUGCTRL,
 +	REG_TRANSFER_LEN_AUX,
 +	REG_CLOCK_DIV,
 +	REG_SCL_HL_RATIO,
 +	REG_SCL_HS_HL_RATIO,
 +	REG_SCL_MIS_COMP_POINT,
 +	REG_STA_STOP_AC_TIME,
 +	REG_HS_STA_STOP_AC_TIME,
 +	REG_DATA_TIME,
 +};
 +
 +enum DMA_REGS_OFFSET {
 +	REG_INT_FLAG = 0x0,
 +	REG_INT_EN = 0x04,
 +	REG_EN = 0x08,
 +	REG_RST = 0x0c,
 +	REG_CON = 0x18,
 +	REG_TX_MEM_ADDR = 0x1c,
 +	REG_RX_MEM_ADDR = 0x20,
 +	REG_TX_LEN = 0x24,
 +	REG_RX_LEN = 0x28,
 +};
 +
 +static const uint mt_i2c_regs_v1[] = {
 +	[REG_PORT] = 0x0,
 +	[REG_SLAVE_ADDR] = 0x4,
 +	[REG_INTR_MASK] = 0x8,
 +	[REG_INTR_STAT] = 0xc,
 +	[REG_CONTROL] = 0x10,
 +	[REG_TRANSFER_LEN] = 0x14,
 +	[REG_TRANSAC_LEN] = 0x18,
 +	[REG_DELAY_LEN] = 0x1c,
 +	[REG_TIMING] = 0x20,
 +	[REG_START] = 0x24,
 +	[REG_EXT_CONF] = 0x28,
 +	[REG_FIFO_STAT1] = 0x2c,
 +	[REG_FIFO_STAT] = 0x30,
 +	[REG_FIFO_THRESH] = 0x34,
 +	[REG_FIFO_ADDR_CLR] = 0x38,
 +	[REG_IO_CONFIG] = 0x40,
 +	[REG_RSV_DEBUG] = 0x44,
 +	[REG_HS] = 0x48,
 +	[REG_SOFTRESET] = 0x50,
 +	[REG_SOFTRESET] = 0x50,
 +	[REG_DCM_EN] = 0x54,
 +	[REG_DEBUGSTAT] = 0x64,
 +	[REG_DEBUGCTRL] = 0x68,
 +	[REG_TRANSFER_LEN_AUX] = 0x6c,
 +	[REG_CLOCK_DIV] = 0x70,
 +	[REG_SCL_HL_RATIO] = 0x74,
 +	[REG_SCL_HS_HL_RATIO] = 0x78,
 +	[REG_SCL_MIS_COMP_POINT] = 0x7c,
 +	[REG_STA_STOP_AC_TIME] = 0x80,
 +	[REG_HS_STA_STOP_AC_TIME] = 0x84,
 +	[REG_DATA_TIME] = 0x88,
 +};
 +
 +static const uint mt_i2c_regs_v2[] = {
 +	[REG_PORT] = 0x0,
 +	[REG_SLAVE_ADDR] = 0x4,
 +	[REG_INTR_MASK] = 0x8,
 +	[REG_INTR_STAT] = 0xc,
 +	[REG_CONTROL] = 0x10,
 +	[REG_TRANSFER_LEN] = 0x14,
 +	[REG_TRANSAC_LEN] = 0x18,
 +	[REG_DELAY_LEN] = 0x1c,
 +	[REG_TIMING] = 0x20,
 +	[REG_START] = 0x24,
 +	[REG_EXT_CONF] = 0x28,
 +	[REG_LTIMING] = 0x2c,
 +	[REG_HS] = 0x30,
 +	[REG_IO_CONFIG] = 0x34,
 +	[REG_FIFO_ADDR_CLR] = 0x38,
 +	[REG_TRANSFER_LEN_AUX] = 0x44,
 +	[REG_CLOCK_DIV] = 0x48,
 +	[REG_SOFTRESET] = 0x50,
 +	[REG_DEBUGSTAT] = 0xe0,
 +	[REG_DEBUGCTRL] = 0xe8,
 +	[REG_FIFO_STAT] = 0xf4,
 +	[REG_FIFO_THRESH] = 0xf8,
 +	[REG_DCM_EN] = 0xf88,
 +};
 +
 +struct mtk_i2c_soc_data {
 +	const uint *regs;
 +	uint dma_sync: 1;
 +};
 +
 +struct mtk_i2c_priv {
 +	/* set in i2c probe */
 +	void __iomem *base;		/* i2c base addr */
 +	void __iomem *pdmabase;		/* dma base address*/
 +	struct clk clk_main;		/* main clock for i2c bus */
 +	struct clk clk_dma;		/* DMA clock for i2c via DMA */
 +	const struct mtk_i2c_soc_data *soc_data; /* Compatible data for different IC */
 +	int op;				/* operation mode */
 +	bool zero_len;			/* Only transfer slave address, no data */
 +	bool pushpull;			/* push pull mode or open drain mode */
 +	bool filter_msg;		/* filter msg error log */
 +	bool auto_restart;		/* restart mode */
 +	bool ignore_restart_irq;	/* ignore restart IRQ */
 +	uint speed;			/* i2c speed, unit: hz */
 +};
 +
 +static inline void i2c_writel(struct mtk_i2c_priv *priv, uint reg, uint value)
 +{
 +	u32 offset = priv->soc_data->regs[reg];
 +
 +	writel(value, priv->base + offset);
 +}
 +
 +static inline uint i2c_readl(struct mtk_i2c_priv *priv, uint offset)
 +{
 +	return readl(priv->base + priv->soc_data->regs[offset]);
 +}
 +
 +static int mtk_i2c_clk_enable(struct mtk_i2c_priv *priv)
 +{
 +	int ret;
 +
 +	ret = clk_enable(&priv->clk_main);
 +	if (ret)
 +		return log_msg_ret("enable clk_main", ret);
 +
 +	ret = clk_enable(&priv->clk_dma);
 +	if (ret)
 +		return log_msg_ret("enable clk_dma", ret);
 +
 +	return 0;
 +}
 +
 +static int mtk_i2c_clk_disable(struct mtk_i2c_priv *priv)
 +{
 +	int ret;
 +
 +	ret = clk_disable(&priv->clk_dma);
 +	if (ret)
 +		return log_msg_ret("disable clk_dma", ret);
 +
 +	ret = clk_disable(&priv->clk_main);
 +	if (ret)
 +		return log_msg_ret("disable clk_main", ret);
 +
 +	return 0;
 +}
 +
 +static void mtk_i2c_init_hw(struct mtk_i2c_priv *priv)
 +{
 +	uint control_reg;
 +
 +	writel(I2C_DMA_HARD_RST, priv->pdmabase + REG_RST);
 +	writel(I2C_DMA_CLR_FLAG, priv->pdmabase + REG_RST);
 +	i2c_writel(priv, REG_SOFTRESET, I2C_SOFT_RST);
 +	/* set ioconfig */
 +	if (priv->pushpull)
 +		i2c_writel(priv, REG_IO_CONFIG, I2C_IO_CONFIG_PUSH_PULL);
 +	else
 +		i2c_writel(priv, REG_IO_CONFIG, I2C_IO_CONFIG_OPEN_DRAIN);
 +
 +	i2c_writel(priv, REG_DCM_EN, I2C_DCM_DISABLE);
 +	control_reg = I2C_CONTROL_ACKERR_DET_EN | I2C_CONTROL_CLK_EXT_EN;
 +	if (priv->soc_data->dma_sync)
 +		control_reg |= I2C_CONTROL_DMAACK | I2C_CONTROL_ASYNC;
 +	i2c_writel(priv, REG_CONTROL, control_reg);
 +	i2c_writel(priv, REG_DELAY_LEN, I2C_DELAY_LEN);
 +}
 +
 +/*
 + * Calculate i2c port speed
 + *
 + * Hardware design:
 + * i2c_bus_freq = parent_clk / (clock_div * 2 * sample_cnt * step_cnt)
 + * clock_div: fixed in hardware, but may be various in different SoCs
 + *
 + * The calculation want to pick the highest bus frequency that is still
 + * less than or equal to target_speed. The calculation try to get
 + * sample_cnt and step_cn
 + * @param[in]
 + *     clk_src: i2c clock source
 + * @param[out]
 + *     timing_step_cnt: step cnt calculate result
 + * @param[out]
 + *     timing_sample_cnt: sample cnt calculate result
 + * @return
 + *     0, set speed successfully.
 + *     -EINVAL, Unsupported speed.
 + */
 +static int mtk_i2c_calculate_speed(uint clk_src,
 +				   uint target_speed,
 +				   uint *timing_step_cnt,
 +				   uint *timing_sample_cnt)
 +{
 +	uint base_sample_cnt = MAX_SAMPLE_CNT_DIV;
 +	uint base_step_cnt;
 +	uint max_step_cnt;
 +	uint sample_cnt;
 +	uint step_cnt;
 +	uint opt_div;
 +	uint best_mul;
 +	uint cnt_mul;
 +
 +	if (target_speed > MAX_HS_MODE_SPEED)
 +		target_speed = MAX_HS_MODE_SPEED;
 +
 +	if (target_speed > MAX_FS_MODE_SPEED)
 +		max_step_cnt = MAX_HS_STEP_CNT_DIV;
 +	else
 +		max_step_cnt = MAX_STEP_CNT_DIV;
 +
 +	base_step_cnt = max_step_cnt;
 +	/* Find the best combination */
 +	opt_div = DIV_ROUND_UP(clk_src >> 1, target_speed);
 +	best_mul = MAX_SAMPLE_CNT_DIV * max_step_cnt;
 +
 +	/*
 +	 * Search for the best pair (sample_cnt, step_cnt) with
 +	 * 0 < sample_cnt < MAX_SAMPLE_CNT_DIV
 +	 * 0 < step_cnt < max_step_cnt
 +	 * sample_cnt * step_cnt >= opt_div
 +	 * optimizing for sample_cnt * step_cnt being minimal
 +	 */
 +	for (sample_cnt = 1; sample_cnt <= MAX_SAMPLE_CNT_DIV; sample_cnt++) {
 +		step_cnt = DIV_ROUND_UP(opt_div, sample_cnt);
 +		cnt_mul = step_cnt * sample_cnt;
 +		if (step_cnt > max_step_cnt)
 +			continue;
 +
 +		if (cnt_mul < best_mul) {
 +			best_mul = cnt_mul;
 +			base_sample_cnt = sample_cnt;
 +			base_step_cnt = step_cnt;
 +			if (best_mul == opt_div)
 +				break;
 +		}
 +	}
 +
 +	sample_cnt = base_sample_cnt;
 +	step_cnt = base_step_cnt;
 +
 +	if ((clk_src / (2 * sample_cnt * step_cnt)) > target_speed) {
 +		/*
 +		 * In this case, hardware can't support such
 +		 * low i2c_bus_freq
 +		 */
 +		debug("Unsupported speed(%uhz)\n", target_speed);
 +		return log_msg_ret("calculate speed", -EINVAL);
 +	}
 +
 +	*timing_step_cnt = step_cnt - 1;
 +	*timing_sample_cnt = sample_cnt - 1;
 +
 +	return 0;
 +}
 +
 +/*
 + * mtk_i2c_set_speed
 + *
 + * @par Description
 + *     Calculate i2c speed and write sample_cnt, step_cnt to TIMING register.
 + * @param[in]
 + *     dev: udevice pointer, struct udevice contains i2c source clock,
 + *     clock divide and speed.
 + * @return
 + *     0, set speed successfully.\n
 + *     error code from mtk_i2c_calculate_speed().
 + */
 +static int mtk_i2c_set_speed(struct udevice *dev, uint speed)
 +{
 +	struct mtk_i2c_priv *priv = dev_get_priv(dev);
 +	uint high_speed_reg;
 +	uint sample_cnt;
 +	uint timing_reg;
 +	uint step_cnt;
 +	uint clk_src;
 +	int ret = 0;
 +
 +	priv->speed = speed;
 +	if (mtk_i2c_clk_enable(priv))
 +		return log_msg_ret("set_speed enable clk", -1);
 +
 +	clk_src = clk_get_rate(&priv->clk_main) / I2C_DEFAULT_CLK_DIV;
 +	i2c_writel(priv, REG_CLOCK_DIV, (I2C_DEFAULT_CLK_DIV - 1));
 +	if (priv->speed > MAX_FS_MODE_SPEED) {
 +		/* Set master code speed register */
 +		ret = mtk_i2c_calculate_speed(clk_src, MAX_FS_MODE_SPEED,
 +					      &step_cnt, &sample_cnt);
 +		if (ret < 0)
 +			goto exit;
 +
 +		timing_reg = (sample_cnt << TIMING_SAMPLE_OFFSET) | step_cnt;
 +		i2c_writel(priv, REG_TIMING, timing_reg);
 +		/* Set the high speed mode register */
 +		ret = mtk_i2c_calculate_speed(clk_src, priv->speed,
 +					      &step_cnt, &sample_cnt);
 +		if (ret < 0)
 +			goto exit;
 +
 +		high_speed_reg = I2C_TIME_DEFAULT_VALUE |
 +				(sample_cnt << HS_SAMPLE_OFFSET) |
 +				(step_cnt << HS_STEP_OFFSET);
 +		i2c_writel(priv, REG_HS, high_speed_reg);
 +	} else {
 +		ret = mtk_i2c_calculate_speed(clk_src, priv->speed,
 +					      &step_cnt, &sample_cnt);
 +		if (ret < 0)
 +			goto exit;
 +
 +		timing_reg = (sample_cnt << TIMING_SAMPLE_OFFSET) | step_cnt;
 +		/* Disable the high speed transaction */
 +		high_speed_reg = I2C_TIME_CLR_VALUE;
 +		i2c_writel(priv, REG_TIMING, timing_reg);
 +		i2c_writel(priv, REG_HS, high_speed_reg);
 +	}
 +exit:
 +	if (mtk_i2c_clk_disable(priv))
 +		return log_msg_ret("set_speed disable clk", -1);
 +
 +	return ret;
 +}
 +
 +/*
 + * mtk_i2c_do_transfer
 + *
 + * @par Description
 + *     Configure i2c register and trigger transfer.
 + * @param[in]
 + *     priv: mtk_i2cmtk_i2c_priv pointer, struct mtk_i2c_priv contains register base\n
 + *     address, operation mode, interrupt status and i2c driver data.
 + * @param[in]
 + *     msgs: i2c_msg pointer, struct i2c_msg contains slave\n
 + *     address, operation mode, msg length and data buffer.
 + * @param[in]
 + *     num: i2c_msg number.
 + * @param[in]
 + *     left_num: left i2c_msg number.
 + * @return
 + *     0, i2c transfer successfully.\n
 + *     -ETIMEDOUT, i2c transfer timeout.\n
 + *     -EREMOTEIO, i2c transfer ack error.
 + */
 +static int mtk_i2c_do_transfer(struct mtk_i2c_priv *priv,
 +			       struct i2c_msg *msgs,
 +			       int num, int left_num)
 +{
 +	struct i2c_msg *msg_rx = NULL;
 +	uint restart_flag = 0;
 +	uint trans_error = 0;
 +	uint irq_stat = 0;
 +	uint tmo_poll = 0;
 +	uint control_reg;
 +	bool tmo = false;
 +	uint start_reg;
 +	uint addr_reg;
 +	int ret = 0;
 +
 +	if (priv->auto_restart)
 +		restart_flag = I2C_RS_TRANSFER;
 +
 +	control_reg = i2c_readl(priv, REG_CONTROL) &
 +		~(I2C_CONTROL_DIR_CHANGE | I2C_CONTROL_RS);
 +
 +	if (priv->speed > MAX_FS_MODE_SPEED || num > 1)
 +		control_reg |= I2C_CONTROL_RS;
 +
 +	if (priv->op == I2C_MASTER_WRRD)
 +		control_reg |= I2C_CONTROL_DIR_CHANGE | I2C_CONTROL_RS;
 +
 +	control_reg |= I2C_CONTROL_DMA_EN;
 +	i2c_writel(priv, REG_CONTROL, control_reg);
 +
 +	/* set start condition */
 +	if (priv->speed <= MAX_ST_MODE_SPEED)
 +		i2c_writel(priv, REG_EXT_CONF, I2C_ST_START_CON);
 +	else
 +		i2c_writel(priv, REG_EXT_CONF, I2C_FS_START_CON);
 +
 +	addr_reg = msgs->addr << 1;
 +	if (priv->op == I2C_MASTER_RD)
 +		addr_reg |= I2C_M_RD;
 +	if (priv->zero_len)
 +		i2c_writel(priv, REG_SLAVE_ADDR, addr_reg | TRANS_ADDR_ONLY);
 +	else
 +		i2c_writel(priv, REG_SLAVE_ADDR, addr_reg);
 +
 +	/* clear interrupt status */
 +	i2c_writel(priv, REG_INTR_STAT, restart_flag | I2C_HS_NACKERR |
 +		   I2C_ACKERR | I2C_TRANSAC_COMP);
 +	i2c_writel(priv, REG_FIFO_ADDR_CLR, I2C_FIFO_ADDR_CLR);
 +
 +	/* enable interrupt */
 +	i2c_writel(priv, REG_INTR_MASK, restart_flag | I2C_HS_NACKERR |
 +		   I2C_ACKERR | I2C_TRANSAC_COMP);
 +
 +	/* set transfer and transaction len */
 +	if (priv->op == I2C_MASTER_WRRD) {
 +		i2c_writel(priv, REG_TRANSFER_LEN, msgs->len);
 +		i2c_writel(priv, REG_TRANSFER_LEN_AUX, (msgs + 1)->len);
 +		i2c_writel(priv, REG_TRANSAC_LEN, I2C_WRRD_TRANAC_VALUE);
 +	} else {
 +		i2c_writel(priv, REG_TRANSFER_LEN, msgs->len);
 +		i2c_writel(priv, REG_TRANSAC_LEN, num);
 +	}
 +
 +	/* Clear DMA interrupt flag */
 +	writel(I2C_DMA_INT_FLAG_NONE, priv->pdmabase + REG_INT_FLAG);
 +
 +	/* Flush cache for first msg */
 +	flush_cache((ulong)msgs->buf, msgs->len);
 +
 +	/*
 +	 * prepare buffer data to start transfer
 +	 * three cases here: read, write, write then read
 +	 */
 +	if (priv->op & I2C_MASTER_WR) {
 +		/* Set DMA direction TX (w/ or w/o RX) */
 +		writel(I2C_DMA_CON_TX, priv->pdmabase + REG_CON);
 +
 +		/* Write the tx buffer address to dma register */
 +		writel((ulong)msgs->buf, priv->pdmabase + REG_TX_MEM_ADDR);
 +		/* Write the tx length to dma register */
 +		writel(msgs->len, priv->pdmabase + REG_TX_LEN);
 +
 +		if (priv->op & I2C_MASTER_RD) {
 +			/* write then read */
 +			msg_rx = msgs + 1;
 +
 +			/* Flush cache for second msg */
 +			flush_cache((ulong)msg_rx->buf, msg_rx->len);
 +		}
 +	}
 +
 +	if (priv->op & I2C_MASTER_RD) {
 +		if (!msg_rx) {
 +			/* Set DMA direction RX */
 +			writel(I2C_DMA_CON_RX, priv->pdmabase + REG_CON);
 +
 +			msg_rx = msgs;
 +		}
 +
 +		/* Write the rx buffer address to dma register */
 +		writel((ulong)msg_rx->buf, priv->pdmabase + REG_RX_MEM_ADDR);
 +		/* Write the rx length to dma register */
 +		writel(msg_rx->len, priv->pdmabase + REG_RX_LEN);
 +	}
 +
 +	writel(I2C_DMA_START_EN, priv->pdmabase + REG_EN);
 +
 +	if (!priv->auto_restart) {
 +		start_reg = I2C_TRANSAC_START;
 +	} else {
 +		start_reg = I2C_TRANSAC_START | I2C_RS_MUL_TRIG;
 +		if (left_num >= 1)
 +			start_reg |= I2C_RS_MUL_CNFG;
 +	}
 +	i2c_writel(priv, REG_START, start_reg);
 +
 +	for (;;) {
 +		irq_stat = i2c_readl(priv, REG_INTR_STAT);
 +
 +		/* ignore the first restart irq after the master code */
 +		if (priv->ignore_restart_irq && (irq_stat & restart_flag)) {
 +			priv->ignore_restart_irq = false;
 +			irq_stat = 0;
 +			i2c_writel(priv, REG_START, I2C_RS_MUL_CNFG |
 +				   I2C_RS_MUL_TRIG | I2C_TRANSAC_START);
 +		}
 +
 +		if (irq_stat & (I2C_TRANSAC_COMP | restart_flag)) {
 +			tmo = false;
 +			if (irq_stat & (I2C_HS_NACKERR | I2C_ACKERR))
 +				trans_error = 1;
 +
 +			break;
 +		}
 +		udelay(1);
 +		if (tmo_poll++ >= TRANSFER_TIMEOUT) {
 +			tmo = true;
 +			break;
 +		}
 +	}
 +
 +	/* clear interrupt mask */
 +	i2c_writel(priv, REG_INTR_MASK, ~(restart_flag | I2C_HS_NACKERR |
 +		  I2C_ACKERR | I2C_TRANSAC_COMP));
 +
 +	if (!tmo && trans_error != 0) {
 +		if (tmo) {
 +			ret = -ETIMEDOUT;
 +			if (!priv->filter_msg)
 +				debug("I2C timeout! addr: 0x%x,\n", msgs->addr);
 +		} else {
 +			ret = -EREMOTEIO;
 +			if (!priv->filter_msg)
 +				debug("I2C ACKERR! addr: 0x%x,IRQ:0x%x\n",
 +				      msgs->addr, irq_stat);
 +		}
 +		mtk_i2c_init_hw(priv);
 +	}
 +
 +	return ret;
 +}
 +
 +/*
 + * mtk_i2c_transfer
 + *
 + * @par Description
 + *     Common i2c transfer API. Set i2c transfer mode according to i2c_msg\n
 + *     information, then call mtk_i2c_do_transfer() to configure i2c register\n
 + *     and trigger transfer.
 + * @param[in]
 + *     dev: udevice pointer, struct udevice contains struct mtk_i2c_priv, \n
 + *	   struct mtk_i2c_priv contains register base\n
 + *     address, operation mode, interrupt status and i2c driver data.
 + * @param[in]
 + *     msgs: i2c_msg pointer, struct i2c_msg contains slave\n
 + *     address, operation mode, msg length and data buffer.
 + * @param[in]
 + *     num: i2c_msg number.
 + * @return
 + *     i2c_msg number, i2c transfer successfully.\n
 + *     -EINVAL, msg length is more than 16\n
 + *     use DMA MODE or slave address more than 0x7f.\n
 + *     error code from mtk_i2c_init_base().\n
 + *     error code from mtk_i2c_set_speed().\n
 + *     error code from mtk_i2c_do_transfer().
 + */
 +static int mtk_i2c_transfer(struct udevice *dev, struct i2c_msg *msg,
 +			    int nmsgs)
 +{
 +	struct mtk_i2c_priv *priv = dev_get_priv(dev);
 +	int left_num;
 +	uint num_cnt;
 +	int ret;
 +
 +	priv->auto_restart = true;
 +	left_num = nmsgs;
 +	if (mtk_i2c_clk_enable(priv))
 +		return log_msg_ret("transfer enable clk", -1);
 +
 +	for (num_cnt = 0; num_cnt < nmsgs; num_cnt++) {
 +		if (((msg + num_cnt)->addr) > MAX_I2C_ADDR) {
 +			ret = -EINVAL;
 +			goto err_exit;
 +		}
 +		if ((msg + num_cnt)->len > MAX_I2C_LEN) {
 +			ret = -EINVAL;
 +			goto err_exit;
 +		}
 +	}
 +
 +	/* check if we can skip restart and optimize using WRRD mode */
 +	if (priv->auto_restart && nmsgs == 2) {
 +		if (!(msg[0].flags & I2C_M_RD) && (msg[1].flags & I2C_M_RD) &&
 +		    msg[0].addr == msg[1].addr) {
 +			priv->auto_restart = false;
 +		}
 +	}
 +
 +	if (priv->auto_restart && nmsgs >= 2 && priv->speed > MAX_FS_MODE_SPEED)
 +		/* ignore the first restart irq after the master code,
 +		 * otherwise the first transfer will be discarded.
 +		 */
 +		priv->ignore_restart_irq = true;
 +	else
 +		priv->ignore_restart_irq = false;
 +
 +	while (left_num--) {
 +		/* transfer slave address only to support devices detect */
 +		if (!msg->buf)
 +			priv->zero_len = true;
 +		else
 +			priv->zero_len = false;
 +
 +		if (msg->flags & I2C_M_RD)
 +			priv->op = I2C_MASTER_RD;
 +		else
 +			priv->op = I2C_MASTER_WR;
 +
 +		if (!priv->auto_restart) {
 +			if (nmsgs > 1) {
 +				/* combined two messages into one transaction */
 +				priv->op = I2C_MASTER_WRRD;
 +				left_num--;
 +			}
 +		}
 +		ret = mtk_i2c_do_transfer(priv, msg, nmsgs, left_num);
 +		if (ret < 0)
 +			goto err_exit;
 +		msg++;
 +	}
 +	ret = 0;
 +
 +err_exit:
 +	if (mtk_i2c_clk_disable(priv))
 +		return log_msg_ret("transfer disable clk", -1);
 +
 +	return ret;
 +}
 +
 +static int mtk_i2c_of_to_plat(struct udevice *dev)
 +{
 +	struct mtk_i2c_priv *priv = dev_get_priv(dev);
 +	int ret;
 +
 +	priv->base = dev_remap_addr_index(dev, 0);
 +	priv->pdmabase = dev_remap_addr_index(dev, 1);
 +	ret = clk_get_by_index(dev, 0, &priv->clk_main);
 +	if (ret)
 +		return log_msg_ret("clk_get_by_index 0", ret);
 +
 +	ret = clk_get_by_index(dev, 1, &priv->clk_dma);
 +
 +	return ret;
 +}
 +
 +static int mtk_i2c_probe(struct udevice *dev)
 +{
 +	struct mtk_i2c_priv *priv = dev_get_priv(dev);
 +
 +	priv->soc_data = (struct mtk_i2c_soc_data *)dev_get_driver_data(dev);
 +
 +	if (mtk_i2c_clk_enable(priv))
 +		return log_msg_ret("probe enable clk", -1);
 +
 +	mtk_i2c_init_hw(priv);
 +
 +	if (mtk_i2c_clk_disable(priv))
 +		return log_msg_ret("probe disable clk", -1);
 +
 +	return 0;
 +}
 +
 +static int mtk_i2c_deblock(struct udevice *dev)
 +{
 +	struct mtk_i2c_priv *priv = dev_get_priv(dev);
 +
 +	if (mtk_i2c_clk_enable(priv))
 +		return log_msg_ret("deblock enable clk", -1);
 +
 +	mtk_i2c_init_hw(priv);
 +
 +	if (mtk_i2c_clk_disable(priv))
 +		return log_msg_ret("deblock disable clk", -1);
 +
 +	return 0;
 +}
 +
 +static const struct mtk_i2c_soc_data mt76xx_soc_data = {
 +	.regs = mt_i2c_regs_v1,
 +	.dma_sync = 0,
 +};
 +
 +static const struct mtk_i2c_soc_data mt7981_soc_data = {
 +	.regs = mt_i2c_regs_v1,
 +	.dma_sync = 1,
 +};
 +
 +static const struct mtk_i2c_soc_data mt7986_soc_data = {
 +	.regs = mt_i2c_regs_v1,
 +	.dma_sync = 1,
 +};
 +
 +static const struct mtk_i2c_soc_data mt8183_soc_data = {
 +	.regs = mt_i2c_regs_v2,
 +	.dma_sync = 1,
 +};
 +
 +static const struct mtk_i2c_soc_data mt8518_soc_data = {
 +	.regs = mt_i2c_regs_v1,
 +	.dma_sync = 0,
 +};
 +
 +static const struct mtk_i2c_soc_data mt8512_soc_data = {
 +	.regs = mt_i2c_regs_v1,
 +	.dma_sync = 1,
 +};
 +
 +static const struct dm_i2c_ops mtk_i2c_ops = {
 +	.xfer		= mtk_i2c_transfer,
 +	.set_bus_speed	= mtk_i2c_set_speed,
 +	.deblock	= mtk_i2c_deblock,
 +};
 +
 +static const struct udevice_id mtk_i2c_ids[] = {
 +	{
 +		.compatible = "mediatek,mt7622-i2c",
 +		.data = (ulong)&mt76xx_soc_data,
 +	}, {
 +		.compatible = "mediatek,mt7623-i2c",
 +		.data = (ulong)&mt76xx_soc_data,
 +	}, {
 +		.compatible = "mediatek,mt7629-i2c",
 +		.data = (ulong)&mt76xx_soc_data,
 +	}, {
 +		.compatible = "mediatek,mt7981-i2c",
 +		.data = (ulong)&mt7981_soc_data,
 +	}, {
 +		.compatible = "mediatek,mt7986-i2c",
 +		.data = (ulong)&mt7986_soc_data,
 +	}, {
 +		.compatible = "mediatek,mt8183-i2c",
 +		.data = (ulong)&mt8183_soc_data,
 +	}, {
 +		.compatible = "mediatek,mt8512-i2c",
 +		.data = (ulong)&mt8512_soc_data,
 +	}, {
 +		.compatible = "mediatek,mt8518-i2c",
 +		.data = (ulong)&mt8518_soc_data,
 +	}
 +};
 +
 +U_BOOT_DRIVER(mtk_i2c) = {
 +	.name		= "mtk_i2c",
 +	.id		= UCLASS_I2C,
 +	.of_match	= mtk_i2c_ids,
 +	.of_to_plat	= mtk_i2c_of_to_plat,
 +	.probe		= mtk_i2c_probe,
 +	.priv_auto	= sizeof(struct mtk_i2c_priv),
 +	.ops		= &mtk_i2c_ops,
 +};
--- a/package/boot/uboot-mediatek/patches/002-0018-arm-dts-mt7622-add-i2c-support.patch
+++ b/package/boot/uboot-mediatek/patches/002-0018-arm-dts-mt7622-add-i2c-support.patch
@@ -0,0 +1,76 @@
 From 9ae337317d5634569bda83dfc5e0658fce34b1e2 Mon Sep 17 00:00:00 2001
 From: Weijie Gao <weijie.gao@mediatek.com>
 Date: Mon, 25 Jul 2022 16:30:30 +0800
 Subject: [PATCH 18/31] arm: dts: mt7622: add i2c support
 Add both hardware and software i2c support for mt7622.
 Reviewed-by: Simon Glass <sjg@chromium.org>
 Signed-off-by: Weijie Gao <weijie.gao@mediatek.com>
 ---
 arch/arm/dts/mt7622-rfb.dts | 18 ++++++++++++++++++
 arch/arm/dts/mt7622.dtsi    | 24 ++++++++++++++++++++++++
 2 files changed, 42 insertions(+)
 --- a/arch/arm/dts/mt7622-rfb.dts
 +++ b/arch/arm/dts/mt7622-rfb.dts
@@ -159,6 +159,14 @@
 		};
 	};
 +
 +	i2c1_pins_default: i2c1-default {
 +		mux {
 +			function = "i2c";
 +			groups = "i2c1_0";
 +		};
 +	};
 +
 };
 &snfi {
@@ -249,3 +257,13 @@
 &u3phy {
        status = "okay";
 };
 +
 +&soft_i2c {
 +	status = "disabled";
 +};
 +
 +&i2c1 {
 +	pinctrl-names = "default";
 +	pinctrl-0 = <&i2c1_pins_default>;
 +	status = "okay";
 +};
 --- a/arch/arm/dts/mt7622.dtsi
 +++ b/arch/arm/dts/mt7622.dtsi
@@ -440,4 +440,28 @@
 		status = "disabled";
 	};
 +	soft_i2c: soft_i2c@0 {
 +		#address-cells = <1>;
 +		#size-cells = <0>;
 +		compatible = "i2c-gpio";
 +		gpios = <&gpio 56 GPIO_ACTIVE_HIGH>, /* SDA */
 +			<&gpio 55 GPIO_ACTIVE_HIGH>; /* CLK */
 +		i2c-gpio,delay-us = <5>;
 +		status = "disabled";
 +	};
 +
 +	i2c1: i2c@11008000 {
 +		compatible = "mediatek,mt7622-i2c";
 +		reg = <0x11008000 0x90>,
 +		      <0x11000180 0x80>;
 +		interrupts = <GIC_SPI 85 IRQ_TYPE_LEVEL_LOW>;
 +		clock-div = <16>;
 +		clocks = <&pericfg CLK_PERI_I2C1_PD>,
 +			 <&pericfg CLK_PERI_AP_DMA_PD>;
 +		clock-names = "main", "dma";
 +		#address-cells = <1>;
 +		#size-cells = <0>;
 +		status = "disabled";
 +	};
 +
 };
--- a/package/boot/uboot-mediatek/patches/002-0019-dt-bindings-pinctrl-mediatek-add-a-header-for-common.patch
+++ b/package/boot/uboot-mediatek/patches/002-0019-dt-bindings-pinctrl-mediatek-add-a-header-for-common.patch
@@ -0,0 +1,60 @@
 From 920ba7b9ba1787fd03dad7a5bdc894073936c197 Mon Sep 17 00:00:00 2001
 From: Weijie Gao <weijie.gao@mediatek.com>
 Date: Thu, 28 Jul 2022 09:37:26 +0800
 Subject: [PATCH 19/31] dt-bindings: pinctrl: mediatek: add a header for common
 pinconf parameters
 This patch adds a pinctrl header for common pinconf parameters such as
 pull-up/pull-down resistors and drive strengths.
 Reviewed-by: Simon Glass <sjg@chromium.org>
 Signed-off-by: Weijie Gao <weijie.gao@mediatek.com>
 ---
 include/dt-bindings/pinctrl/mt65xx.h | 41 ++++++++++++++++++++++++++++
 1 file changed, 41 insertions(+)
 create mode 100644 include/dt-bindings/pinctrl/mt65xx.h
 --- /dev/null
 +++ b/include/dt-bindings/pinctrl/mt65xx.h
@@ -0,0 +1,41 @@
 +/* SPDX-License-Identifier: GPL-2.0-only */
 +/*
 + * Copyright (c) 2022 MediaTek Inc.
 + * Author: Hongzhou.Yang <hongzhou.yang@mediatek.com>
 + */
 +
 +#ifndef _DT_BINDINGS_PINCTRL_MT65XX_H
 +#define _DT_BINDINGS_PINCTRL_MT65XX_H
 +
 +#define MTK_PIN_NO(x)		((x) << 8)
 +#define MTK_GET_PIN_NO(x)	((x) >> 8)
 +#define MTK_GET_PIN_FUNC(x)	((x) & 0xf)
 +
 +#define MTK_PUPD_SET_R1R0_00	100
 +#define MTK_PUPD_SET_R1R0_01	101
 +#define MTK_PUPD_SET_R1R0_10	102
 +#define MTK_PUPD_SET_R1R0_11	103
 +
 +#define MTK_PULL_SET_RSEL_000	200
 +#define MTK_PULL_SET_RSEL_001	201
 +#define MTK_PULL_SET_RSEL_010	202
 +#define MTK_PULL_SET_RSEL_011	203
 +#define MTK_PULL_SET_RSEL_100	204
 +#define MTK_PULL_SET_RSEL_101	205
 +#define MTK_PULL_SET_RSEL_110	206
 +#define MTK_PULL_SET_RSEL_111	207
 +
 +#define MTK_DRIVE_2mA		2
 +#define MTK_DRIVE_4mA		4
 +#define MTK_DRIVE_6mA		6
 +#define MTK_DRIVE_8mA		8
 +#define MTK_DRIVE_10mA		10
 +#define MTK_DRIVE_12mA		12
 +#define MTK_DRIVE_14mA		14
 +#define MTK_DRIVE_16mA		16
 +#define MTK_DRIVE_20mA		20
 +#define MTK_DRIVE_24mA		24
 +#define MTK_DRIVE_28mA		28
 +#define MTK_DRIVE_32mA		32
 +
 +#endif /* _DT_BINDINGS_PINCTRL_MT65XX_H */
--- a/package/boot/uboot-mediatek/patches/002-0020-pinctrl-mediatek-add-pinctrl-driver-for-MT7981-SoC.patch
+++ b/package/boot/uboot-mediatek/patches/002-0020-pinctrl-mediatek-add-pinctrl-driver-for-MT7981-SoC.patch
--- a/package/boot/uboot-mediatek/patches/002-0021-pinctrl-mediatek-add-pinctrl-driver-for-MT7986-SoC.patch
+++ b/package/boot/uboot-mediatek/patches/002-0021-pinctrl-mediatek-add-pinctrl-driver-for-MT7986-SoC.patch
@@ -0,0 +1,817 @@
 From a018800db986d63cf95b0779ebb33b5e246072a7 Mon Sep 17 00:00:00 2001
 From: Weijie Gao <weijie.gao@mediatek.com>
 Date: Thu, 28 Jul 2022 10:01:00 +0800
 Subject: [PATCH 21/31] pinctrl: mediatek: add pinctrl driver for MT7986 SoC
 This patch adds pinctrl and gpio support for MT7986 SoC
 Reviewed-by: Simon Glass <sjg@chromium.org>
 Signed-off-by: Weijie Gao <weijie.gao@mediatek.com>
 ---
 drivers/pinctrl/mediatek/Kconfig          |   4 +
 drivers/pinctrl/mediatek/Makefile         |   1 +
 drivers/pinctrl/mediatek/pinctrl-mt7986.c | 775 ++++++++++++++++++++++
 3 files changed, 780 insertions(+)
 create mode 100644 drivers/pinctrl/mediatek/pinctrl-mt7986.c
 --- a/drivers/pinctrl/mediatek/Kconfig
 +++ b/drivers/pinctrl/mediatek/Kconfig
@@ -20,6 +20,10 @@ config PINCTRL_MT7981
 	bool "MT7981 SoC pinctrl driver"
 	select PINCTRL_MTK
 +config PINCTRL_MT7986
 +	bool "MT7986 SoC pinctrl driver"
 +	select PINCTRL_MTK
 +
 config PINCTRL_MT8512
 	bool "MT8512 SoC pinctrl driver"
 	select PINCTRL_MTK
 --- a/drivers/pinctrl/mediatek/Makefile
 +++ b/drivers/pinctrl/mediatek/Makefile
@@ -7,6 +7,7 @@ obj-$(CONFIG_PINCTRL_MT7622) += pinctrl-
 obj-$(CONFIG_PINCTRL_MT7623) += pinctrl-mt7623.o
 obj-$(CONFIG_PINCTRL_MT7629) += pinctrl-mt7629.o
 obj-$(CONFIG_PINCTRL_MT7981) += pinctrl-mt7981.o
 +obj-$(CONFIG_PINCTRL_MT7986) += pinctrl-mt7986.o
 obj-$(CONFIG_PINCTRL_MT8512) += pinctrl-mt8512.o
 obj-$(CONFIG_PINCTRL_MT8516) += pinctrl-mt8516.o
 obj-$(CONFIG_PINCTRL_MT8518) += pinctrl-mt8518.o
 --- /dev/null
 +++ b/drivers/pinctrl/mediatek/pinctrl-mt7986.c
@@ -0,0 +1,775 @@
 +// SPDX-License-Identifier: GPL-2.0
 +/*
 + * The MT7986 driver based on Linux generic pinctrl binding.
 + *
 + * Copyright (C) 2022 MediaTek Inc.
 + * Author: Sam Shih <sam.shih@mediatek.com>
 + */
 +
 +#include <dm.h>
 +#include "pinctrl-mtk-common.h"
 +
 +#define MT7986_TYPE0_PIN(_number, _name)	\
 +	MTK_TYPED_PIN(_number, _name, DRV_GRP4, IO_TYPE_GRP0)
 +
 +#define MT7986_TYPE1_PIN(_number, _name)	\
 +	MTK_TYPED_PIN(_number, _name, DRV_GRP4, IO_TYPE_GRP1)
 +
 +#define PIN_FIELD_GPIO(_s_pin, _e_pin, _s_addr, _x_addrs, _s_bit, _x_bits)	\
 +	PIN_FIELD_BASE_CALC(_s_pin, _e_pin, GPIO_BASE, _s_addr, _x_addrs,	\
 +			    _s_bit, _x_bits, 32, 0)
 +
 +#define PIN_FIELD_BASE(_s_pin, _e_pin, _i_base, _s_addr, _x_addrs, _s_bit,	\
 +		       _x_bits)							\
 +	PIN_FIELD_BASE_CALC(_s_pin, _e_pin, _i_base, _s_addr, _x_addrs, _s_bit,	\
 +	_x_bits, 32, 0)
 +
 +/**
 + * enum - Locking variants of the iocfg bases
 + *
 + * MT7986 have multiple bases to program pin configuration listed as the below:
 + * iocfg_rt:0x11c30000, iocfg_rb:0x11c40000, iocfg_lt:0x11e20000,
 + * iocfg_lb:0x11e30000, iocfg_tr:0x11f00000, iocfg_tl:0x11f10000,
 + * _i_based could be used to indicate what base the pin should be mapped into.
 + *
 + * Each iocfg register base control different group of pads on the SoC
 + *
 + *
 + *  chip carrier
 + *
 + *      A  B  C  D  E  F  G  H
 + *    +------------------------+
 + *  8 | o  o  o  o  o  o  o  o |
 + *  7 | o  o  o  o  o  o  o  o |
 + *  6 | o  o  o  o  o  o  o  o |
 + *  5 | o  o  o  o  o  o  o  o |
 + *  4 | o  o  o  o  o  o  o  o |
 + *  3 | o  o  o  o  o  o  o  o |
 + *  2 | o  o  o  o  o  o  o  o |
 + *  1 | o  o  o  o  o  o  o  o |
 + *    +------------------------+
 + *
 + *  inside Chip carrier
 + *
 + *      A  B  C  D  E  F  G  H
 + *    +------------------------+
 + *  8 |                        |
 + *  7 |        TL  TR          |
 + *  6 |      +---------+       |
 + *  5 |   LT |         | RT    |
 + *  4 |      |         |       |
 + *  3 |   LB |         | RB    |
 + *  2 |      +---------+       |
 + *  1 |                        |
 + *    +------------------------+
 + *
 + */
 +
 +enum {
 +	GPIO_BASE,
 +	IOCFG_RT_BASE,
 +	IOCFG_RB_BASE,
 +	IOCFG_LT_BASE,
 +	IOCFG_LB_BASE,
 +	IOCFG_TR_BASE,
 +	IOCFG_TL_BASE,
 +};
 +
 +static const char *const mt7986_pinctrl_register_base_names[] = {
 +	"gpio", "iocfg_rt", "iocfg_rb", "iocfg_lt", "iocfg_lb", "iocfg_tr",
 +	"iocfg_tl",
 +};
 +
 +static const struct mtk_pin_field_calc mt7986_pin_mode_range[] = {
 +	PIN_FIELD_GPIO(0, 100, 0x300, 0x10, 0, 4),
 +};
 +
 +static const struct mtk_pin_field_calc mt7986_pin_dir_range[] = {
 +	PIN_FIELD_GPIO(0, 100, 0x0, 0x10, 0, 1),
 +};
 +
 +static const struct mtk_pin_field_calc mt7986_pin_di_range[] = {
 +	PIN_FIELD_GPIO(0, 100, 0x200, 0x10, 0, 1),
 +};
 +
 +static const struct mtk_pin_field_calc mt7986_pin_do_range[] = {
 +	PIN_FIELD_GPIO(0, 100, 0x100, 0x10, 0, 1),
 +};
 +
 +static const struct mtk_pin_field_calc mt7986_pin_ies_range[] = {
 +	PIN_FIELD_BASE(0, 0, IOCFG_RB_BASE, 0x40, 0x10, 17, 1),
 +	PIN_FIELD_BASE(1, 2, IOCFG_LT_BASE, 0x20, 0x10, 10, 1),
 +	PIN_FIELD_BASE(3, 4, IOCFG_LB_BASE, 0x20, 0x10, 0, 1),
 +	PIN_FIELD_BASE(5, 6, IOCFG_RB_BASE, 0x40, 0x10, 0, 1),
 +	PIN_FIELD_BASE(7, 10, IOCFG_LT_BASE, 0x20, 0x10, 0, 1),
 +	PIN_FIELD_BASE(11, 14, IOCFG_RB_BASE, 0x40, 0x10, 8, 1),
 +	PIN_FIELD_BASE(15, 20, IOCFG_RB_BASE, 0x40, 0x10, 2, 1),
 +	PIN_FIELD_BASE(21, 23, IOCFG_RT_BASE, 0x30, 0x10, 12, 1),
 +	PIN_FIELD_BASE(24, 24, IOCFG_RT_BASE, 0x30, 0x10, 18, 1),
 +	PIN_FIELD_BASE(25, 25, IOCFG_RT_BASE, 0x30, 0x10, 17, 1),
 +	PIN_FIELD_BASE(26, 27, IOCFG_RT_BASE, 0x30, 0x10, 15, 1),
 +	PIN_FIELD_BASE(28, 29, IOCFG_RT_BASE, 0x30, 0x10, 19, 1),
 +	PIN_FIELD_BASE(30, 30, IOCFG_RT_BASE, 0x30, 0x10, 23, 1),
 +	PIN_FIELD_BASE(31, 31, IOCFG_RT_BASE, 0x30, 0x10, 22, 1),
 +	PIN_FIELD_BASE(32, 32, IOCFG_RT_BASE, 0x30, 0x10, 21, 1),
 +	PIN_FIELD_BASE(33, 33, IOCFG_LT_BASE, 0x20, 0x10, 4, 1),
 +	PIN_FIELD_BASE(34, 34, IOCFG_LT_BASE, 0x20, 0x10, 8, 1),
 +	PIN_FIELD_BASE(35, 35, IOCFG_LT_BASE, 0x20, 0x10, 7, 1),
 +	PIN_FIELD_BASE(36, 37, IOCFG_LT_BASE, 0x20, 0x10, 5, 1),
 +	PIN_FIELD_BASE(38, 38, IOCFG_LT_BASE, 0x20, 0x10, 9, 1),
 +	PIN_FIELD_BASE(39, 40, IOCFG_RB_BASE, 0x40, 0x10, 18, 1),
 +	PIN_FIELD_BASE(41, 41, IOCFG_RB_BASE, 0x40, 0x10, 12, 1),
 +	PIN_FIELD_BASE(42, 43, IOCFG_RB_BASE, 0x40, 0x10, 22, 1),
 +	PIN_FIELD_BASE(44, 45, IOCFG_RB_BASE, 0x40, 0x10, 20, 1),
 +	PIN_FIELD_BASE(46, 47, IOCFG_RB_BASE, 0x40, 0x10, 26, 1),
 +	PIN_FIELD_BASE(48, 49, IOCFG_RB_BASE, 0x40, 0x10, 24, 1),
 +	PIN_FIELD_BASE(50, 57, IOCFG_RT_BASE, 0x30, 0x10, 2, 1),
 +	PIN_FIELD_BASE(58, 58, IOCFG_RT_BASE, 0x30, 0x10, 1, 1),
 +	PIN_FIELD_BASE(59, 59, IOCFG_RT_BASE, 0x30, 0x10, 0, 1),
 +	PIN_FIELD_BASE(60, 61, IOCFG_RT_BASE, 0x30, 0x10, 10, 1),
 +	PIN_FIELD_BASE(62, 62, IOCFG_RB_BASE, 0x40, 0x10, 15, 1),
 +	PIN_FIELD_BASE(63, 63, IOCFG_RB_BASE, 0x40, 0x10, 14, 1),
 +	PIN_FIELD_BASE(64, 64, IOCFG_RB_BASE, 0x40, 0x10, 13, 1),
 +	PIN_FIELD_BASE(65, 65, IOCFG_RB_BASE, 0x40, 0x10, 16, 1),
 +	PIN_FIELD_BASE(66, 68, IOCFG_LB_BASE, 0x20, 0x10, 2, 1),
 +	PIN_FIELD_BASE(69, 69, IOCFG_TR_BASE, 0x30, 0x10, 1, 1),
 +	PIN_FIELD_BASE(70, 70, IOCFG_TR_BASE, 0x30, 0x10, 0, 1),
 +	PIN_FIELD_BASE(71, 71, IOCFG_TR_BASE, 0x30, 0x10, 16, 1),
 +	PIN_FIELD_BASE(72, 73, IOCFG_TR_BASE, 0x30, 0x10, 14, 1),
 +	PIN_FIELD_BASE(74, 74, IOCFG_TR_BASE, 0x30, 0x10, 4, 1),
 +	PIN_FIELD_BASE(75, 77, IOCFG_TR_BASE, 0x30, 0x10, 6, 1),
 +	PIN_FIELD_BASE(78, 79, IOCFG_TR_BASE, 0x30, 0x10, 2, 1),
 +	PIN_FIELD_BASE(80, 84, IOCFG_TR_BASE, 0x30, 0x10, 9, 1),
 +	PIN_FIELD_BASE(85, 85, IOCFG_TR_BASE, 0x30, 0x10, 5, 1),
 +	PIN_FIELD_BASE(86, 86, IOCFG_TL_BASE, 0x30, 0x10, 1, 1),
 +	PIN_FIELD_BASE(87, 87, IOCFG_TL_BASE, 0x30, 0x10, 0, 1),
 +	PIN_FIELD_BASE(88, 88, IOCFG_TL_BASE, 0x30, 0x10, 14, 1),
 +	PIN_FIELD_BASE(89, 90, IOCFG_TL_BASE, 0x30, 0x10, 12, 1),
 +	PIN_FIELD_BASE(91, 94, IOCFG_TL_BASE, 0x30, 0x10, 4, 1),
 +	PIN_FIELD_BASE(95, 96, IOCFG_TL_BASE, 0x30, 0x10, 2, 1),
 +	PIN_FIELD_BASE(97, 100, IOCFG_TL_BASE, 0x30, 0x10, 8, 1),
 +};
 +
 +static const struct mtk_pin_field_calc mt7986_pin_smt_range[] = {
 +	PIN_FIELD_BASE(0, 0, IOCFG_RB_BASE, 0xf0, 0x10, 17, 1),
 +	PIN_FIELD_BASE(1, 2, IOCFG_LT_BASE, 0x90, 0x10, 10, 1),
 +	PIN_FIELD_BASE(3, 4, IOCFG_LB_BASE, 0x90, 0x10, 0, 1),
 +	PIN_FIELD_BASE(5, 6, IOCFG_RB_BASE, 0xf0, 0x10, 0, 1),
 +	PIN_FIELD_BASE(7, 10, IOCFG_LT_BASE, 0x90, 0x10, 0, 1),
 +	PIN_FIELD_BASE(11, 14, IOCFG_RB_BASE, 0xf0, 0x10, 8, 1),
 +	PIN_FIELD_BASE(15, 20, IOCFG_RB_BASE, 0xf0, 0x10, 2, 1),
 +	PIN_FIELD_BASE(21, 23, IOCFG_RT_BASE, 0xc0, 0x10, 12, 1),
 +	PIN_FIELD_BASE(24, 24, IOCFG_RT_BASE, 0xc0, 0x10, 18, 1),
 +	PIN_FIELD_BASE(25, 25, IOCFG_RT_BASE, 0xc0, 0x10, 17, 1),
 +	PIN_FIELD_BASE(26, 27, IOCFG_RT_BASE, 0xc0, 0x10, 15, 1),
 +	PIN_FIELD_BASE(28, 29, IOCFG_RT_BASE, 0xc0, 0x10, 19, 1),
 +	PIN_FIELD_BASE(30, 30, IOCFG_RT_BASE, 0xc0, 0x10, 23, 1),
 +	PIN_FIELD_BASE(31, 31, IOCFG_RT_BASE, 0xc0, 0x10, 22, 1),
 +	PIN_FIELD_BASE(32, 32, IOCFG_RT_BASE, 0xc0, 0x10, 21, 1),
 +	PIN_FIELD_BASE(33, 33, IOCFG_LT_BASE, 0x90, 0x10, 4, 1),
 +	PIN_FIELD_BASE(34, 34, IOCFG_LT_BASE, 0x90, 0x10, 8, 1),
 +	PIN_FIELD_BASE(35, 35, IOCFG_LT_BASE, 0x90, 0x10, 7, 1),
 +	PIN_FIELD_BASE(36, 37, IOCFG_LT_BASE, 0x90, 0x10, 5, 1),
 +	PIN_FIELD_BASE(38, 38, IOCFG_LT_BASE, 0x90, 0x10, 9, 1),
 +	PIN_FIELD_BASE(39, 40, IOCFG_RB_BASE, 0xf0, 0x10, 18, 1),
 +	PIN_FIELD_BASE(41, 41, IOCFG_RB_BASE, 0xf0, 0x10, 12, 1),
 +	PIN_FIELD_BASE(42, 43, IOCFG_RB_BASE, 0xf0, 0x10, 22, 1),
 +	PIN_FIELD_BASE(44, 45, IOCFG_RB_BASE, 0xf0, 0x10, 20, 1),
 +	PIN_FIELD_BASE(46, 47, IOCFG_RB_BASE, 0xf0, 0x10, 26, 1),
 +	PIN_FIELD_BASE(48, 49, IOCFG_RB_BASE, 0xf0, 0x10, 24, 1),
 +	PIN_FIELD_BASE(50, 57, IOCFG_RT_BASE, 0xc0, 0x10, 2, 1),
 +	PIN_FIELD_BASE(58, 58, IOCFG_RT_BASE, 0xc0, 0x10, 1, 1),
 +	PIN_FIELD_BASE(59, 59, IOCFG_RT_BASE, 0xc0, 0x10, 0, 1),
 +	PIN_FIELD_BASE(60, 61, IOCFG_RT_BASE, 0xc0, 0x10, 10, 1),
 +	PIN_FIELD_BASE(62, 62, IOCFG_RB_BASE, 0xf0, 0x10, 15, 1),
 +	PIN_FIELD_BASE(63, 63, IOCFG_RB_BASE, 0xf0, 0x10, 14, 1),
 +	PIN_FIELD_BASE(64, 64, IOCFG_RB_BASE, 0xf0, 0x10, 13, 1),
 +	PIN_FIELD_BASE(65, 65, IOCFG_RB_BASE, 0xf0, 0x10, 16, 1),
 +	PIN_FIELD_BASE(66, 68, IOCFG_LB_BASE, 0x90, 0x10, 2, 1),
 +	PIN_FIELD_BASE(69, 69, IOCFG_TR_BASE, 0x80, 0x10, 1, 1),
 +	PIN_FIELD_BASE(70, 70, IOCFG_TR_BASE, 0x80, 0x10, 0, 1),
 +	PIN_FIELD_BASE(71, 71, IOCFG_TR_BASE, 0x80, 0x10, 16, 1),
 +	PIN_FIELD_BASE(72, 73, IOCFG_TR_BASE, 0x80, 0x10, 14, 1),
 +	PIN_FIELD_BASE(74, 74, IOCFG_TR_BASE, 0x80, 0x10, 4, 1),
 +	PIN_FIELD_BASE(75, 77, IOCFG_TR_BASE, 0x80, 0x10, 6, 1),
 +	PIN_FIELD_BASE(78, 79, IOCFG_TR_BASE, 0x80, 0x10, 2, 1),
 +	PIN_FIELD_BASE(80, 84, IOCFG_TR_BASE, 0x80, 0x10, 9, 1),
 +	PIN_FIELD_BASE(85, 85, IOCFG_TR_BASE, 0x80, 0x10, 5, 1),
 +	PIN_FIELD_BASE(86, 86, IOCFG_TL_BASE, 0x70, 0x10, 1, 1),
 +	PIN_FIELD_BASE(87, 87, IOCFG_TL_BASE, 0x70, 0x10, 0, 1),
 +	PIN_FIELD_BASE(88, 88, IOCFG_TL_BASE, 0x70, 0x10, 14, 1),
 +	PIN_FIELD_BASE(89, 90, IOCFG_TL_BASE, 0x70, 0x10, 12, 1),
 +	PIN_FIELD_BASE(91, 94, IOCFG_TL_BASE, 0x70, 0x10, 4, 1),
 +	PIN_FIELD_BASE(95, 96, IOCFG_TL_BASE, 0x70, 0x10, 2, 1),
 +	PIN_FIELD_BASE(97, 100, IOCFG_TL_BASE, 0x70, 0x10, 8, 1),
 +};
 +
 +static const struct mtk_pin_field_calc mt7986_pin_pu_range[] = {
 +	PIN_FIELD_BASE(69, 69, IOCFG_TR_BASE, 0x50, 0x10, 1, 1),
 +	PIN_FIELD_BASE(70, 70, IOCFG_TR_BASE, 0x50, 0x10, 0, 1),
 +	PIN_FIELD_BASE(71, 71, IOCFG_TR_BASE, 0x50, 0x10, 16, 1),
 +	PIN_FIELD_BASE(72, 73, IOCFG_TR_BASE, 0x50, 0x10, 14, 1),
 +	PIN_FIELD_BASE(74, 74, IOCFG_TR_BASE, 0x50, 0x10, 4, 1),
 +	PIN_FIELD_BASE(75, 77, IOCFG_TR_BASE, 0x50, 0x10, 6, 1),
 +	PIN_FIELD_BASE(78, 79, IOCFG_TR_BASE, 0x50, 0x10, 2, 1),
 +	PIN_FIELD_BASE(80, 84, IOCFG_TR_BASE, 0x50, 0x10, 9, 1),
 +	PIN_FIELD_BASE(85, 85, IOCFG_TR_BASE, 0x50, 0x10, 5, 1),
 +	PIN_FIELD_BASE(86, 86, IOCFG_TL_BASE, 0x50, 0x10, 1, 1),
 +	PIN_FIELD_BASE(87, 87, IOCFG_TL_BASE, 0x50, 0x10, 0, 1),
 +	PIN_FIELD_BASE(88, 88, IOCFG_TL_BASE, 0x50, 0x10, 14, 1),
 +	PIN_FIELD_BASE(89, 90, IOCFG_TL_BASE, 0x50, 0x10, 12, 1),
 +	PIN_FIELD_BASE(91, 94, IOCFG_TL_BASE, 0x50, 0x10, 4, 1),
 +	PIN_FIELD_BASE(95, 96, IOCFG_TL_BASE, 0x50, 0x10, 2, 1),
 +	PIN_FIELD_BASE(97, 100, IOCFG_TL_BASE, 0x50, 0x10, 8, 1),
 +};
 +
 +static const struct mtk_pin_field_calc mt7986_pin_pd_range[] = {
 +	PIN_FIELD_BASE(69, 69, IOCFG_TR_BASE, 0x40, 0x10, 1, 1),
 +	PIN_FIELD_BASE(70, 70, IOCFG_TR_BASE, 0x40, 0x10, 0, 1),
 +	PIN_FIELD_BASE(71, 71, IOCFG_TR_BASE, 0x40, 0x10, 16, 1),
 +	PIN_FIELD_BASE(72, 73, IOCFG_TR_BASE, 0x40, 0x10, 14, 1),
 +	PIN_FIELD_BASE(74, 74, IOCFG_TR_BASE, 0x40, 0x10, 4, 1),
 +	PIN_FIELD_BASE(75, 77, IOCFG_TR_BASE, 0x40, 0x10, 6, 1),
 +	PIN_FIELD_BASE(78, 79, IOCFG_TR_BASE, 0x40, 0x10, 2, 1),
 +	PIN_FIELD_BASE(80, 84, IOCFG_TR_BASE, 0x40, 0x10, 9, 1),
 +	PIN_FIELD_BASE(85, 85, IOCFG_TR_BASE, 0x40, 0x10, 5, 1),
 +	PIN_FIELD_BASE(86, 86, IOCFG_TL_BASE, 0x40, 0x10, 1, 1),
 +	PIN_FIELD_BASE(87, 87, IOCFG_TL_BASE, 0x40, 0x10, 0, 1),
 +	PIN_FIELD_BASE(88, 88, IOCFG_TL_BASE, 0x40, 0x10, 14, 1),
 +	PIN_FIELD_BASE(89, 90, IOCFG_TL_BASE, 0x40, 0x10, 12, 1),
 +	PIN_FIELD_BASE(91, 94, IOCFG_TL_BASE, 0x40, 0x10, 4, 1),
 +	PIN_FIELD_BASE(95, 96, IOCFG_TL_BASE, 0x40, 0x10, 2, 1),
 +	PIN_FIELD_BASE(97, 100, IOCFG_TL_BASE, 0x40, 0x10, 8, 1),
 +};
 +
 +static const struct mtk_pin_field_calc mt7986_pin_drv_range[] = {
 +	PIN_FIELD_BASE(0, 0, IOCFG_RB_BASE, 0x10, 0x10, 21, 3),
 +	PIN_FIELD_BASE(1, 2, IOCFG_LT_BASE, 0x10, 0x10, 0, 3),
 +	PIN_FIELD_BASE(3, 4, IOCFG_LB_BASE, 0x00, 0x10, 0, 1),
 +	PIN_FIELD_BASE(5, 5, IOCFG_RB_BASE, 0x00, 0x10, 0, 3),
 +	PIN_FIELD_BASE(6, 6, IOCFG_RB_BASE, 0x00, 0x10, 21, 3),
 +	PIN_FIELD_BASE(7, 10, IOCFG_LT_BASE, 0x00, 0x10, 0, 3),
 +	PIN_FIELD_BASE(11, 12, IOCFG_RB_BASE, 0x00, 0x10, 24, 3),
 +	PIN_FIELD_BASE(13, 14, IOCFG_RB_BASE, 0x10, 0x10, 0, 3),
 +	PIN_FIELD_BASE(15, 20, IOCFG_RB_BASE, 0x00, 0x10, 3, 3),
 +	PIN_FIELD_BASE(21, 23, IOCFG_RT_BASE, 0x10, 0x10, 6, 3),
 +	PIN_FIELD_BASE(24, 24, IOCFG_RT_BASE, 0x10, 0x10, 24, 3),
 +	PIN_FIELD_BASE(25, 25, IOCFG_RT_BASE, 0x10, 0x10, 21, 3),
 +	PIN_FIELD_BASE(26, 27, IOCFG_RT_BASE, 0x10, 0x10, 15, 3),
 +	PIN_FIELD_BASE(28, 28, IOCFG_RT_BASE, 0x10, 0x10, 27, 3),
 +	PIN_FIELD_BASE(29, 29, IOCFG_RT_BASE, 0x20, 0x10, 0, 3),
 +	PIN_FIELD_BASE(30, 30, IOCFG_RT_BASE, 0x20, 0x10, 9, 3),
 +	PIN_FIELD_BASE(31, 31, IOCFG_RT_BASE, 0x20, 0x10, 6, 3),
 +	PIN_FIELD_BASE(32, 32, IOCFG_RT_BASE, 0x20, 0x10, 3, 3),
 +	PIN_FIELD_BASE(33, 33, IOCFG_LT_BASE, 0x00, 0x10, 12, 3),
 +	PIN_FIELD_BASE(34, 34, IOCFG_LT_BASE, 0x00, 0x10, 24, 3),
 +	PIN_FIELD_BASE(35, 35, IOCFG_LT_BASE, 0x00, 0x10, 21, 3),
 +	PIN_FIELD_BASE(36, 37, IOCFG_LT_BASE, 0x00, 0x10, 15, 3),
 +	PIN_FIELD_BASE(38, 38, IOCFG_LT_BASE, 0x00, 0x10, 27, 3),
 +	PIN_FIELD_BASE(39, 39, IOCFG_RB_BASE, 0x10, 0x10, 27, 3),
 +	PIN_FIELD_BASE(40, 40, IOCFG_RB_BASE, 0x20, 0x10, 0, 3),
 +	PIN_FIELD_BASE(41, 41, IOCFG_RB_BASE, 0x10, 0x10, 6, 3),
 +	PIN_FIELD_BASE(42, 43, IOCFG_RB_BASE, 0x20, 0x10, 9, 3),
 +	PIN_FIELD_BASE(44, 45, IOCFG_RB_BASE, 0x20, 0x10, 3, 3),
 +	PIN_FIELD_BASE(46, 47, IOCFG_RB_BASE, 0x20, 0x10, 21, 3),
 +	PIN_FIELD_BASE(48, 49, IOCFG_RB_BASE, 0x20, 0x10, 15, 3),
 +	PIN_FIELD_BASE(50, 57, IOCFG_RT_BASE, 0x00, 0x10, 6, 3),
 +	PIN_FIELD_BASE(58, 58, IOCFG_RT_BASE, 0x00, 0x10, 3, 3),
 +	PIN_FIELD_BASE(59, 59, IOCFG_RT_BASE, 0x00, 0x10, 0, 3),
 +	PIN_FIELD_BASE(60, 61, IOCFG_RT_BASE, 0x10, 0x10, 0, 3),
 +	PIN_FIELD_BASE(62, 62, IOCFG_RB_BASE, 0x10, 0x10, 15, 3),
 +	PIN_FIELD_BASE(63, 63, IOCFG_RB_BASE, 0x10, 0x10, 12, 3),
 +	PIN_FIELD_BASE(64, 64, IOCFG_RB_BASE, 0x10, 0x10, 9, 3),
 +	PIN_FIELD_BASE(65, 65, IOCFG_RB_BASE, 0x10, 0x10, 18, 3),
 +	PIN_FIELD_BASE(66, 68, IOCFG_LB_BASE, 0x00, 0x10, 2, 3),
 +	PIN_FIELD_BASE(69, 69, IOCFG_TR_BASE, 0x00, 0x10, 3, 3),
 +	PIN_FIELD_BASE(70, 70, IOCFG_TR_BASE, 0x00, 0x10, 0, 3),
 +	PIN_FIELD_BASE(71, 71, IOCFG_TR_BASE, 0x10, 0x10, 18, 3),
 +	PIN_FIELD_BASE(72, 73, IOCFG_TR_BASE, 0x10, 0x10, 12, 3),
 +	PIN_FIELD_BASE(74, 77, IOCFG_TR_BASE, 0x00, 0x10, 15, 3),
 +	PIN_FIELD_BASE(78, 79, IOCFG_TR_BASE, 0x00, 0x10, 6, 3),
 +	PIN_FIELD_BASE(80, 80, IOCFG_TR_BASE, 0x00, 0x10, 27, 3),
 +	PIN_FIELD_BASE(81, 84, IOCFG_TR_BASE, 0x10, 0x10, 0, 3),
 +	PIN_FIELD_BASE(85, 85, IOCFG_TR_BASE, 0x00, 0x10, 12, 3),
 +	PIN_FIELD_BASE(86, 86, IOCFG_TL_BASE, 0x00, 0x10, 3, 3),
 +	PIN_FIELD_BASE(87, 87, IOCFG_TL_BASE, 0x00, 0x10, 0, 3),
 +	PIN_FIELD_BASE(88, 88, IOCFG_TL_BASE, 0x10, 0x10, 12, 3),
 +	PIN_FIELD_BASE(89, 90, IOCFG_TL_BASE, 0x10, 0x10, 6, 3),
 +	PIN_FIELD_BASE(91, 94, IOCFG_TL_BASE, 0x00, 0x10, 12, 3),
 +	PIN_FIELD_BASE(95, 96, IOCFG_TL_BASE, 0x00, 0x10, 6, 3),
 +	PIN_FIELD_BASE(97, 98, IOCFG_TL_BASE, 0x00, 0x10, 24, 3),
 +	PIN_FIELD_BASE(99, 100, IOCFG_TL_BASE, 0x10, 0x10, 2, 3),
 +};
 +
 +static const struct mtk_pin_field_calc mt7986_pin_pupd_range[] = {
 +	PIN_FIELD_BASE(0, 0, IOCFG_RB_BASE, 0x60, 0x10, 17, 1),
 +	PIN_FIELD_BASE(1, 2, IOCFG_LT_BASE, 0x30, 0x10, 10, 1),
 +	PIN_FIELD_BASE(3, 4, IOCFG_LB_BASE, 0x40, 0x10, 0, 1),
 +	PIN_FIELD_BASE(5, 6, IOCFG_RB_BASE, 0x60, 0x10, 0, 1),
 +	PIN_FIELD_BASE(7, 10, IOCFG_LT_BASE, 0x30, 0x10, 0, 1),
 +	PIN_FIELD_BASE(11, 14, IOCFG_RB_BASE, 0x60, 0x10, 8, 1),
 +	PIN_FIELD_BASE(15, 20, IOCFG_RB_BASE, 0x60, 0x10, 2, 1),
 +	PIN_FIELD_BASE(21, 23, IOCFG_RT_BASE, 0x40, 0x10, 12, 1),
 +	PIN_FIELD_BASE(24, 24, IOCFG_RT_BASE, 0x40, 0x10, 18, 1),
 +	PIN_FIELD_BASE(25, 25, IOCFG_RT_BASE, 0x40, 0x10, 17, 1),
 +	PIN_FIELD_BASE(26, 27, IOCFG_RT_BASE, 0x40, 0x10, 15, 1),
 +	PIN_FIELD_BASE(28, 29, IOCFG_RT_BASE, 0x40, 0x10, 19, 1),
 +	PIN_FIELD_BASE(30, 30, IOCFG_RT_BASE, 0x40, 0x10, 23, 1),
 +	PIN_FIELD_BASE(31, 31, IOCFG_RT_BASE, 0x40, 0x10, 22, 1),
 +	PIN_FIELD_BASE(32, 32, IOCFG_RT_BASE, 0x40, 0x10, 21, 1),
 +	PIN_FIELD_BASE(33, 33, IOCFG_LT_BASE, 0x30, 0x10, 4, 1),
 +	PIN_FIELD_BASE(34, 34, IOCFG_LT_BASE, 0x30, 0x10, 8, 1),
 +	PIN_FIELD_BASE(35, 35, IOCFG_LT_BASE, 0x30, 0x10, 7, 1),
 +	PIN_FIELD_BASE(36, 37, IOCFG_LT_BASE, 0x30, 0x10, 5, 1),
 +	PIN_FIELD_BASE(38, 38, IOCFG_LT_BASE, 0x30, 0x10, 9, 1),
 +	PIN_FIELD_BASE(39, 40, IOCFG_RB_BASE, 0x60, 0x10, 18, 1),
 +	PIN_FIELD_BASE(41, 41, IOCFG_RB_BASE, 0x60, 0x10, 12, 1),
 +	PIN_FIELD_BASE(42, 43, IOCFG_RB_BASE, 0x60, 0x10, 23, 1),
 +	PIN_FIELD_BASE(44, 45, IOCFG_RB_BASE, 0x60, 0x10, 21, 1),
 +	PIN_FIELD_BASE(46, 47, IOCFG_RB_BASE, 0x60, 0x10, 27, 1),
 +	PIN_FIELD_BASE(48, 49, IOCFG_RB_BASE, 0x60, 0x10, 25, 1),
 +	PIN_FIELD_BASE(50, 57, IOCFG_RT_BASE, 0x40, 0x10, 2, 1),
 +	PIN_FIELD_BASE(58, 58, IOCFG_RT_BASE, 0x40, 0x10, 1, 1),
 +	PIN_FIELD_BASE(59, 59, IOCFG_RT_BASE, 0x40, 0x10, 0, 1),
 +	PIN_FIELD_BASE(60, 61, IOCFG_RT_BASE, 0x40, 0x10, 10, 1),
 +	PIN_FIELD_BASE(62, 62, IOCFG_RB_BASE, 0x60, 0x10, 15, 1),
 +	PIN_FIELD_BASE(63, 63, IOCFG_RB_BASE, 0x60, 0x10, 14, 1),
 +	PIN_FIELD_BASE(64, 64, IOCFG_RB_BASE, 0x60, 0x10, 13, 1),
 +	PIN_FIELD_BASE(65, 65, IOCFG_RB_BASE, 0x60, 0x10, 16, 1),
 +	PIN_FIELD_BASE(66, 68, IOCFG_LB_BASE, 0x40, 0x10, 2, 1),
 +};
 +
 +static const struct mtk_pin_field_calc mt7986_pin_r0_range[] = {
 +	PIN_FIELD_BASE(0, 0, IOCFG_RB_BASE, 0x70, 0x10, 17, 1),
 +	PIN_FIELD_BASE(1, 2, IOCFG_LT_BASE, 0x40, 0x10, 10, 1),
 +	PIN_FIELD_BASE(3, 4, IOCFG_LB_BASE, 0x50, 0x10, 0, 1),
 +	PIN_FIELD_BASE(5, 6, IOCFG_RB_BASE, 0x70, 0x10, 0, 1),
 +	PIN_FIELD_BASE(7, 10, IOCFG_LT_BASE, 0x40, 0x10, 0, 1),
 +	PIN_FIELD_BASE(11, 14, IOCFG_RB_BASE, 0x70, 0x10, 8, 1),
 +	PIN_FIELD_BASE(15, 20, IOCFG_RB_BASE, 0x70, 0x10, 2, 1),
 +	PIN_FIELD_BASE(21, 23, IOCFG_RT_BASE, 0x50, 0x10, 12, 1),
 +	PIN_FIELD_BASE(24, 24, IOCFG_RT_BASE, 0x50, 0x10, 18, 1),
 +	PIN_FIELD_BASE(25, 25, IOCFG_RT_BASE, 0x50, 0x10, 17, 1),
 +	PIN_FIELD_BASE(26, 27, IOCFG_RT_BASE, 0x50, 0x10, 15, 1),
 +	PIN_FIELD_BASE(28, 29, IOCFG_RT_BASE, 0x50, 0x10, 19, 1),
 +	PIN_FIELD_BASE(30, 30, IOCFG_RT_BASE, 0x50, 0x10, 23, 1),
 +	PIN_FIELD_BASE(31, 31, IOCFG_RT_BASE, 0x50, 0x10, 22, 1),
 +	PIN_FIELD_BASE(32, 32, IOCFG_RT_BASE, 0x50, 0x10, 21, 1),
 +	PIN_FIELD_BASE(33, 33, IOCFG_LT_BASE, 0x40, 0x10, 4, 1),
 +	PIN_FIELD_BASE(34, 34, IOCFG_LT_BASE, 0x40, 0x10, 8, 1),
 +	PIN_FIELD_BASE(35, 35, IOCFG_LT_BASE, 0x40, 0x10, 7, 1),
 +	PIN_FIELD_BASE(36, 37, IOCFG_LT_BASE, 0x40, 0x10, 5, 1),
 +	PIN_FIELD_BASE(38, 38, IOCFG_LT_BASE, 0x40, 0x10, 9, 1),
 +	PIN_FIELD_BASE(39, 40, IOCFG_RB_BASE, 0x70, 0x10, 18, 1),
 +	PIN_FIELD_BASE(41, 41, IOCFG_RB_BASE, 0x70, 0x10, 12, 1),
 +	PIN_FIELD_BASE(42, 43, IOCFG_RB_BASE, 0x70, 0x10, 23, 1),
 +	PIN_FIELD_BASE(44, 45, IOCFG_RB_BASE, 0x70, 0x10, 21, 1),
 +	PIN_FIELD_BASE(46, 47, IOCFG_RB_BASE, 0x70, 0x10, 27, 1),
 +	PIN_FIELD_BASE(48, 49, IOCFG_RB_BASE, 0x70, 0x10, 25, 1),
 +	PIN_FIELD_BASE(50, 57, IOCFG_RT_BASE, 0x50, 0x10, 2, 1),
 +	PIN_FIELD_BASE(58, 58, IOCFG_RT_BASE, 0x50, 0x10, 1, 1),
 +	PIN_FIELD_BASE(59, 59, IOCFG_RT_BASE, 0x50, 0x10, 0, 1),
 +	PIN_FIELD_BASE(60, 61, IOCFG_RT_BASE, 0x50, 0x10, 10, 1),
 +	PIN_FIELD_BASE(62, 62, IOCFG_RB_BASE, 0x70, 0x10, 15, 1),
 +	PIN_FIELD_BASE(63, 63, IOCFG_RB_BASE, 0x70, 0x10, 14, 1),
 +	PIN_FIELD_BASE(64, 64, IOCFG_RB_BASE, 0x70, 0x10, 13, 1),
 +	PIN_FIELD_BASE(65, 65, IOCFG_RB_BASE, 0x70, 0x10, 16, 1),
 +	PIN_FIELD_BASE(66, 68, IOCFG_LB_BASE, 0x50, 0x10, 2, 1),
 +};
 +
 +static const struct mtk_pin_field_calc mt7986_pin_r1_range[] = {
 +	PIN_FIELD_BASE(0, 0, IOCFG_RB_BASE, 0x80, 0x10, 17, 1),
 +	PIN_FIELD_BASE(1, 2, IOCFG_LT_BASE, 0x50, 0x10, 10, 1),
 +	PIN_FIELD_BASE(3, 4, IOCFG_LB_BASE, 0x60, 0x10, 0, 1),
 +	PIN_FIELD_BASE(5, 6, IOCFG_RB_BASE, 0x80, 0x10, 0, 1),
 +	PIN_FIELD_BASE(7, 10, IOCFG_LT_BASE, 0x50, 0x10, 0, 1),
 +	PIN_FIELD_BASE(11, 14, IOCFG_RB_BASE, 0x80, 0x10, 8, 1),
 +	PIN_FIELD_BASE(15, 20, IOCFG_RB_BASE, 0x80, 0x10, 2, 1),
 +	PIN_FIELD_BASE(21, 23, IOCFG_RT_BASE, 0x60, 0x10, 12, 1),
 +	PIN_FIELD_BASE(24, 24, IOCFG_RT_BASE, 0x60, 0x10, 18, 1),
 +	PIN_FIELD_BASE(25, 25, IOCFG_RT_BASE, 0x60, 0x10, 17, 1),
 +	PIN_FIELD_BASE(26, 27, IOCFG_RT_BASE, 0x60, 0x10, 15, 1),
 +	PIN_FIELD_BASE(28, 29, IOCFG_RT_BASE, 0x60, 0x10, 19, 1),
 +	PIN_FIELD_BASE(30, 30, IOCFG_RT_BASE, 0x60, 0x10, 23, 1),
 +	PIN_FIELD_BASE(31, 31, IOCFG_RT_BASE, 0x60, 0x10, 22, 1),
 +	PIN_FIELD_BASE(32, 32, IOCFG_RT_BASE, 0x60, 0x10, 21, 1),
 +	PIN_FIELD_BASE(33, 33, IOCFG_LT_BASE, 0x50, 0x10, 4, 1),
 +	PIN_FIELD_BASE(34, 34, IOCFG_LT_BASE, 0x50, 0x10, 8, 1),
 +	PIN_FIELD_BASE(35, 35, IOCFG_LT_BASE, 0x50, 0x10, 7, 1),
 +	PIN_FIELD_BASE(36, 37, IOCFG_LT_BASE, 0x50, 0x10, 5, 1),
 +	PIN_FIELD_BASE(38, 38, IOCFG_LT_BASE, 0x50, 0x10, 9, 1),
 +	PIN_FIELD_BASE(39, 40, IOCFG_RB_BASE, 0x80, 0x10, 18, 1),
 +	PIN_FIELD_BASE(41, 41, IOCFG_RB_BASE, 0x80, 0x10, 12, 1),
 +	PIN_FIELD_BASE(42, 43, IOCFG_RB_BASE, 0x80, 0x10, 23, 1),
 +	PIN_FIELD_BASE(44, 45, IOCFG_RB_BASE, 0x80, 0x10, 21, 1),
 +	PIN_FIELD_BASE(46, 47, IOCFG_RB_BASE, 0x80, 0x10, 27, 1),
 +	PIN_FIELD_BASE(48, 49, IOCFG_RB_BASE, 0x80, 0x10, 25, 1),
 +	PIN_FIELD_BASE(50, 57, IOCFG_RT_BASE, 0x60, 0x10, 2, 1),
 +	PIN_FIELD_BASE(58, 58, IOCFG_RT_BASE, 0x60, 0x10, 1, 1),
 +	PIN_FIELD_BASE(59, 59, IOCFG_RT_BASE, 0x60, 0x10, 0, 1),
 +	PIN_FIELD_BASE(60, 61, IOCFG_RT_BASE, 0x60, 0x10, 10, 1),
 +	PIN_FIELD_BASE(62, 62, IOCFG_RB_BASE, 0x80, 0x10, 15, 1),
 +	PIN_FIELD_BASE(63, 63, IOCFG_RB_BASE, 0x80, 0x10, 14, 1),
 +	PIN_FIELD_BASE(64, 64, IOCFG_RB_BASE, 0x80, 0x10, 13, 1),
 +	PIN_FIELD_BASE(65, 65, IOCFG_RB_BASE, 0x80, 0x10, 16, 1),
 +	PIN_FIELD_BASE(66, 68, IOCFG_LB_BASE, 0x60, 0x10, 2, 1),
 +};
 +
 +static const struct mtk_pin_reg_calc mt7986_reg_cals[] = {
 +	[PINCTRL_PIN_REG_MODE] = MTK_RANGE(mt7986_pin_mode_range),
 +	[PINCTRL_PIN_REG_DIR] = MTK_RANGE(mt7986_pin_dir_range),
 +	[PINCTRL_PIN_REG_DI] = MTK_RANGE(mt7986_pin_di_range),
 +	[PINCTRL_PIN_REG_DO] = MTK_RANGE(mt7986_pin_do_range),
 +	[PINCTRL_PIN_REG_SMT] = MTK_RANGE(mt7986_pin_smt_range),
 +	[PINCTRL_PIN_REG_IES] = MTK_RANGE(mt7986_pin_ies_range),
 +	[PINCTRL_PIN_REG_DRV] = MTK_RANGE(mt7986_pin_drv_range),
 +	[PINCTRL_PIN_REG_PU] = MTK_RANGE(mt7986_pin_pu_range),
 +	[PINCTRL_PIN_REG_PD] = MTK_RANGE(mt7986_pin_pd_range),
 +	[PINCTRL_PIN_REG_PUPD] = MTK_RANGE(mt7986_pin_pupd_range),
 +	[PINCTRL_PIN_REG_R0] = MTK_RANGE(mt7986_pin_r0_range),
 +	[PINCTRL_PIN_REG_R1] = MTK_RANGE(mt7986_pin_r1_range),
 +};
 +
 +static const struct mtk_pin_desc mt7986_pins[] = {
 +	MT7986_TYPE0_PIN(0, "SYS_WATCHDOG"),
 +	MT7986_TYPE0_PIN(1, "WF2G_LED"),
 +	MT7986_TYPE0_PIN(2, "WF5G_LED"),
 +	MT7986_TYPE0_PIN(3, "I2C_SCL"),
 +	MT7986_TYPE0_PIN(4, "I2C_SDA"),
 +	MT7986_TYPE0_PIN(5, "GPIO_0"),
 +	MT7986_TYPE0_PIN(6, "GPIO_1"),
 +	MT7986_TYPE0_PIN(7, "GPIO_2"),
 +	MT7986_TYPE0_PIN(8, "GPIO_3"),
 +	MT7986_TYPE0_PIN(9, "GPIO_4"),
 +	MT7986_TYPE0_PIN(10, "GPIO_5"),
 +	MT7986_TYPE0_PIN(11, "GPIO_6"),
 +	MT7986_TYPE0_PIN(12, "GPIO_7"),
 +	MT7986_TYPE0_PIN(13, "GPIO_8"),
 +	MT7986_TYPE0_PIN(14, "GPIO_9"),
 +	MT7986_TYPE0_PIN(15, "GPIO_10"),
 +	MT7986_TYPE0_PIN(16, "GPIO_11"),
 +	MT7986_TYPE0_PIN(17, "GPIO_12"),
 +	MT7986_TYPE0_PIN(18, "GPIO_13"),
 +	MT7986_TYPE0_PIN(19, "GPIO_14"),
 +	MT7986_TYPE0_PIN(20, "GPIO_15"),
 +	MT7986_TYPE0_PIN(21, "PWM0"),
 +	MT7986_TYPE0_PIN(22, "PWM1"),
 +	MT7986_TYPE0_PIN(23, "SPI0_CLK"),
 +	MT7986_TYPE0_PIN(24, "SPI0_MOSI"),
 +	MT7986_TYPE0_PIN(25, "SPI0_MISO"),
 +	MT7986_TYPE0_PIN(26, "SPI0_CS"),
 +	MT7986_TYPE0_PIN(27, "SPI0_HOLD"),
 +	MT7986_TYPE0_PIN(28, "SPI0_WP"),
 +	MT7986_TYPE0_PIN(29, "SPI1_CLK"),
 +	MT7986_TYPE0_PIN(30, "SPI1_MOSI"),
 +	MT7986_TYPE0_PIN(31, "SPI1_MISO"),
 +	MT7986_TYPE0_PIN(32, "SPI1_CS"),
 +	MT7986_TYPE0_PIN(33, "SPI2_CLK"),
 +	MT7986_TYPE0_PIN(34, "SPI2_MOSI"),
 +	MT7986_TYPE0_PIN(35, "SPI2_MISO"),
 +	MT7986_TYPE0_PIN(36, "SPI2_CS"),
 +	MT7986_TYPE0_PIN(37, "SPI2_HOLD"),
 +	MT7986_TYPE0_PIN(38, "SPI2_WP"),
 +	MT7986_TYPE0_PIN(39, "UART0_RXD"),
 +	MT7986_TYPE0_PIN(40, "UART0_TXD"),
 +	MT7986_TYPE0_PIN(41, "PCIE_PERESET_N"),
 +	MT7986_TYPE0_PIN(42, "UART1_RXD"),
 +	MT7986_TYPE0_PIN(43, "UART1_TXD"),
 +	MT7986_TYPE0_PIN(44, "UART1_CTS"),
 +	MT7986_TYPE0_PIN(45, "UART1_RTS"),
 +	MT7986_TYPE0_PIN(46, "UART2_RXD"),
 +	MT7986_TYPE0_PIN(47, "UART2_TXD"),
 +	MT7986_TYPE0_PIN(48, "UART2_CTS"),
 +	MT7986_TYPE0_PIN(49, "UART2_RTS"),
 +	MT7986_TYPE0_PIN(50, "EMMC_DATA_0"),
 +	MT7986_TYPE0_PIN(51, "EMMC_DATA_1"),
 +	MT7986_TYPE0_PIN(52, "EMMC_DATA_2"),
 +	MT7986_TYPE0_PIN(53, "EMMC_DATA_3"),
 +	MT7986_TYPE0_PIN(54, "EMMC_DATA_4"),
 +	MT7986_TYPE0_PIN(55, "EMMC_DATA_5"),
 +	MT7986_TYPE0_PIN(56, "EMMC_DATA_6"),
 +	MT7986_TYPE0_PIN(57, "EMMC_DATA_7"),
 +	MT7986_TYPE0_PIN(58, "EMMC_CMD"),
 +	MT7986_TYPE0_PIN(59, "EMMC_CK"),
 +	MT7986_TYPE0_PIN(60, "EMMC_DSL"),
 +	MT7986_TYPE0_PIN(61, "EMMC_RSTB"),
 +	MT7986_TYPE0_PIN(62, "PCM_DTX"),
 +	MT7986_TYPE0_PIN(63, "PCM_DRX"),
 +	MT7986_TYPE0_PIN(64, "PCM_CLK"),
 +	MT7986_TYPE0_PIN(65, "PCM_FS"),
 +	MT7986_TYPE0_PIN(66, "MT7531_INT"),
 +	MT7986_TYPE0_PIN(67, "SMI_MDC"),
 +	MT7986_TYPE0_PIN(68, "SMI_MDIO"),
 +	MT7986_TYPE1_PIN(69, "WF0_DIG_RESETB"),
 +	MT7986_TYPE1_PIN(70, "WF0_CBA_RESETB"),
 +	MT7986_TYPE1_PIN(71, "WF0_XO_REQ"),
 +	MT7986_TYPE1_PIN(72, "WF0_TOP_CLK"),
 +	MT7986_TYPE1_PIN(73, "WF0_TOP_DATA"),
 +	MT7986_TYPE1_PIN(74, "WF0_HB1"),
 +	MT7986_TYPE1_PIN(75, "WF0_HB2"),
 +	MT7986_TYPE1_PIN(76, "WF0_HB3"),
 +	MT7986_TYPE1_PIN(77, "WF0_HB4"),
 +	MT7986_TYPE1_PIN(78, "WF0_HB0"),
 +	MT7986_TYPE1_PIN(79, "WF0_HB0_B"),
 +	MT7986_TYPE1_PIN(80, "WF0_HB5"),
 +	MT7986_TYPE1_PIN(81, "WF0_HB6"),
 +	MT7986_TYPE1_PIN(82, "WF0_HB7"),
 +	MT7986_TYPE1_PIN(83, "WF0_HB8"),
 +	MT7986_TYPE1_PIN(84, "WF0_HB9"),
 +	MT7986_TYPE1_PIN(85, "WF0_HB10"),
 +	MT7986_TYPE1_PIN(86, "WF1_DIG_RESETB"),
 +	MT7986_TYPE1_PIN(87, "WF1_CBA_RESETB"),
 +	MT7986_TYPE1_PIN(88, "WF1_XO_REQ"),
 +	MT7986_TYPE1_PIN(89, "WF1_TOP_CLK"),
 +	MT7986_TYPE1_PIN(90, "WF1_TOP_DATA"),
 +	MT7986_TYPE1_PIN(91, "WF1_HB1"),
 +	MT7986_TYPE1_PIN(92, "WF1_HB2"),
 +	MT7986_TYPE1_PIN(93, "WF1_HB3"),
 +	MT7986_TYPE1_PIN(94, "WF1_HB4"),
 +	MT7986_TYPE1_PIN(95, "WF1_HB0"),
 +	MT7986_TYPE1_PIN(96, "WF1_HB0_B"),
 +	MT7986_TYPE1_PIN(97, "WF1_HB5"),
 +	MT7986_TYPE1_PIN(98, "WF1_HB6"),
 +	MT7986_TYPE1_PIN(99, "WF1_HB7"),
 +	MT7986_TYPE1_PIN(100, "WF1_HB8"),
 +};
 +
 +static const struct mtk_io_type_desc mt7986_io_type_desc[] = {
 +	[IO_TYPE_GRP0] = {
 +		.name = "18OD33",
 +		.bias_set = mtk_pinconf_bias_set_pupd_r1_r0,
 +		.drive_set = mtk_pinconf_drive_set_v1,
 +		.input_enable = mtk_pinconf_input_enable_v1,
 +	},
 +	[IO_TYPE_GRP1] = {
 +		.name = "18A01",
 +		.bias_set = mtk_pinconf_bias_set_pu_pd,
 +		.drive_set = mtk_pinconf_drive_set_v1,
 +		.input_enable = mtk_pinconf_input_enable_v1,
 +	},
 +};
 +
 +/* List all groups consisting of these pins dedicated to the enablement of
 + * certain hardware block and the corresponding mode for all of the pins.
 + * The hardware probably has multiple combinations of these pinouts.
 + */
 +
 +static int mt7986_watchdog_pins[] = { 0, };
 +static int mt7986_watchdog_funcs[] = { 1, };
 +
 +static int mt7986_wifi_led_pins[] = { 1, 2, };
 +static int mt7986_wifi_led_funcs[] = { 1, 1, };
 +
 +static int mt7986_i2c_pins[] = { 3, 4, };
 +static int mt7986_i2c_funcs[] = { 1, 1, };
 +
 +static int mt7986_uart1_0_pins[] = { 7, 8, 9, 10, };
 +static int mt7986_uart1_0_funcs[] = { 3, 3, 3, 3, };
 +
 +static int mt7986_spi1_0_pins[] = { 11, 12, 13, 14, };
 +static int mt7986_spi1_0_funcs[] = { 3, 3, 3, 3, };
 +
 +static int mt7986_pwm1_1_pins[] = { 20, };
 +static int mt7986_pwm1_1_funcs[] = { 2, };
 +
 +static int mt7986_pwm0_pins[] = { 21, };
 +static int mt7986_pwm0_funcs[] = { 1, };
 +
 +static int mt7986_pwm1_0_pins[] = { 22, };
 +static int mt7986_pwm1_0_funcs[] = { 1, };
 +
 +static int mt7986_emmc_45_pins[] = {
 +	22, 23, 24, 25, 26, 27, 28, 29, 30, 31, 32, };
 +static int mt7986_emmc_45_funcs[] = { 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, };
 +
 +static int mt7986_snfi_pins[] = { 23, 24, 25, 26, 27, 28, };
 +static int mt7986_snfi_funcs[] = { 1, 1, 1, 1, 1, 1, };
 +
 +static int mt7986_spi1_1_pins[] = { 23, 24, 25, 26, };
 +static int mt7986_spi1_1_funcs[] = { 3, 3, 3, 3, };
 +
 +static int mt7986_uart1_1_pins[] = { 23, 24, 25, 26, };
 +static int mt7986_uart1_1_funcs[] = { 4, 4, 4, 4, };
 +
 +static int mt7986_spi1_2_pins[] = { 29, 30, 31, 32, };
 +static int mt7986_spi1_2_funcs[] = { 1, 1, 1, 1, };
 +
 +static int mt7986_uart1_2_pins[] = { 29, 30, 31, 32, };
 +static int mt7986_uart1_2_funcs[] = { 3, 3, 3, 3, };
 +
 +static int mt7986_uart2_0_pins[] = { 29, 30, 31, 32, };
 +static int mt7986_uart2_0_funcs[] = { 4, 4, 4, 4, };
 +
 +static int mt7986_spi0_pins[] = { 33, 34, 35, 36, };
 +static int mt7986_spi0_funcs[] = { 1, 1, 1, 1, };
 +
 +static int mt7986_spi0_wp_hold_pins[] = { 37, 38, };
 +static int mt7986_spi0_wp_hold_funcs[] = { 1, 1, };
 +
 +static int mt7986_uart2_1_pins[] = { 33, 34, 35, 36, };
 +static int mt7986_uart2_1_funcs[] = { 3, 3, 3, 3, };
 +
 +static int mt7986_uart1_3_rx_tx_pins[] = { 35, 36, };
 +static int mt7986_uart1_3_rx_tx_funcs[] = { 2, 2, };
 +
 +static int mt7986_uart1_3_cts_rts_pins[] = { 37, 38, };
 +static int mt7986_uart1_3_cts_rts_funcs[] = { 2, 2, };
 +
 +static int mt7986_spi1_3_pins[] = { 33, 34, 35, 36, };
 +static int mt7986_spi1_3_funcs[] = { 4, 4, 4, 4, };
 +
 +static int mt7986_uart0_pins[] = { 39, 40, };
 +static int mt7986_uart0_funcs[] = { 1, 1, };
 +
 +static int mt7986_pcie_reset_pins[] = { 41, };
 +static int mt7986_pcie_reset_funcs[] = { 1, };
 +
 +static int mt7986_uart1_pins[] = { 42, 43, 44, 45, };
 +static int mt7986_uart1_funcs[] = { 1, 1, 1, 1, };
 +
 +static int mt7986_uart2_pins[] = { 46, 47, 48, 49, };
 +static int mt7986_uart2_funcs[] = { 1, 1, 1, 1, };
 +
 +static int mt7986_emmc_51_pins[] = {
 +	50, 51, 52, 53, 54, 55, 56, 57, 58, 59, 60, 61, };
 +static int mt7986_emmc_51_funcs[] = { 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, };
 +
 +static int mt7986_pcm_pins[] = { 62, 63, 64, 65, };
 +static int mt7986_pcm_funcs[] = { 1, 1, 1, 1, };
 +
 +static int mt7986_i2s_pins[] = { 62, 63, 64, 65, };
 +static int mt7986_i2s_funcs[] = { 1, 1, 1, 1, };
 +
 +static int mt7986_switch_int_pins[] = { 66, };
 +static int mt7986_switch_int_funcs[] = { 1, };
 +
 +static int mt7986_mdc_mdio_pins[] = { 67, 68, };
 +static int mt7986_mdc_mdio_funcs[] = { 1, 1, };
 +
 +static int mt7986_wf_2g_pins[] = {74, 75, 76, 77, 78, 79, 80, 81, 82, 83, };
 +static int mt7986_wf_2g_funcs[] = {1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, };
 +
 +static int mt7986_wf_5g_pins[] = {91, 92, 93, 94, 95, 96, 97, 98, 99, 100, };
 +static int mt7986_wf_5g_funcs[] = {1, 1, 1, 1, 1, 1, 1, 1, 1, 1, };
 +
 +static int mt7986_wf_dbdc_pins[] = {
 +	74, 75, 76, 77, 78, 79, 80, 81, 82, 83, 84, 85, };
 +static int mt7986_wf_dbdc_funcs[] = {
 +	2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, };
 +
 +static int mt7986_pcie_clk_pins[] = { 9, };
 +static int mt7986_pcie_clk_funcs[] = { 1, };
 +
 +static int mt7986_pcie_wake_pins[] = { 10, };
 +static int mt7986_pcie_wake_funcs[] = { 1, };
 +
 +static const struct mtk_group_desc mt7986_groups[] = {
 +	PINCTRL_PIN_GROUP("watchdog", mt7986_watchdog),
 +	PINCTRL_PIN_GROUP("wifi_led", mt7986_wifi_led),
 +	PINCTRL_PIN_GROUP("i2c", mt7986_i2c),
 +	PINCTRL_PIN_GROUP("uart1_0", mt7986_uart1_0),
 +	PINCTRL_PIN_GROUP("pcie_clk", mt7986_pcie_clk),
 +	PINCTRL_PIN_GROUP("pcie_wake", mt7986_pcie_wake),
 +	PINCTRL_PIN_GROUP("spi1_0", mt7986_spi1_0),
 +	PINCTRL_PIN_GROUP("pwm1_1", mt7986_pwm1_1),
 +	PINCTRL_PIN_GROUP("pwm0", mt7986_pwm0),
 +	PINCTRL_PIN_GROUP("pwm1_0", mt7986_pwm1_0),
 +	PINCTRL_PIN_GROUP("emmc_45", mt7986_emmc_45),
 +	PINCTRL_PIN_GROUP("snfi", mt7986_snfi),
 +	PINCTRL_PIN_GROUP("spi1_1", mt7986_spi1_1),
 +	PINCTRL_PIN_GROUP("uart1_1", mt7986_uart1_1),
 +	PINCTRL_PIN_GROUP("spi1_2", mt7986_spi1_2),
 +	PINCTRL_PIN_GROUP("uart1_2", mt7986_uart1_2),
 +	PINCTRL_PIN_GROUP("uart2_0", mt7986_uart2_0),
 +	PINCTRL_PIN_GROUP("spi0", mt7986_spi0),
 +	PINCTRL_PIN_GROUP("spi0_wp_hold", mt7986_spi0_wp_hold),
 +	PINCTRL_PIN_GROUP("uart2_1", mt7986_uart2_1),
 +	PINCTRL_PIN_GROUP("uart1_3_rx_tx", mt7986_uart1_3_rx_tx),
 +	PINCTRL_PIN_GROUP("uart1_3_cts_rts", mt7986_uart1_3_cts_rts),
 +	PINCTRL_PIN_GROUP("spi1_3", mt7986_spi1_3),
 +	PINCTRL_PIN_GROUP("uart0", mt7986_uart0),
 +	PINCTRL_PIN_GROUP("switch_int", mt7986_switch_int),
 +	PINCTRL_PIN_GROUP("mdc_mdio", mt7986_mdc_mdio),
 +	PINCTRL_PIN_GROUP("pcie_pereset", mt7986_pcie_reset),
 +	PINCTRL_PIN_GROUP("uart1", mt7986_uart1),
 +	PINCTRL_PIN_GROUP("uart2", mt7986_uart2),
 +	PINCTRL_PIN_GROUP("emmc_51", mt7986_emmc_51),
 +	PINCTRL_PIN_GROUP("pcm", mt7986_pcm),
 +	PINCTRL_PIN_GROUP("i2s", mt7986_i2s),
 +	PINCTRL_PIN_GROUP("wf_2g", mt7986_wf_2g),
 +	PINCTRL_PIN_GROUP("wf_5g", mt7986_wf_5g),
 +	PINCTRL_PIN_GROUP("wf_dbdc", mt7986_wf_dbdc),
 +};
 +
 +/* Joint those groups owning the same capability in user point of view which
 + * allows that people tend to use through the device tree.
 + */
 +
 +static const char *const mt7986_audio_groups[] = { "pcm", "i2s" };
 +static const char *const mt7986_emmc_groups[] = { "emmc_45", "emmc_51", };
 +static const char *const mt7986_ethernet_groups[] = { "switch_int",
 +	"mdc_mdio", };
 +static const char *const mt7986_i2c_groups[] = { "i2c", };
 +static const char *const mt7986_led_groups[] = { "wifi_led", };
 +static const char *const mt7986_flash_groups[] = { "snfi", };
 +static const char *const mt7986_pcie_groups[] = { "pcie_clk", "pcie_wake",
 +	"pcie_pereset" };
 +static const char *const mt7986_pwm_groups[] = { "pwm0", "pwm1_0", "pwm1_1", };
 +static const char *const mt7986_spi_groups[] = { "spi0", "spi0_wp_hold",
 +	"spi1_0", "spi1_1", "spi1_2", "spi1_3", };
 +static const char *const mt7986_uart_groups[] = { "uart1_0", "uart1_1",
 +	"uart1_2", "uart1_3_rx_tx", "uart1_3_cts_rts", "uart2_0", "uart2_1",
 +	"uart0", "uart1", "uart2", };
 +static const char *const mt7986_wdt_groups[] = { "watchdog", };
 +static const char *const mt7986_wf_groups[] = { "wf_2g", "wf_5g", "wf_dbdc", };
 +
 +static const struct mtk_function_desc mt7986_functions[] = {
 +	{"audio", mt7986_audio_groups, ARRAY_SIZE(mt7986_audio_groups)},
 +	{"emmc", mt7986_emmc_groups, ARRAY_SIZE(mt7986_emmc_groups)},
 +	{"eth", mt7986_ethernet_groups, ARRAY_SIZE(mt7986_ethernet_groups)},
 +	{"i2c", mt7986_i2c_groups, ARRAY_SIZE(mt7986_i2c_groups)},
 +	{"led", mt7986_led_groups, ARRAY_SIZE(mt7986_led_groups)},
 +	{"flash", mt7986_flash_groups, ARRAY_SIZE(mt7986_flash_groups)},
 +	{"pcie", mt7986_pcie_groups, ARRAY_SIZE(mt7986_pcie_groups)},
 +	{"pwm", mt7986_pwm_groups, ARRAY_SIZE(mt7986_pwm_groups)},
 +	{"spi", mt7986_spi_groups, ARRAY_SIZE(mt7986_spi_groups)},
 +	{"uart", mt7986_uart_groups, ARRAY_SIZE(mt7986_uart_groups)},
 +	{"watchdog", mt7986_wdt_groups, ARRAY_SIZE(mt7986_wdt_groups)},
 +	{"wifi", mt7986_wf_groups, ARRAY_SIZE(mt7986_wf_groups)},
 +};
 +
 +static struct mtk_pinctrl_soc mt7986_data = {
 +	.name = "mt7986_pinctrl",
 +	.reg_cal = mt7986_reg_cals,
 +	.pins = mt7986_pins,
 +	.npins = ARRAY_SIZE(mt7986_pins),
 +	.grps = mt7986_groups,
 +	.ngrps = ARRAY_SIZE(mt7986_groups),
 +	.funcs = mt7986_functions,
 +	.nfuncs = ARRAY_SIZE(mt7986_functions),
 +	.io_type = mt7986_io_type_desc,
 +	.ntype = ARRAY_SIZE(mt7986_io_type_desc),
 +	.gpio_mode = 0,
 +	.base_names = mt7986_pinctrl_register_base_names,
 +	.nbase_names = ARRAY_SIZE(mt7986_pinctrl_register_base_names),
 +	.base_calc = 1,
 +};
 +
 +static int mtk_pinctrl_mt7986_probe(struct udevice *dev)
 +{
 +	return mtk_pinctrl_common_probe(dev, &mt7986_data);
 +}
 +
 +static const struct udevice_id mt7986_pctrl_match[] = {
 +	{.compatible = "mediatek,mt7986-pinctrl"},
 +	{ /* sentinel */ }
 +};
 +
 +U_BOOT_DRIVER(mt7986_pinctrl) = {
 +	.name = "mt7986_pinctrl",
 +	.id = UCLASS_PINCTRL,
 +	.of_match = mt7986_pctrl_match,
 +	.ops = &mtk_pinctrl_ops,
 +	.probe = mtk_pinctrl_mt7986_probe,
 +	.priv_auto = sizeof(struct mtk_pinctrl_priv),
 +};
--- a/package/boot/uboot-mediatek/patches/002-0022-clk-mediatek-add-CLK_BYPASS_XTAL-flag-to-allow-bypas.patch
+++ b/package/boot/uboot-mediatek/patches/002-0022-clk-mediatek-add-CLK_BYPASS_XTAL-flag-to-allow-bypas.patch
@@ -0,0 +1,69 @@
 From 7f6c8bdfe020c45c398c01b417460e3319476606 Mon Sep 17 00:00:00 2001
 From: Weijie Gao <weijie.gao@mediatek.com>
 Date: Fri, 29 Jul 2022 10:43:39 +0800
 Subject: [PATCH 22/31] clk: mediatek: add CLK_BYPASS_XTAL flag to allow
 bypassing searching clock parent of xtal clock
 The mtk clock framework in u-boot uses array index for searching clock
 parent (kernel uses strings for search), so we need to specify a special
 clock with ID=0 for CLK_XTAL in u-boot.
 In the mt7622/mt7629 clock tree, the clocks with ID=0 never call
 mtk_topckgen_get_mux_rate, adn return xtal clock directly. This what we
 expected.
 However for newer chips, they may have some clocks with ID=0 not
 representing the xtal clock and still needs mtk_topckgen_get_mux_rate be
 called. Current logic will make entire clock driver not working.
 This patch adds a flag to indicate that whether a clock driver needs clocks
 with ID=0 to call mtk_topckgen_get_mux_rate.
 Reviewed-by: Simon Glass <sjg@chromium.org>
 Signed-off-by: Weijie Gao <weijie.gao@mediatek.com>
 ---
 drivers/clk/mediatek/clk-mtk.c | 5 ++++-
 drivers/clk/mediatek/clk-mtk.h | 6 ++++++
 2 files changed, 10 insertions(+), 1 deletion(-)
 --- a/drivers/clk/mediatek/clk-mtk.c
 +++ b/drivers/clk/mediatek/clk-mtk.c
@@ -314,12 +314,15 @@ static ulong mtk_topckgen_get_mux_rate(s
 	struct mtk_clk_priv *priv = dev_get_priv(clk->dev);
 	const struct mtk_composite *mux = &priv->tree->muxes[off];
 	u32 index;
 +	u32 flag = 0;
 	index = readl(priv->base + mux->mux_reg);
 	index &= mux->mux_mask << mux->mux_shift;
 	index = index >> mux->mux_shift;
 -	if (mux->parent[index])
 +	if (mux->parent[index] == CLK_XTAL && priv->tree->flags & CLK_BYPASS_XTAL)
 +		flag = 1;
 +	if (mux->parent[index] > 0 || flag == 1)
 		return mtk_clk_find_parent_rate(clk, mux->parent[index],
 						NULL);
 --- a/drivers/clk/mediatek/clk-mtk.h
 +++ b/drivers/clk/mediatek/clk-mtk.h
@@ -11,6 +11,11 @@
 #define CLK_XTAL			0
 #define MHZ				(1000 * 1000)
 +/* flags in struct mtk_clk_tree */
 +
 +/* clk id == 0 doesn't mean it's xtal clk */
 +#define CLK_BYPASS_XTAL			BIT(0)
 +
 #define HAVE_RST_BAR			BIT(0)
 #define CLK_DOMAIN_SCPSYS		BIT(0)
 #define CLK_MUX_SETCLR_UPD		BIT(1)
@@ -197,6 +202,7 @@ struct mtk_clk_tree {
 	const struct mtk_fixed_clk *fclks;
 	const struct mtk_fixed_factor *fdivs;
 	const struct mtk_composite *muxes;
 +	u32 flags;
 };
 struct mtk_clk_priv {
--- a/package/boot/uboot-mediatek/patches/002-0023-clk-mediatek-add-support-to-configure-clock-driver-p.patch
+++ b/package/boot/uboot-mediatek/patches/002-0023-clk-mediatek-add-support-to-configure-clock-driver-p.patch
@@ -0,0 +1,198 @@
 From cd4d6be5ed0488de2e0df9c388d89ad93d781caa Mon Sep 17 00:00:00 2001
 From: Weijie Gao <weijie.gao@mediatek.com>
 Date: Fri, 29 Jul 2022 10:57:05 +0800
 Subject: [PATCH 23/31] clk: mediatek: add support to configure clock driver
 parent
 This patch adds support for a clock node to configure its parent clock
 where possible.
 Reviewed-by: Simon Glass <sjg@chromium.org>
 Signed-off-by: Weijie Gao <weijie.gao@mediatek.com>
 ---
 drivers/clk/mediatek/clk-mtk.c | 79 ++++++++++++++++++++--------------
 drivers/clk/mediatek/clk-mtk.h |  2 +
 2 files changed, 48 insertions(+), 33 deletions(-)
 --- a/drivers/clk/mediatek/clk-mtk.c
 +++ b/drivers/clk/mediatek/clk-mtk.c
@@ -42,20 +42,14 @@
  * the accurate frequency.
  */
 static ulong mtk_clk_find_parent_rate(struct clk *clk, int id,
 -				      const struct driver *drv)
 +				      struct udevice *pdev)
 {
 	struct clk parent = { .id = id, };
 -	if (drv) {
 -		struct udevice *dev;
 -
 -		if (uclass_get_device_by_driver(UCLASS_CLK, drv, &dev))
 -			return -ENODEV;
 -
 -		parent.dev = dev;
 -	} else {
 +	if (pdev)
 +		parent.dev = pdev;
 +	else
 		parent.dev = clk->dev;
 -	}
 	return clk_get_rate(&parent);
 }
@@ -296,7 +290,7 @@ static ulong mtk_topckgen_get_factor_rat
 	switch (fdiv->flags & CLK_PARENT_MASK) {
 	case CLK_PARENT_APMIXED:
 		rate = mtk_clk_find_parent_rate(clk, fdiv->parent,
 -				DM_DRIVER_GET(mtk_clk_apmixedsys));
 +						priv->parent);
 		break;
 	case CLK_PARENT_TOPCKGEN:
 		rate = mtk_clk_find_parent_rate(clk, fdiv->parent, NULL);
@@ -322,9 +316,18 @@ static ulong mtk_topckgen_get_mux_rate(s
 	if (mux->parent[index] == CLK_XTAL && priv->tree->flags & CLK_BYPASS_XTAL)
 		flag = 1;
 -	if (mux->parent[index] > 0 || flag == 1)
 -		return mtk_clk_find_parent_rate(clk, mux->parent[index],
 -						NULL);
 +	if (mux->parent[index] > 0 || flag == 1) {
 +		switch (mux->flags & CLK_PARENT_MASK) {
 +		case CLK_PARENT_APMIXED:
 +			return mtk_clk_find_parent_rate(clk, mux->parent[index],
 +							priv->parent);
 +			break;
 +		default:
 +			return mtk_clk_find_parent_rate(clk, mux->parent[index],
 +							NULL);
 +			break;
 +		}
 +	}
 	return priv->tree->xtal_rate;
 }
@@ -343,7 +346,7 @@ static ulong mtk_topckgen_get_rate(struc
 						 priv->tree->muxes_offs);
 }
 -static int mtk_topckgen_enable(struct clk *clk)
 +static int mtk_clk_mux_enable(struct clk *clk)
 {
 	struct mtk_clk_priv *priv = dev_get_priv(clk->dev);
 	const struct mtk_composite *mux;
@@ -376,7 +379,7 @@ static int mtk_topckgen_enable(struct cl
 	return 0;
 }
 -static int mtk_topckgen_disable(struct clk *clk)
 +static int mtk_clk_mux_disable(struct clk *clk)
 {
 	struct mtk_clk_priv *priv = dev_get_priv(clk->dev);
 	const struct mtk_composite *mux;
@@ -402,7 +405,7 @@ static int mtk_topckgen_disable(struct c
 	return 0;
 }
 -static int mtk_topckgen_set_parent(struct clk *clk, struct clk *parent)
 +static int mtk_common_clk_set_parent(struct clk *clk, struct clk *parent)
 {
 	struct mtk_clk_priv *priv = dev_get_priv(clk->dev);
@@ -474,19 +477,7 @@ static ulong mtk_clk_gate_get_rate(struc
 	struct mtk_cg_priv *priv = dev_get_priv(clk->dev);
 	const struct mtk_gate *gate = &priv->gates[clk->id];
 -	switch (gate->flags & CLK_PARENT_MASK) {
 -	case CLK_PARENT_APMIXED:
 -		return mtk_clk_find_parent_rate(clk, gate->parent,
 -				DM_DRIVER_GET(mtk_clk_apmixedsys));
 -		break;
 -	case CLK_PARENT_TOPCKGEN:
 -		return mtk_clk_find_parent_rate(clk, gate->parent,
 -				DM_DRIVER_GET(mtk_clk_topckgen));
 -		break;
 -
 -	default:
 -		return priv->tree->xtal_rate;
 -	}
 +	return mtk_clk_find_parent_rate(clk, gate->parent, priv->parent);
 }
 const struct clk_ops mtk_clk_apmixedsys_ops = {
@@ -497,10 +488,10 @@ const struct clk_ops mtk_clk_apmixedsys_
 };
 const struct clk_ops mtk_clk_topckgen_ops = {
 -	.enable = mtk_topckgen_enable,
 -	.disable = mtk_topckgen_disable,
 +	.enable = mtk_clk_mux_enable,
 +	.disable = mtk_clk_mux_disable,
 	.get_rate = mtk_topckgen_get_rate,
 -	.set_parent = mtk_topckgen_set_parent,
 +	.set_parent = mtk_common_clk_set_parent,
 };
 const struct clk_ops mtk_clk_gate_ops = {
@@ -513,11 +504,22 @@ int mtk_common_clk_init(struct udevice *
 			const struct mtk_clk_tree *tree)
 {
 	struct mtk_clk_priv *priv = dev_get_priv(dev);
 +	struct udevice *parent;
 +	int ret;
 	priv->base = dev_read_addr_ptr(dev);
 	if (!priv->base)
 		return -ENOENT;
 +	ret = uclass_get_device_by_phandle(UCLASS_CLK, dev, "clock-parent", &parent);
 +	if (ret || !parent) {
 +		ret = uclass_get_device_by_driver(UCLASS_CLK,
 +				DM_DRIVER_GET(mtk_clk_apmixedsys), &parent);
 +		if (ret || !parent)
 +			return -ENOENT;
 +	}
 +
 +	priv->parent = parent;
 	priv->tree = tree;
 	return 0;
@@ -528,11 +530,22 @@ int mtk_common_clk_gate_init(struct udev
 			     const struct mtk_gate *gates)
 {
 	struct mtk_cg_priv *priv = dev_get_priv(dev);
 +	struct udevice *parent;
 +	int ret;
 	priv->base = dev_read_addr_ptr(dev);
 	if (!priv->base)
 		return -ENOENT;
 +	ret = uclass_get_device_by_phandle(UCLASS_CLK, dev, "clock-parent", &parent);
 +	if (ret || !parent) {
 +		ret = uclass_get_device_by_driver(UCLASS_CLK,
 +				DM_DRIVER_GET(mtk_clk_topckgen), &parent);
 +		if (ret || !parent)
 +			return -ENOENT;
 +	}
 +
 +	priv->parent = parent;
 	priv->tree = tree;
 	priv->gates = gates;
 --- a/drivers/clk/mediatek/clk-mtk.h
 +++ b/drivers/clk/mediatek/clk-mtk.h
@@ -206,11 +206,13 @@ struct mtk_clk_tree {
 };
 struct mtk_clk_priv {
 +	struct udevice *parent;
 	void __iomem *base;
 	const struct mtk_clk_tree *tree;
 };
 struct mtk_cg_priv {
 +	struct udevice *parent;
 	void __iomem *base;
 	const struct mtk_clk_tree *tree;
 	const struct mtk_gate *gates;
--- a/package/boot/uboot-mediatek/patches/002-0024-clk-mediatek-add-infrasys-clock-mux-support.patch
+++ b/package/boot/uboot-mediatek/patches/002-0024-clk-mediatek-add-infrasys-clock-mux-support.patch
@@ -0,0 +1,136 @@
 From e9c0c2ebd346aa578007c2aa88fc0974af6afb40 Mon Sep 17 00:00:00 2001
 From: Weijie Gao <weijie.gao@mediatek.com>
 Date: Fri, 29 Jul 2022 11:14:33 +0800
 Subject: [PATCH 24/31] clk: mediatek: add infrasys clock mux support
 This patch adds infrasys clock mux support for mediatek clock drivers.
 Reviewed-by: Simon Glass <sjg@chromium.org>
 Signed-off-by: Weijie Gao <weijie.gao@mediatek.com>
 ---
 drivers/clk/mediatek/clk-mtk.c | 72 ++++++++++++++++++++++++++++++++++
 drivers/clk/mediatek/clk-mtk.h |  4 +-
 2 files changed, 75 insertions(+), 1 deletion(-)
 --- a/drivers/clk/mediatek/clk-mtk.c
 +++ b/drivers/clk/mediatek/clk-mtk.c
@@ -303,6 +303,24 @@ static ulong mtk_topckgen_get_factor_rat
 	return mtk_factor_recalc_rate(fdiv, rate);
 }
 +static ulong mtk_infrasys_get_factor_rate(struct clk *clk, u32 off)
 +{
 +	struct mtk_clk_priv *priv = dev_get_priv(clk->dev);
 +	const struct mtk_fixed_factor *fdiv = &priv->tree->fdivs[off];
 +	ulong rate;
 +
 +	switch (fdiv->flags & CLK_PARENT_MASK) {
 +	case CLK_PARENT_TOPCKGEN:
 +		rate = mtk_clk_find_parent_rate(clk, fdiv->parent,
 +						priv->parent);
 +		break;
 +	default:
 +		rate = mtk_clk_find_parent_rate(clk, fdiv->parent, NULL);
 +	}
 +
 +	return mtk_factor_recalc_rate(fdiv, rate);
 +}
 +
 static ulong mtk_topckgen_get_mux_rate(struct clk *clk, u32 off)
 {
 	struct mtk_clk_priv *priv = dev_get_priv(clk->dev);
@@ -332,6 +350,34 @@ static ulong mtk_topckgen_get_mux_rate(s
 	return priv->tree->xtal_rate;
 }
 +static ulong mtk_infrasys_get_mux_rate(struct clk *clk, u32 off)
 +{
 +	struct mtk_clk_priv *priv = dev_get_priv(clk->dev);
 +	const struct mtk_composite *mux = &priv->tree->muxes[off];
 +	u32 index;
 +	u32 flag;
 +
 +	index = readl(priv->base + mux->mux_reg);
 +	index &= mux->mux_mask << mux->mux_shift;
 +	index = index >> mux->mux_shift;
 +
 +	if (mux->parent[index] == CLK_XTAL && priv->tree->flags & CLK_BYPASS_XTAL)
 +		flag = 1;
 +	if (mux->parent[index] > 0 || flag == 1) {
 +		switch (mux->flags & CLK_PARENT_MASK) {
 +		case CLK_PARENT_TOPCKGEN:
 +			return mtk_clk_find_parent_rate(clk, mux->parent[index],
 +							priv->parent);
 +			break;
 +		default:
 +			return mtk_clk_find_parent_rate(clk, mux->parent[index],
 +							NULL);
 +			break;
 +		}
 +	}
 +	return 0;
 +}
 +
 static ulong mtk_topckgen_get_rate(struct clk *clk)
 {
 	struct mtk_clk_priv *priv = dev_get_priv(clk->dev);
@@ -346,6 +392,25 @@ static ulong mtk_topckgen_get_rate(struc
 						 priv->tree->muxes_offs);
 }
 +static ulong mtk_infrasys_get_rate(struct clk *clk)
 +{
 +	struct mtk_clk_priv *priv = dev_get_priv(clk->dev);
 +
 +	ulong rate;
 +
 +	if (clk->id < priv->tree->fdivs_offs) {
 +		rate = priv->tree->fclks[clk->id].rate;
 +	} else if (clk->id < priv->tree->muxes_offs) {
 +		rate = mtk_infrasys_get_factor_rate(clk, clk->id -
 +						    priv->tree->fdivs_offs);
 +	} else {
 +		rate = mtk_infrasys_get_mux_rate(clk, clk->id -
 +						 priv->tree->muxes_offs);
 +	}
 +
 +	return rate;
 +}
 +
 static int mtk_clk_mux_enable(struct clk *clk)
 {
 	struct mtk_clk_priv *priv = dev_get_priv(clk->dev);
@@ -494,6 +559,13 @@ const struct clk_ops mtk_clk_topckgen_op
 	.set_parent = mtk_common_clk_set_parent,
 };
 +const struct clk_ops mtk_clk_infrasys_ops = {
 +	.enable = mtk_clk_mux_enable,
 +	.disable = mtk_clk_mux_disable,
 +	.get_rate = mtk_infrasys_get_rate,
 +	.set_parent = mtk_common_clk_set_parent,
 +};
 +
 const struct clk_ops mtk_clk_gate_ops = {
 	.enable = mtk_clk_gate_enable,
 	.disable = mtk_clk_gate_disable,
 --- a/drivers/clk/mediatek/clk-mtk.h
 +++ b/drivers/clk/mediatek/clk-mtk.h
@@ -28,7 +28,8 @@
 #define CLK_PARENT_APMIXED		BIT(4)
 #define CLK_PARENT_TOPCKGEN		BIT(5)
 -#define CLK_PARENT_MASK			GENMASK(5, 4)
 +#define CLK_PARENT_INFRASYS		BIT(6)
 +#define CLK_PARENT_MASK			GENMASK(6, 4)
 #define ETHSYS_HIFSYS_RST_CTRL_OFS	0x34
@@ -220,6 +221,7 @@ struct mtk_cg_priv {
 extern const struct clk_ops mtk_clk_apmixedsys_ops;
 extern const struct clk_ops mtk_clk_topckgen_ops;
 +extern const struct clk_ops mtk_clk_infrasys_ops;
 extern const struct clk_ops mtk_clk_gate_ops;
 int mtk_common_clk_init(struct udevice *dev,
--- a/package/boot/uboot-mediatek/patches/002-0025-clk-mediatek-add-CLK_XTAL-support-for-clock-driver.patch
+++ b/package/boot/uboot-mediatek/patches/002-0025-clk-mediatek-add-CLK_XTAL-support-for-clock-driver.patch
@@ -0,0 +1,46 @@
 From cf70b726c9844bb5d1ba4bc3c202c5ab3ba4d421 Mon Sep 17 00:00:00 2001
 From: Weijie Gao <weijie.gao@mediatek.com>
 Date: Fri, 29 Jul 2022 11:15:35 +0800
 Subject: [PATCH 25/31] clk: mediatek: add CLK_XTAL support for clock driver
 This add CLK_XTAL macro and flag to mediatek clock driver common part,
 to make thi SoC that has clock directlly connect to XTAL working.
 Signed-off-by: Weijie Gao <weijie.gao@mediatek.com>
 ---
 drivers/clk/mediatek/clk-mtk.c | 4 ++++
 drivers/clk/mediatek/clk-mtk.h | 3 ++-
 2 files changed, 6 insertions(+), 1 deletion(-)
 --- a/drivers/clk/mediatek/clk-mtk.c
 +++ b/drivers/clk/mediatek/clk-mtk.c
@@ -296,6 +296,7 @@ static ulong mtk_topckgen_get_factor_rat
 		rate = mtk_clk_find_parent_rate(clk, fdiv->parent, NULL);
 		break;
 +	case CLK_PARENT_XTAL:
 	default:
 		rate = priv->tree->xtal_rate;
 	}
@@ -314,6 +315,9 @@ static ulong mtk_infrasys_get_factor_rat
 		rate = mtk_clk_find_parent_rate(clk, fdiv->parent,
 						priv->parent);
 		break;
 +	case CLK_PARENT_XTAL:
 +		rate = priv->tree->xtal_rate;
 +		break;
 	default:
 		rate = mtk_clk_find_parent_rate(clk, fdiv->parent, NULL);
 	}
 --- a/drivers/clk/mediatek/clk-mtk.h
 +++ b/drivers/clk/mediatek/clk-mtk.h
@@ -29,7 +29,8 @@
 #define CLK_PARENT_APMIXED		BIT(4)
 #define CLK_PARENT_TOPCKGEN		BIT(5)
 #define CLK_PARENT_INFRASYS		BIT(6)
 -#define CLK_PARENT_MASK			GENMASK(6, 4)
 +#define CLK_PARENT_XTAL			BIT(7)
 +#define CLK_PARENT_MASK			GENMASK(7, 4)
 #define ETHSYS_HIFSYS_RST_CTRL_OFS	0x34
--- a/package/boot/uboot-mediatek/patches/002-0026-clk-mediatek-add-clock-driver-support-for-MediaTek-M.patch
+++ b/package/boot/uboot-mediatek/patches/002-0026-clk-mediatek-add-clock-driver-support-for-MediaTek-M.patch
@@ -0,0 +1,955 @@
 From ba4acf55044a8a11fc7e11a558a8a93e3c126391 Mon Sep 17 00:00:00 2001
 From: Weijie Gao <weijie.gao@mediatek.com>
 Date: Fri, 29 Jul 2022 11:21:59 +0800
 Subject: [PATCH 26/31] clk: mediatek: add clock driver support for MediaTek
 MT7986 SoC
 This patch adds clock driver support for MediaTek MT7986 SoC
 Reviewed-by: Simon Glass <sjg@chromium.org>
 Signed-off-by: Weijie Gao <weijie.gao@mediatek.com>
 ---
 drivers/clk/mediatek/Makefile          |   1 +
 drivers/clk/mediatek/clk-mt7986.c      | 672 +++++++++++++++++++++++++
 include/dt-bindings/clock/mt7986-clk.h | 249 +++++++++
 3 files changed, 922 insertions(+)
 create mode 100644 drivers/clk/mediatek/clk-mt7986.c
 create mode 100644 include/dt-bindings/clock/mt7986-clk.h
 --- a/drivers/clk/mediatek/Makefile
 +++ b/drivers/clk/mediatek/Makefile
@@ -7,6 +7,7 @@ obj-$(CONFIG_MT8512) += clk-mt8512.o
 obj-$(CONFIG_TARGET_MT7623) += clk-mt7623.o
 obj-$(CONFIG_TARGET_MT7622) += clk-mt7622.o
 obj-$(CONFIG_TARGET_MT7629) += clk-mt7629.o
 +obj-$(CONFIG_TARGET_MT7986) += clk-mt7986.o
 obj-$(CONFIG_TARGET_MT8183) += clk-mt8183.o
 obj-$(CONFIG_TARGET_MT8516) += clk-mt8516.o
 obj-$(CONFIG_TARGET_MT8518) += clk-mt8518.o
 --- /dev/null
 +++ b/drivers/clk/mediatek/clk-mt7986.c
@@ -0,0 +1,672 @@
 +// SPDX-License-Identifier: GPL-2.0
 +/*
 + * MediaTek clock driver for MT7986 SoC
 + *
 + * Copyright (C) 2022 MediaTek Inc.
 + * Author: Sam Shih <sam.shih@mediatek.com>
 + */
 +
 +#include <dm.h>
 +#include <log.h>
 +#include <asm/arch-mediatek/reset.h>
 +#include <asm/io.h>
 +#include <dt-bindings/clock/mt7986-clk.h>
 +#include <linux/bitops.h>
 +
 +#include "clk-mtk.h"
 +
 +#define MT7986_CLK_PDN 0x250
 +#define MT7986_CLK_PDN_EN_WRITE BIT(31)
 +
 +#define PLL_FACTOR(_id, _name, _parent, _mult, _div)                           \
 +	FACTOR(_id, _parent, _mult, _div, CLK_PARENT_APMIXED)
 +
 +#define TOP_FACTOR(_id, _name, _parent, _mult, _div)                           \
 +	FACTOR(_id, _parent, _mult, _div, CLK_PARENT_TOPCKGEN)
 +
 +#define INFRA_FACTOR(_id, _name, _parent, _mult, _div)                         \
 +	FACTOR(_id, _parent, _mult, _div, CLK_PARENT_INFRASYS)
 +
 +/* FIXED PLLS */
 +static const struct mtk_fixed_clk fixed_pll_clks[] = {
 +	FIXED_CLK(CK_APMIXED_ARMPLL, CLK_XTAL, 2000000000),
 +	FIXED_CLK(CK_APMIXED_NET2PLL, CLK_XTAL, 800000000),
 +	FIXED_CLK(CK_APMIXED_MMPLL, CLK_XTAL, 1440000000),
 +	FIXED_CLK(CK_APMIXED_SGMPLL, CLK_XTAL, 325000000),
 +	FIXED_CLK(CK_APMIXED_WEDMCUPLL, CLK_XTAL, 760000000),
 +	FIXED_CLK(CK_APMIXED_NET1PLL, CLK_XTAL, 2500000000),
 +	FIXED_CLK(CK_APMIXED_MPLL, CLK_XTAL, 416000000),
 +	FIXED_CLK(CK_APMIXED_APLL2, CLK_XTAL, 196608000),
 +};
 +
 +/* TOPCKGEN FIXED CLK */
 +static const struct mtk_fixed_clk top_fixed_clks[] = {
 +	FIXED_CLK(CK_TOP_CB_CKSQ_40M, CLK_XTAL, 40000000),
 +};
 +
 +/* TOPCKGEN FIXED DIV */
 +static const struct mtk_fixed_factor top_fixed_divs[] = {
 +	PLL_FACTOR(CK_TOP_CB_M_416M, "cb_m_416m", CK_APMIXED_MPLL, 1, 1),
 +	PLL_FACTOR(CK_TOP_CB_M_D2, "cb_m_d2", CK_APMIXED_MPLL, 1, 2),
 +	PLL_FACTOR(CK_TOP_CB_M_D4, "cb_m_d4", CK_APMIXED_MPLL, 1, 4),
 +	PLL_FACTOR(CK_TOP_CB_M_D8, "cb_m_d8", CK_APMIXED_MPLL, 1, 8),
 +	PLL_FACTOR(CK_TOP_M_D8_D2, "m_d8_d2", CK_APMIXED_MPLL, 1, 16),
 +	PLL_FACTOR(CK_TOP_M_D3_D2, "m_d3_d2", CK_APMIXED_MPLL, 1, 2),
 +	PLL_FACTOR(CK_TOP_CB_MM_D2, "cb_mm_d2", CK_APMIXED_MMPLL, 1, 2),
 +	PLL_FACTOR(CK_TOP_CB_MM_D4, "cb_mm_d4", CK_APMIXED_MMPLL, 1, 4),
 +	PLL_FACTOR(CK_TOP_CB_MM_D8, "cb_mm_d8", CK_APMIXED_MMPLL, 1, 8),
 +	PLL_FACTOR(CK_TOP_MM_D8_D2, "mm_d8_d2", CK_APMIXED_MMPLL, 1, 16),
 +	PLL_FACTOR(CK_TOP_MM_D3_D8, "mm_d3_d8", CK_APMIXED_MMPLL, 1, 8),
 +	PLL_FACTOR(CK_TOP_CB_U2_PHYD_CK, "cb_u2_phyd", CK_APMIXED_MMPLL, 1, 30),
 +	PLL_FACTOR(CK_TOP_CB_APLL2_196M, "cb_apll2_196m", CK_APMIXED_APLL2, 1,
 +		   1),
 +	PLL_FACTOR(CK_TOP_APLL2_D4, "apll2_d4", CK_APMIXED_APLL2, 1, 4),
 +	PLL_FACTOR(CK_TOP_CB_NET1_D4, "cb_net1_d4", CK_APMIXED_NET1PLL, 1, 4),
 +	PLL_FACTOR(CK_TOP_CB_NET1_D5, "cb_net1_d5", CK_APMIXED_NET1PLL, 1, 5),
 +	PLL_FACTOR(CK_TOP_NET1_D5_D2, "net1_d5_d2", CK_APMIXED_NET1PLL, 1, 10),
 +	PLL_FACTOR(CK_TOP_NET1_D5_D4, "net1_d5_d4", CK_APMIXED_NET1PLL, 1, 20),
 +	PLL_FACTOR(CK_TOP_NET1_D8_D2, "net1_d8_d2", CK_APMIXED_NET1PLL, 1, 16),
 +	PLL_FACTOR(CK_TOP_NET1_D8_D4, "net1_d8_d4", CK_APMIXED_NET1PLL, 1, 32),
 +	PLL_FACTOR(CK_TOP_CB_NET2_800M, "cb_net2_800m", CK_APMIXED_NET2PLL, 1,
 +		   1),
 +	PLL_FACTOR(CK_TOP_CB_NET2_D4, "cb_net2_d4", CK_APMIXED_NET2PLL, 1, 4),
 +	PLL_FACTOR(CK_TOP_NET2_D4_D2, "net2_d4_d2", CK_APMIXED_NET2PLL, 1, 8),
 +	PLL_FACTOR(CK_TOP_NET2_D3_D2, "net2_d3_d2", CK_APMIXED_NET2PLL, 1, 2),
 +	PLL_FACTOR(CK_TOP_CB_WEDMCU_760M, "cb_wedmcu_760m",
 +		   CK_APMIXED_WEDMCUPLL, 1, 1),
 +	PLL_FACTOR(CK_TOP_WEDMCU_D5_D2, "wedmcu_d5_d2", CK_APMIXED_WEDMCUPLL, 1,
 +		   10),
 +	PLL_FACTOR(CK_TOP_CB_SGM_325M, "cb_sgm_325m", CK_APMIXED_SGMPLL, 1, 1),
 +	TOP_FACTOR(CK_TOP_CB_CKSQ_40M_D2, "cb_cksq_40m_d2", CK_TOP_CB_CKSQ_40M,
 +		   1, 2),
 +	TOP_FACTOR(CK_TOP_CB_RTC_32K, "cb_rtc_32k", CK_TOP_CB_CKSQ_40M, 1,
 +		   1250),
 +	TOP_FACTOR(CK_TOP_CB_RTC_32P7K, "cb_rtc_32p7k", CK_TOP_CB_CKSQ_40M, 1,
 +		   1220),
 +	TOP_FACTOR(CK_TOP_NFI1X, "nfi1x", CK_TOP_NFI1X_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_USB_EQ_RX250M, "usb_eq_rx250m", CK_TOP_CB_CKSQ_40M, 1,
 +		   1),
 +	TOP_FACTOR(CK_TOP_USB_TX250M, "usb_tx250m", CK_TOP_CB_CKSQ_40M, 1, 1),
 +	TOP_FACTOR(CK_TOP_USB_LN0_CK, "usb_ln0", CK_TOP_CB_CKSQ_40M, 1, 1),
 +	TOP_FACTOR(CK_TOP_USB_CDR_CK, "usb_cdr", CK_TOP_CB_CKSQ_40M, 1, 1),
 +	TOP_FACTOR(CK_TOP_SPINFI_BCK, "spinfi_bck", CK_TOP_SPINFI_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_I2C_BCK, "i2c_bck", CK_TOP_I2C_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_PEXTP_TL, "pextp_tl", CK_TOP_PEXTP_TL_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_EMMC_250M, "emmc_250m", CK_TOP_EMMC_250M_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_EMMC_416M, "emmc_416m", CK_TOP_EMMC_416M_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_F_26M_ADC_CK, "f_26m_adc", CK_TOP_F_26M_ADC_SEL, 1,
 +		   1),
 +	TOP_FACTOR(CK_TOP_SYSAXI, "sysaxi", CK_TOP_SYSAXI_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_NETSYS_WED_MCU, "netsys_wed_mcu",
 +		   CK_TOP_NETSYS_MCU_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_NETSYS_2X, "netsys_2x", CK_TOP_NETSYS_2X_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_SGM_325M, "sgm_325m", CK_TOP_SGM_325M_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_A1SYS, "a1sys", CK_TOP_A1SYS_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_EIP_B, "eip_b", CK_TOP_EIP_B_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_F26M, "csw_f26m", CK_TOP_F26M_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_AUD_L, "aud_l", CK_TOP_AUD_L_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_A_TUNER, "a_tuner", CK_TOP_A_TUNER_SEL, 2, 1),
 +	TOP_FACTOR(CK_TOP_U2U3_REF, "u2u3_ref", CK_TOP_U2U3_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_U2U3_SYS, "u2u3_sys", CK_TOP_U2U3_SYS_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_U2U3_XHCI, "u2u3_xhci", CK_TOP_U2U3_XHCI_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_AP2CNN_HOST, "ap2cnn_host", CK_TOP_AP2CNN_HOST_SEL, 1,
 +		   1),
 +};
 +
 +/* TOPCKGEN MUX PARENTS */
 +static const int nfi1x_parents[] = { CK_TOP_CB_CKSQ_40M,  CK_TOP_CB_MM_D8,
 +				     CK_TOP_NET1_D8_D2,   CK_TOP_NET2_D3_D2,
 +				     CK_TOP_CB_M_D4,      CK_TOP_MM_D8_D2,
 +				     CK_TOP_WEDMCU_D5_D2, CK_TOP_CB_M_D8 };
 +
 +static const int spinfi_parents[] = {
 +	CK_TOP_CB_CKSQ_40M_D2, CK_TOP_CB_CKSQ_40M, CK_TOP_NET1_D5_D4,
 +	CK_TOP_CB_M_D4,	CK_TOP_MM_D8_D2,    CK_TOP_WEDMCU_D5_D2,
 +	CK_TOP_MM_D3_D8,       CK_TOP_CB_M_D8
 +};
 +
 +static const int spi_parents[] = { CK_TOP_CB_CKSQ_40M, CK_TOP_CB_M_D2,
 +				   CK_TOP_CB_MM_D8,    CK_TOP_NET1_D8_D2,
 +				   CK_TOP_NET2_D3_D2,  CK_TOP_NET1_D5_D4,
 +				   CK_TOP_CB_M_D4,     CK_TOP_WEDMCU_D5_D2 };
 +
 +static const int uart_parents[] = { CK_TOP_CB_CKSQ_40M, CK_TOP_CB_M_D8,
 +				    CK_TOP_M_D8_D2 };
 +
 +static const int pwm_parents[] = { CK_TOP_CB_CKSQ_40M, CK_TOP_NET1_D8_D2,
 +				   CK_TOP_NET1_D5_D4, CK_TOP_CB_M_D4 };
 +
 +static const int i2c_parents[] = { CK_TOP_CB_CKSQ_40M, CK_TOP_NET1_D5_D4,
 +				   CK_TOP_CB_M_D4, CK_TOP_NET1_D8_D4 };
 +
 +static const int pextp_tl_ck_parents[] = { CK_TOP_CB_CKSQ_40M,
 +					   CK_TOP_NET1_D5_D4, CK_TOP_NET2_D4_D2,
 +					   CK_TOP_CB_RTC_32K };
 +
 +static const int emmc_250m_parents[] = { CK_TOP_CB_CKSQ_40M,
 +					 CK_TOP_NET1_D5_D2 };
 +
 +static const int emmc_416m_parents[] = { CK_TOP_CB_CKSQ_40M, CK_TOP_CB_M_416M };
 +
 +static const int f_26m_adc_parents[] = { CK_TOP_CB_CKSQ_40M, CK_TOP_M_D8_D2 };
 +
 +static const int dramc_md32_parents[] = { CK_TOP_CB_CKSQ_40M, CK_TOP_CB_M_D2 };
 +
 +static const int sysaxi_parents[] = { CK_TOP_CB_CKSQ_40M, CK_TOP_NET1_D8_D2,
 +				      CK_TOP_CB_NET2_D4 };
 +
 +static const int sysapb_parents[] = { CK_TOP_CB_CKSQ_40M, CK_TOP_M_D3_D2,
 +				      CK_TOP_NET2_D4_D2 };
 +
 +static const int arm_db_main_parents[] = { CK_TOP_CB_CKSQ_40M,
 +					   CK_TOP_NET2_D3_D2 };
 +
 +static const int arm_db_jtsel_parents[] = { -1, CK_TOP_CB_CKSQ_40M };
 +
 +static const int netsys_parents[] = { CK_TOP_CB_CKSQ_40M, CK_TOP_CB_MM_D4 };
 +
 +static const int netsys_500m_parents[] = { CK_TOP_CB_CKSQ_40M,
 +					   CK_TOP_CB_NET1_D5 };
 +
 +static const int netsys_mcu_parents[] = { CK_TOP_CB_CKSQ_40M,
 +					  CK_TOP_CB_WEDMCU_760M,
 +					  CK_TOP_CB_MM_D2, CK_TOP_CB_NET1_D4,
 +					  CK_TOP_CB_NET1_D5 };
 +
 +static const int netsys_2x_parents[] = { CK_TOP_CB_CKSQ_40M,
 +					 CK_TOP_CB_NET2_800M,
 +					 CK_TOP_CB_WEDMCU_760M,
 +					 CK_TOP_CB_MM_D2 };
 +
 +static const int sgm_325m_parents[] = { CK_TOP_CB_CKSQ_40M,
 +					CK_TOP_CB_SGM_325M };
 +
 +static const int sgm_reg_parents[] = { CK_TOP_CB_CKSQ_40M, CK_TOP_NET1_D8_D4 };
 +
 +static const int a1sys_parents[] = { CK_TOP_CB_CKSQ_40M, CK_TOP_APLL2_D4 };
 +
 +static const int conn_mcusys_parents[] = { CK_TOP_CB_CKSQ_40M,
 +					   CK_TOP_CB_MM_D2 };
 +
 +static const int eip_b_parents[] = { CK_TOP_CB_CKSQ_40M, CK_TOP_CB_NET2_800M };
 +
 +static const int aud_l_parents[] = { CK_TOP_CB_CKSQ_40M, CK_TOP_CB_APLL2_196M,
 +				     CK_TOP_M_D8_D2 };
 +
 +static const int a_tuner_parents[] = { CK_TOP_CB_CKSQ_40M, CK_TOP_APLL2_D4,
 +				       CK_TOP_M_D8_D2 };
 +
 +static const int u2u3_sys_parents[] = { CK_TOP_CB_CKSQ_40M, CK_TOP_NET1_D5_D4 };
 +
 +static const int da_u2_refsel_parents[] = { CK_TOP_CB_CKSQ_40M,
 +					    CK_TOP_CB_U2_PHYD_CK };
 +
 +#define TOP_MUX(_id, _name, _parents, _mux_ofs, _mux_set_ofs, _mux_clr_ofs,    \
 +		_shift, _width, _gate, _upd_ofs, _upd)                         \
 +	{                                                                      \
 +		.id = _id, .mux_reg = _mux_ofs, .mux_set_reg = _mux_set_ofs,   \
 +		.mux_clr_reg = _mux_clr_ofs, .upd_reg = _upd_ofs,              \
 +		.upd_shift = _upd, .mux_shift = _shift,                        \
 +		.mux_mask = BIT(_width) - 1, .gate_reg = _mux_ofs,             \
 +		.gate_shift = _gate, .parent = _parents,                       \
 +		.num_parents = ARRAY_SIZE(_parents),                           \
 +		.flags = CLK_MUX_SETCLR_UPD,                                   \
 +	}
 +
 +/* TOPCKGEN MUX_GATE */
 +static const struct mtk_composite top_muxes[] = {
 +	/* CLK_CFG_0 */
 +	TOP_MUX(CK_TOP_NFI1X_SEL, "nfi1x_sel", nfi1x_parents, 0x000, 0x004,
 +		0x008, 0, 3, 7, 0x1C0, 0),
 +	TOP_MUX(CK_TOP_SPINFI_SEL, "spinfi_sel", spinfi_parents, 0x000, 0x004,
 +		0x008, 8, 3, 15, 0x1C0, 1),
 +	TOP_MUX(CK_TOP_SPI_SEL, "spi_sel", spi_parents, 0x000, 0x004, 0x008, 16,
 +		3, 23, 0x1C0, 2),
 +	TOP_MUX(CK_TOP_SPIM_MST_SEL, "spim_mst_sel", spi_parents, 0x000, 0x004,
 +		0x008, 24, 3, 31, 0x1C0, 3),
 +	/* CLK_CFG_1 */
 +	TOP_MUX(CK_TOP_UART_SEL, "uart_sel", uart_parents, 0x010, 0x014, 0x018,
 +		0, 2, 7, 0x1C0, 4),
 +	TOP_MUX(CK_TOP_PWM_SEL, "pwm_sel", pwm_parents, 0x010, 0x014, 0x018, 8,
 +		2, 15, 0x1C0, 5),
 +	TOP_MUX(CK_TOP_I2C_SEL, "i2c_sel", i2c_parents, 0x010, 0x014, 0x018, 16,
 +		2, 23, 0x1C0, 6),
 +	TOP_MUX(CK_TOP_PEXTP_TL_SEL, "pextp_tl_ck_sel", pextp_tl_ck_parents,
 +		0x010, 0x014, 0x018, 24, 2, 31, 0x1C0, 7),
 +	/* CLK_CFG_2 */
 +	TOP_MUX(CK_TOP_EMMC_250M_SEL, "emmc_250m_sel", emmc_250m_parents, 0x020,
 +		0x024, 0x028, 0, 1, 7, 0x1C0, 8),
 +	TOP_MUX(CK_TOP_EMMC_416M_SEL, "emmc_416m_sel", emmc_416m_parents, 0x020,
 +		0x024, 0x028, 8, 1, 15, 0x1C0, 9),
 +	TOP_MUX(CK_TOP_F_26M_ADC_SEL, "f_26m_adc_sel", f_26m_adc_parents, 0x020,
 +		0x024, 0x028, 16, 1, 23, 0x1C0, 10),
 +	TOP_MUX(CK_TOP_DRAMC_SEL, "dramc_sel", f_26m_adc_parents, 0x020, 0x024,
 +		0x028, 24, 1, 31, 0x1C0, 11),
 +	/* CLK_CFG_3 */
 +	TOP_MUX(CK_TOP_DRAMC_MD32_SEL, "dramc_md32_sel", dramc_md32_parents,
 +		0x030, 0x034, 0x038, 0, 1, 7, 0x1C0, 12),
 +	TOP_MUX(CK_TOP_SYSAXI_SEL, "sysaxi_sel", sysaxi_parents, 0x030, 0x034,
 +		0x038, 8, 2, 15, 0x1C0, 13),
 +	TOP_MUX(CK_TOP_SYSAPB_SEL, "sysapb_sel", sysapb_parents, 0x030, 0x034,
 +		0x038, 16, 2, 23, 0x1C0, 14),
 +	TOP_MUX(CK_TOP_ARM_DB_MAIN_SEL, "arm_db_main_sel", arm_db_main_parents,
 +		0x030, 0x034, 0x038, 24, 1, 31, 0x1C0, 15),
 +	/* CLK_CFG_4 */
 +	TOP_MUX(CK_TOP_ARM_DB_JTSEL, "arm_db_jtsel", arm_db_jtsel_parents,
 +		0x040, 0x044, 0x048, 0, 1, 7, 0x1C0, 16),
 +	TOP_MUX(CK_TOP_NETSYS_SEL, "netsys_sel", netsys_parents, 0x040, 0x044,
 +		0x048, 8, 1, 15, 0x1C0, 17),
 +	TOP_MUX(CK_TOP_NETSYS_500M_SEL, "netsys_500m_sel", netsys_500m_parents,
 +		0x040, 0x044, 0x048, 16, 1, 23, 0x1C0, 18),
 +	TOP_MUX(CK_TOP_NETSYS_MCU_SEL, "netsys_mcu_sel", netsys_mcu_parents,
 +		0x040, 0x044, 0x048, 24, 3, 31, 0x1C0, 19),
 +	/* CLK_CFG_5 */
 +	TOP_MUX(CK_TOP_NETSYS_2X_SEL, "netsys_2x_sel", netsys_2x_parents, 0x050,
 +		0x054, 0x058, 0, 2, 7, 0x1C0, 20),
 +	TOP_MUX(CK_TOP_SGM_325M_SEL, "sgm_325m_sel", sgm_325m_parents, 0x050,
 +		0x054, 0x058, 8, 1, 15, 0x1C0, 21),
 +	TOP_MUX(CK_TOP_SGM_REG_SEL, "sgm_reg_sel", sgm_reg_parents, 0x050,
 +		0x054, 0x058, 16, 1, 23, 0x1C0, 22),
 +	TOP_MUX(CK_TOP_A1SYS_SEL, "a1sys_sel", a1sys_parents, 0x050, 0x054,
 +		0x058, 24, 1, 31, 0x1C0, 23),
 +	/* CLK_CFG_6 */
 +	TOP_MUX(CK_TOP_CONN_MCUSYS_SEL, "conn_mcusys_sel", conn_mcusys_parents,
 +		0x060, 0x064, 0x068, 0, 1, 7, 0x1C0, 24),
 +	TOP_MUX(CK_TOP_EIP_B_SEL, "eip_b_sel", eip_b_parents, 0x060, 0x064,
 +		0x068, 8, 1, 15, 0x1C0, 25),
 +	TOP_MUX(CK_TOP_PCIE_PHY_SEL, "pcie_phy_sel", f_26m_adc_parents, 0x060,
 +		0x064, 0x068, 16, 1, 23, 0x1C0, 26),
 +	TOP_MUX(CK_TOP_USB3_PHY_SEL, "usb3_phy_sel", f_26m_adc_parents, 0x060,
 +		0x064, 0x068, 24, 1, 31, 0x1C0, 27),
 +	/* CLK_CFG_7 */
 +	TOP_MUX(CK_TOP_F26M_SEL, "csw_f26m_sel", f_26m_adc_parents, 0x070,
 +		0x074, 0x078, 0, 1, 7, 0x1C0, 28),
 +	TOP_MUX(CK_TOP_AUD_L_SEL, "aud_l_sel", aud_l_parents, 0x070, 0x074,
 +		0x078, 8, 2, 15, 0x1C0, 29),
 +	TOP_MUX(CK_TOP_A_TUNER_SEL, "a_tuner_sel", a_tuner_parents, 0x070,
 +		0x074, 0x078, 16, 2, 23, 0x1C0, 30),
 +	TOP_MUX(CK_TOP_U2U3_SEL, "u2u3_sel", f_26m_adc_parents, 0x070, 0x074,
 +		0x078, 24, 1, 31, 0x1C4, 0),
 +	/* CLK_CFG_8 */
 +	TOP_MUX(CK_TOP_U2U3_SYS_SEL, "u2u3_sys_sel", u2u3_sys_parents, 0x080,
 +		0x084, 0x088, 0, 1, 7, 0x1C4, 1),
 +	TOP_MUX(CK_TOP_U2U3_XHCI_SEL, "u2u3_xhci_sel", u2u3_sys_parents, 0x080,
 +		0x084, 0x088, 8, 1, 15, 0x1C4, 2),
 +	TOP_MUX(CK_TOP_DA_U2_REFSEL, "da_u2_refsel", da_u2_refsel_parents,
 +		0x080, 0x084, 0x088, 16, 1, 23, 0x1C4, 3),
 +	TOP_MUX(CK_TOP_DA_U2_CK_1P_SEL, "da_u2_ck_1p_sel", da_u2_refsel_parents,
 +		0x080, 0x084, 0x088, 24, 1, 31, 0x1C4, 4),
 +	/* CLK_CFG_9 */
 +	TOP_MUX(CK_TOP_AP2CNN_HOST_SEL, "ap2cnn_host_sel", sgm_reg_parents,
 +		0x090, 0x094, 0x098, 0, 1, 7, 0x1C4, 5),
 +};
 +
 +/* INFRA FIXED DIV */
 +static const struct mtk_fixed_factor infra_fixed_divs[] = {
 +	TOP_FACTOR(CK_INFRA_CK_F26M, "infra_ck_f26m", CK_TOP_F26M_SEL, 1, 1),
 +	TOP_FACTOR(CK_INFRA_UART, "infra_uart", CK_TOP_UART_SEL, 1, 1),
 +	TOP_FACTOR(CK_INFRA_ISPI0, "infra_ispi0", CK_TOP_SPI_SEL, 1, 1),
 +	TOP_FACTOR(CK_INFRA_I2C, "infra_i2c", CK_TOP_I2C_SEL, 1, 1),
 +	TOP_FACTOR(CK_INFRA_ISPI1, "infra_ispi1", CK_TOP_SPINFI_SEL, 1, 1),
 +	TOP_FACTOR(CK_INFRA_PWM, "infra_pwm", CK_TOP_PWM_SEL, 1, 1),
 +	TOP_FACTOR(CK_INFRA_66M_MCK, "infra_66m_mck", CK_TOP_SYSAXI_SEL, 1, 2),
 +	TOP_FACTOR(CK_INFRA_CK_F32K, "infra_ck_f32k", CK_TOP_CB_RTC_32P7K, 1,
 +		   1),
 +	TOP_FACTOR(CK_INFRA_PCIE_CK, "infra_pcie", CK_TOP_PEXTP_TL_SEL, 1, 1),
 +	INFRA_FACTOR(CK_INFRA_PWM_BCK, "infra_pwm_bck", CK_INFRA_PWM_BSEL, 1,
 +		     1),
 +	INFRA_FACTOR(CK_INFRA_PWM_CK1, "infra_pwm_ck1", CK_INFRA_PWM1_SEL, 1,
 +		     1),
 +	INFRA_FACTOR(CK_INFRA_PWM_CK2, "infra_pwm_ck2", CK_INFRA_PWM2_SEL, 1,
 +		     1),
 +	TOP_FACTOR(CK_INFRA_133M_HCK, "infra_133m_hck", CK_TOP_SYSAXI, 1, 1),
 +	TOP_FACTOR(CK_INFRA_EIP_CK, "infra_eip", CK_TOP_EIP_B, 1, 1),
 +	INFRA_FACTOR(CK_INFRA_66M_PHCK, "infra_66m_phck", CK_INFRA_133M_HCK, 1,
 +		     1),
 +	TOP_FACTOR(CK_INFRA_FAUD_L_CK, "infra_faud_l", CK_TOP_AUD_L, 1, 1),
 +	TOP_FACTOR(CK_INFRA_FAUD_AUD_CK, "infra_faud_aud", CK_TOP_A1SYS, 1, 1),
 +	TOP_FACTOR(CK_INFRA_FAUD_EG2_CK, "infra_faud_eg2", CK_TOP_A_TUNER, 1,
 +		   1),
 +	TOP_FACTOR(CK_INFRA_I2CS_CK, "infra_i2cs", CK_TOP_I2C_BCK, 1, 1),
 +	INFRA_FACTOR(CK_INFRA_MUX_UART0, "infra_mux_uart0", CK_INFRA_UART0_SEL,
 +		     1, 1),
 +	INFRA_FACTOR(CK_INFRA_MUX_UART1, "infra_mux_uart1", CK_INFRA_UART1_SEL,
 +		     1, 1),
 +	INFRA_FACTOR(CK_INFRA_MUX_UART2, "infra_mux_uart2", CK_INFRA_UART2_SEL,
 +		     1, 1),
 +	TOP_FACTOR(CK_INFRA_NFI_CK, "infra_nfi", CK_TOP_NFI1X, 1, 1),
 +	TOP_FACTOR(CK_INFRA_SPINFI_CK, "infra_spinfi", CK_TOP_SPINFI_BCK, 1, 1),
 +	INFRA_FACTOR(CK_INFRA_MUX_SPI0, "infra_mux_spi0", CK_INFRA_SPI0_SEL, 1,
 +		     1),
 +	INFRA_FACTOR(CK_INFRA_MUX_SPI1, "infra_mux_spi1", CK_INFRA_SPI1_SEL, 1,
 +		     1),
 +	TOP_FACTOR(CK_INFRA_RTC_32K, "infra_rtc_32k", CK_TOP_CB_RTC_32K, 1, 1),
 +	TOP_FACTOR(CK_INFRA_FMSDC_CK, "infra_fmsdc", CK_TOP_EMMC_416M, 1, 1),
 +	TOP_FACTOR(CK_INFRA_FMSDC_HCK_CK, "infra_fmsdc_hck", CK_TOP_EMMC_250M,
 +		   1, 1),
 +	TOP_FACTOR(CK_INFRA_PERI_133M, "infra_peri_133m", CK_TOP_SYSAXI, 1, 1),
 +	TOP_FACTOR(CK_INFRA_133M_PHCK, "infra_133m_phck", CK_TOP_SYSAXI, 1, 1),
 +	TOP_FACTOR(CK_INFRA_USB_SYS_CK, "infra_usb_sys", CK_TOP_U2U3_SYS, 1, 1),
 +	TOP_FACTOR(CK_INFRA_USB_CK, "infra_usb", CK_TOP_U2U3_REF, 1, 1),
 +	TOP_FACTOR(CK_INFRA_USB_XHCI_CK, "infra_usb_xhci", CK_TOP_U2U3_XHCI, 1,
 +		   1),
 +	TOP_FACTOR(CK_INFRA_PCIE_GFMUX_TL_O_PRE, "infra_pcie_mux",
 +		   CK_TOP_PEXTP_TL, 1, 1),
 +	TOP_FACTOR(CK_INFRA_F26M_CK0, "infra_f26m_ck0", CK_TOP_F26M, 1, 1),
 +	TOP_FACTOR(CK_INFRA_HD_133M, "infra_hd_133m", CK_TOP_SYSAXI, 1, 1),
 +};
 +
 +/* INFRASYS MUX PARENTS */
 +static const int infra_uart0_parents[] = { CK_INFRA_CK_F26M, CK_INFRA_UART };
 +
 +static const int infra_spi0_parents[] = { CK_INFRA_I2C, CK_INFRA_ISPI0 };
 +
 +static const int infra_spi1_parents[] = { CK_INFRA_I2C, CK_INFRA_ISPI1 };
 +
 +static const int infra_pwm_bsel_parents[] = { CK_INFRA_CK_F32K,
 +					      CK_INFRA_CK_F26M,
 +					      CK_INFRA_66M_MCK, CK_INFRA_PWM };
 +
 +static const int infra_pcie_parents[] = { CK_INFRA_CK_F32K, CK_INFRA_CK_F26M,
 +					  -1, CK_INFRA_PCIE_CK };
 +
 +#define INFRA_MUX(_id, _name, _parents, _reg, _shift, _width)                  \
 +	{                                                                      \
 +		.id = _id, .mux_reg = (_reg) + 0x8,                            \
 +		.mux_set_reg = (_reg) + 0x0, .mux_clr_reg = (_reg) + 0x4,      \
 +		.mux_shift = _shift, .mux_mask = BIT(_width) - 1,              \
 +		.parent = _parents, .num_parents = ARRAY_SIZE(_parents),       \
 +		.flags = CLK_MUX_SETCLR_UPD | CLK_PARENT_INFRASYS,             \
 +	}
 +
 +/* INFRA MUX */
 +
 +static const struct mtk_composite infra_muxes[] = {
 +	/* MODULE_CLK_SEL_0 */
 +	INFRA_MUX(CK_INFRA_UART0_SEL, "infra_uart0_sel", infra_uart0_parents,
 +		  0x10, 0, 1),
 +	INFRA_MUX(CK_INFRA_UART1_SEL, "infra_uart1_sel", infra_uart0_parents,
 +		  0x10, 1, 1),
 +	INFRA_MUX(CK_INFRA_UART2_SEL, "infra_uart2_sel", infra_uart0_parents,
 +		  0x10, 2, 1),
 +	INFRA_MUX(CK_INFRA_SPI0_SEL, "infra_spi0_sel", infra_spi0_parents, 0x10,
 +		  4, 1),
 +	INFRA_MUX(CK_INFRA_SPI1_SEL, "infra_spi1_sel", infra_spi1_parents, 0x10,
 +		  5, 1),
 +	INFRA_MUX(CK_INFRA_PWM1_SEL, "infra_pwm1_sel", infra_pwm_bsel_parents,
 +		  0x10, 9, 2),
 +	INFRA_MUX(CK_INFRA_PWM2_SEL, "infra_pwm2_sel", infra_pwm_bsel_parents,
 +		  0x10, 11, 2),
 +	INFRA_MUX(CK_INFRA_PWM_BSEL, "infra_pwm_bsel", infra_pwm_bsel_parents,
 +		  0x10, 13, 2),
 +	/* MODULE_CLK_SEL_1 */
 +	INFRA_MUX(CK_INFRA_PCIE_SEL, "infra_pcie_sel", infra_pcie_parents, 0x20,
 +		  0, 2),
 +};
 +
 +static const struct mtk_gate_regs infra_0_cg_regs = {
 +	.set_ofs = 0x40,
 +	.clr_ofs = 0x44,
 +	.sta_ofs = 0x48,
 +};
 +
 +static const struct mtk_gate_regs infra_1_cg_regs = {
 +	.set_ofs = 0x50,
 +	.clr_ofs = 0x54,
 +	.sta_ofs = 0x58,
 +};
 +
 +static const struct mtk_gate_regs infra_2_cg_regs = {
 +	.set_ofs = 0x60,
 +	.clr_ofs = 0x64,
 +	.sta_ofs = 0x68,
 +};
 +
 +#define GATE_INFRA0(_id, _name, _parent, _shift)                               \
 +	{                                                                      \
 +		.id = _id, .parent = _parent, .regs = &infra_0_cg_regs,        \
 +		.shift = _shift,                                               \
 +		.flags = CLK_GATE_SETCLR | CLK_PARENT_INFRASYS,                \
 +	}
 +
 +#define GATE_INFRA1(_id, _name, _parent, _shift)                               \
 +	{                                                                      \
 +		.id = _id, .parent = _parent, .regs = &infra_1_cg_regs,        \
 +		.shift = _shift,                                               \
 +		.flags = CLK_GATE_SETCLR | CLK_PARENT_INFRASYS,                \
 +	}
 +
 +#define GATE_INFRA2(_id, _name, _parent, _shift)                               \
 +	{                                                                      \
 +		.id = _id, .parent = _parent, .regs = &infra_2_cg_regs,        \
 +		.shift = _shift,                                               \
 +		.flags = CLK_GATE_SETCLR | CLK_PARENT_INFRASYS,                \
 +	}
 +
 +/* INFRA GATE */
 +
 +static const struct mtk_gate infracfg_ao_gates[] = {
 +	/* INFRA0 */
 +	GATE_INFRA0(CK_INFRA_GPT_STA, "infra_gpt_sta", CK_INFRA_66M_MCK, 0),
 +	GATE_INFRA0(CK_INFRA_PWM_HCK, "infra_pwm_hck", CK_INFRA_66M_MCK, 1),
 +	GATE_INFRA0(CK_INFRA_PWM_STA, "infra_pwm_sta", CK_INFRA_PWM_BCK, 2),
 +	GATE_INFRA0(CK_INFRA_PWM1_CK, "infra_pwm1", CK_INFRA_PWM_CK1, 3),
 +	GATE_INFRA0(CK_INFRA_PWM2_CK, "infra_pwm2", CK_INFRA_PWM_CK2, 4),
 +	GATE_INFRA0(CK_INFRA_CQ_DMA_CK, "infra_cq_dma", CK_INFRA_133M_HCK, 6),
 +	GATE_INFRA0(CK_INFRA_EIP97_CK, "infra_eip97", CK_INFRA_EIP_CK, 7),
 +	GATE_INFRA0(CK_INFRA_AUD_BUS_CK, "infra_aud_bus", CK_INFRA_66M_PHCK, 8),
 +	GATE_INFRA0(CK_INFRA_AUD_26M_CK, "infra_aud_26m", CK_INFRA_CK_F26M, 9),
 +	GATE_INFRA0(CK_INFRA_AUD_L_CK, "infra_aud_l", CK_INFRA_FAUD_L_CK, 10),
 +	GATE_INFRA0(CK_INFRA_AUD_AUD_CK, "infra_aud_aud", CK_INFRA_FAUD_AUD_CK,
 +		    11),
 +	GATE_INFRA0(CK_INFRA_AUD_EG2_CK, "infra_aud_eg2", CK_INFRA_FAUD_EG2_CK,
 +		    13),
 +	GATE_INFRA0(CK_INFRA_DRAMC_26M_CK, "infra_dramc_26m", CK_INFRA_CK_F26M,
 +		    14),
 +	GATE_INFRA0(CK_INFRA_DBG_CK, "infra_dbg", CK_INFRA_66M_MCK, 15),
 +	GATE_INFRA0(CK_INFRA_AP_DMA_CK, "infra_ap_dma", CK_INFRA_66M_MCK, 16),
 +	GATE_INFRA0(CK_INFRA_SEJ_CK, "infra_sej", CK_INFRA_66M_MCK, 24),
 +	GATE_INFRA0(CK_INFRA_SEJ_13M_CK, "infra_sej_13m", CK_INFRA_CK_F26M, 25),
 +	GATE_INFRA0(CK_INFRA_TRNG_CK, "infra_trng", CK_INFRA_HD_133M, 26),
 +	/* INFRA1 */
 +	GATE_INFRA1(CK_INFRA_THERM_CK, "infra_therm", CK_INFRA_CK_F26M, 0),
 +	GATE_INFRA1(CK_INFRA_I2CO_CK, "infra_i2co", CK_INFRA_I2CS_CK, 1),
 +	GATE_INFRA1(CK_INFRA_UART0_CK, "infra_uart0", CK_INFRA_MUX_UART0, 2),
 +	GATE_INFRA1(CK_INFRA_UART1_CK, "infra_uart1", CK_INFRA_MUX_UART1, 3),
 +	GATE_INFRA1(CK_INFRA_UART2_CK, "infra_uart2", CK_INFRA_MUX_UART2, 4),
 +	GATE_INFRA1(CK_INFRA_NFI1_CK, "infra_nfi1", CK_INFRA_NFI_CK, 8),
 +	GATE_INFRA1(CK_INFRA_SPINFI1_CK, "infra_spinfi1", CK_INFRA_SPINFI_CK,
 +		    9),
 +	GATE_INFRA1(CK_INFRA_NFI_HCK_CK, "infra_nfi_hck", CK_INFRA_66M_MCK, 10),
 +	GATE_INFRA1(CK_INFRA_SPI0_CK, "infra_spi0", CK_INFRA_MUX_SPI0, 11),
 +	GATE_INFRA1(CK_INFRA_SPI1_CK, "infra_spi1", CK_INFRA_MUX_SPI1, 12),
 +	GATE_INFRA1(CK_INFRA_SPI0_HCK_CK, "infra_spi0_hck", CK_INFRA_66M_MCK,
 +		    13),
 +	GATE_INFRA1(CK_INFRA_SPI1_HCK_CK, "infra_spi1_hck", CK_INFRA_66M_MCK,
 +		    14),
 +	GATE_INFRA1(CK_INFRA_FRTC_CK, "infra_frtc", CK_INFRA_RTC_32K, 15),
 +	GATE_INFRA1(CK_INFRA_MSDC_CK, "infra_msdc", CK_INFRA_FMSDC_CK, 16),
 +	GATE_INFRA1(CK_INFRA_MSDC_HCK_CK, "infra_msdc_hck",
 +		    CK_INFRA_FMSDC_HCK_CK, 17),
 +	GATE_INFRA1(CK_INFRA_MSDC_133M_CK, "infra_msdc_133m",
 +		    CK_INFRA_PERI_133M, 18),
 +	GATE_INFRA1(CK_INFRA_MSDC_66M_CK, "infra_msdc_66m", CK_INFRA_66M_PHCK,
 +		    19),
 +	GATE_INFRA1(CK_INFRA_ADC_26M_CK, "infra_adc_26m", CK_INFRA_CK_F26M, 20),
 +	GATE_INFRA1(CK_INFRA_ADC_FRC_CK, "infra_adc_frc", CK_INFRA_CK_F26M, 21),
 +	GATE_INFRA1(CK_INFRA_FBIST2FPC_CK, "infra_fbist2fpc", CK_INFRA_NFI_CK,
 +		    23),
 +	/* INFRA2 */
 +	GATE_INFRA2(CK_INFRA_IUSB_133_CK, "infra_iusb_133", CK_INFRA_133M_PHCK,
 +		    0),
 +	GATE_INFRA2(CK_INFRA_IUSB_66M_CK, "infra_iusb_66m", CK_INFRA_66M_PHCK,
 +		    1),
 +	GATE_INFRA2(CK_INFRA_IUSB_SYS_CK, "infra_iusb_sys", CK_INFRA_USB_SYS_CK,
 +		    2),
 +	GATE_INFRA2(CK_INFRA_IUSB_CK, "infra_iusb", CK_INFRA_USB_CK, 3),
 +	GATE_INFRA2(CK_INFRA_IPCIE_CK, "infra_ipcie", CK_INFRA_PCIE_CK, 13),
 +	GATE_INFRA2(CK_INFRA_IPCIER_CK, "infra_ipcier", CK_INFRA_F26M_CK0, 15),
 +	GATE_INFRA2(CK_INFRA_IPCIEB_CK, "infra_ipcieb", CK_INFRA_133M_PHCK, 15),
 +};
 +
 +static const struct mtk_clk_tree mt7986_fixed_pll_clk_tree = {
 +	.fdivs_offs = CLK_APMIXED_NR_CLK,
 +	.xtal_rate = 40 * MHZ,
 +	.fclks = fixed_pll_clks,
 +};
 +
 +static const struct mtk_clk_tree mt7986_topckgen_clk_tree = {
 +	.fdivs_offs = CK_TOP_CB_M_416M,
 +	.muxes_offs = CK_TOP_NFI1X_SEL,
 +	.fclks = top_fixed_clks,
 +	.fdivs = top_fixed_divs,
 +	.muxes = top_muxes,
 +	.flags = CLK_BYPASS_XTAL,
 +};
 +
 +static const struct mtk_clk_tree mt7986_infracfg_clk_tree = {
 +	.fdivs_offs = CK_INFRA_CK_F26M,
 +	.muxes_offs = CK_INFRA_UART0_SEL,
 +	.fdivs = infra_fixed_divs,
 +	.muxes = infra_muxes,
 +};
 +
 +static const struct udevice_id mt7986_fixed_pll_compat[] = {
 +	{ .compatible = "mediatek,mt7986-fixed-plls" },
 +	{}
 +};
 +
 +static const struct udevice_id mt7986_topckgen_compat[] = {
 +	{ .compatible = "mediatek,mt7986-topckgen" },
 +	{}
 +};
 +
 +static int mt7986_fixed_pll_probe(struct udevice *dev)
 +{
 +	return mtk_common_clk_init(dev, &mt7986_fixed_pll_clk_tree);
 +}
 +
 +static int mt7986_topckgen_probe(struct udevice *dev)
 +{
 +	struct mtk_clk_priv *priv = dev_get_priv(dev);
 +
 +	priv->base = dev_read_addr_ptr(dev);
 +	writel(MT7986_CLK_PDN_EN_WRITE, priv->base + MT7986_CLK_PDN);
 +
 +	return mtk_common_clk_init(dev, &mt7986_topckgen_clk_tree);
 +}
 +
 +U_BOOT_DRIVER(mtk_clk_apmixedsys) = {
 +	.name = "mt7986-clock-fixed-pll",
 +	.id = UCLASS_CLK,
 +	.of_match = mt7986_fixed_pll_compat,
 +	.probe = mt7986_fixed_pll_probe,
 +	.priv_auto = sizeof(struct mtk_clk_priv),
 +	.ops = &mtk_clk_topckgen_ops,
 +	.flags = DM_FLAG_PRE_RELOC,
 +};
 +
 +U_BOOT_DRIVER(mtk_clk_topckgen) = {
 +	.name = "mt7986-clock-topckgen",
 +	.id = UCLASS_CLK,
 +	.of_match = mt7986_topckgen_compat,
 +	.probe = mt7986_topckgen_probe,
 +	.priv_auto = sizeof(struct mtk_clk_priv),
 +	.ops = &mtk_clk_topckgen_ops,
 +	.flags = DM_FLAG_PRE_RELOC,
 +};
 +
 +static const struct udevice_id mt7986_infracfg_compat[] = {
 +	{ .compatible = "mediatek,mt7986-infracfg" },
 +	{}
 +};
 +
 +static const struct udevice_id mt7986_infracfg_ao_compat[] = {
 +	{ .compatible = "mediatek,mt7986-infracfg_ao" },
 +	{}
 +};
 +
 +static int mt7986_infracfg_probe(struct udevice *dev)
 +{
 +	return mtk_common_clk_init(dev, &mt7986_infracfg_clk_tree);
 +}
 +
 +static int mt7986_infracfg_ao_probe(struct udevice *dev)
 +{
 +	return mtk_common_clk_gate_init(dev, &mt7986_infracfg_clk_tree,
 +					infracfg_ao_gates);
 +}
 +
 +U_BOOT_DRIVER(mtk_clk_infracfg) = {
 +	.name = "mt7986-clock-infracfg",
 +	.id = UCLASS_CLK,
 +	.of_match = mt7986_infracfg_compat,
 +	.probe = mt7986_infracfg_probe,
 +	.priv_auto = sizeof(struct mtk_clk_priv),
 +	.ops = &mtk_clk_infrasys_ops,
 +	.flags = DM_FLAG_PRE_RELOC,
 +};
 +
 +U_BOOT_DRIVER(mtk_clk_infracfg_ao) = {
 +	.name = "mt7986-clock-infracfg-ao",
 +	.id = UCLASS_CLK,
 +	.of_match = mt7986_infracfg_ao_compat,
 +	.probe = mt7986_infracfg_ao_probe,
 +	.priv_auto = sizeof(struct mtk_cg_priv),
 +	.ops = &mtk_clk_gate_ops,
 +	.flags = DM_FLAG_PRE_RELOC,
 +};
 +
 +/* ethsys */
 +static const struct mtk_gate_regs eth_cg_regs = {
 +	.sta_ofs = 0x30,
 +};
 +
 +#define GATE_ETH(_id, _name, _parent, _shift)                                  \
 +	{                                                                      \
 +		.id = _id, .parent = _parent, .regs = &eth_cg_regs,            \
 +		.shift = _shift,                                               \
 +		.flags = CLK_GATE_NO_SETCLR_INV | CLK_PARENT_TOPCKGEN,         \
 +	}
 +
 +static const struct mtk_gate eth_cgs[] = {
 +	GATE_ETH(CK_ETH_FE_EN, "eth_fe_en", CK_TOP_NETSYS_2X, 7),
 +	GATE_ETH(CK_ETH_GP2_EN, "eth_gp2_en", CK_TOP_SGM_325M, 8),
 +	GATE_ETH(CK_ETH_GP1_EN, "eth_gp1_en", CK_TOP_SGM_325M, 8),
 +	GATE_ETH(CK_ETH_WOCPU1_EN, "eth_wocpu1_en", CK_TOP_NETSYS_WED_MCU, 14),
 +	GATE_ETH(CK_ETH_WOCPU0_EN, "eth_wocpu0_en", CK_TOP_NETSYS_WED_MCU, 15),
 +};
 +
 +static int mt7986_ethsys_probe(struct udevice *dev)
 +{
 +	return mtk_common_clk_gate_init(dev, &mt7986_topckgen_clk_tree,
 +					eth_cgs);
 +}
 +
 +static int mt7986_ethsys_bind(struct udevice *dev)
 +{
 +	int ret = 0;
 +
 +	if (CONFIG_IS_ENABLED(RESET_MEDIATEK)) {
 +		ret = mediatek_reset_bind(dev, ETHSYS_HIFSYS_RST_CTRL_OFS, 1);
 +		if (ret)
 +			debug("Warning: failed to bind reset controller\n");
 +	}
 +
 +	return ret;
 +}
 +
 +static const struct udevice_id mt7986_ethsys_compat[] = {
 +	{ .compatible = "mediatek,mt7986-ethsys" },
 +	{ }
 +};
 +
 +U_BOOT_DRIVER(mtk_clk_ethsys) = {
 +	.name = "mt7986-clock-ethsys",
 +	.id = UCLASS_CLK,
 +	.of_match = mt7986_ethsys_compat,
 +	.probe = mt7986_ethsys_probe,
 +	.bind = mt7986_ethsys_bind,
 +	.priv_auto = sizeof(struct mtk_cg_priv),
 +	.ops = &mtk_clk_gate_ops,
 +};
 --- /dev/null
 +++ b/include/dt-bindings/clock/mt7986-clk.h
@@ -0,0 +1,249 @@
 +/* SPDX-License-Identifier: GPL-2.0 */
 +/*
 + * Copyright (C) 2022 MediaTek Inc. All rights reserved.
 + *
 + * Author: Sam Shih <sam.shih@mediatek.com>
 + */
 +
 +#ifndef _DT_BINDINGS_CLK_MT7986_H
 +#define _DT_BINDINGS_CLK_MT7986_H
 +
 +/* INFRACFG */
 +
 +#define CK_INFRA_CK_F26M		0
 +#define CK_INFRA_UART			1
 +#define CK_INFRA_ISPI0			2
 +#define CK_INFRA_I2C			3
 +#define CK_INFRA_ISPI1			4
 +#define CK_INFRA_PWM			5
 +#define CK_INFRA_66M_MCK		6
 +#define CK_INFRA_CK_F32K		7
 +#define CK_INFRA_PCIE_CK		8
 +#define CK_INFRA_PWM_BCK		9
 +#define CK_INFRA_PWM_CK1		10
 +#define CK_INFRA_PWM_CK2		11
 +#define CK_INFRA_133M_HCK		12
 +#define CK_INFRA_EIP_CK			13
 +#define CK_INFRA_66M_PHCK		14
 +#define CK_INFRA_FAUD_L_CK		15
 +#define CK_INFRA_FAUD_AUD_CK		17
 +#define CK_INFRA_FAUD_EG2_CK		17
 +#define CK_INFRA_I2CS_CK		18
 +#define CK_INFRA_MUX_UART0		19
 +#define CK_INFRA_MUX_UART1		20
 +#define CK_INFRA_MUX_UART2		21
 +#define CK_INFRA_NFI_CK			22
 +#define CK_INFRA_SPINFI_CK		23
 +#define CK_INFRA_MUX_SPI0		24
 +#define CK_INFRA_MUX_SPI1		25
 +#define CK_INFRA_RTC_32K		26
 +#define CK_INFRA_FMSDC_CK		27
 +#define CK_INFRA_FMSDC_HCK_CK		28
 +#define CK_INFRA_PERI_133M		29
 +#define CK_INFRA_133M_PHCK		30
 +#define CK_INFRA_USB_SYS_CK		31
 +#define CK_INFRA_USB_CK			32
 +#define CK_INFRA_USB_XHCI_CK		33
 +#define CK_INFRA_PCIE_GFMUX_TL_O_PRE	34
 +#define CK_INFRA_F26M_CK0		35
 +#define CK_INFRA_HD_133M		36
 +#define CLK_INFRA_NR_CLK		37
 +
 +/* TOPCKGEN */
 +
 +#define CK_TOP_CB_CKSQ_40M		0
 +#define CK_TOP_CB_M_416M		1
 +#define CK_TOP_CB_M_D2			2
 +#define CK_TOP_CB_M_D4			3
 +#define CK_TOP_CB_M_D8			4
 +#define CK_TOP_M_D8_D2			5
 +#define CK_TOP_M_D3_D2			6
 +#define CK_TOP_CB_MM_D2			7
 +#define CK_TOP_CB_MM_D4			8
 +#define CK_TOP_CB_MM_D8			9
 +#define CK_TOP_MM_D8_D2			10
 +#define CK_TOP_MM_D3_D8			11
 +#define CK_TOP_CB_U2_PHYD_CK		12
 +#define CK_TOP_CB_APLL2_196M		13
 +#define CK_TOP_APLL2_D4			14
 +#define CK_TOP_CB_NET1_D4		15
 +#define CK_TOP_CB_NET1_D5		16
 +#define CK_TOP_NET1_D5_D2		17
 +#define CK_TOP_NET1_D5_D4		18
 +#define CK_TOP_NET1_D8_D2		19
 +#define CK_TOP_NET1_D8_D4		20
 +#define CK_TOP_CB_NET2_800M		21
 +#define CK_TOP_CB_NET2_D4		22
 +#define CK_TOP_NET2_D4_D2		23
 +#define CK_TOP_NET2_D3_D2		24
 +#define CK_TOP_CB_WEDMCU_760M		25
 +#define CK_TOP_WEDMCU_D5_D2		26
 +#define CK_TOP_CB_SGM_325M		27
 +#define CK_TOP_CB_CKSQ_40M_D2		28
 +#define CK_TOP_CB_RTC_32K		29
 +#define CK_TOP_CB_RTC_32P7K		30
 +#define CK_TOP_NFI1X			31
 +#define CK_TOP_USB_EQ_RX250M		32
 +#define CK_TOP_USB_TX250M		33
 +#define CK_TOP_USB_LN0_CK		34
 +#define CK_TOP_USB_CDR_CK		35
 +#define CK_TOP_SPINFI_BCK		36
 +#define CK_TOP_I2C_BCK			37
 +#define CK_TOP_PEXTP_TL			38
 +#define CK_TOP_EMMC_250M		39
 +#define CK_TOP_EMMC_416M		40
 +#define CK_TOP_F_26M_ADC_CK		41
 +#define CK_TOP_SYSAXI			42
 +#define CK_TOP_NETSYS_WED_MCU		43
 +#define CK_TOP_NETSYS_2X		44
 +#define CK_TOP_SGM_325M			45
 +#define CK_TOP_A1SYS			46
 +#define CK_TOP_EIP_B			47
 +#define CK_TOP_F26M			48
 +#define CK_TOP_AUD_L			49
 +#define CK_TOP_A_TUNER			50
 +#define CK_TOP_U2U3_REF			51
 +#define CK_TOP_U2U3_SYS			52
 +#define CK_TOP_U2U3_XHCI		53
 +#define CK_TOP_AP2CNN_HOST		54
 +#define CK_TOP_NFI1X_SEL		55
 +#define CK_TOP_SPINFI_SEL		56
 +#define CK_TOP_SPI_SEL			57
 +#define CK_TOP_SPIM_MST_SEL		58
 +#define CK_TOP_UART_SEL			59
 +#define CK_TOP_PWM_SEL			60
 +#define CK_TOP_I2C_SEL			61
 +#define CK_TOP_PEXTP_TL_SEL		62
 +#define CK_TOP_EMMC_250M_SEL		63
 +#define CK_TOP_EMMC_416M_SEL		64
 +#define CK_TOP_F_26M_ADC_SEL		65
 +#define CK_TOP_DRAMC_SEL		66
 +#define CK_TOP_DRAMC_MD32_SEL		67
 +#define CK_TOP_SYSAXI_SEL		68
 +#define CK_TOP_SYSAPB_SEL		69
 +#define CK_TOP_ARM_DB_MAIN_SEL		70
 +#define CK_TOP_ARM_DB_JTSEL		71
 +#define CK_TOP_NETSYS_SEL		72
 +#define CK_TOP_NETSYS_500M_SEL		73
 +#define CK_TOP_NETSYS_MCU_SEL		74
 +#define CK_TOP_NETSYS_2X_SEL		75
 +#define CK_TOP_SGM_325M_SEL		76
 +#define CK_TOP_SGM_REG_SEL		77
 +#define CK_TOP_A1SYS_SEL		78
 +#define CK_TOP_CONN_MCUSYS_SEL		79
 +#define CK_TOP_EIP_B_SEL		80
 +#define CK_TOP_PCIE_PHY_SEL		81
 +#define CK_TOP_USB3_PHY_SEL		82
 +#define CK_TOP_F26M_SEL			83
 +#define CK_TOP_AUD_L_SEL		84
 +#define CK_TOP_A_TUNER_SEL		85
 +#define CK_TOP_U2U3_SEL			86
 +#define CK_TOP_U2U3_SYS_SEL		87
 +#define CK_TOP_U2U3_XHCI_SEL		88
 +#define CK_TOP_DA_U2_REFSEL		89
 +#define CK_TOP_DA_U2_CK_1P_SEL		90
 +#define CK_TOP_AP2CNN_HOST_SEL		91
 +#define CLK_TOP_NR_CLK			92
 +
 +/*
 + * INFRACFG_AO
 + * clock muxes need to be append to infracfg domain, and clock gates
 + * need to be keep in infracgh_ao domain
 + */
 +
 +#define CK_INFRA_UART0_SEL		(0 + CLK_INFRA_NR_CLK)
 +#define CK_INFRA_UART1_SEL		(1 + CLK_INFRA_NR_CLK)
 +#define CK_INFRA_UART2_SEL		(2 + CLK_INFRA_NR_CLK)
 +#define CK_INFRA_SPI0_SEL		(3 + CLK_INFRA_NR_CLK)
 +#define CK_INFRA_SPI1_SEL		(4 + CLK_INFRA_NR_CLK)
 +#define CK_INFRA_PWM1_SEL		(5 + CLK_INFRA_NR_CLK)
 +#define CK_INFRA_PWM2_SEL		(6 + CLK_INFRA_NR_CLK)
 +#define CK_INFRA_PWM_BSEL		(7 + CLK_INFRA_NR_CLK)
 +#define CK_INFRA_PCIE_SEL		(8 + CLK_INFRA_NR_CLK)
 +#define CK_INFRA_GPT_STA		0
 +#define CK_INFRA_PWM_HCK		1
 +#define CK_INFRA_PWM_STA		2
 +#define CK_INFRA_PWM1_CK		3
 +#define CK_INFRA_PWM2_CK		4
 +#define CK_INFRA_CQ_DMA_CK		5
 +#define CK_INFRA_EIP97_CK		6
 +#define CK_INFRA_AUD_BUS_CK		7
 +#define CK_INFRA_AUD_26M_CK		8
 +#define CK_INFRA_AUD_L_CK		9
 +#define CK_INFRA_AUD_AUD_CK		10
 +#define CK_INFRA_AUD_EG2_CK		11
 +#define CK_INFRA_DRAMC_26M_CK		12
 +#define CK_INFRA_DBG_CK			13
 +#define CK_INFRA_AP_DMA_CK		14
 +#define CK_INFRA_SEJ_CK			15
 +#define CK_INFRA_SEJ_13M_CK		16
 +#define CK_INFRA_THERM_CK		17
 +#define CK_INFRA_I2CO_CK		18
 +#define CK_INFRA_TRNG_CK		19
 +#define CK_INFRA_UART0_CK		20
 +#define CK_INFRA_UART1_CK		21
 +#define CK_INFRA_UART2_CK		22
 +#define CK_INFRA_NFI1_CK		23
 +#define CK_INFRA_SPINFI1_CK		24
 +#define CK_INFRA_NFI_HCK_CK		25
 +#define CK_INFRA_SPI0_CK		26
 +#define CK_INFRA_SPI1_CK		27
 +#define CK_INFRA_SPI0_HCK_CK		28
 +#define CK_INFRA_SPI1_HCK_CK		29
 +#define CK_INFRA_FRTC_CK		30
 +#define CK_INFRA_MSDC_CK		31
 +#define CK_INFRA_MSDC_HCK_CK		32
 +#define CK_INFRA_MSDC_133M_CK		33
 +#define CK_INFRA_MSDC_66M_CK		34
 +#define CK_INFRA_ADC_26M_CK		35
 +#define CK_INFRA_ADC_FRC_CK		36
 +#define CK_INFRA_FBIST2FPC_CK		37
 +#define CK_INFRA_IUSB_133_CK		38
 +#define CK_INFRA_IUSB_66M_CK		39
 +#define CK_INFRA_IUSB_SYS_CK		40
 +#define CK_INFRA_IUSB_CK		41
 +#define CK_INFRA_IPCIE_CK		42
 +#define CK_INFRA_IPCIER_CK		43
 +#define CK_INFRA_IPCIEB_CK		44
 +#define CLK_INFRA_AO_NR_CLK		45
 +
 +/* APMIXEDSYS */
 +
 +#define CK_APMIXED_ARMPLL		0
 +#define CK_APMIXED_NET2PLL		1
 +#define CK_APMIXED_MMPLL		2
 +#define CK_APMIXED_SGMPLL		3
 +#define CK_APMIXED_WEDMCUPLL		4
 +#define CK_APMIXED_NET1PLL		5
 +#define CK_APMIXED_MPLL			6
 +#define CK_APMIXED_APLL2		7
 +#define CLK_APMIXED_NR_CLK		8
 +
 +/* SGMIISYS_0 */
 +
 +#define CK_SGM0_TX_EN			0
 +#define CK_SGM0_RX_EN			1
 +#define CK_SGM0_CK0_EN			2
 +#define CK_SGM0_CDR_CK0_EN		3
 +#define CLK_SGMII0_NR_CLK		4
 +
 +/* SGMIISYS_1 */
 +
 +#define CK_SGM1_TX_EN			0
 +#define CK_SGM1_RX_EN			1
 +#define CK_SGM1_CK1_EN			2
 +#define CK_SGM1_CDR_CK1_EN		3
 +#define CLK_SGMII1_NR_CLK		4
 +
 +/* ETHSYS */
 +
 +#define CK_ETH_FE_EN			0
 +#define CK_ETH_GP2_EN			1
 +#define CK_ETH_GP1_EN			2
 +#define CK_ETH_WOCPU1_EN		3
 +#define CK_ETH_WOCPU0_EN		4
 +#define CLK_ETH_NR_CLK			5
 +
 +#endif
 +
 +/* _DT_BINDINGS_CLK_MT7986_H */
--- a/package/boot/uboot-mediatek/patches/002-0027-clk-mediatek-add-clock-driver-support-for-MediaTek-M.patch
+++ b/package/boot/uboot-mediatek/patches/002-0027-clk-mediatek-add-clock-driver-support-for-MediaTek-M.patch
@@ -0,0 +1,984 @@
 From 79bca945dbfafcd08d71437b11e8ee57d64b4305 Mon Sep 17 00:00:00 2001
 From: Weijie Gao <weijie.gao@mediatek.com>
 Date: Fri, 29 Jul 2022 11:22:51 +0800
 Subject: [PATCH 27/31] clk: mediatek: add clock driver support for MediaTek
 MT7981 SoC
 This patch adds clock driver support for MediaTek MT7981 SoC
 Reviewed-by: Simon Glass <sjg@chromium.org>
 Signed-off-by: Weijie Gao <weijie.gao@mediatek.com>
 ---
 drivers/clk/mediatek/Makefile          |   1 +
 drivers/clk/mediatek/clk-mt7981.c      | 683 +++++++++++++++++++++++++
 include/dt-bindings/clock/mt7981-clk.h | 267 ++++++++++
 3 files changed, 951 insertions(+)
 create mode 100644 drivers/clk/mediatek/clk-mt7981.c
 create mode 100644 include/dt-bindings/clock/mt7981-clk.h
 --- a/drivers/clk/mediatek/Makefile
 +++ b/drivers/clk/mediatek/Makefile
@@ -8,6 +8,7 @@ obj-$(CONFIG_TARGET_MT7623) += clk-mt762
 obj-$(CONFIG_TARGET_MT7622) += clk-mt7622.o
 obj-$(CONFIG_TARGET_MT7629) += clk-mt7629.o
 obj-$(CONFIG_TARGET_MT7986) += clk-mt7986.o
 +obj-$(CONFIG_TARGET_MT7981) += clk-mt7981.o
 obj-$(CONFIG_TARGET_MT8183) += clk-mt8183.o
 obj-$(CONFIG_TARGET_MT8516) += clk-mt8516.o
 obj-$(CONFIG_TARGET_MT8518) += clk-mt8518.o
 --- /dev/null
 +++ b/drivers/clk/mediatek/clk-mt7981.c
@@ -0,0 +1,683 @@
 +// SPDX-License-Identifier: GPL-2.0
 +/*
 + * MediaTek clock driver for MT7981 SoC
 + *
 + * Copyright (C) 2022 MediaTek Inc.
 + * Author: Sam Shih <sam.shih@mediatek.com>
 + */
 +
 +#include <dm.h>
 +#include <log.h>
 +#include <asm/arch-mediatek/reset.h>
 +#include <asm/io.h>
 +#include <dt-bindings/clock/mt7981-clk.h>
 +#include <linux/bitops.h>
 +
 +#include "clk-mtk.h"
 +
 +#define MT7981_CLK_PDN 0x250
 +#define MT7981_CLK_PDN_EN_WRITE BIT(31)
 +
 +#define PLL_FACTOR(_id, _name, _parent, _mult, _div)                           \
 +	FACTOR(_id, _parent, _mult, _div, CLK_PARENT_APMIXED)
 +
 +#define TOP_FACTOR(_id, _name, _parent, _mult, _div)                           \
 +	FACTOR(_id, _parent, _mult, _div, CLK_PARENT_TOPCKGEN)
 +
 +#define INFRA_FACTOR(_id, _name, _parent, _mult, _div)                         \
 +	FACTOR(_id, _parent, _mult, _div, CLK_PARENT_INFRASYS)
 +
 +/* FIXED PLLS */
 +static const struct mtk_fixed_clk fixed_pll_clks[] = {
 +	FIXED_CLK(CK_APMIXED_ARMPLL, CLK_XTAL, 1300000000),
 +	FIXED_CLK(CK_APMIXED_NET2PLL, CLK_XTAL, 800000000),
 +	FIXED_CLK(CK_APMIXED_MMPLL, CLK_XTAL, 720000000),
 +	FIXED_CLK(CK_APMIXED_SGMPLL, CLK_XTAL, 325000000),
 +	FIXED_CLK(CK_APMIXED_WEDMCUPLL, CLK_XTAL, 208000000),
 +	FIXED_CLK(CK_APMIXED_NET1PLL, CLK_XTAL, 2500000000),
 +	FIXED_CLK(CK_APMIXED_MPLL, CLK_XTAL, 416000000),
 +	FIXED_CLK(CK_APMIXED_APLL2, CLK_XTAL, 196608000),
 +};
 +
 +/* TOPCKGEN FIXED CLK */
 +static const struct mtk_fixed_clk top_fixed_clks[] = {
 +	FIXED_CLK(CK_TOP_CB_CKSQ_40M, CLK_XTAL, 40000000),
 +};
 +
 +/* TOPCKGEN FIXED DIV */
 +static const struct mtk_fixed_factor top_fixed_divs[] = {
 +	PLL_FACTOR(CK_TOP_CB_M_416M, "cb_m_416m", CK_APMIXED_MPLL, 1, 1),
 +	PLL_FACTOR(CK_TOP_CB_M_D2, "cb_m_d2", CK_APMIXED_MPLL, 1, 2),
 +	PLL_FACTOR(CK_TOP_CB_M_D3, "cb_m_d3", CK_APMIXED_MPLL, 1, 3),
 +	PLL_FACTOR(CK_TOP_M_D3_D2, "m_d3_d2", CK_APMIXED_MPLL, 1, 2),
 +	PLL_FACTOR(CK_TOP_CB_M_D4, "cb_m_d4", CK_APMIXED_MPLL, 1, 4),
 +	PLL_FACTOR(CK_TOP_CB_M_D8, "cb_m_d8", CK_APMIXED_MPLL, 1, 8),
 +	PLL_FACTOR(CK_TOP_M_D8_D2, "m_d8_d2", CK_APMIXED_MPLL, 1, 16),
 +	PLL_FACTOR(CK_TOP_CB_MM_720M, "cb_mm_720m", CK_APMIXED_MMPLL, 1, 1),
 +	PLL_FACTOR(CK_TOP_CB_MM_D2, "cb_mm_d2", CK_APMIXED_MMPLL, 1, 2),
 +	PLL_FACTOR(CK_TOP_CB_MM_D3, "cb_mm_d3", CK_APMIXED_MMPLL, 1, 3),
 +	PLL_FACTOR(CK_TOP_CB_MM_D3_D5, "cb_mm_d3_d5", CK_APMIXED_MMPLL, 1, 15),
 +	PLL_FACTOR(CK_TOP_CB_MM_D4, "cb_mm_d4", CK_APMIXED_MMPLL, 1, 4),
 +	PLL_FACTOR(CK_TOP_CB_MM_D6, "cb_mm_d6", CK_APMIXED_MMPLL, 1, 6),
 +	PLL_FACTOR(CK_TOP_MM_D6_D2, "mm_d6_d2", CK_APMIXED_MMPLL, 1, 12),
 +	PLL_FACTOR(CK_TOP_CB_MM_D8, "cb_mm_d8", CK_APMIXED_MMPLL, 1, 8),
 +	PLL_FACTOR(CK_TOP_CB_APLL2_196M, "cb_apll2_196m", CK_APMIXED_APLL2, 1,
 +		   1),
 +	PLL_FACTOR(CK_TOP_APLL2_D2, "apll2_d2", CK_APMIXED_APLL2, 1, 2),
 +	PLL_FACTOR(CK_TOP_APLL2_D4, "apll2_d4", CK_APMIXED_APLL2, 1, 4),
 +	PLL_FACTOR(CK_TOP_NET1_2500M, "net1_2500m", CK_APMIXED_NET1PLL, 1, 1),
 +	PLL_FACTOR(CK_TOP_CB_NET1_D4, "cb_net1_d4", CK_APMIXED_NET1PLL, 1, 4),
 +	PLL_FACTOR(CK_TOP_CB_NET1_D5, "cb_net1_d5", CK_APMIXED_NET1PLL, 1, 5),
 +	PLL_FACTOR(CK_TOP_NET1_D5_D2, "net1_d5_d2", CK_APMIXED_NET1PLL, 1, 10),
 +	PLL_FACTOR(CK_TOP_NET1_D5_D4, "net1_d5_d4", CK_APMIXED_NET1PLL, 1, 20),
 +	PLL_FACTOR(CK_TOP_CB_NET1_D8, "cb_net1_d8", CK_APMIXED_NET1PLL, 1, 8),
 +	PLL_FACTOR(CK_TOP_NET1_D8_D2, "net1_d8_d2", CK_APMIXED_NET1PLL, 1, 16),
 +	PLL_FACTOR(CK_TOP_NET1_D8_D4, "net1_d8_d4", CK_APMIXED_NET1PLL, 1, 32),
 +	PLL_FACTOR(CK_TOP_CB_NET2_800M, "cb_net2_800m", CK_APMIXED_NET2PLL, 1,
 +		   1),
 +	PLL_FACTOR(CK_TOP_CB_NET2_D2, "cb_net2_d2", CK_APMIXED_NET2PLL, 1, 2),
 +	PLL_FACTOR(CK_TOP_CB_NET2_D4, "cb_net2_d4", CK_APMIXED_NET2PLL, 1, 4),
 +	PLL_FACTOR(CK_TOP_NET2_D4_D2, "net2_d4_d2", CK_APMIXED_NET2PLL, 1, 8),
 +	PLL_FACTOR(CK_TOP_NET2_D4_D4, "net2_d4_d4", CK_APMIXED_NET2PLL, 1, 16),
 +	PLL_FACTOR(CK_TOP_CB_NET2_D6, "cb_net2_d6", CK_APMIXED_NET2PLL, 1, 6),
 +	PLL_FACTOR(CK_TOP_CB_WEDMCU_208M, "cb_wedmcu_208m",
 +		   CK_APMIXED_WEDMCUPLL, 1, 1),
 +	PLL_FACTOR(CK_TOP_CB_SGM_325M, "cb_sgm_325m", CK_APMIXED_SGMPLL, 1, 1),
 +	TOP_FACTOR(CK_TOP_CKSQ_40M_D2, "cksq_40m_d2", CK_TOP_CB_CKSQ_40M, 1, 2),
 +	TOP_FACTOR(CK_TOP_CB_RTC_32K, "cb_rtc_32k", CK_TOP_CB_CKSQ_40M, 1,
 +		   1250),
 +	TOP_FACTOR(CK_TOP_CB_RTC_32P7K, "cb_rtc_32p7k", CK_TOP_CB_CKSQ_40M, 1,
 +		   1220),
 +	TOP_FACTOR(CK_TOP_USB_TX250M, "usb_tx250m", CK_TOP_CB_CKSQ_40M, 1, 1),
 +	TOP_FACTOR(CK_TOP_FAUD, "faud", CK_TOP_CB_CKSQ_40M, 1, 1),
 +	TOP_FACTOR(CK_TOP_NFI1X, "nfi1x", CK_TOP_NFI1X_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_USB_EQ_RX250M, "usb_eq_rx250m", CK_TOP_CB_CKSQ_40M, 1,
 +		   1),
 +	TOP_FACTOR(CK_TOP_USB_CDR_CK, "usb_cdr", CK_TOP_CB_CKSQ_40M, 1, 1),
 +	TOP_FACTOR(CK_TOP_USB_LN0_CK, "usb_ln0", CK_TOP_CB_CKSQ_40M, 1, 1),
 +	TOP_FACTOR(CK_TOP_SPINFI_BCK, "spinfi_bck", CK_TOP_SPINFI_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_SPI, "spi", CK_TOP_SPI_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_SPIM_MST, "spim_mst", CK_TOP_SPIM_MST_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_UART_BCK, "uart_bck", CK_TOP_UART_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_PWM_BCK, "pwm_bck", CK_TOP_PWM_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_I2C_BCK, "i2c_bck", CK_TOP_I2C_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_PEXTP_TL, "pextp_tl", CK_TOP_PEXTP_TL_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_EMMC_208M, "emmc_208m", CK_TOP_EMMC_208M_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_EMMC_400M, "emmc_400m", CK_TOP_EMMC_400M_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_DRAMC_REF, "dramc_ref", CK_TOP_DRAMC_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_DRAMC_MD32, "dramc_md32", CK_TOP_DRAMC_MD32_SEL, 1,
 +		   1),
 +	TOP_FACTOR(CK_TOP_SYSAXI, "sysaxi", CK_TOP_SYSAXI_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_SYSAPB, "sysapb", CK_TOP_SYSAPB_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_ARM_DB_MAIN, "arm_db_main", CK_TOP_ARM_DB_MAIN_SEL, 1,
 +		   1),
 +	TOP_FACTOR(CK_TOP_AP2CNN_HOST, "ap2cnn_host", CK_TOP_AP2CNN_HOST_SEL, 1,
 +		   1),
 +	TOP_FACTOR(CK_TOP_NETSYS, "netsys", CK_TOP_NETSYS_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_NETSYS_500M, "netsys_500m", CK_TOP_NETSYS_500M_SEL, 1,
 +		   1),
 +	TOP_FACTOR(CK_TOP_NETSYS_WED_MCU, "netsys_wed_mcu",
 +		   CK_TOP_NETSYS_MCU_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_NETSYS_2X, "netsys_2x", CK_TOP_NETSYS_2X_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_SGM_325M, "sgm_325m", CK_TOP_SGM_325M_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_SGM_REG, "sgm_reg", CK_TOP_SGM_REG_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_F26M, "csw_f26m", CK_TOP_F26M_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_EIP97B, "eip97b", CK_TOP_EIP97B_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_USB3_PHY, "usb3_phy", CK_TOP_USB3_PHY_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_AUD, "aud", CK_TOP_FAUD, 1, 1),
 +	TOP_FACTOR(CK_TOP_A1SYS, "a1sys", CK_TOP_A1SYS_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_AUD_L, "aud_l", CK_TOP_AUD_L_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_A_TUNER, "a_tuner", CK_TOP_A_TUNER_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_U2U3_REF, "u2u3_ref", CK_TOP_U2U3_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_U2U3_SYS, "u2u3_sys", CK_TOP_U2U3_SYS_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_U2U3_XHCI, "u2u3_xhci", CK_TOP_U2U3_XHCI_SEL, 1, 1),
 +	TOP_FACTOR(CK_TOP_USB_FRMCNT, "usb_frmcnt", CK_TOP_USB_FRMCNT_SEL, 1,
 +		   1),
 +};
 +
 +/* TOPCKGEN MUX PARENTS */
 +static const int nfi1x_parents[] = { CK_TOP_CB_CKSQ_40M, CK_TOP_CB_MM_D4,
 +				     CK_TOP_NET1_D8_D2,  CK_TOP_CB_NET2_D6,
 +				     CK_TOP_CB_M_D4,     CK_TOP_CB_MM_D8,
 +				     CK_TOP_NET1_D8_D4,  CK_TOP_CB_M_D8 };
 +
 +static const int spinfi_parents[] = { CK_TOP_CKSQ_40M_D2, CK_TOP_CB_CKSQ_40M,
 +				      CK_TOP_NET1_D5_D4,  CK_TOP_CB_M_D4,
 +				      CK_TOP_CB_MM_D8,    CK_TOP_NET1_D8_D4,
 +				      CK_TOP_MM_D6_D2,    CK_TOP_CB_M_D8 };
 +
 +static const int spi_parents[] = { CK_TOP_CB_CKSQ_40M, CK_TOP_CB_M_D2,
 +				   CK_TOP_CB_MM_D4,    CK_TOP_NET1_D8_D2,
 +				   CK_TOP_CB_NET2_D6,  CK_TOP_NET1_D5_D4,
 +				   CK_TOP_CB_M_D4,     CK_TOP_NET1_D8_D4 };
 +
 +static const int uart_parents[] = { CK_TOP_CB_CKSQ_40M, CK_TOP_CB_M_D8,
 +				    CK_TOP_M_D8_D2 };
 +
 +static const int pwm_parents[] = { CK_TOP_CB_CKSQ_40M, CK_TOP_NET1_D8_D2,
 +				   CK_TOP_NET1_D5_D4,  CK_TOP_CB_M_D4,
 +				   CK_TOP_M_D8_D2,     CK_TOP_CB_RTC_32K };
 +
 +static const int i2c_parents[] = { CK_TOP_CB_CKSQ_40M, CK_TOP_NET1_D5_D4,
 +				   CK_TOP_CB_M_D4, CK_TOP_NET1_D8_D4 };
 +
 +static const int pextp_tl_ck_parents[] = { CK_TOP_CB_CKSQ_40M,
 +					   CK_TOP_NET1_D5_D4, CK_TOP_CB_M_D4,
 +					   CK_TOP_CB_RTC_32K };
 +
 +static const int emmc_208m_parents[] = {
 +	CK_TOP_CB_CKSQ_40M,   CK_TOP_CB_M_D2,  CK_TOP_CB_NET2_D4,
 +	CK_TOP_CB_APLL2_196M, CK_TOP_CB_MM_D4, CK_TOP_NET1_D8_D2,
 +	CK_TOP_CB_MM_D6
 +};
 +
 +static const int emmc_400m_parents[] = { CK_TOP_CB_CKSQ_40M, CK_TOP_CB_NET2_D2,
 +					 CK_TOP_CB_MM_D2, CK_TOP_CB_NET2_D2 };
 +
 +static const int csw_f26m_parents[] = { CK_TOP_CKSQ_40M_D2, CK_TOP_M_D8_D2 };
 +
 +static const int dramc_md32_parents[] = { CK_TOP_CB_CKSQ_40M, CK_TOP_CB_M_D2,
 +					  CK_TOP_CB_WEDMCU_208M };
 +
 +static const int sysaxi_parents[] = { CK_TOP_CB_CKSQ_40M, CK_TOP_NET1_D8_D2 };
 +
 +static const int sysapb_parents[] = { CK_TOP_CB_CKSQ_40M, CK_TOP_M_D3_D2 };
 +
 +static const int arm_db_main_parents[] = { CK_TOP_CB_CKSQ_40M,
 +					   CK_TOP_CB_NET2_D6 };
 +
 +static const int ap2cnn_host_parents[] = { CK_TOP_CB_CKSQ_40M,
 +					   CK_TOP_NET1_D8_D4 };
 +
 +static const int netsys_parents[] = { CK_TOP_CB_CKSQ_40M, CK_TOP_CB_MM_D2 };
 +
 +static const int netsys_500m_parents[] = { CK_TOP_CB_CKSQ_40M,
 +					   CK_TOP_CB_NET1_D5 };
 +
 +static const int netsys_mcu_parents[] = { CK_TOP_CB_CKSQ_40M, CK_TOP_CB_MM_720M,
 +					  CK_TOP_CB_NET1_D4, CK_TOP_CB_NET1_D5,
 +					  CK_TOP_CB_M_416M };
 +
 +static const int netsys_2x_parents[] = { CK_TOP_CB_CKSQ_40M,
 +					 CK_TOP_CB_NET2_800M,
 +					 CK_TOP_CB_MM_720M };
 +
 +static const int sgm_325m_parents[] = { CK_TOP_CB_CKSQ_40M,
 +					CK_TOP_CB_SGM_325M };
 +
 +static const int sgm_reg_parents[] = { CK_TOP_CB_CKSQ_40M, CK_TOP_CB_NET2_D4 };
 +
 +static const int eip97b_parents[] = { CK_TOP_CB_CKSQ_40M, CK_TOP_CB_NET1_D5,
 +				      CK_TOP_CB_M_416M, CK_TOP_CB_MM_D2,
 +				      CK_TOP_NET1_D5_D2 };
 +
 +static const int aud_parents[] = { CK_TOP_CB_CKSQ_40M, CK_TOP_CB_APLL2_196M };
 +
 +static const int a1sys_parents[] = { CK_TOP_CB_CKSQ_40M, CK_TOP_APLL2_D4 };
 +
 +static const int aud_l_parents[] = { CK_TOP_CB_CKSQ_40M, CK_TOP_CB_APLL2_196M,
 +				     CK_TOP_M_D8_D2 };
 +
 +static const int a_tuner_parents[] = { CK_TOP_CB_CKSQ_40M, CK_TOP_APLL2_D4,
 +				       CK_TOP_M_D8_D2 };
 +
 +static const int u2u3_parents[] = { CK_TOP_CB_CKSQ_40M, CK_TOP_M_D8_D2 };
 +
 +static const int u2u3_sys_parents[] = { CK_TOP_CB_CKSQ_40M, CK_TOP_NET1_D5_D4 };
 +
 +static const int usb_frmcnt_parents[] = { CK_TOP_CB_CKSQ_40M,
 +					  CK_TOP_CB_MM_D3_D5 };
 +
 +#define TOP_MUX(_id, _name, _parents, _mux_ofs, _mux_set_ofs, _mux_clr_ofs,    \
 +		_shift, _width, _gate, _upd_ofs, _upd)                         \
 +	{                                                                      \
 +		.id = _id, .mux_reg = _mux_ofs, .mux_set_reg = _mux_set_ofs,   \
 +		.mux_clr_reg = _mux_clr_ofs, .upd_reg = _upd_ofs,              \
 +		.upd_shift = _upd, .mux_shift = _shift,                        \
 +		.mux_mask = BIT(_width) - 1, .gate_reg = _mux_ofs,             \
 +		.gate_shift = _gate, .parent = _parents,                       \
 +		.num_parents = ARRAY_SIZE(_parents),                           \
 +		.flags = CLK_MUX_SETCLR_UPD,                                   \
 +	}
 +
 +/* TOPCKGEN MUX_GATE */
 +static const struct mtk_composite top_muxes[] = {
 +	TOP_MUX(CK_TOP_NFI1X_SEL, "nfi1x_sel", nfi1x_parents, 0x0, 0x4, 0x8, 0,
 +		3, 7, 0x1c0, 0),
 +	TOP_MUX(CK_TOP_SPINFI_SEL, "spinfi_sel", spinfi_parents, 0x0, 0x4, 0x8,
 +		8, 3, 15, 0x1c0, 1),
 +	TOP_MUX(CK_TOP_SPI_SEL, "spi_sel", spi_parents, 0x0, 0x4, 0x8, 16, 3,
 +		23, 0x1c0, 2),
 +	TOP_MUX(CK_TOP_SPIM_MST_SEL, "spim_mst_sel", spi_parents, 0x0, 0x4, 0x8,
 +		24, 3, 31, 0x1c0, 3),
 +	TOP_MUX(CK_TOP_UART_SEL, "uart_sel", uart_parents, 0x10, 0x14, 0x18, 0,
 +		2, 7, 0x1c0, 4),
 +	TOP_MUX(CK_TOP_PWM_SEL, "pwm_sel", pwm_parents, 0x10, 0x14, 0x18, 8, 3,
 +		15, 0x1c0, 5),
 +	TOP_MUX(CK_TOP_I2C_SEL, "i2c_sel", i2c_parents, 0x10, 0x14, 0x18, 16, 2,
 +		23, 0x1c0, 6),
 +	TOP_MUX(CK_TOP_PEXTP_TL_SEL, "pextp_tl_ck_sel", pextp_tl_ck_parents,
 +		0x10, 0x14, 0x18, 24, 2, 31, 0x1c0, 7),
 +	TOP_MUX(CK_TOP_EMMC_208M_SEL, "emmc_208m_sel", emmc_208m_parents, 0x20,
 +		0x24, 0x28, 0, 3, 7, 0x1c0, 8),
 +	TOP_MUX(CK_TOP_EMMC_400M_SEL, "emmc_400m_sel", emmc_400m_parents, 0x20,
 +		0x24, 0x28, 8, 2, 15, 0x1c0, 9),
 +	TOP_MUX(CK_TOP_F26M_SEL, "csw_f26m_sel", csw_f26m_parents, 0x20, 0x24,
 +		0x28, 16, 1, 23, 0x1c0, 10),
 +	TOP_MUX(CK_TOP_DRAMC_SEL, "dramc_sel", csw_f26m_parents, 0x20, 0x24,
 +		0x28, 24, 1, 31, 0x1c0, 11),
 +	TOP_MUX(CK_TOP_DRAMC_MD32_SEL, "dramc_md32_sel", dramc_md32_parents,
 +		0x30, 0x34, 0x38, 0, 2, 7, 0x1c0, 12),
 +	TOP_MUX(CK_TOP_SYSAXI_SEL, "sysaxi_sel", sysaxi_parents, 0x30, 0x34,
 +		0x38, 8, 1, 15, 0x1c0, 13),
 +	TOP_MUX(CK_TOP_SYSAPB_SEL, "sysapb_sel", sysapb_parents, 0x30, 0x34,
 +		0x38, 16, 1, 23, 0x1c0, 14),
 +	TOP_MUX(CK_TOP_ARM_DB_MAIN_SEL, "arm_db_main_sel", arm_db_main_parents,
 +		0x30, 0x34, 0x38, 24, 1, 31, 0x1c0, 15),
 +	TOP_MUX(CK_TOP_AP2CNN_HOST_SEL, "ap2cnn_host_sel", ap2cnn_host_parents,
 +		0x40, 0x44, 0x48, 0, 1, 7, 0x1c0, 16),
 +	TOP_MUX(CK_TOP_NETSYS_SEL, "netsys_sel", netsys_parents, 0x40, 0x44,
 +		0x48, 8, 1, 15, 0x1c0, 17),
 +	TOP_MUX(CK_TOP_NETSYS_500M_SEL, "netsys_500m_sel", netsys_500m_parents,
 +		0x40, 0x44, 0x48, 16, 1, 23, 0x1c0, 18),
 +	TOP_MUX(CK_TOP_NETSYS_MCU_SEL, "netsys_mcu_sel", netsys_mcu_parents,
 +		0x40, 0x44, 0x48, 24, 3, 31, 0x1c0, 19),
 +	TOP_MUX(CK_TOP_NETSYS_2X_SEL, "netsys_2x_sel", netsys_2x_parents, 0x50,
 +		0x54, 0x58, 0, 2, 7, 0x1c0, 20),
 +	TOP_MUX(CK_TOP_SGM_325M_SEL, "sgm_325m_sel", sgm_325m_parents, 0x50,
 +		0x54, 0x58, 8, 1, 15, 0x1c0, 21),
 +	TOP_MUX(CK_TOP_SGM_REG_SEL, "sgm_reg_sel", sgm_reg_parents, 0x50, 0x54,
 +		0x58, 16, 1, 23, 0x1c0, 22),
 +	TOP_MUX(CK_TOP_EIP97B_SEL, "eip97b_sel", eip97b_parents, 0x50, 0x54,
 +		0x58, 24, 3, 31, 0x1c0, 23),
 +	TOP_MUX(CK_TOP_USB3_PHY_SEL, "usb3_phy_sel", csw_f26m_parents, 0x60,
 +		0x64, 0x68, 0, 1, 7, 0x1c0, 24),
 +	TOP_MUX(CK_TOP_AUD_SEL, "aud_sel", aud_parents, 0x60, 0x64, 0x68, 8, 1,
 +		15, 0x1c0, 25),
 +	TOP_MUX(CK_TOP_A1SYS_SEL, "a1sys_sel", a1sys_parents, 0x60, 0x64, 0x68,
 +		16, 1, 23, 0x1c0, 26),
 +	TOP_MUX(CK_TOP_AUD_L_SEL, "aud_l_sel", aud_l_parents, 0x60, 0x64, 0x68,
 +		24, 2, 31, 0x1c0, 27),
 +	TOP_MUX(CK_TOP_A_TUNER_SEL, "a_tuner_sel", a_tuner_parents, 0x70, 0x74,
 +		0x78, 0, 2, 7, 0x1c0, 28),
 +	TOP_MUX(CK_TOP_U2U3_SEL, "u2u3_sel", u2u3_parents, 0x70, 0x74, 0x78, 8,
 +		1, 15, 0x1c0, 29),
 +	TOP_MUX(CK_TOP_U2U3_SYS_SEL, "u2u3_sys_sel", u2u3_sys_parents, 0x70,
 +		0x74, 0x78, 16, 1, 23, 0x1c0, 30),
 +	TOP_MUX(CK_TOP_U2U3_XHCI_SEL, "u2u3_xhci_sel", u2u3_sys_parents, 0x70,
 +		0x74, 0x78, 24, 1, 31, 0x1c4, 0),
 +	TOP_MUX(CK_TOP_USB_FRMCNT_SEL, "usb_frmcnt_sel", usb_frmcnt_parents,
 +		0x80, 0x84, 0x88, 0, 1, 7, 0x1c4, 1),
 +};
 +
 +/* INFRA FIXED DIV */
 +static const struct mtk_fixed_factor infra_fixed_divs[] = {
 +	TOP_FACTOR(CK_INFRA_CK_F26M, "infra_ck_f26m", CK_TOP_F26M_SEL, 1, 1),
 +	TOP_FACTOR(CK_INFRA_UART, "infra_uart", CK_TOP_UART_SEL, 1, 1),
 +	TOP_FACTOR(CK_INFRA_ISPI0, "infra_ispi0", CK_TOP_SPI_SEL, 1, 1),
 +	TOP_FACTOR(CK_INFRA_I2C, "infra_i2c", CK_TOP_I2C_SEL, 1, 1),
 +	TOP_FACTOR(CK_INFRA_ISPI1, "infra_ispi1", CK_TOP_SPIM_MST_SEL, 1, 1),
 +	TOP_FACTOR(CK_INFRA_PWM, "infra_pwm", CK_TOP_PWM_SEL, 1, 1),
 +	TOP_FACTOR(CK_INFRA_66M_MCK, "infra_66m_mck", CK_TOP_SYSAXI_SEL, 1, 2),
 +	TOP_FACTOR(CK_INFRA_CK_F32K, "infra_ck_f32k", CK_TOP_CB_RTC_32P7K, 1,
 +		   1),
 +	TOP_FACTOR(CK_INFRA_PCIE_CK, "infra_pcie", CK_TOP_PEXTP_TL_SEL, 1, 1),
 +	INFRA_FACTOR(CK_INFRA_PWM_BCK, "infra_pwm_bck", CK_INFRA_PWM_BSEL, 1,
 +		     1),
 +	INFRA_FACTOR(CK_INFRA_PWM_CK1, "infra_pwm_ck1", CK_INFRA_PWM1_SEL, 1,
 +		     1),
 +	INFRA_FACTOR(CK_INFRA_PWM_CK2, "infra_pwm_ck2", CK_INFRA_PWM2_SEL, 1,
 +		     1),
 +	TOP_FACTOR(CK_INFRA_133M_HCK, "infra_133m_hck", CK_TOP_SYSAXI, 1, 1),
 +	INFRA_FACTOR(CK_INFRA_66M_PHCK, "infra_66m_phck", CK_INFRA_133M_HCK, 1,
 +		     1),
 +	TOP_FACTOR(CK_INFRA_FAUD_L_CK, "infra_faud_l", CK_TOP_AUD_L, 1, 1),
 +	TOP_FACTOR(CK_INFRA_FAUD_AUD_CK, "infra_faud_aud", CK_TOP_A1SYS, 1, 1),
 +	TOP_FACTOR(CK_INFRA_FAUD_EG2_CK, "infra_faud_eg2", CK_TOP_A_TUNER, 1,
 +		   1),
 +	TOP_FACTOR(CK_INFRA_I2CS_CK, "infra_i2cs", CK_TOP_I2C_BCK, 1, 1),
 +	INFRA_FACTOR(CK_INFRA_MUX_UART0, "infra_mux_uart0", CK_INFRA_UART0_SEL,
 +		     1, 1),
 +	INFRA_FACTOR(CK_INFRA_MUX_UART1, "infra_mux_uart1", CK_INFRA_UART1_SEL,
 +		     1, 1),
 +	INFRA_FACTOR(CK_INFRA_MUX_UART2, "infra_mux_uart2", CK_INFRA_UART2_SEL,
 +		     1, 1),
 +	TOP_FACTOR(CK_INFRA_NFI_CK, "infra_nfi", CK_TOP_NFI1X, 1, 1),
 +	TOP_FACTOR(CK_INFRA_SPINFI_CK, "infra_spinfi", CK_TOP_SPINFI_BCK, 1, 1),
 +	INFRA_FACTOR(CK_INFRA_MUX_SPI0, "infra_mux_spi0", CK_INFRA_SPI0_SEL, 1,
 +		     1),
 +	INFRA_FACTOR(CK_INFRA_MUX_SPI1, "infra_mux_spi1", CK_INFRA_SPI1_SEL, 1,
 +		     1),
 +	INFRA_FACTOR(CK_INFRA_MUX_SPI2, "infra_mux_spi2", CK_INFRA_SPI2_SEL, 1,
 +		     1),
 +	TOP_FACTOR(CK_INFRA_RTC_32K, "infra_rtc_32k", CK_TOP_CB_RTC_32K, 1, 1),
 +	TOP_FACTOR(CK_INFRA_FMSDC_CK, "infra_fmsdc", CK_TOP_EMMC_400M, 1, 1),
 +	TOP_FACTOR(CK_INFRA_FMSDC_HCK_CK, "infra_fmsdc_hck", CK_TOP_EMMC_208M,
 +		   1, 1),
 +	TOP_FACTOR(CK_INFRA_PERI_133M, "infra_peri_133m", CK_TOP_SYSAXI, 1, 1),
 +	TOP_FACTOR(CK_INFRA_133M_PHCK, "infra_133m_phck", CK_TOP_SYSAXI, 1, 1),
 +	TOP_FACTOR(CK_INFRA_USB_SYS_CK, "infra_usb_sys", CK_TOP_U2U3_SYS, 1, 1),
 +	TOP_FACTOR(CK_INFRA_USB_CK, "infra_usb", CK_TOP_U2U3_REF, 1, 1),
 +	TOP_FACTOR(CK_INFRA_USB_XHCI_CK, "infra_usb_xhci", CK_TOP_U2U3_XHCI, 1,
 +		   1),
 +	TOP_FACTOR(CK_INFRA_PCIE_GFMUX_TL_O_PRE, "infra_pcie_mux",
 +		   CK_TOP_PEXTP_TL, 1, 1),
 +	TOP_FACTOR(CK_INFRA_F26M_CK0, "infra_f26m_ck0", CK_TOP_F26M, 1, 1),
 +	TOP_FACTOR(CK_INFRA_133M_MCK, "infra_133m_mck", CK_TOP_SYSAXI, 1, 1),
 +};
 +
 +/* INFRASYS MUX PARENTS */
 +static const int infra_uart0_parents[] = { CK_INFRA_CK_F26M, CK_INFRA_UART };
 +
 +static const int infra_spi0_parents[] = { CK_INFRA_I2C, CK_INFRA_ISPI0 };
 +
 +static const int infra_spi1_parents[] = { CK_INFRA_I2C, CK_INFRA_ISPI1 };
 +
 +static const int infra_pwm1_parents[] = { -1, -1, -1, CK_INFRA_PWM };
 +
 +static const int infra_pwm_bsel_parents[] = { -1, -1, -1, CK_INFRA_PWM };
 +
 +static const int infra_pcie_parents[] = { CK_INFRA_CK_F32K, CK_INFRA_CK_F26M,
 +					  CK_TOP_CB_CKSQ_40M, CK_INFRA_PCIE_CK};
 +
 +#define INFRA_MUX(_id, _name, _parents, _reg, _shift, _width)                  \
 +	{                                                                      \
 +		.id = _id, .mux_reg = (_reg) + 0x8,                            \
 +		.mux_set_reg = (_reg) + 0x0, .mux_clr_reg = (_reg) + 0x4,      \
 +		.mux_shift = _shift, .mux_mask = BIT(_width) - 1,              \
 +		.parent = _parents, .num_parents = ARRAY_SIZE(_parents),       \
 +		.flags = CLK_MUX_SETCLR_UPD | CLK_PARENT_INFRASYS,             \
 +	}
 +
 +/* INFRA MUX */
 +static const struct mtk_composite infra_muxes[] = {
 +	INFRA_MUX(CK_INFRA_UART0_SEL, "infra_uart0_sel", infra_uart0_parents,
 +		  0x10, 0, 1),
 +	INFRA_MUX(CK_INFRA_UART1_SEL, "infra_uart1_sel", infra_uart0_parents,
 +		  0x10, 1, 1),
 +	INFRA_MUX(CK_INFRA_UART2_SEL, "infra_uart2_sel", infra_uart0_parents,
 +		  0x10, 2, 1),
 +	INFRA_MUX(CK_INFRA_SPI0_SEL, "infra_spi0_sel", infra_spi0_parents, 0x10,
 +		  4, 1),
 +	INFRA_MUX(CK_INFRA_SPI1_SEL, "infra_spi1_sel", infra_spi1_parents, 0x10,
 +		  5, 1),
 +	INFRA_MUX(CK_INFRA_SPI2_SEL, "infra_spi2_sel", infra_spi0_parents, 0x10,
 +		  6, 1),
 +	INFRA_MUX(CK_INFRA_PWM1_SEL, "infra_pwm1_sel", infra_pwm1_parents, 0x10,
 +		  9, 2),
 +	INFRA_MUX(CK_INFRA_PWM2_SEL, "infra_pwm2_sel", infra_pwm1_parents, 0x10,
 +		  11, 2),
 +	INFRA_MUX(CK_INFRA_PWM_BSEL, "infra_pwm_bsel", infra_pwm_bsel_parents,
 +		  0x10, 13, 2),
 +	INFRA_MUX(CK_INFRA_PCIE_SEL, "infra_pcie_sel", infra_pcie_parents, 0x20,
 +		  0, 2),
 +};
 +
 +static const struct mtk_gate_regs infra_0_cg_regs = {
 +	.set_ofs = 0x40,
 +	.clr_ofs = 0x44,
 +	.sta_ofs = 0x48,
 +};
 +
 +static const struct mtk_gate_regs infra_1_cg_regs = {
 +	.set_ofs = 0x50,
 +	.clr_ofs = 0x54,
 +	.sta_ofs = 0x58,
 +};
 +
 +static const struct mtk_gate_regs infra_2_cg_regs = {
 +	.set_ofs = 0x60,
 +	.clr_ofs = 0x64,
 +	.sta_ofs = 0x68,
 +};
 +
 +#define GATE_INFRA0(_id, _name, _parent, _shift)                               \
 +	{                                                                      \
 +		.id = _id, .parent = _parent, .regs = &infra_0_cg_regs,        \
 +		.shift = _shift,                                               \
 +		.flags = CLK_GATE_SETCLR | CLK_PARENT_INFRASYS,                \
 +	}
 +
 +#define GATE_INFRA1(_id, _name, _parent, _shift)                               \
 +	{                                                                      \
 +		.id = _id, .parent = _parent, .regs = &infra_1_cg_regs,        \
 +		.shift = _shift,                                               \
 +		.flags = CLK_GATE_SETCLR | CLK_PARENT_INFRASYS,                \
 +	}
 +
 +#define GATE_INFRA2(_id, _name, _parent, _shift)                               \
 +	{                                                                      \
 +		.id = _id, .parent = _parent, .regs = &infra_2_cg_regs,        \
 +		.shift = _shift,                                               \
 +		.flags = CLK_GATE_SETCLR | CLK_PARENT_INFRASYS,                \
 +	}
 +
 +/* INFRA GATE */
 +static const struct mtk_gate infracfg_ao_gates[] = {
 +	GATE_INFRA0(CK_INFRA_GPT_STA, "infra_gpt_sta", CK_INFRA_66M_MCK, 0),
 +	GATE_INFRA0(CK_INFRA_PWM_HCK, "infra_pwm_hck", CK_INFRA_66M_MCK, 1),
 +	GATE_INFRA0(CK_INFRA_PWM_STA, "infra_pwm_sta", CK_INFRA_PWM_BCK, 2),
 +	GATE_INFRA0(CK_INFRA_PWM1_CK, "infra_pwm1", CK_INFRA_PWM_CK1, 3),
 +	GATE_INFRA0(CK_INFRA_PWM2_CK, "infra_pwm2", CK_INFRA_PWM_CK2, 4),
 +	GATE_INFRA0(CK_INFRA_CQ_DMA_CK, "infra_cq_dma", CK_INFRA_133M_HCK, 6),
 +	GATE_INFRA0(CK_INFRA_AUD_BUS_CK, "infra_aud_bus", CK_INFRA_66M_PHCK, 8),
 +	GATE_INFRA0(CK_INFRA_AUD_26M_CK, "infra_aud_26m", CK_INFRA_CK_F26M, 9),
 +	GATE_INFRA0(CK_INFRA_AUD_L_CK, "infra_aud_l", CK_INFRA_FAUD_L_CK, 10),
 +	GATE_INFRA0(CK_INFRA_AUD_AUD_CK, "infra_aud_aud", CK_INFRA_FAUD_AUD_CK,
 +		    11),
 +	GATE_INFRA0(CK_INFRA_AUD_EG2_CK, "infra_aud_eg2", CK_INFRA_FAUD_EG2_CK,
 +		    13),
 +	GATE_INFRA0(CK_INFRA_DRAMC_26M_CK, "infra_dramc_26m", CK_INFRA_CK_F26M,
 +		    14),
 +	GATE_INFRA0(CK_INFRA_DBG_CK, "infra_dbg", CK_INFRA_66M_MCK, 15),
 +	GATE_INFRA0(CK_INFRA_AP_DMA_CK, "infra_ap_dma", CK_INFRA_66M_MCK, 16),
 +	GATE_INFRA0(CK_INFRA_SEJ_CK, "infra_sej", CK_INFRA_66M_MCK, 24),
 +	GATE_INFRA0(CK_INFRA_SEJ_13M_CK, "infra_sej_13m", CK_INFRA_CK_F26M, 25),
 +	GATE_INFRA1(CK_INFRA_THERM_CK, "infra_therm", CK_INFRA_CK_F26M, 0),
 +	GATE_INFRA1(CK_INFRA_I2CO_CK, "infra_i2co", CK_INFRA_I2CS_CK, 1),
 +	GATE_INFRA1(CK_INFRA_UART0_CK, "infra_uart0", CK_INFRA_MUX_UART0, 2),
 +	GATE_INFRA1(CK_INFRA_UART1_CK, "infra_uart1", CK_INFRA_MUX_UART1, 3),
 +	GATE_INFRA1(CK_INFRA_UART2_CK, "infra_uart2", CK_INFRA_MUX_UART2, 4),
 +	GATE_INFRA1(CK_INFRA_SPI2_CK, "infra_spi2", CK_INFRA_MUX_SPI2, 6),
 +	GATE_INFRA1(CK_INFRA_SPI2_HCK_CK, "infra_spi2_hck", CK_INFRA_66M_MCK,
 +		    7),
 +	GATE_INFRA1(CK_INFRA_NFI1_CK, "infra_nfi1", CK_INFRA_NFI_CK, 8),
 +	GATE_INFRA1(CK_INFRA_SPINFI1_CK, "infra_spinfi1", CK_INFRA_SPINFI_CK,
 +		    9),
 +	GATE_INFRA1(CK_INFRA_NFI_HCK_CK, "infra_nfi_hck", CK_INFRA_66M_MCK, 10),
 +	GATE_INFRA1(CK_INFRA_SPI0_CK, "infra_spi0", CK_INFRA_MUX_SPI0, 11),
 +	GATE_INFRA1(CK_INFRA_SPI1_CK, "infra_spi1", CK_INFRA_MUX_SPI1, 12),
 +	GATE_INFRA1(CK_INFRA_SPI0_HCK_CK, "infra_spi0_hck", CK_INFRA_66M_MCK,
 +		    13),
 +	GATE_INFRA1(CK_INFRA_SPI1_HCK_CK, "infra_spi1_hck", CK_INFRA_66M_MCK,
 +		    14),
 +	GATE_INFRA1(CK_INFRA_FRTC_CK, "infra_frtc", CK_INFRA_RTC_32K, 15),
 +	GATE_INFRA1(CK_INFRA_MSDC_CK, "infra_msdc", CK_INFRA_FMSDC_CK, 16),
 +	GATE_INFRA1(CK_INFRA_MSDC_HCK_CK, "infra_msdc_hck",
 +		    CK_INFRA_FMSDC_HCK_CK, 17),
 +	GATE_INFRA1(CK_INFRA_MSDC_133M_CK, "infra_msdc_133m",
 +		    CK_INFRA_PERI_133M, 18),
 +	GATE_INFRA1(CK_INFRA_MSDC_66M_CK, "infra_msdc_66m", CK_INFRA_66M_PHCK,
 +		    19),
 +	GATE_INFRA1(CK_INFRA_ADC_26M_CK, "infra_adc_26m", CK_TOP_F26M, 20),
 +	GATE_INFRA1(CK_INFRA_ADC_FRC_CK, "infra_adc_frc", CK_TOP_F26M, 21),
 +	GATE_INFRA1(CK_INFRA_FBIST2FPC_CK, "infra_fbist2fpc", CK_INFRA_NFI_CK,
 +		    23),
 +	GATE_INFRA1(CK_INFRA_I2C_MCK_CK, "infra_i2c_mck", CK_INFRA_133M_MCK,
 +		    25),
 +	GATE_INFRA1(CK_INFRA_I2C_PCK_CK, "infra_i2c_pck", CK_INFRA_66M_MCK, 26),
 +	GATE_INFRA2(CK_INFRA_IUSB_133_CK, "infra_iusb_133", CK_INFRA_133M_PHCK,
 +		    0),
 +	GATE_INFRA2(CK_INFRA_IUSB_66M_CK, "infra_iusb_66m", CK_INFRA_66M_PHCK,
 +		    1),
 +	GATE_INFRA2(CK_INFRA_IUSB_SYS_CK, "infra_iusb_sys", CK_INFRA_USB_SYS_CK,
 +		    2),
 +	GATE_INFRA2(CK_INFRA_IUSB_CK, "infra_iusb", CK_INFRA_USB_CK, 3),
 +	GATE_INFRA2(CK_INFRA_IPCIE_CK, "infra_ipcie",
 +		    CK_INFRA_PCIE_GFMUX_TL_O_PRE, 12),
 +	GATE_INFRA2(CK_INFRA_IPCIER_CK, "infra_ipcier", CK_INFRA_F26M_CK0, 14),
 +	GATE_INFRA2(CK_INFRA_IPCIEB_CK, "infra_ipcieb", CK_INFRA_133M_PHCK, 15),
 +};
 +
 +static const struct mtk_clk_tree mt7981_fixed_pll_clk_tree = {
 +	.fdivs_offs = CLK_APMIXED_NR_CLK,
 +	.xtal_rate = 40 * MHZ,
 +	.fclks = fixed_pll_clks,
 +};
 +
 +static const struct mtk_clk_tree mt7981_topckgen_clk_tree = {
 +	.fdivs_offs = CK_TOP_CB_M_416M,
 +	.muxes_offs = CK_TOP_NFI1X_SEL,
 +	.fclks = top_fixed_clks,
 +	.fdivs = top_fixed_divs,
 +	.muxes = top_muxes,
 +	.flags = CLK_BYPASS_XTAL,
 +};
 +
 +static const struct mtk_clk_tree mt7981_infracfg_clk_tree = {
 +	.fdivs_offs = CK_INFRA_CK_F26M,
 +	.muxes_offs = CK_INFRA_UART0_SEL,
 +	.fdivs = infra_fixed_divs,
 +	.muxes = infra_muxes,
 +};
 +
 +static const struct udevice_id mt7981_fixed_pll_compat[] = {
 +	{ .compatible = "mediatek,mt7981-fixed-plls" },
 +	{}
 +};
 +
 +static const struct udevice_id mt7981_topckgen_compat[] = {
 +	{ .compatible = "mediatek,mt7981-topckgen" },
 +	{}
 +};
 +
 +static int mt7981_fixed_pll_probe(struct udevice *dev)
 +{
 +	return mtk_common_clk_init(dev, &mt7981_fixed_pll_clk_tree);
 +}
 +
 +static int mt7981_topckgen_probe(struct udevice *dev)
 +{
 +	struct mtk_clk_priv *priv = dev_get_priv(dev);
 +
 +	priv->base = dev_read_addr_ptr(dev);
 +	writel(MT7981_CLK_PDN_EN_WRITE, priv->base + MT7981_CLK_PDN);
 +
 +	return mtk_common_clk_init(dev, &mt7981_topckgen_clk_tree);
 +}
 +
 +U_BOOT_DRIVER(mtk_clk_apmixedsys) = {
 +	.name = "mt7981-clock-fixed-pll",
 +	.id = UCLASS_CLK,
 +	.of_match = mt7981_fixed_pll_compat,
 +	.probe = mt7981_fixed_pll_probe,
 +	.priv_auto = sizeof(struct mtk_clk_priv),
 +	.ops = &mtk_clk_topckgen_ops,
 +	.flags = DM_FLAG_PRE_RELOC,
 +};
 +
 +U_BOOT_DRIVER(mtk_clk_topckgen) = {
 +	.name = "mt7981-clock-topckgen",
 +	.id = UCLASS_CLK,
 +	.of_match = mt7981_topckgen_compat,
 +	.probe = mt7981_topckgen_probe,
 +	.priv_auto = sizeof(struct mtk_clk_priv),
 +	.ops = &mtk_clk_topckgen_ops,
 +	.flags = DM_FLAG_PRE_RELOC,
 +};
 +
 +static const struct udevice_id mt7981_infracfg_compat[] = {
 +	{ .compatible = "mediatek,mt7981-infracfg" },
 +	{}
 +};
 +
 +static const struct udevice_id mt7981_infracfg_ao_compat[] = {
 +	{ .compatible = "mediatek,mt7981-infracfg_ao" },
 +	{}
 +};
 +
 +static int mt7981_infracfg_probe(struct udevice *dev)
 +{
 +	return mtk_common_clk_init(dev, &mt7981_infracfg_clk_tree);
 +}
 +
 +static int mt7981_infracfg_ao_probe(struct udevice *dev)
 +{
 +	return mtk_common_clk_gate_init(dev, &mt7981_infracfg_clk_tree,
 +					infracfg_ao_gates);
 +}
 +
 +U_BOOT_DRIVER(mtk_clk_infracfg) = {
 +	.name = "mt7981-clock-infracfg",
 +	.id = UCLASS_CLK,
 +	.of_match = mt7981_infracfg_compat,
 +	.probe = mt7981_infracfg_probe,
 +	.priv_auto = sizeof(struct mtk_clk_priv),
 +	.ops = &mtk_clk_infrasys_ops,
 +	.flags = DM_FLAG_PRE_RELOC,
 +};
 +
 +U_BOOT_DRIVER(mtk_clk_infracfg_ao) = {
 +	.name = "mt7981-clock-infracfg-ao",
 +	.id = UCLASS_CLK,
 +	.of_match = mt7981_infracfg_ao_compat,
 +	.probe = mt7981_infracfg_ao_probe,
 +	.priv_auto = sizeof(struct mtk_cg_priv),
 +	.ops = &mtk_clk_gate_ops,
 +	.flags = DM_FLAG_PRE_RELOC,
 +};
 +
 +/* ethsys */
 +static const struct mtk_gate_regs eth_cg_regs = {
 +	.set_ofs = 0x30,
 +	.clr_ofs = 0x30,
 +	.sta_ofs = 0x30,
 +};
 +
 +#define GATE_ETH(_id, _name, _parent, _shift)                                  \
 +	{                                                                      \
 +		.id = _id, .parent = _parent, .regs = &eth_cg_regs,            \
 +		.shift = _shift,                                               \
 +		.flags = CLK_GATE_NO_SETCLR_INV | CLK_PARENT_TOPCKGEN,         \
 +	}
 +
 +static const struct mtk_gate eth_cgs[] = {
 +	GATE_ETH(CK_ETH_FE_EN, "eth_fe_en", CK_TOP_NETSYS_2X, 6),
 +	GATE_ETH(CK_ETH_GP2_EN, "eth_gp2_en", CK_TOP_SGM_325M, 7),
 +	GATE_ETH(CK_ETH_GP1_EN, "eth_gp1_en", CK_TOP_SGM_325M, 8),
 +	GATE_ETH(CK_ETH_WOCPU0_EN, "eth_wocpu0_en", CK_TOP_NETSYS_WED_MCU, 15),
 +};
 +
 +static int mt7981_ethsys_probe(struct udevice *dev)
 +{
 +	return mtk_common_clk_gate_init(dev, &mt7981_topckgen_clk_tree,
 +					eth_cgs);
 +}
 +
 +static int mt7981_ethsys_bind(struct udevice *dev)
 +{
 +	int ret = 0;
 +
 +	if (CONFIG_IS_ENABLED(RESET_MEDIATEK)) {
 +		ret = mediatek_reset_bind(dev, ETHSYS_HIFSYS_RST_CTRL_OFS, 1);
 +		if (ret)
 +			debug("Warning: failed to bind reset controller\n");
 +	}
 +
 +	return ret;
 +}
 +
 +static const struct udevice_id mt7981_ethsys_compat[] = {
 +	{ .compatible = "mediatek,mt7981-ethsys", },
 +	{}
 +};
 +
 +U_BOOT_DRIVER(mtk_clk_ethsys) = {
 +	.name = "mt7981-clock-ethsys",
 +	.id = UCLASS_CLK,
 +	.of_match = mt7981_ethsys_compat,
 +	.probe = mt7981_ethsys_probe,
 +	.bind = mt7981_ethsys_bind,
 +	.priv_auto = sizeof(struct mtk_cg_priv),
 +	.ops = &mtk_clk_gate_ops,
 +};
 --- /dev/null
 +++ b/include/dt-bindings/clock/mt7981-clk.h
@@ -0,0 +1,267 @@
 +/* SPDX-License-Identifier: GPL-2.0 */
 +/*
 + * Copyright (C) 2022 MediaTek Inc. All rights reserved.
 + *
 + * Author: Sam Shih <sam.shih@mediatek.com>
 + */
 +
 +#ifndef _DT_BINDINGS_CLK_MT7981_H
 +#define _DT_BINDINGS_CLK_MT7981_H
 +
 +/* INFRACFG */
 +
 +#define CK_INFRA_CK_F26M		0
 +#define CK_INFRA_UART			1
 +#define CK_INFRA_ISPI0			2
 +#define CK_INFRA_I2C			3
 +#define CK_INFRA_ISPI1			4
 +#define CK_INFRA_PWM			5
 +#define CK_INFRA_66M_MCK		6
 +#define CK_INFRA_CK_F32K		7
 +#define CK_INFRA_PCIE_CK		8
 +#define CK_INFRA_PWM_BCK		9
 +#define CK_INFRA_PWM_CK1		10
 +#define CK_INFRA_PWM_CK2		11
 +#define CK_INFRA_133M_HCK		12
 +#define CK_INFRA_66M_PHCK		13
 +#define CK_INFRA_FAUD_L_CK		14
 +#define CK_INFRA_FAUD_AUD_CK		15
 +#define CK_INFRA_FAUD_EG2_CK		16
 +#define CK_INFRA_I2CS_CK		17
 +#define CK_INFRA_MUX_UART0		18
 +#define CK_INFRA_MUX_UART1		19
 +#define CK_INFRA_MUX_UART2		20
 +#define CK_INFRA_NFI_CK			21
 +#define CK_INFRA_SPINFI_CK		22
 +#define CK_INFRA_MUX_SPI0		23
 +#define CK_INFRA_MUX_SPI1		24
 +#define CK_INFRA_MUX_SPI2		25
 +#define CK_INFRA_RTC_32K		26
 +#define CK_INFRA_FMSDC_CK		27
 +#define CK_INFRA_FMSDC_HCK_CK		28
 +#define CK_INFRA_PERI_133M		29
 +#define CK_INFRA_133M_PHCK		30
 +#define CK_INFRA_USB_SYS_CK		31
 +#define CK_INFRA_USB_CK			32
 +#define CK_INFRA_USB_XHCI_CK		33
 +#define CK_INFRA_PCIE_GFMUX_TL_O_PRE	34
 +#define CK_INFRA_F26M_CK0		35
 +#define CK_INFRA_133M_MCK		36
 +#define CLK_INFRA_NR_CLK		37
 +
 +/* TOPCKGEN */
 +
 +#define CK_TOP_CB_CKSQ_40M		0
 +#define CK_TOP_CB_M_416M		1
 +#define CK_TOP_CB_M_D2			2
 +#define CK_TOP_CB_M_D3			3
 +#define CK_TOP_M_D3_D2			4
 +#define CK_TOP_CB_M_D4			5
 +#define CK_TOP_CB_M_D8			6
 +#define CK_TOP_M_D8_D2			7
 +#define CK_TOP_CB_MM_720M		8
 +#define CK_TOP_CB_MM_D2			9
 +#define CK_TOP_CB_MM_D3			10
 +#define CK_TOP_CB_MM_D3_D5		11
 +#define CK_TOP_CB_MM_D4			12
 +#define CK_TOP_CB_MM_D6			13
 +#define CK_TOP_MM_D6_D2			14
 +#define CK_TOP_CB_MM_D8			15
 +#define CK_TOP_CB_APLL2_196M		16
 +#define CK_TOP_APLL2_D2			17
 +#define CK_TOP_APLL2_D4			18
 +#define CK_TOP_NET1_2500M		19
 +#define CK_TOP_CB_NET1_D4		20
 +#define CK_TOP_CB_NET1_D5		21
 +#define CK_TOP_NET1_D5_D2		22
 +#define CK_TOP_NET1_D5_D4		23
 +#define CK_TOP_CB_NET1_D8		24
 +#define CK_TOP_NET1_D8_D2		25
 +#define CK_TOP_NET1_D8_D4		26
 +#define CK_TOP_CB_NET2_800M		27
 +#define CK_TOP_CB_NET2_D2		28
 +#define CK_TOP_CB_NET2_D4		29
 +#define CK_TOP_NET2_D4_D2		30
 +#define CK_TOP_NET2_D4_D4		31
 +#define CK_TOP_CB_NET2_D6		32
 +#define CK_TOP_CB_WEDMCU_208M		33
 +#define CK_TOP_CB_SGM_325M		34
 +#define CK_TOP_CKSQ_40M_D2		35
 +#define CK_TOP_CB_RTC_32K		36
 +#define CK_TOP_CB_RTC_32P7K		37
 +#define CK_TOP_USB_TX250M		38
 +#define CK_TOP_FAUD			39
 +#define CK_TOP_NFI1X			40
 +#define CK_TOP_USB_EQ_RX250M		41
 +#define CK_TOP_USB_CDR_CK		42
 +#define CK_TOP_USB_LN0_CK		43
 +#define CK_TOP_SPINFI_BCK		44
 +#define CK_TOP_SPI			45
 +#define CK_TOP_SPIM_MST			46
 +#define CK_TOP_UART_BCK			47
 +#define CK_TOP_PWM_BCK			48
 +#define CK_TOP_I2C_BCK			49
 +#define CK_TOP_PEXTP_TL			50
 +#define CK_TOP_EMMC_208M		51
 +#define CK_TOP_EMMC_400M		52
 +#define CK_TOP_DRAMC_REF		53
 +#define CK_TOP_DRAMC_MD32		54
 +#define CK_TOP_SYSAXI			55
 +#define CK_TOP_SYSAPB			56
 +#define CK_TOP_ARM_DB_MAIN		57
 +#define CK_TOP_AP2CNN_HOST		58
 +#define CK_TOP_NETSYS			59
 +#define CK_TOP_NETSYS_500M		60
 +#define CK_TOP_NETSYS_WED_MCU		61
 +#define CK_TOP_NETSYS_2X		62
 +#define CK_TOP_SGM_325M			63
 +#define CK_TOP_SGM_REG			64
 +#define CK_TOP_F26M			65
 +#define CK_TOP_EIP97B			66
 +#define CK_TOP_USB3_PHY			67
 +#define CK_TOP_AUD			68
 +#define CK_TOP_A1SYS			69
 +#define CK_TOP_AUD_L			70
 +#define CK_TOP_A_TUNER			71
 +#define CK_TOP_U2U3_REF			72
 +#define CK_TOP_U2U3_SYS			73
 +#define CK_TOP_U2U3_XHCI		74
 +#define CK_TOP_USB_FRMCNT		75
 +#define CK_TOP_NFI1X_SEL		76
 +#define CK_TOP_SPINFI_SEL		77
 +#define CK_TOP_SPI_SEL			78
 +#define CK_TOP_SPIM_MST_SEL		79
 +#define CK_TOP_UART_SEL			80
 +#define CK_TOP_PWM_SEL			81
 +#define CK_TOP_I2C_SEL			82
 +#define CK_TOP_PEXTP_TL_SEL		83
 +#define CK_TOP_EMMC_208M_SEL		84
 +#define CK_TOP_EMMC_400M_SEL		85
 +#define CK_TOP_F26M_SEL			86
 +#define CK_TOP_DRAMC_SEL		87
 +#define CK_TOP_DRAMC_MD32_SEL		88
 +#define CK_TOP_SYSAXI_SEL		89
 +#define CK_TOP_SYSAPB_SEL		90
 +#define CK_TOP_ARM_DB_MAIN_SEL		91
 +#define CK_TOP_AP2CNN_HOST_SEL		92
 +#define CK_TOP_NETSYS_SEL		93
 +#define CK_TOP_NETSYS_500M_SEL		94
 +#define CK_TOP_NETSYS_MCU_SEL		95
 +#define CK_TOP_NETSYS_2X_SEL		96
 +#define CK_TOP_SGM_325M_SEL		97
 +#define CK_TOP_SGM_REG_SEL		98
 +#define CK_TOP_EIP97B_SEL		99
 +#define CK_TOP_USB3_PHY_SEL		100
 +#define CK_TOP_AUD_SEL			101
 +#define CK_TOP_A1SYS_SEL		102
 +#define CK_TOP_AUD_L_SEL		103
 +#define CK_TOP_A_TUNER_SEL		104
 +#define CK_TOP_U2U3_SEL			105
 +#define CK_TOP_U2U3_SYS_SEL		106
 +#define CK_TOP_U2U3_XHCI_SEL		107
 +#define CK_TOP_USB_FRMCNT_SEL		108
 +#define CLK_TOP_NR_CLK			109
 +
 +/*
 + * INFRACFG_AO
 + * clock muxes need to be append to infracfg domain, and clock gates
 + * need to be keep in infracgh_ao domain
 + */
 +#define INFRACFG_AO_OFFSET		10
 +
 +#define CK_INFRA_UART0_SEL		(0 + CLK_INFRA_NR_CLK)
 +#define CK_INFRA_UART1_SEL		(1 + CLK_INFRA_NR_CLK)
 +#define CK_INFRA_UART2_SEL		(2 + CLK_INFRA_NR_CLK)
 +#define CK_INFRA_SPI0_SEL		(3 + CLK_INFRA_NR_CLK)
 +#define CK_INFRA_SPI1_SEL		(4 + CLK_INFRA_NR_CLK)
 +#define CK_INFRA_SPI2_SEL		(5 + CLK_INFRA_NR_CLK)
 +#define CK_INFRA_PWM1_SEL		(6 + CLK_INFRA_NR_CLK)
 +#define CK_INFRA_PWM2_SEL		(7 + CLK_INFRA_NR_CLK)
 +#define CK_INFRA_PWM_BSEL		(8 + CLK_INFRA_NR_CLK)
 +#define CK_INFRA_PCIE_SEL		(9 + CLK_INFRA_NR_CLK)
 +#define CK_INFRA_GPT_STA		(10 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_PWM_HCK		(11 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_PWM_STA		(12 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_PWM1_CK		(13 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_PWM2_CK		(14 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_CQ_DMA_CK		(15 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_AUD_BUS_CK		(16 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_AUD_26M_CK		(17 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_AUD_L_CK		(18 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_AUD_AUD_CK		(19 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_AUD_EG2_CK		(20 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_DRAMC_26M_CK		(21 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_DBG_CK			(22 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_AP_DMA_CK		(23 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_SEJ_CK			(24 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_SEJ_13M_CK		(25 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_THERM_CK		(26 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_I2CO_CK		(27 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_UART0_CK		(28 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_UART1_CK		(29 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_UART2_CK		(30 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_SPI2_CK		(31 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_SPI2_HCK_CK		(32 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_NFI1_CK		(33 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_SPINFI1_CK		(34 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_NFI_HCK_CK		(35 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_SPI0_CK		(36 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_SPI1_CK		(37 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_SPI0_HCK_CK		(38 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_SPI1_HCK_CK		(39 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_FRTC_CK		(40 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_MSDC_CK		(41 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_MSDC_HCK_CK		(42 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_MSDC_133M_CK		(43 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_MSDC_66M_CK		(44 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_ADC_26M_CK		(45 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_ADC_FRC_CK		(46 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_FBIST2FPC_CK		(47 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_I2C_MCK_CK		(48 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_I2C_PCK_CK		(49 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_IUSB_133_CK		(50 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_IUSB_66M_CK		(51 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_IUSB_SYS_CK		(52 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_IUSB_CK		(53 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_IPCIE_CK		(54 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_IPCIER_CK		(55 - INFRACFG_AO_OFFSET)
 +#define CK_INFRA_IPCIEB_CK		(56 - INFRACFG_AO_OFFSET)
 +#define CLK_INFRA_AO_NR_CLK		(57 - INFRACFG_AO_OFFSET)
 +
 +/* APMIXEDSYS */
 +
 +#define CK_APMIXED_ARMPLL		0
 +#define CK_APMIXED_NET2PLL		1
 +#define CK_APMIXED_MMPLL		2
 +#define CK_APMIXED_SGMPLL		3
 +#define CK_APMIXED_WEDMCUPLL		4
 +#define CK_APMIXED_NET1PLL		5
 +#define CK_APMIXED_MPLL			6
 +#define CK_APMIXED_APLL2		7
 +#define CLK_APMIXED_NR_CLK		8
 +
 +/* SGMIISYS_0 */
 +
 +#define CK_SGM0_TX_EN			0
 +#define CK_SGM0_RX_EN			1
 +#define CK_SGM0_CK0_EN			2
 +#define CK_SGM0_CDR_CK0_EN		3
 +#define CLK_SGMII0_NR_CLK		4
 +
 +/* SGMIISYS_1 */
 +
 +#define CK_SGM1_TX_EN			0
 +#define CK_SGM1_RX_EN			1
 +#define CK_SGM1_CK1_EN			2
 +#define CK_SGM1_CDR_CK1_EN		3
 +#define CLK_SGMII1_NR_CLK		4
 +
 +/* ETHSYS */
 +
 +#define CK_ETH_FE_EN			0
 +#define CK_ETH_GP2_EN			1
 +#define CK_ETH_GP1_EN			2
 +#define CK_ETH_WOCPU0_EN		3
 +#define CLK_ETH_NR_CLK			4
 +
 +#endif /* _DT_BINDINGS_CLK_MT7981_H */
--- a/package/boot/uboot-mediatek/patches/002-0028-tools-mtk_image-split-gfh-header-verification-into-a.patch
+++ b/package/boot/uboot-mediatek/patches/002-0028-tools-mtk_image-split-gfh-header-verification-into-a.patch
@@ -0,0 +1,89 @@
 From b6bb61fd3818f4a3025fedbe4d15dbeeaef6ee82 Mon Sep 17 00:00:00 2001
 From: Weijie Gao <weijie.gao@mediatek.com>
 Date: Tue, 2 Aug 2022 17:21:34 +0800
 Subject: [PATCH 28/31] tools: mtk_image: split gfh header verification into a
 new function
 The verification code of gfh header for NAND and non-NAND are identical.
 It's better to define a individual function to reduce redundancy.
 Reviewed-by: Simon Glass <sjg@chromium.org>
 Signed-off-by: Weijie Gao <weijie.gao@mediatek.com>
 ---
 tools/mtk_image.c | 51 +++++++++++++++++++----------------------------
 1 file changed, 21 insertions(+), 30 deletions(-)
 --- a/tools/mtk_image.c
 +++ b/tools/mtk_image.c
@@ -480,6 +480,25 @@ static int mtk_image_vrec_header(struct
 	return SHA256_SUM_LEN;
 }
 +static int mtk_image_verify_gfh(struct gfh_header *gfh, uint32_t type, int print)
 +{
 +	if (strcmp(gfh->file_info.name, GFH_FILE_INFO_NAME))
 +		return -1;
 +
 +	if (le32_to_cpu(gfh->file_info.flash_type) != type)
 +		return -1;
 +
 +	if (print)
 +		printf("Load Address: %08x\n",
 +		       le32_to_cpu(gfh->file_info.load_addr) +
 +		       le32_to_cpu(gfh->file_info.jump_offset));
 +
 +	if (print)
 +		printf("Architecture: %s\n", is_arm64_image ? "ARM64" : "ARM");
 +
 +	return 0;
 +}
 +
 static int mtk_image_verify_gen_header(const uint8_t *ptr, int print)
 {
 	union gen_boot_header *gbh = (union gen_boot_header *)ptr;
@@ -542,21 +561,7 @@ static int mtk_image_verify_gen_header(c
 	gfh = (struct gfh_header *)(ptr + gfh_offset);
 -	if (strcmp(gfh->file_info.name, GFH_FILE_INFO_NAME))
 -		return -1;
 -
 -	if (le32_to_cpu(gfh->file_info.flash_type) != GFH_FLASH_TYPE_GEN)
 -		return -1;
 -
 -	if (print)
 -		printf("Load Address: %08x\n",
 -		       le32_to_cpu(gfh->file_info.load_addr) +
 -		       le32_to_cpu(gfh->file_info.jump_offset));
 -
 -	if (print)
 -		printf("Architecture: %s\n", is_arm64_image ? "ARM64" : "ARM");
 -
 -	return 0;
 +	return mtk_image_verify_gfh(gfh, GFH_FLASH_TYPE_GEN, print);
 }
 static int mtk_image_verify_nand_header(const uint8_t *ptr, int print)
@@ -610,21 +615,7 @@ static int mtk_image_verify_nand_header(
 	gfh = (struct gfh_header *)(ptr + 2 * le16_to_cpu(nh->pagesize));
 -	if (strcmp(gfh->file_info.name, GFH_FILE_INFO_NAME))
 -		return -1;
 -
 -	if (le32_to_cpu(gfh->file_info.flash_type) != GFH_FLASH_TYPE_NAND)
 -		return -1;
 -
 -	if (print)
 -		printf("Load Address: %08x\n",
 -		       le32_to_cpu(gfh->file_info.load_addr) +
 -		       le32_to_cpu(gfh->file_info.jump_offset));
 -
 -	if (print)
 -		printf("Architecture: %s\n", is_arm64_image ? "ARM64" : "ARM");
 -
 -	return 0;
 +	return mtk_image_verify_gfh(gfh, GFH_FLASH_TYPE_NAND, print);
 }
 static uint32_t crc32be_cal(const void *data, size_t length)
--- a/package/boot/uboot-mediatek/patches/002-0029-tools-mtk_image-split-the-code-of-generating-NAND-he.patch
+++ b/package/boot/uboot-mediatek/patches/002-0029-tools-mtk_image-split-the-code-of-generating-NAND-he.patch
@@ -0,0 +1,821 @@
 From 20ebf03eab571b25e9f62b2764ab84932111dcd6 Mon Sep 17 00:00:00 2001
 From: Weijie Gao <weijie.gao@mediatek.com>
 Date: Tue, 2 Aug 2022 17:23:57 +0800
 Subject: [PATCH 29/31] tools: mtk_image: split the code of generating NAND
 header into a new file
 The predefined NAND headers take too much spaces in the mtk_image.c.
 Moving them into a new file can significantly improve the readability of
 both mtk_image.c and the new mtk_nand_headers.c.
 This is a preparation for adding more NAND headers.
 Reviewed-by: Simon Glass <sjg@chromium.org>
 Signed-off-by: Weijie Gao <weijie.gao@mediatek.com>
 ---
 tools/Makefile           |   1 +
 tools/mtk_image.c        | 305 ++++++---------------------------------
 tools/mtk_image.h        |  25 ----
 tools/mtk_nand_headers.c | 286 ++++++++++++++++++++++++++++++++++++
 tools/mtk_nand_headers.h |  61 ++++++++
 5 files changed, 389 insertions(+), 289 deletions(-)
 create mode 100644 tools/mtk_nand_headers.c
 create mode 100644 tools/mtk_nand_headers.h
 --- a/tools/Makefile
 +++ b/tools/Makefile
@@ -148,6 +148,7 @@ dumpimage-mkimage-objs := aisimage.o \
 			gpimage.o \
 			gpimage-common.o \
 			mtk_image.o \
 +			mtk_nand_headers.o \
 			$(ECDSA_OBJS-y) \
 			$(RSA_OBJS-y) \
 			$(AES_OBJS-y)
 --- a/tools/mtk_image.c
 +++ b/tools/mtk_image.c
@@ -12,216 +12,7 @@
 #include <u-boot/sha256.h>
 #include "imagetool.h"
 #include "mtk_image.h"
 -
 -/* NAND header for SPI-NAND with 2KB page + 64B spare */
 -static const union nand_boot_header snand_hdr_2k_64_data = {
 -	.data = {
 -		0x42, 0x4F, 0x4F, 0x54, 0x4C, 0x4F, 0x41, 0x44,
 -		0x45, 0x52, 0x21, 0x00, 0x56, 0x30, 0x30, 0x36,
 -		0x4E, 0x46, 0x49, 0x49, 0x4E, 0x46, 0x4F, 0x00,
 -		0x00, 0x00, 0x00, 0x08, 0x03, 0x00, 0x40, 0x00,
 -		0x40, 0x00, 0x00, 0x08, 0x10, 0x00, 0x16, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x7B, 0xC4, 0x17, 0x9D,
 -		0xCA, 0x42, 0x90, 0xD0, 0x98, 0xD0, 0xE0, 0xF7,
 -		0xDB, 0xCD, 0x16, 0xF6, 0x03, 0x73, 0xD2, 0xB8,
 -		0x93, 0xB2, 0x56, 0x5A, 0x84, 0x6E, 0x00, 0x00
 -	}
 -};
 -
 -/* NAND header for SPI-NAND with 2KB page + 120B/128B spare */
 -static const union nand_boot_header snand_hdr_2k_128_data = {
 -	.data = {
 -		0x42, 0x4F, 0x4F, 0x54, 0x4C, 0x4F, 0x41, 0x44,
 -		0x45, 0x52, 0x21, 0x00, 0x56, 0x30, 0x30, 0x36,
 -		0x4E, 0x46, 0x49, 0x49, 0x4E, 0x46, 0x4F, 0x00,
 -		0x00, 0x00, 0x00, 0x08, 0x05, 0x00, 0x70, 0x00,
 -		0x40, 0x00, 0x00, 0x08, 0x10, 0x00, 0x16, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x90, 0x28, 0xED, 0x13,
 -		0x7F, 0x12, 0x22, 0xCD, 0x3D, 0x06, 0xF1, 0xB3,
 -		0x6F, 0x2E, 0xD9, 0xA0, 0x9D, 0x7A, 0xBD, 0xD7,
 -		0xB3, 0x28, 0x3C, 0x13, 0xDB, 0x4E, 0x00, 0x00
 -	}
 -};
 -
 -/* NAND header for SPI-NAND with 4KB page + 256B spare */
 -static const union nand_boot_header snand_hdr_4k_256_data = {
 -	.data = {
 -		0x42, 0x4F, 0x4F, 0x54, 0x4C, 0x4F, 0x41, 0x44,
 -		0x45, 0x52, 0x21, 0x00, 0x56, 0x30, 0x30, 0x36,
 -		0x4E, 0x46, 0x49, 0x49, 0x4E, 0x46, 0x4F, 0x00,
 -		0x00, 0x00, 0x00, 0x10, 0x05, 0x00, 0xE0, 0x00,
 -		0x40, 0x00, 0x00, 0x08, 0x10, 0x00, 0x16, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x47, 0xED, 0x0E, 0xC3,
 -		0x83, 0xBF, 0x41, 0xD2, 0x85, 0x21, 0x97, 0x57,
 -		0xC4, 0x2E, 0x6B, 0x7A, 0x40, 0xE0, 0xCF, 0x8F,
 -		0x37, 0xBD, 0x17, 0xB6, 0xC7, 0xFE, 0x00, 0x00
 -	}
 -};
 -
 -/* NAND header for Parallel NAND 1Gb with 2KB page + 64B spare */
 -static const union nand_boot_header nand_hdr_1gb_2k_64_data = {
 -	.data = {
 -		0x42, 0x4F, 0x4F, 0x54, 0x4C, 0x4F, 0x41, 0x44,
 -		0x45, 0x52, 0x21, 0x00, 0x56, 0x30, 0x30, 0x36,
 -		0x4E, 0x46, 0x49, 0x49, 0x4E, 0x46, 0x4F, 0x00,
 -		0x00, 0x00, 0x00, 0x08, 0x05, 0x00, 0x40, 0x00,
 -		0x40, 0x00, 0x00, 0x04, 0x0B, 0x00, 0x11, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x12, 0x28, 0x1C, 0x12,
 -		0x8F, 0xFD, 0xF8, 0x32, 0x6F, 0x6D, 0xCF, 0x6C,
 -		0xDA, 0x21, 0x70, 0x8C, 0xDA, 0x0A, 0x22, 0x82,
 -		0xAA, 0x59, 0xFA, 0x7C, 0x42, 0x2D, 0x00, 0x00
 -	}
 -};
 -
 -/* NAND header for Parallel NAND 2Gb with 2KB page + 64B spare */
 -static const union nand_boot_header nand_hdr_2gb_2k_64_data = {
 -	.data = {
 -		0x42, 0x4F, 0x4F, 0x54, 0x4C, 0x4F, 0x41, 0x44,
 -		0x45, 0x52, 0x21, 0x00, 0x56, 0x30, 0x30, 0x36,
 -		0x4E, 0x46, 0x49, 0x49, 0x4E, 0x46, 0x4F, 0x00,
 -		0x00, 0x00, 0x00, 0x08, 0x05, 0x00, 0x40, 0x00,
 -		0x40, 0x00, 0x00, 0x08, 0x0B, 0x00, 0x11, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x20, 0x9C, 0x3D, 0x2D,
 -		0x7B, 0x68, 0x63, 0x52, 0x2E, 0x04, 0x63, 0xF1,
 -		0x35, 0x4E, 0x44, 0x3E, 0xF8, 0xAC, 0x9B, 0x95,
 -		0xAB, 0xFE, 0xE4, 0xE1, 0xD5, 0xF9, 0x00, 0x00
 -	}
 -};
 -
 -/* NAND header for Parallel NAND 4Gb with 2KB page + 64B spare */
 -static const union nand_boot_header nand_hdr_4gb_2k_64_data = {
 -	.data = {
 -		0x42, 0x4F, 0x4F, 0x54, 0x4C, 0x4F, 0x41, 0x44,
 -		0x45, 0x52, 0x21, 0x00, 0x56, 0x30, 0x30, 0x36,
 -		0x4E, 0x46, 0x49, 0x49, 0x4E, 0x46, 0x4F, 0x00,
 -		0x00, 0x00, 0x00, 0x08, 0x05, 0x00, 0x40, 0x00,
 -		0x40, 0x00, 0x00, 0x10, 0x0B, 0x00, 0x11, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0xE3, 0x0F, 0x86, 0x32,
 -		0x68, 0x05, 0xD9, 0xC8, 0x13, 0xDF, 0xC5, 0x0B,
 -		0x35, 0x3A, 0x68, 0xA5, 0x3C, 0x0C, 0x73, 0x87,
 -		0x63, 0xB0, 0xBE, 0xCC, 0x84, 0x47, 0x00, 0x00
 -	}
 -};
 -
 -/* NAND header for Parallel NAND 2Gb with 2KB page + 128B spare */
 -static const union nand_boot_header nand_hdr_2gb_2k_128_data = {
 -	.data = {
 -		0x42, 0x4F, 0x4F, 0x54, 0x4C, 0x4F, 0x41, 0x44,
 -		0x45, 0x52, 0x21, 0x00, 0x56, 0x30, 0x30, 0x36,
 -		0x4E, 0x46, 0x49, 0x49, 0x4E, 0x46, 0x4F, 0x00,
 -		0x00, 0x00, 0x00, 0x08, 0x05, 0x00, 0x70, 0x00,
 -		0x40, 0x00, 0x00, 0x08, 0x0B, 0x00, 0x11, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x01, 0xA5, 0xE9, 0x5A,
 -		0xDF, 0x58, 0x62, 0x41, 0xD6, 0x26, 0x77, 0xBC,
 -		0x76, 0x1F, 0x27, 0x4E, 0x4F, 0x6C, 0xC3, 0xF0,
 -		0x36, 0xDE, 0xD9, 0xB3, 0xFF, 0x93, 0x00, 0x00
 -	}
 -};
 -
 -/* NAND header for Parallel NAND 4Gb with 2KB page + 128B spare */
 -static const union nand_boot_header nand_hdr_4gb_2k_128_data = {
 -	.data = {
 -		0x42, 0x4F, 0x4F, 0x54, 0x4C, 0x4F, 0x41, 0x44,
 -		0x45, 0x52, 0x21, 0x00, 0x56, 0x30, 0x30, 0x36,
 -		0x4E, 0x46, 0x49, 0x49, 0x4E, 0x46, 0x4F, 0x00,
 -		0x00, 0x00, 0x00, 0x08, 0x05, 0x00, 0x70, 0x00,
 -		0x40, 0x00, 0x00, 0x10, 0x0B, 0x00, 0x11, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 -		0x00, 0x00, 0x00, 0x00, 0xC2, 0x36, 0x52, 0x45,
 -		0xCC, 0x35, 0xD8, 0xDB, 0xEB, 0xFD, 0xD1, 0x46,
 -		0x76, 0x6B, 0x0B, 0xD5, 0x8B, 0xCC, 0x2B, 0xE2,
 -		0xFE, 0x90, 0x83, 0x9E, 0xAE, 0x2D, 0x00, 0x00
 -	}
 -};
 -
 -static const struct nand_header_type {
 -	const char *name;
 -	const union nand_boot_header *data;
 -} nand_headers[] = {
 -	{
 -		.name = "2k+64",
 -		.data = &snand_hdr_2k_64_data
 -	}, {
 -		.name = "2k+120",
 -		.data = &snand_hdr_2k_128_data
 -	}, {
 -		.name = "2k+128",
 -		.data = &snand_hdr_2k_128_data
 -	}, {
 -		.name = "4k+256",
 -		.data = &snand_hdr_4k_256_data
 -	}, {
 -		.name = "1g:2k+64",
 -		.data = &nand_hdr_1gb_2k_64_data
 -	}, {
 -		.name = "2g:2k+64",
 -		.data = &nand_hdr_2gb_2k_64_data
 -	}, {
 -		.name = "4g:2k+64",
 -		.data = &nand_hdr_4gb_2k_64_data
 -	}, {
 -		.name = "2g:2k+128",
 -		.data = &nand_hdr_2gb_2k_128_data
 -	}, {
 -		.name = "4g:2k+128",
 -		.data = &nand_hdr_4gb_2k_128_data
 -	}
 -};
 +#include "mtk_nand_headers.h"
 static const struct brom_img_type {
 	const char *name;
@@ -264,6 +55,7 @@ static uint32_t crc32tbl[256];
 /* NAND header selected by user */
 static const union nand_boot_header *hdr_nand;
 +static uint32_t hdr_nand_size;
 /* GFH header + 2 * 4KB pages of NAND */
 static char hdr_tmp[sizeof(struct gfh_header) + 0x2000];
@@ -402,12 +194,7 @@ static int mtk_brom_parse_imagename(cons
 	}
 	/* parse nand header type */
 -	for (i = 0; i < ARRAY_SIZE(nand_headers); i++) {
 -		if (!strcmp(nand_headers[i].name, nandinfo)) {
 -			hdr_nand = nand_headers[i].data;
 -			break;
 -		}
 -	}
 +	hdr_nand = mtk_nand_header_find(nandinfo);
 	/* parse device header offset */
 	if (hdr_offs && hdr_offs[0])
@@ -432,6 +219,9 @@ static int mtk_brom_parse_imagename(cons
 		return -EINVAL;
 	}
 +	if (hdr_media == BRLYT_TYPE_NAND || hdr_media == BRLYT_TYPE_SNAND)
 +		hdr_nand_size = mtk_nand_header_size(hdr_nand);
 +
 	return 0;
 }
@@ -468,7 +258,7 @@ static int mtk_image_vrec_header(struct
 	}
 	if (hdr_media == BRLYT_TYPE_NAND || hdr_media == BRLYT_TYPE_SNAND)
 -		tparams->header_size = 2 * le16_to_cpu(hdr_nand->pagesize);
 +		tparams->header_size = hdr_nand_size;
 	else
 		tparams->header_size = sizeof(struct gen_device_header);
@@ -566,16 +356,17 @@ static int mtk_image_verify_gen_header(c
 static int mtk_image_verify_nand_header(const uint8_t *ptr, int print)
 {
 -	union nand_boot_header *nh = (union nand_boot_header *)ptr;
 	struct brom_layout_header *bh;
 +	struct nand_header_info info;
 	struct gfh_header *gfh;
 	const char *bootmedia;
 +	int ret;
 -	if (strncmp(nh->version, NAND_BOOT_VERSION, sizeof(nh->version)) ||
 -	    strcmp(nh->id, NAND_BOOT_ID))
 -		return -1;
 +	ret = mtk_nand_header_info(ptr, &info);
 +	if (ret < 0)
 +		return ret;
 -	bh = (struct brom_layout_header *)(ptr + le16_to_cpu(nh->pagesize));
 +	bh = (struct brom_layout_header *)(ptr + info.page_size);
 	if (strcmp(bh->name, BRLYT_NAME))
 		return -1;
@@ -586,34 +377,23 @@ static int mtk_image_verify_nand_header(
 		if (le32_to_cpu(bh->type) == BRLYT_TYPE_NAND)
 			bootmedia = "Parallel NAND";
 		else if (le32_to_cpu(bh->type) == BRLYT_TYPE_SNAND)
 -			bootmedia = "Serial NAND";
 +			bootmedia = "Serial NAND (SNFI/AP)";
 		else
 			return -1;
 	}
 	if (print) {
 -		printf("Boot Media: %s\n", bootmedia);
 -
 -		if (le32_to_cpu(bh->type) == BRLYT_TYPE_NAND) {
 -			uint64_t capacity =
 -				(uint64_t)le16_to_cpu(nh->numblocks) *
 -				(uint64_t)le16_to_cpu(nh->pages_of_block) *
 -				(uint64_t)le16_to_cpu(nh->pagesize) * 8;
 -			printf("Capacity:     %dGb\n",
 -			       (uint32_t)(capacity >> 30));
 -		}
 +		printf("Boot Media:   %s\n", bootmedia);
 -		if (le16_to_cpu(nh->pagesize) >= 1024)
 -			printf("Page Size:    %dKB\n",
 -			       le16_to_cpu(nh->pagesize) >> 10);
 +		if (info.page_size >= 1024)
 +			printf("Page Size:    %dKB\n", info.page_size >> 10);
 		else
 -			printf("Page Size:    %dB\n",
 -			       le16_to_cpu(nh->pagesize));
 +			printf("Page Size:    %dB\n", info.page_size);
 -		printf("Spare Size:   %dB\n", le16_to_cpu(nh->oobsize));
 +		printf("Spare Size:   %dB\n", info.spare_size);
 	}
 -	gfh = (struct gfh_header *)(ptr + 2 * le16_to_cpu(nh->pagesize));
 +	gfh = (struct gfh_header *)(ptr + info.gfh_offset);
 	return mtk_image_verify_gfh(gfh, GFH_FLASH_TYPE_NAND, print);
 }
@@ -713,7 +493,7 @@ static int mtk_image_verify_header(unsig
 	if (image_get_magic(hdr) == IH_MAGIC)
 		return mtk_image_verify_mt7621_header(ptr, 0);
 -	if (!strcmp((char *)ptr, NAND_BOOT_NAME))
 +	if (is_mtk_nand_header(ptr))
 		return mtk_image_verify_nand_header(ptr, 0);
 	else
 		return mtk_image_verify_gen_header(ptr, 0);
@@ -739,7 +519,7 @@ static void mtk_image_print_header(const
 		return;
 	}
 -	if (!strcmp((char *)ptr, NAND_BOOT_NAME))
 +	if (is_mtk_nand_header(ptr))
 		mtk_image_verify_nand_header(ptr, 1);
 	else
 		mtk_image_verify_gen_header(ptr, 1);
@@ -870,36 +650,33 @@ static void mtk_image_set_gen_header(voi
 static void mtk_image_set_nand_header(void *ptr, off_t filesize,
 				      uint32_t loadaddr)
 {
 -	union nand_boot_header *nh = (union nand_boot_header *)ptr;
 	struct brom_layout_header *brlyt;
 	struct gfh_header *gfh;
 -	uint32_t payload_pages;
 -	int i;
 +	uint32_t payload_pages, nand_page_size;
 -	/* NAND device header, repeat 4 times */
 -	for (i = 0; i < 4; i++)
 -		memcpy(nh + i, hdr_nand, sizeof(union nand_boot_header));
 +	/* NAND header */
 +	nand_page_size = mtk_nand_header_put(hdr_nand, ptr);
 -	/* BRLYT header */
 -	payload_pages = (filesize + le16_to_cpu(hdr_nand->pagesize) - 1) /
 -			le16_to_cpu(hdr_nand->pagesize);
 -	brlyt = (struct brom_layout_header *)
 -		(ptr + le16_to_cpu(hdr_nand->pagesize));
 -	put_brom_layout_header(brlyt, hdr_media);
 -	brlyt->header_size = cpu_to_le32(2);
 -	brlyt->total_size = cpu_to_le32(payload_pages);
 -	brlyt->header_size_2 = brlyt->header_size;
 -	brlyt->total_size_2 = brlyt->total_size;
 -	brlyt->unused = cpu_to_le32(1);
 +	if (nand_page_size) {
 +		/* BRLYT header */
 +		payload_pages = (filesize + nand_page_size - 1) /
 +				nand_page_size;
 +		brlyt = (struct brom_layout_header *)(ptr + nand_page_size);
 +		put_brom_layout_header(brlyt, hdr_media);
 +		brlyt->header_size = cpu_to_le32(2);
 +		brlyt->total_size = cpu_to_le32(payload_pages);
 +		brlyt->header_size_2 = brlyt->header_size;
 +		brlyt->total_size_2 = brlyt->total_size;
 +		brlyt->unused = cpu_to_le32(1);
 +	}
 	/* GFH header */
 -	gfh = (struct gfh_header *)(ptr + 2 * le16_to_cpu(hdr_nand->pagesize));
 -	put_ghf_header(gfh, filesize, 2 * le16_to_cpu(hdr_nand->pagesize),
 -		       loadaddr, GFH_FLASH_TYPE_NAND);
 +	gfh = (struct gfh_header *)(ptr + hdr_nand_size);
 +	put_ghf_header(gfh, filesize, hdr_nand_size, loadaddr,
 +		       GFH_FLASH_TYPE_NAND);
 	/* Generate SHA256 hash */
 -	put_hash((uint8_t *)gfh,
 -		 filesize - 2 * le16_to_cpu(hdr_nand->pagesize) - SHA256_SUM_LEN);
 +	put_hash((uint8_t *)gfh, filesize - hdr_nand_size - SHA256_SUM_LEN);
 }
 static void mtk_image_set_mt7621_header(void *ptr, off_t filesize,
 --- a/tools/mtk_image.h
 +++ b/tools/mtk_image.h
@@ -26,31 +26,6 @@ union gen_boot_header {
 #define SF_BOOT_NAME		"SF_BOOT"
 #define SDMMC_BOOT_NAME		"SDMMC_BOOT"
 -/* Header for NAND */
 -union nand_boot_header {
 -	struct {
 -		char name[12];
 -		char version[4];
 -		char id[8];
 -		uint16_t ioif;
 -		uint16_t pagesize;
 -		uint16_t addrcycles;
 -		uint16_t oobsize;
 -		uint16_t pages_of_block;
 -		uint16_t numblocks;
 -		uint16_t writesize_shift;
 -		uint16_t erasesize_shift;
 -		uint8_t dummy[60];
 -		uint8_t ecc_parity[28];
 -	};
 -
 -	uint8_t data[0x80];
 -};
 -
 -#define NAND_BOOT_NAME		"BOOTLOADER!"
 -#define NAND_BOOT_VERSION	"V006"
 -#define NAND_BOOT_ID		"NFIINFO"
 -
 /* BootROM layout header */
 struct brom_layout_header {
 	char name[8];
 --- /dev/null
 +++ b/tools/mtk_nand_headers.c
@@ -0,0 +1,286 @@
 +// SPDX-License-Identifier: GPL-2.0+
 +/*
 + * MediaTek BootROM NAND header definitions
 + *
 + * Copyright (C) 2022 MediaTek Inc.
 + * Author: Weijie Gao <weijie.gao@mediatek.com>
 + */
 +
 +#include <stdint.h>
 +#include <string.h>
 +#include "imagetool.h"
 +#include "mtk_image.h"
 +#include "mtk_nand_headers.h"
 +
 +/* NAND header for SPI-NAND with 2KB page + 64B spare */
 +static const union nand_boot_header snand_hdr_2k_64_data = {
 +	.data = {
 +		0x42, 0x4F, 0x4F, 0x54, 0x4C, 0x4F, 0x41, 0x44,
 +		0x45, 0x52, 0x21, 0x00, 0x56, 0x30, 0x30, 0x36,
 +		0x4E, 0x46, 0x49, 0x49, 0x4E, 0x46, 0x4F, 0x00,
 +		0x00, 0x00, 0x00, 0x08, 0x03, 0x00, 0x40, 0x00,
 +		0x40, 0x00, 0x00, 0x08, 0x10, 0x00, 0x16, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x7B, 0xC4, 0x17, 0x9D,
 +		0xCA, 0x42, 0x90, 0xD0, 0x98, 0xD0, 0xE0, 0xF7,
 +		0xDB, 0xCD, 0x16, 0xF6, 0x03, 0x73, 0xD2, 0xB8,
 +		0x93, 0xB2, 0x56, 0x5A, 0x84, 0x6E, 0x00, 0x00
 +	}
 +};
 +
 +/* NAND header for SPI-NAND with 2KB page + 120B/128B spare */
 +static const union nand_boot_header snand_hdr_2k_128_data = {
 +	.data = {
 +		0x42, 0x4F, 0x4F, 0x54, 0x4C, 0x4F, 0x41, 0x44,
 +		0x45, 0x52, 0x21, 0x00, 0x56, 0x30, 0x30, 0x36,
 +		0x4E, 0x46, 0x49, 0x49, 0x4E, 0x46, 0x4F, 0x00,
 +		0x00, 0x00, 0x00, 0x08, 0x05, 0x00, 0x70, 0x00,
 +		0x40, 0x00, 0x00, 0x08, 0x10, 0x00, 0x16, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x90, 0x28, 0xED, 0x13,
 +		0x7F, 0x12, 0x22, 0xCD, 0x3D, 0x06, 0xF1, 0xB3,
 +		0x6F, 0x2E, 0xD9, 0xA0, 0x9D, 0x7A, 0xBD, 0xD7,
 +		0xB3, 0x28, 0x3C, 0x13, 0xDB, 0x4E, 0x00, 0x00
 +	}
 +};
 +
 +/* NAND header for SPI-NAND with 4KB page + 256B spare */
 +static const union nand_boot_header snand_hdr_4k_256_data = {
 +	.data = {
 +		0x42, 0x4F, 0x4F, 0x54, 0x4C, 0x4F, 0x41, 0x44,
 +		0x45, 0x52, 0x21, 0x00, 0x56, 0x30, 0x30, 0x36,
 +		0x4E, 0x46, 0x49, 0x49, 0x4E, 0x46, 0x4F, 0x00,
 +		0x00, 0x00, 0x00, 0x10, 0x05, 0x00, 0xE0, 0x00,
 +		0x40, 0x00, 0x00, 0x08, 0x10, 0x00, 0x16, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x47, 0xED, 0x0E, 0xC3,
 +		0x83, 0xBF, 0x41, 0xD2, 0x85, 0x21, 0x97, 0x57,
 +		0xC4, 0x2E, 0x6B, 0x7A, 0x40, 0xE0, 0xCF, 0x8F,
 +		0x37, 0xBD, 0x17, 0xB6, 0xC7, 0xFE, 0x00, 0x00
 +	}
 +};
 +
 +/* NAND header for Parallel NAND 1Gb with 2KB page + 64B spare */
 +static const union nand_boot_header nand_hdr_1gb_2k_64_data = {
 +	.data = {
 +		0x42, 0x4F, 0x4F, 0x54, 0x4C, 0x4F, 0x41, 0x44,
 +		0x45, 0x52, 0x21, 0x00, 0x56, 0x30, 0x30, 0x36,
 +		0x4E, 0x46, 0x49, 0x49, 0x4E, 0x46, 0x4F, 0x00,
 +		0x00, 0x00, 0x00, 0x08, 0x05, 0x00, 0x40, 0x00,
 +		0x40, 0x00, 0x00, 0x04, 0x0B, 0x00, 0x11, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x12, 0x28, 0x1C, 0x12,
 +		0x8F, 0xFD, 0xF8, 0x32, 0x6F, 0x6D, 0xCF, 0x6C,
 +		0xDA, 0x21, 0x70, 0x8C, 0xDA, 0x0A, 0x22, 0x82,
 +		0xAA, 0x59, 0xFA, 0x7C, 0x42, 0x2D, 0x00, 0x00
 +	}
 +};
 +
 +/* NAND header for Parallel NAND 2Gb with 2KB page + 64B spare */
 +static const union nand_boot_header nand_hdr_2gb_2k_64_data = {
 +	.data = {
 +		0x42, 0x4F, 0x4F, 0x54, 0x4C, 0x4F, 0x41, 0x44,
 +		0x45, 0x52, 0x21, 0x00, 0x56, 0x30, 0x30, 0x36,
 +		0x4E, 0x46, 0x49, 0x49, 0x4E, 0x46, 0x4F, 0x00,
 +		0x00, 0x00, 0x00, 0x08, 0x05, 0x00, 0x40, 0x00,
 +		0x40, 0x00, 0x00, 0x08, 0x0B, 0x00, 0x11, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x20, 0x9C, 0x3D, 0x2D,
 +		0x7B, 0x68, 0x63, 0x52, 0x2E, 0x04, 0x63, 0xF1,
 +		0x35, 0x4E, 0x44, 0x3E, 0xF8, 0xAC, 0x9B, 0x95,
 +		0xAB, 0xFE, 0xE4, 0xE1, 0xD5, 0xF9, 0x00, 0x00
 +	}
 +};
 +
 +/* NAND header for Parallel NAND 4Gb with 2KB page + 64B spare */
 +static const union nand_boot_header nand_hdr_4gb_2k_64_data = {
 +	.data = {
 +		0x42, 0x4F, 0x4F, 0x54, 0x4C, 0x4F, 0x41, 0x44,
 +		0x45, 0x52, 0x21, 0x00, 0x56, 0x30, 0x30, 0x36,
 +		0x4E, 0x46, 0x49, 0x49, 0x4E, 0x46, 0x4F, 0x00,
 +		0x00, 0x00, 0x00, 0x08, 0x05, 0x00, 0x40, 0x00,
 +		0x40, 0x00, 0x00, 0x10, 0x0B, 0x00, 0x11, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0xE3, 0x0F, 0x86, 0x32,
 +		0x68, 0x05, 0xD9, 0xC8, 0x13, 0xDF, 0xC5, 0x0B,
 +		0x35, 0x3A, 0x68, 0xA5, 0x3C, 0x0C, 0x73, 0x87,
 +		0x63, 0xB0, 0xBE, 0xCC, 0x84, 0x47, 0x00, 0x00
 +	}
 +};
 +
 +/* NAND header for Parallel NAND 2Gb with 2KB page + 128B spare */
 +static const union nand_boot_header nand_hdr_2gb_2k_128_data = {
 +	.data = {
 +		0x42, 0x4F, 0x4F, 0x54, 0x4C, 0x4F, 0x41, 0x44,
 +		0x45, 0x52, 0x21, 0x00, 0x56, 0x30, 0x30, 0x36,
 +		0x4E, 0x46, 0x49, 0x49, 0x4E, 0x46, 0x4F, 0x00,
 +		0x00, 0x00, 0x00, 0x08, 0x05, 0x00, 0x70, 0x00,
 +		0x40, 0x00, 0x00, 0x08, 0x0B, 0x00, 0x11, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x01, 0xA5, 0xE9, 0x5A,
 +		0xDF, 0x58, 0x62, 0x41, 0xD6, 0x26, 0x77, 0xBC,
 +		0x76, 0x1F, 0x27, 0x4E, 0x4F, 0x6C, 0xC3, 0xF0,
 +		0x36, 0xDE, 0xD9, 0xB3, 0xFF, 0x93, 0x00, 0x00
 +	}
 +};
 +
 +/* NAND header for Parallel NAND 4Gb with 2KB page + 128B spare */
 +static const union nand_boot_header nand_hdr_4gb_2k_128_data = {
 +	.data = {
 +		0x42, 0x4F, 0x4F, 0x54, 0x4C, 0x4F, 0x41, 0x44,
 +		0x45, 0x52, 0x21, 0x00, 0x56, 0x30, 0x30, 0x36,
 +		0x4E, 0x46, 0x49, 0x49, 0x4E, 0x46, 0x4F, 0x00,
 +		0x00, 0x00, 0x00, 0x08, 0x05, 0x00, 0x70, 0x00,
 +		0x40, 0x00, 0x00, 0x10, 0x0B, 0x00, 0x11, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0xC2, 0x36, 0x52, 0x45,
 +		0xCC, 0x35, 0xD8, 0xDB, 0xEB, 0xFD, 0xD1, 0x46,
 +		0x76, 0x6B, 0x0B, 0xD5, 0x8B, 0xCC, 0x2B, 0xE2,
 +		0xFE, 0x90, 0x83, 0x9E, 0xAE, 0x2D, 0x00, 0x00
 +	}
 +};
 +
 +static const struct nand_header_type {
 +	const char *name;
 +	const union nand_boot_header *data;
 +} nand_headers[] = {
 +	{
 +		.name = "2k+64",
 +		.data = &snand_hdr_2k_64_data
 +	}, {
 +		.name = "2k+120",
 +		.data = &snand_hdr_2k_128_data
 +	}, {
 +		.name = "2k+128",
 +		.data = &snand_hdr_2k_128_data
 +	}, {
 +		.name = "4k+256",
 +		.data = &snand_hdr_4k_256_data
 +	}, {
 +		.name = "1g:2k+64",
 +		.data = &nand_hdr_1gb_2k_64_data
 +	}, {
 +		.name = "2g:2k+64",
 +		.data = &nand_hdr_2gb_2k_64_data
 +	}, {
 +		.name = "4g:2k+64",
 +		.data = &nand_hdr_4gb_2k_64_data
 +	}, {
 +		.name = "2g:2k+128",
 +		.data = &nand_hdr_2gb_2k_128_data
 +	}, {
 +		.name = "4g:2k+128",
 +		.data = &nand_hdr_4gb_2k_128_data
 +	}
 +};
 +
 +const union nand_boot_header *mtk_nand_header_find(const char *name)
 +{
 +	uint32_t i;
 +
 +	for (i = 0; i < ARRAY_SIZE(nand_headers); i++) {
 +		if (!strcmp(nand_headers[i].name, name))
 +			return nand_headers[i].data;
 +	}
 +
 +	return NULL;
 +}
 +
 +uint32_t mtk_nand_header_size(const union nand_boot_header *hdr_nand)
 +{
 +	return 2 * le16_to_cpu(hdr_nand->pagesize);
 +}
 +
 +static int mtk_nand_header_ap_info(const void *ptr,
 +				   struct nand_header_info *info)
 +{
 +	union nand_boot_header *nh = (union nand_boot_header *)ptr;
 +
 +	if (strncmp(nh->version, NAND_BOOT_VERSION, sizeof(nh->version)) ||
 +	    strcmp(nh->id, NAND_BOOT_ID))
 +		return -1;
 +
 +	info->page_size = le16_to_cpu(nh->pagesize);
 +	info->spare_size = le16_to_cpu(nh->oobsize);
 +	info->gfh_offset = 2 * info->page_size;
 +
 +	return 0;
 +}
 +
 +int mtk_nand_header_info(const void *ptr, struct nand_header_info *info)
 +{
 +	if (!strcmp((char *)ptr, NAND_BOOT_NAME))
 +		return mtk_nand_header_ap_info(ptr, info);
 +
 +	return -1;
 +}
 +
 +bool is_mtk_nand_header(const void *ptr)
 +{
 +	struct nand_header_info info;
 +
 +	if (mtk_nand_header_info(ptr, &info) >= 0)
 +		return true;
 +
 +	return false;
 +}
 +
 +uint32_t mtk_nand_header_put(const union nand_boot_header *hdr_nand, void *ptr)
 +{
 +	union nand_boot_header *nh = (union nand_boot_header *)ptr;
 +	int i;
 +
 +	/* NAND device header, repeat 4 times */
 +	for (i = 0; i < 4; i++)
 +		memcpy(nh + i, hdr_nand, sizeof(union nand_boot_header));
 +
 +	return le16_to_cpu(hdr_nand->pagesize);
 +}
 --- /dev/null
 +++ b/tools/mtk_nand_headers.h
@@ -0,0 +1,61 @@
 +/* SPDX-License-Identifier: GPL-2.0+ */
 +/*
 + * MediaTek BootROM NAND header definitions
 + *
 + * Copyright (C) 2022 MediaTek Inc.
 + * Author: Weijie Gao <weijie.gao@mediatek.com>
 + */
 +
 +#ifndef _MTK_NAND_HEADERS_H
 +#define _MTK_NAND_HEADERS_H
 +
 +#include <stdint.h>
 +#include <stdbool.h>
 +
 +struct nand_header_info {
 +	uint32_t page_size;
 +	uint32_t spare_size;
 +	uint32_t gfh_offset;
 +};
 +
 +/* AP BROM Header for NAND */
 +union nand_boot_header {
 +	struct {
 +		char name[12];
 +		char version[4];
 +		char id[8];
 +		uint16_t ioif;			/* I/O interface */
 +		uint16_t pagesize;		/* NAND page size */
 +		uint16_t addrcycles;		/* Address cycles */
 +		uint16_t oobsize;		/* NAND page spare size */
 +		uint16_t pages_of_block;	/* Pages of one block */
 +		uint16_t numblocks;		/* Total blocks of NAND chip */
 +		uint16_t writesize_shift;
 +		uint16_t erasesize_shift;
 +		uint8_t dummy[60];
 +		uint8_t ecc_parity[28];		/* ECC parity of this header */
 +	};
 +
 +	uint8_t data[0x80];
 +};
 +
 +#define NAND_BOOT_NAME		"BOOTLOADER!"
 +#define NAND_BOOT_VERSION	"V006"
 +#define NAND_BOOT_ID		"NFIINFO"
 +
 +/* Find nand header data by name */
 +const union nand_boot_header *mtk_nand_header_find(const char *name);
 +
 +/* Device header size using this nand header */
 +uint32_t mtk_nand_header_size(const union nand_boot_header *hdr_nand);
 +
 +/* Get nand info from nand header (page size, spare size, ...) */
 +int mtk_nand_header_info(const void *ptr, struct nand_header_info *info);
 +
 +/* Whether given header data is valid */
 +bool is_mtk_nand_header(const void *ptr);
 +
 +/* Generate Device header using give nand header */
 +uint32_t mtk_nand_header_put(const union nand_boot_header *hdr_nand, void *ptr);
 +
 +#endif /* _MTK_NAND_HEADERS_H */
--- a/package/boot/uboot-mediatek/patches/002-0030-tools-mtk_image-add-support-for-nand-headers-used-by.patch
+++ b/package/boot/uboot-mediatek/patches/002-0030-tools-mtk_image-add-support-for-nand-headers-used-by.patch
@@ -0,0 +1,702 @@
 From fbf296f9ed5daab70020686e9ba072efe663bbab Mon Sep 17 00:00:00 2001
 From: Weijie Gao <weijie.gao@mediatek.com>
 Date: Wed, 3 Aug 2022 11:14:36 +0800
 Subject: [PATCH 30/31] tools: mtk_image: add support for nand headers used by
 newer chips
 This patch adds more nand headers in two new types:
 1. HSM header, used for spi-nand thru SNFI interface
 2. SPIM header, used for spi-nand thru spi-mem interface
 The original nand header is renamed to AP header.
 Signed-off-by: Weijie Gao <weijie.gao@mediatek.com>
 ---
 tools/mtk_image.c        |  23 ++-
 tools/mtk_nand_headers.c | 422 +++++++++++++++++++++++++++++++++++++--
 tools/mtk_nand_headers.h | 110 +++++++++-
 3 files changed, 525 insertions(+), 30 deletions(-)
 --- a/tools/mtk_image.c
 +++ b/tools/mtk_image.c
@@ -33,6 +33,9 @@ static const struct brom_img_type {
 	}, {
 		.name = "snand",
 		.type = BRLYT_TYPE_SNAND
 +	}, {
 +		.name = "spim-nand",
 +		.type = BRLYT_TYPE_SNAND
 	}
 };
@@ -54,7 +57,7 @@ static char lk_name[32] = "U-Boot";
 static uint32_t crc32tbl[256];
 /* NAND header selected by user */
 -static const union nand_boot_header *hdr_nand;
 +static const struct nand_header_type *hdr_nand;
 static uint32_t hdr_nand_size;
 /* GFH header + 2 * 4KB pages of NAND */
@@ -366,20 +369,26 @@ static int mtk_image_verify_nand_header(
 	if (ret < 0)
 		return ret;
 -	bh = (struct brom_layout_header *)(ptr + info.page_size);
 +	if (!ret) {
 +		bh = (struct brom_layout_header *)(ptr + info.page_size);
 -	if (strcmp(bh->name, BRLYT_NAME))
 -		return -1;
 +		if (strcmp(bh->name, BRLYT_NAME))
 +			return -1;
 +
 +		if (le32_to_cpu(bh->magic) != BRLYT_MAGIC)
 +			return -1;
 -	if (le32_to_cpu(bh->magic) != BRLYT_MAGIC) {
 -		return -1;
 -	} else {
 		if (le32_to_cpu(bh->type) == BRLYT_TYPE_NAND)
 			bootmedia = "Parallel NAND";
 		else if (le32_to_cpu(bh->type) == BRLYT_TYPE_SNAND)
 			bootmedia = "Serial NAND (SNFI/AP)";
 		else
 			return -1;
 +	} else {
 +		if (info.snfi)
 +			bootmedia = "Serial NAND (SNFI/HSM)";
 +		else
 +			bootmedia = "Serial NAND (SPIM)";
 	}
 	if (print) {
 --- a/tools/mtk_nand_headers.c
 +++ b/tools/mtk_nand_headers.c
@@ -188,55 +188,346 @@ static const union nand_boot_header nand
 	}
 };
 -static const struct nand_header_type {
 +/* HSM BROM NAND header for SPI NAND with 2KB page + 64B spare */
 +static const union hsm_nand_boot_header hsm_nand_hdr_2k_64_data = {
 +	.data = {
 +		0x4E, 0x41, 0x4E, 0x44, 0x43, 0x46, 0x47, 0x21,
 +		0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x04, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00,
 +		0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x08, 0x00, 0x00, 0x40, 0x00, 0x00, 0x00,
 +		0x40, 0x00, 0x00, 0x00, 0x00, 0x08, 0x00, 0x00,
 +		0x0C, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x01, 0x00, 0x00, 0x00,
 +		0xFF, 0x00, 0x00, 0x00, 0x21, 0xD2, 0xEE, 0xF6,
 +		0xAE, 0xDD, 0x5E, 0xC2, 0x82, 0x8E, 0x9A, 0x62,
 +		0x09, 0x8E, 0x80, 0xE2, 0x37, 0x0D, 0xC9, 0xFA,
 +		0xA9, 0xDD, 0xFC, 0x92, 0x34, 0x2A, 0xED, 0x51,
 +		0xA4, 0x1B, 0xF7, 0x63, 0xCC, 0x5A, 0xC7, 0xFB,
 +		0xED, 0x21, 0x02, 0x23, 0x51, 0x31
 +	}
 +};
 +
 +/* HSM BROM NAND header for SPI NAND with 2KB page + 128B spare */
 +static const union hsm_nand_boot_header hsm_nand_hdr_2k_128_data = {
 +	.data = {
 +		0x4E, 0x41, 0x4E, 0x44, 0x43, 0x46, 0x47, 0x21,
 +		0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x04, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00,
 +		0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x08, 0x00, 0x00, 0x80, 0x00, 0x00, 0x00,
 +		0x40, 0x00, 0x00, 0x00, 0x00, 0x04, 0x00, 0x00,
 +		0x0C, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x01, 0x00, 0x00, 0x00,
 +		0xFF, 0x00, 0x00, 0x00, 0x71, 0x7f, 0x71, 0xAC,
 +		0x42, 0xD0, 0x5B, 0xD2, 0x12, 0x81, 0x15, 0x0A,
 +		0x0C, 0xD4, 0xF6, 0x32, 0x1E, 0x63, 0xE7, 0x81,
 +		0x8A, 0x7F, 0xDE, 0xF9, 0x4B, 0x91, 0xEC, 0xC2,
 +		0x70, 0x00, 0x7F, 0x57, 0xAF, 0xDC, 0xE4, 0x24,
 +		0x57, 0x09, 0xBC, 0xC5, 0x35, 0xDC
 +	}
 +};
 +
 +/* HSM BROM NAND header for SPI NAND with 4KB page + 256B spare */
 +static const union hsm_nand_boot_header hsm_nand_hdr_4k_256_data = {
 +	.data = {
 +		0x4E, 0x41, 0x4E, 0x44, 0x43, 0x46, 0x47, 0x21,
 +		0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x04, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00,
 +		0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x10, 0x00, 0x00, 0x00, 0x01, 0x00, 0x00,
 +		0x40, 0x00, 0x00, 0x00, 0x00, 0x08, 0x00, 0x00,
 +		0x0C, 0x00, 0x00, 0x00, 0x04, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x01, 0x00, 0x00, 0x00,
 +		0xFF, 0x00, 0x00, 0x00, 0x62, 0x04, 0xD6, 0x1F,
 +		0x2B, 0x57, 0x7A, 0x2D, 0xFE, 0xBB, 0x4A, 0x50,
 +		0xEC, 0xF8, 0x70, 0x1A, 0x44, 0x15, 0xF6, 0xA2,
 +		0x8E, 0xB0, 0xFD, 0xFA, 0xDC, 0xAA, 0x5A, 0x4E,
 +		0xCB, 0x8E, 0xC9, 0x72, 0x08, 0xDC, 0x20, 0xB9,
 +		0x98, 0xC8, 0x82, 0xD8, 0xBE, 0x44
 +	}
 +};
 +
 +/* HSM2.0 BROM NAND header for SPI NAND with 2KB page + 64B spare */
 +static const union hsm20_nand_boot_header hsm20_nand_hdr_2k_64_data = {
 +	.data = {
 +		0x4E, 0x41, 0x4E, 0x44, 0x43, 0x46, 0x47, 0x21,
 +		0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0x00,
 +		0x00, 0x04, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00,
 +		0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x08, 0x00, 0x00, 0x40, 0x00, 0x00, 0x00,
 +		0x40, 0x00, 0x00, 0x00, 0x00, 0x08, 0x00, 0x00,
 +		0x0C, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0xFF, 0xFF, 0xFF, 0xFF,
 +		0x01, 0x00, 0x00, 0x00, 0xFF, 0x00, 0x00, 0x00,
 +		0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x5F, 0x4B, 0xB2, 0x5B, 0x8B, 0x1C, 0x35, 0xDA,
 +		0x83, 0xE6, 0x6C, 0xC3, 0xFB, 0x8C, 0x78, 0x23,
 +		0xD0, 0x89, 0x24, 0xD9, 0x6C, 0x35, 0x2C, 0x5D,
 +		0x8F, 0xBB, 0xFC, 0x10, 0xD0, 0xE2, 0x22, 0x7D,
 +		0xC8, 0x97, 0x9A, 0xEF, 0xC6, 0xB5, 0xA7, 0x4E,
 +		0x4E, 0x0E
 +	}
 +};
 +
 +/* HSM2.0 BROM NAND header for SPI NAND with 2KB page + 128B spare */
 +static const union hsm20_nand_boot_header hsm20_nand_hdr_2k_128_data = {
 +	.data = {
 +		0x4E, 0x41, 0x4E, 0x44, 0x43, 0x46, 0x47, 0x21,
 +		0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0x00,
 +		0x00, 0x04, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00,
 +		0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x08, 0x00, 0x00, 0x80, 0x00, 0x00, 0x00,
 +		0x40, 0x00, 0x00, 0x00, 0x00, 0x08, 0x00, 0x00,
 +		0x0C, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0xFF, 0xFF, 0xFF, 0xFF,
 +		0x01, 0x00, 0x00, 0x00, 0xFF, 0x00, 0x00, 0x00,
 +		0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0xF8, 0x7E, 0xC1, 0x5D, 0x61, 0x54, 0xEA, 0x9F,
 +		0x5E, 0x66, 0x39, 0x66, 0x21, 0xFF, 0x8C, 0x3B,
 +		0xBE, 0xA7, 0x5A, 0x9E, 0xD7, 0xBD, 0x9E, 0x89,
 +		0xEE, 0x7E, 0x10, 0x31, 0x9A, 0x1D, 0x82, 0x49,
 +		0xA3, 0x4E, 0xD8, 0x47, 0xD7, 0x19, 0xF4, 0x2D,
 +		0x8E, 0x53
 +	}
 +};
 +
 +/* HSM2.0 BROM NAND header for SPI NAND with 4KB page + 256B spare */
 +static const union hsm20_nand_boot_header hsm20_nand_hdr_4k_256_data = {
 +	.data = {
 +		0x4E, 0x41, 0x4E, 0x44, 0x43, 0x46, 0x47, 0x21,
 +		0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0x00,
 +		0x00, 0x04, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00,
 +		0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x10, 0x00, 0x00, 0x00, 0x01, 0x00, 0x00,
 +		0x40, 0x00, 0x00, 0x00, 0x00, 0x08, 0x00, 0x00,
 +		0x0C, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0xFF, 0xFF, 0xFF, 0xFF,
 +		0x01, 0x00, 0x00, 0x00, 0xFF, 0x00, 0x00, 0x00,
 +		0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x79, 0x01, 0x1F, 0x86, 0x62, 0x6A, 0x43, 0xAE,
 +		0xE6, 0xF8, 0xDD, 0x5B, 0x29, 0xB7, 0xA2, 0x7F,
 +		0x29, 0x72, 0x54, 0x37, 0xBE, 0x50, 0xD4, 0x24,
 +		0xAB, 0x60, 0xF4, 0x44, 0x97, 0x3B, 0x65, 0x21,
 +		0x73, 0x24, 0x1F, 0x93, 0x0E, 0x9E, 0x96, 0x88,
 +		0x78, 0x6C
 +	}
 +};
 +
 +/* SPIM-NAND header for SPI NAND with 2KB page + 64B spare */
 +static const union spim_nand_boot_header spim_nand_hdr_2k_64_data = {
 +	.data = {
 +		0x53, 0x50, 0x49, 0x4e, 0x41, 0x4e, 0x44, 0x21,
 +		0x01, 0x00, 0x00, 0x00, 0x10, 0x00, 0x00, 0x00,
 +		0x00, 0x08, 0x00, 0x00, 0x40, 0x00, 0x00, 0x00,
 +		0x40, 0x00, 0x0c, 0x00, 0x00, 0x00, 0x20, 0x30,
 +		0x01, 0x00, 0x00, 0x00, 0xff, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
 +	}
 +};
 +
 +/* SPIM-NAND header for SPI NAND with 2KB page + 128B spare */
 +static const union spim_nand_boot_header spim_nand_hdr_2k_128_data = {
 +	.data = {
 +		0x53, 0x50, 0x49, 0x4e, 0x41, 0x4e, 0x44, 0x21,
 +		0x01, 0x00, 0x00, 0x00, 0x10, 0x00, 0x00, 0x00,
 +		0x00, 0x08, 0x00, 0x00, 0x80, 0x00, 0x00, 0x00,
 +		0x40, 0x00, 0x0c, 0x00, 0x00, 0x00, 0x20, 0x30,
 +		0x01, 0x00, 0x00, 0x00, 0xff, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
 +	}
 +};
 +
 +/* SPIM-NAND header for SPI NAND with 4KB page + 256B spare */
 +static const union spim_nand_boot_header spim_nand_hdr_4k_256_data = {
 +	.data = {
 +		0x53, 0x50, 0x49, 0x4e, 0x41, 0x4e, 0x44, 0x21,
 +		0x01, 0x00, 0x00, 0x00, 0x10, 0x00, 0x00, 0x00,
 +		0x00, 0x10, 0x00, 0x00, 0x00, 0x01, 0x00, 0x00,
 +		0x40, 0x00, 0x0d, 0x00, 0x00, 0x00, 0x20, 0x30,
 +		0x01, 0x00, 0x00, 0x00, 0xff, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 +		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
 +	}
 +};
 +
 +struct nand_header_type {
 	const char *name;
 -	const union nand_boot_header *data;
 +	enum nand_boot_header_type type;
 +	union {
 +		const union nand_boot_header *ap;
 +		const union hsm_nand_boot_header *hsm;
 +		const union hsm20_nand_boot_header *hsm20;
 +		const union spim_nand_boot_header *spim;
 +	};
 } nand_headers[] = {
 	{
 		.name = "2k+64",
 -		.data = &snand_hdr_2k_64_data
 +		.type = NAND_BOOT_AP_HEADER,
 +		.ap = &snand_hdr_2k_64_data,
 	}, {
 		.name = "2k+120",
 -		.data = &snand_hdr_2k_128_data
 +		.type = NAND_BOOT_AP_HEADER,
 +		.ap = &snand_hdr_2k_128_data,
 	}, {
 		.name = "2k+128",
 -		.data = &snand_hdr_2k_128_data
 +		.type = NAND_BOOT_AP_HEADER,
 +		.ap = &snand_hdr_2k_128_data,
 	}, {
 		.name = "4k+256",
 -		.data = &snand_hdr_4k_256_data
 +		.type = NAND_BOOT_AP_HEADER,
 +		.ap = &snand_hdr_4k_256_data,
 	}, {
 		.name = "1g:2k+64",
 -		.data = &nand_hdr_1gb_2k_64_data
 +		.type = NAND_BOOT_AP_HEADER,
 +		.ap = &nand_hdr_1gb_2k_64_data,
 	}, {
 		.name = "2g:2k+64",
 -		.data = &nand_hdr_2gb_2k_64_data
 +		.type = NAND_BOOT_AP_HEADER,
 +		.ap = &nand_hdr_2gb_2k_64_data,
 	}, {
 		.name = "4g:2k+64",
 -		.data = &nand_hdr_4gb_2k_64_data
 +		.type = NAND_BOOT_AP_HEADER,
 +		.ap = &nand_hdr_4gb_2k_64_data,
 	}, {
 		.name = "2g:2k+128",
 -		.data = &nand_hdr_2gb_2k_128_data
 +		.type = NAND_BOOT_AP_HEADER,
 +		.ap = &nand_hdr_2gb_2k_128_data,
 	}, {
 		.name = "4g:2k+128",
 -		.data = &nand_hdr_4gb_2k_128_data
 +		.type = NAND_BOOT_AP_HEADER,
 +		.ap = &nand_hdr_4gb_2k_128_data,
 +	}, {
 +		.name = "hsm:2k+64",
 +		.type = NAND_BOOT_HSM_HEADER,
 +		.hsm = &hsm_nand_hdr_2k_64_data,
 +	}, {
 +		.name = "hsm:2k+128",
 +		.type = NAND_BOOT_HSM_HEADER,
 +		.hsm = &hsm_nand_hdr_2k_128_data,
 +	}, {
 +		.name = "hsm:4k+256",
 +		.type = NAND_BOOT_HSM_HEADER,
 +		.hsm = &hsm_nand_hdr_4k_256_data,
 +	},  {
 +		.name = "hsm20:2k+64",
 +		.type = NAND_BOOT_HSM20_HEADER,
 +		.hsm20 = &hsm20_nand_hdr_2k_64_data,
 +	}, {
 +		.name = "hsm20:2k+128",
 +		.type = NAND_BOOT_HSM20_HEADER,
 +		.hsm20 = &hsm20_nand_hdr_2k_128_data,
 +	}, {
 +		.name = "hsm20:4k+256",
 +		.type = NAND_BOOT_HSM20_HEADER,
 +		.hsm20 = &hsm20_nand_hdr_4k_256_data,
 +	}, {
 +		.name = "spim:2k+64",
 +		.type = NAND_BOOT_SPIM_HEADER,
 +		.spim = &spim_nand_hdr_2k_64_data,
 +	}, {
 +		.name = "spim:2k+128",
 +		.type = NAND_BOOT_SPIM_HEADER,
 +		.spim = &spim_nand_hdr_2k_128_data,
 +	}, {
 +		.name = "spim:4k+256",
 +		.type = NAND_BOOT_SPIM_HEADER,
 +		.spim = &spim_nand_hdr_4k_256_data,
 	}
 };
 -const union nand_boot_header *mtk_nand_header_find(const char *name)
 +const struct nand_header_type *mtk_nand_header_find(const char *name)
 {
 	uint32_t i;
 	for (i = 0; i < ARRAY_SIZE(nand_headers); i++) {
 		if (!strcmp(nand_headers[i].name, name))
 -			return nand_headers[i].data;
 +			return &nand_headers[i];
 	}
 	return NULL;
 }
 -uint32_t mtk_nand_header_size(const union nand_boot_header *hdr_nand)
 +uint32_t mtk_nand_header_size(const struct nand_header_type *hdr_nand)
 {
 -	return 2 * le16_to_cpu(hdr_nand->pagesize);
 +	switch (hdr_nand->type) {
 +	case NAND_BOOT_HSM_HEADER:
 +		return le32_to_cpu(hdr_nand->hsm->page_size);
 +
 +	case NAND_BOOT_HSM20_HEADER:
 +		return le32_to_cpu(hdr_nand->hsm20->page_size);
 +
 +	case NAND_BOOT_SPIM_HEADER:
 +		return le32_to_cpu(hdr_nand->spim->page_size);
 +
 +	default:
 +		return 2 * le16_to_cpu(hdr_nand->ap->pagesize);
 +	}
 }
 static int mtk_nand_header_ap_info(const void *ptr,
@@ -251,14 +542,45 @@ static int mtk_nand_header_ap_info(const
 	info->page_size = le16_to_cpu(nh->pagesize);
 	info->spare_size = le16_to_cpu(nh->oobsize);
 	info->gfh_offset = 2 * info->page_size;
 +	info->snfi = true;
 	return 0;
 }
 +static int mtk_nand_header_hsm_info(const void *ptr,
 +				    struct nand_header_info *info)
 +{
 +	union hsm_nand_boot_header *nh = (union hsm_nand_boot_header *)ptr;
 +
 +	info->page_size = le16_to_cpu(nh->page_size);
 +	info->spare_size = le16_to_cpu(nh->spare_size);
 +	info->gfh_offset = info->page_size;
 +	info->snfi = true;
 +
 +	return 1;
 +}
 +
 +static int mtk_nand_header_spim_info(const void *ptr,
 +				     struct nand_header_info *info)
 +{
 +	union spim_nand_boot_header *nh = (union spim_nand_boot_header *)ptr;
 +
 +	info->page_size = le16_to_cpu(nh->page_size);
 +	info->spare_size = le16_to_cpu(nh->spare_size);
 +	info->gfh_offset = info->page_size;
 +	info->snfi = false;
 +
 +	return 1;
 +}
 +
 int mtk_nand_header_info(const void *ptr, struct nand_header_info *info)
 {
 	if (!strcmp((char *)ptr, NAND_BOOT_NAME))
 		return mtk_nand_header_ap_info(ptr, info);
 +	else if (!strncmp((char *)ptr, HSM_NAND_BOOT_NAME, 8))
 +		return mtk_nand_header_hsm_info(ptr, info);
 +	else if (!strncmp((char *)ptr, SPIM_NAND_BOOT_NAME, 8))
 +		return mtk_nand_header_spim_info(ptr, info);
 	return -1;
 }
@@ -273,14 +595,74 @@ bool is_mtk_nand_header(const void *ptr)
 	return false;
 }
 -uint32_t mtk_nand_header_put(const union nand_boot_header *hdr_nand, void *ptr)
 +static uint16_t crc16(const uint8_t *p, uint32_t len)
 +{
 +	uint16_t crc = 0x4f4e;
 +	uint32_t i;
 +
 +	while (len--) {
 +		crc ^= *p++ << 8;
 +		for (i = 0; i < 8; i++)
 +			crc = (crc << 1) ^ ((crc & 0x8000) ? 0x8005 : 0);
 +	}
 +
 +	return crc;
 +}
 +
 +static uint32_t mtk_nand_header_put_ap(const struct nand_header_type *hdr_nand,
 +				       void *ptr)
 {
 -	union nand_boot_header *nh = (union nand_boot_header *)ptr;
 	int i;
 	/* NAND device header, repeat 4 times */
 -	for (i = 0; i < 4; i++)
 -		memcpy(nh + i, hdr_nand, sizeof(union nand_boot_header));
 +	for (i = 0; i < 4; i++) {
 +		memcpy(ptr, hdr_nand->ap, sizeof(*hdr_nand->ap));
 +		ptr += sizeof(*hdr_nand->ap);
 +	}
 +
 +	return le16_to_cpu(hdr_nand->ap->pagesize);
 +}
 -	return le16_to_cpu(hdr_nand->pagesize);
 +static uint32_t mtk_nand_header_put_hsm(const struct nand_header_type *hdr_nand,
 +					void *ptr)
 +{
 +	memcpy(ptr, hdr_nand->hsm, sizeof(*hdr_nand->hsm));
 +	return 0;
 +}
 +
 +static uint32_t mtk_nand_header_put_hsm20(const struct nand_header_type *hdr_nand,
 +					  void *ptr)
 +{
 +	memcpy(ptr, hdr_nand->hsm20, sizeof(*hdr_nand->hsm20));
 +	return 0;
 +}
 +
 +static uint32_t mtk_nand_header_put_spim(const struct nand_header_type *hdr_nand,
 +					 void *ptr)
 +{
 +	uint16_t crc;
 +
 +	memcpy(ptr, hdr_nand->spim, sizeof(*hdr_nand->spim));
 +
 +	crc = crc16(ptr, 0x4e);
 +	memcpy(ptr + 0x4e, &crc, sizeof(uint16_t));
 +
 +	return 0;
 +}
 +
 +uint32_t mtk_nand_header_put(const struct nand_header_type *hdr_nand, void *ptr)
 +{
 +	switch (hdr_nand->type) {
 +	case NAND_BOOT_HSM_HEADER:
 +		return mtk_nand_header_put_hsm(hdr_nand, ptr);
 +
 +	case NAND_BOOT_HSM20_HEADER:
 +		return mtk_nand_header_put_hsm20(hdr_nand, ptr);
 +
 +	case NAND_BOOT_SPIM_HEADER:
 +		return mtk_nand_header_put_spim(hdr_nand, ptr);
 +
 +	default:
 +		return mtk_nand_header_put_ap(hdr_nand, ptr);
 +	}
 }
 --- a/tools/mtk_nand_headers.h
 +++ b/tools/mtk_nand_headers.h
@@ -16,6 +16,7 @@ struct nand_header_info {
 	uint32_t page_size;
 	uint32_t spare_size;
 	uint32_t gfh_offset;
 +	bool snfi;
 };
 /* AP BROM Header for NAND */
@@ -39,15 +40,117 @@ union nand_boot_header {
 	uint8_t data[0x80];
 };
 +/* HSM BROM Header for NAND */
 +union hsm_nand_boot_header {
 +	struct {
 +		char id[8];
 +		uint32_t version;		/* Header version */
 +		uint32_t config;		/* Header config */
 +		uint32_t sector_size;		/* ECC step size */
 +		uint32_t fdm_size;		/* User OOB size of a step */
 +		uint32_t fdm_ecc_size;		/* ECC parity size of a step */
 +		uint32_t lbs;
 +		uint32_t page_size;		/* NAND page size */
 +		uint32_t spare_size;		/* NAND page spare size */
 +		uint32_t page_per_block;	/* Pages of one block */
 +		uint32_t blocks;		/* Total blocks of NAND chip */
 +		uint32_t plane_sel_position;	/* Plane bit position */
 +		uint32_t pll;			/* Value of pll reg */
 +		uint32_t acccon;		/* Value of access timing reg */
 +		uint32_t strobe_sel;		/* Value of DQS selection reg*/
 +		uint32_t acccon1;		/* Value of access timing reg */
 +		uint32_t dqs_mux;		/* Value of DQS mux reg */
 +		uint32_t dqs_ctrl;		/* Value of DQS control reg */
 +		uint32_t delay_ctrl;		/* Value of delay ctrl reg */
 +		uint32_t latch_lat;		/* Value of latch latency reg */
 +		uint32_t sample_delay;		/* Value of sample delay reg */
 +		uint32_t driving;		/* Value of driving reg */
 +		uint32_t bl_start;		/* Bootloader start addr */
 +		uint32_t bl_end;		/* Bootloader end addr */
 +		uint8_t ecc_parity[42];		/* ECC parity of this header */
 +	};
 +
 +	uint8_t data[0x8E];
 +};
 +
 +/* HSM2.0 BROM Header for NAND */
 +union hsm20_nand_boot_header {
 +	struct {
 +		char id[8];
 +		uint32_t version;		/* Header version */
 +		uint32_t config;		/* Header config */
 +		uint32_t sector_size;		/* ECC step size */
 +		uint32_t fdm_size;		/* User OOB size of a step */
 +		uint32_t fdm_ecc_size;		/* ECC parity size of a step */
 +		uint32_t lbs;
 +		uint32_t page_size;		/* NAND page size */
 +		uint32_t spare_size;		/* NAND page spare size */
 +		uint32_t page_per_block;	/* Pages of one block */
 +		uint32_t blocks;		/* Total blocks of NAND chip */
 +		uint32_t plane_sel_position;	/* Plane bit position */
 +		uint32_t pll;			/* Value of pll reg */
 +		uint32_t acccon;		/* Value of access timing reg */
 +		uint32_t strobe_sel;		/* Value of DQS selection reg*/
 +		uint32_t acccon1;		/* Value of access timing reg */
 +		uint32_t dqs_mux;		/* Value of DQS mux reg */
 +		uint32_t dqs_ctrl;		/* Value of DQS control reg */
 +		uint32_t delay_ctrl;		/* Value of delay ctrl reg */
 +		uint32_t latch_lat;		/* Value of latch latency reg */
 +		uint32_t sample_delay;		/* Value of sample delay reg */
 +		uint32_t driving;		/* Value of driving reg */
 +		uint32_t reserved;
 +		uint32_t bl0_start;		/* Bootloader start addr */
 +		uint32_t bl0_end;		/* Bootloader end addr */
 +		uint32_t bl0_type;		/* Bootloader type */
 +		uint8_t bl_reserve[84];
 +		uint8_t ecc_parity[42];		/* ECC parity of this header */
 +	};
 +
 +	uint8_t data[0xEA];
 +};
 +
 +/* SPIM BROM Header for SPI-NAND */
 +union spim_nand_boot_header {
 +	struct {
 +		char id[8];
 +		uint32_t version;		/* Header version */
 +		uint32_t config;		/* Header config */
 +		uint32_t page_size;		/* NAND page size */
 +		uint32_t spare_size;		/* NAND page spare size */
 +		uint16_t page_per_block;	/* Pages of one block */
 +		uint16_t plane_sel_position;	/* Plane bit position */
 +		uint16_t reserve_reg;
 +		uint16_t reserve_val;
 +		uint16_t ecc_error;		/* ECC error reg addr */
 +		uint16_t ecc_mask;		/* ECC error bit mask */
 +		uint32_t bl_start;		/* Bootloader start addr */
 +		uint32_t bl_end;		/* Bootloader end addr */
 +		uint8_t ecc_parity[32];		/* ECC parity of this header */
 +		uint32_t integrity_crc;		/* CRC of this header */
 +	};
 +
 +	uint8_t data[0x50];
 +};
 +
 +enum nand_boot_header_type {
 +	NAND_BOOT_AP_HEADER,
 +	NAND_BOOT_HSM_HEADER,
 +	NAND_BOOT_HSM20_HEADER,
 +	NAND_BOOT_SPIM_HEADER
 +};
 +
 #define NAND_BOOT_NAME		"BOOTLOADER!"
 #define NAND_BOOT_VERSION	"V006"
 #define NAND_BOOT_ID		"NFIINFO"
 +#define HSM_NAND_BOOT_NAME	"NANDCFG!"
 +#define SPIM_NAND_BOOT_NAME	"SPINAND!"
 +
 /* Find nand header data by name */
 -const union nand_boot_header *mtk_nand_header_find(const char *name);
 +const struct nand_header_type *mtk_nand_header_find(const char *name);
 /* Device header size using this nand header */
 -uint32_t mtk_nand_header_size(const union nand_boot_header *hdr_nand);
 +uint32_t mtk_nand_header_size(const struct nand_header_type *hdr_nand);
 /* Get nand info from nand header (page size, spare size, ...) */
 int mtk_nand_header_info(const void *ptr, struct nand_header_info *info);
@@ -56,6 +159,7 @@ int mtk_nand_header_info(const void *ptr
 bool is_mtk_nand_header(const void *ptr);
 /* Generate Device header using give nand header */
 -uint32_t mtk_nand_header_put(const union nand_boot_header *hdr_nand, void *ptr);
 +uint32_t mtk_nand_header_put(const struct nand_header_type *hdr_nand,
 +			     void *ptr);
 #endif /* _MTK_NAND_HEADERS_H */
--- a/package/boot/uboot-mediatek/patches/002-0031-MAINTAINERS-update-maintainer-for-MediaTek-ARM-platf.patch
+++ b/package/boot/uboot-mediatek/patches/002-0031-MAINTAINERS-update-maintainer-for-MediaTek-ARM-platf.patch
@@ -0,0 +1,42 @@
 From ca90c165157c19af9bf46a69dcf719b8aab636b1 Mon Sep 17 00:00:00 2001
 From: Weijie Gao <weijie.gao@mediatek.com>
 Date: Thu, 4 Aug 2022 09:50:40 +0800
 Subject: [PATCH 31/31] MAINTAINERS: update maintainer for MediaTek ARM
 platform
 Add new files for MediaTek ARM platform
 Reviewed-by: Simon Glass <sjg@chromium.org>
 Signed-off-by: Weijie Gao <weijie.gao@mediatek.com>
 ---
 MAINTAINERS | 5 +++++
 1 file changed, 5 insertions(+)
 --- a/MAINTAINERS
 +++ b/MAINTAINERS
@@ -340,20 +340,25 @@ F:	doc/device-tree-bindings/phy/phy-mtk-
 F:	doc/device-tree-bindings/usb/mediatek,*
 F:	doc/README.mediatek
 F:	drivers/clk/mediatek/
 +F:	drivers/i2c/mtk_i2c.c
 F:	drivers/mmc/mtk-sd.c
 F:	drivers/phy/phy-mtk-*
 F:	drivers/pinctrl/mediatek/
 F:	drivers/power/domain/mtk-power-domain.c
 F:	drivers/ram/mediatek/
 F:	drivers/spi/mtk_snfi_spi.c
 +F:	drivers/spi/mtk_spim.c
 F:	drivers/timer/mtk_timer.c
 F:	drivers/usb/host/xhci-mtk.c
 F:	drivers/usb/mtu3/
 F:	drivers/watchdog/mtk_wdt.c
 F:	drivers/net/mtk_eth.c
 +F:	drivers/net/mtk_eth.h
 F:	drivers/reset/reset-mediatek.c
 F:	tools/mtk_image.c
 F:	tools/mtk_image.h
 +F:	tools/mtk_nand_headers.c
 +F:	tools/mtk_nand_headers.h
 N:	mediatek
 ARM MICROCHIP/ATMEL AT91
--- a/package/boot/uboot-mediatek/patches/200-cmd-add-imsz-and-imszb.patch
+++ b/package/boot/uboot-mediatek/patches/200-cmd-add-imsz-and-imszb.patch
@@ -1,9 +1,10 @@
 --- a/cmd/bootm.c
 +++ b/cmd/bootm.c
-@@ -257,6 +257,65 @@ U_BOOT_CMD(
+@@ -257,6 +257,67 @@ U_BOOT_CMD(
 /* iminfo - print header info for a requested image */
 /*******************************************************************/
 #if defined(CONFIG_CMD_IMI)
 +#if defined(CONFIG_FIT)
 +#define SECTOR_SHIFT 9
 +static int image_totalsize(struct cmd_tbl *cmdtp, int flag, int argc,
 +			   char *const argv[], short int in_blocks)
@@ -63,6 +64,7 @@
 +	"addr [maxhdrlen] [varname]\n"
 +);
 +
 +#endif
 static int do_iminfo(struct cmd_tbl *cmdtp, int flag, int argc,
 		     char *const argv[])
 {
--- a/package/boot/uboot-mediatek/patches/301-mt7622-generic-reset-button-ignore-env.patch
+++ b/package/boot/uboot-mediatek/patches/301-mt7622-generic-reset-button-ignore-env.patch
@@ -40,8 +40,8 @@
 }
 --- a/arch/arm/mach-mediatek/Kconfig
 +++ b/arch/arm/mach-mediatek/Kconfig
-@@ -115,4 +115,8 @@ config MTK_BROM_HEADER_INFO
+@@ -136,4 +136,8 @@ config MTK_BROM_HEADER_INFO
- 	default "media=emmc" if TARGET_MT8516 || TARGET_MT8365 || TARGET_MT8183
+ 	default "media=snand;nandinfo=2k+64" if TARGET_MT7981 || TARGET_MT7986
 	default "lk=1" if TARGET_MT7623
 +config RESET_BUTTON_LABEL
--- a/package/boot/uboot-mediatek/patches/410-add-linksys-e8450.patch
+++ b/package/boot/uboot-mediatek/patches/410-add-linksys-e8450.patch
@@ -342,7 +342,7 @@
 +	mt7622-linksys-e8450-ubi.dtb \
 	mt7623n-bananapi-bpi-r2.dtb \
 	mt7629-rfb.dtb \
- 	mt8183-pumpkin.dtb \
+ 	mt7981-rfb.dtb \
 --- /dev/null
 +++ b/linksys_e8450_env
@@ -0,0 +1,57 @@
--- a/package/boot/uboot-mediatek/patches/412-add-ubnt-unifi-6-lr.patch
+++ b/package/boot/uboot-mediatek/patches/412-add-ubnt-unifi-6-lr.patch
@@ -342,7 +342,7 @@
 +	mt7622-ubnt-unifi-6-lr.dtb \
 	mt7623n-bananapi-bpi-r2.dtb \
 	mt7629-rfb.dtb \
- 	mt8183-pumpkin.dtb \
+ 	mt7981-rfb.dtb \
 --- /dev/null
 +++ b/ubnt_unifi-6-lr_env
@@ -0,0 +1,50 @@