Recognise storage devices on USB bus
[petitboot] / discover / device-handler.c
1 #include <assert.h>
2 #include <stdlib.h>
3 #include <stdbool.h>
4 #include <unistd.h>
5 #include <string.h>
6 #include <errno.h>
7 #include <mntent.h>
8 #include <locale.h>
9 #include <sys/stat.h>
10 #include <sys/wait.h>
11 #include <sys/mount.h>
12
13 #include <talloc/talloc.h>
14 #include <list/list.h>
15 #include <log/log.h>
16 #include <types/types.h>
17 #include <system/system.h>
18 #include <process/process.h>
19 #include <url/url.h>
20 #include <i18n/i18n.h>
21
22 #include <sys/types.h>
23 #include <sys/socket.h>
24 #include <netdb.h>
25 #include <arpa/inet.h>
26
27 #include "device-handler.h"
28 #include "discover-server.h"
29 #include "devmapper.h"
30 #include "user-event.h"
31 #include "platform.h"
32 #include "event.h"
33 #include "parser.h"
34 #include "resource.h"
35 #include "paths.h"
36 #include "sysinfo.h"
37 #include "boot.h"
38 #include "udev.h"
39 #include "network.h"
40 #include "ipmi.h"
41
42 enum default_priority {
43         DEFAULT_PRIORITY_REMOTE         = 1,
44         DEFAULT_PRIORITY_LOCAL_FIRST    = 2,
45         DEFAULT_PRIORITY_LOCAL_LAST     = 0xfe,
46         DEFAULT_PRIORITY_DISABLED       = 0xff,
47 };
48
49 struct device_handler {
50         struct discover_server  *server;
51         int                     dry_run;
52
53         struct pb_udev          *udev;
54         struct network          *network;
55         struct user_event       *user_event;
56
57         struct discover_device  **devices;
58         unsigned int            n_devices;
59
60         struct ramdisk_device   **ramdisks;
61         unsigned int            n_ramdisks;
62
63         struct waitset          *waitset;
64         struct waiter           *timeout_waiter;
65         bool                    autoboot_enabled;
66         unsigned int            sec_to_boot;
67
68         struct discover_boot_option *default_boot_option;
69         int                     default_boot_option_priority;
70
71         struct list             unresolved_boot_options;
72
73         struct boot_task        *pending_boot;
74         bool                    pending_boot_is_default;
75 };
76
77 static int mount_device(struct discover_device *dev);
78 static int umount_device(struct discover_device *dev);
79
80 static int device_handler_init_sources(struct device_handler *handler);
81 static void device_handler_reinit_sources(struct device_handler *handler);
82
83 static void device_handler_update_lang(const char *lang);
84
85 void discover_context_add_boot_option(struct discover_context *ctx,
86                 struct discover_boot_option *boot_option)
87 {
88         boot_option->source = ctx->parser;
89         list_add_tail(&ctx->boot_options, &boot_option->list);
90         talloc_steal(ctx, boot_option);
91 }
92
93 /**
94  * device_handler_get_device_count - Get the count of current handler devices.
95  */
96
97 int device_handler_get_device_count(const struct device_handler *handler)
98 {
99         return handler->n_devices;
100 }
101
102 /**
103  * device_handler_get_device - Get a handler device by index.
104  */
105
106 const struct discover_device *device_handler_get_device(
107         const struct device_handler *handler, unsigned int index)
108 {
109         if (index >= handler->n_devices) {
110                 assert(0 && "bad index");
111                 return NULL;
112         }
113
114         return handler->devices[index];
115 }
116
117 struct discover_boot_option *discover_boot_option_create(
118                 struct discover_context *ctx,
119                 struct discover_device *device)
120 {
121         struct discover_boot_option *opt;
122
123         opt = talloc_zero(ctx, struct discover_boot_option);
124         opt->option = talloc_zero(opt, struct boot_option);
125         opt->device = device;
126
127         return opt;
128 }
129
130 static int device_match_uuid(struct discover_device *dev, const char *uuid)
131 {
132         return dev->uuid && !strcmp(dev->uuid, uuid);
133 }
134
135 static int device_match_label(struct discover_device *dev, const char *label)
136 {
137         return dev->label && !strcmp(dev->label, label);
138 }
139
140 static int device_match_id(struct discover_device *dev, const char *id)
141 {
142         return !strcmp(dev->device->id, id);
143 }
144
145 static int device_match_serial(struct discover_device *dev, const char *serial)
146 {
147         const char *val = discover_device_get_param(dev, "ID_SERIAL");
148         return val && !strcmp(val, serial);
149 }
150
151 static struct discover_device *device_lookup(
152                 struct device_handler *device_handler,
153                 int (match_fn)(struct discover_device *, const char *),
154                 const char *str)
155 {
156         struct discover_device *dev;
157         unsigned int i;
158
159         if (!str)
160                 return NULL;
161
162         for (i = 0; i < device_handler->n_devices; i++) {
163                 dev = device_handler->devices[i];
164
165                 if (match_fn(dev, str))
166                         return dev;
167         }
168
169         return NULL;
170 }
171
172 struct discover_device *device_lookup_by_name(struct device_handler *handler,
173                 const char *name)
174 {
175         if (!strncmp(name, "/dev/", strlen("/dev/")))
176                 name += strlen("/dev/");
177
178         return device_lookup_by_id(handler, name);
179 }
180
181 struct discover_device *device_lookup_by_uuid(
182                 struct device_handler *device_handler,
183                 const char *uuid)
184 {
185         return device_lookup(device_handler, device_match_uuid, uuid);
186 }
187
188 struct discover_device *device_lookup_by_label(
189                 struct device_handler *device_handler,
190                 const char *label)
191 {
192         return device_lookup(device_handler, device_match_label, label);
193 }
194
195 struct discover_device *device_lookup_by_id(
196                 struct device_handler *device_handler,
197                 const char *id)
198 {
199         return device_lookup(device_handler, device_match_id, id);
200 }
201
202 struct discover_device *device_lookup_by_serial(
203                 struct device_handler *device_handler,
204                 const char *serial)
205 {
206         return device_lookup(device_handler, device_match_serial, serial);
207 }
208
209 void device_handler_destroy(struct device_handler *handler)
210 {
211         talloc_free(handler);
212 }
213
214 static int destroy_device(void *arg)
215 {
216         struct discover_device *dev = arg;
217
218         umount_device(dev);
219
220         return 0;
221 }
222
223 struct discover_device *discover_device_create(struct device_handler *handler,
224                 const char *id)
225 {
226         struct discover_device *dev;
227
228         dev = device_lookup_by_id(handler, id);
229         if (dev)
230                 return dev;
231
232         dev = talloc_zero(handler, struct discover_device);
233         dev->device = talloc_zero(dev, struct device);
234         dev->device->id = talloc_strdup(dev->device, id);
235         list_init(&dev->params);
236         list_init(&dev->boot_options);
237
238         talloc_set_destructor(dev, destroy_device);
239
240         return dev;
241 }
242
243 struct discover_device_param {
244         char                    *name;
245         char                    *value;
246         struct list_item        list;
247 };
248
249 void discover_device_set_param(struct discover_device *device,
250                 const char *name, const char *value)
251 {
252         struct discover_device_param *param;
253         bool found = false;
254
255         list_for_each_entry(&device->params, param, list) {
256                 if (!strcmp(param->name, name)) {
257                         found = true;
258                         break;
259                 }
260         }
261
262         if (!found) {
263                 if (!value)
264                         return;
265                 param = talloc(device, struct discover_device_param);
266                 param->name = talloc_strdup(param, name);
267                 list_add(&device->params, &param->list);
268         } else {
269                 if (!value) {
270                         list_remove(&param->list);
271                         talloc_free(param);
272                         return;
273                 }
274                 talloc_free(param->value);
275         }
276
277         param->value = talloc_strdup(param, value);
278 }
279
280 const char *discover_device_get_param(struct discover_device *device,
281                 const char *name)
282 {
283         struct discover_device_param *param;
284
285         list_for_each_entry(&device->params, param, list) {
286                 if (!strcmp(param->name, name))
287                         return param->value;
288         }
289         return NULL;
290 }
291
292 struct device_handler *device_handler_init(struct discover_server *server,
293                 struct waitset *waitset, int dry_run)
294 {
295         struct device_handler *handler;
296         int rc;
297
298         handler = talloc_zero(NULL, struct device_handler);
299         handler->server = server;
300         handler->waitset = waitset;
301         handler->dry_run = dry_run;
302         handler->autoboot_enabled = config_get()->autoboot_enabled;
303
304         list_init(&handler->unresolved_boot_options);
305
306         /* set up our mount point base */
307         pb_mkdir_recursive(mount_base());
308
309         parser_init();
310
311         if (config_get()->safe_mode)
312                 return handler;
313
314         rc = device_handler_init_sources(handler);
315         if (rc) {
316                 talloc_free(handler);
317                 return NULL;
318         }
319
320         return handler;
321 }
322
323 void device_handler_reinit(struct device_handler *handler)
324 {
325         struct discover_boot_option *opt, *tmp;
326         struct ramdisk_device *ramdisk;
327         unsigned int i;
328
329         device_handler_cancel_default(handler);
330
331         /* free unresolved boot options */
332         list_for_each_entry_safe(&handler->unresolved_boot_options,
333                         opt, tmp, list)
334                 talloc_free(opt);
335         list_init(&handler->unresolved_boot_options);
336
337         /* drop all devices */
338         for (i = 0; i < handler->n_devices; i++) {
339                 discover_server_notify_device_remove(handler->server,
340                                 handler->devices[i]->device);
341                 ramdisk = handler->devices[i]->ramdisk;
342                 talloc_free(handler->devices[i]);
343                 talloc_free(ramdisk);
344         }
345
346         talloc_free(handler->devices);
347         handler->devices = NULL;
348         handler->n_devices = 0;
349         talloc_free(handler->ramdisks);
350         handler->ramdisks = NULL;
351         handler->n_ramdisks = 0;
352
353         device_handler_reinit_sources(handler);
354 }
355
356 void device_handler_remove(struct device_handler *handler,
357                 struct discover_device *device)
358 {
359         struct discover_boot_option *opt, *tmp;
360         unsigned int i;
361
362         for (i = 0; i < handler->n_devices; i++)
363                 if (handler->devices[i] == device)
364                         break;
365
366         if (i == handler->n_devices) {
367                 talloc_free(device);
368                 return;
369         }
370
371         /* Free any unresolved options, as they're currently allocated
372          * against the handler */
373         list_for_each_entry_safe(&handler->unresolved_boot_options,
374                         opt, tmp, list) {
375                 if (opt->device != device)
376                         continue;
377                 list_remove(&opt->list);
378                 talloc_free(opt);
379         }
380
381         /* if this is a network device, we have to unregister it from the
382          * network code */
383         if (device->device->type == DEVICE_TYPE_NETWORK)
384                 network_unregister_device(handler->network, device);
385
386         handler->n_devices--;
387         memmove(&handler->devices[i], &handler->devices[i + 1],
388                 (handler->n_devices - i) * sizeof(handler->devices[0]));
389         handler->devices = talloc_realloc(handler, handler->devices,
390                 struct discover_device *, handler->n_devices);
391
392         if (device->notified)
393                 discover_server_notify_device_remove(handler->server,
394                                                         device->device);
395
396         talloc_free(device);
397 }
398
399 static void boot_status(void *arg, struct boot_status *status)
400 {
401         struct device_handler *handler = arg;
402
403         discover_server_notify_boot_status(handler->server, status);
404 }
405
406 static void countdown_status(struct device_handler *handler,
407                 struct discover_boot_option *opt, unsigned int sec)
408 {
409         struct boot_status status;
410
411         status.type = BOOT_STATUS_INFO;
412         status.progress = -1;
413         status.detail = NULL;
414         status.message = talloc_asprintf(handler,
415                         _("Booting in %d sec: %s"), sec, opt->option->name);
416
417         discover_server_notify_boot_status(handler->server, &status);
418
419         talloc_free(status.message);
420 }
421
422 static int default_timeout(void *arg)
423 {
424         struct device_handler *handler = arg;
425         struct discover_boot_option *opt;
426
427         if (!handler->default_boot_option)
428                 return 0;
429
430         if (handler->pending_boot)
431                 return 0;
432
433         opt = handler->default_boot_option;
434
435         if (handler->sec_to_boot) {
436                 countdown_status(handler, opt, handler->sec_to_boot);
437                 handler->sec_to_boot--;
438                 handler->timeout_waiter = waiter_register_timeout(
439                                                 handler->waitset, 1000,
440                                                 default_timeout, handler);
441                 return 0;
442         }
443
444         handler->timeout_waiter = NULL;
445
446         pb_log("Timeout expired, booting default option %s\n", opt->option->id);
447
448         handler->pending_boot = boot(handler, handler->default_boot_option,
449                         NULL, handler->dry_run, boot_status, handler);
450         handler->pending_boot_is_default = true;
451         return 0;
452 }
453
454 struct {
455         enum ipmi_bootdev       ipmi_type;
456         enum device_type        device_type;
457 } device_type_map[] = {
458         { IPMI_BOOTDEV_NETWORK, DEVICE_TYPE_NETWORK },
459         { IPMI_BOOTDEV_DISK, DEVICE_TYPE_DISK },
460         { IPMI_BOOTDEV_DISK, DEVICE_TYPE_USB },
461         { IPMI_BOOTDEV_CDROM, DEVICE_TYPE_OPTICAL },
462 };
463
464 static bool ipmi_device_type_matches(enum ipmi_bootdev ipmi_type,
465                 enum device_type device_type)
466 {
467         unsigned int i;
468
469         for (i = 0; i < ARRAY_SIZE(device_type_map); i++) {
470                 if (device_type_map[i].device_type == device_type)
471                         return device_type_map[i].ipmi_type == ipmi_type;
472         }
473
474         return false;
475 }
476
477 static int autoboot_option_priority(const struct config *config,
478                                 struct discover_boot_option *opt)
479 {
480         enum device_type type = opt->device->device->type;
481         const char *uuid = opt->device->uuid;
482         struct autoboot_option *auto_opt;
483         unsigned int i;
484
485         for (i = 0; i < config->n_autoboot_opts; i++) {
486                 auto_opt = &config->autoboot_opts[i];
487                 if (auto_opt->boot_type == BOOT_DEVICE_UUID)
488                         if (!strcmp(auto_opt->uuid, uuid))
489                                 return DEFAULT_PRIORITY_LOCAL_FIRST + i;
490
491                 if (auto_opt->boot_type == BOOT_DEVICE_TYPE)
492                         if (auto_opt->type == type ||
493                             auto_opt->type == DEVICE_TYPE_ANY)
494                                 return DEFAULT_PRIORITY_LOCAL_FIRST + i;
495         }
496
497         return -1;
498 }
499
500 /*
501  * We have different priorities to resolve conflicts between boot options that
502  * report to be the default for their device. This function assigns a priority
503  * for these options.
504  */
505 static enum default_priority default_option_priority(
506                 struct discover_boot_option *opt)
507 {
508         const struct config *config;
509
510         config = config_get();
511
512         /* We give highest priority to IPMI-configured boot options. If
513          * we have an IPMI bootdev configuration set, then we don't allow
514          * any other defaults */
515         if (config->ipmi_bootdev) {
516                 bool ipmi_match = ipmi_device_type_matches(config->ipmi_bootdev,
517                                 opt->device->device->type);
518                 if (ipmi_match)
519                         return DEFAULT_PRIORITY_REMOTE;
520
521                 pb_debug("handler: disabled default priority due to "
522                                 "non-matching IPMI type %x\n",
523                                 config->ipmi_bootdev);
524                 return DEFAULT_PRIORITY_DISABLED;
525         }
526
527         /* Next, try to match the option against the user-defined autoboot
528          * options, either by device UUID or type. */
529         if (config->n_autoboot_opts) {
530                 int boot_match = autoboot_option_priority(config, opt);
531                 if (boot_match > 0)
532                         return boot_match;
533         }
534
535         /* If the option didn't match any entry in the array, it is disabled */
536         pb_debug("handler: disabled default priority due to "
537                         "non-matching UUID or type\n");
538         return DEFAULT_PRIORITY_DISABLED;
539 }
540
541 static void set_default(struct device_handler *handler,
542                 struct discover_boot_option *opt)
543 {
544         enum default_priority cur_prio, new_prio;
545
546         if (!handler->autoboot_enabled)
547                 return;
548
549         pb_debug("handler: new default option: %s\n", opt->option->id);
550
551         new_prio = default_option_priority(opt);
552
553         /* Anything outside our range prevents a default boot */
554         if (new_prio >= DEFAULT_PRIORITY_DISABLED)
555                 return;
556
557         pb_debug("handler: calculated priority %d\n", new_prio);
558
559         /* Resolve any conflicts: if we have a new default option, it only
560          * replaces the current if it has a higher priority. */
561         if (handler->default_boot_option) {
562
563                 cur_prio = handler->default_boot_option_priority;
564
565                 if (new_prio < cur_prio) {
566                         pb_log("handler: new prio %d beats "
567                                         "old prio %d for %s\n",
568                                         new_prio, cur_prio,
569                                         handler->default_boot_option
570                                                 ->option->id);
571                         handler->default_boot_option = opt;
572                         handler->default_boot_option_priority = new_prio;
573                         /* extend the timeout a little, so the user sees some
574                          * indication of the change */
575                         handler->sec_to_boot += 2;
576                 }
577
578                 return;
579         }
580
581         handler->sec_to_boot = config_get()->autoboot_timeout_sec;
582         handler->default_boot_option = opt;
583         handler->default_boot_option_priority = new_prio;
584
585         pb_log("handler: boot option %s set as default, timeout %u sec.\n",
586                opt->option->id, handler->sec_to_boot);
587
588         default_timeout(handler);
589 }
590
591 static bool resource_is_resolved(struct resource *res)
592 {
593         return !res || res->resolved;
594 }
595
596 /* We only use this in an assert, which will disappear if we're compiling
597  * with NDEBUG, so we need the 'used' attribute for these builds */
598 static bool __attribute__((used)) boot_option_is_resolved(
599                 struct discover_boot_option *opt)
600 {
601         return resource_is_resolved(opt->boot_image) &&
602                 resource_is_resolved(opt->initrd) &&
603                 resource_is_resolved(opt->dtb) &&
604                 resource_is_resolved(opt->icon);
605 }
606
607 static bool resource_resolve(struct resource *res, const char *name,
608                 struct discover_boot_option *opt,
609                 struct device_handler *handler)
610 {
611         struct parser *parser = opt->source;
612
613         if (resource_is_resolved(res))
614                 return true;
615
616         pb_debug("Attempting to resolve resource %s->%s with parser %s\n",
617                         opt->option->id, name, parser->name);
618         parser->resolve_resource(handler, res);
619
620         return res->resolved;
621 }
622
623 static bool boot_option_resolve(struct discover_boot_option *opt,
624                 struct device_handler *handler)
625 {
626         return resource_resolve(opt->boot_image, "boot_image", opt, handler) &&
627                 resource_resolve(opt->initrd, "initrd", opt, handler) &&
628                 resource_resolve(opt->dtb, "dtb", opt, handler) &&
629                 resource_resolve(opt->icon, "icon", opt, handler);
630 }
631
632 static void boot_option_finalise(struct device_handler *handler,
633                 struct discover_boot_option *opt)
634 {
635         assert(boot_option_is_resolved(opt));
636
637         /* check that the parsers haven't set any of the final data */
638         assert(!opt->option->boot_image_file);
639         assert(!opt->option->initrd_file);
640         assert(!opt->option->dtb_file);
641         assert(!opt->option->icon_file);
642         assert(!opt->option->device_id);
643
644         if (opt->boot_image)
645                 opt->option->boot_image_file = opt->boot_image->url->full;
646         if (opt->initrd)
647                 opt->option->initrd_file = opt->initrd->url->full;
648         if (opt->dtb)
649                 opt->option->dtb_file = opt->dtb->url->full;
650         if (opt->icon)
651                 opt->option->icon_file = opt->icon->url->full;
652
653         opt->option->device_id = opt->device->device->id;
654
655         if (opt->option->is_default)
656                 set_default(handler, opt);
657 }
658
659 static void notify_boot_option(struct device_handler *handler,
660                 struct discover_boot_option *opt)
661 {
662         struct discover_device *dev = opt->device;
663
664         if (!dev->notified)
665                 discover_server_notify_device_add(handler->server,
666                                                   opt->device->device);
667         dev->notified = true;
668         discover_server_notify_boot_option_add(handler->server, opt->option);
669 }
670
671 static void process_boot_option_queue(struct device_handler *handler)
672 {
673         struct discover_boot_option *opt, *tmp;
674
675         list_for_each_entry_safe(&handler->unresolved_boot_options,
676                         opt, tmp, list) {
677
678                 pb_debug("queue: attempting resolution for %s\n",
679                                 opt->option->id);
680
681                 if (!boot_option_resolve(opt, handler))
682                         continue;
683
684                 pb_debug("\tresolved!\n");
685
686                 list_remove(&opt->list);
687                 list_add_tail(&opt->device->boot_options, &opt->list);
688                 talloc_steal(opt->device, opt);
689                 boot_option_finalise(handler, opt);
690                 notify_boot_option(handler, opt);
691         }
692 }
693
694 struct discover_context *device_handler_discover_context_create(
695                 struct device_handler *handler,
696                 struct discover_device *device)
697 {
698         struct discover_context *ctx;
699
700         ctx = talloc_zero(handler, struct discover_context);
701         ctx->device = device;
702         ctx->network = handler->network;
703         list_init(&ctx->boot_options);
704
705         return ctx;
706 }
707
708 /**
709  * context_commit - Commit a temporary discovery context to the handler,
710  * and notify the clients about any new options / devices
711  */
712 void device_handler_discover_context_commit(struct device_handler *handler,
713                 struct discover_context *ctx)
714 {
715         struct discover_device *dev = ctx->device;
716         struct discover_boot_option *opt, *tmp;
717
718         if (!device_lookup_by_id(handler, dev->device->id))
719                 device_handler_add_device(handler, dev);
720
721         /* move boot options from the context to the device */
722         list_for_each_entry_safe(&ctx->boot_options, opt, tmp, list) {
723                 list_remove(&opt->list);
724
725                 if (boot_option_resolve(opt, handler)) {
726                         pb_log("boot option %s is resolved, "
727                                         "sending to clients\n",
728                                         opt->option->id);
729                         list_add_tail(&dev->boot_options, &opt->list);
730                         talloc_steal(dev, opt);
731                         boot_option_finalise(handler, opt);
732                         notify_boot_option(handler, opt);
733                 } else {
734                         if (!opt->source->resolve_resource) {
735                                 pb_log("parser %s gave us an unresolved "
736                                         "resource (%s), but no way to "
737                                         "resolve it\n",
738                                         opt->source->name, opt->option->id);
739                                 talloc_free(opt);
740                         } else {
741                                 pb_log("boot option %s is unresolved, "
742                                                 "adding to queue\n",
743                                                 opt->option->id);
744                                 list_add(&handler->unresolved_boot_options,
745                                                 &opt->list);
746                                 talloc_steal(handler, opt);
747                         }
748                 }
749         }
750 }
751
752 void device_handler_add_device(struct device_handler *handler,
753                 struct discover_device *device)
754 {
755         handler->n_devices++;
756         handler->devices = talloc_realloc(handler, handler->devices,
757                                 struct discover_device *, handler->n_devices);
758         handler->devices[handler->n_devices - 1] = device;
759
760         if (device->device->type == DEVICE_TYPE_NETWORK)
761                 network_register_device(handler->network, device);
762 }
763
764 void device_handler_add_ramdisk(struct device_handler *handler,
765                 const char *path)
766 {
767         struct ramdisk_device *dev;
768         unsigned int i;
769
770         if (!path)
771                 return;
772
773         for (i = 0; i < handler->n_ramdisks; i++)
774                 if (!strcmp(handler->ramdisks[i]->path, path))
775                         return;
776
777         dev = talloc_zero(handler, struct ramdisk_device);
778         if (!dev) {
779                 pb_log("Failed to allocate memory to track %s\n", path);
780                 return;
781         }
782
783         dev->path = talloc_strdup(handler, path);
784
785         handler->ramdisks = talloc_realloc(handler, handler->ramdisks,
786                                 struct ramdisk_device *,
787                                 handler->n_ramdisks + 1);
788         if (!handler->ramdisks) {
789                 pb_log("Failed to reallocate memory"
790                        "- ramdisk tracking inconsistent!\n");
791                 return;
792         }
793
794         handler->ramdisks[i] = dev;
795         i = handler->n_ramdisks++;
796 }
797
798 struct ramdisk_device *device_handler_get_ramdisk(
799                 struct device_handler *handler)
800 {
801         unsigned int i;
802         char *name;
803         dev_t id;
804
805         /* Check if free ramdisk exists */
806         for (i = 0; i < handler->n_ramdisks; i++)
807                 if (!handler->ramdisks[i]->snapshot &&
808                     !handler->ramdisks[i]->origin &&
809                     !handler->ramdisks[i]->base)
810                         return handler->ramdisks[i];
811
812         /* Otherwise create a new one */
813         name = talloc_asprintf(handler, "/dev/ram%d",
814                         handler->n_ramdisks);
815         if (!name) {
816                 pb_debug("Failed to allocate memory to name /dev/ram%d",
817                         handler->n_ramdisks);
818                 return NULL;
819         }
820
821         id = makedev(1, handler->n_ramdisks);
822         if (mknod(name, S_IFBLK, id)) {
823                 if (errno == EEXIST) {
824                         /* We haven't yet received updates for existing
825                          * ramdisks - add and use this one */
826                         pb_debug("Using untracked ramdisk %s\n", name);
827                 } else {
828                         pb_log("Failed to create new ramdisk %s: %s\n",
829                                name, strerror(errno));
830                         return NULL;
831                 }
832         }
833         device_handler_add_ramdisk(handler, name);
834         talloc_free(name);
835
836         return handler->ramdisks[i];
837 }
838
839 void device_handler_release_ramdisk(struct discover_device *device)
840 {
841         struct ramdisk_device *ramdisk = device->ramdisk;
842
843         talloc_free(ramdisk->snapshot);
844         talloc_free(ramdisk->origin);
845         talloc_free(ramdisk->base);
846
847         ramdisk->snapshot = ramdisk->origin = ramdisk->base = NULL;
848         ramdisk->sectors = 0;
849
850         device->ramdisk = NULL;
851 }
852
853 /* Start discovery on a hotplugged device. The device will be in our devices
854  * array, but has only just been initialised by the hotplug source.
855  */
856 int device_handler_discover(struct device_handler *handler,
857                 struct discover_device *dev)
858 {
859         struct discover_context *ctx;
860         struct boot_status *status;
861         int rc;
862
863         status = talloc_zero(handler, struct boot_status);
864         status->type = BOOT_STATUS_INFO;
865         status->message = talloc_asprintf(status, "Processing %s device %s",
866                                 device_type_display_name(dev->device->type),
867                                 dev->device->id);
868         boot_status(handler, status);
869
870         process_boot_option_queue(handler);
871
872         /* create our context */
873         ctx = device_handler_discover_context_create(handler, dev);
874
875         rc = mount_device(dev);
876         if (rc)
877                 goto out;
878
879         /* add this device to our system info */
880         system_info_register_blockdev(dev->device->id, dev->uuid,
881                         dev->mount_path);
882
883         /* run the parsers. This will populate the ctx's boot_option list. */
884         iterate_parsers(ctx);
885
886         /* add discovered stuff to the handler */
887         device_handler_discover_context_commit(handler, ctx);
888
889 out:
890         status->message = talloc_asprintf(status,"Processing %s complete\n",
891                                 dev->device->id);
892         boot_status(handler, status);
893
894         talloc_free(status);
895         talloc_free(ctx);
896
897         return 0;
898 }
899
900 /* Incoming dhcp event */
901 int device_handler_dhcp(struct device_handler *handler,
902                 struct discover_device *dev, struct event *event)
903 {
904         struct discover_context *ctx;
905         struct boot_status *status;
906
907         status = talloc_zero(handler, struct boot_status);
908         status->type = BOOT_STATUS_INFO;
909         status->message = talloc_asprintf(status, "Processing dhcp event on %s",
910                                 dev->device->id);
911         boot_status(handler, status);
912
913         /* create our context */
914         ctx = device_handler_discover_context_create(handler, dev);
915         ctx->event = event;
916
917         iterate_parsers(ctx);
918
919         device_handler_discover_context_commit(handler, ctx);
920
921         status->message = talloc_asprintf(status,"Processing %s complete\n",
922                                 dev->device->id);
923         boot_status(handler, status);
924
925         talloc_free(status);
926         talloc_free(ctx);
927
928         return 0;
929 }
930
931 /* incoming conf event */
932 int device_handler_conf(struct device_handler *handler,
933                 struct discover_device *dev, struct pb_url *url)
934 {
935         struct discover_context *ctx;
936         struct boot_status *status;
937
938         status = talloc_zero(handler, struct boot_status);
939         status->type = BOOT_STATUS_INFO;
940         status->message = talloc_asprintf(status, "Processing user config");
941         boot_status(handler, status);
942
943         /* create our context */
944         ctx = device_handler_discover_context_create(handler, dev);
945         ctx->conf_url = url;
946
947         iterate_parsers(ctx);
948
949         device_handler_discover_context_commit(handler, ctx);
950
951         status->message = talloc_asprintf(status,
952                                 "Processing user config complete");
953         boot_status(handler, status);
954
955         talloc_free(status);
956         talloc_free(ctx);
957
958         return 0;
959 }
960
961 static struct discover_boot_option *find_boot_option_by_id(
962                 struct device_handler *handler, const char *id)
963 {
964         unsigned int i;
965
966         for (i = 0; i < handler->n_devices; i++) {
967                 struct discover_device *dev = handler->devices[i];
968                 struct discover_boot_option *opt;
969
970                 list_for_each_entry(&dev->boot_options, opt, list)
971                         if (!strcmp(opt->option->id, id))
972                                 return opt;
973         }
974
975         return NULL;
976 }
977
978 void device_handler_boot(struct device_handler *handler,
979                 struct boot_command *cmd)
980 {
981         struct discover_boot_option *opt = NULL;
982
983         if (cmd->option_id && strlen(cmd->option_id))
984                 opt = find_boot_option_by_id(handler, cmd->option_id);
985
986         if (handler->pending_boot)
987                 boot_cancel(handler->pending_boot);
988
989         platform_pre_boot();
990
991         handler->pending_boot = boot(handler, opt, cmd, handler->dry_run,
992                         boot_status, handler);
993         handler->pending_boot_is_default = false;
994 }
995
996 void device_handler_cancel_default(struct device_handler *handler)
997 {
998         struct boot_status status;
999
1000         if (handler->timeout_waiter)
1001                 waiter_remove(handler->timeout_waiter);
1002
1003         handler->timeout_waiter = NULL;
1004         handler->autoboot_enabled = false;
1005
1006         /* we only send status if we had a default boot option queued */
1007         if (!handler->default_boot_option)
1008                 return;
1009
1010         pb_log("Cancelling default boot option\n");
1011
1012         if (handler->pending_boot && handler->pending_boot_is_default) {
1013                 boot_cancel(handler->pending_boot);
1014                 handler->pending_boot = NULL;
1015                 handler->pending_boot_is_default = false;
1016         }
1017
1018         handler->default_boot_option = NULL;
1019
1020         status.type = BOOT_STATUS_INFO;
1021         status.progress = -1;
1022         status.detail = NULL;
1023         status.message = _("Default boot cancelled");
1024
1025         discover_server_notify_boot_status(handler->server, &status);
1026 }
1027
1028 void device_handler_update_config(struct device_handler *handler,
1029                 struct config *config)
1030 {
1031         int rc;
1032
1033         rc = config_set(config);
1034         if (rc)
1035                 return;
1036
1037         discover_server_notify_config(handler->server, config);
1038         device_handler_update_lang(config->lang);
1039         device_handler_reinit(handler);
1040 }
1041
1042 static char *device_from_addr(void *ctx, struct pb_url *url)
1043 {
1044         char *ipaddr, *buf, *tok, *dev = NULL;
1045         const char *delim = " ";
1046         struct sockaddr_in *ip;
1047         struct sockaddr_in si;
1048         struct addrinfo *res;
1049         struct process *p;
1050         int rc;
1051
1052         /* Note: IPv4 only */
1053         rc = inet_pton(AF_INET, url->host, &(si.sin_addr));
1054         if (rc > 0) {
1055                 ipaddr = url->host;
1056         } else {
1057                 /* need to turn hostname into a valid IP */
1058                 rc = getaddrinfo(url->host, NULL, NULL, &res);
1059                 if (rc) {
1060                         pb_debug("%s: Invalid URL\n",__func__);
1061                         return NULL;
1062                 }
1063                 ipaddr = talloc_array(ctx,char,INET_ADDRSTRLEN);
1064                 ip = (struct sockaddr_in *) res->ai_addr;
1065                 inet_ntop(AF_INET, &(ip->sin_addr), ipaddr, INET_ADDRSTRLEN);
1066                 freeaddrinfo(res);
1067         }
1068
1069         const char *argv[] = {
1070                 pb_system_apps.ip,
1071                 "route", "show", "to", "match",
1072                 ipaddr,
1073                 NULL
1074         };
1075
1076         p = process_create(ctx);
1077
1078         p->path = pb_system_apps.ip;
1079         p->argv = argv;
1080         p->keep_stdout = true;
1081
1082         rc = process_run_sync(p);
1083
1084         if (rc) {
1085                 /* ip has complained for some reason; most likely
1086                  * there is no route to the host - bail out */
1087                 pb_debug("%s: No route to %s\n",__func__,url->host);
1088                 return NULL;
1089         }
1090
1091         buf = p->stdout_buf;
1092         /* If a route is found, ip-route output will be of the form
1093          * "... dev DEVNAME ... " */
1094         tok = strtok(buf, delim);
1095         while (tok) {
1096                 if (!strcmp(tok, "dev")) {
1097                         tok = strtok(NULL, delim);
1098                         dev = talloc_strdup(ctx, tok);
1099                         break;
1100                 }
1101                 tok = strtok(NULL, delim);
1102         }
1103
1104         process_release(p);
1105         if (dev)
1106                 pb_debug("%s: Found interface '%s'\n", __func__,dev);
1107         return dev;
1108 }
1109
1110
1111 void device_handler_process_url(struct device_handler *handler,
1112                 const char *url)
1113 {
1114         struct discover_context *ctx;
1115         struct discover_device *dev;
1116         struct boot_status *status;
1117         struct pb_url *pb_url;
1118         struct event *event;
1119         struct param *param;
1120
1121         status = talloc(handler, struct boot_status);
1122
1123         status->type = BOOT_STATUS_ERROR;
1124         status->progress = 0;
1125         status->detail = talloc_asprintf(status,
1126                         _("Received config URL %s"), url);
1127
1128         if (!handler->network) {
1129                 status->message = talloc_asprintf(handler,
1130                                         _("No network configured"));
1131                 goto msg;
1132         }
1133
1134         event = talloc(handler, struct event);
1135         event->type = EVENT_TYPE_USER;
1136         event->action = EVENT_ACTION_CONF;
1137
1138         event->params = talloc_array(event, struct param, 1);
1139         param = &event->params[0];
1140         param->name = talloc_strdup(event, "pxeconffile");
1141         param->value = talloc_strdup(event, url);
1142         event->n_params = 1;
1143
1144         pb_url = pb_url_parse(event, event->params->value);
1145         if (!pb_url || !pb_url->host) {
1146                 status->message = talloc_asprintf(handler,
1147                                         _("Invalid config URL!"));
1148                 goto msg;
1149         }
1150
1151         event->device = device_from_addr(event, pb_url);
1152         if (!event->device) {
1153                 status->message = talloc_asprintf(status,
1154                                         _("Unable to route to host %s"),
1155                                         pb_url->host);
1156                 goto msg;
1157         }
1158
1159         dev = discover_device_create(handler, event->device);
1160         ctx = device_handler_discover_context_create(handler, dev);
1161         ctx->event = event;
1162
1163         iterate_parsers(ctx);
1164
1165         device_handler_discover_context_commit(handler, ctx);
1166
1167         talloc_free(ctx);
1168
1169         status->type = BOOT_STATUS_INFO;
1170         status->message = talloc_asprintf(status, _("Config file %s parsed"),
1171                                         pb_url->file);
1172 msg:
1173         boot_status(handler, status);
1174         talloc_free(status);
1175 }
1176
1177 #ifndef PETITBOOT_TEST
1178
1179 static void device_handler_update_lang(const char *lang)
1180 {
1181         const char *cur_lang;
1182
1183         if (!lang)
1184                 return;
1185
1186         cur_lang = setlocale(LC_ALL, NULL);
1187         if (cur_lang && !strcmp(cur_lang, lang))
1188                 return;
1189
1190         setlocale(LC_ALL, lang);
1191 }
1192
1193 static int device_handler_init_sources(struct device_handler *handler)
1194 {
1195         /* init our device sources: udev, network and user events */
1196         handler->udev = udev_init(handler, handler->waitset);
1197         if (!handler->udev)
1198                 return -1;
1199
1200         handler->network = network_init(handler, handler->waitset,
1201                         handler->dry_run);
1202         if (!handler->network)
1203                 return -1;
1204
1205         handler->user_event = user_event_init(handler, handler->waitset);
1206         if (!handler->user_event)
1207                 return -1;
1208
1209         return 0;
1210 }
1211
1212 static void device_handler_reinit_sources(struct device_handler *handler)
1213 {
1214         /* if we haven't initialised sources previously (becuase we started in
1215          * safe mode), then init once here. */
1216         if (!(handler->udev || handler->network || handler->user_event)) {
1217                 device_handler_init_sources(handler);
1218                 return;
1219         }
1220
1221         udev_reinit(handler->udev);
1222
1223         network_shutdown(handler->network);
1224         handler->network = network_init(handler, handler->waitset,
1225                         handler->dry_run);
1226 }
1227
1228 static const char *fs_parameters(unsigned int rw_flags, const char *fstype)
1229 {
1230         if ((rw_flags | MS_RDONLY) != MS_RDONLY)
1231                 return "";
1232
1233         /* Avoid writing back to the disk on journaled filesystems */
1234         if (!strncmp(fstype, "ext4", strlen("ext4")))
1235                 return "norecovery";
1236         if (!strncmp(fstype, "xfs", strlen("xfs")))
1237                 return "norecovery";
1238
1239         return "";
1240 }
1241
1242 static inline const char *get_device_path(struct discover_device *dev)
1243 {
1244         return dev->ramdisk ? dev->ramdisk->snapshot : dev->device_path;
1245 }
1246
1247 static bool check_existing_mount(struct discover_device *dev)
1248 {
1249         struct stat devstat, mntstat;
1250         const char *device_path;
1251         struct mntent *mnt;
1252         FILE *fp;
1253         int rc;
1254
1255         device_path = get_device_path(dev);
1256
1257         rc = stat(device_path, &devstat);
1258         if (rc) {
1259                 pb_debug("%s: stat failed: %s\n", __func__, strerror(errno));
1260                 return false;
1261         }
1262
1263         if (!S_ISBLK(devstat.st_mode)) {
1264                 pb_debug("%s: %s isn't a block device?\n", __func__,
1265                                 dev->device_path);
1266                 return false;
1267         }
1268
1269         fp = fopen("/proc/self/mounts", "r");
1270
1271         for (;;) {
1272                 mnt = getmntent(fp);
1273                 if (!mnt)
1274                         break;
1275
1276                 if (!mnt->mnt_fsname || mnt->mnt_fsname[0] != '/')
1277                         continue;
1278
1279                 rc = stat(mnt->mnt_fsname, &mntstat);
1280                 if (rc)
1281                         continue;
1282
1283                 if (!S_ISBLK(mntstat.st_mode))
1284                         continue;
1285
1286                 if (mntstat.st_rdev == devstat.st_rdev) {
1287                         dev->mount_path = talloc_strdup(dev, mnt->mnt_dir);
1288                         dev->mounted_rw = !!hasmntopt(mnt, "rw");
1289                         dev->mounted = true;
1290                         dev->unmount = false;
1291
1292                         pb_debug("%s: %s is already mounted (r%c) at %s\n",
1293                                         __func__, dev->device_path,
1294                                         dev->mounted_rw ? 'w' : 'o',
1295                                         mnt->mnt_dir);
1296                         break;
1297                 }
1298         }
1299
1300         fclose(fp);
1301
1302         return mnt != NULL;
1303 }
1304
1305 static int mount_device(struct discover_device *dev)
1306 {
1307         const char *fstype, *device_path;
1308         int rc;
1309
1310         if (!dev->device_path)
1311                 return -1;
1312
1313         if (dev->mounted)
1314                 return 0;
1315
1316         if (check_existing_mount(dev))
1317                 return 0;
1318
1319         fstype = discover_device_get_param(dev, "ID_FS_TYPE");
1320         if (!fstype)
1321                 return 0;
1322
1323         /* ext3 treats the norecovery option as an error, so mount the device
1324          * as an ext4 filesystem instead */
1325         if (!strncmp(fstype, "ext3", strlen("ext3"))) {
1326                 pb_debug("Mounting ext3 filesystem as ext4\n");
1327                 fstype = talloc_asprintf(dev, "ext4");
1328         }
1329
1330         dev->mount_path = join_paths(dev, mount_base(),
1331                                         dev->device_path);
1332
1333         if (pb_mkdir_recursive(dev->mount_path)) {
1334                 pb_log("couldn't create mount directory %s: %s\n",
1335                                 dev->mount_path, strerror(errno));
1336                 goto err_free;
1337         }
1338
1339         device_path = get_device_path(dev);
1340
1341         pb_log("mounting device %s read-only\n", dev->device_path);
1342         errno = 0;
1343         rc = mount(device_path, dev->mount_path, fstype,
1344                         MS_RDONLY | MS_SILENT,
1345                         fs_parameters(MS_RDONLY, fstype));
1346         if (!rc) {
1347                 dev->mounted = true;
1348                 dev->mounted_rw = false;
1349                 dev->unmount = true;
1350                 return 0;
1351         }
1352
1353         pb_log("couldn't mount device %s: mount failed: %s\n",
1354                         device_path, strerror(errno));
1355
1356         /* If mount fails clean up any snapshot */
1357         devmapper_destroy_snapshot(dev);
1358
1359         pb_rmdir_recursive(mount_base(), dev->mount_path);
1360 err_free:
1361         talloc_free(dev->mount_path);
1362         dev->mount_path = NULL;
1363         return -1;
1364 }
1365
1366 static int umount_device(struct discover_device *dev)
1367 {
1368         const char *device_path;
1369         int rc;
1370
1371         if (!dev->mounted || !dev->unmount)
1372                 return 0;
1373
1374         device_path = get_device_path(dev);
1375
1376         pb_log("unmounting device %s\n", device_path);
1377         rc = umount(dev->mount_path);
1378         if (rc)
1379                 return -1;
1380
1381         dev->mounted = false;
1382         devmapper_destroy_snapshot(dev);
1383
1384         pb_rmdir_recursive(mount_base(), dev->mount_path);
1385
1386         talloc_free(dev->mount_path);
1387         dev->mount_path = NULL;
1388
1389         return 0;
1390 }
1391
1392 int device_request_write(struct discover_device *dev, bool *release)
1393 {
1394         const char *fstype, *device_path;
1395         const struct config *config;
1396         int rc;
1397
1398         *release = false;
1399
1400         config = config_get();
1401         if (!config->allow_writes)
1402                 return -1;
1403
1404         if (!dev->mounted)
1405                 return -1;
1406
1407         if (dev->mounted_rw)
1408                 return 0;
1409
1410         fstype = discover_device_get_param(dev, "ID_FS_TYPE");
1411
1412         device_path = get_device_path(dev);
1413
1414         pb_log("remounting device %s read-write\n", device_path);
1415
1416         rc = umount(dev->mount_path);
1417         if (rc) {
1418                 pb_log("Failed to unmount %s: %s\n",
1419                        dev->mount_path, strerror(errno));
1420                 return -1;
1421         }
1422
1423         rc = mount(device_path, dev->mount_path, fstype,
1424                         MS_SILENT,
1425                         fs_parameters(MS_REMOUNT, fstype));
1426         if (rc)
1427                 goto mount_ro;
1428
1429         dev->mounted_rw = true;
1430         *release = true;
1431         return 0;
1432
1433 mount_ro:
1434         pb_log("Unable to remount device %s read-write: %s\n",
1435                device_path, strerror(errno));
1436         if (mount(device_path, dev->mount_path, fstype,
1437                         MS_RDONLY | MS_SILENT,
1438                         fs_parameters(MS_RDONLY, fstype)))
1439                 pb_log("Unable to recover mount for %s: %s\n",
1440                        device_path, strerror(errno));
1441         return -1;
1442 }
1443
1444 void device_release_write(struct discover_device *dev, bool release)
1445 {
1446         const char *fstype, *device_path;
1447         int rc = 0;
1448
1449         if (!release)
1450                 return;
1451
1452         device_path = get_device_path(dev);
1453
1454         fstype = discover_device_get_param(dev, "ID_FS_TYPE");
1455
1456         pb_log("remounting device %s read-only\n", device_path);
1457
1458         if (umount(dev->mount_path)) {
1459                 pb_log("Failed to unmount %s\n", dev->mount_path);
1460                 return;
1461         }
1462         dev->mounted_rw = dev->mounted = false;
1463
1464         if (dev->ramdisk) {
1465                 devmapper_merge_snapshot(dev);
1466                 /* device_path becomes stale after merge */
1467                 device_path = get_device_path(dev);
1468         }
1469
1470         mount(device_path, dev->mount_path, fstype,
1471                         MS_RDONLY | MS_SILENT,
1472                         fs_parameters(MS_RDONLY, fstype));
1473         if (rc)
1474                 pb_log("Failed to remount %s read-only: %s\n",
1475                        device_path, strerror(errno));
1476         else
1477                 dev->mounted = true;
1478 }
1479
1480 #else
1481
1482 static void device_handler_update_lang(const char *lang __attribute__((unused)))
1483 {
1484 }
1485
1486 static int device_handler_init_sources(
1487                 struct device_handler *handler __attribute__((unused)))
1488 {
1489         return 0;
1490 }
1491
1492 static void device_handler_reinit_sources(
1493                 struct device_handler *handler __attribute__((unused)))
1494 {
1495 }
1496
1497 static int umount_device(struct discover_device *dev __attribute__((unused)))
1498 {
1499         return 0;
1500 }
1501
1502 static int __attribute__((unused)) mount_device(
1503                 struct discover_device *dev __attribute__((unused)))
1504 {
1505         return 0;
1506 }
1507
1508 int device_request_write(struct discover_device *dev __attribute__((unused)),
1509                 bool *release)
1510 {
1511         *release = true;
1512         return 0;
1513 }
1514
1515 void device_release_write(struct discover_device *dev __attribute__((unused)),
1516         bool release __attribute__((unused)))
1517 {
1518 }
1519
1520 #endif
1521