X-Git-Url: https://www.chiark.greenend.org.uk/ucgi/~ianmdlvl/git?a=blobdiff_plain;f=src%2Fcore%2Fdevice.c;h=b5d9d827e2ea11d9c792d4fa98d2cced95a9dd78;hb=4543768d13946e9193b367330cb32ded4d96058a;hp=c7bc1e25e7bd5225a9ce089f79fb3244baf19be1;hpb=f78e6385dc4cee0a1f399c4c89ebf823c108d447;p=elogind.git diff --git a/src/core/device.c b/src/core/device.c index c7bc1e25e..b5d9d827e 100644 --- a/src/core/device.c +++ b/src/core/device.c @@ -23,11 +23,9 @@ #include #include -#include "strv.h" #include "log.h" #include "unit-name.h" #include "dbus-device.h" -#include "def.h" #include "path-util.h" #include "udev-util.h" #include "unit.h" @@ -36,7 +34,8 @@ static const UnitActiveState state_translation_table[_DEVICE_STATE_MAX] = { [DEVICE_DEAD] = UNIT_INACTIVE, - [DEVICE_PLUGGED] = UNIT_ACTIVE + [DEVICE_TENTATIVE] = UNIT_ACTIVATING, + [DEVICE_PLUGGED] = UNIT_ACTIVE, }; static int device_dispatch_io(sd_event_source *source, int fd, uint32_t revents, void *userdata); @@ -65,6 +64,41 @@ static void device_unset_sysfs(Device *d) { d->sysfs = NULL; } +static int device_set_sysfs(Device *d, const char *sysfs) { + Device *first; + char *copy; + int r; + + assert(d); + + if (streq_ptr(d->sysfs, sysfs)) + return 0; + + r = hashmap_ensure_allocated(&UNIT(d)->manager->devices_by_sysfs, &string_hash_ops); + if (r < 0) + return r; + + copy = strdup(sysfs); + if (!copy) + return -ENOMEM; + + device_unset_sysfs(d); + + first = hashmap_get(UNIT(d)->manager->devices_by_sysfs, sysfs); + LIST_PREPEND(same_sysfs, first, d); + + r = hashmap_replace(UNIT(d)->manager->devices_by_sysfs, copy, first); + if (r < 0) { + LIST_REMOVE(same_sysfs, first, d); + free(copy); + return r; + } + + d->sysfs = copy; + + return 0; +} + static void device_init(Unit *u) { Device *d = DEVICE(u); @@ -98,7 +132,7 @@ static void device_set_state(Device *d, DeviceState state) { d->state = state; if (state != old_state) - log_debug_unit(UNIT(d)->id, + log_unit_debug(UNIT(d)->id, "%s changed %s -> %s", UNIT(d)->id, device_state_to_string(old_state), device_state_to_string(state)); @@ -106,14 +140,19 @@ static void device_set_state(Device *d, DeviceState state) { unit_notify(UNIT(d), state_translation_table[old_state], state_translation_table[state], true); } -static int device_coldplug(Unit *u) { +static int device_coldplug(Unit *u, Hashmap *deferred_work) { Device *d = DEVICE(u); assert(d); assert(d->state == DEVICE_DEAD); - if (d->sysfs) + if (d->found & DEVICE_FOUND_UDEV) + /* If udev says the device is around, it's around */ device_set_state(d, DEVICE_PLUGGED); + else if (d->found != DEVICE_NOT_FOUND) + /* If a device is found in /proc/self/mountinfo or + * /proc/swaps, it's "tentatively" around. */ + device_set_state(d, DEVICE_TENTATIVE); return 0; } @@ -142,65 +181,110 @@ _pure_ static const char *device_sub_state_to_string(Unit *u) { return device_state_to_string(DEVICE(u)->state); } -static int device_add_escaped_name(Unit *u, const char *dn) { - _cleanup_free_ char *e = NULL; +static int device_update_description(Unit *u, struct udev_device *dev, const char *path) { + const char *model; int r; assert(u); - assert(dn); - assert(dn[0] == '/'); + assert(dev); + assert(path); - e = unit_name_from_path(dn, ".device"); - if (!e) - return -ENOMEM; + model = udev_device_get_property_value(dev, "ID_MODEL_FROM_DATABASE"); + if (!model) + model = udev_device_get_property_value(dev, "ID_MODEL"); - r = unit_add_name(u, e); - if (r < 0 && r != -EEXIST) - return r; + if (model) { + const char *label; - return 0; + /* Try to concatenate the device model string with a label, if there is one */ + label = udev_device_get_property_value(dev, "ID_FS_LABEL"); + if (!label) + label = udev_device_get_property_value(dev, "ID_PART_ENTRY_NAME"); + if (!label) + label = udev_device_get_property_value(dev, "ID_PART_ENTRY_NUMBER"); + + if (label) { + _cleanup_free_ char *j; + + j = strjoin(model, " ", label, NULL); + if (j) + r = unit_set_description(u, j); + else + r = -ENOMEM; + } else + r = unit_set_description(u, model); + } else + r = unit_set_description(u, path); + + if (r < 0) + log_unit_error_errno(u->id, r, "Failed to set device description: %m"); + + return r; } -static int device_find_escape_name(Manager *m, const char *dn, Unit **_u) { - _cleanup_free_ char *e = NULL; - Unit *u; +static int device_add_udev_wants(Unit *u, struct udev_device *dev) { + const char *wants; + const char *word, *state; + size_t l; + int r; + const char *property; - assert(m); - assert(dn); - assert(dn[0] == '/'); - assert(_u); + assert(u); + assert(dev); - e = unit_name_from_path(dn, ".device"); - if (!e) - return -ENOMEM; + property = u->manager->running_as == SYSTEMD_USER ? "SYSTEMD_USER_WANTS" : "SYSTEMD_WANTS"; + wants = udev_device_get_property_value(dev, property); + if (!wants) + return 0; - u = manager_get_unit(m, e); - if (u) { - *_u = u; - return 1; + FOREACH_WORD_QUOTED(word, l, wants, state) { + _cleanup_free_ char *n = NULL; + char e[l+1]; + + memcpy(e, word, l); + e[l] = 0; + + n = unit_name_mangle(e, MANGLE_NOGLOB); + if (!n) + return log_oom(); + + r = unit_add_dependency_by_name(u, UNIT_WANTS, n, NULL, true); + if (r < 0) + return log_unit_error_errno(u->id, r, "Failed to add wants dependency: %m"); } + if (!isempty(state)) + log_unit_warning(u->id, "Property %s on %s has trailing garbage, ignoring.", property, strna(udev_device_get_syspath(dev))); return 0; } -static int device_update_unit(Manager *m, struct udev_device *dev, const char *path, bool main) { - const char *sysfs, *model; +static int device_setup_unit(Manager *m, struct udev_device *dev, const char *path, bool main) { + _cleanup_free_ char *e = NULL; + const char *sysfs; Unit *u = NULL; - int r; bool delete; + int r; assert(m); + assert(dev); + assert(path); sysfs = udev_device_get_syspath(dev); if (!sysfs) return 0; - r = device_find_escape_name(m, path, &u); - if (r < 0) - return r; + e = unit_name_from_path(path, ".device"); + if (!e) + return log_oom(); - if (u && DEVICE(u)->sysfs && !path_equal(DEVICE(u)->sysfs, sysfs)) + u = manager_get_unit(m, e); + + if (u && + DEVICE(u)->sysfs && + !path_equal(DEVICE(u)->sysfs, sysfs)) { + log_unit_error(u->id, "Device %s appeared twice with different sysfs paths %s and %s", e, DEVICE(u)->sysfs, sysfs); return -EEXIST; + } if (!u) { delete = true; @@ -209,7 +293,7 @@ static int device_update_unit(Manager *m, struct udev_device *dev, const char *p if (!u) return log_oom(); - r = device_add_escaped_name(u, path); + r = unit_add_name(u, e); if (r < 0) goto fail; @@ -221,65 +305,16 @@ static int device_update_unit(Manager *m, struct udev_device *dev, const char *p * actually been seen yet ->sysfs will not be * initialized. Hence initialize it if necessary. */ - if (!DEVICE(u)->sysfs) { - Device *first; - - DEVICE(u)->sysfs = strdup(sysfs); - if (!DEVICE(u)->sysfs) { - r = -ENOMEM; - goto fail; - } - - r = hashmap_ensure_allocated(&m->devices_by_sysfs, string_hash_func, string_compare_func); - if (r < 0) - goto fail; - - first = hashmap_get(m->devices_by_sysfs, sysfs); - LIST_PREPEND(same_sysfs, first, DEVICE(u)); - - r = hashmap_replace(m->devices_by_sysfs, DEVICE(u)->sysfs, first); - if (r < 0) - goto fail; - } - - if ((model = udev_device_get_property_value(dev, "ID_MODEL_FROM_DATABASE")) || - (model = udev_device_get_property_value(dev, "ID_MODEL"))) - r = unit_set_description(u, model); - else - r = unit_set_description(u, path); + r = device_set_sysfs(DEVICE(u), sysfs); if (r < 0) goto fail; - if (main) { - const char *wants; - - /* The additional systemd udev properties we only - * interpret for the main object */ - - wants = udev_device_get_property_value(dev, m->running_as == SYSTEMD_USER ? "SYSTEMD_USER_WANTS" : "SYSTEMD_WANTS"); - if (wants) { - char *state, *w; - size_t l; + (void) device_update_description(u, dev, path); - FOREACH_WORD_QUOTED(w, l, wants, state) { - _cleanup_free_ char *n = NULL; - char e[l+1]; - - memcpy(e, w, l); - e[l] = 0; - - n = unit_name_mangle(e, MANGLE_NOGLOB); - if (!n) { - r = -ENOMEM; - goto fail; - } - - r = unit_add_dependency_by_name(u, UNIT_WANTS, n, NULL, true); - if (r < 0) - goto fail; - } - } - } + /* The additional systemd udev properties we only interpret + * for the main object */ + if (main) + (void) device_add_udev_wants(u, dev); /* Note that this won't dispatch the load queue, the caller * has to do that if needed and appropriate */ @@ -288,7 +323,7 @@ static int device_update_unit(Manager *m, struct udev_device *dev, const char *p return 0; fail: - log_warning("Failed to load device unit: %s", strerror(-r)); + log_unit_warning_errno(u->id, r, "Failed to set up device unit: %m"); if (delete && u) unit_free(u); @@ -296,7 +331,7 @@ fail: return r; } -static int device_process_new_device(Manager *m, struct udev_device *dev) { +static int device_process_new(Manager *m, struct udev_device *dev) { const char *sysfs, *dn, *alias; struct udev_list_entry *item = NULL, *first = NULL; int r; @@ -308,14 +343,14 @@ static int device_process_new_device(Manager *m, struct udev_device *dev) { return 0; /* Add the main unit named after the sysfs path */ - r = device_update_unit(m, dev, sysfs, true); + r = device_setup_unit(m, dev, sysfs, true); if (r < 0) return r; /* Add an additional unit for the device node */ dn = udev_device_get_devnode(dev); if (dn) - device_update_unit(m, dev, dn, false); + (void) device_setup_unit(m, dev, dn, false); /* Add additional units for all symlinks */ first = udev_device_get_devlinks_list_entry(dev); @@ -336,71 +371,96 @@ static int device_process_new_device(Manager *m, struct udev_device *dev) { * same /dev/disk/by-label/xxx link because they have * the same label. We want to make sure that the same * device that won the symlink wins in systemd, so we - * check the device node major/minor*/ + * check the device node major/minor */ if (stat(p, &st) >= 0) if ((!S_ISBLK(st.st_mode) && !S_ISCHR(st.st_mode)) || st.st_rdev != udev_device_get_devnum(dev)) continue; - device_update_unit(m, dev, p, false); + (void) device_setup_unit(m, dev, p, false); } /* Add additional units for all explicitly configured * aliases */ alias = udev_device_get_property_value(dev, "SYSTEMD_ALIAS"); if (alias) { - char *state, *w; + const char *word, *state; size_t l; - FOREACH_WORD_QUOTED(w, l, alias, state) { + FOREACH_WORD_QUOTED(word, l, alias, state) { char e[l+1]; - memcpy(e, w, l); + memcpy(e, word, l); e[l] = 0; if (path_is_absolute(e)) - device_update_unit(m, dev, e, false); + (void) device_setup_unit(m, dev, e, false); else log_warning("SYSTEMD_ALIAS for %s is not an absolute path, ignoring: %s", sysfs, e); } + if (!isempty(state)) + log_warning("SYSTEMD_ALIAS for %s has trailing garbage, ignoring.", sysfs); } return 0; } -static void device_set_path_plugged(Manager *m, struct udev_device *dev) { - const char *sysfs; +static void device_update_found_one(Device *d, bool add, DeviceFound found, bool now) { + DeviceFound n; + + assert(d); + + n = add ? (d->found | found) : (d->found & ~found); + if (n == d->found) + return; + + d->found = n; + + if (now) { + if (d->found & DEVICE_FOUND_UDEV) + device_set_state(d, DEVICE_PLUGGED); + else if (add && d->found != DEVICE_NOT_FOUND) + device_set_state(d, DEVICE_TENTATIVE); + else + device_set_state(d, DEVICE_DEAD); + } +} + +static int device_update_found_by_sysfs(Manager *m, const char *sysfs, bool add, DeviceFound found, bool now) { Device *d, *l; assert(m); - assert(dev); + assert(sysfs); - sysfs = udev_device_get_syspath(dev); - if (!sysfs) - return; + if (found == DEVICE_NOT_FOUND) + return 0; l = hashmap_get(m->devices_by_sysfs, sysfs); LIST_FOREACH(same_sysfs, d, l) - device_set_state(d, DEVICE_PLUGGED); + device_update_found_one(d, add, found, now); + + return 0; } -static int device_process_removed_device(Manager *m, struct udev_device *dev) { - const char *sysfs; - Device *d; +static int device_update_found_by_name(Manager *m, const char *path, bool add, DeviceFound found, bool now) { + _cleanup_free_ char *e = NULL; + Unit *u; assert(m); - assert(dev); + assert(path); - sysfs = udev_device_get_syspath(dev); - if (!sysfs) - return -ENOMEM; + if (found == DEVICE_NOT_FOUND) + return 0; - /* Remove all units of this sysfs path */ - while ((d = hashmap_get(m->devices_by_sysfs, sysfs))) { - device_unset_sysfs(d); - device_set_state(d, DEVICE_DEAD); - } + e = unit_name_from_path(path, ".device"); + if (!e) + return log_oom(); + + u = manager_get_unit(m, e); + if (!u) + return 0; + device_update_found_one(DEVICE(u), add, found, now); return 0; } @@ -416,22 +476,6 @@ static bool device_is_ready(struct udev_device *dev) { return parse_boolean(ready) != 0; } -static int device_process_new_path(Manager *m, const char *path) { - _cleanup_udev_device_unref_ struct udev_device *dev = NULL; - - assert(m); - assert(path); - - dev = udev_device_new_from_syspath(m->udev, path); - if (!dev) - return log_oom(); - - if (!device_is_ready(dev)) - return 0; - - return device_process_new_device(m, dev); -} - static Unit *device_following(Unit *u) { Device *d = DEVICE(u); Device *other, *first = NULL; @@ -469,7 +513,7 @@ static int device_following_set(Unit *u, Set **_set) { return 0; } - set = set_new(NULL, NULL); + set = set_new(NULL); if (!set) return -ENOMEM; @@ -524,7 +568,7 @@ static int device_enumerate(Manager *m) { /* This will fail if we are unprivileged, but that * should not matter much, as user instances won't run * during boot. */ - udev_monitor_set_receive_buffer_size(m->udev_monitor, 128*1024*1024); + (void) udev_monitor_set_receive_buffer_size(m->udev_monitor, 128*1024*1024); r = udev_monitor_filter_add_match_tag(m->udev_monitor, "systemd"); if (r < 0) @@ -534,7 +578,7 @@ static int device_enumerate(Manager *m) { if (r < 0) goto fail; - r = sd_event_add_io(m->event, udev_monitor_get_fd(m->udev_monitor), EPOLLIN, device_dispatch_io, m, &m->udev_event_source); + r = sd_event_add_io(m->event, &m->udev_event_source, udev_monitor_get_fd(m->udev_monitor), EPOLLIN, device_dispatch_io, m); if (r < 0) goto fail; } @@ -558,12 +602,31 @@ static int device_enumerate(Manager *m) { goto fail; first = udev_enumerate_get_list_entry(e); - udev_list_entry_foreach(item, first) - device_process_new_path(m, udev_list_entry_get_name(item)); + udev_list_entry_foreach(item, first) { + _cleanup_udev_device_unref_ struct udev_device *dev = NULL; + const char *sysfs; + + sysfs = udev_list_entry_get_name(item); + + dev = udev_device_new_from_syspath(m->udev, sysfs); + if (!dev) { + log_oom(); + continue; + } + + if (!device_is_ready(dev)) + continue; + + (void) device_process_new(m, dev); + + device_update_found_by_sysfs(m, sysfs, true, DEVICE_FOUND_UDEV, false); + } return 0; fail: + log_error_errno(r, "Failed to enumerate devices: %m"); + device_shutdown(m); return r; } @@ -571,7 +634,7 @@ fail: static int device_dispatch_io(sd_event_source *source, int fd, uint32_t revents, void *userdata) { _cleanup_udev_device_unref_ struct udev_device *dev = NULL; Manager *m = userdata; - const char *action; + const char *action, *sysfs; int r; assert(m); @@ -580,7 +643,7 @@ static int device_dispatch_io(sd_event_source *source, int fd, uint32_t revents, static RATELIMIT_DEFINE(limit, 10*USEC_PER_SEC, 5); if (!ratelimit_test(&limit)) - log_error("Failed to get udev event: %m"); + log_error_errno(errno, "Failed to get udev event: %m"); if (!(revents & EPOLLIN)) return 0; } @@ -593,41 +656,117 @@ static int device_dispatch_io(sd_event_source *source, int fd, uint32_t revents, if (!dev) return 0; + sysfs = udev_device_get_syspath(dev); + if (!sysfs) { + log_error("Failed to get udev sys path."); + return 0; + } + action = udev_device_get_action(dev); if (!action) { log_error("Failed to get udev action string."); return 0; } - if (streq(action, "remove") || !device_is_ready(dev)) { - r = device_process_removed_device(m, dev); + if (streq(action, "remove")) { + r = swap_process_device_remove(m, dev); if (r < 0) - log_error("Failed to process device remove event: %s", strerror(-r)); + log_error_errno(r, "Failed to process swap device remove event: %m"); - r = swap_process_removed_device(m, dev); - if (r < 0) - log_error("Failed to process swap device remove event: %s", strerror(-r)); + /* If we get notified that a device was removed by + * udev, then it's completely gone, hence unset all + * found bits */ + device_update_found_by_sysfs(m, sysfs, false, DEVICE_FOUND_UDEV|DEVICE_FOUND_MOUNT|DEVICE_FOUND_SWAP, true); - } else { - r = device_process_new_device(m, dev); - if (r < 0) - log_error("Failed to process device new event: %s", strerror(-r)); + } else if (device_is_ready(dev)) { + + (void) device_process_new(m, dev); - r = swap_process_new_device(m, dev); + r = swap_process_device_new(m, dev); if (r < 0) - log_error("Failed to process swap device new event: %s", strerror(-r)); + log_error_errno(r, "Failed to process swap device new event: %m"); manager_dispatch_load_queue(m); - device_set_path_plugged(m, dev); + /* The device is found now, set the udev found bit */ + device_update_found_by_sysfs(m, sysfs, true, DEVICE_FOUND_UDEV, true); + + } else { + /* The device is nominally around, but not ready for + * us. Hence unset the udev bit, but leave the rest + * around. */ + + device_update_found_by_sysfs(m, sysfs, false, DEVICE_FOUND_UDEV, true); } return 0; } +static bool device_supported(Manager *m) { + static int read_only = -1; + assert(m); + + /* If /sys is read-only we don't support device units, and any + * attempts to start one should fail immediately. */ + + if (read_only < 0) + read_only = path_is_read_only_fs("/sys"); + + return read_only <= 0; +} + +int device_found_node(Manager *m, const char *node, bool add, DeviceFound found, bool now) { + _cleanup_udev_device_unref_ struct udev_device *dev = NULL; + struct stat st; + + assert(m); + assert(node); + + /* This is called whenever we find a device referenced in + * /proc/swaps or /proc/self/mounts. Such a device might be + * mounted/enabled at a time where udev has not finished + * probing it yet, and we thus haven't learned about it + * yet. In this case we will set the device unit to + * "tentative" state. */ + + if (add) { + if (!path_startswith(node, "/dev")) + return 0; + + if (stat(node, &st) < 0) { + if (errno == ENOENT) + return 0; + + return log_error_errno(errno, "Failed to stat device node file %s: %m", node); + } + + if (!S_ISBLK(st.st_mode) && !S_ISCHR(st.st_mode)) + return 0; + + dev = udev_device_new_from_devnum(m->udev, S_ISBLK(st.st_mode) ? 'b' : 'c', st.st_rdev); + if (!dev) { + if (errno == ENOENT) + return 0; + + return log_oom(); + } + + /* If the device is known in the kernel and newly + * appeared, then we'll create a device unit for it, + * under the name referenced in /proc/swaps or + * /proc/self/mountinfo. */ + + (void) device_setup_unit(m, dev, node, false); + } + + /* Update the device unit's state, should it exist */ + return device_update_found_by_name(m, node, add, found, now); +} + static const char* const device_state_table[_DEVICE_STATE_MAX] = { [DEVICE_DEAD] = "dead", - [DEVICE_PLUGGED] = "plugged" + [DEVICE_TENTATIVE] = "tentative", + [DEVICE_PLUGGED] = "plugged", }; DEFINE_STRING_TABLE_LOOKUP(device_state, DeviceState); @@ -660,6 +799,7 @@ const UnitVTable device_vtable = { .enumerate = device_enumerate, .shutdown = device_shutdown, + .supported = device_supported, .status_message_formats = { .starting_stopping = {