arch/arm/mach-k3/am625_init.c - filogic/uboot - Gitiles

 // SPDX-License-Identifier: GPL-2.0
 /*
  * AM625: SoC specific initialization
  *
  * Copyright (C) 2020-2022 Texas Instruments Incorporated - https://www.ti.com/
  *	Suman Anna <s-anna@ti.com>
  */

 #include <spl.h>
 #include <asm/io.h>
 #include <asm/arch/hardware.h>
 #include "sysfw-loader.h"
 #include "common.h"
 #include <dm.h>
 #include <dm/uclass-internal.h>
 #include <dm/pinctrl.h>
 #include <dm/ofnode.h>

 #define RTC_BASE_ADDRESS		0x2b1f0000
 #define REG_K3RTC_S_CNT_LSW		(RTC_BASE_ADDRESS + 0x18)
 #define REG_K3RTC_KICK0			(RTC_BASE_ADDRESS + 0x70)
 #define REG_K3RTC_KICK1			(RTC_BASE_ADDRESS + 0x74)

 /* Magic values for lock/unlock */
 #define K3RTC_KICK0_UNLOCK_VALUE	0x83e70b13
 #define K3RTC_KICK1_UNLOCK_VALUE	0x95a4f1e0

 /* TISCI DEV ID for A53 Clock */
 #define AM62X_DEV_A53SS0_CORE_0_DEV_ID 135

 /*
  * This uninitialized global variable would normal end up in the .bss section,
  * but the .bss is cleared between writing and reading this variable, so move
  * it to the .data section.
  */
 u32 bootindex __section(".data");
 static struct rom_extended_boot_data bootdata __section(".data");

 static void store_boot_info_from_rom(void)
 {
 	bootindex = *(u32 *)(CONFIG_SYS_K3_BOOT_PARAM_TABLE_INDEX);
 	memcpy(&bootdata, (uintptr_t *)ROM_EXTENDED_BOOT_DATA_INFO,
 	       sizeof(struct rom_extended_boot_data));
 }

 static void ctrl_mmr_unlock(void)
 {
 	/* Unlock all WKUP_CTRL_MMR0 module registers */
 	mmr_unlock(WKUP_CTRL_MMR0_BASE, 0);
 	mmr_unlock(WKUP_CTRL_MMR0_BASE, 1);
 	mmr_unlock(WKUP_CTRL_MMR0_BASE, 2);
 	mmr_unlock(WKUP_CTRL_MMR0_BASE, 3);
 	mmr_unlock(WKUP_CTRL_MMR0_BASE, 4);
 	mmr_unlock(WKUP_CTRL_MMR0_BASE, 5);
 	mmr_unlock(WKUP_CTRL_MMR0_BASE, 6);
 	mmr_unlock(WKUP_CTRL_MMR0_BASE, 7);

 	/* Unlock all CTRL_MMR0 module registers */
 	mmr_unlock(CTRL_MMR0_BASE, 0);
 	mmr_unlock(CTRL_MMR0_BASE, 1);
 	mmr_unlock(CTRL_MMR0_BASE, 2);
 	mmr_unlock(CTRL_MMR0_BASE, 4);
 	mmr_unlock(CTRL_MMR0_BASE, 6);

 	/* Unlock all MCU_CTRL_MMR0 module registers */
 	mmr_unlock(MCU_CTRL_MMR0_BASE, 0);
 	mmr_unlock(MCU_CTRL_MMR0_BASE, 1);
 	mmr_unlock(MCU_CTRL_MMR0_BASE, 2);
 	mmr_unlock(MCU_CTRL_MMR0_BASE, 3);
 	mmr_unlock(MCU_CTRL_MMR0_BASE, 4);
 	mmr_unlock(MCU_CTRL_MMR0_BASE, 6);

 	/* Unlock PADCFG_CTRL_MMR padconf registers */
 	mmr_unlock(PADCFG_MMR0_BASE, 1);
 	mmr_unlock(PADCFG_MMR1_BASE, 1);
 }

 static __maybe_unused void enable_mcu_esm_reset(void)
 {
 	/* Set CTRLMMR_MCU_RST_CTRL:MCU_ESM_ERROR_RST_EN_Z  to '0' (low active) */
 	u32 stat = readl(CTRLMMR_MCU_RST_CTRL);

 	stat &= RST_CTRL_ESM_ERROR_RST_EN_Z_MASK;
 	writel(stat, CTRLMMR_MCU_RST_CTRL);
 }

 /*
  * RTC Erratum i2327 Workaround for Silicon Revision 1
  *
  * Due to a bug in initial synchronization out of cold power on,
  * IRQ status can get locked infinitely if we do not unlock RTC
  *
  * This workaround *must* be applied within 1 second of power on,
  * So, this is closest point to be able to guarantee the max
  * timing.
  *
  * https://www.ti.com/lit/er/sprz487c/sprz487c.pdf
  */
 static __maybe_unused void rtc_erratumi2327_init(void)
 {
 	u32 counter;

 	/*
 	 * If counter has gone past 1, nothing we can do, leave
 	 * system locked! This is the only way we know if RTC
 	 * can be used for all practical purposes.
 	 */
 	counter = readl(REG_K3RTC_S_CNT_LSW);
 	if (counter > 1)
 		return;
 	/*
 	 * Need to set this up at the very start
 	 * MUST BE DONE under 1 second of boot.
 	 */
 	writel(K3RTC_KICK0_UNLOCK_VALUE, REG_K3RTC_KICK0);
 	writel(K3RTC_KICK1_UNLOCK_VALUE, REG_K3RTC_KICK1);
 }

 #if CONFIG_IS_ENABLED(OF_CONTROL)
 static int get_a53_cpu_clock_index(ofnode node)
 {
 	int count, i;
 	struct ofnode_phandle_args *args;
 	ofnode clknode;

 	clknode = ofnode_path("/bus@f0000/system-controller@44043000/clock-controller");
 	if (!ofnode_valid(clknode))
 		return -1;

 	count = ofnode_count_phandle_with_args(node,  "assigned-clocks", "#clock-cells", 0);

 	for (i  = 0; i < count; i++) {
 		if (!ofnode_parse_phandle_with_args(node, "assigned-clocks",
 						    "#clock-cells", 0, i, args)) {
 			if (ofnode_equal(clknode, args->node) &&
 			    args->args[0] == AM62X_DEV_A53SS0_CORE_0_DEV_ID)
 				return i;
 		}
 	}

 	return -1;
 }

 static void fixup_a53_cpu_freq_by_speed_grade(void)
 {
 	int index, size;
 	u32 *rates;
 	ofnode node;

 	node =  ofnode_path("/a53@0");
 	if (!ofnode_valid(node))
 		return;

 	rates = fdt_getprop_w(ofnode_to_fdt(node), ofnode_to_offset(node),
 			      "assigned-clock-rates", &size);

 	index = get_a53_cpu_clock_index(node);

 	if (!rates || index < 0 || index >= (size / sizeof(u32))) {
 		printf("Wrong A53 assigned-clocks configuration\n");
 		return;
 	}

 	rates[index] = cpu_to_fdt32(k3_get_a53_max_frequency());

 	printf("Changed A53 CPU frequency to %dHz (%c grade) in DT\n",
 	       k3_get_a53_max_frequency(), k3_get_speed_grade());
 }
 #else
 static void fixup_a53_cpu_freq_by_speed_grade(void)
 {
 }
 #endif

 void board_init_f(ulong dummy)
 {
 	struct udevice *dev;
 	int ret;

 	if (IS_ENABLED(CONFIG_CPU_V7R)) {
 		setup_k3_mpu_regions();
 		rtc_erratumi2327_init();
 	}

 	/*
 	 * Cannot delay this further as there is a chance that
 	 * K3_BOOT_PARAM_TABLE_INDEX can be over written by SPL MALLOC section.
 	 */
 	store_boot_info_from_rom();

 	ctrl_mmr_unlock();

 	/* Init DM early */
 	spl_early_init();

 	/*
 	 * Process pinctrl for the serial0 and serial3, aka WKUP_UART0 and
 	 * MAIN_UART1 modules and continue regardless of the result of pinctrl.
 	 * Do this without probing the device, but instead by searching the
 	 * device that would request the given sequence number if probed. The
 	 * UARTs will be used by the DM firmware and TIFS firmware images
 	 * respectively and the firmware depend on SPL to initialize the pin
 	 * settings.
 	 */
 	ret = uclass_find_device_by_seq(UCLASS_SERIAL, 0, &dev);
 	if (!ret)
 		pinctrl_select_state(dev, "default");

 	ret = uclass_find_device_by_seq(UCLASS_SERIAL, 3, &dev);
 	if (!ret)
 		pinctrl_select_state(dev, "default");

 	preloader_console_init();

 	/*
 	 * Allow establishing an early console as required for example when
 	 * doing a UART-based boot. Note that this console may not "survive"
 	 * through a SYSFW PM-init step and will need a re-init in some way
 	 * due to changing module clock frequencies.
 	 */
 	if (IS_ENABLED(CONFIG_K3_EARLY_CONS))
 		early_console_init();

 	/*
 	 * Configure and start up system controller firmware. Provide
 	 * the U-Boot console init function to the SYSFW post-PM configuration
 	 * callback hook, effectively switching on (or over) the console
 	 * output.
 	 */
 	if (IS_ENABLED(CONFIG_K3_LOAD_SYSFW)) {
 		ret = is_rom_loaded_sysfw(&bootdata);
 		if (!ret)
 			panic("ROM has not loaded TIFS firmware\n");

 		k3_sysfw_loader(true, NULL, NULL);
 	}

 	/*
 	 * Relocate boot information to OCRAM (after TIFS has opend this
 	 * region for us) so the next bootloader stages can keep access to
 	 * primary vs backup bootmodes.
 	 */
 	if (IS_ENABLED(CONFIG_CPU_V7R))
 		writel(bootindex, K3_BOOT_PARAM_TABLE_INDEX_OCRAM);

 	/*
 	 * Force probe of clk_k3 driver here to ensure basic default clock
 	 * configuration is always done.
 	 */
 	if (IS_ENABLED(CONFIG_SPL_CLK_K3)) {
 		ret = uclass_get_device_by_driver(UCLASS_CLK,
 						  DM_DRIVER_GET(ti_clk),
 						  &dev);
 		if (ret)
 			printf("Failed to initialize clk-k3!\n");
 	}

 	/* Output System Firmware version info */
 	k3_sysfw_print_ver();

 	if (IS_ENABLED(CONFIG_ESM_K3)) {
 		/* Probe/configure ESM0 */
 		ret = uclass_get_device_by_name(UCLASS_MISC, "esm@420000", &dev);
 		if (ret)
 			printf("esm main init failed: %d\n", ret);

 		/* Probe/configure MCUESM */
 		ret = uclass_get_device_by_name(UCLASS_MISC, "esm@4100000", &dev);
 		if (ret)
 			printf("esm mcu init failed: %d\n", ret);

 		enable_mcu_esm_reset();
 	}

 	if (IS_ENABLED(CONFIG_K3_AM64_DDRSS)) {
 		ret = uclass_get_device(UCLASS_RAM, 0, &dev);
 		if (ret)
 			panic("DRAM init failed: %d\n", ret);
 	}
 	spl_enable_cache();

 	fixup_a53_cpu_freq_by_speed_grade();
 }

 u32 spl_mmc_boot_mode(struct mmc *mmc, const u32 boot_device)
 {
 	u32 devstat = readl(CTRLMMR_MAIN_DEVSTAT);
 	u32 bootmode = (devstat & MAIN_DEVSTAT_PRIMARY_BOOTMODE_MASK) >>
 				MAIN_DEVSTAT_PRIMARY_BOOTMODE_SHIFT;
 	u32 bootmode_cfg = (devstat & MAIN_DEVSTAT_PRIMARY_BOOTMODE_CFG_MASK) >>
 			    MAIN_DEVSTAT_PRIMARY_BOOTMODE_CFG_SHIFT;

 	switch (bootmode) {
 	case BOOT_DEVICE_EMMC:
 		if (IS_ENABLED(CONFIG_SUPPORT_EMMC_BOOT))
 			return MMCSD_MODE_EMMCBOOT;
 		if (IS_ENABLED(CONFIG_SPL_FS_FAT) || IS_ENABLED(CONFIG_SPL_FS_EXT4))
 			return MMCSD_MODE_FS;
 		return MMCSD_MODE_EMMCBOOT;
 	case BOOT_DEVICE_MMC:
 		if (bootmode_cfg & MAIN_DEVSTAT_PRIMARY_MMC_FS_RAW_MASK)
 			return MMCSD_MODE_RAW;
 	default:
 		return MMCSD_MODE_FS;
 	}
 }

 u32 spl_boot_device(void)
 {
 	return get_boot_device();
 }
	// SPDX-License-Identifier: GPL-2.0
	/*
	* AM625: SoC specific initialization
	*
	* Copyright (C) 2020-2022 Texas Instruments Incorporated - https://www.ti.com/
	* Suman Anna <s-anna@ti.com>
	*/

	#include <spl.h>
	#include <asm/io.h>
	#include <asm/arch/hardware.h>
	#include "sysfw-loader.h"
	#include "common.h"
	#include <dm.h>
	#include <dm/uclass-internal.h>
	#include <dm/pinctrl.h>
	#include <dm/ofnode.h>

	#define RTC_BASE_ADDRESS 0x2b1f0000
	#define REG_K3RTC_S_CNT_LSW (RTC_BASE_ADDRESS + 0x18)
	#define REG_K3RTC_KICK0 (RTC_BASE_ADDRESS + 0x70)
	#define REG_K3RTC_KICK1 (RTC_BASE_ADDRESS + 0x74)

	/* Magic values for lock/unlock */
	#define K3RTC_KICK0_UNLOCK_VALUE 0x83e70b13
	#define K3RTC_KICK1_UNLOCK_VALUE 0x95a4f1e0

	/* TISCI DEV ID for A53 Clock */
	#define AM62X_DEV_A53SS0_CORE_0_DEV_ID 135

	/*
	* This uninitialized global variable would normal end up in the .bss section,
	* but the .bss is cleared between writing and reading this variable, so move
	* it to the .data section.
	*/
	u32 bootindex __section(".data");
	static struct rom_extended_boot_data bootdata __section(".data");

	static void store_boot_info_from_rom(void)
	{
	bootindex = (u32 )(CONFIG_SYS_K3_BOOT_PARAM_TABLE_INDEX);
	memcpy(&bootdata, (uintptr_t *)ROM_EXTENDED_BOOT_DATA_INFO,
	sizeof(struct rom_extended_boot_data));
	}

	static void ctrl_mmr_unlock(void)
	{
	/* Unlock all WKUP_CTRL_MMR0 module registers */
	mmr_unlock(WKUP_CTRL_MMR0_BASE, 0);
	mmr_unlock(WKUP_CTRL_MMR0_BASE, 1);
	mmr_unlock(WKUP_CTRL_MMR0_BASE, 2);
	mmr_unlock(WKUP_CTRL_MMR0_BASE, 3);
	mmr_unlock(WKUP_CTRL_MMR0_BASE, 4);
	mmr_unlock(WKUP_CTRL_MMR0_BASE, 5);
	mmr_unlock(WKUP_CTRL_MMR0_BASE, 6);
	mmr_unlock(WKUP_CTRL_MMR0_BASE, 7);

	/* Unlock all CTRL_MMR0 module registers */
	mmr_unlock(CTRL_MMR0_BASE, 0);
	mmr_unlock(CTRL_MMR0_BASE, 1);
	mmr_unlock(CTRL_MMR0_BASE, 2);
	mmr_unlock(CTRL_MMR0_BASE, 4);
	mmr_unlock(CTRL_MMR0_BASE, 6);

	/* Unlock all MCU_CTRL_MMR0 module registers */
	mmr_unlock(MCU_CTRL_MMR0_BASE, 0);
	mmr_unlock(MCU_CTRL_MMR0_BASE, 1);
	mmr_unlock(MCU_CTRL_MMR0_BASE, 2);
	mmr_unlock(MCU_CTRL_MMR0_BASE, 3);
	mmr_unlock(MCU_CTRL_MMR0_BASE, 4);
	mmr_unlock(MCU_CTRL_MMR0_BASE, 6);

	/* Unlock PADCFG_CTRL_MMR padconf registers */
	mmr_unlock(PADCFG_MMR0_BASE, 1);
	mmr_unlock(PADCFG_MMR1_BASE, 1);
	}

	static __maybe_unused void enable_mcu_esm_reset(void)
	{
	/* Set CTRLMMR_MCU_RST_CTRL:MCU_ESM_ERROR_RST_EN_Z to '0' (low active) */
	u32 stat = readl(CTRLMMR_MCU_RST_CTRL);

	stat &= RST_CTRL_ESM_ERROR_RST_EN_Z_MASK;
	writel(stat, CTRLMMR_MCU_RST_CTRL);
	}

	/*
	* RTC Erratum i2327 Workaround for Silicon Revision 1
	*
	* Due to a bug in initial synchronization out of cold power on,
	* IRQ status can get locked infinitely if we do not unlock RTC
	*
	* This workaround must be applied within 1 second of power on,
	* So, this is closest point to be able to guarantee the max
	* timing.
	*
	* https://www.ti.com/lit/er/sprz487c/sprz487c.pdf
	*/
	static __maybe_unused void rtc_erratumi2327_init(void)
	{
	u32 counter;

	/*
	* If counter has gone past 1, nothing we can do, leave
	* system locked! This is the only way we know if RTC
	* can be used for all practical purposes.
	*/
	counter = readl(REG_K3RTC_S_CNT_LSW);
	if (counter > 1)
	return;
	/*
	* Need to set this up at the very start
	* MUST BE DONE under 1 second of boot.
	*/
	writel(K3RTC_KICK0_UNLOCK_VALUE, REG_K3RTC_KICK0);
	writel(K3RTC_KICK1_UNLOCK_VALUE, REG_K3RTC_KICK1);
	}

	#if CONFIG_IS_ENABLED(OF_CONTROL)
	static int get_a53_cpu_clock_index(ofnode node)
	{
	int count, i;
	struct ofnode_phandle_args *args;
	ofnode clknode;

	clknode = ofnode_path("/bus@f0000/system-controller@44043000/clock-controller");
	if (!ofnode_valid(clknode))
	return -1;

	count = ofnode_count_phandle_with_args(node, "assigned-clocks", "#clock-cells", 0);

	for (i = 0; i < count; i++) {
	if (!ofnode_parse_phandle_with_args(node, "assigned-clocks",
	"#clock-cells", 0, i, args)) {
	if (ofnode_equal(clknode, args->node) &&
	args->args[0] == AM62X_DEV_A53SS0_CORE_0_DEV_ID)
	return i;
	}
	}

	return -1;
	}

	static void fixup_a53_cpu_freq_by_speed_grade(void)
	{
	int index, size;
	u32 *rates;
	ofnode node;

	node = ofnode_path("/a53@0");
	if (!ofnode_valid(node))
	return;

	rates = fdt_getprop_w(ofnode_to_fdt(node), ofnode_to_offset(node),
	"assigned-clock-rates", &size);

	index = get_a53_cpu_clock_index(node);

	if (!rates \|\| index < 0 \|\| index >= (size / sizeof(u32))) {
	printf("Wrong A53 assigned-clocks configuration\n");
	return;
	}

	rates[index] = cpu_to_fdt32(k3_get_a53_max_frequency());

	printf("Changed A53 CPU frequency to %dHz (%c grade) in DT\n",
	k3_get_a53_max_frequency(), k3_get_speed_grade());
	}
	#else
	static void fixup_a53_cpu_freq_by_speed_grade(void)
	{
	}
	#endif

	void board_init_f(ulong dummy)
	{
	struct udevice *dev;
	int ret;

	if (IS_ENABLED(CONFIG_CPU_V7R)) {
	setup_k3_mpu_regions();
	rtc_erratumi2327_init();
	}

	/*
	* Cannot delay this further as there is a chance that
	* K3_BOOT_PARAM_TABLE_INDEX can be over written by SPL MALLOC section.
	*/
	store_boot_info_from_rom();

	ctrl_mmr_unlock();

	/* Init DM early */
	spl_early_init();

	/*
	* Process pinctrl for the serial0 and serial3, aka WKUP_UART0 and
	* MAIN_UART1 modules and continue regardless of the result of pinctrl.
	* Do this without probing the device, but instead by searching the
	* device that would request the given sequence number if probed. The
	* UARTs will be used by the DM firmware and TIFS firmware images
	* respectively and the firmware depend on SPL to initialize the pin
	* settings.
	*/
	ret = uclass_find_device_by_seq(UCLASS_SERIAL, 0, &dev);
	if (!ret)
	pinctrl_select_state(dev, "default");

	ret = uclass_find_device_by_seq(UCLASS_SERIAL, 3, &dev);
	if (!ret)
	pinctrl_select_state(dev, "default");

	preloader_console_init();

	/*
	* Allow establishing an early console as required for example when
	* doing a UART-based boot. Note that this console may not "survive"
	* through a SYSFW PM-init step and will need a re-init in some way
	* due to changing module clock frequencies.
	*/
	if (IS_ENABLED(CONFIG_K3_EARLY_CONS))
	early_console_init();

	/*
	* Configure and start up system controller firmware. Provide
	* the U-Boot console init function to the SYSFW post-PM configuration
	* callback hook, effectively switching on (or over) the console
	* output.
	*/
	if (IS_ENABLED(CONFIG_K3_LOAD_SYSFW)) {
	ret = is_rom_loaded_sysfw(&bootdata);
	if (!ret)
	panic("ROM has not loaded TIFS firmware\n");

	k3_sysfw_loader(true, NULL, NULL);
	}

	/*
	* Relocate boot information to OCRAM (after TIFS has opend this
	* region for us) so the next bootloader stages can keep access to
	* primary vs backup bootmodes.
	*/
	if (IS_ENABLED(CONFIG_CPU_V7R))
	writel(bootindex, K3_BOOT_PARAM_TABLE_INDEX_OCRAM);

	/*
	* Force probe of clk_k3 driver here to ensure basic default clock
	* configuration is always done.
	*/
	if (IS_ENABLED(CONFIG_SPL_CLK_K3)) {
	ret = uclass_get_device_by_driver(UCLASS_CLK,
	DM_DRIVER_GET(ti_clk),
	&dev);
	if (ret)
	printf("Failed to initialize clk-k3!\n");
	}

	/* Output System Firmware version info */
	k3_sysfw_print_ver();

	if (IS_ENABLED(CONFIG_ESM_K3)) {
	/* Probe/configure ESM0 */
	ret = uclass_get_device_by_name(UCLASS_MISC, "esm@420000", &dev);
	if (ret)
	printf("esm main init failed: %d\n", ret);

	/* Probe/configure MCUESM */
	ret = uclass_get_device_by_name(UCLASS_MISC, "esm@4100000", &dev);
	if (ret)
	printf("esm mcu init failed: %d\n", ret);

	enable_mcu_esm_reset();
	}

	if (IS_ENABLED(CONFIG_K3_AM64_DDRSS)) {
	ret = uclass_get_device(UCLASS_RAM, 0, &dev);
	if (ret)
	panic("DRAM init failed: %d\n", ret);
	}
	spl_enable_cache();

	fixup_a53_cpu_freq_by_speed_grade();
	}

	u32 spl_mmc_boot_mode(struct mmc *mmc, const u32 boot_device)
	{
	u32 devstat = readl(CTRLMMR_MAIN_DEVSTAT);
	u32 bootmode = (devstat & MAIN_DEVSTAT_PRIMARY_BOOTMODE_MASK) >>
	MAIN_DEVSTAT_PRIMARY_BOOTMODE_SHIFT;
	u32 bootmode_cfg = (devstat & MAIN_DEVSTAT_PRIMARY_BOOTMODE_CFG_MASK) >>
	MAIN_DEVSTAT_PRIMARY_BOOTMODE_CFG_SHIFT;

	switch (bootmode) {
	case BOOT_DEVICE_EMMC:
	if (IS_ENABLED(CONFIG_SUPPORT_EMMC_BOOT))
	return MMCSD_MODE_EMMCBOOT;
	if (IS_ENABLED(CONFIG_SPL_FS_FAT) \|\| IS_ENABLED(CONFIG_SPL_FS_EXT4))
	return MMCSD_MODE_FS;
	return MMCSD_MODE_EMMCBOOT;
	case BOOT_DEVICE_MMC:
	if (bootmode_cfg & MAIN_DEVSTAT_PRIMARY_MMC_FS_RAW_MASK)
	return MMCSD_MODE_RAW;
	default:
	return MMCSD_MODE_FS;
	}
	}

	u32 spl_boot_device(void)
	{
	return get_boot_device();
	}