[J-u-boot.git] / board / toradex / common / tdx-cfg-block.c

// SPDX-License-Identifier: GPL-2.0+
/*
 * Copyright (c) 2016-2020 Toradex
 */

#include <common.h>
#include "tdx-cfg-block.h"
#include <command.h>
#include <asm/cache.h>

#if defined(CONFIG_TARGET_APALIS_IMX6) || \
	defined(CONFIG_TARGET_APALIS_IMX8) || \
	defined(CONFIG_TARGET_APALIS_IMX8X) || \
	defined(CONFIG_TARGET_COLIBRI_IMX6) || \
	defined(CONFIG_TARGET_COLIBRI_IMX8X) || \
	defined(CONFIG_TARGET_VERDIN_IMX8MM) || \
	defined(CONFIG_TARGET_VERDIN_IMX8MN)
#include <asm/arch/sys_proto.h>
#else
#define is_cpu_type(cpu) (0)
#endif
#if defined(CONFIG_CPU_PXA27X)
#include <asm/arch-pxa/pxa.h>
#else
#define cpu_is_pxa27x(cpu) (0)
#endif
#include <cli.h>
#include <console.h>
#include <env.h>
#include <flash.h>
#include <malloc.h>
#include <mmc.h>
#include <nand.h>
#include <asm/mach-types.h>

DECLARE_GLOBAL_DATA_PTR;

#define TAG_VALID	0xcf01
#define TAG_MAC		0x0000
#define TAG_HW		0x0008
#define TAG_INVALID	0xffff

#define TAG_FLAG_VALID	0x1

#if defined(CONFIG_TDX_CFG_BLOCK_IS_IN_MMC)
#define TDX_CFG_BLOCK_MAX_SIZE 512
#elif defined(CONFIG_TDX_CFG_BLOCK_IS_IN_NAND)
#define TDX_CFG_BLOCK_MAX_SIZE 64
#elif defined(CONFIG_TDX_CFG_BLOCK_IS_IN_NOR)
#define TDX_CFG_BLOCK_MAX_SIZE 64
#else
#error Toradex config block location not set
#endif

struct toradex_tag {
	u32 len:14;
	u32 flags:2;
	u32 id:16;
};

bool valid_cfgblock;
struct toradex_hw tdx_hw_tag;
struct toradex_eth_addr tdx_eth_addr;
u32 tdx_serial;

const char * const toradex_modules[] = {
	 [0] = "UNKNOWN MODULE",
	 [1] = "Colibri PXA270 312MHz",
	 [2] = "Colibri PXA270 520MHz",
	 [3] = "Colibri PXA320 806MHz",
	 [4] = "Colibri PXA300 208MHz",
	 [5] = "Colibri PXA310 624MHz",
	 [6] = "Colibri PXA320 806MHz IT",
	 [7] = "Colibri PXA300 208MHz XT",
	 [8] = "Colibri PXA270 312MHz",
	 [9] = "Colibri PXA270 520MHz",
	[10] = "Colibri VF50 128MB", /* not currently on sale */
	[11] = "Colibri VF61 256MB",
	[12] = "Colibri VF61 256MB IT",
	[13] = "Colibri VF50 128MB IT",
	[14] = "Colibri iMX6 Solo 256MB",
	[15] = "Colibri iMX6 DualLite 512MB",
	[16] = "Colibri iMX6 Solo 256MB IT",
	[17] = "Colibri iMX6 DualLite 512MB IT",
	[18] = "UNKNOWN MODULE",
	[19] = "UNKNOWN MODULE",
	[20] = "Colibri T20 256MB",
	[21] = "Colibri T20 512MB",
	[22] = "Colibri T20 512MB IT",
	[23] = "Colibri T30 1GB",
	[24] = "Colibri T20 256MB IT",
	[25] = "Apalis T30 2GB",
	[26] = "Apalis T30 1GB",
	[27] = "Apalis iMX6 Quad 1GB",
	[28] = "Apalis iMX6 Quad 2GB IT",
	[29] = "Apalis iMX6 Dual 512MB",
	[30] = "Colibri T30 1GB IT",
	[31] = "Apalis T30 1GB IT",
	[32] = "Colibri iMX7 Solo 256MB",
	[33] = "Colibri iMX7 Dual 512MB",
	[34] = "Apalis TK1 2GB",
	[35] = "Apalis iMX6 Dual 1GB IT",
	[36] = "Colibri iMX6ULL 256MB",
	[37] = "Apalis iMX8 QuadMax 4GB Wi-Fi / BT IT",
	[38] = "Colibri iMX8 QuadXPlus 2GB Wi-Fi / BT IT",
	[39] = "Colibri iMX7 Dual 1GB (eMMC)",
	[40] = "Colibri iMX6ULL 512MB Wi-Fi / BT IT",
	[41] = "Colibri iMX7 Dual 512MB EPDC",
	[42] = "Apalis TK1 4GB",
	[43] = "Colibri T20 512MB IT SETEK",
	[44] = "Colibri iMX6ULL 512MB IT",
	[45] = "Colibri iMX6ULL 512MB Wi-Fi / Bluetooth",
	[46] = "Apalis iMX8 QuadXPlus 2GB Wi-Fi / BT IT",
	[47] = "Apalis iMX8 QuadMax 4GB IT",
	[48] = "Apalis iMX8 QuadPlus 2GB Wi-Fi / BT",
	[49] = "Apalis iMX8 QuadPlus 2GB",
	[50] = "Colibri iMX8 QuadXPlus 2GB IT",
	[51] = "Colibri iMX8 DualX 1GB Wi-Fi / Bluetooth",
	[52] = "Colibri iMX8 DualX 1GB",
	[53] = "Apalis iMX8 QuadXPlus 2GB ECC IT",
	[54] = "Apalis iMX8 DualXPlus 1GB",
	[55] = "Verdin iMX8M Mini Quad 2GB Wi-Fi / BT IT",
	[56] = "Verdin iMX8M Nano SoloLite 1GB", /* not currently on sale */
	[57] = "Verdin iMX8M Mini DualLite 1GB",
};

#ifdef CONFIG_TDX_CFG_BLOCK_IS_IN_MMC
static int tdx_cfg_block_mmc_storage(u8 *config_block, int write)
{
	struct mmc *mmc;
	int dev = CONFIG_TDX_CFG_BLOCK_DEV;
	int offset = CONFIG_TDX_CFG_BLOCK_OFFSET;
	uint part = CONFIG_TDX_CFG_BLOCK_PART;
	uint blk_start;
	int ret = 0;

	/* Read production parameter config block from eMMC */
	mmc = find_mmc_device(dev);
	if (!mmc) {
		puts("No MMC card found\n");
		ret = -ENODEV;
		goto out;
	}
	if (mmc_init(mmc)) {
		puts("MMC init failed\n");
		return -EINVAL;
	}
	if (part != mmc_get_blk_desc(mmc)->hwpart) {
		if (blk_select_hwpart_devnum(IF_TYPE_MMC, dev, part)) {
			puts("MMC partition switch failed\n");
			ret = -ENODEV;
			goto out;
		}
	}
	if (offset < 0)
		offset += mmc->capacity;
	blk_start = ALIGN(offset, mmc->write_bl_len) / mmc->write_bl_len;

	if (!write) {
		/* Careful reads a whole block of 512 bytes into config_block */
		if (blk_dread(mmc_get_blk_desc(mmc), blk_start, 1,
			      (unsigned char *)config_block) != 1) {
			ret = -EIO;
			goto out;
		}
	} else {
		/* Just writing one 512 byte block */
		if (blk_dwrite(mmc_get_blk_desc(mmc), blk_start, 1,
			       (unsigned char *)config_block) != 1) {
			ret = -EIO;
			goto out;
		}
	}

out:
	/* Switch back to regular eMMC user partition */
	blk_select_hwpart_devnum(IF_TYPE_MMC, 0, 0);

	return ret;
}
#endif

#ifdef CONFIG_TDX_CFG_BLOCK_IS_IN_NAND
static int read_tdx_cfg_block_from_nand(unsigned char *config_block)
{
	size_t size = TDX_CFG_BLOCK_MAX_SIZE;
	struct mtd_info *mtd = get_nand_dev_by_index(0);

	if (!mtd)
		return -ENODEV;

	/* Read production parameter config block from NAND page */
	return nand_read_skip_bad(mtd, CONFIG_TDX_CFG_BLOCK_OFFSET,
				  &size, NULL, TDX_CFG_BLOCK_MAX_SIZE,
				  config_block);
}

static int write_tdx_cfg_block_to_nand(unsigned char *config_block)
{
	size_t size = TDX_CFG_BLOCK_MAX_SIZE;

	/* Write production parameter config block to NAND page */
	return nand_write_skip_bad(get_nand_dev_by_index(0),
				   CONFIG_TDX_CFG_BLOCK_OFFSET,
				   &size, NULL, TDX_CFG_BLOCK_MAX_SIZE,
				   config_block, WITH_WR_VERIFY);
}
#endif

#ifdef CONFIG_TDX_CFG_BLOCK_IS_IN_NOR
static int read_tdx_cfg_block_from_nor(unsigned char *config_block)
{
	/* Read production parameter config block from NOR flash */
	memcpy(config_block, (void *)CONFIG_TDX_CFG_BLOCK_OFFSET,
	       TDX_CFG_BLOCK_MAX_SIZE);
	return 0;
}

static int write_tdx_cfg_block_to_nor(unsigned char *config_block)
{
	/* Write production parameter config block to NOR flash */
	return flash_write((void *)config_block, CONFIG_TDX_CFG_BLOCK_OFFSET,
			   TDX_CFG_BLOCK_MAX_SIZE);
}
#endif

int read_tdx_cfg_block(void)
{
	int ret = 0;
	u8 *config_block = NULL;
	struct toradex_tag *tag;
	size_t size = TDX_CFG_BLOCK_MAX_SIZE;
	int offset;

	/* Allocate RAM area for config block */
	config_block = memalign(ARCH_DMA_MINALIGN, size);
	if (!config_block) {
		printf("Not enough malloc space available!\n");
		return -ENOMEM;
	}

	memset(config_block, 0, size);

#if defined(CONFIG_TDX_CFG_BLOCK_IS_IN_MMC)
	ret = tdx_cfg_block_mmc_storage(config_block, 0);
#elif defined(CONFIG_TDX_CFG_BLOCK_IS_IN_NAND)
	ret = read_tdx_cfg_block_from_nand(config_block);
#elif defined(CONFIG_TDX_CFG_BLOCK_IS_IN_NOR)
	ret = read_tdx_cfg_block_from_nor(config_block);
#else
	ret = -EINVAL;
#endif
	if (ret)
		goto out;

	/* Expect a valid tag first */
	tag = (struct toradex_tag *)config_block;
	if (tag->flags != TAG_FLAG_VALID || tag->id != TAG_VALID) {
		valid_cfgblock = false;
		ret = -EINVAL;
		goto out;
	}
	valid_cfgblock = true;
	offset = 4;

	while (offset < TDX_CFG_BLOCK_MAX_SIZE) {
		tag = (struct toradex_tag *)(config_block + offset);
		offset += 4;
		if (tag->id == TAG_INVALID)
			break;

		if (tag->flags == TAG_FLAG_VALID) {
			switch (tag->id) {
			case TAG_MAC:
				memcpy(&tdx_eth_addr, config_block + offset,
				       6);

				/* NIC part of MAC address is serial number */
				tdx_serial = ntohl(tdx_eth_addr.nic) >> 8;
				break;
			case TAG_HW:
				memcpy(&tdx_hw_tag, config_block + offset, 8);
				break;
			}
		}

		/* Get to next tag according to current tags length */
		offset += tag->len * 4;
	}

	/* Cap product id to avoid issues with a yet unknown one */
	if (tdx_hw_tag.prodid >= (sizeof(toradex_modules) /
				  sizeof(toradex_modules[0])))
		tdx_hw_tag.prodid = 0;

out:
	free(config_block);
	return ret;
}

static int get_cfgblock_interactive(void)
{
	char message[CONFIG_SYS_CBSIZE];
	char *soc;
	char it = 'n';
	char wb = 'n';
	int len = 0;

	/* Unknown module by default */
	tdx_hw_tag.prodid = 0;

	if (cpu_is_pxa27x())
		sprintf(message, "Is the module the 312 MHz version? [y/N] ");
#if !defined(CONFIG_TARGET_VERDIN_IMX8MM) || !defined(CONFIG_TARGET_VERDIN_IMX8MN)
	else
		sprintf(message, "Is the module an IT version? [y/N] ");

	len = cli_readline(message);
	it = console_buffer[0];
#else
	else
		it = 'y';
#endif


#if defined(CONFIG_TARGET_APALIS_IMX8) || \
		defined(CONFIG_TARGET_APALIS_IMX8X) || \
		defined(CONFIG_TARGET_COLIBRI_IMX6ULL) || \
		defined(CONFIG_TARGET_COLIBRI_IMX8X)
	sprintf(message, "Does the module have Wi-Fi / Bluetooth? [y/N] ");
	len = cli_readline(message);
	wb = console_buffer[0];
#endif

	soc = env_get("soc");
	if (!strcmp("mx6", soc)) {
#ifdef CONFIG_TARGET_APALIS_IMX6
		if (it == 'y' || it == 'Y') {
			if (is_cpu_type(MXC_CPU_MX6Q))
				tdx_hw_tag.prodid = APALIS_IMX6Q_IT;
			else
				tdx_hw_tag.prodid = APALIS_IMX6D_IT;
		} else {
			if (is_cpu_type(MXC_CPU_MX6Q))
				tdx_hw_tag.prodid = APALIS_IMX6Q;
			else
				tdx_hw_tag.prodid = APALIS_IMX6D;
		}
#elif CONFIG_TARGET_COLIBRI_IMX6
		if (it == 'y' || it == 'Y') {
			if (is_cpu_type(MXC_CPU_MX6DL))
				tdx_hw_tag.prodid = COLIBRI_IMX6DL_IT;
			else if (is_cpu_type(MXC_CPU_MX6SOLO))
				tdx_hw_tag.prodid = COLIBRI_IMX6S_IT;
		} else {
			if (is_cpu_type(MXC_CPU_MX6DL))
				tdx_hw_tag.prodid = COLIBRI_IMX6DL;
			else if (is_cpu_type(MXC_CPU_MX6SOLO))
				tdx_hw_tag.prodid = COLIBRI_IMX6S;
		}
#elif CONFIG_TARGET_COLIBRI_IMX6ULL
		if (it == 'y' || it == 'Y') {
			if (wb == 'y' || wb == 'Y')
				tdx_hw_tag.prodid = COLIBRI_IMX6ULL_WIFI_BT_IT;
			else
				tdx_hw_tag.prodid = COLIBRI_IMX6ULL_IT;
		} else {
			if (wb == 'y' || wb == 'Y')
				tdx_hw_tag.prodid = COLIBRI_IMX6ULL_WIFI_BT;
			else
				tdx_hw_tag.prodid = COLIBRI_IMX6ULL;
		}
#endif
	} else if (!strcmp("imx7d", soc))
		tdx_hw_tag.prodid = COLIBRI_IMX7D;
	else if (!strcmp("imx7s", soc))
		tdx_hw_tag.prodid = COLIBRI_IMX7S;
	else if (is_cpu_type(MXC_CPU_IMX8MM))
		tdx_hw_tag.prodid = VERDIN_IMX8MMQ_WIFI_BT_IT;
	else if (is_cpu_type(MXC_CPU_IMX8MMDL))
		tdx_hw_tag.prodid = VERDIN_IMX8MMDL;
	else if (is_cpu_type(MXC_CPU_IMX8MN))
		tdx_hw_tag.prodid = VERDIN_IMX8MNSL;
	else if (is_cpu_type(MXC_CPU_IMX8QM)) {
		if (it == 'y' || it == 'Y') {
			if (wb == 'y' || wb == 'Y')
				tdx_hw_tag.prodid = APALIS_IMX8QM_WIFI_BT_IT;
			else
				tdx_hw_tag.prodid = APALIS_IMX8QM_IT;
		} else {
			if (wb == 'y' || wb == 'Y')
				tdx_hw_tag.prodid = APALIS_IMX8QP_WIFI_BT;
			else
				tdx_hw_tag.prodid = APALIS_IMX8QP;
		}
	} else if (is_cpu_type(MXC_CPU_IMX8QXP)) {
#ifdef CONFIG_TARGET_APALIS_IMX8X
		if (it == 'y' || it == 'Y' || wb == 'y' || wb == 'Y') {
				tdx_hw_tag.prodid = APALIS_IMX8QXP_WIFI_BT_IT;
		} else {
			if (gd->ram_size == 0x40000000)
				tdx_hw_tag.prodid = APALIS_IMX8DXP;
			else
				tdx_hw_tag.prodid = APALIS_IMX8QXP;
		}
#elif CONFIG_TARGET_COLIBRI_IMX8X
		if (it == 'y' || it == 'Y') {
			if (wb == 'y' || wb == 'Y')
				tdx_hw_tag.prodid = COLIBRI_IMX8QXP_WIFI_BT_IT;
			else
				tdx_hw_tag.prodid = COLIBRI_IMX8QXP_IT;
		} else {
			if (wb == 'y' || wb == 'Y')
				tdx_hw_tag.prodid = COLIBRI_IMX8DX_WIFI_BT;
			else
				tdx_hw_tag.prodid = COLIBRI_IMX8DX;
		}
#endif
	} else if (!strcmp("tegra20", soc)) {
		if (it == 'y' || it == 'Y')
			if (gd->ram_size == 0x10000000)
				tdx_hw_tag.prodid = COLIBRI_T20_256MB_IT;
			else
				tdx_hw_tag.prodid = COLIBRI_T20_512MB_IT;
		else
			if (gd->ram_size == 0x10000000)
				tdx_hw_tag.prodid = COLIBRI_T20_256MB;
			else
				tdx_hw_tag.prodid = COLIBRI_T20_512MB;
	} else if (cpu_is_pxa27x()) {
		if (it == 'y' || it == 'Y')
			tdx_hw_tag.prodid = COLIBRI_PXA270_312MHZ;
		else
			tdx_hw_tag.prodid = COLIBRI_PXA270_520MHZ;
	}
#ifdef CONFIG_MACH_TYPE
	else if (!strcmp("tegra30", soc)) {
		if (CONFIG_MACH_TYPE == MACH_TYPE_APALIS_T30) {
			if (it == 'y' || it == 'Y')
				tdx_hw_tag.prodid = APALIS_T30_IT;
			else
				if (gd->ram_size == 0x40000000)
					tdx_hw_tag.prodid = APALIS_T30_1GB;
				else
					tdx_hw_tag.prodid = APALIS_T30_2GB;
		} else {
			if (it == 'y' || it == 'Y')
				tdx_hw_tag.prodid = COLIBRI_T30_IT;
			else
				tdx_hw_tag.prodid = COLIBRI_T30;
		}
	}
#endif /* CONFIG_MACH_TYPE */
	else if (!strcmp("tegra124", soc)) {
		tdx_hw_tag.prodid = APALIS_TK1_2GB;
	} else if (!strcmp("vf500", soc)) {
		if (it == 'y' || it == 'Y')
			tdx_hw_tag.prodid = COLIBRI_VF50_IT;
		else
			tdx_hw_tag.prodid = COLIBRI_VF50;
	} else if (!strcmp("vf610", soc)) {
		if (it == 'y' || it == 'Y')
			tdx_hw_tag.prodid = COLIBRI_VF61_IT;
		else
			tdx_hw_tag.prodid = COLIBRI_VF61;
	}

	if (!tdx_hw_tag.prodid) {
		printf("Module type not detectable due to unknown SoC\n");
		return -1;
	}

	while (len < 4) {
		sprintf(message, "Enter the module version (e.g. V1.1B): V");
		len = cli_readline(message);
	}

	tdx_hw_tag.ver_major = console_buffer[0] - '0';
	tdx_hw_tag.ver_minor = console_buffer[2] - '0';
	tdx_hw_tag.ver_assembly = console_buffer[3] - 'A';

	if (cpu_is_pxa27x() && tdx_hw_tag.ver_major == 1)
		tdx_hw_tag.prodid -= (COLIBRI_PXA270_312MHZ -
				       COLIBRI_PXA270_V1_312MHZ);

	while (len < 8) {
		sprintf(message, "Enter module serial number: ");
		len = cli_readline(message);
	}

	tdx_serial = simple_strtoul(console_buffer, NULL, 10);

	return 0;
}

static int get_cfgblock_barcode(char *barcode)
{
	if (strlen(barcode) < 16) {
		printf("Argument too short, barcode is 16 chars long\n");
		return -1;
	}

	/* Get hardware information from the first 8 digits */
	tdx_hw_tag.ver_major = barcode[4] - '0';
	tdx_hw_tag.ver_minor = barcode[5] - '0';
	tdx_hw_tag.ver_assembly = barcode[7] - '0';

	barcode[4] = '\0';
	tdx_hw_tag.prodid = simple_strtoul(barcode, NULL, 10);

	/* Parse second part of the barcode (serial number */
	barcode += 8;
	tdx_serial = simple_strtoul(barcode, NULL, 10);

	return 0;
}

static int do_cfgblock_create(struct cmd_tbl *cmdtp, int flag, int argc,
			      char *const argv[])
{
	u8 *config_block;
	struct toradex_tag *tag;
	size_t size = TDX_CFG_BLOCK_MAX_SIZE;
	int offset = 0;
	int ret = CMD_RET_SUCCESS;
	int err;
	int force_overwrite = 0;

	/* Allocate RAM area for config block */
	config_block = memalign(ARCH_DMA_MINALIGN, size);
	if (!config_block) {
		printf("Not enough malloc space available!\n");
		return CMD_RET_FAILURE;
	}

	memset(config_block, 0xff, size);

	if (argc >= 3) {
		if (argv[2][0] == '-' && argv[2][1] == 'y')
			force_overwrite = 1;
	}

	read_tdx_cfg_block();
	if (valid_cfgblock) {
#if defined(CONFIG_TDX_CFG_BLOCK_IS_IN_NAND)
		/*
		 * On NAND devices, recreation is only allowed if the page is
		 * empty (config block invalid...)
		 */
		printf("NAND erase block %d need to be erased before creating a Toradex config block\n",
		       CONFIG_TDX_CFG_BLOCK_OFFSET /
		       get_nand_dev_by_index(0)->erasesize);
		goto out;
#elif defined(CONFIG_TDX_CFG_BLOCK_IS_IN_NOR)
		/*
		 * On NOR devices, recreation is only allowed if the sector is
		 * empty and write protection is off (config block invalid...)
		 */
		printf("NOR sector at offset 0x%02x need to be erased and unprotected before creating a Toradex config block\n",
		       CONFIG_TDX_CFG_BLOCK_OFFSET);
		goto out;
#else
		if (!force_overwrite) {
			char message[CONFIG_SYS_CBSIZE];

			sprintf(message,
				"A valid Toradex config block is present, still recreate? [y/N] ");

			if (!cli_readline(message))
				goto out;

			if (console_buffer[0] != 'y' &&
			    console_buffer[0] != 'Y')
				goto out;
		}
#endif
	}

	/* Parse new Toradex config block data... */
	if (argc < 3 || (force_overwrite && argc < 4)) {
		err = get_cfgblock_interactive();
	} else {
		if (force_overwrite)
			err = get_cfgblock_barcode(argv[3]);
		else
			err = get_cfgblock_barcode(argv[2]);
	}
	if (err) {
		ret = CMD_RET_FAILURE;
		goto out;
	}

	/* Convert serial number to MAC address (the storage format) */
	tdx_eth_addr.oui = htonl(0x00142dUL << 8);
	tdx_eth_addr.nic = htonl(tdx_serial << 8);

	/* Valid Tag */
	tag = (struct toradex_tag *)config_block;
	tag->id = TAG_VALID;
	tag->flags = TAG_FLAG_VALID;
	tag->len = 0;
	offset += 4;

	/* Product Tag */
	tag = (struct toradex_tag *)(config_block + offset);
	tag->id = TAG_HW;
	tag->flags = TAG_FLAG_VALID;
	tag->len = 2;
	offset += 4;

	memcpy(config_block + offset, &tdx_hw_tag, 8);
	offset += 8;

	/* MAC Tag */
	tag = (struct toradex_tag *)(config_block + offset);
	tag->id = TAG_MAC;
	tag->flags = TAG_FLAG_VALID;
	tag->len = 2;
	offset += 4;

	memcpy(config_block + offset, &tdx_eth_addr, 6);
	offset += 6;
	memset(config_block + offset, 0, 32 - offset);

#if defined(CONFIG_TDX_CFG_BLOCK_IS_IN_MMC)
	err = tdx_cfg_block_mmc_storage(config_block, 1);
#elif defined(CONFIG_TDX_CFG_BLOCK_IS_IN_NAND)
	err = write_tdx_cfg_block_to_nand(config_block);
#elif defined(CONFIG_TDX_CFG_BLOCK_IS_IN_NOR)
	err = write_tdx_cfg_block_to_nor(config_block);
#else
	err = -EINVAL;
#endif
	if (err) {
		printf("Failed to write Toradex config block: %d\n", ret);
		ret = CMD_RET_FAILURE;
		goto out;
	}

	printf("Toradex config block successfully written\n");

out:
	free(config_block);
	return ret;
}

static int do_cfgblock(struct cmd_tbl *cmdtp, int flag, int argc,
		       char *const argv[])
{
	int ret;

	if (argc < 2)
		return CMD_RET_USAGE;

	if (!strcmp(argv[1], "create")) {
		return do_cfgblock_create(cmdtp, flag, argc, argv);
	} else if (!strcmp(argv[1], "reload")) {
		ret = read_tdx_cfg_block();
		if (ret) {
			printf("Failed to reload Toradex config block: %d\n",
			       ret);
			return CMD_RET_FAILURE;
		}
		return CMD_RET_SUCCESS;
	}

	return CMD_RET_USAGE;
}

U_BOOT_CMD(cfgblock, 4, 0, do_cfgblock,
	   "Toradex config block handling commands",
	   "create [-y] [barcode] - (Re-)create Toradex config block\n"
	   "cfgblock reload - Reload Toradex config block from flash"
);
Commit	Line	Data
83d290c5	1	// SPDX-License-Identifier: GPL-2.0+
a2777ecb	2	/*
842ddf8e	3	* Copyright (c) 2016-2020 Toradex
a2777ecb MZ	4	*/
	5
	6	#include <common.h>
	7	#include "tdx-cfg-block.h"
09140113	8	#include <command.h>
90526e9f	9	#include <asm/cache.h>
a2777ecb	10
4adc9fc1	11	#if defined(CONFIG_TARGET_APALIS_IMX6) \|\| \
9d63c7d8	12	defined(CONFIG_TARGET_APALIS_IMX8) \|\| \
842ddf8e	13	defined(CONFIG_TARGET_APALIS_IMX8X) \|\| \
4adc9fc1	14	defined(CONFIG_TARGET_COLIBRI_IMX6) \|\| \
c0c3978c MZ	15	defined(CONFIG_TARGET_COLIBRI_IMX8X) \|\| \
	16	defined(CONFIG_TARGET_VERDIN_IMX8MM) \|\| \
	17	defined(CONFIG_TARGET_VERDIN_IMX8MN)
a2777ecb MZ	18	#include <asm/arch/sys_proto.h>
	19	#else
	20	#define is_cpu_type(cpu) (0)
	21	#endif
	22	#if defined(CONFIG_CPU_PXA27X)
	23	#include <asm/arch-pxa/pxa.h>
	24	#else
	25	#define cpu_is_pxa27x(cpu) (0)
	26	#endif
	27	#include <cli.h>
	28	#include <console.h>
7b51b576	29	#include <env.h>
a2777ecb MZ	30	#include <flash.h>
	31	#include <malloc.h>
	32	#include <mmc.h>
	33	#include <nand.h>
c62db35d	34	#include <asm/mach-types.h>
a2777ecb MZ	35
	36	DECLARE_GLOBAL_DATA_PTR;
	37
	38	#define TAG_VALID 0xcf01
	39	#define TAG_MAC 0x0000
	40	#define TAG_HW 0x0008
	41	#define TAG_INVALID 0xffff
	42
	43	#define TAG_FLAG_VALID 0x1
	44
	45	#if defined(CONFIG_TDX_CFG_BLOCK_IS_IN_MMC)
	46	#define TDX_CFG_BLOCK_MAX_SIZE 512
	47	#elif defined(CONFIG_TDX_CFG_BLOCK_IS_IN_NAND)
	48	#define TDX_CFG_BLOCK_MAX_SIZE 64
	49	#elif defined(CONFIG_TDX_CFG_BLOCK_IS_IN_NOR)
	50	#define TDX_CFG_BLOCK_MAX_SIZE 64
	51	#else
	52	#error Toradex config block location not set
	53	#endif
	54
	55	struct toradex_tag {
	56	u32 len:14;
	57	u32 flags:2;
	58	u32 id:16;
	59	};
	60
	61	bool valid_cfgblock;
	62	struct toradex_hw tdx_hw_tag;
	63	struct toradex_eth_addr tdx_eth_addr;
	64	u32 tdx_serial;
	65
	66	const char * const toradex_modules[] = {
	67	[0] = "UNKNOWN MODULE",
	68	[1] = "Colibri PXA270 312MHz",
	69	[2] = "Colibri PXA270 520MHz",
	70	[3] = "Colibri PXA320 806MHz",
	71	[4] = "Colibri PXA300 208MHz",
	72	[5] = "Colibri PXA310 624MHz",
	73	[6] = "Colibri PXA320 806MHz IT",
	74	[7] = "Colibri PXA300 208MHz XT",
	75	[8] = "Colibri PXA270 312MHz",
	76	[9] = "Colibri PXA270 520MHz",
	77	[10] = "Colibri VF50 128MB", /* not currently on sale */
	78	[11] = "Colibri VF61 256MB",
	79	[12] = "Colibri VF61 256MB IT",
	80	[13] = "Colibri VF50 128MB IT",
	81	[14] = "Colibri iMX6 Solo 256MB",
	82	[15] = "Colibri iMX6 DualLite 512MB",
	83	[16] = "Colibri iMX6 Solo 256MB IT",
	84	[17] = "Colibri iMX6 DualLite 512MB IT",
	85	[18] = "UNKNOWN MODULE",
	86	[19] = "UNKNOWN MODULE",
	87	[20] = "Colibri T20 256MB",
	88	[21] = "Colibri T20 512MB",
	89	[22] = "Colibri T20 512MB IT",
	90	[23] = "Colibri T30 1GB",
	91	[24] = "Colibri T20 256MB IT",
	92	[25] = "Apalis T30 2GB",
	93	[26] = "Apalis T30 1GB",
	94	[27] = "Apalis iMX6 Quad 1GB",
	95	[28] = "Apalis iMX6 Quad 2GB IT",
	96	[29] = "Apalis iMX6 Dual 512MB",
	97	[30] = "Colibri T30 1GB IT",
	98	[31] = "Apalis T30 1GB IT",
99	[32] = "Colibri iMX7 Solo 256MB",
100	[33] = "Colibri iMX7 Dual 512MB",
101	[34] = "Apalis TK1 2GB",
102	[35] = "Apalis iMX6 Dual 1GB IT",
d826b875	103	[36] = "Colibri iMX6ULL 256MB",
4adc9fc1 MZ	104	[37] = "Apalis iMX8 QuadMax 4GB Wi-Fi / BT IT",
4adc9fc1 MZ	105	[38] = "Colibri iMX8 QuadXPlus 2GB Wi-Fi / BT IT",
d826b875	106	[39] = "Colibri iMX7 Dual 1GB (eMMC)",
4adc9fc1	107	[40] = "Colibri iMX6ULL 512MB Wi-Fi / BT IT",
d826b875 SA	108	[41] = "Colibri iMX7 Dual 512MB EPDC",
d826b875 SA	109	[42] = "Apalis TK1 4GB",
08f80555 GS	110	[43] = "Colibri T20 512MB IT SETEK",
	111	[44] = "Colibri iMX6ULL 512MB IT",
	112	[45] = "Colibri iMX6ULL 512MB Wi-Fi / Bluetooth",
6988a3af MZ	113	[46] = "Apalis iMX8 QuadXPlus 2GB Wi-Fi / BT IT",
	114	[47] = "Apalis iMX8 QuadMax 4GB IT",
	115	[48] = "Apalis iMX8 QuadPlus 2GB Wi-Fi / BT",
	116	[49] = "Apalis iMX8 QuadPlus 2GB",
	117	[50] = "Colibri iMX8 QuadXPlus 2GB IT",
	118	[51] = "Colibri iMX8 DualX 1GB Wi-Fi / Bluetooth",
	119	[52] = "Colibri iMX8 DualX 1GB",
842ddf8e MZ	120	[53] = "Apalis iMX8 QuadXPlus 2GB ECC IT",
842ddf8e MZ	121	[54] = "Apalis iMX8 DualXPlus 1GB",
c0c3978c MZ	122	[55] = "Verdin iMX8M Mini Quad 2GB Wi-Fi / BT IT",
	123	[56] = "Verdin iMX8M Nano SoloLite 1GB", /* not currently on sale */
	124	[57] = "Verdin iMX8M Mini DualLite 1GB",
a2777ecb MZ	125	};
	126
	127	#ifdef CONFIG_TDX_CFG_BLOCK_IS_IN_MMC
	128	static int tdx_cfg_block_mmc_storage(u8 *config_block, int write)
	129	{
	130	struct mmc *mmc;
	131	int dev = CONFIG_TDX_CFG_BLOCK_DEV;
	132	int offset = CONFIG_TDX_CFG_BLOCK_OFFSET;
	133	uint part = CONFIG_TDX_CFG_BLOCK_PART;
	134	uint blk_start;
	135	int ret = 0;
	136
	137	/* Read production parameter config block from eMMC */
	138	mmc = find_mmc_device(dev);
	139	if (!mmc) {
	140	puts("No MMC card found\n");
	141	ret = -ENODEV;
	142	goto out;
	143	}
42a4f182 SA	144	if (mmc_init(mmc)) {
	145	puts("MMC init failed\n");
	146	return -EINVAL;
	147	}
0e513e78	148	if (part != mmc_get_blk_desc(mmc)->hwpart) {
a2777ecb MZ	149	if (blk_select_hwpart_devnum(IF_TYPE_MMC, dev, part)) {
	150	puts("MMC partition switch failed\n");
	151	ret = -ENODEV;
	152	goto out;
	153	}
	154	}
	155	if (offset < 0)
	156	offset += mmc->capacity;
	157	blk_start = ALIGN(offset, mmc->write_bl_len) / mmc->write_bl_len;
	158
	159	if (!write) {
	160	/* Careful reads a whole block of 512 bytes into config_block */
	161	if (blk_dread(mmc_get_blk_desc(mmc), blk_start, 1,
	162	(unsigned char *)config_block) != 1) {
	163	ret = -EIO;
	164	goto out;
	165	}
a2777ecb MZ	166	} else {
	167	/* Just writing one 512 byte block */
	168	if (blk_dwrite(mmc_get_blk_desc(mmc), blk_start, 1,
	169	(unsigned char *)config_block) != 1) {
	170	ret = -EIO;
	171	goto out;
	172	}
	173	}
	174
	175	out:
	176	/* Switch back to regular eMMC user partition */
	177	blk_select_hwpart_devnum(IF_TYPE_MMC, 0, 0);
	178
	179	return ret;
	180	}
	181	#endif
	182
	183	#ifdef CONFIG_TDX_CFG_BLOCK_IS_IN_NAND
	184	static int read_tdx_cfg_block_from_nand(unsigned char *config_block)
	185	{
	186	size_t size = TDX_CFG_BLOCK_MAX_SIZE;
bc53fb19 SA	187	struct mtd_info *mtd = get_nand_dev_by_index(0);
	188
	189	if (!mtd)
	190	return -ENODEV;
a2777ecb MZ	191
a2777ecb MZ	192	/* Read production parameter config block from NAND page */
bc53fb19	193	return nand_read_skip_bad(mtd, CONFIG_TDX_CFG_BLOCK_OFFSET,
bf264cd0 GS	194	&size, NULL, TDX_CFG_BLOCK_MAX_SIZE,
bf264cd0 GS	195	config_block);
a2777ecb MZ	196	}
	197
	198	static int write_tdx_cfg_block_to_nand(unsigned char *config_block)
	199	{
	200	size_t size = TDX_CFG_BLOCK_MAX_SIZE;
	201
	202	/* Write production parameter config block to NAND page */
bf264cd0 GS	203	return nand_write_skip_bad(get_nand_dev_by_index(0),
bf264cd0 GS	204	CONFIG_TDX_CFG_BLOCK_OFFSET,
a2777ecb MZ	205	&size, NULL, TDX_CFG_BLOCK_MAX_SIZE,
	206	config_block, WITH_WR_VERIFY);
	207	}
	208	#endif
	209
	210	#ifdef CONFIG_TDX_CFG_BLOCK_IS_IN_NOR
	211	static int read_tdx_cfg_block_from_nor(unsigned char *config_block)
	212	{
	213	/* Read production parameter config block from NOR flash */
	214	memcpy(config_block, (void *)CONFIG_TDX_CFG_BLOCK_OFFSET,
	215	TDX_CFG_BLOCK_MAX_SIZE);
	216	return 0;
	217	}
	218
	219	static int write_tdx_cfg_block_to_nor(unsigned char *config_block)
	220	{
	221	/* Write production parameter config block to NOR flash */
	222	return flash_write((void *)config_block, CONFIG_TDX_CFG_BLOCK_OFFSET,
	223	TDX_CFG_BLOCK_MAX_SIZE);
	224	}
	225	#endif
	226
	227	int read_tdx_cfg_block(void)
	228	{
	229	int ret = 0;
	230	u8 *config_block = NULL;
	231	struct toradex_tag *tag;
	232	size_t size = TDX_CFG_BLOCK_MAX_SIZE;
	233	int offset;
	234
	235	/* Allocate RAM area for config block */
	236	config_block = memalign(ARCH_DMA_MINALIGN, size);
	237	if (!config_block) {
	238	printf("Not enough malloc space available!\n");
	239	return -ENOMEM;
	240	}
	241
	242	memset(config_block, 0, size);
	243
	244	#if defined(CONFIG_TDX_CFG_BLOCK_IS_IN_MMC)
	245	ret = tdx_cfg_block_mmc_storage(config_block, 0);
	246	#elif defined(CONFIG_TDX_CFG_BLOCK_IS_IN_NAND)
	247	ret = read_tdx_cfg_block_from_nand(config_block);
	248	#elif defined(CONFIG_TDX_CFG_BLOCK_IS_IN_NOR)
	249	ret = read_tdx_cfg_block_from_nor(config_block);
	250	#else
	251	ret = -EINVAL;
	252	#endif
	253	if (ret)
	254	goto out;
	255
	256	/* Expect a valid tag first */
	257	tag = (struct toradex_tag *)config_block;
	258	if (tag->flags != TAG_FLAG_VALID \|\| tag->id != TAG_VALID) {
	259	valid_cfgblock = false;
	260	ret = -EINVAL;
	261	goto out;
	262	}
	263	valid_cfgblock = true;
	264	offset = 4;
	265
	266	while (offset < TDX_CFG_BLOCK_MAX_SIZE) {
	267	tag = (struct toradex_tag *)(config_block + offset);
	268	offset += 4;
269	if (tag->id == TAG_INVALID)
270	break;
271
272	if (tag->flags == TAG_FLAG_VALID) {
273	switch (tag->id) {
274	case TAG_MAC:
275	memcpy(&tdx_eth_addr, config_block + offset,
276	6);
277
278	/* NIC part of MAC address is serial number */
279	tdx_serial = ntohl(tdx_eth_addr.nic) >> 8;
280	break;
281	case TAG_HW:
282	memcpy(&tdx_hw_tag, config_block + offset, 8);
283	break;
284	}
285	}
286
287	/* Get to next tag according to current tags length */
288	offset += tag->len * 4;
289	}
290
291	/* Cap product id to avoid issues with a yet unknown one */
ccdd3713	292	if (tdx_hw_tag.prodid >= (sizeof(toradex_modules) /
a2777ecb MZ	293	sizeof(toradex_modules[0])))
	294	tdx_hw_tag.prodid = 0;
	295
	296	out:
	297	free(config_block);
	298	return ret;
	299	}
	300
	301	static int get_cfgblock_interactive(void)
	302	{
	303	char message[CONFIG_SYS_CBSIZE];
	304	char *soc;
	305	char it = 'n';
d1aa1444	306	char wb = 'n';
c0c3978c	307	int len = 0;
a2777ecb	308
89315f31 SA	309	/* Unknown module by default */
	310	tdx_hw_tag.prodid = 0;
	311
a2777ecb MZ	312	if (cpu_is_pxa27x())
a2777ecb MZ	313	sprintf(message, "Is the module the 312 MHz version? [y/N] ");
c0c3978c	314	#if !defined(CONFIG_TARGET_VERDIN_IMX8MM) \|\| !defined(CONFIG_TARGET_VERDIN_IMX8MN)
a2777ecb MZ	315	else
a2777ecb MZ	316	sprintf(message, "Is the module an IT version? [y/N] ");
c0c3978c	317
a2777ecb MZ	318	len = cli_readline(message);
a2777ecb MZ	319	it = console_buffer[0];
c0c3978c MZ	320	#else
	321	else
	322	it = 'y';
	323	#endif
	324
a2777ecb	325
d1aa1444	326	#if defined(CONFIG_TARGET_APALIS_IMX8) \|\| \
842ddf8e	327	defined(CONFIG_TARGET_APALIS_IMX8X) \|\| \
d1aa1444 MZ	328	defined(CONFIG_TARGET_COLIBRI_IMX6ULL) \|\| \
	329	defined(CONFIG_TARGET_COLIBRI_IMX8X)
	330	sprintf(message, "Does the module have Wi-Fi / Bluetooth? [y/N] ");
	331	len = cli_readline(message);
	332	wb = console_buffer[0];
	333	#endif
	334
00caae6d	335	soc = env_get("soc");
a2777ecb	336	if (!strcmp("mx6", soc)) {
89315f31 SA	337	#ifdef CONFIG_TARGET_APALIS_IMX6
89315f31 SA	338	if (it == 'y' \|\| it == 'Y') {
a2777ecb MZ	339	if (is_cpu_type(MXC_CPU_MX6Q))
	340	tdx_hw_tag.prodid = APALIS_IMX6Q_IT;
	341	else
	342	tdx_hw_tag.prodid = APALIS_IMX6D_IT;
89315f31	343	} else {
a2777ecb MZ	344	if (is_cpu_type(MXC_CPU_MX6Q))
	345	tdx_hw_tag.prodid = APALIS_IMX6Q;
	346	else
	347	tdx_hw_tag.prodid = APALIS_IMX6D;
89315f31 SA	348	}
89315f31 SA	349	#elif CONFIG_TARGET_COLIBRI_IMX6
08f80555	350	if (it == 'y' \|\| it == 'Y') {
89315f31	351	if (is_cpu_type(MXC_CPU_MX6DL))
a2777ecb	352	tdx_hw_tag.prodid = COLIBRI_IMX6DL_IT;
89315f31	353	else if (is_cpu_type(MXC_CPU_MX6SOLO))
a2777ecb	354	tdx_hw_tag.prodid = COLIBRI_IMX6S_IT;
08f80555	355	} else {
89315f31	356	if (is_cpu_type(MXC_CPU_MX6DL))
a2777ecb	357	tdx_hw_tag.prodid = COLIBRI_IMX6DL;
89315f31	358	else if (is_cpu_type(MXC_CPU_MX6SOLO))
a2777ecb	359	tdx_hw_tag.prodid = COLIBRI_IMX6S;
08f80555	360	}
89315f31	361	#elif CONFIG_TARGET_COLIBRI_IMX6ULL
89315f31 SA	362	if (it == 'y' \|\| it == 'Y') {
	363	if (wb == 'y' \|\| wb == 'Y')
	364	tdx_hw_tag.prodid = COLIBRI_IMX6ULL_WIFI_BT_IT;
	365	else
	366	tdx_hw_tag.prodid = COLIBRI_IMX6ULL_IT;
	367	} else {
	368	if (wb == 'y' \|\| wb == 'Y')
	369	tdx_hw_tag.prodid = COLIBRI_IMX6ULL_WIFI_BT;
	370	else
	371	tdx_hw_tag.prodid = COLIBRI_IMX6ULL;
	372	}
	373	#endif
08f80555	374	} else if (!strcmp("imx7d", soc))
a2777ecb	375	tdx_hw_tag.prodid = COLIBRI_IMX7D;
08f80555	376	else if (!strcmp("imx7s", soc))
a2777ecb	377	tdx_hw_tag.prodid = COLIBRI_IMX7S;
c0c3978c MZ	378	else if (is_cpu_type(MXC_CPU_IMX8MM))
	379	tdx_hw_tag.prodid = VERDIN_IMX8MMQ_WIFI_BT_IT;
	380	else if (is_cpu_type(MXC_CPU_IMX8MMDL))
	381	tdx_hw_tag.prodid = VERDIN_IMX8MMDL;
	382	else if (is_cpu_type(MXC_CPU_IMX8MN))
	383	tdx_hw_tag.prodid = VERDIN_IMX8MNSL;
9d63c7d8 MZ	384	else if (is_cpu_type(MXC_CPU_IMX8QM)) {
	385	if (it == 'y' \|\| it == 'Y') {
	386	if (wb == 'y' \|\| wb == 'Y')
	387	tdx_hw_tag.prodid = APALIS_IMX8QM_WIFI_BT_IT;
	388	else
	389	tdx_hw_tag.prodid = APALIS_IMX8QM_IT;
	390	} else {
	391	if (wb == 'y' \|\| wb == 'Y')
	392	tdx_hw_tag.prodid = APALIS_IMX8QP_WIFI_BT;
	393	else
	394	tdx_hw_tag.prodid = APALIS_IMX8QP;
	395	}
	396	} else if (is_cpu_type(MXC_CPU_IMX8QXP)) {
842ddf8e MZ	397	#ifdef CONFIG_TARGET_APALIS_IMX8X
	398	if (it == 'y' \|\| it == 'Y' \|\| wb == 'y' \|\| wb == 'Y') {
	399	tdx_hw_tag.prodid = APALIS_IMX8QXP_WIFI_BT_IT;
	400	} else {
	401	if (gd->ram_size == 0x40000000)
	402	tdx_hw_tag.prodid = APALIS_IMX8DXP;
	403	else
	404	tdx_hw_tag.prodid = APALIS_IMX8QXP;
	405	}
	406	#elif CONFIG_TARGET_COLIBRI_IMX8X
6c297ee8 MZ	407	if (it == 'y' \|\| it == 'Y') {
	408	if (wb == 'y' \|\| wb == 'Y')
	409	tdx_hw_tag.prodid = COLIBRI_IMX8QXP_WIFI_BT_IT;
	410	else
	411	tdx_hw_tag.prodid = COLIBRI_IMX8QXP_IT;
	412	} else {
	413	if (wb == 'y' \|\| wb == 'Y')
	414	tdx_hw_tag.prodid = COLIBRI_IMX8DX_WIFI_BT;
	415	else
	416	tdx_hw_tag.prodid = COLIBRI_IMX8DX;
	417	}
842ddf8e	418	#endif
6c297ee8	419	} else if (!strcmp("tegra20", soc)) {
a2777ecb MZ	420	if (it == 'y' \|\| it == 'Y')
	421	if (gd->ram_size == 0x10000000)
	422	tdx_hw_tag.prodid = COLIBRI_T20_256MB_IT;
	423	else
	424	tdx_hw_tag.prodid = COLIBRI_T20_512MB_IT;
	425	else
	426	if (gd->ram_size == 0x10000000)
	427	tdx_hw_tag.prodid = COLIBRI_T20_256MB;
	428	else
	429	tdx_hw_tag.prodid = COLIBRI_T20_512MB;
	430	} else if (cpu_is_pxa27x()) {
	431	if (it == 'y' \|\| it == 'Y')
	432	tdx_hw_tag.prodid = COLIBRI_PXA270_312MHZ;
	433	else
	434	tdx_hw_tag.prodid = COLIBRI_PXA270_520MHZ;
08f80555	435	}
a2777ecb	436	#ifdef CONFIG_MACH_TYPE
08f80555	437	else if (!strcmp("tegra30", soc)) {
a2777ecb MZ	438	if (CONFIG_MACH_TYPE == MACH_TYPE_APALIS_T30) {
	439	if (it == 'y' \|\| it == 'Y')
	440	tdx_hw_tag.prodid = APALIS_T30_IT;
	441	else
	442	if (gd->ram_size == 0x40000000)
	443	tdx_hw_tag.prodid = APALIS_T30_1GB;
	444	else
	445	tdx_hw_tag.prodid = APALIS_T30_2GB;
	446	} else {
	447	if (it == 'y' \|\| it == 'Y')
	448	tdx_hw_tag.prodid = COLIBRI_T30_IT;
	449	else
	450	tdx_hw_tag.prodid = COLIBRI_T30;
	451	}
08f80555	452	}
a2777ecb	453	#endif /* CONFIG_MACH_TYPE */
08f80555	454	else if (!strcmp("tegra124", soc)) {
a2777ecb MZ	455	tdx_hw_tag.prodid = APALIS_TK1_2GB;
	456	} else if (!strcmp("vf500", soc)) {
	457	if (it == 'y' \|\| it == 'Y')
	458	tdx_hw_tag.prodid = COLIBRI_VF50_IT;
	459	else
	460	tdx_hw_tag.prodid = COLIBRI_VF50;
	461	} else if (!strcmp("vf610", soc)) {
	462	if (it == 'y' \|\| it == 'Y')
	463	tdx_hw_tag.prodid = COLIBRI_VF61_IT;
	464	else
	465	tdx_hw_tag.prodid = COLIBRI_VF61;
89315f31 SA	466	}
	467
	468	if (!tdx_hw_tag.prodid) {
a2777ecb MZ	469	printf("Module type not detectable due to unknown SoC\n");
	470	return -1;
	471	}
	472
	473	while (len < 4) {
	474	sprintf(message, "Enter the module version (e.g. V1.1B): V");
	475	len = cli_readline(message);
	476	}
	477
	478	tdx_hw_tag.ver_major = console_buffer[0] - '0';
	479	tdx_hw_tag.ver_minor = console_buffer[2] - '0';
	480	tdx_hw_tag.ver_assembly = console_buffer[3] - 'A';
	481
08f80555	482	if (cpu_is_pxa27x() && tdx_hw_tag.ver_major == 1)
a2777ecb MZ	483	tdx_hw_tag.prodid -= (COLIBRI_PXA270_312MHZ -
	484	COLIBRI_PXA270_V1_312MHZ);
	485
	486	while (len < 8) {
	487	sprintf(message, "Enter module serial number: ");
	488	len = cli_readline(message);
	489	}
	490
	491	tdx_serial = simple_strtoul(console_buffer, NULL, 10);
	492
	493	return 0;
	494	}
	495
	496	static int get_cfgblock_barcode(char *barcode)
	497	{
	498	if (strlen(barcode) < 16) {
	499	printf("Argument too short, barcode is 16 chars long\n");
	500	return -1;
	501	}
	502
	503	/* Get hardware information from the first 8 digits */
	504	tdx_hw_tag.ver_major = barcode[4] - '0';
	505	tdx_hw_tag.ver_minor = barcode[5] - '0';
	506	tdx_hw_tag.ver_assembly = barcode[7] - '0';
	507
	508	barcode[4] = '\0';
	509	tdx_hw_tag.prodid = simple_strtoul(barcode, NULL, 10);
	510
	511	/* Parse second part of the barcode (serial number */
	512	barcode += 8;
	513	tdx_serial = simple_strtoul(barcode, NULL, 10);
	514
	515	return 0;
	516	}
	517
09140113 SG	518	static int do_cfgblock_create(struct cmd_tbl *cmdtp, int flag, int argc,
09140113 SG	519	char *const argv[])
a2777ecb MZ	520	{
	521	u8 *config_block;
	522	struct toradex_tag *tag;
	523	size_t size = TDX_CFG_BLOCK_MAX_SIZE;
	524	int offset = 0;
	525	int ret = CMD_RET_SUCCESS;
	526	int err;
587b13c6	527	int force_overwrite = 0;
a2777ecb MZ	528
	529	/* Allocate RAM area for config block */
	530	config_block = memalign(ARCH_DMA_MINALIGN, size);
	531	if (!config_block) {
	532	printf("Not enough malloc space available!\n");
	533	return CMD_RET_FAILURE;
	534	}
	535
	536	memset(config_block, 0xff, size);
	537
587b13c6 DS	538	if (argc >= 3) {
	539	if (argv[2][0] == '-' && argv[2][1] == 'y')
	540	force_overwrite = 1;
	541	}
	542
a2777ecb MZ	543	read_tdx_cfg_block();
	544	if (valid_cfgblock) {
	545	#if defined(CONFIG_TDX_CFG_BLOCK_IS_IN_NAND)
	546	/*
	547	* On NAND devices, recreation is only allowed if the page is
	548	* empty (config block invalid...)
	549	*/
9d364ebd	550	printf("NAND erase block %d need to be erased before creating a Toradex config block\n",
bf264cd0 GS	551	CONFIG_TDX_CFG_BLOCK_OFFSET /
bf264cd0 GS	552	get_nand_dev_by_index(0)->erasesize);
a2777ecb MZ	553	goto out;
	554	#elif defined(CONFIG_TDX_CFG_BLOCK_IS_IN_NOR)
	555	/*
	556	* On NOR devices, recreation is only allowed if the sector is
	557	* empty and write protection is off (config block invalid...)
	558	*/
9d364ebd	559	printf("NOR sector at offset 0x%02x need to be erased and unprotected before creating a Toradex config block\n",
a2777ecb MZ	560	CONFIG_TDX_CFG_BLOCK_OFFSET);
	561	goto out;
	562	#else
587b13c6 DS	563	if (!force_overwrite) {
587b13c6 DS	564	char message[CONFIG_SYS_CBSIZE];
a2777ecb	565
587b13c6 DS	566	sprintf(message,
587b13c6 DS	567	"A valid Toradex config block is present, still recreate? [y/N] ");
a2777ecb	568
587b13c6 DS	569	if (!cli_readline(message))
	570	goto out;
	571
	572	if (console_buffer[0] != 'y' &&
	573	console_buffer[0] != 'Y')
	574	goto out;
	575	}
a2777ecb MZ	576	#endif
	577	}
	578
	579	/* Parse new Toradex config block data... */
587b13c6	580	if (argc < 3 \|\| (force_overwrite && argc < 4)) {
a2777ecb	581	err = get_cfgblock_interactive();
587b13c6 DS	582	} else {
	583	if (force_overwrite)
	584	err = get_cfgblock_barcode(argv[3]);
	585	else
	586	err = get_cfgblock_barcode(argv[2]);
	587	}
a2777ecb MZ	588	if (err) {
	589	ret = CMD_RET_FAILURE;
	590	goto out;
	591	}
	592
	593	/* Convert serial number to MAC address (the storage format) */
	594	tdx_eth_addr.oui = htonl(0x00142dUL << 8);
	595	tdx_eth_addr.nic = htonl(tdx_serial << 8);
	596
	597	/* Valid Tag */
	598	tag = (struct toradex_tag *)config_block;
	599	tag->id = TAG_VALID;
	600	tag->flags = TAG_FLAG_VALID;
	601	tag->len = 0;
	602	offset += 4;
	603
	604	/* Product Tag */
	605	tag = (struct toradex_tag *)(config_block + offset);
	606	tag->id = TAG_HW;
	607	tag->flags = TAG_FLAG_VALID;
	608	tag->len = 2;
	609	offset += 4;
	610
	611	memcpy(config_block + offset, &tdx_hw_tag, 8);
	612	offset += 8;
	613
	614	/* MAC Tag */
	615	tag = (struct toradex_tag *)(config_block + offset);
	616	tag->id = TAG_MAC;
	617	tag->flags = TAG_FLAG_VALID;
	618	tag->len = 2;
	619	offset += 4;
	620
	621	memcpy(config_block + offset, &tdx_eth_addr, 6);
	622	offset += 6;
	623	memset(config_block + offset, 0, 32 - offset);
	624
	625	#if defined(CONFIG_TDX_CFG_BLOCK_IS_IN_MMC)
	626	err = tdx_cfg_block_mmc_storage(config_block, 1);
	627	#elif defined(CONFIG_TDX_CFG_BLOCK_IS_IN_NAND)
	628	err = write_tdx_cfg_block_to_nand(config_block);
	629	#elif defined(CONFIG_TDX_CFG_BLOCK_IS_IN_NOR)
	630	err = write_tdx_cfg_block_to_nor(config_block);
	631	#else
	632	err = -EINVAL;
	633	#endif
	634	if (err) {
	635	printf("Failed to write Toradex config block: %d\n", ret);
	636	ret = CMD_RET_FAILURE;
	637	goto out;
	638	}
	639
	640	printf("Toradex config block successfully written\n");
	641
	642	out:
	643	free(config_block);
	644	return ret;
	645	}
	646
09140113 SG	647	static int do_cfgblock(struct cmd_tbl *cmdtp, int flag, int argc,
09140113 SG	648	char *const argv[])
a2777ecb MZ	649	{
	650	int ret;
	651
	652	if (argc < 2)
	653	return CMD_RET_USAGE;
	654
	655	if (!strcmp(argv[1], "create")) {
	656	return do_cfgblock_create(cmdtp, flag, argc, argv);
	657	} else if (!strcmp(argv[1], "reload")) {
	658	ret = read_tdx_cfg_block();
	659	if (ret) {
	660	printf("Failed to reload Toradex config block: %d\n",
	661	ret);
	662	return CMD_RET_FAILURE;
	663	}
	664	return CMD_RET_SUCCESS;
	665	}
	666
	667	return CMD_RET_USAGE;
	668	}
	669
9d364ebd MZ	670	U_BOOT_CMD(cfgblock, 4, 0, do_cfgblock,
	671	"Toradex config block handling commands",
	672	"create [-y] [barcode] - (Re-)create Toradex config block\n"
	673	"cfgblock reload - Reload Toradex config block from flash"
a2777ecb	674	);