1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * (C) Copyright 2008 - 2009
4 * Windriver, <www.windriver.com>
5 * Tom Rix <Tom.Rix@windriver.com>
6 *
7 * Copyright 2011 Sebastian Andrzej Siewior <bigeasy@linutronix.de>
8 *
9 * Copyright 2014 Linaro, Ltd.
10 * Rob Herring <robh@kernel.org>
11 */
12
13 #include <bcb.h>
14 #include <common.h>
15 #include <command.h>
16 #include <env.h>
17 #include <fastboot.h>
18 #include <net.h>
19
20 /**
21 * fastboot_buf_addr - base address of the fastboot download buffer
22 */
23 void *fastboot_buf_addr;
24
25 /**
26 * fastboot_buf_size - size of the fastboot download buffer
27 */
28 u32 fastboot_buf_size;
29
30 /**
31 * fastboot_progress_callback - callback executed during long operations
32 */
33 void (*fastboot_progress_callback)(const char *msg);
34
35 /**
36 * fastboot_response() - Writes a response of the form "$tag$reason".
37 *
38 * @tag: The first part of the response
39 * @response: Pointer to fastboot response buffer
40 * @format: printf style format string
41 */
fastboot_response(const char * tag,char * response,const char * format,...)42 void fastboot_response(const char *tag, char *response,
43 const char *format, ...)
44 {
45 va_list args;
46
47 strlcpy(response, tag, FASTBOOT_RESPONSE_LEN);
48 if (format) {
49 va_start(args, format);
50 vsnprintf(response + strlen(response),
51 FASTBOOT_RESPONSE_LEN - strlen(response) - 1,
52 format, args);
53 va_end(args);
54 }
55 }
56
57 /**
58 * fastboot_fail() - Write a FAIL response of the form "FAIL$reason".
59 *
60 * @reason: Pointer to returned reason string
61 * @response: Pointer to fastboot response buffer
62 */
fastboot_fail(const char * reason,char * response)63 void fastboot_fail(const char *reason, char *response)
64 {
65 fastboot_response("FAIL", response, "%s", reason);
66 }
67
68 /**
69 * fastboot_okay() - Write an OKAY response of the form "OKAY$reason".
70 *
71 * @reason: Pointer to returned reason string, or NULL to send a bare "OKAY"
72 * @response: Pointer to fastboot response buffer
73 */
fastboot_okay(const char * reason,char * response)74 void fastboot_okay(const char *reason, char *response)
75 {
76 if (reason)
77 fastboot_response("OKAY", response, "%s", reason);
78 else
79 fastboot_response("OKAY", response, NULL);
80 }
81
82 /**
83 * fastboot_set_reboot_flag() - Set flag to indicate reboot-bootloader
84 *
85 * Set flag which indicates that we should reboot into the bootloader
86 * following the reboot that fastboot executes after this function.
87 *
88 * This function should be overridden in your board file with one
89 * which sets whatever flag your board specific Android bootloader flow
90 * requires in order to re-enter the bootloader.
91 */
fastboot_set_reboot_flag(enum fastboot_reboot_reason reason)92 int __weak fastboot_set_reboot_flag(enum fastboot_reboot_reason reason)
93 {
94 static const char * const boot_cmds[] = {
95 [FASTBOOT_REBOOT_REASON_BOOTLOADER] = "bootonce-bootloader",
96 [FASTBOOT_REBOOT_REASON_FASTBOOTD] = "boot-fastboot",
97 [FASTBOOT_REBOOT_REASON_RECOVERY] = "boot-recovery"
98 };
99 const int mmc_dev = config_opt_enabled(CONFIG_FASTBOOT_FLASH_MMC,
100 CONFIG_FASTBOOT_FLASH_MMC_DEV, -1);
101
102 if (!IS_ENABLED(CONFIG_FASTBOOT_FLASH_MMC))
103 return -EINVAL;
104
105 if (reason >= FASTBOOT_REBOOT_REASONS_COUNT)
106 return -EINVAL;
107
108 return bcb_write_reboot_reason(mmc_dev, "misc", boot_cmds[reason]);
109 }
110
111 /**
112 * fastboot_get_progress_callback() - Return progress callback
113 *
114 * Return: Pointer to function called during long operations
115 */
fastboot_get_progress_callback(void)116 void (*fastboot_get_progress_callback(void))(const char *)
117 {
118 return fastboot_progress_callback;
119 }
120
121 /**
122 * fastboot_boot() - Execute fastboot boot command
123 *
124 * If ${fastboot_bootcmd} is set, run that command to execute the boot
125 * process, if that returns, then exit the fastboot server and return
126 * control to the caller.
127 *
128 * Otherwise execute "bootm <fastboot_buf_addr>", if that fails, reset
129 * the board.
130 */
fastboot_boot(void)131 void fastboot_boot(void)
132 {
133 char *s;
134
135 s = env_get("fastboot_bootcmd");
136 if (s) {
137 run_command(s, CMD_FLAG_ENV);
138 } else {
139 static char boot_addr_start[20];
140 static char *const bootm_args[] = {
141 "bootm", boot_addr_start, NULL
142 };
143
144 snprintf(boot_addr_start, sizeof(boot_addr_start) - 1,
145 "0x%p", fastboot_buf_addr);
146 printf("Booting kernel at %s...\n\n\n", boot_addr_start);
147
148 do_bootm(NULL, 0, 2, bootm_args);
149
150 /*
151 * This only happens if image is somehow faulty so we start
152 * over. We deliberately leave this policy to the invocation
153 * of fastbootcmd if that's what's being run
154 */
155 do_reset(NULL, 0, 0, NULL);
156 }
157 }
158
159 /**
160 * fastboot_handle_boot() - Shared implementation of system reaction to
161 * fastboot commands
162 *
163 * Making desceisions about device boot state (stay in fastboot, reboot
164 * to bootloader, reboot to OS, etc).
165 */
fastboot_handle_boot(int command,bool success)166 void fastboot_handle_boot(int command, bool success)
167 {
168 if (!success)
169 return;
170
171 switch (command) {
172 case FASTBOOT_COMMAND_BOOT:
173 fastboot_boot();
174 net_set_state(NETLOOP_SUCCESS);
175 break;
176
177 case FASTBOOT_COMMAND_CONTINUE:
178 net_set_state(NETLOOP_SUCCESS);
179 break;
180
181 case FASTBOOT_COMMAND_REBOOT:
182 case FASTBOOT_COMMAND_REBOOT_BOOTLOADER:
183 case FASTBOOT_COMMAND_REBOOT_FASTBOOTD:
184 case FASTBOOT_COMMAND_REBOOT_RECOVERY:
185 do_reset(NULL, 0, 0, NULL);
186 break;
187 }
188 }
189
190 /**
191 * fastboot_set_progress_callback() - set progress callback
192 *
193 * @progress: Pointer to progress callback
194 *
195 * Set a callback which is invoked periodically during long running operations
196 * (flash and erase). This can be used (for example) by the UDP transport to
197 * send INFO responses to keep the client alive whilst those commands are
198 * executing.
199 */
fastboot_set_progress_callback(void (* progress)(const char * msg))200 void fastboot_set_progress_callback(void (*progress)(const char *msg))
201 {
202 fastboot_progress_callback = progress;
203 }
204
205 /*
206 * fastboot_init() - initialise new fastboot protocol session
207 *
208 * @buf_addr: Pointer to download buffer, or NULL for default
209 * @buf_size: Size of download buffer, or zero for default
210 */
fastboot_init(void * buf_addr,u32 buf_size)211 void fastboot_init(void *buf_addr, u32 buf_size)
212 {
213 fastboot_buf_addr = buf_addr ? buf_addr :
214 (void *)CONFIG_FASTBOOT_BUF_ADDR;
215 fastboot_buf_size = buf_size ? buf_size : CONFIG_FASTBOOT_BUF_SIZE;
216 fastboot_set_progress_callback(NULL);
217 }
218