fastboot: add the 'reboot-bootloader' command

Implements the ability to reboot device into bootloader fastboot mode.
Only for OMAP4 devices for now.

Change-Id: Ie798f63e2c31dc5b27c714a284d6634737793192
Signed-off-by: Leonid Iziumtsev <[email protected]>

Author: Leonid Iziumtsev

arch/omap4/board/board_blaze.c

@@ -37,6 +37,8 @@
 #include <mux.h>
 #include <hw.h>
 
+#include <string.h>
+
 static struct partition partitions[] = {
 	{ "-", 128 },
 	{ "xloader", 128 },
@@ -392,6 +394,14 @@ static void blaze_ddr_init(struct proc_specific_functions *proc_ops)
 
 static int blaze_check_fastboot(void)
 {
+	if (readl(PRM_RSTST) & PRM_RSTST_RESET_WARM_BIT)
+		if (!strcmp((const char *)PUBLIC_SAR_RAM_1_FREE,
+							"bootloader")) {
+			printf("\nreboot command [%s]\n",
+					(const char *)PUBLIC_SAR_RAM_1_FREE);
+			return 1;
+		}
+
 	return 0;
 }
 

arch/omap4/board/board_blaze_tablet.c

@@ -37,6 +37,8 @@
 #include <mux.h>
 #include <hw.h>
 
+#include <string.h>
+
 static struct partition partitions[] = {
 	{ "-", 128 },
 	{ "xloader", 128 },
@@ -390,6 +392,14 @@ static void blaze_tablet_ddr_init(struct proc_specific_functions *proc_ops)
 
 static int blaze_tablet_check_fastboot(void)
 {
+	if (readl(PRM_RSTST) & PRM_RSTST_RESET_WARM_BIT)
+		if (!strcmp((const char *)PUBLIC_SAR_RAM_1_FREE,
+							"bootloader")) {
+			printf("\nreboot command [%s]\n",
+					(const char *)PUBLIC_SAR_RAM_1_FREE);
+			return 1;
+		}
+
 	return 0;
 }
 

arch/omap4/board/board_panda.c

@@ -41,6 +41,8 @@
 #include <mux.h>
 #include <hw.h>
 
+#include <string.h>
+
 static struct partition partitions[] = {
 	{ "-", 128 },
 	{ "xloader", 128 },
@@ -390,6 +392,14 @@ static void panda_ddr_init(struct proc_specific_functions *proc_ops)
 
 static int panda_check_fastboot(void)
 {
+	if (readl(PRM_RSTST) & PRM_RSTST_RESET_WARM_BIT)
+		if (!strcmp((const char *)PUBLIC_SAR_RAM_1_FREE,
+							"bootloader")) {
+			printf("\nreboot command [%s]\n",
+					(const char *)PUBLIC_SAR_RAM_1_FREE);
+			return 1;
+		}
+
 	return 0;
 }
 

fastboot.c

@@ -30,6 +30,7 @@
 #include <bootimg.h>
 #include <io.h>
 #include <types.h>
+#include <hw.h>
 
 #include <alloc.h>
 #include <omap_rom.h>
@@ -976,6 +977,22 @@ static int fastboot_erase(char *cmd, char *response, struct usb *usb)
 }
 
 #if defined(CONFIG_IS_OMAP4)
+static int fastboot_reboot_bl(char *cmd, char *response, struct usb *usb)
+{
+	strcpy(response, "OKAY");
+	fastboot_tx_status(response, strlen(response), usb);
+
+	/* clear all reset events */
+	writel(PRM_RSTST_CLR, PRM_RSTST);
+
+	strcpy((char *)PUBLIC_SAR_RAM_1_FREE, "bootloader");
+
+	/* trigger warm reset */
+	writel(PRM_RSTCTRL_RESET_WARM_BIT, PRM_RSTCTRL);
+
+	return 0;
+}
+
 static int fastboot_reboot(char *cmd, char *response, struct usb *usb)
 {
 	strcpy(response, "OKAY");
@@ -1085,6 +1102,8 @@ void do_fastboot(struct bootloader_ops *boot_ops)
 		} else if (memcmp(cmd, "boot", 4) == 0) {
 			ret = fastboot_boot(boot_ops, cmd + 4, response);
 #if defined(CONFIG_IS_OMAP4)
+		} else if (memcmp(cmd, "reboot-bootloader", 17) == 0) {
+			ret = fastboot_reboot_bl(cmd + 17, response, usb);
 		} else if (memcmp(cmd, "reboot", 6) == 0) {
 			ret = fastboot_reboot(cmd + 6, response, usb);
 #endif

include/omap4/hw.h

@@ -224,6 +224,7 @@
 #define PRM_RSTCTRL_RESET_WARM_BIT      (1<<0)
 #define PRM_RSTCTRL_RESET_COLD_BIT      (1<<1)
 #define PRM_RSTST                       (PRM_DEVICE_BASE + 0x4)
+#define PRM_RSTST_CLR			0xfff
 #define PRM_RSTST_RESET_COLD_BIT        (1<<0)
 #define PRM_RSTST_RESET_WARM_BIT        (1<<1)