[J-u-boot.git] / board / samsung / common / misc.c

// SPDX-License-Identifier: GPL-2.0+
/*
 * Copyright (C) 2013 Samsung Electronics
 * Przemyslaw Marczak <[email protected]>
 */

#include <common.h>
#include <command.h>
#include <env.h>
#include <lcd.h>
#include <libtizen.h>
#include <asm/global_data.h>
#include <linux/delay.h>
#include <samsung/misc.h>
#include <errno.h>
#include <version.h>
#include <malloc.h>
#include <memalign.h>
#include <linux/sizes.h>
#include <asm/arch/cpu.h>
#include <asm/gpio.h>
#include <linux/input.h>
#include <dm.h>
/*
 * Use #ifdef to work around conflicting headers while we wait for this to be
 * converted to driver model.
 */
#ifdef CONFIG_DM_PMIC_MAX77686
#include <power/max77686_pmic.h>
#endif
#ifdef CONFIG_DM_PMIC_MAX8998
#include <power/max8998_pmic.h>
#endif
#ifdef CONFIG_PMIC_MAX8997
#include <power/max8997_pmic.h>
#endif
#include <power/pmic.h>
#include <mmc.h>

DECLARE_GLOBAL_DATA_PTR;

#ifdef CONFIG_SET_DFU_ALT_INFO
void set_dfu_alt_info(char *interface, char *devstr)
{
	size_t buf_size = CONFIG_SET_DFU_ALT_BUF_LEN;
	ALLOC_CACHE_ALIGN_BUFFER(char, buf, buf_size);
	char *alt_info = "Settings not found!";
	char *status = "error!\n";
	char *alt_setting;
	char *alt_sep;
	int offset = 0;

	puts("DFU alt info setting: ");

	alt_setting = get_dfu_alt_boot(interface, devstr);
	if (alt_setting) {
		env_set("dfu_alt_boot", alt_setting);
		offset = snprintf(buf, buf_size, "%s", alt_setting);
	}

	alt_setting = get_dfu_alt_system(interface, devstr);
	if (alt_setting) {
		if (offset)
			alt_sep = ";";
		else
			alt_sep = "";

		offset += snprintf(buf + offset, buf_size - offset,
				    "%s%s", alt_sep, alt_setting);
	}

	if (offset) {
		alt_info = buf;
		status = "done\n";
	}

	env_set("dfu_alt_info", alt_info);
	puts(status);
}
#endif

#ifdef CONFIG_ENV_VARS_UBOOT_RUNTIME_CONFIG
void set_board_info(void)
{
	char info[64];

	snprintf(info, ARRAY_SIZE(info), "%u.%u", (s5p_cpu_rev & 0xf0) >> 4,
		 s5p_cpu_rev & 0xf);
	env_set("soc_rev", info);

	snprintf(info, ARRAY_SIZE(info), "%x", s5p_cpu_id);
	env_set("soc_id", info);

#ifdef CONFIG_REVISION_TAG
	snprintf(info, ARRAY_SIZE(info), "%x", get_board_rev());
	env_set("board_rev", info);
#endif
#ifdef CONFIG_OF_LIBFDT
	const char *bdtype = "";
	const char *bdname = CONFIG_SYS_BOARD;

#ifdef CONFIG_BOARD_TYPES
	bdtype = get_board_type();
	if (!bdtype)
		bdtype = "";

	sprintf(info, "%s%s", bdname, bdtype);
	env_set("board_name", info);
#endif
	snprintf(info, ARRAY_SIZE(info),  "%s%x-%s%s.dtb",
		 CONFIG_SYS_SOC, s5p_cpu_id, bdname, bdtype);
	env_set("fdtfile", info);
#endif
}
#endif /* CONFIG_ENV_VARS_UBOOT_RUNTIME_CONFIG */

#ifdef CONFIG_LCD_MENU
static int power_key_pressed(u32 reg)
{
	struct udevice *dev;
	int ret;
	u32 status;
	u32 mask;

	if (IS_ENABLED(CONFIG_TARGET_TRATS))
		ret = pmic_get("max8997-pmic", &dev);
	else if (IS_ENABLED(CONFIG_TARGET_TRATS2))
		ret = pmic_get("max77686-pmic", &dev);
	else if (IS_ENABLED(CONFIG_TARGET_S5PC210_UNIVERSAL))
		ret = pmic_get("max8998-pmic", &dev);
	else
		return 0;

	if (ret)
		return ret;

	if (reg == KEY_PWR_STATUS_REG)
		mask = KEY_PWR_STATUS_MASK;
	else
		mask = KEY_PWR_INTERRUPT_MASK;

	status = pmic_reg_read(dev, reg);
	if (status < 0)
		return status;

	return !!(status & mask);
}

static int key_pressed(int key)
{
	int value;

	switch (key) {
	case KEY_POWER:
		value = power_key_pressed(KEY_PWR_INTERRUPT_REG);
		break;
	case KEY_VOLUMEUP:
		value = !gpio_get_value(KEY_VOL_UP_GPIO);
		break;
	case KEY_VOLUMEDOWN:
		value = !gpio_get_value(KEY_VOL_DOWN_GPIO);
		break;
	default:
		value = 0;
		break;
	}

	return value;
}

#ifdef CONFIG_LCD
static int check_keys(void)
{
	int keys = 0;

	if (key_pressed(KEY_POWER))
		keys += KEY_POWER;
	if (key_pressed(KEY_VOLUMEUP))
		keys += KEY_VOLUMEUP;
	if (key_pressed(KEY_VOLUMEDOWN))
		keys += KEY_VOLUMEDOWN;

	return keys;
}

/*
 * 0 BOOT_MODE_INFO
 * 1 BOOT_MODE_THOR
 * 2 BOOT_MODE_UMS
 * 3 BOOT_MODE_DFU
 * 4 BOOT_MODE_EXIT
 */
static char *
mode_name[BOOT_MODE_EXIT + 1][2] = {
	{"DEVICE", ""},
	{"THOR", "thor"},
	{"UMS", "ums"},
	{"DFU", "dfu"},
	{"GPT", "gpt"},
	{"ENV", "env"},
	{"EXIT", ""},
};

static char *
mode_info[BOOT_MODE_EXIT + 1] = {
	"info",
	"downloader",
	"mass storage",
	"firmware update",
	"restore",
	"default",
	"and run normal boot"
};

static char *
mode_cmd[BOOT_MODE_EXIT + 1] = {
	"",
	"thor 0 mmc 0",
	"ums 0 mmc 0",
	"dfu 0 mmc 0",
	"gpt write mmc 0 $partitions",
	"env default -a; saveenv",
	"",
};

static void display_board_info(void)
{
#ifdef CONFIG_MMC
	struct mmc *mmc = find_mmc_device(0);
#endif
	vidinfo_t *vid = &panel_info;

	lcd_position_cursor(4, 4);

	lcd_printf("%s\n\t", U_BOOT_VERSION);
	lcd_puts("\n\t\tBoard Info:\n");
#ifdef CONFIG_SYS_BOARD
	lcd_printf("\tBoard name: %s\n", CONFIG_SYS_BOARD);
#endif
#ifdef CONFIG_REVISION_TAG
	lcd_printf("\tBoard rev: %u\n", get_board_rev());
#endif
	lcd_printf("\tDRAM banks: %u\n", CONFIG_NR_DRAM_BANKS);
	lcd_printf("\tDRAM size: %u MB\n", gd->ram_size / SZ_1M);

#ifdef CONFIG_MMC
	if (mmc) {
		if (!mmc->capacity)
			mmc_init(mmc);

		lcd_printf("\teMMC size: %llu MB\n", mmc->capacity / SZ_1M);
	}
#endif
	if (vid)
		lcd_printf("\tDisplay resolution: %u x % u\n",
			   vid->vl_col, vid->vl_row);

	lcd_printf("\tDisplay BPP: %u\n", 1 << vid->vl_bpix);
}
#endif

static int mode_leave_menu(int mode)
{
#ifdef CONFIG_LCD
	char *exit_option;
	char *exit_reset = "reset";
	char *exit_back = "back";
	struct cmd_tbl *cmd;
	int cmd_result;
	int leave;

	lcd_clear();

	switch (mode) {
	case BOOT_MODE_EXIT:
		return 1;
	case BOOT_MODE_INFO:
		display_board_info();
		exit_option = exit_back;
		leave = 0;
		break;
	default:
		cmd = find_cmd(mode_name[mode][1]);
		if (cmd) {
			printf("Enter: %s %s\n", mode_name[mode][0],
			       mode_info[mode]);
			lcd_printf("\n\n\t%s %s\n", mode_name[mode][0],
				   mode_info[mode]);
			lcd_puts("\n\tDo not turn off device before finish!\n");

			cmd_result = run_command(mode_cmd[mode], 0);

			if (cmd_result == CMD_RET_SUCCESS) {
				printf("Command finished\n");
				lcd_clear();
				lcd_printf("\n\n\t%s finished\n",
					   mode_name[mode][0]);

				exit_option = exit_reset;
				leave = 1;
			} else {
				printf("Command error\n");
				lcd_clear();
				lcd_printf("\n\n\t%s command error\n",
					   mode_name[mode][0]);

				exit_option = exit_back;
				leave = 0;
			}
		} else {
			lcd_puts("\n\n\tThis mode is not supported.\n");
			exit_option = exit_back;
			leave = 0;
		}
	}

	lcd_printf("\n\n\tPress POWER KEY to %s\n", exit_option);

	/* Clear PWR button Rising edge interrupt status flag */
	power_key_pressed(KEY_PWR_INTERRUPT_REG);

	/* Wait for PWR key */
	while (!key_pressed(KEY_POWER))
		mdelay(1);

	lcd_clear();
	return leave;
#else
	return 0;
#endif
}

#ifdef CONFIG_LCD
static void display_download_menu(int mode)
{
	char *selection[BOOT_MODE_EXIT + 1];
	int i;

	for (i = 0; i <= BOOT_MODE_EXIT; i++)
		selection[i] = "[  ]";

	selection[mode] = "[=>]";

	lcd_clear();
	lcd_printf("\n\n\t\tDownload Mode Menu\n\n");

	for (i = 0; i <= BOOT_MODE_EXIT; i++)
		lcd_printf("\t%s  %s - %s\n\n", selection[i],
			   mode_name[i][0], mode_info[i]);
}
#endif

static void download_menu(void)
{
#ifdef CONFIG_LCD
	int mode = 0;
	int last_mode = 0;
	int run;
	int key = 0;
	int timeout = 15; /* sec */
	int i;

	display_download_menu(mode);

	lcd_puts("\n");

	/* Start count if no key is pressed */
	while (check_keys())
		continue;

	while (timeout--) {
		lcd_printf("\r\tNormal boot will start in: %2.d seconds.",
			   timeout);

		/* about 1000 ms in for loop */
		for (i = 0; i < 10; i++) {
			mdelay(100);
			key = check_keys();
			if (key)
				break;
		}
		if (key)
			break;
	}

	if (!key) {
		lcd_clear();
		return;
	}

	while (1) {
		run = 0;

		if (mode != last_mode)
			display_download_menu(mode);

		last_mode = mode;
		mdelay(200);

		key = check_keys();
		switch (key) {
		case KEY_POWER:
			run = 1;
			break;
		case KEY_VOLUMEUP:
			if (mode > 0)
				mode--;
			break;
		case KEY_VOLUMEDOWN:
			if (mode < BOOT_MODE_EXIT)
				mode++;
			break;
		default:
			break;
		}

		if (run) {
			if (mode_leave_menu(mode))
				run_command("reset", 0);

			display_download_menu(mode);
		}
	}

	lcd_clear();
#endif
}

void check_boot_mode(void)
{
	int pwr_key;

	pwr_key = power_key_pressed(KEY_PWR_STATUS_REG);
	if (!pwr_key)
		return;

	/* Clear PWR button Rising edge interrupt status flag */
	power_key_pressed(KEY_PWR_INTERRUPT_REG);

	if (key_pressed(KEY_VOLUMEUP))
		download_menu();
	else if (key_pressed(KEY_VOLUMEDOWN))
		mode_leave_menu(BOOT_MODE_THOR);
}

void keys_init(void)
{
	/* Set direction to input */
	gpio_request(KEY_VOL_UP_GPIO, "volume-up");
	gpio_request(KEY_VOL_DOWN_GPIO, "volume-down");
	gpio_direction_input(KEY_VOL_UP_GPIO);
	gpio_direction_input(KEY_VOL_DOWN_GPIO);
}
#endif /* CONFIG_LCD_MENU */

#ifdef CONFIG_CMD_BMP
void draw_logo(void)
{
	int x, y;
	ulong addr;

	addr = panel_info.logo_addr;
	if (!addr) {
		pr_err("There is no logo data.\n");
		return;
	}

	if (panel_info.vl_width >= panel_info.logo_width) {
		x = ((panel_info.vl_width - panel_info.logo_width) >> 1);
		x += panel_info.logo_x_offset; /* For X center align */
	} else {
		x = 0;
		printf("Warning: image width is bigger than display width\n");
	}

	if (panel_info.vl_height >= panel_info.logo_height) {
		y = ((panel_info.vl_height - panel_info.logo_height) >> 1);
		y += panel_info.logo_y_offset; /* For Y center align */
	} else {
		y = 0;
		printf("Warning: image height is bigger than display height\n");
	}

	bmp_display(addr, x, y);
}
#endif /* CONFIG_CMD_BMP */
Commit	Line	Data
83d290c5	1	// SPDX-License-Identifier: GPL-2.0+
679549d1 PM	2	/*
	3	* Copyright (C) 2013 Samsung Electronics
	4	* Przemyslaw Marczak <[email protected]>
679549d1 PM	5	*/
	6
	7	#include <common.h>
288b29e4	8	#include <command.h>
9fb625ce	9	#include <env.h>
679549d1 PM	10	#include <lcd.h>
679549d1 PM	11	#include <libtizen.h>
401d1c4f	12	#include <asm/global_data.h>
c05ed00a	13	#include <linux/delay.h>
679549d1	14	#include <samsung/misc.h>
9d29a682 PM	15	#include <errno.h>
9d29a682 PM	16	#include <version.h>
1d07c101	17	#include <malloc.h>
cf92e05c	18	#include <memalign.h>
1ace4022	19	#include <linux/sizes.h>
9d29a682	20	#include <asm/arch/cpu.h>
9d29a682 PM	21	#include <asm/gpio.h>
9d29a682 PM	22	#include <linux/input.h>
ca2b933a	23	#include <dm.h>
f6e76202 SG	24	/*
	25	* Use #ifdef to work around conflicting headers while we wait for this to be
	26	* converted to driver model.
	27	*/
	28	#ifdef CONFIG_DM_PMIC_MAX77686
	29	#include <power/max77686_pmic.h>
	30	#endif
	31	#ifdef CONFIG_DM_PMIC_MAX8998
	32	#include <power/max8998_pmic.h>
	33	#endif
	34	#ifdef CONFIG_PMIC_MAX8997
	35	#include <power/max8997_pmic.h>
	36	#endif
9d29a682 PM	37	#include <power/pmic.h>
	38	#include <mmc.h>
	39
	40	DECLARE_GLOBAL_DATA_PTR;
	41
1d07c101	42	#ifdef CONFIG_SET_DFU_ALT_INFO
899a5282	43	void set_dfu_alt_info(char interface, char devstr)
1d07c101 PM	44	{
	45	size_t buf_size = CONFIG_SET_DFU_ALT_BUF_LEN;
	46	ALLOC_CACHE_ALIGN_BUFFER(char, buf, buf_size);
	47	char *alt_info = "Settings not found!";
	48	char *status = "error!\n";
	49	char *alt_setting;
	50	char *alt_sep;
	51	int offset = 0;
	52
	53	puts("DFU alt info setting: ");
	54
899a5282	55	alt_setting = get_dfu_alt_boot(interface, devstr);
1d07c101	56	if (alt_setting) {
382bee57	57	env_set("dfu_alt_boot", alt_setting);
1d07c101 PM	58	offset = snprintf(buf, buf_size, "%s", alt_setting);
	59	}
	60
899a5282	61	alt_setting = get_dfu_alt_system(interface, devstr);
1d07c101 PM	62	if (alt_setting) {
	63	if (offset)
	64	alt_sep = ";";
	65	else
	66	alt_sep = "";
	67
	68	offset += snprintf(buf + offset, buf_size - offset,
	69	"%s%s", alt_sep, alt_setting);
	70	}
	71
	72	if (offset) {
	73	alt_info = buf;
	74	status = "done\n";
	75	}
	76
382bee57	77	env_set("dfu_alt_info", alt_info);
1d07c101 PM	78	puts(status);
	79	}
	80	#endif
	81
eee2fab0 PW	82	#ifdef CONFIG_ENV_VARS_UBOOT_RUNTIME_CONFIG
	83	void set_board_info(void)
	84	{
	85	char info[64];
	86
0dc579f3 PM	87	snprintf(info, ARRAY_SIZE(info), "%u.%u", (s5p_cpu_rev & 0xf0) >> 4,
0dc579f3 PM	88	s5p_cpu_rev & 0xf);
382bee57	89	env_set("soc_rev", info);
eee2fab0 PW	90
eee2fab0 PW	91	snprintf(info, ARRAY_SIZE(info), "%x", s5p_cpu_id);
382bee57	92	env_set("soc_id", info);
eee2fab0 PW	93
	94	#ifdef CONFIG_REVISION_TAG
	95	snprintf(info, ARRAY_SIZE(info), "%x", get_board_rev());
382bee57	96	env_set("board_rev", info);
eee2fab0 PW	97	#endif
eee2fab0 PW	98	#ifdef CONFIG_OF_LIBFDT
c9c36bf5 PM	99	const char *bdtype = "";
	100	const char *bdname = CONFIG_SYS_BOARD;
	101
	102	#ifdef CONFIG_BOARD_TYPES
	103	bdtype = get_board_type();
bc3f39ea PM	104	if (!bdtype)
	105	bdtype = "";
	106
c9c36bf5	107	sprintf(info, "%s%s", bdname, bdtype);
e6b14670	108	env_set("board_name", info);
c9c36bf5 PM	109	#endif
	110	snprintf(info, ARRAY_SIZE(info), "%s%x-%s%s.dtb",
	111	CONFIG_SYS_SOC, s5p_cpu_id, bdname, bdtype);
382bee57	112	env_set("fdtfile", info);
eee2fab0 PW	113	#endif
	114	}
	115	#endif /* CONFIG_ENV_VARS_UBOOT_RUNTIME_CONFIG */
	116
9d29a682 PM	117	#ifdef CONFIG_LCD_MENU
	118	static int power_key_pressed(u32 reg)
	119	{
579d8199 JC	120	struct udevice *dev;
579d8199 JC	121	int ret;
9d29a682 PM	122	u32 status;
	123	u32 mask;
	124
579d8199 JC	125	if (IS_ENABLED(CONFIG_TARGET_TRATS))
	126	ret = pmic_get("max8997-pmic", &dev);
	127	else if (IS_ENABLED(CONFIG_TARGET_TRATS2))
	128	ret = pmic_get("max77686-pmic", &dev);
	129	else if (IS_ENABLED(CONFIG_TARGET_S5PC210_UNIVERSAL))
	130	ret = pmic_get("max8998-pmic", &dev);
	131	else
9d29a682	132	return 0;
9d29a682	133
579d8199 JC	134	if (ret)
579d8199 JC	135	return ret;
9d29a682 PM	136
	137	if (reg == KEY_PWR_STATUS_REG)
	138	mask = KEY_PWR_STATUS_MASK;
	139	else
	140	mask = KEY_PWR_INTERRUPT_MASK;
	141
579d8199 JC	142	status = pmic_reg_read(dev, reg);
	143	if (status < 0)
	144	return status;
9d29a682 PM	145
	146	return !!(status & mask);
	147	}
	148
	149	static int key_pressed(int key)
	150	{
	151	int value;
	152
	153	switch (key) {
	154	case KEY_POWER:
	155	value = power_key_pressed(KEY_PWR_INTERRUPT_REG);
	156	break;
	157	case KEY_VOLUMEUP:
	158	value = !gpio_get_value(KEY_VOL_UP_GPIO);
	159	break;
	160	case KEY_VOLUMEDOWN:
	161	value = !gpio_get_value(KEY_VOL_DOWN_GPIO);
	162	break;
	163	default:
	164	value = 0;
	165	break;
	166	}
	167
	168	return value;
	169	}
	170
531a4a66	171	#ifdef CONFIG_LCD
9d29a682 PM	172	static int check_keys(void)
	173	{
	174	int keys = 0;
	175
	176	if (key_pressed(KEY_POWER))
	177	keys += KEY_POWER;
	178	if (key_pressed(KEY_VOLUMEUP))
	179	keys += KEY_VOLUMEUP;
	180	if (key_pressed(KEY_VOLUMEDOWN))
	181	keys += KEY_VOLUMEDOWN;
	182
	183	return keys;
	184	}
	185
	186	/*
	187	* 0 BOOT_MODE_INFO
	188	* 1 BOOT_MODE_THOR
	189	* 2 BOOT_MODE_UMS
	190	* 3 BOOT_MODE_DFU
	191	* 4 BOOT_MODE_EXIT
	192	*/
	193	static char *
e6bfe79f PM	194	mode_name[BOOT_MODE_EXIT + 1][2] = {
	195	{"DEVICE", ""},
	196	{"THOR", "thor"},
	197	{"UMS", "ums"},
	198	{"DFU", "dfu"},
5c7b8a37	199	{"GPT", "gpt"},
0954dd61	200	{"ENV", "env"},
e6bfe79f	201	{"EXIT", ""},
9d29a682 PM	202	};
	203
	204	static char *
	205	mode_info[BOOT_MODE_EXIT + 1] = {
	206	"info",
	207	"downloader",
	208	"mass storage",
	209	"firmware update",
5c7b8a37	210	"restore",
0954dd61	211	"default",
9d29a682 PM	212	"and run normal boot"
	213	};
	214
9d29a682	215	static char *
e6bfe79f PM	216	mode_cmd[BOOT_MODE_EXIT + 1] = {
	217	"",
	218	"thor 0 mmc 0",
	219	"ums 0 mmc 0",
	220	"dfu 0 mmc 0",
5c7b8a37	221	"gpt write mmc 0 $partitions",
0954dd61	222	"env default -a; saveenv",
e6bfe79f	223	"",
9d29a682 PM	224	};
	225
	226	static void display_board_info(void)
	227	{
4aa2ba3a	228	#ifdef CONFIG_MMC
9d29a682 PM	229	struct mmc *mmc = find_mmc_device(0);
	230	#endif
	231	vidinfo_t *vid = &panel_info;
	232
	233	lcd_position_cursor(4, 4);
	234
	235	lcd_printf("%s\n\t", U_BOOT_VERSION);
	236	lcd_puts("\n\t\tBoard Info:\n");
	237	#ifdef CONFIG_SYS_BOARD
	238	lcd_printf("\tBoard name: %s\n", CONFIG_SYS_BOARD);
	239	#endif
	240	#ifdef CONFIG_REVISION_TAG
	241	lcd_printf("\tBoard rev: %u\n", get_board_rev());
	242	#endif
	243	lcd_printf("\tDRAM banks: %u\n", CONFIG_NR_DRAM_BANKS);
	244	lcd_printf("\tDRAM size: %u MB\n", gd->ram_size / SZ_1M);
	245
4aa2ba3a	246	#ifdef CONFIG_MMC
9d29a682 PM	247	if (mmc) {
	248	if (!mmc->capacity)
	249	mmc_init(mmc);
	250
	251	lcd_printf("\teMMC size: %llu MB\n", mmc->capacity / SZ_1M);
	252	}
	253	#endif
	254	if (vid)
	255	lcd_printf("\tDisplay resolution: %u x % u\n",
	256	vid->vl_col, vid->vl_row);
	257
	258	lcd_printf("\tDisplay BPP: %u\n", 1 << vid->vl_bpix);
	259	}
531a4a66	260	#endif
9d29a682 PM	261
	262	static int mode_leave_menu(int mode)
	263	{
531a4a66	264	#ifdef CONFIG_LCD
9d29a682	265	char *exit_option;
e6bfe79f	266	char *exit_reset = "reset";
9d29a682	267	char *exit_back = "back";
09140113	268	struct cmd_tbl *cmd;
9d29a682	269	int cmd_result;
9d29a682 PM	270	int leave;
	271
	272	lcd_clear();
	273
	274	switch (mode) {
	275	case BOOT_MODE_EXIT:
	276	return 1;
	277	case BOOT_MODE_INFO:
	278	display_board_info();
	279	exit_option = exit_back;
	280	leave = 0;
	281	break;
	282	default:
e6bfe79f	283	cmd = find_cmd(mode_name[mode][1]);
9d29a682	284	if (cmd) {
e6bfe79f	285	printf("Enter: %s %s\n", mode_name[mode][0],
de5f9733	286	mode_info[mode]);
e6bfe79f	287	lcd_printf("\n\n\t%s %s\n", mode_name[mode][0],
de5f9733	288	mode_info[mode]);
9d29a682 PM	289	lcd_puts("\n\tDo not turn off device before finish!\n");
9d29a682 PM	290
e6bfe79f	291	cmd_result = run_command(mode_cmd[mode], 0);
9d29a682 PM	292
	293	if (cmd_result == CMD_RET_SUCCESS) {
	294	printf("Command finished\n");
	295	lcd_clear();
	296	lcd_printf("\n\n\t%s finished\n",
e6bfe79f	297	mode_name[mode][0]);
9d29a682	298
e6bfe79f	299	exit_option = exit_reset;
9d29a682 PM	300	leave = 1;
	301	} else {
	302	printf("Command error\n");
	303	lcd_clear();
	304	lcd_printf("\n\n\t%s command error\n",
e6bfe79f	305	mode_name[mode][0]);
9d29a682 PM	306
	307	exit_option = exit_back;
	308	leave = 0;
	309	}
	310	} else {
	311	lcd_puts("\n\n\tThis mode is not supported.\n");
	312	exit_option = exit_back;
	313	leave = 0;
	314	}
	315	}
	316
	317	lcd_printf("\n\n\tPress POWER KEY to %s\n", exit_option);
	318
	319	/* Clear PWR button Rising edge interrupt status flag */
	320	power_key_pressed(KEY_PWR_INTERRUPT_REG);
	321
	322	/* Wait for PWR key */
	323	while (!key_pressed(KEY_POWER))
	324	mdelay(1);
	325
	326	lcd_clear();
	327	return leave;
531a4a66 SG	328	#else
	329	return 0;
	330	#endif
9d29a682 PM	331	}
9d29a682 PM	332
531a4a66	333	#ifdef CONFIG_LCD
9d29a682 PM	334	static void display_download_menu(int mode)
	335	{
	336	char *selection[BOOT_MODE_EXIT + 1];
	337	int i;
	338
	339	for (i = 0; i <= BOOT_MODE_EXIT; i++)
	340	selection[i] = "[ ]";
	341
	342	selection[mode] = "[=>]";
	343
	344	lcd_clear();
605d7e2a	345	lcd_printf("\n\n\t\tDownload Mode Menu\n\n");
9d29a682 PM	346
	347	for (i = 0; i <= BOOT_MODE_EXIT; i++)
	348	lcd_printf("\t%s %s - %s\n\n", selection[i],
de5f9733	349	mode_name[i][0], mode_info[i]);
9d29a682	350	}
531a4a66	351	#endif
9d29a682 PM	352
	353	static void download_menu(void)
	354	{
531a4a66	355	#ifdef CONFIG_LCD
9d29a682 PM	356	int mode = 0;
	357	int last_mode = 0;
	358	int run;
605d7e2a PM	359	int key = 0;
	360	int timeout = 15; /* sec */
	361	int i;
9d29a682 PM	362
	363	display_download_menu(mode);
	364
605d7e2a PM	365	lcd_puts("\n");
	366
	367	/* Start count if no key is pressed */
	368	while (check_keys())
	369	continue;
	370
	371	while (timeout--) {
	372	lcd_printf("\r\tNormal boot will start in: %2.d seconds.",
	373	timeout);
	374
	375	/* about 1000 ms in for loop */
	376	for (i = 0; i < 10; i++) {
	377	mdelay(100);
	378	key = check_keys();
	379	if (key)
	380	break;
	381	}
	382	if (key)
	383	break;
	384	}
	385
	386	if (!key) {
	387	lcd_clear();
	388	return;
	389	}
	390
9d29a682 PM	391	while (1) {
	392	run = 0;
	393
	394	if (mode != last_mode)
	395	display_download_menu(mode);
	396
	397	last_mode = mode;
f418a1cf	398	mdelay(200);
9d29a682 PM	399
	400	key = check_keys();
	401	switch (key) {
	402	case KEY_POWER:
	403	run = 1;
	404	break;
	405	case KEY_VOLUMEUP:
	406	if (mode > 0)
	407	mode--;
	408	break;
	409	case KEY_VOLUMEDOWN:
	410	if (mode < BOOT_MODE_EXIT)
	411	mode++;
	412	break;
	413	default:
	414	break;
	415	}
	416
	417	if (run) {
	418	if (mode_leave_menu(mode))
e6bfe79f	419	run_command("reset", 0);
9d29a682 PM	420
	421	display_download_menu(mode);
	422	}
	423	}
	424
	425	lcd_clear();
531a4a66	426	#endif
9d29a682 PM	427	}
9d29a682 PM	428
9d29a682 PM	429	void check_boot_mode(void)
	430	{
	431	int pwr_key;
	432
	433	pwr_key = power_key_pressed(KEY_PWR_STATUS_REG);
	434	if (!pwr_key)
	435	return;
	436
	437	/* Clear PWR button Rising edge interrupt status flag */
	438	power_key_pressed(KEY_PWR_INTERRUPT_REG);
	439
	440	if (key_pressed(KEY_VOLUMEUP))
605d7e2a	441	download_menu();
9d29a682 PM	442	else if (key_pressed(KEY_VOLUMEDOWN))
	443	mode_leave_menu(BOOT_MODE_THOR);
	444	}
	445
	446	void keys_init(void)
	447	{
	448	/* Set direction to input */
7f196101 SG	449	gpio_request(KEY_VOL_UP_GPIO, "volume-up");
7f196101 SG	450	gpio_request(KEY_VOL_DOWN_GPIO, "volume-down");
9d29a682 PM	451	gpio_direction_input(KEY_VOL_UP_GPIO);
	452	gpio_direction_input(KEY_VOL_DOWN_GPIO);
	453	}
	454	#endif /* CONFIG_LCD_MENU */
679549d1 PM	455
	456	#ifdef CONFIG_CMD_BMP
	457	void draw_logo(void)
	458	{
	459	int x, y;
	460	ulong addr;
	461
	462	addr = panel_info.logo_addr;
	463	if (!addr) {
5c890b1b	464	pr_err("There is no logo data.\n");
679549d1 PM	465	return;
	466	}
	467
	468	if (panel_info.vl_width >= panel_info.logo_width) {
	469	x = ((panel_info.vl_width - panel_info.logo_width) >> 1);
903afe18	470	x += panel_info.logo_x_offset; /* For X center align */
679549d1 PM	471	} else {
	472	x = 0;
	473	printf("Warning: image width is bigger than display width\n");
	474	}
	475
	476	if (panel_info.vl_height >= panel_info.logo_height) {
	477	y = ((panel_info.vl_height - panel_info.logo_height) >> 1);
903afe18	478	y += panel_info.logo_y_offset; /* For Y center align */
679549d1 PM	479	} else {
	480	y = 0;
	481	printf("Warning: image height is bigger than display height\n");
	482	}
	483
	484	bmp_display(addr, x, y);
	485	}
	486	#endif /* CONFIG_CMD_BMP */