ed30ef9fe085104d1e94f957d426e1c7555089e0
[petitboot] / discover / boot.c
1
2 #define _GNU_SOURCE
3
4 #include <stdbool.h>
5 #include <stdlib.h>
6 #include <assert.h>
7 #include <dirent.h>
8 #include <string.h>
9 #include <fcntl.h>
10 #include <sys/types.h>
11
12 #include <log/log.h>
13 #include <pb-protocol/pb-protocol.h>
14 #include <system/system.h>
15 #include <talloc/talloc.h>
16 #include <url/url.h>
17
18 #include "device-handler.h"
19 #include "boot.h"
20 #include "paths.h"
21 #include "resource.h"
22
23 static const char *boot_hook_dir = PKG_SYSCONF_DIR "/boot.d";
24 enum {
25         BOOT_HOOK_EXIT_OK       = 0,
26         BOOT_HOOK_EXIT_UPDATE   = 2,
27 };
28
29
30 struct boot_task {
31         char *local_image;
32         char *local_initrd;
33         char *local_dtb;
34         char *args;
35
36         bool dry_run;
37 };
38
39 /**
40  * kexec_load - kexec load helper.
41  */
42 static int kexec_load(struct boot_task *boot_task)
43 {
44         int result;
45         const char *argv[7];
46         const char **p;
47         char *s_initrd = NULL;
48         char *s_dtb = NULL;
49         char *s_args = NULL;
50
51         p = argv;
52         *p++ = pb_system_apps.kexec;    /* 1 */
53         *p++ = "-l";                    /* 2 */
54
55         if (boot_task->local_initrd) {
56                 s_initrd = talloc_asprintf(NULL, "--initrd=%s",
57                                 boot_task->local_initrd);
58                 assert(s_initrd);
59                 *p++ = s_initrd;         /* 3 */
60         }
61
62         if (boot_task->local_dtb) {
63                 s_dtb = talloc_asprintf(NULL, "--dtb=%s", boot_task->local_dtb);
64                 assert(s_dtb);
65                 *p++ = s_dtb;            /* 4 */
66         }
67
68         if (boot_task->args) {
69                 s_args = talloc_asprintf(NULL, "--append=%s", boot_task->args);
70                 assert(s_args);
71                 *p++ = s_args;          /* 5 */
72         }
73
74         *p++ = boot_task->local_image;  /* 6 */
75         *p++ = NULL;                    /* 7 */
76
77         result = pb_run_cmd(argv, 1, boot_task->dry_run);
78
79         if (result)
80                 pb_log("%s: failed: (%d)\n", __func__, result);
81
82         talloc_free(s_initrd);
83         talloc_free(s_dtb);
84         talloc_free(s_args);
85
86         return result;
87 }
88
89 /**
90  * kexec_reboot - Helper to boot the new kernel.
91  *
92  * Must only be called after a successful call to kexec_load().
93  */
94
95 static int kexec_reboot(bool dry_run)
96 {
97         int result = 0;
98         const char *argv[4];
99         const char **p;
100
101         /* First try running shutdown.  Init scripts should run 'exec -e' */
102
103         p = argv;
104         *p++ = pb_system_apps.shutdown; /* 1 */
105         *p++ =  "-r";                   /* 2 */
106         *p++ =  "now";                  /* 3 */
107         *p++ =  NULL;                   /* 4 */
108
109         result = pb_run_cmd(argv, 1, dry_run);
110
111         /* On error, force a kexec with the -e option */
112
113         if (result) {
114                 p = argv;
115                 *p++ = pb_system_apps.kexec;    /* 1 */
116                 *p++ = "-e";                    /* 2 */
117                 *p++ = NULL;                    /* 3 */
118
119                 result = pb_run_cmd(argv, 1, 0);
120         }
121
122         if (result)
123                 pb_log("%s: failed: (%d)\n", __func__, result);
124
125         /* okay, kexec -e -f */
126         if (result) {
127                 p = argv;
128                 *p++ = pb_system_apps.kexec;    /* 1 */
129                 *p++ = "-e";                    /* 2 */
130                 *p++ = "-f";                    /* 3 */
131                 *p++ = NULL;                    /* 4 */
132
133                 result = pb_run_cmd(argv, 1, 0);
134         }
135
136         if (result)
137                 pb_log("%s: failed: (%d)\n", __func__, result);
138
139
140         return result;
141 }
142
143 static void update_status(boot_status_fn fn, void *arg, int type,
144                 char *message)
145 {
146         struct boot_status status;
147
148         status.type = type;
149         status.message = message;
150         status.progress = -1;
151         status.detail = NULL;
152
153         fn(arg, &status);
154 }
155
156 static void boot_hook_update_param(void *ctx, struct boot_task *task,
157                 const char *name, const char *value)
158 {
159         struct p {
160                 const char *name;
161                 char **p;
162         } *param, params[] = {
163                 { "boot_image",         &task->local_image },
164                 { "boot_initrd",        &task->local_initrd },
165                 { "boot_dtb",           &task->local_dtb },
166                 { "boot_args",          &task->args },
167                 { NULL, NULL },
168         };
169
170         for (param = params; param->name; param++) {
171                 if (strcmp(param->name, name))
172                         continue;
173
174                 *param->p = talloc_strdup(ctx, value);
175                 return;
176         }
177 }
178
179 static void boot_hook_update(void *ctx, const char *hookname,
180                 struct boot_task *task, char *buf)
181 {
182         char *line, *name, *val, *sep;
183         char *saveptr;
184
185         for (;; buf = NULL) {
186
187                 line = strtok_r(buf, "\n", &saveptr);
188                 if (!line)
189                         break;
190
191                 sep = strchr(line, '=');
192                 if (!sep)
193                         continue;
194
195                 *sep = '\0';
196                 name = line;
197                 val = sep + 1;
198
199                 boot_hook_update_param(ctx, task, name, val);
200
201                 pb_log("boot hook %s specified %s=%s\n",
202                                 hookname, name, val);
203         }
204 }
205
206 static void boot_hook_setenv(struct boot_task *task)
207 {
208         unsetenv("boot_image");
209         unsetenv("boot_initrd");
210         unsetenv("boot_dtb");
211         unsetenv("boot_args");
212
213         setenv("boot_image", task->local_image, 1);
214         if (task->local_initrd)
215                 setenv("boot_initrd", task->local_initrd, 1);
216         if (task->local_dtb)
217                 setenv("boot_dtb", task->local_dtb, 1);
218         if (task->args)
219                 setenv("boot_args", task->args, 1);
220 }
221
222 static int hook_filter(const struct dirent *dirent)
223 {
224         return dirent->d_type == DT_REG || dirent->d_type == DT_LNK;
225 }
226
227 static int hook_cmp(const struct dirent **a, const struct dirent **b)
228 {
229         return strcmp((*a)->d_name, (*b)->d_name);
230 }
231
232 static void run_boot_hooks(void *ctx, struct boot_task *task,
233                 boot_status_fn status_fn, void *status_arg)
234 {
235         struct dirent **hooks;
236         int i, n;
237
238         n = scandir(boot_hook_dir, &hooks, hook_filter, hook_cmp);
239         if (n < 1)
240                 return;
241
242         update_status(status_fn, status_arg, BOOT_STATUS_INFO,
243                         "running boot hooks");
244
245         boot_hook_setenv(task);
246
247         for (i = 0; i < n; i++) {
248                 const char *argv[2] = { NULL, NULL };
249                 char *path, *buf;
250                 int buf_len, rc;
251
252                 path = join_paths(ctx, boot_hook_dir, hooks[i]->d_name);
253
254                 if (access(path, X_OK))
255                         continue;
256
257                 pb_log("running boot hook %s\n", hooks[i]->d_name);
258
259                 argv[0] = path;
260                 rc = pb_run_cmd_pipe(argv, 1, task->dry_run, ctx,
261                                 &buf, &buf_len);
262
263                 /* if the hook returned with BOOT_HOOK_EXIT_UPDATE,
264                  * then we process stdout to look for updated params
265                  */
266                 if (rc == BOOT_HOOK_EXIT_UPDATE) {
267                         boot_hook_update(ctx, hooks[i]->d_name, task, buf);
268                         boot_hook_setenv(task);
269                 }
270
271                 talloc_free(buf);
272                 talloc_free(path);
273         }
274
275         free(hooks);
276 }
277
278 int boot(void *ctx, struct discover_boot_option *opt, struct boot_command *cmd,
279                 int dry_run, boot_status_fn status_fn, void *status_arg)
280 {
281         struct boot_task boot_task;
282         struct pb_url *image, *initrd, *dtb;
283         unsigned int clean_image = 0;
284         unsigned int clean_initrd = 0;
285         unsigned int clean_dtb = 0;
286         int result;
287
288         image = NULL;
289         initrd = NULL;
290         dtb = NULL;
291         boot_task.dry_run = dry_run;
292
293         if (cmd && cmd->boot_image_file) {
294                 image = pb_url_parse(opt, cmd->boot_image_file);
295         } else if (opt && opt->boot_image) {
296                 image = opt->boot_image->url;
297         } else {
298                 pb_log("%s: no image specified", __func__);
299                 return -1;
300         }
301
302         if (cmd && cmd->initrd_file) {
303                 initrd = pb_url_parse(opt, cmd->initrd_file);
304         } else if (opt && opt->initrd) {
305                 initrd = opt->initrd->url;
306         }
307
308         if (cmd && cmd->dtb_file) {
309                 dtb = pb_url_parse(opt, cmd->dtb_file);
310         } else if (opt && opt->dtb) {
311                 dtb = opt->dtb->url;
312         }
313
314         if (cmd && cmd->boot_args) {
315                 boot_task.args = talloc_strdup(ctx, cmd->boot_args);
316         } else if (opt && opt->option->boot_args) {
317                 boot_task.args = talloc_strdup(ctx, opt->option->boot_args);
318         } else {
319                 boot_task.args = NULL;
320         }
321
322         result = -1;
323
324         update_status(status_fn, status_arg, BOOT_STATUS_INFO,
325                         "loading kernel");
326         boot_task.local_image = load_url(NULL, image, &clean_image);
327         if (!boot_task.local_image) {
328                 update_status(status_fn, status_arg, BOOT_STATUS_ERROR,
329                                 "Couldn't load kernel image");
330                 goto no_load;
331         }
332
333         boot_task.local_initrd = NULL;
334         if (initrd) {
335                 update_status(status_fn, status_arg, BOOT_STATUS_INFO,
336                                 "loading initrd");
337                 boot_task.local_initrd = load_url(NULL, initrd, &clean_initrd);
338                 if (!boot_task.local_initrd) {
339                         update_status(status_fn, status_arg, BOOT_STATUS_ERROR,
340                                         "Couldn't load initrd image");
341                         goto no_load;
342                 }
343         }
344
345         boot_task.local_dtb = NULL;
346         if (dtb) {
347                 update_status(status_fn, status_arg, BOOT_STATUS_INFO,
348                                 "loading device tree");
349                 boot_task.local_dtb = load_url(NULL, dtb, &clean_dtb);
350                 if (!boot_task.local_dtb) {
351                         update_status(status_fn, status_arg, BOOT_STATUS_ERROR,
352                                         "Couldn't load device tree");
353                         goto no_load;
354                 }
355         }
356
357         run_boot_hooks(ctx, &boot_task, status_fn, status_arg);
358
359         update_status(status_fn, status_arg, BOOT_STATUS_INFO,
360                         "performing kexec_load");
361
362         result = kexec_load(&boot_task);
363
364         if (result) {
365                 update_status(status_fn, status_arg, BOOT_STATUS_ERROR,
366                                 "kexec load failed");
367         }
368
369 no_load:
370         if (clean_image)
371                 unlink(boot_task.local_image);
372         if (clean_initrd)
373                 unlink(boot_task.local_initrd);
374         if (clean_dtb)
375                 unlink(boot_task.local_dtb);
376
377         talloc_free(boot_task.local_image);
378         talloc_free(boot_task.local_initrd);
379         talloc_free(boot_task.local_dtb);
380
381         if (!result) {
382                 update_status(status_fn, status_arg, BOOT_STATUS_INFO,
383                                 "performing kexec reboot");
384
385                 result = kexec_reboot(boot_task.dry_run);
386
387                 if (result) {
388                         update_status(status_fn, status_arg, BOOT_STATUS_ERROR,
389                                         "kexec reboot failed");
390                 }
391         }
392
393         return result;
394 }