arch/arm/mach-imx/imx8ulp/soc.c - github/trini/u-boot - Gitiles

 // SPDX-License-Identifier: GPL-2.0+
 /*
  * Copyright 2021 NXP
  */

 #include <asm/io.h>
 #include <asm/arch/clock.h>
 #include <asm/arch/imx-regs.h>
 #include <asm/arch/sys_proto.h>
 #include <asm/armv8/mmu.h>
 #include <asm/mach-imx/boot_mode.h>
 #include <asm/global_data.h>
 #include <efi_loader.h>
 #include <spl.h>
 #include <asm/arch/rdc.h>
 #include <asm/arch/s400_api.h>
 #include <asm/arch/mu_hal.h>
 #include <cpu_func.h>
 #include <asm/setup.h>
 #include <dm.h>
 #include <dm/device-internal.h>
 #include <dm/lists.h>
 #include <dm/uclass.h>
 #include <dm/device.h>
 #include <dm/uclass-internal.h>
 #include <fuse.h>

 DECLARE_GLOBAL_DATA_PTR;

 struct rom_api *g_rom_api = (struct rom_api *)0x1980;

 enum boot_device get_boot_device(void)
 {
 	volatile gd_t *pgd = gd;
 	int ret;
 	u32 boot;
 	u16 boot_type;
 	u8 boot_instance;
 	enum boot_device boot_dev = SD1_BOOT;

 	ret = g_rom_api->query_boot_infor(QUERY_BT_DEV, &boot,
 					  ((uintptr_t)&boot) ^ QUERY_BT_DEV);
 	set_gd(pgd);

 	if (ret != ROM_API_OKAY) {
 		puts("ROMAPI: failure at query_boot_info\n");
 		return -1;
 	}

 	boot_type = boot >> 16;
 	boot_instance = (boot >> 8) & 0xff;

 	switch (boot_type) {
 	case BT_DEV_TYPE_SD:
 		boot_dev = boot_instance + SD1_BOOT;
 		break;
 	case BT_DEV_TYPE_MMC:
 		boot_dev = boot_instance + MMC1_BOOT;
 		break;
 	case BT_DEV_TYPE_NAND:
 		boot_dev = NAND_BOOT;
 		break;
 	case BT_DEV_TYPE_FLEXSPINOR:
 		boot_dev = QSPI_BOOT;
 		break;
 	case BT_DEV_TYPE_USB:
 		boot_dev = USB_BOOT;
 		break;
 	default:
 		break;
 	}

 	return boot_dev;
 }

 bool is_usb_boot(void)
 {
 	return get_boot_device() == USB_BOOT;
 }

 #ifdef CONFIG_ENV_IS_IN_MMC
 __weak int board_mmc_get_env_dev(int devno)
 {
 	return devno;
 }

 int mmc_get_env_dev(void)
 {
 	volatile gd_t *pgd = gd;
 	int ret;
 	u32 boot;
 	u16 boot_type;
 	u8 boot_instance;

 	ret = g_rom_api->query_boot_infor(QUERY_BT_DEV, &boot,
 					  ((uintptr_t)&boot) ^ QUERY_BT_DEV);
 	set_gd(pgd);

 	if (ret != ROM_API_OKAY) {
 		puts("ROMAPI: failure at query_boot_info\n");
 		return CONFIG_SYS_MMC_ENV_DEV;
 	}

 	boot_type = boot >> 16;
 	boot_instance = (boot >> 8) & 0xff;

 	/* If not boot from sd/mmc, use default value */
 	if (boot_type != BOOT_TYPE_SD && boot_type != BOOT_TYPE_MMC)
 		return env_get_ulong("mmcdev", 10, CONFIG_SYS_MMC_ENV_DEV);

 	return board_mmc_get_env_dev(boot_instance);
 }
 #endif

 u32 get_cpu_rev(void)
 {
 	return (MXC_CPU_IMX8ULP << 12) | CHIP_REV_1_0;
 }

 enum bt_mode get_boot_mode(void)
 {
 	u32 bt0_cfg = 0;

 	bt0_cfg = readl(SIM_SEC_BASE_ADDR + 0x24);
 	bt0_cfg &= (BT0CFG_LPBOOT_MASK | BT0CFG_DUALBOOT_MASK);

 	if (!(bt0_cfg & BT0CFG_LPBOOT_MASK)) {
 		/* No low power boot */
 		if (bt0_cfg & BT0CFG_DUALBOOT_MASK)
 			return DUAL_BOOT;
 		else
 			return SINGLE_BOOT;
 	}

 	return LOW_POWER_BOOT;
 }

 #define CMC_SRS_TAMPER                    BIT(31)
 #define CMC_SRS_SECURITY                  BIT(30)
 #define CMC_SRS_TZWDG                     BIT(29)
 #define CMC_SRS_JTAG_RST                  BIT(28)
 #define CMC_SRS_CORE1                     BIT(16)
 #define CMC_SRS_LOCKUP                    BIT(15)
 #define CMC_SRS_SW                        BIT(14)
 #define CMC_SRS_WDG                       BIT(13)
 #define CMC_SRS_PIN_RESET                 BIT(8)
 #define CMC_SRS_WARM                      BIT(4)
 #define CMC_SRS_HVD                       BIT(3)
 #define CMC_SRS_LVD                       BIT(2)
 #define CMC_SRS_POR                       BIT(1)
 #define CMC_SRS_WUP                       BIT(0)

 static char *get_reset_cause(char *ret)
 {
 	u32 cause1, cause = 0, srs = 0;
 	void __iomem *reg_ssrs = (void __iomem *)(CMC1_BASE_ADDR + 0x88);
 	void __iomem *reg_srs = (void __iomem *)(CMC1_BASE_ADDR + 0x80);

 	if (!ret)
 		return "null";

 	srs = readl(reg_srs);
 	cause1 = readl(reg_ssrs);

 	cause = srs & (CMC_SRS_POR | CMC_SRS_WUP | CMC_SRS_WARM);

 	switch (cause) {
 	case CMC_SRS_POR:
 		sprintf(ret, "%s", "POR");
 		break;
 	case CMC_SRS_WUP:
 		sprintf(ret, "%s", "WUP");
 		break;
 	case CMC_SRS_WARM:
 		cause = srs & (CMC_SRS_WDG | CMC_SRS_SW |
 			CMC_SRS_JTAG_RST);
 		switch (cause) {
 		case CMC_SRS_WDG:
 			sprintf(ret, "%s", "WARM-WDG");
 			break;
 		case CMC_SRS_SW:
 			sprintf(ret, "%s", "WARM-SW");
 			break;
 		case CMC_SRS_JTAG_RST:
 			sprintf(ret, "%s", "WARM-JTAG");
 			break;
 		default:
 			sprintf(ret, "%s", "WARM-UNKN");
 			break;
 		}
 		break;
 	default:
 		sprintf(ret, "%s-%X", "UNKN", srs);
 		break;
 	}

 	debug("[%X] SRS[%X] %X - ", cause1, srs, srs ^ cause1);
 	return ret;
 }

 #if defined(CONFIG_DISPLAY_CPUINFO)
 const char *get_imx_type(u32 imxtype)
 {
 	return "8ULP";
 }

 int print_cpuinfo(void)
 {
 	u32 cpurev;
 	char cause[18];

 	cpurev = get_cpu_rev();

 	printf("CPU:   i.MX%s rev%d.%d at %d MHz\n",
 	       get_imx_type((cpurev & 0xFF000) >> 12),
 	       (cpurev & 0x000F0) >> 4, (cpurev & 0x0000F) >> 0,
 	       mxc_get_clock(MXC_ARM_CLK) / 1000000);

 	printf("Reset cause: %s\n", get_reset_cause(cause));

 	printf("Boot mode: ");
 	switch (get_boot_mode()) {
 	case LOW_POWER_BOOT:
 		printf("Low power boot\n");
 		break;
 	case DUAL_BOOT:
 		printf("Dual boot\n");
 		break;
 	case SINGLE_BOOT:
 	default:
 		printf("Single boot\n");
 		break;
 	}

 	return 0;
 }
 #endif

 #define UNLOCK_WORD0 0xC520 /* 1st unlock word */
 #define UNLOCK_WORD1 0xD928 /* 2nd unlock word */
 #define REFRESH_WORD0 0xA602 /* 1st refresh word */
 #define REFRESH_WORD1 0xB480 /* 2nd refresh word */

 static void disable_wdog(void __iomem *wdog_base)
 {
 	u32 val_cs = readl(wdog_base + 0x00);

 	if (!(val_cs & 0x80))
 		return;

 	dmb();
 	__raw_writel(REFRESH_WORD0, (wdog_base + 0x04)); /* Refresh the CNT */
 	__raw_writel(REFRESH_WORD1, (wdog_base + 0x04));
 	dmb();

 	if (!(val_cs & 800)) {
 		dmb();
 		__raw_writel(UNLOCK_WORD0, (wdog_base + 0x04));
 		__raw_writel(UNLOCK_WORD1, (wdog_base + 0x04));
 		dmb();

 		while (!(readl(wdog_base + 0x00) & 0x800))
 			;
 	}
 	writel(0x0, (wdog_base + 0x0C)); /* Set WIN to 0 */
 	writel(0x400, (wdog_base + 0x08)); /* Set timeout to default 0x400 */
 	writel(0x120, (wdog_base + 0x00)); /* Disable it and set update */

 	while (!(readl(wdog_base + 0x00) & 0x400))
 		;
 }

 void init_wdog(void)
 {
 	disable_wdog((void __iomem *)WDG3_RBASE);
 }

 static struct mm_region imx8ulp_arm64_mem_map[] = {
 	{
 		/* ROM */
 		.virt = 0x0,
 		.phys = 0x0,
 		.size = 0x40000UL,
 		.attrs = PTE_BLOCK_MEMTYPE(MT_NORMAL) |
 			 PTE_BLOCK_OUTER_SHARE
 	},
 	{
 		/* FLEXSPI0 */
 		.virt = 0x04000000,
 		.phys = 0x04000000,
 		.size = 0x08000000UL,
 		.attrs = PTE_BLOCK_MEMTYPE(MT_DEVICE_NGNRNE) |
 			 PTE_BLOCK_NON_SHARE |
 			 PTE_BLOCK_PXN | PTE_BLOCK_UXN
 	},
 	{
 		/* SSRAM (align with 2M) */
 		.virt = 0x1FE00000UL,
 		.phys = 0x1FE00000UL,
 		.size = 0x400000UL,
 		.attrs = PTE_BLOCK_MEMTYPE(MT_NORMAL) |
 			 PTE_BLOCK_OUTER_SHARE |
 			 PTE_BLOCK_PXN | PTE_BLOCK_UXN
 	}, {
 		/* SRAM1 (align with 2M) */
 		.virt = 0x21000000UL,
 		.phys = 0x21000000UL,
 		.size = 0x200000UL,
 		.attrs = PTE_BLOCK_MEMTYPE(MT_NORMAL) |
 			 PTE_BLOCK_OUTER_SHARE |
 			 PTE_BLOCK_PXN | PTE_BLOCK_UXN
 	}, {
 		/* SRAM0 (align with 2M) */
 		.virt = 0x22000000UL,
 		.phys = 0x22000000UL,
 		.size = 0x200000UL,
 		.attrs = PTE_BLOCK_MEMTYPE(MT_NORMAL) |
 			 PTE_BLOCK_OUTER_SHARE |
 			 PTE_BLOCK_PXN | PTE_BLOCK_UXN
 	}, {
 		/* Peripherals */
 		.virt = 0x27000000UL,
 		.phys = 0x27000000UL,
 		.size = 0x3000000UL,
 		.attrs = PTE_BLOCK_MEMTYPE(MT_DEVICE_NGNRNE) |
 			 PTE_BLOCK_NON_SHARE |
 			 PTE_BLOCK_PXN | PTE_BLOCK_UXN
 	}, {
 		/* Peripherals */
 		.virt = 0x2D000000UL,
 		.phys = 0x2D000000UL,
 		.size = 0x1600000UL,
 		.attrs = PTE_BLOCK_MEMTYPE(MT_DEVICE_NGNRNE) |
 			 PTE_BLOCK_NON_SHARE |
 			 PTE_BLOCK_PXN | PTE_BLOCK_UXN
 	}, {
 		/* FLEXSPI1-2 */
 		.virt = 0x40000000UL,
 		.phys = 0x40000000UL,
 		.size = 0x40000000UL,
 		.attrs = PTE_BLOCK_MEMTYPE(MT_DEVICE_NGNRNE) |
 			 PTE_BLOCK_NON_SHARE |
 			 PTE_BLOCK_PXN | PTE_BLOCK_UXN
 	}, {
 		/* DRAM1 */
 		.virt = 0x80000000UL,
 		.phys = 0x80000000UL,
 		.size = PHYS_SDRAM_SIZE,
 		.attrs = PTE_BLOCK_MEMTYPE(MT_NORMAL) |
 			 PTE_BLOCK_OUTER_SHARE
 	}, {
 		/*
 		 * empty entrie to split table entry 5
 		 * if needed when TEEs are used
 		 */
 		0,
 	}, {
 		/* List terminator */
 		0,
 	}
 };

 struct mm_region *mem_map = imx8ulp_arm64_mem_map;

 /* simplify the page table size to enhance boot speed */
 #define MAX_PTE_ENTRIES		512
 #define MAX_MEM_MAP_REGIONS	16
 u64 get_page_table_size(void)
 {
 	u64 one_pt = MAX_PTE_ENTRIES * sizeof(u64);
 	u64 size = 0;

 	/*
 	 * For each memory region, the max table size:
 	 * 2 level 3 tables + 2 level 2 tables + 1 level 1 table
 	 */
 	size = (2 + 2 + 1) * one_pt * MAX_MEM_MAP_REGIONS + one_pt;

 	/*
 	 * We need to duplicate our page table once to have an emergency pt to
 	 * resort to when splitting page tables later on
 	 */
 	size *= 2;

 	/*
 	 * We may need to split page tables later on if dcache settings change,
 	 * so reserve up to 4 (random pick) page tables for that.
 	 */
 	size += one_pt * 4;

 	return size;
 }

 void enable_caches(void)
 {
 	/* TODO: add TEE memmap region */

 	icache_enable();
 	dcache_enable();
 }

 int dram_init(void)
 {
 	gd->ram_size = PHYS_SDRAM_SIZE;

 	return 0;
 }

 #ifdef CONFIG_ENV_VARS_UBOOT_RUNTIME_CONFIG
 void get_board_serial(struct tag_serialnr *serialnr)
 {
 	u32 uid[4];
 	u32 res;
 	int ret;

 	ret = ahab_read_common_fuse(1, uid, 4, &res);
 	if (ret)
 		printf("ahab read fuse failed %d, 0x%x\n", ret, res);
 	else
 		printf("UID 0x%x,0x%x,0x%x,0x%x\n", uid[0], uid[1], uid[2], uid[3]);

 	serialnr->low = uid[0];
 	serialnr->high = uid[3];
 }
 #endif

 static void set_core0_reset_vector(u32 entry)
 {
 	/* Update SIM1 DGO8 for reset vector base */
 	writel(entry, SIM1_BASE_ADDR + 0x5c);

 	/* set update bit */
 	setbits_le32(SIM1_BASE_ADDR + 0x8, 0x1 << 24);

 	/* polling the ack */
 	while ((readl(SIM1_BASE_ADDR + 0x8) & (0x1 << 26)) == 0)
 		;

 	/* clear the update */
 	clrbits_le32(SIM1_BASE_ADDR + 0x8, (0x1 << 24));

 	/* clear the ack by set 1 */
 	setbits_le32(SIM1_BASE_ADDR + 0x8, (0x1 << 26));
 }

 static int trdc_set_access(void)
 {
 	/*
 	 * TRDC mgr + 4 MBC + 2 MRC.
 	 * S400 should already configure when release RDC
 	 * A35 only map non-secure region for pbridge0 and 1, set sec_access to false
 	 */
 	trdc_mbc_set_access(2, 7, 0, 49, false);
 	trdc_mbc_set_access(2, 7, 0, 50, false);
 	trdc_mbc_set_access(2, 7, 0, 51, false);
 	trdc_mbc_set_access(2, 7, 0, 52, false);
 	trdc_mbc_set_access(2, 7, 0, 53, false);
 	trdc_mbc_set_access(2, 7, 0, 54, false);

 	/* CGC0: PBridge0 slot 47 */
 	trdc_mbc_set_access(2, 7, 0, 47, false);

 	/* Iomuxc0: : PBridge1 slot 33 */
 	trdc_mbc_set_access(2, 7, 1, 33, false);

 	/* flexspi0 */
 	trdc_mrc_region_set_access(0, 7, 0x04000000, 0x0c000000, false);

 	/* tpm0: PBridge1 slot 21 */
 	trdc_mbc_set_access(2, 7, 1, 21, false);
 	/* lpi2c0: PBridge1 slot 24 */
 	trdc_mbc_set_access(2, 7, 1, 24, false);
 	return 0;
 }

 void lpav_configure(void)
 {
 	/* LPAV to APD */
 	setbits_le32(SIM_SEC_BASE_ADDR + 0x44, BIT(7));

 	/* PXP/GPU 2D/3D/DCNANO/MIPI_DSI/EPDC/HIFI4 to APD */
 	setbits_le32(SIM_SEC_BASE_ADDR + 0x4c, 0x7F);

 	/* LPAV slave/dma2 ch allocation and request allocation to APD */
 	writel(0x1f, SIM_SEC_BASE_ADDR + 0x50);
 	writel(0xffffffff, SIM_SEC_BASE_ADDR + 0x54);
 	writel(0x003fffff, SIM_SEC_BASE_ADDR + 0x58);
 }

 void set_lpav_qos(void)
 {
 	/* Set read QoS of dcnano on LPAV NIC */
 	writel(0xf, 0x2e447100);
 }

 int arch_cpu_init(void)
 {
 	if (IS_ENABLED(CONFIG_SPL_BUILD)) {
 		u32 val = 0;
 		int ret;
 		bool rdc_en = true; /* Default assume DBD_EN is set */

 		/* Disable wdog */
 		init_wdog();

 		/* Read DBD_EN fuse */
 		ret = fuse_read(8, 1, &val);
 		if (!ret)
 			rdc_en = !!(val & 0x4000);

 		if (get_boot_mode() == SINGLE_BOOT) {
 			if (rdc_en)
 				release_rdc(RDC_TRDC);

 			trdc_set_access();

 			lpav_configure();
 		}

 		/* Release xrdc, then allow A35 to write SRAM2 */
 		if (rdc_en)
 			release_rdc(RDC_XRDC);

 		xrdc_mrc_region_set_access(2, CONFIG_SPL_TEXT_BASE, 0xE00);

 		clock_init();
 	} else {
 		/* reconfigure core0 reset vector to ROM */
 		set_core0_reset_vector(0x1000);
 	}

 	return 0;
 }

 int arch_cpu_init_dm(void)
 {
 	struct udevice *devp;
 	int node, ret;

 	node = fdt_node_offset_by_compatible(gd->fdt_blob, -1, "fsl,imx8ulp-mu");

 	ret = uclass_get_device_by_of_offset(UCLASS_MISC, node, &devp);
 	if (ret) {
 		printf("could not get S400 mu %d\n", ret);
 		return ret;
 	}

 	return 0;
 }

 #if defined(CONFIG_SPL_BUILD)
 __weak void __noreturn jump_to_image_no_args(struct spl_image_info *spl_image)
 {
 	debug("image entry point: 0x%lx\n", spl_image->entry_point);

 	set_core0_reset_vector((u32)spl_image->entry_point);

 	/* Enable the 512KB cache */
 	setbits_le32(SIM1_BASE_ADDR + 0x30, (0x1 << 4));

 	/* reset core */
 	setbits_le32(SIM1_BASE_ADDR + 0x30, (0x1 << 16));

 	while (1)
 		;
 }
 #endif

 void imx_get_mac_from_fuse(int dev_id, unsigned char *mac)
 {
 	memset(mac, 0, 6);
 }

 int (*card_emmc_is_boot_part_en)(void) = (void *)0x67cc;
 u32 spl_arch_boot_image_offset(u32 image_offset, u32 rom_bt_dev)
 {
 	/* Hard code for eMMC image_offset on 8ULP ROM, need fix by ROM, temp workaround */
 	if (((rom_bt_dev >> 16) & 0xff) == BT_DEV_TYPE_MMC && card_emmc_is_boot_part_en())
 		image_offset = 0;

 	return image_offset;
 }
	// SPDX-License-Identifier: GPL-2.0+
	/*
	* Copyright 2021 NXP
	*/

	#include <asm/io.h>
	#include <asm/arch/clock.h>
	#include <asm/arch/imx-regs.h>
	#include <asm/arch/sys_proto.h>
	#include <asm/armv8/mmu.h>
	#include <asm/mach-imx/boot_mode.h>
	#include <asm/global_data.h>
	#include <efi_loader.h>
	#include <spl.h>
	#include <asm/arch/rdc.h>
	#include <asm/arch/s400_api.h>
	#include <asm/arch/mu_hal.h>
	#include <cpu_func.h>
	#include <asm/setup.h>
	#include <dm.h>
	#include <dm/device-internal.h>
	#include <dm/lists.h>
	#include <dm/uclass.h>
	#include <dm/device.h>
	#include <dm/uclass-internal.h>
	#include <fuse.h>

	DECLARE_GLOBAL_DATA_PTR;

	struct rom_api g_rom_api = (struct rom_api )0x1980;

	enum boot_device get_boot_device(void)
	{
	volatile gd_t *pgd = gd;
	int ret;
	u32 boot;
	u16 boot_type;
	u8 boot_instance;
	enum boot_device boot_dev = SD1_BOOT;

	ret = g_rom_api->query_boot_infor(QUERY_BT_DEV, &boot,
	((uintptr_t)&boot) ^ QUERY_BT_DEV);
	set_gd(pgd);

	if (ret != ROM_API_OKAY) {
	puts("ROMAPI: failure at query_boot_info\n");
	return -1;
	}

	boot_type = boot >> 16;
	boot_instance = (boot >> 8) & 0xff;

	switch (boot_type) {
	case BT_DEV_TYPE_SD:
	boot_dev = boot_instance + SD1_BOOT;
	break;
	case BT_DEV_TYPE_MMC:
	boot_dev = boot_instance + MMC1_BOOT;
	break;
	case BT_DEV_TYPE_NAND:
	boot_dev = NAND_BOOT;
	break;
	case BT_DEV_TYPE_FLEXSPINOR:
	boot_dev = QSPI_BOOT;
	break;
	case BT_DEV_TYPE_USB:
	boot_dev = USB_BOOT;
	break;
	default:
	break;
	}

	return boot_dev;
	}

	bool is_usb_boot(void)
	{
	return get_boot_device() == USB_BOOT;
	}

	#ifdef CONFIG_ENV_IS_IN_MMC
	__weak int board_mmc_get_env_dev(int devno)
	{
	return devno;
	}

	int mmc_get_env_dev(void)
	{
	volatile gd_t *pgd = gd;
	int ret;
	u32 boot;
	u16 boot_type;
	u8 boot_instance;

	ret = g_rom_api->query_boot_infor(QUERY_BT_DEV, &boot,
	((uintptr_t)&boot) ^ QUERY_BT_DEV);
	set_gd(pgd);

	if (ret != ROM_API_OKAY) {
	puts("ROMAPI: failure at query_boot_info\n");
	return CONFIG_SYS_MMC_ENV_DEV;
	}

	boot_type = boot >> 16;
	boot_instance = (boot >> 8) & 0xff;

	/* If not boot from sd/mmc, use default value */
	if (boot_type != BOOT_TYPE_SD && boot_type != BOOT_TYPE_MMC)
	return env_get_ulong("mmcdev", 10, CONFIG_SYS_MMC_ENV_DEV);

	return board_mmc_get_env_dev(boot_instance);
	}
	#endif

	u32 get_cpu_rev(void)
	{
	return (MXC_CPU_IMX8ULP << 12) \| CHIP_REV_1_0;
	}

	enum bt_mode get_boot_mode(void)
	{
	u32 bt0_cfg = 0;

	bt0_cfg = readl(SIM_SEC_BASE_ADDR + 0x24);
	bt0_cfg &= (BT0CFG_LPBOOT_MASK \| BT0CFG_DUALBOOT_MASK);

	if (!(bt0_cfg & BT0CFG_LPBOOT_MASK)) {
	/* No low power boot */
	if (bt0_cfg & BT0CFG_DUALBOOT_MASK)
	return DUAL_BOOT;
	else
	return SINGLE_BOOT;
	}

	return LOW_POWER_BOOT;
	}

	#define CMC_SRS_TAMPER BIT(31)
	#define CMC_SRS_SECURITY BIT(30)
	#define CMC_SRS_TZWDG BIT(29)
	#define CMC_SRS_JTAG_RST BIT(28)
	#define CMC_SRS_CORE1 BIT(16)
	#define CMC_SRS_LOCKUP BIT(15)
	#define CMC_SRS_SW BIT(14)
	#define CMC_SRS_WDG BIT(13)
	#define CMC_SRS_PIN_RESET BIT(8)
	#define CMC_SRS_WARM BIT(4)
	#define CMC_SRS_HVD BIT(3)
	#define CMC_SRS_LVD BIT(2)
	#define CMC_SRS_POR BIT(1)
	#define CMC_SRS_WUP BIT(0)

	static char get_reset_cause(char ret)
	{
	u32 cause1, cause = 0, srs = 0;
	void __iomem reg_ssrs = (void __iomem )(CMC1_BASE_ADDR + 0x88);
	void __iomem reg_srs = (void __iomem )(CMC1_BASE_ADDR + 0x80);

	if (!ret)
	return "null";

	srs = readl(reg_srs);
	cause1 = readl(reg_ssrs);

	cause = srs & (CMC_SRS_POR \| CMC_SRS_WUP \| CMC_SRS_WARM);

	switch (cause) {
	case CMC_SRS_POR:
	sprintf(ret, "%s", "POR");
	break;
	case CMC_SRS_WUP:
	sprintf(ret, "%s", "WUP");
	break;
	case CMC_SRS_WARM:
	cause = srs & (CMC_SRS_WDG \| CMC_SRS_SW \|
	CMC_SRS_JTAG_RST);
	switch (cause) {
	case CMC_SRS_WDG:
	sprintf(ret, "%s", "WARM-WDG");
	break;
	case CMC_SRS_SW:
	sprintf(ret, "%s", "WARM-SW");
	break;
	case CMC_SRS_JTAG_RST:
	sprintf(ret, "%s", "WARM-JTAG");
	break;
	default:
	sprintf(ret, "%s", "WARM-UNKN");
	break;
	}
	break;
	default:
	sprintf(ret, "%s-%X", "UNKN", srs);
	break;
	}

	debug("[%X] SRS[%X] %X - ", cause1, srs, srs ^ cause1);
	return ret;
	}

	#if defined(CONFIG_DISPLAY_CPUINFO)
	const char *get_imx_type(u32 imxtype)
	{
	return "8ULP";
	}

	int print_cpuinfo(void)
	{
	u32 cpurev;
	char cause[18];

	cpurev = get_cpu_rev();

	printf("CPU: i.MX%s rev%d.%d at %d MHz\n",
	get_imx_type((cpurev & 0xFF000) >> 12),
	(cpurev & 0x000F0) >> 4, (cpurev & 0x0000F) >> 0,
	mxc_get_clock(MXC_ARM_CLK) / 1000000);

	printf("Reset cause: %s\n", get_reset_cause(cause));

	printf("Boot mode: ");
	switch (get_boot_mode()) {
	case LOW_POWER_BOOT:
	printf("Low power boot\n");
	break;
	case DUAL_BOOT:
	printf("Dual boot\n");
	break;
	case SINGLE_BOOT:
	default:
	printf("Single boot\n");
	break;
	}

	return 0;
	}
	#endif

	#define UNLOCK_WORD0 0xC520 /* 1st unlock word */
	#define UNLOCK_WORD1 0xD928 /* 2nd unlock word */
	#define REFRESH_WORD0 0xA602 /* 1st refresh word */
	#define REFRESH_WORD1 0xB480 /* 2nd refresh word */

	static void disable_wdog(void __iomem *wdog_base)
	{
	u32 val_cs = readl(wdog_base + 0x00);

	if (!(val_cs & 0x80))
	return;

	dmb();
	__raw_writel(REFRESH_WORD0, (wdog_base + 0x04)); /* Refresh the CNT */
	__raw_writel(REFRESH_WORD1, (wdog_base + 0x04));
	dmb();

	if (!(val_cs & 800)) {
	dmb();
	__raw_writel(UNLOCK_WORD0, (wdog_base + 0x04));
	__raw_writel(UNLOCK_WORD1, (wdog_base + 0x04));
	dmb();

	while (!(readl(wdog_base + 0x00) & 0x800))
	;
	}
	writel(0x0, (wdog_base + 0x0C)); /* Set WIN to 0 */
	writel(0x400, (wdog_base + 0x08)); /* Set timeout to default 0x400 */
	writel(0x120, (wdog_base + 0x00)); /* Disable it and set update */

	while (!(readl(wdog_base + 0x00) & 0x400))
	;
	}

	void init_wdog(void)
	{
	disable_wdog((void __iomem *)WDG3_RBASE);
	}

	static struct mm_region imx8ulp_arm64_mem_map[] = {
	{
	/* ROM */
	.virt = 0x0,
	.phys = 0x0,
	.size = 0x40000UL,
	.attrs = PTE_BLOCK_MEMTYPE(MT_NORMAL) \|
	PTE_BLOCK_OUTER_SHARE
	},
	{
	/* FLEXSPI0 */
	.virt = 0x04000000,
	.phys = 0x04000000,
	.size = 0x08000000UL,
	.attrs = PTE_BLOCK_MEMTYPE(MT_DEVICE_NGNRNE) \|
	PTE_BLOCK_NON_SHARE \|
	PTE_BLOCK_PXN \| PTE_BLOCK_UXN
	},
	{
	/* SSRAM (align with 2M) */
	.virt = 0x1FE00000UL,
	.phys = 0x1FE00000UL,
	.size = 0x400000UL,
	.attrs = PTE_BLOCK_MEMTYPE(MT_NORMAL) \|
	PTE_BLOCK_OUTER_SHARE \|
	PTE_BLOCK_PXN \| PTE_BLOCK_UXN
	}, {
	/* SRAM1 (align with 2M) */
	.virt = 0x21000000UL,
	.phys = 0x21000000UL,
	.size = 0x200000UL,
	.attrs = PTE_BLOCK_MEMTYPE(MT_NORMAL) \|
	PTE_BLOCK_OUTER_SHARE \|
	PTE_BLOCK_PXN \| PTE_BLOCK_UXN
	}, {
	/* SRAM0 (align with 2M) */
	.virt = 0x22000000UL,
	.phys = 0x22000000UL,
	.size = 0x200000UL,
	.attrs = PTE_BLOCK_MEMTYPE(MT_NORMAL) \|
	PTE_BLOCK_OUTER_SHARE \|
	PTE_BLOCK_PXN \| PTE_BLOCK_UXN
	}, {
	/* Peripherals */
	.virt = 0x27000000UL,
	.phys = 0x27000000UL,
	.size = 0x3000000UL,
	.attrs = PTE_BLOCK_MEMTYPE(MT_DEVICE_NGNRNE) \|
	PTE_BLOCK_NON_SHARE \|
	PTE_BLOCK_PXN \| PTE_BLOCK_UXN
	}, {
	/* Peripherals */
	.virt = 0x2D000000UL,
	.phys = 0x2D000000UL,
	.size = 0x1600000UL,
	.attrs = PTE_BLOCK_MEMTYPE(MT_DEVICE_NGNRNE) \|
	PTE_BLOCK_NON_SHARE \|
	PTE_BLOCK_PXN \| PTE_BLOCK_UXN
	}, {
	/* FLEXSPI1-2 */
	.virt = 0x40000000UL,
	.phys = 0x40000000UL,
	.size = 0x40000000UL,
	.attrs = PTE_BLOCK_MEMTYPE(MT_DEVICE_NGNRNE) \|
	PTE_BLOCK_NON_SHARE \|
	PTE_BLOCK_PXN \| PTE_BLOCK_UXN
	}, {
	/* DRAM1 */
	.virt = 0x80000000UL,
	.phys = 0x80000000UL,
	.size = PHYS_SDRAM_SIZE,
	.attrs = PTE_BLOCK_MEMTYPE(MT_NORMAL) \|
	PTE_BLOCK_OUTER_SHARE
	}, {
	/*
	* empty entrie to split table entry 5
	* if needed when TEEs are used
	*/
	0,
	}, {
	/* List terminator */
	0,
	}
	};

	struct mm_region *mem_map = imx8ulp_arm64_mem_map;

	/* simplify the page table size to enhance boot speed */
	#define MAX_PTE_ENTRIES 512
	#define MAX_MEM_MAP_REGIONS 16
	u64 get_page_table_size(void)
	{
	u64 one_pt = MAX_PTE_ENTRIES * sizeof(u64);
	u64 size = 0;

	/*
	* For each memory region, the max table size:
	* 2 level 3 tables + 2 level 2 tables + 1 level 1 table
	*/
	size = (2 + 2 + 1) * one_pt * MAX_MEM_MAP_REGIONS + one_pt;

	/*
	* We need to duplicate our page table once to have an emergency pt to
	* resort to when splitting page tables later on
	*/
	size *= 2;

	/*
	* We may need to split page tables later on if dcache settings change,
	* so reserve up to 4 (random pick) page tables for that.
	*/
	size += one_pt * 4;

	return size;
	}

	void enable_caches(void)
	{
	/* TODO: add TEE memmap region */

	icache_enable();
	dcache_enable();
	}

	int dram_init(void)
	{
	gd->ram_size = PHYS_SDRAM_SIZE;

	return 0;
	}

	#ifdef CONFIG_ENV_VARS_UBOOT_RUNTIME_CONFIG
	void get_board_serial(struct tag_serialnr *serialnr)
	{
	u32 uid[4];
	u32 res;
	int ret;

	ret = ahab_read_common_fuse(1, uid, 4, &res);
	if (ret)
	printf("ahab read fuse failed %d, 0x%x\n", ret, res);
	else
	printf("UID 0x%x,0x%x,0x%x,0x%x\n", uid[0], uid[1], uid[2], uid[3]);

	serialnr->low = uid[0];
	serialnr->high = uid[3];
	}
	#endif

	static void set_core0_reset_vector(u32 entry)
	{
	/* Update SIM1 DGO8 for reset vector base */
	writel(entry, SIM1_BASE_ADDR + 0x5c);

	/* set update bit */
	setbits_le32(SIM1_BASE_ADDR + 0x8, 0x1 << 24);

	/* polling the ack */
	while ((readl(SIM1_BASE_ADDR + 0x8) & (0x1 << 26)) == 0)
	;

	/* clear the update */
	clrbits_le32(SIM1_BASE_ADDR + 0x8, (0x1 << 24));

	/* clear the ack by set 1 */
	setbits_le32(SIM1_BASE_ADDR + 0x8, (0x1 << 26));
	}

	static int trdc_set_access(void)
	{
	/*
	* TRDC mgr + 4 MBC + 2 MRC.
	* S400 should already configure when release RDC
	* A35 only map non-secure region for pbridge0 and 1, set sec_access to false
	*/
	trdc_mbc_set_access(2, 7, 0, 49, false);
	trdc_mbc_set_access(2, 7, 0, 50, false);
	trdc_mbc_set_access(2, 7, 0, 51, false);
	trdc_mbc_set_access(2, 7, 0, 52, false);
	trdc_mbc_set_access(2, 7, 0, 53, false);
	trdc_mbc_set_access(2, 7, 0, 54, false);

	/* CGC0: PBridge0 slot 47 */
	trdc_mbc_set_access(2, 7, 0, 47, false);

	/* Iomuxc0: : PBridge1 slot 33 */
	trdc_mbc_set_access(2, 7, 1, 33, false);

	/* flexspi0 */
	trdc_mrc_region_set_access(0, 7, 0x04000000, 0x0c000000, false);

	/* tpm0: PBridge1 slot 21 */
	trdc_mbc_set_access(2, 7, 1, 21, false);
	/* lpi2c0: PBridge1 slot 24 */
	trdc_mbc_set_access(2, 7, 1, 24, false);
	return 0;
	}

	void lpav_configure(void)
	{
	/* LPAV to APD */
	setbits_le32(SIM_SEC_BASE_ADDR + 0x44, BIT(7));

	/* PXP/GPU 2D/3D/DCNANO/MIPI_DSI/EPDC/HIFI4 to APD */
	setbits_le32(SIM_SEC_BASE_ADDR + 0x4c, 0x7F);

	/* LPAV slave/dma2 ch allocation and request allocation to APD */
	writel(0x1f, SIM_SEC_BASE_ADDR + 0x50);
	writel(0xffffffff, SIM_SEC_BASE_ADDR + 0x54);
	writel(0x003fffff, SIM_SEC_BASE_ADDR + 0x58);
	}

	void set_lpav_qos(void)
	{
	/* Set read QoS of dcnano on LPAV NIC */
	writel(0xf, 0x2e447100);
	}

	int arch_cpu_init(void)
	{
	if (IS_ENABLED(CONFIG_SPL_BUILD)) {
	u32 val = 0;
	int ret;
	bool rdc_en = true; /* Default assume DBD_EN is set */

	/* Disable wdog */
	init_wdog();

	/* Read DBD_EN fuse */
	ret = fuse_read(8, 1, &val);
	if (!ret)
	rdc_en = !!(val & 0x4000);

	if (get_boot_mode() == SINGLE_BOOT) {
	if (rdc_en)
	release_rdc(RDC_TRDC);

	trdc_set_access();

	lpav_configure();
	}

	/* Release xrdc, then allow A35 to write SRAM2 */
	if (rdc_en)
	release_rdc(RDC_XRDC);

	xrdc_mrc_region_set_access(2, CONFIG_SPL_TEXT_BASE, 0xE00);

	clock_init();
	} else {
	/* reconfigure core0 reset vector to ROM */
	set_core0_reset_vector(0x1000);
	}

	return 0;
	}

	int arch_cpu_init_dm(void)
	{
	struct udevice *devp;
	int node, ret;

	node = fdt_node_offset_by_compatible(gd->fdt_blob, -1, "fsl,imx8ulp-mu");

	ret = uclass_get_device_by_of_offset(UCLASS_MISC, node, &devp);
	if (ret) {
	printf("could not get S400 mu %d\n", ret);
	return ret;
	}

	return 0;
	}

	#if defined(CONFIG_SPL_BUILD)
	__weak void __noreturn jump_to_image_no_args(struct spl_image_info *spl_image)
	{
	debug("image entry point: 0x%lx\n", spl_image->entry_point);

	set_core0_reset_vector((u32)spl_image->entry_point);

	/* Enable the 512KB cache */
	setbits_le32(SIM1_BASE_ADDR + 0x30, (0x1 << 4));

	/* reset core */
	setbits_le32(SIM1_BASE_ADDR + 0x30, (0x1 << 16));

	while (1)
	;
	}
	#endif

	void imx_get_mac_from_fuse(int dev_id, unsigned char *mac)
	{
	memset(mac, 0, 6);
	}

	int (card_emmc_is_boot_part_en)(void) = (void )0x67cc;
	u32 spl_arch_boot_image_offset(u32 image_offset, u32 rom_bt_dev)
	{
	/* Hard code for eMMC image_offset on 8ULP ROM, need fix by ROM, temp workaround */
	if (((rom_bt_dev >> 16) & 0xff) == BT_DEV_TYPE_MMC && card_emmc_is_boot_part_en())
	image_offset = 0;

	return image_offset;
	}