[people/ms/u-boot.git] / arch / arm / mach-omap2 / utils.c

/*
 * Copyright 2011 Linaro Limited
 * Aneesh V <aneesh@ti.com>
 *
 * SPDX-License-Identifier:	GPL-2.0+
 */
#include <common.h>
#include <asm/setup.h>
#include <asm/arch/sys_proto.h>
static void do_cancel_out(u32 *num, u32 *den, u32 factor)
{
	while (1) {
		if (((*num)/factor*factor == (*num)) &&
		   ((*den)/factor*factor == (*den))) {
			(*num) /= factor;
			(*den) /= factor;
		} else
			break;
	}
}

#ifdef CONFIG_FASTBOOT_FLASH
static void omap_set_fastboot_cpu(void)
{
	char *cpu;
	u32 cpu_rev = omap_revision();

	switch (cpu_rev) {
	case DRA752_ES1_0:
	case DRA752_ES1_1:
	case DRA752_ES2_0:
		cpu = "DRA752";
		break;
	case DRA722_ES1_0:
	case DRA722_ES2_0:
	case DRA722_ES2_1:
		cpu = "DRA722";
		break;
	default:
		cpu = NULL;
		printf("Warning: fastboot.cpu: unknown CPU rev: %u\n", cpu_rev);
	}

	env_set("fastboot.cpu", cpu);
}

static void omap_set_fastboot_secure(void)
{
	const char *secure;
	u32 dev = get_device_type();

	switch (dev) {
	case EMU_DEVICE:
		secure = "EMU";
		break;
	case HS_DEVICE:
		secure = "HS";
		break;
	case GP_DEVICE:
		secure = "GP";
		break;
	default:
		secure = NULL;
		printf("Warning: fastboot.secure: unknown CPU sec: %u\n", dev);
	}

	env_set("fastboot.secure", secure);
}

static void omap_set_fastboot_board_rev(void)
{
	const char *board_rev;

	board_rev = env_get("board_rev");
	if (board_rev == NULL)
		printf("Warning: fastboot.board_rev: unknown board revision\n");

	env_set("fastboot.board_rev", board_rev);
}

#ifdef CONFIG_FASTBOOT_FLASH_MMC_DEV
static u32 omap_mmc_get_part_size(const char *part)
{
	int res;
	struct blk_desc *dev_desc;
	disk_partition_t info;
	u64 sz = 0;

	dev_desc = blk_get_dev("mmc", CONFIG_FASTBOOT_FLASH_MMC_DEV);
	if (!dev_desc || dev_desc->type == DEV_TYPE_UNKNOWN) {
		pr_err("invalid mmc device\n");
		return 0;
	}

	/* Check only for EFI (GPT) partition table */
	res = part_get_info_by_name_type(dev_desc, part, &info, PART_TYPE_EFI);
	if (res < 0)
		return 0;

	/* Calculate size in bytes */
	sz = (info.size * (u64)info.blksz);
	/* to KiB */
	sz >>= 10;

	return (u32)sz;
}

static void omap_set_fastboot_userdata_size(void)
{
	char buf[16];
	u32 sz_kb;

	sz_kb = omap_mmc_get_part_size("userdata");
	if (sz_kb == 0)
		return; /* probably it's not Android partition table */

	sprintf(buf, "%u", sz_kb);
	env_set("fastboot.userdata_size", buf);
}
#else
static inline void omap_set_fastboot_userdata_size(void)
{
}
#endif /* CONFIG_FASTBOOT_FLASH_MMC_DEV */
void omap_set_fastboot_vars(void)
{
	omap_set_fastboot_cpu();
	omap_set_fastboot_secure();
	omap_set_fastboot_board_rev();
	omap_set_fastboot_userdata_size();
}
#endif /* CONFIG_FASTBOOT_FLASH */

/*
 * Cancel out the denominator and numerator of a fraction
 * to get smaller numerator and denominator.
 */
void cancel_out(u32 *num, u32 *den, u32 den_limit)
{
	do_cancel_out(num, den, 2);
	do_cancel_out(num, den, 3);
	do_cancel_out(num, den, 5);
	do_cancel_out(num, den, 7);
	do_cancel_out(num, den, 11);
	do_cancel_out(num, den, 13);
	do_cancel_out(num, den, 17);
	while ((*den) > den_limit) {
		*num /= 2;
		/*
		 * Round up the denominator so that the final fraction
		 * (num/den) is always <= the desired value
		 */
		*den = (*den + 1) / 2;
	}
}

__weak void omap_die_id(unsigned int *die_id)
{
	die_id[0] = die_id[1] = die_id[2] = die_id[3] = 0;
}

void omap_die_id_serial(void)
{
	unsigned int die_id[4] = { 0 };
	char serial_string[17] = { 0 };

	omap_die_id((unsigned int *)&die_id);

	if (!env_get("serial#")) {
		snprintf(serial_string, sizeof(serial_string),
			"%08x%08x", die_id[0], die_id[3]);

		env_set("serial#", serial_string);
	}
}

void omap_die_id_get_board_serial(struct tag_serialnr *serialnr)
{
	char *serial_string;
	unsigned long long serial;

	serial_string = env_get("serial#");

	if (serial_string) {
		serial = simple_strtoull(serial_string, NULL, 16);

		serialnr->high = (unsigned int) (serial >> 32);
		serialnr->low = (unsigned int) (serial & 0xffffffff);
	} else {
		serialnr->high = 0;
		serialnr->low = 0;
	}
}

void omap_die_id_usbethaddr(void)
{
	unsigned int die_id[4] = { 0 };
	unsigned char mac[6] = { 0 };

	omap_die_id((unsigned int *)&die_id);

	if (!env_get("usbethaddr")) {
		/*
		 * Create a fake MAC address from the processor ID code.
		 * First byte is 0x02 to signify locally administered.
		 */
		mac[0] = 0x02;
		mac[1] = die_id[3] & 0xff;
		mac[2] = die_id[2] & 0xff;
		mac[3] = die_id[1] & 0xff;
		mac[4] = die_id[0] & 0xff;
		mac[5] = (die_id[0] >> 8) & 0xff;

		eth_env_set_enetaddr("usbethaddr", mac);
	}
}

void omap_die_id_display(void)
{
	unsigned int die_id[4] = { 0 };

	omap_die_id(die_id);

	printf("OMAP die ID: %08x%08x%08x%08x\n", die_id[3], die_id[2],
		die_id[1], die_id[0]);
}
Commit	Line	Data
095aea29 A	1	/*
	2	* Copyright 2011 Linaro Limited
	3	* Aneesh V <aneesh@ti.com>
	4	*
1a459660	5	* SPDX-License-Identifier: GPL-2.0+
095aea29 A	6	*/
095aea29 A	7	#include <common.h>
5d982856	8	#include <asm/setup.h>
8a0c6d6f	9	#include <asm/arch/sys_proto.h>
095aea29 A	10	static void do_cancel_out(u32 num, u32 den, u32 factor)
	11	{
	12	while (1) {
	13	if (((num)/factorfactor == (*num)) &&
	14	((den)/factorfactor == (*den))) {
	15	(*num) /= factor;
	16	(*den) /= factor;
	17	} else
	18	break;
	19	}
	20	}
	21
fa24eca1 SP	22	#ifdef CONFIG_FASTBOOT_FLASH
	23	static void omap_set_fastboot_cpu(void)
	24	{
	25	char *cpu;
	26	u32 cpu_rev = omap_revision();
	27
	28	switch (cpu_rev) {
	29	case DRA752_ES1_0:
	30	case DRA752_ES1_1:
	31	case DRA752_ES2_0:
	32	cpu = "DRA752";
	33	break;
	34	case DRA722_ES1_0:
	35	case DRA722_ES2_0:
b6df9359	36	case DRA722_ES2_1:
fa24eca1 SP	37	cpu = "DRA722";
	38	break;
	39	default:
	40	cpu = NULL;
	41	printf("Warning: fastboot.cpu: unknown CPU rev: %u\n", cpu_rev);
	42	}
	43
382bee57	44	env_set("fastboot.cpu", cpu);
fa24eca1 SP	45	}
	46
	47	static void omap_set_fastboot_secure(void)
	48	{
	49	const char *secure;
	50	u32 dev = get_device_type();
	51
	52	switch (dev) {
	53	case EMU_DEVICE:
	54	secure = "EMU";
	55	break;
	56	case HS_DEVICE:
	57	secure = "HS";
	58	break;
	59	case GP_DEVICE:
	60	secure = "GP";
	61	break;
	62	default:
	63	secure = NULL;
	64	printf("Warning: fastboot.secure: unknown CPU sec: %u\n", dev);
	65	}
	66
382bee57	67	env_set("fastboot.secure", secure);
fa24eca1 SP	68	}
	69
	70	static void omap_set_fastboot_board_rev(void)
	71	{
	72	const char *board_rev;
	73
00caae6d	74	board_rev = env_get("board_rev");
fa24eca1 SP	75	if (board_rev == NULL)
	76	printf("Warning: fastboot.board_rev: unknown board revision\n");
	77
382bee57	78	env_set("fastboot.board_rev", board_rev);
fa24eca1 SP	79	}
	80
	81	#ifdef CONFIG_FASTBOOT_FLASH_MMC_DEV
	82	static u32 omap_mmc_get_part_size(const char *part)
	83	{
	84	int res;
	85	struct blk_desc *dev_desc;
	86	disk_partition_t info;
	87	u64 sz = 0;
	88
	89	dev_desc = blk_get_dev("mmc", CONFIG_FASTBOOT_FLASH_MMC_DEV);
	90	if (!dev_desc \|\| dev_desc->type == DEV_TYPE_UNKNOWN) {
9b643e31	91	pr_err("invalid mmc device\n");
fa24eca1 SP	92	return 0;
	93	}
	94
26857766 SP	95	/* Check only for EFI (GPT) partition table */
26857766 SP	96	res = part_get_info_by_name_type(dev_desc, part, &info, PART_TYPE_EFI);
19d141a0	97	if (res < 0)
fa24eca1	98	return 0;
fa24eca1 SP	99
	100	/* Calculate size in bytes */
	101	sz = (info.size * (u64)info.blksz);
	102	/* to KiB */
	103	sz >>= 10;
	104
	105	return (u32)sz;
	106	}
	107
	108	static void omap_set_fastboot_userdata_size(void)
	109	{
	110	char buf[16];
	111	u32 sz_kb;
	112
	113	sz_kb = omap_mmc_get_part_size("userdata");
19d141a0 SP	114	if (sz_kb == 0)
19d141a0 SP	115	return; /* probably it's not Android partition table */
fa24eca1	116
19d141a0	117	sprintf(buf, "%u", sz_kb);
382bee57	118	env_set("fastboot.userdata_size", buf);
fa24eca1 SP	119	}
	120	#else
	121	static inline void omap_set_fastboot_userdata_size(void)
	122	{
	123	}
	124	#endif /* CONFIG_FASTBOOT_FLASH_MMC_DEV */
	125	void omap_set_fastboot_vars(void)
	126	{
	127	omap_set_fastboot_cpu();
	128	omap_set_fastboot_secure();
	129	omap_set_fastboot_board_rev();
	130	omap_set_fastboot_userdata_size();
	131	}
	132	#endif /* CONFIG_FASTBOOT_FLASH */
	133
095aea29 A	134	/*
	135	* Cancel out the denominator and numerator of a fraction
	136	* to get smaller numerator and denominator.
	137	*/
	138	void cancel_out(u32 num, u32 den, u32 den_limit)
	139	{
	140	do_cancel_out(num, den, 2);
	141	do_cancel_out(num, den, 3);
	142	do_cancel_out(num, den, 5);
	143	do_cancel_out(num, den, 7);
	144	do_cancel_out(num, den, 11);
	145	do_cancel_out(num, den, 13);
	146	do_cancel_out(num, den, 17);
	147	while ((*den) > den_limit) {
	148	*num /= 2;
	149	/*
	150	* Round up the denominator so that the final fraction
	151	* (num/den) is always <= the desired value
	152	*/
	153	den = (den + 1) / 2;
	154	}
	155	}
8a0c6d6f	156
72931b15 PK	157	__weak void omap_die_id(unsigned int *die_id)
	158	{
	159	die_id[0] = die_id[1] = die_id[2] = die_id[3] = 0;
	160	}
	161
07815eb9	162	void omap_die_id_serial(void)
8a0c6d6f	163	{
07815eb9 PK	164	unsigned int die_id[4] = { 0 };
07815eb9 PK	165	char serial_string[17] = { 0 };
8a0c6d6f	166
07815eb9	167	omap_die_id((unsigned int *)&die_id);
8a0c6d6f	168
00caae6d	169	if (!env_get("serial#")) {
07815eb9 PK	170	snprintf(serial_string, sizeof(serial_string),
	171	"%08x%08x", die_id[0], die_id[3]);
	172
382bee57	173	env_set("serial#", serial_string);
8a0c6d6f NM	174	}
8a0c6d6f NM	175	}
f12467d1	176
2da87ab3 PK	177	void omap_die_id_get_board_serial(struct tag_serialnr *serialnr)
	178	{
	179	char *serial_string;
	180	unsigned long long serial;
	181
00caae6d	182	serial_string = env_get("serial#");
2da87ab3 PK	183
	184	if (serial_string) {
	185	serial = simple_strtoull(serial_string, NULL, 16);
	186
	187	serialnr->high = (unsigned int) (serial >> 32);
	188	serialnr->low = (unsigned int) (serial & 0xffffffff);
	189	} else {
	190	serialnr->high = 0;
	191	serialnr->low = 0;
	192	}
	193	}
	194
07815eb9	195	void omap_die_id_usbethaddr(void)
f12467d1	196	{
07815eb9 PK	197	unsigned int die_id[4] = { 0 };
07815eb9 PK	198	unsigned char mac[6] = { 0 };
f12467d1	199
07815eb9 PK	200	omap_die_id((unsigned int *)&die_id);
07815eb9 PK	201
00caae6d	202	if (!env_get("usbethaddr")) {
07815eb9 PK	203	/*
	204	* Create a fake MAC address from the processor ID code.
	205	* First byte is 0x02 to signify locally administered.
	206	*/
	207	mac[0] = 0x02;
	208	mac[1] = die_id[3] & 0xff;
	209	mac[2] = die_id[2] & 0xff;
	210	mac[3] = die_id[1] & 0xff;
	211	mac[4] = die_id[0] & 0xff;
	212	mac[5] = (die_id[0] >> 8) & 0xff;
	213
fd1e959e	214	eth_env_set_enetaddr("usbethaddr", mac);
f12467d1 DK	215	}
f12467d1 DK	216	}
679f82c3 PK	217
	218	void omap_die_id_display(void)
	219	{
	220	unsigned int die_id[4] = { 0 };
	221
	222	omap_die_id(die_id);
	223
e22455f0 LM	224	printf("OMAP die ID: %08x%08x%08x%08x\n", die_id[3], die_id[2],
e22455f0 LM	225	die_id[1], die_id[0]);
679f82c3	226	}