mirror of https://github.com/OpenIPC/firmware.git
475 lines
12 KiB
Diff
475 lines
12 KiB
Diff
diff -drupN a/init/do_mounts_dm.c b/init/do_mounts_dm.c
|
|
--- a/init/do_mounts_dm.c 1970-01-01 03:00:00.000000000 +0300
|
|
+++ b/init/do_mounts_dm.c 2022-06-12 05:28:14.000000000 +0300
|
|
@@ -0,0 +1,470 @@
|
|
+/* do_mounts_dm.c
|
|
+ * Copyright (C) 2010 The Chromium OS Authors <chromium-os-dev@chromium.org>
|
|
+ * All Rights Reserved.
|
|
+ * Based on do_mounts_md.c
|
|
+ *
|
|
+ * This file is released under the GPL.
|
|
+ */
|
|
+#include <linux/async.h>
|
|
+#include <linux/ctype.h>
|
|
+#include <linux/device-mapper.h>
|
|
+#include <linux/fs.h>
|
|
+#include <linux/string.h>
|
|
+#include <linux/delay.h>
|
|
+
|
|
+#include "do_mounts.h"
|
|
+
|
|
+#define DM_MAX_DEVICES 256
|
|
+#define DM_MAX_TARGETS 256
|
|
+#define DM_MAX_NAME 32
|
|
+#define DM_MAX_UUID 129
|
|
+#define DM_NO_UUID "none"
|
|
+
|
|
+#define DM_MSG_PREFIX "init"
|
|
+
|
|
+/* Separators used for parsing the dm= argument. */
|
|
+#define DM_FIELD_SEP " "
|
|
+#define DM_LINE_SEP ","
|
|
+#define DM_ANY_SEP DM_FIELD_SEP DM_LINE_SEP
|
|
+
|
|
+/*
|
|
+ * When the device-mapper and any targets are compiled into the kernel
|
|
+ * (not a module), one or more device-mappers may be created and used
|
|
+ * as the root device at boot time with the parameters given with the
|
|
+ * boot line dm=...
|
|
+ *
|
|
+ * Multiple device-mappers can be stacked specifing the number of
|
|
+ * devices. A device can have multiple targets if the the number of
|
|
+ * targets is specified.
|
|
+ *
|
|
+ * TODO(taysom:defect 32847)
|
|
+ * In the future, the <num> field will be mandatory.
|
|
+ *
|
|
+ * <device> ::= [<num>] <device-mapper>+
|
|
+ * <device-mapper> ::= <head> "," <target>+
|
|
+ * <head> ::= <name> <uuid> <mode> [<num>]
|
|
+ * <target> ::= <start> <length> <type> <options> ","
|
|
+ * <mode> ::= "ro" | "rw"
|
|
+ * <uuid> ::= xxxxxxxx-xxxx-xxxx-xxxx-xxxxxxxxxxxx | "none"
|
|
+ * <type> ::= "verity" | "bootcache" | ...
|
|
+ *
|
|
+ * Example:
|
|
+ * 2 vboot none ro 1,
|
|
+ * 0 1768000 bootcache
|
|
+ * device=aa55b119-2a47-8c45-946a-5ac57765011f+1
|
|
+ * signature=76e9be054b15884a9fa85973e9cb274c93afadb6
|
|
+ * cache_start=1768000 max_blocks=100000 size_limit=23 max_trace=20000,
|
|
+ * vroot none ro 1,
|
|
+ * 0 1740800 verity payload=254:0 hashtree=254:0 hashstart=1740800 alg=sha1
|
|
+ * root_hexdigest=76e9be054b15884a9fa85973e9cb274c93afadb6
|
|
+ * salt=5b3549d54d6c7a3837b9b81ed72e49463a64c03680c47835bef94d768e5646fe
|
|
+ *
|
|
+ * Notes:
|
|
+ * 1. uuid is a label for the device and we set it to "none".
|
|
+ * 2. The <num> field will be optional initially and assumed to be 1.
|
|
+ * Once all the scripts that set these fields have been set, it will
|
|
+ * be made mandatory.
|
|
+ */
|
|
+
|
|
+struct dm_setup_target {
|
|
+ sector_t begin;
|
|
+ sector_t length;
|
|
+ char *type;
|
|
+ char *params;
|
|
+ /* simple singly linked list */
|
|
+ struct dm_setup_target *next;
|
|
+};
|
|
+
|
|
+struct dm_device {
|
|
+ int minor;
|
|
+ int ro;
|
|
+ char name[DM_MAX_NAME];
|
|
+ char uuid[DM_MAX_UUID];
|
|
+ unsigned long num_targets;
|
|
+ struct dm_setup_target *target;
|
|
+ int target_count;
|
|
+ struct dm_device *next;
|
|
+};
|
|
+
|
|
+struct dm_option {
|
|
+ char *start;
|
|
+ char *next;
|
|
+ size_t len;
|
|
+ char delim;
|
|
+};
|
|
+
|
|
+static struct {
|
|
+ unsigned long num_devices;
|
|
+ char *str;
|
|
+} dm_setup_args __initdata;
|
|
+
|
|
+static __initdata int dm_early_setup;
|
|
+
|
|
+static int __init get_dm_option(struct dm_option *opt, const char *accept)
|
|
+{
|
|
+ char *str = opt->next;
|
|
+ char *endp;
|
|
+
|
|
+ if (!str)
|
|
+ return 0;
|
|
+
|
|
+ str = skip_spaces(str);
|
|
+ opt->start = str;
|
|
+ endp = strpbrk(str, accept);
|
|
+ if (!endp) { /* act like strchrnul */
|
|
+ opt->len = strlen(str);
|
|
+ endp = str + opt->len;
|
|
+ } else {
|
|
+ opt->len = endp - str;
|
|
+ }
|
|
+ opt->delim = *endp;
|
|
+ if (*endp == 0) {
|
|
+ /* Don't advance past the nul. */
|
|
+ opt->next = endp;
|
|
+ } else {
|
|
+ opt->next = endp + 1;
|
|
+ }
|
|
+ return opt->len != 0;
|
|
+}
|
|
+
|
|
+static int __init dm_setup_cleanup(struct dm_device *devices)
|
|
+{
|
|
+ struct dm_device *dev = devices;
|
|
+
|
|
+ while (dev) {
|
|
+ struct dm_device *old_dev = dev;
|
|
+ struct dm_setup_target *target = dev->target;
|
|
+ while (target) {
|
|
+ struct dm_setup_target *old_target = target;
|
|
+ kfree(target->type);
|
|
+ kfree(target->params);
|
|
+ target = target->next;
|
|
+ kfree(old_target);
|
|
+ dev->target_count--;
|
|
+ }
|
|
+ BUG_ON(dev->target_count);
|
|
+ dev = dev->next;
|
|
+ kfree(old_dev);
|
|
+ }
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static char * __init dm_parse_device(struct dm_device *dev, char *str)
|
|
+{
|
|
+ struct dm_option opt;
|
|
+ size_t len;
|
|
+
|
|
+ /* Grab the logical name of the device to be exported to udev */
|
|
+ opt.next = str;
|
|
+ if (!get_dm_option(&opt, DM_FIELD_SEP)) {
|
|
+ DMERR("failed to parse device name");
|
|
+ goto parse_fail;
|
|
+ }
|
|
+ len = min(opt.len + 1, sizeof(dev->name));
|
|
+ strlcpy(dev->name, opt.start, len); /* includes nul */
|
|
+
|
|
+ /* Grab the UUID value or "none" */
|
|
+ if (!get_dm_option(&opt, DM_FIELD_SEP)) {
|
|
+ DMERR("failed to parse device uuid");
|
|
+ goto parse_fail;
|
|
+ }
|
|
+ len = min(opt.len + 1, sizeof(dev->uuid));
|
|
+ strlcpy(dev->uuid, opt.start, len);
|
|
+
|
|
+ /* Determine if the table/device will be read only or read-write */
|
|
+ get_dm_option(&opt, DM_ANY_SEP);
|
|
+ if (!strncmp("ro", opt.start, opt.len)) {
|
|
+ dev->ro = 1;
|
|
+ } else if (!strncmp("rw", opt.start, opt.len)) {
|
|
+ dev->ro = 0;
|
|
+ } else {
|
|
+ DMERR("failed to parse table mode");
|
|
+ goto parse_fail;
|
|
+ }
|
|
+
|
|
+ /* Optional number field */
|
|
+ /* XXX: The <num> field will be mandatory in the next round */
|
|
+ if (opt.delim == DM_FIELD_SEP[0]) {
|
|
+ if (!get_dm_option(&opt, DM_LINE_SEP))
|
|
+ return NULL;
|
|
+ dev->num_targets = simple_strtoul(opt.start, NULL, 10);
|
|
+ } else {
|
|
+ dev->num_targets = 1;
|
|
+ }
|
|
+ if (dev->num_targets > DM_MAX_TARGETS) {
|
|
+ DMERR("too many targets %lu > %d",
|
|
+ dev->num_targets, DM_MAX_TARGETS);
|
|
+ }
|
|
+ return opt.next;
|
|
+
|
|
+parse_fail:
|
|
+ return NULL;
|
|
+}
|
|
+
|
|
+static char * __init dm_parse_targets(struct dm_device *dev, char *str)
|
|
+{
|
|
+ struct dm_option opt;
|
|
+ struct dm_setup_target **target = &dev->target;
|
|
+ unsigned long num_targets = dev->num_targets;
|
|
+ unsigned long i;
|
|
+
|
|
+ /* Targets are defined as per the table format but with a
|
|
+ * comma as a newline separator. */
|
|
+ opt.next = str;
|
|
+ for (i = 0; i < num_targets; i++) {
|
|
+ *target = kzalloc(sizeof(struct dm_setup_target), GFP_KERNEL);
|
|
+ if (!*target) {
|
|
+ DMERR("failed to allocate memory for target %s<%ld>",
|
|
+ dev->name, i);
|
|
+ goto parse_fail;
|
|
+ }
|
|
+ dev->target_count++;
|
|
+
|
|
+ if (!get_dm_option(&opt, DM_FIELD_SEP)) {
|
|
+ DMERR("failed to parse starting sector"
|
|
+ " for target %s<%ld>", dev->name, i);
|
|
+ goto parse_fail;
|
|
+ }
|
|
+ (*target)->begin = simple_strtoull(opt.start, NULL, 10);
|
|
+
|
|
+ if (!get_dm_option(&opt, DM_FIELD_SEP)) {
|
|
+ DMERR("failed to parse length for target %s<%ld>",
|
|
+ dev->name, i);
|
|
+ goto parse_fail;
|
|
+ }
|
|
+ (*target)->length = simple_strtoull(opt.start, NULL, 10);
|
|
+
|
|
+ if (get_dm_option(&opt, DM_FIELD_SEP))
|
|
+ (*target)->type = kstrndup(opt.start, opt.len,
|
|
+ GFP_KERNEL);
|
|
+ if (!((*target)->type)) {
|
|
+ DMERR("failed to parse type for target %s<%ld>",
|
|
+ dev->name, i);
|
|
+ goto parse_fail;
|
|
+ }
|
|
+ if (get_dm_option(&opt, DM_LINE_SEP))
|
|
+ (*target)->params = kstrndup(opt.start, opt.len,
|
|
+ GFP_KERNEL);
|
|
+ if (!((*target)->params)) {
|
|
+ DMERR("failed to parse params for target %s<%ld>",
|
|
+ dev->name, i);
|
|
+ goto parse_fail;
|
|
+ }
|
|
+ target = &((*target)->next);
|
|
+ }
|
|
+ DMDEBUG("parsed %d targets", dev->target_count);
|
|
+
|
|
+ return opt.next;
|
|
+
|
|
+parse_fail:
|
|
+ return NULL;
|
|
+}
|
|
+
|
|
+static struct dm_device * __init dm_parse_args(void)
|
|
+{
|
|
+ struct dm_device *devices = NULL;
|
|
+ struct dm_device **tail = &devices;
|
|
+ struct dm_device *dev;
|
|
+ char *str = dm_setup_args.str;
|
|
+ unsigned long num_devices = dm_setup_args.num_devices;
|
|
+ unsigned long i;
|
|
+
|
|
+ if (!str)
|
|
+ return NULL;
|
|
+ for (i = 0; i < num_devices; i++) {
|
|
+ dev = kzalloc(sizeof(*dev), GFP_KERNEL);
|
|
+ if (!dev) {
|
|
+ DMERR("failed to allocated memory for dev");
|
|
+ goto error;
|
|
+ }
|
|
+ *tail = dev;
|
|
+ tail = &dev->next;
|
|
+ /*
|
|
+ * devices are given minor numbers 0 - n-1
|
|
+ * in the order they are found in the arg
|
|
+ * string.
|
|
+ */
|
|
+ dev->minor = i;
|
|
+ str = dm_parse_device(dev, str);
|
|
+ if (!str) /* NULL indicates error in parsing, bail */
|
|
+ goto error;
|
|
+
|
|
+ str = dm_parse_targets(dev, str);
|
|
+ if (!str)
|
|
+ goto error;
|
|
+ }
|
|
+ return devices;
|
|
+error:
|
|
+ dm_setup_cleanup(devices);
|
|
+ return NULL;
|
|
+}
|
|
+
|
|
+/*
|
|
+ * Parse the command-line parameters given our kernel, but do not
|
|
+ * actually try to invoke the DM device now; that is handled by
|
|
+ * dm_setup_drives after the low-level disk drivers have initialised.
|
|
+ * dm format is described at the top of the file.
|
|
+ *
|
|
+ * Because dm minor numbers are assigned in assending order starting with 0,
|
|
+ * You can assume the first device is /dev/dm-0, the next device is /dev/dm-1,
|
|
+ * and so forth.
|
|
+ */
|
|
+static int __init dm_setup(char *str)
|
|
+{
|
|
+ struct dm_option opt;
|
|
+ unsigned long num_devices;
|
|
+
|
|
+ if (!str) {
|
|
+ DMDEBUG("str is NULL");
|
|
+ goto parse_fail;
|
|
+ }
|
|
+ opt.next = str;
|
|
+ if (!get_dm_option(&opt, DM_FIELD_SEP))
|
|
+ goto parse_fail;
|
|
+ if (isdigit(opt.start[0])) { /* XXX: Optional number field */
|
|
+ num_devices = simple_strtoul(opt.start, NULL, 10);
|
|
+ str = opt.next;
|
|
+ } else {
|
|
+ num_devices = 1;
|
|
+ /* Don't advance str */
|
|
+ }
|
|
+ if (num_devices > DM_MAX_DEVICES) {
|
|
+ DMDEBUG("too many devices %lu > %d",
|
|
+ num_devices, DM_MAX_DEVICES);
|
|
+ }
|
|
+ dm_setup_args.str = str;
|
|
+ dm_setup_args.num_devices = num_devices;
|
|
+ DMINFO("will configure %lu devices", num_devices);
|
|
+ dm_early_setup = 1;
|
|
+ return 1;
|
|
+
|
|
+parse_fail:
|
|
+ DMWARN("Invalid arguments supplied to dm=.");
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static void __init dm_setup_drives(void)
|
|
+{
|
|
+ struct mapped_device *md = NULL;
|
|
+ struct dm_table *table = NULL;
|
|
+ struct dm_setup_target *target;
|
|
+ struct dm_device *dev;
|
|
+ char *uuid;
|
|
+ fmode_t fmode = FMODE_READ;
|
|
+ struct dm_device *devices;
|
|
+
|
|
+ devices = dm_parse_args();
|
|
+
|
|
+ for (dev = devices; dev; dev = dev->next) {
|
|
+ if (dm_create(dev->minor, &md)) {
|
|
+ DMDEBUG("failed to create the device");
|
|
+ goto dm_create_fail;
|
|
+ }
|
|
+ DMDEBUG("created device '%s'", dm_device_name(md));
|
|
+
|
|
+ /*
|
|
+ * In addition to flagging the table below, the disk must be
|
|
+ * set explicitly ro/rw.
|
|
+ */
|
|
+ set_disk_ro(dm_disk(md), dev->ro);
|
|
+
|
|
+ if (!dev->ro)
|
|
+ fmode |= FMODE_WRITE;
|
|
+ if (dm_table_create(&table, fmode, dev->target_count, md)) {
|
|
+ DMDEBUG("failed to create the table");
|
|
+ goto dm_table_create_fail;
|
|
+ }
|
|
+
|
|
+ dm_lock_md_type(md);
|
|
+
|
|
+ for (target = dev->target; target; target = target->next) {
|
|
+ DMINFO("adding target '%llu %llu %s %s'",
|
|
+ (unsigned long long) target->begin,
|
|
+ (unsigned long long) target->length,
|
|
+ target->type, target->params);
|
|
+ if (dm_table_add_target(table, target->type,
|
|
+ target->begin,
|
|
+ target->length,
|
|
+ target->params)) {
|
|
+ DMDEBUG("failed to add the target"
|
|
+ " to the table");
|
|
+ goto add_target_fail;
|
|
+ }
|
|
+ }
|
|
+ if (dm_table_complete(table)) {
|
|
+ DMDEBUG("failed to complete the table");
|
|
+ goto table_complete_fail;
|
|
+ }
|
|
+
|
|
+ /* Suspend the device so that we can bind it to the table. */
|
|
+ if (dm_suspend(md, 0)) {
|
|
+ DMDEBUG("failed to suspend the device pre-bind");
|
|
+ goto suspend_fail;
|
|
+ }
|
|
+
|
|
+ /* Initial table load: acquire type of table. */
|
|
+ dm_set_md_type(md, dm_table_get_type(table));
|
|
+
|
|
+ /* Setup md->queue to reflect md's type. */
|
|
+ if (dm_setup_md_queue(md, table)) {
|
|
+ DMWARN("unable to set up device queue for new table.");
|
|
+ goto setup_md_queue_fail;
|
|
+ }
|
|
+
|
|
+ /*
|
|
+ * Bind the table to the device. This is the only way
|
|
+ * to associate md->map with the table and set the disk
|
|
+ * capacity directly.
|
|
+ */
|
|
+ if (dm_swap_table(md, table)) { /* should return NULL. */
|
|
+ DMDEBUG("failed to bind the device to the table");
|
|
+ goto table_bind_fail;
|
|
+ }
|
|
+
|
|
+ /* Finally, resume and the device should be ready. */
|
|
+ if (dm_resume(md)) {
|
|
+ DMDEBUG("failed to resume the device");
|
|
+ goto resume_fail;
|
|
+ }
|
|
+
|
|
+ /* Export the dm device via the ioctl interface */
|
|
+ if (!strcmp(DM_NO_UUID, dev->uuid))
|
|
+ uuid = NULL;
|
|
+ if (dm_ioctl_export(md, dev->name, uuid)) {
|
|
+ DMDEBUG("failed to export device with given"
|
|
+ " name and uuid");
|
|
+ goto export_fail;
|
|
+ }
|
|
+
|
|
+ dm_unlock_md_type(md);
|
|
+
|
|
+ DMINFO("dm-%d is ready", dev->minor);
|
|
+ }
|
|
+ dm_setup_cleanup(devices);
|
|
+ return;
|
|
+
|
|
+export_fail:
|
|
+resume_fail:
|
|
+table_bind_fail:
|
|
+setup_md_queue_fail:
|
|
+suspend_fail:
|
|
+table_complete_fail:
|
|
+add_target_fail:
|
|
+ dm_unlock_md_type(md);
|
|
+dm_table_create_fail:
|
|
+ dm_put(md);
|
|
+dm_create_fail:
|
|
+ DMWARN("starting dm-%d (%s) failed",
|
|
+ dev->minor, dev->name);
|
|
+ dm_setup_cleanup(devices);
|
|
+}
|
|
+
|
|
+__setup("dm=", dm_setup);
|
|
+
|
|
+void __init dm_run_setup(void)
|
|
+{
|
|
+ if (!dm_early_setup)
|
|
+ return;
|
|
+ DMINFO("attempting early device configuration.");
|
|
+ dm_setup_drives();
|
|
+}
|