node_device_udev.c 53.5 KB
Newer Older
1 2 3
/*
 * node_device_udev.c: node device enumeration - libudev implementation
 *
4
 * Copyright (C) 2009-2015 Red Hat, Inc.
5 6 7 8 9 10 11 12 13 14 15 16
 *
 * This library is free software; you can redistribute it and/or
 * modify it under the terms of the GNU Lesser General Public
 * License as published by the Free Software Foundation; either
 * version 2.1 of the License, or (at your option) any later version.
 *
 * This library is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * Lesser General Public License for more details.
 *
 * You should have received a copy of the GNU Lesser General Public
17
 * License along with this library.  If not, see
O
Osier Yang 已提交
18
 * <http://www.gnu.org/licenses/>.
19 20 21 22 23 24
 *
 * Author: Dave Allan <dallan@redhat.com>
 */

#include <config.h>
#include <libudev.h>
25
#include <pciaccess.h>
26 27 28
#include <scsi/scsi.h>
#include <c-ctype.h>

29
#include "dirname.h"
30
#include "node_device_conf.h"
31
#include "node_device_event.h"
32
#include "node_device_driver.h"
33 34 35
#include "node_device_linux_sysfs.h"
#include "node_device_udev.h"
#include "virerror.h"
36 37
#include "driver.h"
#include "datatypes.h"
38
#include "virlog.h"
39
#include "viralloc.h"
40
#include "viruuid.h"
41
#include "virbuffer.h"
42
#include "virfile.h"
43
#include "virpci.h"
44
#include "virstring.h"
45
#include "virnetdev.h"
46
#include "virmdev.h"
47 48 49

#define VIR_FROM_THIS VIR_FROM_NODEDEV

50 51
VIR_LOG_INIT("node_device.node_device_udev");

52 53 54 55
#ifndef TYPE_RAID
# define TYPE_RAID 12
#endif

56 57 58
struct _udevPrivate {
    struct udev_monitor *udev_monitor;
    int watch;
59
    bool privileged;
60 61
};

62

J
Ján Tomko 已提交
63 64 65 66 67 68 69 70 71 72 73
static bool
udevHasDeviceProperty(struct udev_device *dev,
                      const char *key)
{
    if (udev_device_get_property_value(dev, key))
        return true;

    return false;
}


74 75
static const char *udevGetDeviceProperty(struct udev_device *udev_device,
                                         const char *property_key)
76
{
77
    const char *ret = NULL;
78

79
    ret = udev_device_get_property_value(udev_device, property_key);
80

81 82
    VIR_DEBUG("Found property key '%s' value '%s' for device with sysname '%s'",
              property_key, NULLSTR(ret), udev_device_get_sysname(udev_device));
83 84 85 86 87 88 89 90 91

    return ret;
}


static int udevGetStringProperty(struct udev_device *udev_device,
                                 const char *property_key,
                                 char **value)
{
92 93
    if (VIR_STRDUP(*value,
                   udevGetDeviceProperty(udev_device, property_key)) < 0)
94
        return -1;
95

96
    return 0;
97 98 99 100 101 102 103 104
}


static int udevGetIntProperty(struct udev_device *udev_device,
                              const char *property_key,
                              int *value,
                              int base)
{
105
    const char *str = NULL;
106

107
    str = udevGetDeviceProperty(udev_device, property_key);
108

109
    if (str && virStrToLong_i(str, NULL, base, value) < 0) {
110 111
        virReportError(VIR_ERR_INTERNAL_ERROR,
                       _("Failed to convert '%s' to int"), str);
112
        return -1;
113
    }
114
    return 0;
115 116 117 118 119 120 121 122
}


static int udevGetUintProperty(struct udev_device *udev_device,
                               const char *property_key,
                               unsigned int *value,
                               int base)
{
123
    const char *str = NULL;
124

125
    str = udevGetDeviceProperty(udev_device, property_key);
126

127
    if (str && virStrToLong_ui(str, NULL, base, value) < 0) {
128 129
        virReportError(VIR_ERR_INTERNAL_ERROR,
                       _("Failed to convert '%s' to int"), str);
130
        return -1;
131
    }
132
    return 0;
133 134 135
}


136 137
static const char *udevGetDeviceSysfsAttr(struct udev_device *udev_device,
                                          const char *attr_name)
138
{
139
    const char *ret = NULL;
140

141
    ret = udev_device_get_sysattr_value(udev_device, attr_name);
142 143

    VIR_DEBUG("Found sysfs attribute '%s' value '%s' "
144
              "for device with sysname '%s'",
145
              attr_name, NULLSTR(ret),
146 147 148 149 150 151 152 153 154
              udev_device_get_sysname(udev_device));
    return ret;
}


static int udevGetStringSysfsAttr(struct udev_device *udev_device,
                                  const char *attr_name,
                                  char **value)
{
155
    if (VIR_STRDUP(*value, udevGetDeviceSysfsAttr(udev_device, attr_name)) < 0)
156
        return -1;
157

158
    virStringStripControlChars(*value);
159

160 161
    if (*value != NULL && (STREQ(*value, "")))
        VIR_FREE(*value);
162

163
    return 0;
164 165 166 167 168 169 170 171
}


static int udevGetIntSysfsAttr(struct udev_device *udev_device,
                               const char *attr_name,
                               int *value,
                               int base)
{
172
    const char *str = NULL;
173

174
    str = udevGetDeviceSysfsAttr(udev_device, attr_name);
175

176
    if (str && virStrToLong_i(str, NULL, base, value) < 0) {
177 178
        virReportError(VIR_ERR_INTERNAL_ERROR,
                       _("Failed to convert '%s' to int"), str);
179
        return -1;
180 181
    }

182
    return 0;
183 184 185 186 187 188 189 190
}


static int udevGetUintSysfsAttr(struct udev_device *udev_device,
                                const char *attr_name,
                                unsigned int *value,
                                int base)
{
191
    const char *str = NULL;
192

193
    str = udevGetDeviceSysfsAttr(udev_device, attr_name);
194

195
    if (str && virStrToLong_ui(str, NULL, base, value) < 0) {
196 197
        virReportError(VIR_ERR_INTERNAL_ERROR,
                       _("Failed to convert '%s' to unsigned int"), str);
198
        return -1;
199 200
    }

201
    return 0;
202 203 204 205 206 207 208
}


static int udevGetUint64SysfsAttr(struct udev_device *udev_device,
                                  const char *attr_name,
                                  unsigned long long *value)
{
209
    const char *str = NULL;
210

211
    str = udevGetDeviceSysfsAttr(udev_device, attr_name);
212

213
    if (str && virStrToLong_ull(str, NULL, 0, value) < 0) {
214 215
        virReportError(VIR_ERR_INTERNAL_ERROR,
                       _("Failed to convert '%s' to unsigned long long"), str);
J
Ján Tomko 已提交
216
        return -1;
217 218
    }

J
Ján Tomko 已提交
219
    return 0;
220 221 222 223 224 225 226
}


static int udevGenerateDeviceName(struct udev_device *device,
                                  virNodeDeviceDefPtr def,
                                  const char *s)
{
227
    size_t i;
228 229
    virBuffer buf = VIR_BUFFER_INITIALIZER;

230
    virBufferAsprintf(&buf, "%s_%s",
231 232 233
                      udev_device_get_subsystem(device),
                      udev_device_get_sysname(device));

234
    if (s != NULL)
235
        virBufferAsprintf(&buf, "_%s", s);
236

237 238
    if (virBufferCheckError(&buf) < 0)
        return -1;
239 240 241

    def->name = virBufferContentAndReset(&buf);

242
    for (i = 0; i < strlen(def->name); i++) {
243
        if (!(c_isalnum(*(def->name + i))))
244 245 246
            *(def->name + i) = '_';
    }

247
    return 0;
248 249
}

250
#if HAVE_UDEV_LOGGING
J
Ján Tomko 已提交
251 252 253 254 255 256 257 258 259
typedef void (*udevLogFunctionPtr)(struct udev *udev,
                                   int priority,
                                   const char *file,
                                   int line,
                                   const char *fn,
                                   const char *format,
                                   va_list args);

static void
260
ATTRIBUTE_FMT_PRINTF(6, 0)
J
Ján Tomko 已提交
261 262 263 264 265 266 267
udevLogFunction(struct udev *udev ATTRIBUTE_UNUSED,
                int priority,
                const char *file,
                int line,
                const char *fn,
                const char *fmt,
                va_list args)
268
{
J
Ján Tomko 已提交
269
    virBuffer buf = VIR_BUFFER_INITIALIZER;
270
    char *format = NULL;
J
Ján Tomko 已提交
271 272 273 274 275 276

    virBufferAdd(&buf, fmt, -1);
    virBufferTrim(&buf, "\n", -1);

    format = virBufferContentAndReset(&buf);

277
    virLogVMessage(&virLogSelf,
J
Ján Tomko 已提交
278 279 280 281
                   virLogPriorityFromSyslog(priority),
                   file, line, fn, NULL, format ? format : fmt, args);

    VIR_FREE(format);
282
}
283
#endif
284 285


286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304
static int udevTranslatePCIIds(unsigned int vendor,
                               unsigned int product,
                               char **vendor_string,
                               char **product_string)
{
    struct pci_id_match m;
    const char *vendor_name = NULL, *device_name = NULL;

    m.vendor_id = vendor;
    m.device_id = product;
    m.subvendor_id = PCI_MATCH_ANY;
    m.subdevice_id = PCI_MATCH_ANY;
    m.device_class = 0;
    m.device_class_mask = 0;
    m.match_data = 0;

    /* pci_get_strings returns void */
    pci_get_strings(&m,
                    &device_name,
305
                    &vendor_name,
306 307 308
                    NULL,
                    NULL);

309
    if (VIR_STRDUP(*vendor_string, vendor_name) < 0 ||
310
        VIR_STRDUP(*product_string, device_name) < 0)
311
        return -1;
312

313
    return 0;
314 315 316
}


317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429
static int
udevFillMdevType(struct udev_device *device,
                 const char *dir,
                 virNodeDevCapMdevTypePtr type)
{
    int ret = -1;
    char *attrpath = NULL;

#define MDEV_GET_SYSFS_ATTR(attr_name, cb, ...)                             \
    do {                                                                    \
        if (virAsprintf(&attrpath, "%s/%s", dir, #attr_name) < 0)           \
            goto cleanup;                                                   \
                                                                            \
        if (cb(device, attrpath, __VA_ARGS__) < 0)                          \
            goto cleanup;                                                   \
                                                                            \
        VIR_FREE(attrpath);                                                 \
    } while (0)                                                             \

    if (VIR_STRDUP(type->id, last_component(dir)) < 0)
        goto cleanup;

    /* query udev for the attributes under subdirectories using the relative
     * path stored in @dir, i.e. 'mdev_supported_types/<type_id>'
     */
    MDEV_GET_SYSFS_ATTR(name, udevGetStringSysfsAttr, &type->name);
    MDEV_GET_SYSFS_ATTR(device_api, udevGetStringSysfsAttr, &type->device_api);
    MDEV_GET_SYSFS_ATTR(available_instances, udevGetUintSysfsAttr,
                        &type->available_instances, 10);

#undef MDEV_GET_SYSFS_ATTR

    ret = 0;
 cleanup:
    VIR_FREE(attrpath);
    return ret;
}


static int
udevPCIGetMdevTypesCap(struct udev_device *device,
                       virNodeDevCapPCIDevPtr pcidata)
{
    int ret = -1;
    int dirret = -1;
    DIR *dir = NULL;
    struct dirent *entry;
    char *path = NULL;
    char *tmppath = NULL;
    virNodeDevCapMdevTypePtr type = NULL;
    virNodeDevCapMdevTypePtr *types = NULL;
    size_t ntypes = 0;
    size_t i;

    if (virAsprintf(&path, "%s/mdev_supported_types",
                    udev_device_get_syspath(device)) < 0)
        return -1;

    if ((dirret = virDirOpenIfExists(&dir, path)) < 0)
        goto cleanup;

    if (dirret == 0) {
        ret = 0;
        goto cleanup;
    }

    if (VIR_ALLOC(types) < 0)
        goto cleanup;

    /* UDEV doesn't report attributes under subdirectories by default but is
     * able to query them if the path to the attribute is relative to the
     * device's base path, e.g. /sys/devices/../0000:00:01.0/ is the device's
     * base path as udev reports it, but we're interested in attributes under
     * /sys/devices/../0000:00:01.0/mdev_supported_types/<type>/. So, we need to
     * scan the subdirectories ourselves.
     */
    while ((dirret = virDirRead(dir, &entry, path)) > 0) {
        if (VIR_ALLOC(type) < 0)
            goto cleanup;

        /* construct the relative mdev type path bit for udev */
        if (virAsprintf(&tmppath, "mdev_supported_types/%s", entry->d_name) < 0)
            goto cleanup;

        if (udevFillMdevType(device, tmppath, type) < 0)
            goto cleanup;

        if (VIR_APPEND_ELEMENT(types, ntypes, type) < 0)
            goto cleanup;

        VIR_FREE(tmppath);
    }

    if (dirret < 0)
        goto cleanup;

    VIR_STEAL_PTR(pcidata->mdev_types, types);
    pcidata->nmdev_types = ntypes;
    pcidata->flags |= VIR_NODE_DEV_CAP_FLAG_PCI_MDEV;
    ntypes = 0;
    ret = 0;
 cleanup:
    virNodeDevCapMdevTypeFree(type);
    for (i = 0; i < ntypes; i++)
        virNodeDevCapMdevTypeFree(types[i]);
    VIR_FREE(types);
    VIR_FREE(path);
    VIR_FREE(tmppath);
    VIR_DIR_CLOSE(dir);
    return ret;
}


430 431 432
static int udevProcessPCI(struct udev_device *device,
                          virNodeDeviceDefPtr def)
{
433
    virNodeDevCapPCIDevPtr pci_dev = &def->caps->data.pci_dev;
434 435
    virPCIEDeviceInfoPtr pci_express = NULL;
    virPCIDevicePtr pciDev = NULL;
436
    udevPrivate *priv = driver->privateData;
437
    int ret = -1;
438
    char *p;
439

440
    if (udevGetUintProperty(device, "PCI_CLASS", &pci_dev->class, 16) < 0)
441
        goto cleanup;
442

443
    if ((p = strrchr(def->sysfs_path, '/')) == NULL ||
444 445 446 447
        virStrToLong_ui(p + 1, &p, 16, &pci_dev->domain) < 0 || p == NULL ||
        virStrToLong_ui(p + 1, &p, 16, &pci_dev->bus) < 0 || p == NULL ||
        virStrToLong_ui(p + 1, &p, 16, &pci_dev->slot) < 0 || p == NULL ||
        virStrToLong_ui(p + 1, &p, 16, &pci_dev->function) < 0) {
448 449
        virReportError(VIR_ERR_INTERNAL_ERROR,
                       _("failed to parse the PCI address from sysfs path: '%s'"),
450
                       def->sysfs_path);
451
        goto cleanup;
452 453
    }

454
    if (udevGetUintSysfsAttr(device, "vendor", &pci_dev->vendor, 16) < 0)
455
        goto cleanup;
456

457
    if (udevGetUintSysfsAttr(device, "device", &pci_dev->product, 16) < 0)
458
        goto cleanup;
459

460 461 462 463
    if (udevTranslatePCIIds(pci_dev->vendor,
                            pci_dev->product,
                            &pci_dev->vendor_name,
                            &pci_dev->product_name) != 0) {
464
        goto cleanup;
465
    }
466

467
    if (udevGenerateDeviceName(device, def, NULL) != 0)
468
        goto cleanup;
469

470 471
    /* The default value is -1, because it can't be 0
     * as zero is valid node number. */
472
    pci_dev->numa_node = -1;
473
    if (udevGetIntSysfsAttr(device, "numa_node",
474
                            &pci_dev->numa_node, 10) < 0)
475
        goto cleanup;
476

477
    if (nodeDeviceSysfsGetPCIRelatedDevCaps(def->sysfs_path, pci_dev) < 0)
478
        goto cleanup;
479

480 481 482 483
    if (!(pciDev = virPCIDeviceNew(pci_dev->domain,
                                   pci_dev->bus,
                                   pci_dev->slot,
                                   pci_dev->function)))
484
        goto cleanup;
485

486
    /* We need to be root to read PCI device configs */
487
    if (priv->privileged) {
488
        if (virPCIGetHeaderType(pciDev, &pci_dev->hdrType) < 0)
489
            goto cleanup;
490

491 492
        if (virPCIDeviceIsPCIExpress(pciDev) > 0) {
            if (VIR_ALLOC(pci_express) < 0)
493
                goto cleanup;
494

495 496 497
            if (virPCIDeviceHasPCIExpressLink(pciDev) > 0) {
                if (VIR_ALLOC(pci_express->link_cap) < 0 ||
                    VIR_ALLOC(pci_express->link_sta) < 0)
498
                    goto cleanup;
499 500 501 502 503 504 505

                if (virPCIDeviceGetLinkCapSta(pciDev,
                                              &pci_express->link_cap->port,
                                              &pci_express->link_cap->speed,
                                              &pci_express->link_cap->width,
                                              &pci_express->link_sta->speed,
                                              &pci_express->link_sta->width) < 0)
506
                    goto cleanup;
507 508 509

                pci_express->link_sta->port = -1; /* PCIe can't negotiate port. Yet :) */
            }
510 511
            pci_dev->flags |= VIR_NODE_DEV_CAP_FLAG_PCIE;
            pci_dev->pci_express = pci_express;
512
            pci_express = NULL;
513 514 515
        }
    }

516 517 518 519 520 521
    /* check whether the device is mediated devices framework capable, if so,
     * process it
     */
    if (udevPCIGetMdevTypesCap(device, pci_dev) < 0)
        goto cleanup;

522 523
    ret = 0;

524
 cleanup:
525
    virPCIDeviceFree(pciDev);
526
    virPCIEDeviceInfoFree(pci_express);
527 528 529
    return ret;
}

M
Marc-André Lureau 已提交
530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549
static int drmGetMinorType(int minor)
{
    int type = minor >> 6;

    if (minor < 0)
        return -1;

    switch (type) {
    case VIR_NODE_DEV_DRM_PRIMARY:
    case VIR_NODE_DEV_DRM_CONTROL:
    case VIR_NODE_DEV_DRM_RENDER:
        return type;
    default:
        return -1;
    }
}

static int udevProcessDRMDevice(struct udev_device *device,
                                virNodeDeviceDefPtr def)
{
550
    virNodeDevCapDRMPtr drm = &def->caps->data.drm;
M
Marc-André Lureau 已提交
551 552 553 554 555 556 557 558 559 560 561
    int minor;

    if (udevGenerateDeviceName(device, def, NULL) != 0)
        return -1;

    if (udevGetIntProperty(device, "MINOR", &minor, 10) < 0)
        return -1;

    if ((minor = drmGetMinorType(minor)) == -1)
        return -1;

562
    drm->type = minor;
M
Marc-André Lureau 已提交
563 564 565

    return 0;
}
566 567 568 569

static int udevProcessUSBDevice(struct udev_device *device,
                                virNodeDeviceDefPtr def)
{
570
    virNodeDevCapUSBDevPtr usb_dev = &def->caps->data.usb_dev;
571

572
    if (udevGetUintProperty(device, "BUSNUM", &usb_dev->bus, 10) < 0)
573
        return -1;
574
    if (udevGetUintProperty(device, "DEVNUM", &usb_dev->device, 10) < 0)
575
        return -1;
576
    if (udevGetUintProperty(device, "ID_VENDOR_ID", &usb_dev->vendor, 16) < 0)
577
        return -1;
578

579 580
    if (udevGetStringProperty(device,
                              "ID_VENDOR_FROM_DATABASE",
581
                              &usb_dev->vendor_name) < 0)
582
        return -1;
583

584
    if (!usb_dev->vendor_name &&
585
        udevGetStringSysfsAttr(device, "manufacturer",
586
                               &usb_dev->vendor_name) < 0)
587
        return -1;
588

589
    if (udevGetUintProperty(device, "ID_MODEL_ID", &usb_dev->product, 16) < 0)
590
        return -1;
591

592 593
    if (udevGetStringProperty(device,
                              "ID_MODEL_FROM_DATABASE",
594
                              &usb_dev->product_name) < 0)
595
        return -1;
596

597
    if (!usb_dev->product_name &&
598
        udevGetStringSysfsAttr(device, "product",
599
                               &usb_dev->product_name) < 0)
600
        return -1;
601

602
    if (udevGenerateDeviceName(device, def, NULL) != 0)
603
        return -1;
604

605
    return 0;
606 607 608 609 610 611
}


static int udevProcessUSBInterface(struct udev_device *device,
                                   virNodeDeviceDefPtr def)
{
612
    virNodeDevCapUSBIfPtr usb_if = &def->caps->data.usb_if;
613

614
    if (udevGetUintSysfsAttr(device, "bInterfaceNumber",
615
                             &usb_if->number, 16) < 0)
616
        return -1;
617

618
    if (udevGetUintSysfsAttr(device, "bInterfaceClass",
619
                             &usb_if->_class, 16) < 0)
620
        return -1;
621

622
    if (udevGetUintSysfsAttr(device, "bInterfaceSubClass",
623
                             &usb_if->subclass, 16) < 0)
624
        return -1;
625

626
    if (udevGetUintSysfsAttr(device, "bInterfaceProtocol",
627
                             &usb_if->protocol, 16) < 0)
628
        return -1;
629

630
    if (udevGenerateDeviceName(device, def, NULL) != 0)
631
        return -1;
632

633
    return 0;
634 635 636 637 638 639
}


static int udevProcessNetworkInterface(struct udev_device *device,
                                       virNodeDeviceDefPtr def)
{
D
David Allan 已提交
640
    const char *devtype = udev_device_get_devtype(device);
641
    virNodeDevCapNetPtr net = &def->caps->data.net;
642

D
David Allan 已提交
643
    if (devtype && STREQ(devtype, "wlan")) {
644
        net->subtype = VIR_NODE_DEV_CAP_NET_80211;
D
David Allan 已提交
645
    } else {
646
        net->subtype = VIR_NODE_DEV_CAP_NET_80203;
D
David Allan 已提交
647 648
    }

649 650
    if (udevGetStringProperty(device,
                              "INTERFACE",
651
                              &net->ifname) < 0)
652
        return -1;
653

654
    if (udevGetStringSysfsAttr(device, "address",
655
                               &net->address) < 0)
656
        return -1;
657

658
    if (udevGetUintSysfsAttr(device, "addr_len", &net->address_len, 0) < 0)
659
        return -1;
660

661
    if (udevGenerateDeviceName(device, def, net->address) != 0)
662
        return -1;
663

664
    if (virNetDevGetLinkInfo(net->ifname, &net->lnk) < 0)
665
        return -1;
666

667
    if (virNetDevGetFeatures(net->ifname, &net->features) < 0)
668
        return -1;
669

670
    return 0;
671 672 673 674 675 676
}


static int udevProcessSCSIHost(struct udev_device *device ATTRIBUTE_UNUSED,
                               virNodeDeviceDefPtr def)
{
677
    virNodeDevCapSCSIHostPtr scsi_host = &def->caps->data.scsi_host;
678
    char *filename = NULL;
J
Ján Tomko 已提交
679
    char *str;
680

681
    filename = last_component(def->sysfs_path);
682

683
    if (!(str = STRSKIP(filename, "host")) ||
684
        virStrToLong_ui(str, NULL, 0, &scsi_host->host) < 0) {
685 686 687
        virReportError(VIR_ERR_INTERNAL_ERROR,
                       _("failed to parse SCSI host '%s'"),
                       filename);
688
        return -1;
689 690
    }

691
    nodeDeviceSysfsGetSCSIHostCaps(&def->caps->data.scsi_host);
692

693
    if (udevGenerateDeviceName(device, def, NULL) != 0)
694
        return -1;
695

696
    return 0;
697 698 699
}


700
static int udevProcessSCSITarget(struct udev_device *device,
D
David Allan 已提交
701 702 703
                                 virNodeDeviceDefPtr def)
{
    const char *sysname = NULL;
704
    virNodeDevCapSCSITargetPtr scsi_target = &def->caps->data.scsi_target;
D
David Allan 已提交
705 706 707

    sysname = udev_device_get_sysname(device);

708
    if (VIR_STRDUP(scsi_target->name, sysname) < 0)
709
        return -1;
D
David Allan 已提交
710

711 712
    nodeDeviceSysfsGetSCSITargetCaps(def->sysfs_path, &def->caps->data.scsi_target);

713
    if (udevGenerateDeviceName(device, def, NULL) != 0)
714
        return -1;
D
David Allan 已提交
715

716
    return 0;
D
David Allan 已提交
717 718 719
}


720
static int udevGetSCSIType(virNodeDeviceDefPtr def ATTRIBUTE_UNUSED,
721
                           unsigned int type, char **typestring)
722 723 724 725 726 727 728 729
{
    int ret = 0;
    int foundtype = 1;

    *typestring = NULL;

    switch (type) {
    case TYPE_DISK:
730
        ignore_value(VIR_STRDUP(*typestring, "disk"));
731 732
        break;
    case TYPE_TAPE:
733
        ignore_value(VIR_STRDUP(*typestring, "tape"));
734 735
        break;
    case TYPE_PROCESSOR:
736
        ignore_value(VIR_STRDUP(*typestring, "processor"));
737 738
        break;
    case TYPE_WORM:
739
        ignore_value(VIR_STRDUP(*typestring, "worm"));
740 741
        break;
    case TYPE_ROM:
742
        ignore_value(VIR_STRDUP(*typestring, "cdrom"));
743 744
        break;
    case TYPE_SCANNER:
745
        ignore_value(VIR_STRDUP(*typestring, "scanner"));
746 747
        break;
    case TYPE_MOD:
748
        ignore_value(VIR_STRDUP(*typestring, "mod"));
749 750
        break;
    case TYPE_MEDIUM_CHANGER:
751
        ignore_value(VIR_STRDUP(*typestring, "changer"));
752 753
        break;
    case TYPE_ENCLOSURE:
754
        ignore_value(VIR_STRDUP(*typestring, "enclosure"));
755
        break;
756
    case TYPE_RAID:
757
        ignore_value(VIR_STRDUP(*typestring, "raid"));
758
        break;
759 760 761 762 763 764 765 766 767 768
    case TYPE_NO_LUN:
    default:
        foundtype = 0;
        break;
    }

    if (*typestring == NULL) {
        if (foundtype == 1) {
            ret = -1;
        } else {
769 770
            VIR_DEBUG("Failed to find SCSI device type %d for %s",
                      type, def->sysfs_path);
771 772 773 774 775 776 777 778 779 780 781 782
        }
    }

    return ret;
}


static int udevProcessSCSIDevice(struct udev_device *device ATTRIBUTE_UNUSED,
                                 virNodeDeviceDefPtr def)
{
    int ret = -1;
    unsigned int tmp = 0;
783
    virNodeDevCapSCSIPtr scsi = &def->caps->data.scsi;
784 785
    char *filename = NULL, *p = NULL;

786
    filename = last_component(def->sysfs_path);
787

788 789 790 791
    if (virStrToLong_ui(filename, &p, 10, &scsi->host) < 0 || p == NULL ||
        virStrToLong_ui(p + 1, &p, 10, &scsi->bus) < 0 || p == NULL ||
        virStrToLong_ui(p + 1, &p, 10, &scsi->target) < 0 || p == NULL ||
        virStrToLong_ui(p + 1, &p, 10, &scsi->lun) < 0) {
792 793 794 795
        virReportError(VIR_ERR_INTERNAL_ERROR,
                       _("failed to parse the SCSI address from filename: '%s'"),
                       filename);
        return -1;
796 797
    }

798 799
    if (udev_device_get_sysattr_value(device, "type")) {
        if (udevGetUintSysfsAttr(device, "type", &tmp, 0) < 0)
800
            goto cleanup;
801

802
        if (udevGetSCSIType(def, tmp, &scsi->type) < 0)
803
            goto cleanup;
804 805
    }

806
    if (udevGenerateDeviceName(device, def, NULL) != 0)
807
        goto cleanup;
808 809 810

    ret = 0;

811
 cleanup:
812
    if (ret != 0) {
813 814 815
        virReportError(VIR_ERR_INTERNAL_ERROR,
                       _("Failed to process SCSI device with sysfs path '%s'"),
                       def->sysfs_path);
816 817 818 819 820 821 822 823
    }
    return ret;
}


static int udevProcessDisk(struct udev_device *device,
                           virNodeDeviceDefPtr def)
{
824
    virNodeDevCapStoragePtr storage = &def->caps->data.storage;
825

826
    if (udevGetUint64SysfsAttr(device, "size", &storage->num_blocks) < 0)
827
        return -1;
828

J
Ján Tomko 已提交
829
    if (udevGetUint64SysfsAttr(device, "queue/logical_block_size",
830
                               &storage->logical_block_size) < 0)
831
        return -1;
832

833
    storage->size = storage->num_blocks * storage->logical_block_size;
834

835
    return 0;
836 837 838
}


839 840 841
static int udevProcessRemoveableMedia(struct udev_device *device,
                                      virNodeDeviceDefPtr def,
                                      int has_media)
842
{
843
    virNodeDevCapStoragePtr storage = &def->caps->data.storage;
J
Ján Tomko 已提交
844
    int is_removable = 0;
845

846 847 848
    if (udevGetIntSysfsAttr(device, "removable", &is_removable, 0) < 0)
        return -1;
    if (is_removable == 1)
849 850
        def->caps->data.storage.flags |= VIR_NODE_DEV_CAP_STORAGE_REMOVABLE;

J
Ján Tomko 已提交
851 852
    if (!has_media)
        return 0;
853

J
Ján Tomko 已提交
854 855
    def->caps->data.storage.flags |=
        VIR_NODE_DEV_CAP_STORAGE_REMOVABLE_MEDIA_AVAILABLE;
856

J
Ján Tomko 已提交
857
    if (udevGetStringProperty(device, "ID_FS_LABEL",
858
                              &storage->media_label) < 0)
J
Ján Tomko 已提交
859
        return -1;
860

J
Ján Tomko 已提交
861
    if (udevGetUint64SysfsAttr(device, "size",
862
                               &storage->num_blocks) < 0)
J
Ján Tomko 已提交
863
        return -1;
864

J
Ján Tomko 已提交
865
    if (udevGetUint64SysfsAttr(device, "queue/logical_block_size",
866
                               &storage->logical_block_size) < 0)
J
Ján Tomko 已提交
867
        return -1;
868

J
Ján Tomko 已提交
869 870 871 872 873 874 875
    /* XXX This calculation is wrong for the qemu virtual cdrom
     * which reports the size in 512 byte blocks, but the logical
     * block size as 2048.  I don't have a physical cdrom on a
     * devel system to see how they behave. */
    def->caps->data.storage.removable_media_size =
        def->caps->data.storage.num_blocks *
        def->caps->data.storage.logical_block_size;
876

J
Ján Tomko 已提交
877
    return 0;
878 879
}

880 881 882 883 884 885 886 887 888 889
static int udevProcessCDROM(struct udev_device *device,
                            virNodeDeviceDefPtr def)
{
    int has_media = 0;

    /* NB: the drive_type string provided by udev is different from
     * that provided by HAL; now it's "cd" instead of "cdrom" We
     * change it to cdrom to preserve compatibility with earlier
     * versions of libvirt.  */
    VIR_FREE(def->caps->data.storage.drive_type);
890
    if (VIR_STRDUP(def->caps->data.storage.drive_type, "cdrom") < 0)
891
        return -1;
892

893 894
    if (udevHasDeviceProperty(device, "ID_CDROM_MEDIA") &&
        udevGetIntProperty(device, "ID_CDROM_MEDIA", &has_media, 0) < 0)
895
        return -1;
896

897
    return udevProcessRemoveableMedia(device, def, has_media);
898 899 900 901 902 903 904
}

static int udevProcessFloppy(struct udev_device *device,
                             virNodeDeviceDefPtr def)
{
    int has_media = 0;

905
    if (udevHasDeviceProperty(device, "ID_CDROM_MEDIA")) {
906
        /* USB floppy */
907 908
        if (udevGetIntProperty(device, "DKD_MEDIA_AVAILABLE", &has_media, 0) < 0)
            return -1;
909
    } else if (udevHasDeviceProperty(device, "ID_FS_LABEL")) {
910 911 912 913 914 915
        /* Legacy floppy */
        has_media = 1;
    }

    return udevProcessRemoveableMedia(device, def, has_media);
}
916

917 918 919 920

static int udevProcessSD(struct udev_device *device,
                         virNodeDeviceDefPtr def)
{
921
    virNodeDevCapStoragePtr storage = &def->caps->data.storage;
922

J
Ján Tomko 已提交
923
    if (udevGetUint64SysfsAttr(device, "size",
924
                               &storage->num_blocks) < 0)
925
        return -1;
926

J
Ján Tomko 已提交
927
    if (udevGetUint64SysfsAttr(device, "queue/logical_block_size",
928
                               &storage->logical_block_size) < 0)
929
        return -1;
930

931
    storage->size = storage->num_blocks * storage->logical_block_size;
932

933
    return 0;
934 935 936 937
}



938 939 940 941 942 943
/* This function exists to deal with the case in which a driver does
 * not provide a device type in the usual place, but udev told us it's
 * a storage device, and we can make a good guess at what kind of
 * storage device it is from other information that is provided. */
static int udevKludgeStorageType(virNodeDeviceDefPtr def)
{
944 945 946
    VIR_DEBUG("Could not find definitive storage type for device "
              "with sysfs path '%s', trying to guess it",
              def->sysfs_path);
947

948 949 950
    /* virtio disk */
    if (STRPREFIX(def->caps->data.storage.block, "/dev/vd") &&
        VIR_STRDUP(def->caps->data.storage.drive_type, "disk") > 0) {
951
        VIR_DEBUG("Found storage type '%s' for device "
952
                  "with sysfs path '%s'",
953 954
                  def->caps->data.storage.drive_type,
                  def->sysfs_path);
955
        return 0;
956
    }
957 958 959
    VIR_DEBUG("Could not determine storage type "
              "for device with sysfs path '%s'", def->sysfs_path);
    return -1;
960 961 962 963 964 965
}


static int udevProcessStorage(struct udev_device *device,
                              virNodeDeviceDefPtr def)
{
966
    virNodeDevCapStoragePtr storage = &def->caps->data.storage;
967
    int ret = -1;
968
    const char* devnode;
969

970
    devnode = udev_device_get_devnode(device);
971
    if (!devnode) {
972
        VIR_DEBUG("No devnode for '%s'", udev_device_get_devpath(device));
973
        goto cleanup;
974
    }
975

976
    if (VIR_STRDUP(storage->block, devnode) < 0)
977
        goto cleanup;
978

979
    if (udevGetStringProperty(device, "ID_BUS", &storage->bus) < 0)
980
        goto cleanup;
981
    if (udevGetStringProperty(device, "ID_SERIAL", &storage->serial) < 0)
982
        goto cleanup;
983

984
    if (udevGetStringSysfsAttr(device, "device/vendor", &storage->vendor) < 0)
985
        goto cleanup;
986 987 988
    if (def->caps->data.storage.vendor)
        virTrimSpaces(def->caps->data.storage.vendor, NULL);

989
    if (udevGetStringSysfsAttr(device, "device/model", &storage->model) < 0)
990
        goto cleanup;
991 992
    if (def->caps->data.storage.model)
        virTrimSpaces(def->caps->data.storage.model, NULL);
993 994 995 996 997
    /* There is no equivalent of the hotpluggable property in libudev,
     * but storage is going toward a world in which hotpluggable is
     * expected, so I don't see a problem with not having a property
     * for it. */

998
    if (udevGetStringProperty(device, "ID_TYPE", &storage->drive_type) < 0)
999
        goto cleanup;
1000

1001
    if (!storage->drive_type ||
1002
        STREQ(def->caps->data.storage.drive_type, "generic")) {
1003 1004
        int val = 0;
        const char *str = NULL;
1005 1006 1007

        /* All floppy drives have the ID_DRIVE_FLOPPY prop. This is
         * needed since legacy floppies don't have a drive_type */
1008
        if (udevGetIntProperty(device, "ID_DRIVE_FLOPPY", &val, 0) < 0)
1009
            goto cleanup;
1010 1011
        else if (val == 1)
            str = "floppy";
1012

1013
        if (!str) {
1014
            if (udevGetIntProperty(device, "ID_CDROM", &val, 0) < 0)
1015
                goto cleanup;
1016 1017 1018
            else if (val == 1)
                str = "cd";
        }
1019

1020
        if (!str) {
1021
            if (udevGetIntProperty(device, "ID_DRIVE_FLASH_SD", &val, 0) < 0)
1022
                goto cleanup;
1023 1024 1025
            if (val == 1)
                str = "sd";
        }
1026

1027
        if (str) {
1028
            if (VIR_STRDUP(storage->drive_type, str) < 0)
1029
                goto cleanup;
1030 1031
        } else {
            /* If udev doesn't have it, perhaps we can guess it. */
1032
            if (udevKludgeStorageType(def) != 0)
1033
                goto cleanup;
1034 1035 1036 1037 1038 1039 1040
        }
    }

    if (STREQ(def->caps->data.storage.drive_type, "cd")) {
        ret = udevProcessCDROM(device, def);
    } else if (STREQ(def->caps->data.storage.drive_type, "disk")) {
        ret = udevProcessDisk(device, def);
1041 1042
    } else if (STREQ(def->caps->data.storage.drive_type, "floppy")) {
        ret = udevProcessFloppy(device, def);
1043 1044
    } else if (STREQ(def->caps->data.storage.drive_type, "sd")) {
        ret = udevProcessSD(device, def);
1045
    } else {
1046 1047
        VIR_DEBUG("Unsupported storage type '%s'",
                  def->caps->data.storage.drive_type);
1048
        goto cleanup;
1049 1050
    }

1051
    if (udevGenerateDeviceName(device, def, storage->serial) != 0)
1052
        goto cleanup;
1053

1054
 cleanup:
1055
    VIR_DEBUG("Storage ret=%d", ret);
1056 1057 1058
    return ret;
}

1059
static int
1060
udevProcessSCSIGeneric(struct udev_device *dev,
1061 1062
                       virNodeDeviceDefPtr def)
{
1063 1064
    if (udevGetStringProperty(dev, "DEVNAME", &def->caps->data.sg.path) < 0 ||
        !def->caps->data.sg.path)
1065 1066 1067 1068 1069 1070 1071 1072
        return -1;

    if (udevGenerateDeviceName(dev, def, NULL) != 0)
        return -1;

    return 0;
}

1073 1074 1075 1076 1077 1078 1079 1080
static int
udevProcessMediatedDevice(struct udev_device *dev,
                          virNodeDeviceDefPtr def)
{
    int ret = -1;
    const char *uuidstr = NULL;
    int iommugrp = -1;
    char *linkpath = NULL;
1081
    char *canonicalpath = NULL;
1082 1083 1084 1085 1086
    virNodeDevCapMdevPtr data = &def->caps->data.mdev;

    if (virAsprintf(&linkpath, "%s/mdev_type", udev_device_get_syspath(dev)) < 0)
        goto cleanup;

1087
    if (virFileResolveLink(linkpath, &canonicalpath) < 0)
1088 1089
        goto cleanup;

1090
    if (VIR_STRDUP(data->type, last_component(canonicalpath)) < 0)
1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 1104
        goto cleanup;

    uuidstr = udev_device_get_sysname(dev);
    if ((iommugrp = virMediatedDeviceGetIOMMUGroupNum(uuidstr)) < 0)
        goto cleanup;

    if (udevGenerateDeviceName(dev, def, NULL) != 0)
        goto cleanup;

    data->iommuGroupNumber = iommugrp;

    ret = 0;
 cleanup:
    VIR_FREE(linkpath);
1105
    VIR_FREE(canonicalpath);
1106 1107 1108
    return ret;
}

B
Bjoern Walk 已提交
1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138

static int
udevProcessCCW(struct udev_device *device,
               virNodeDeviceDefPtr def)
{
    int online;
    char *p;
    virNodeDevCapDataPtr data = &def->caps->data;

    /* process only online devices to keep the list sane */
    if (udevGetIntSysfsAttr(device, "online", &online, 0) < 0 || online != 1)
        return -1;

    if ((p = strrchr(def->sysfs_path, '/')) == NULL ||
        virStrToLong_ui(p + 1, &p, 16, &data->ccw_dev.cssid) < 0 || p == NULL ||
        virStrToLong_ui(p + 1, &p, 16, &data->ccw_dev.ssid) < 0 || p == NULL ||
        virStrToLong_ui(p + 1, &p, 16, &data->ccw_dev.devno) < 0) {
        virReportError(VIR_ERR_INTERNAL_ERROR,
                       _("failed to parse the CCW address from sysfs path: '%s'"),
                       def->sysfs_path);
        return -1;
    }

    if (udevGenerateDeviceName(device, def, NULL) != 0)
        return -1;

    return 0;
}


1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166
static int
udevGetDeviceNodes(struct udev_device *device,
                   virNodeDeviceDefPtr def)
{
    const char *devnode = NULL;
    struct udev_list_entry *list_entry = NULL;
    int n = 0;

    devnode = udev_device_get_devnode(device);

    if (VIR_STRDUP(def->devnode, devnode) < 0)
        return -1;

    udev_list_entry_foreach(list_entry, udev_device_get_devlinks_list_entry(device))
        n++;

    if (VIR_ALLOC_N(def->devlinks, n + 1) < 0)
        return -1;

    n = 0;
    udev_list_entry_foreach(list_entry, udev_device_get_devlinks_list_entry(device)) {
        if (VIR_STRDUP(def->devlinks[n++], udev_list_entry_get_name(list_entry)) < 0)
            return -1;
    }

    return 0;
}

1167 1168
static int
udevGetDeviceType(struct udev_device *device,
1169
                  virNodeDevCapType *type)
1170 1171
{
    const char *devtype = NULL;
1172
    char *subsystem = NULL;
1173
    int ret = -1;
D
David Allan 已提交
1174

1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192
    devtype = udev_device_get_devtype(device);
    *type = 0;

    if (devtype) {
        if (STREQ(devtype, "usb_device"))
            *type = VIR_NODE_DEV_CAP_USB_DEV;
        else if (STREQ(devtype, "usb_interface"))
            *type = VIR_NODE_DEV_CAP_USB_INTERFACE;
        else if (STREQ(devtype, "scsi_host"))
            *type = VIR_NODE_DEV_CAP_SCSI_HOST;
        else if (STREQ(devtype, "scsi_target"))
            *type = VIR_NODE_DEV_CAP_SCSI_TARGET;
        else if (STREQ(devtype, "scsi_device"))
            *type = VIR_NODE_DEV_CAP_SCSI;
        else if (STREQ(devtype, "disk"))
            *type = VIR_NODE_DEV_CAP_STORAGE;
        else if (STREQ(devtype, "wlan"))
            *type = VIR_NODE_DEV_CAP_NET;
M
Marc-André Lureau 已提交
1193 1194
        else if (STREQ(devtype, "drm_minor"))
            *type = VIR_NODE_DEV_CAP_DRM;
1195 1196
    } else {
        /* PCI devices don't set the DEVTYPE property. */
1197
        if (udevHasDeviceProperty(device, "PCI_CLASS"))
1198
            *type = VIR_NODE_DEV_CAP_PCI_DEV;
1199

1200 1201 1202 1203
        /* Wired network interfaces don't set the DEVTYPE property,
         * USB devices also have an INTERFACE property, but they do
         * set DEVTYPE, so if devtype is NULL and the INTERFACE
         * property exists, we have a network device. */
1204
        if (udevHasDeviceProperty(device, "INTERFACE"))
1205
            *type = VIR_NODE_DEV_CAP_NET;
1206

B
Bjoern Walk 已提交
1207 1208
        /* The following devices do not set the DEVTYPE property, therefore
         * we need to rely on the SUBSYSTEM property */
1209 1210 1211 1212
        if (udevGetStringProperty(device, "SUBSYSTEM", &subsystem) < 0)
            return -1;

        if (STREQ_NULLABLE(subsystem, "scsi_generic"))
1213
            *type = VIR_NODE_DEV_CAP_SCSI_GENERIC;
1214 1215
        else if (STREQ_NULLABLE(subsystem, "mdev"))
            *type = VIR_NODE_DEV_CAP_MDEV;
B
Bjoern Walk 已提交
1216 1217
        else if (STREQ_NULLABLE(subsystem, "ccw"))
            *type = VIR_NODE_DEV_CAP_CCW_DEV;
1218

1219
        VIR_FREE(subsystem);
1220 1221
    }

1222 1223 1224 1225 1226 1227
    if (!*type)
        VIR_DEBUG("Could not determine device type for device "
                  "with sysfs name '%s'",
                  udev_device_get_sysname(device));
    else
        ret = 0;
1228 1229 1230 1231 1232 1233 1234 1235

    return ret;
}


static int udevGetDeviceDetails(struct udev_device *device,
                                virNodeDeviceDefPtr def)
{
1236
    switch (def->caps->data.type) {
1237
    case VIR_NODE_DEV_CAP_PCI_DEV:
1238
        return udevProcessPCI(device, def);
1239
    case VIR_NODE_DEV_CAP_USB_DEV:
1240
        return udevProcessUSBDevice(device, def);
1241
    case VIR_NODE_DEV_CAP_USB_INTERFACE:
1242
        return udevProcessUSBInterface(device, def);
1243
    case VIR_NODE_DEV_CAP_NET:
1244
        return udevProcessNetworkInterface(device, def);
1245
    case VIR_NODE_DEV_CAP_SCSI_HOST:
1246
        return udevProcessSCSIHost(device, def);
D
David Allan 已提交
1247
    case VIR_NODE_DEV_CAP_SCSI_TARGET:
1248
        return udevProcessSCSITarget(device, def);
1249
    case VIR_NODE_DEV_CAP_SCSI:
1250
        return udevProcessSCSIDevice(device, def);
1251
    case VIR_NODE_DEV_CAP_STORAGE:
1252
        return udevProcessStorage(device, def);
1253
    case VIR_NODE_DEV_CAP_SCSI_GENERIC:
1254
        return udevProcessSCSIGeneric(device, def);
M
Marc-André Lureau 已提交
1255
    case VIR_NODE_DEV_CAP_DRM:
1256
        return udevProcessDRMDevice(device, def);
1257
    case VIR_NODE_DEV_CAP_MDEV:
1258
        return udevProcessMediatedDevice(device, def);
B
Bjoern Walk 已提交
1259 1260
    case VIR_NODE_DEV_CAP_CCW_DEV:
        return udevProcessCCW(device, def);
1261
    case VIR_NODE_DEV_CAP_MDEV_TYPES:
1262 1263 1264 1265
    case VIR_NODE_DEV_CAP_SYSTEM:
    case VIR_NODE_DEV_CAP_FC_HOST:
    case VIR_NODE_DEV_CAP_VPORTS:
    case VIR_NODE_DEV_CAP_LAST:
1266 1267 1268
        break;
    }

1269
    return 0;
1270 1271 1272 1273 1274 1275
}


static int udevRemoveOneDevice(struct udev_device *device)
{
    virNodeDeviceObjPtr dev = NULL;
1276
    virObjectEventPtr event = NULL;
1277
    const char *name = NULL;
1278
    int ret = -1;
1279 1280

    name = udev_device_get_syspath(device);
1281
    dev = virNodeDeviceObjFindBySysfsPath(&driver->devs, name);
1282

1283
    if (!dev) {
1284 1285
        VIR_DEBUG("Failed to find device to remove that has udev name '%s'",
                  name);
1286
        goto cleanup;
1287 1288
    }

1289 1290 1291 1292 1293 1294
    event = virNodeDeviceEventLifecycleNew(dev->def->name,
                                           VIR_NODE_DEVICE_EVENT_DELETED,
                                           0);

    VIR_DEBUG("Removing device '%s' with sysfs path '%s'",
              dev->def->name, name);
1295
    virNodeDeviceObjRemove(&driver->devs, &dev);
1296 1297 1298 1299 1300

    ret = 0;
 cleanup:
    if (event)
        virObjectEventStateQueue(driver->nodeDeviceEventState, event);
1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312
    return ret;
}


static int udevSetParent(struct udev_device *device,
                         virNodeDeviceDefPtr def)
{
    struct udev_device *parent_device = NULL;
    const char *parent_sysfs_path = NULL;
    virNodeDeviceObjPtr dev = NULL;
    int ret = -1;

1313 1314
    parent_device = device;
    do {
1315

1316
        parent_device = udev_device_get_parent(parent_device);
1317
        if (parent_device == NULL)
1318
            break;
1319

1320 1321
        parent_sysfs_path = udev_device_get_syspath(parent_device);
        if (parent_sysfs_path == NULL) {
1322 1323 1324
            virReportError(VIR_ERR_INTERNAL_ERROR,
                           _("Could not get syspath for parent of '%s'"),
                           udev_device_get_syspath(parent_device));
1325
            goto cleanup;
1326 1327
        }

1328 1329
        dev = virNodeDeviceObjFindBySysfsPath(&driver->devs,
                                              parent_sysfs_path);
1330
        if (dev != NULL) {
1331 1332
            if (VIR_STRDUP(def->parent, dev->def->name) < 0) {
                virNodeDeviceObjUnlock(dev);
1333
                goto cleanup;
1334
            }
1335
            virNodeDeviceObjUnlock(dev);
1336

1337
            if (VIR_STRDUP(def->parent_sysfs_path, parent_sysfs_path) < 0)
1338
                goto cleanup;
1339 1340 1341 1342
        }

    } while (def->parent == NULL && parent_device != NULL);

1343
    if (!def->parent && VIR_STRDUP(def->parent, "computer") < 0)
1344
        goto cleanup;
1345 1346 1347

    ret = 0;

1348
 cleanup:
1349 1350 1351 1352 1353 1354 1355 1356
    return ret;
}


static int udevAddOneDevice(struct udev_device *device)
{
    virNodeDeviceDefPtr def = NULL;
    virNodeDeviceObjPtr dev = NULL;
1357 1358
    virObjectEventPtr event = NULL;
    bool new_device = true;
1359 1360
    int ret = -1;

1361
    if (VIR_ALLOC(def) != 0)
1362
        goto cleanup;
1363

1364
    if (VIR_STRDUP(def->sysfs_path, udev_device_get_syspath(device)) < 0)
1365
        goto cleanup;
1366

1367
    if (udevGetStringProperty(device, "DRIVER", &def->driver) < 0)
1368
        goto cleanup;
1369

1370
    if (VIR_ALLOC(def->caps) != 0)
1371
        goto cleanup;
1372

1373
    if (udevGetDeviceType(device, &def->caps->data.type) != 0)
1374
        goto cleanup;
1375

1376 1377 1378
    if (udevGetDeviceNodes(device, def) != 0)
        goto cleanup;

1379
    if (udevGetDeviceDetails(device, def) != 0)
1380
        goto cleanup;
1381

1382
    if (udevSetParent(device, def) != 0)
1383
        goto cleanup;
1384

1385
    dev = virNodeDeviceObjFindByName(&driver->devs, def->name);
1386 1387 1388 1389 1390
    if (dev) {
        virNodeDeviceObjUnlock(dev);
        new_device = false;
    }

1391 1392
    /* If this is a device change, the old definition will be freed
     * and the current definition will take its place. */
1393
    dev = virNodeDeviceObjAssignDef(&driver->devs, def);
1394
    if (dev == NULL)
1395
        goto cleanup;
1396

1397 1398 1399 1400
    if (new_device)
        event = virNodeDeviceEventLifecycleNew(dev->def->name,
                                               VIR_NODE_DEVICE_EVENT_CREATED,
                                               0);
1401 1402
    else
        event = virNodeDeviceEventUpdateNew(dev->def->name);
1403

1404 1405 1406 1407
    virNodeDeviceObjUnlock(dev);

    ret = 0;

1408
 cleanup:
1409 1410 1411
    if (event)
        virObjectEventStateQueue(driver->nodeDeviceEventState, event);

1412
    if (ret != 0) {
1413
        VIR_DEBUG("Discarding device %d %p %s", ret, def,
1414
                  def ? NULLSTR(def->sysfs_path) : "");
1415 1416 1417
        virNodeDeviceDefFree(def);
    }

1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431
    return ret;
}


static int udevProcessDeviceListEntry(struct udev *udev,
                                      struct udev_list_entry *list_entry)
{
    struct udev_device *device;
    const char *name = NULL;
    int ret = -1;

    name = udev_list_entry_get_name(list_entry);

    device = udev_device_new_from_syspath(udev, name);
1432

1433 1434
    if (device != NULL) {
        if (udevAddOneDevice(device) != 0) {
1435 1436
            VIR_DEBUG("Failed to create node device for udev device '%s'",
                      name);
1437 1438 1439 1440
        }
        ret = 0;
    }

1441 1442
    udev_device_unref(device);

1443 1444 1445 1446
    return ret;
}


1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469
/* We do not care about every device (see udevGetDeviceType).
 * Do not bother enumerating over subsystems that do not
 * contain interesting devices.
 */
const char *subsystem_blacklist[] = {
    "acpi", "tty", "vc", "i2c",
};

static int udevEnumerateAddMatches(struct udev_enumerate *udev_enumerate)
{
    size_t i;

    for (i = 0; i < ARRAY_CARDINALITY(subsystem_blacklist); i++) {
        const char *s = subsystem_blacklist[i];
        if (udev_enumerate_add_nomatch_subsystem(udev_enumerate, s) < 0) {
            virReportSystemError(errno, "%s", _("failed to add susbsystem filter"));
            return -1;
        }
    }
    return 0;
}


1470 1471 1472 1473
static int udevEnumerateDevices(struct udev *udev)
{
    struct udev_enumerate *udev_enumerate = NULL;
    struct udev_list_entry *list_entry = NULL;
1474
    int ret = -1;
1475 1476

    udev_enumerate = udev_enumerate_new(udev);
1477 1478
    if (udevEnumerateAddMatches(udev_enumerate) < 0)
        goto cleanup;
1479 1480

    ret = udev_enumerate_scan_devices(udev_enumerate);
1481
    if (ret != 0) {
1482 1483 1484
        virReportError(VIR_ERR_INTERNAL_ERROR,
                       _("udev scan devices returned %d"),
                       ret);
1485
        goto cleanup;
1486 1487 1488 1489 1490 1491 1492 1493
    }

    udev_list_entry_foreach(list_entry,
                            udev_enumerate_get_list_entry(udev_enumerate)) {

        udevProcessDeviceListEntry(udev, list_entry);
    }

1494
 cleanup:
1495 1496 1497 1498 1499
    udev_enumerate_unref(udev_enumerate);
    return ret;
}


1500 1501 1502 1503 1504 1505 1506 1507 1508 1509 1510 1511
static void udevPCITranslateDeinit(void)
{
#if defined __s390__ || defined __s390x_
    /* Nothing was initialized, nothing needs to be cleaned up */
#else
    /* pci_system_cleanup returns void */
    pci_system_cleanup();
#endif
    return;
}


1512
static int nodeStateCleanup(void)
1513
{
1514
    udevPrivate *priv = NULL;
1515 1516 1517
    struct udev_monitor *udev_monitor = NULL;
    struct udev *udev = NULL;

J
Ján Tomko 已提交
1518 1519
    if (!driver)
        return -1;
1520

J
Ján Tomko 已提交
1521
    nodeDeviceLock();
1522

1523
    virObjectUnref(driver->nodeDeviceEventState);
1524

J
Ján Tomko 已提交
1525
    priv = driver->privateData;
1526

1527 1528 1529
    if (priv) {
        if (priv->watch != -1)
            virEventRemoveHandle(priv->watch);
1530

1531
        udev_monitor = DRV_STATE_UDEV_MONITOR(driver);
1532

1533 1534 1535 1536
        if (udev_monitor != NULL) {
            udev = udev_monitor_get_udev(udev_monitor);
            udev_monitor_unref(udev_monitor);
        }
J
Ján Tomko 已提交
1537
    }
1538

J
Ján Tomko 已提交
1539 1540
    if (udev != NULL)
        udev_unref(udev);
1541

J
Ján Tomko 已提交
1542 1543 1544 1545 1546
    virNodeDeviceObjListFree(&driver->devs);
    nodeDeviceUnlock();
    virMutexDestroy(&driver->lock);
    VIR_FREE(driver);
    VIR_FREE(priv);
1547

J
Ján Tomko 已提交
1548 1549
    udevPCITranslateDeinit();
    return 0;
1550 1551 1552 1553 1554 1555 1556 1557 1558
}


static void udevEventHandleCallback(int watch ATTRIBUTE_UNUSED,
                                    int fd,
                                    int events ATTRIBUTE_UNUSED,
                                    void *data ATTRIBUTE_UNUSED)
{
    struct udev_device *device = NULL;
1559
    struct udev_monitor *udev_monitor = DRV_STATE_UDEV_MONITOR(driver);
1560 1561 1562
    const char *action = NULL;
    int udev_fd = -1;

1563
    nodeDeviceLock();
1564 1565
    udev_fd = udev_monitor_get_fd(udev_monitor);
    if (fd != udev_fd) {
1566 1567 1568 1569
        virReportError(VIR_ERR_INTERNAL_ERROR,
                       _("File descriptor returned by udev %d does not "
                         "match node device file descriptor %d"),
                       fd, udev_fd);
1570
        goto cleanup;
1571 1572 1573 1574
    }

    device = udev_monitor_receive_device(udev_monitor);
    if (device == NULL) {
1575 1576
        virReportError(VIR_ERR_INTERNAL_ERROR, "%s",
                       _("udev_monitor_receive_device returned NULL"));
1577
        goto cleanup;
1578 1579 1580
    }

    action = udev_device_get_action(device);
1581
    VIR_DEBUG("udev action: '%s'", action);
1582 1583 1584

    if (STREQ(action, "add") || STREQ(action, "change")) {
        udevAddOneDevice(device);
1585
        goto cleanup;
1586 1587 1588 1589
    }

    if (STREQ(action, "remove")) {
        udevRemoveOneDevice(device);
1590
        goto cleanup;
1591 1592
    }

1593
 cleanup:
1594
    udev_device_unref(device);
1595
    nodeDeviceUnlock();
1596 1597 1598 1599
    return;
}


1600 1601
/* DMI is intel-compatible specific */
#if defined(__x86_64__) || defined(__i386__) || defined(__amd64__)
1602
static void
1603
udevGetDMIData(virNodeDevCapSystemPtr syscap)
1604 1605 1606
{
    struct udev *udev = NULL;
    struct udev_device *device = NULL;
1607 1608
    virNodeDevCapSystemHardwarePtr hardware = &syscap->hardware;
    virNodeDevCapSystemFirmwarePtr firmware = &syscap->firmware;
1609

1610
    udev = udev_monitor_get_udev(DRV_STATE_UDEV_MONITOR(driver));
1611

1612 1613
    device = udev_device_new_from_syspath(udev, DMI_DEVPATH);
    if (device == NULL) {
1614 1615
        device = udev_device_new_from_syspath(udev, DMI_DEVPATH_FALLBACK);
        if (device == NULL) {
1616 1617 1618
            virReportError(VIR_ERR_INTERNAL_ERROR,
                           _("Failed to get udev device for syspath '%s' or '%s'"),
                           DMI_DEVPATH, DMI_DEVPATH_FALLBACK);
1619
            return;
1620
        }
1621 1622
    }

1623
    if (udevGetStringSysfsAttr(device, "product_name",
1624
                               &syscap->product_name) < 0)
1625
        goto cleanup;
1626
    if (udevGetStringSysfsAttr(device, "sys_vendor",
1627
                               &hardware->vendor_name) < 0)
1628
        goto cleanup;
1629
    if (udevGetStringSysfsAttr(device, "product_version",
1630
                               &hardware->version) < 0)
1631
        goto cleanup;
1632
    if (udevGetStringSysfsAttr(device, "product_serial",
1633
                               &hardware->serial) < 0)
1634
        goto cleanup;
1635

1636
    if (virGetHostUUID(hardware->uuid))
1637
        goto cleanup;
1638

1639
    if (udevGetStringSysfsAttr(device, "bios_vendor",
1640
                               &firmware->vendor_name) < 0)
1641
        goto cleanup;
1642
    if (udevGetStringSysfsAttr(device, "bios_version",
1643
                               &firmware->version) < 0)
1644
        goto cleanup;
1645
    if (udevGetStringSysfsAttr(device, "bios_date",
1646
                               &firmware->release_date) < 0)
1647
        goto cleanup;
1648

1649
 cleanup:
1650
    if (device != NULL)
1651 1652 1653
        udev_device_unref(device);
    return;
}
1654
#endif
1655 1656 1657 1658 1659 1660 1661 1662


static int udevSetupSystemDev(void)
{
    virNodeDeviceDefPtr def = NULL;
    virNodeDeviceObjPtr dev = NULL;
    int ret = -1;

1663 1664
    if (VIR_ALLOC(def) < 0)
        return -1;
1665

1666
    if (VIR_STRDUP(def->name, "computer") < 0)
1667
        goto cleanup;
1668

1669
    if (VIR_ALLOC(def->caps) != 0)
1670
        goto cleanup;
1671

1672
#if defined(__x86_64__) || defined(__i386__) || defined(__amd64__)
1673
    udevGetDMIData(&def->caps->data.system);
1674
#endif
1675

1676
    dev = virNodeDeviceObjAssignDef(&driver->devs, def);
1677
    if (dev == NULL)
1678
        goto cleanup;
1679 1680 1681 1682 1683

    virNodeDeviceObjUnlock(dev);

    ret = 0;

1684
 cleanup:
1685
    if (ret == -1)
1686 1687
        virNodeDeviceDefFree(def);

1688 1689 1690
    return ret;
}

1691
static int udevPCITranslateInit(bool privileged ATTRIBUTE_UNUSED)
1692
{
1693 1694 1695 1696
#if defined __s390__ || defined __s390x_
    /* On s390(x) system there is no PCI bus.
     * Therefore there is nothing to initialize here. */
#else
1697
    int rc;
1698

1699
    if ((rc = pci_system_init()) != 0) {
1700 1701 1702
        /* Ignore failure as non-root; udev is not as helpful in that
         * situation, but a non-privileged user won't benefit much
         * from udev in the first place.  */
1703
        if (errno != ENOENT && (privileged  || errno != EACCES)) {
1704 1705
            virReportSystemError(rc, "%s",
                                 _("Failed to initialize libpciaccess"));
1706
            return -1;
1707
        }
1708
    }
1709
#endif
1710 1711 1712 1713 1714 1715 1716 1717 1718 1719 1720
    return 0;
}

static int nodeStateInitialize(bool privileged,
                               virStateInhibitCallback callback ATTRIBUTE_UNUSED,
                               void *opaque ATTRIBUTE_UNUSED)
{
    udevPrivate *priv = NULL;
    struct udev *udev = NULL;
    int ret = -1;

1721
    if (VIR_ALLOC(priv) < 0)
1722
        return -1;
1723 1724

    priv->watch = -1;
1725
    priv->privileged = privileged;
1726

1727
    if (VIR_ALLOC(driver) < 0) {
1728
        VIR_FREE(priv);
1729
        return -1;
1730 1731
    }

1732
    if (virMutexInit(&driver->lock) < 0) {
1733 1734
        virReportError(VIR_ERR_INTERNAL_ERROR, "%s",
                       _("Unable to initialize mutex"));
1735
        VIR_FREE(priv);
1736
        VIR_FREE(driver);
1737
        return -1;
1738 1739
    }

1740
    driver->privateData = priv;
1741
    nodeDeviceLock();
1742
    driver->nodeDeviceEventState = virObjectEventStateNew();
1743

1744
    if (udevPCITranslateInit(privileged) < 0)
1745
        goto cleanup;
1746

1747
    udev = udev_new();
1748 1749 1750 1751 1752
    if (!udev) {
        virReportError(VIR_ERR_INTERNAL_ERROR, "%s",
                       _("failed to create udev context"));
        goto cleanup;
    }
1753
#if HAVE_UDEV_LOGGING
J
Ján Tomko 已提交
1754 1755
    /* cast to get rid of missing-format-attribute warning */
    udev_set_log_fn(udev, (udevLogFunctionPtr) udevLogFunction);
1756
#endif
1757

1758 1759
    priv->udev_monitor = udev_monitor_new_from_netlink(udev, "udev");
    if (priv->udev_monitor == NULL) {
1760 1761
        virReportError(VIR_ERR_INTERNAL_ERROR, "%s",
                       _("udev_monitor_new_from_netlink returned NULL"));
1762
        goto cleanup;
1763 1764
    }

1765
    udev_monitor_enable_receiving(priv->udev_monitor);
1766

1767
#if HAVE_UDEV_MONITOR_SET_RECEIVE_BUFFER_SIZE
1768 1769 1770 1771 1772 1773
    /* mimic udevd's behaviour and override the systems rmem_max limit in case
     * there's a significant number of device 'add' events
     */
    if (geteuid() == 0)
        udev_monitor_set_receive_buffer_size(priv->udev_monitor,
                                             128 * 1024 * 1024);
1774
#endif
1775

1776 1777 1778 1779 1780 1781 1782 1783
    /* We register the monitor with the event callback so we are
     * notified by udev of device changes before we enumerate existing
     * devices because libvirt will simply recreate the device if we
     * try to register it twice, i.e., if the device appears between
     * the time we register the callback and the time we begin
     * enumeration.  The alternative is to register the callback after
     * we enumerate, in which case we will fail to create any devices
     * that appear while the enumeration is taking place.  */
1784 1785 1786
    priv->watch = virEventAddHandle(udev_monitor_get_fd(priv->udev_monitor),
                                    VIR_EVENT_HANDLE_READABLE,
                                    udevEventHandleCallback, NULL, NULL);
1787
    if (priv->watch == -1)
1788
        goto cleanup;
1789 1790

    /* Create a fictional 'computer' device to root the device tree. */
1791
    if (udevSetupSystemDev() != 0)
1792
        goto cleanup;
1793 1794 1795

    /* Populate with known devices */

1796
    if (udevEnumerateDevices(udev) != 0)
1797
        goto cleanup;
1798 1799

    ret = 0;
1800

1801
 cleanup:
1802
    nodeDeviceUnlock();
1803

1804
    if (ret == -1)
1805
        nodeStateCleanup();
1806 1807 1808 1809
    return ret;
}


1810
static int nodeStateReload(void)
1811 1812 1813 1814 1815
{
    return 0;
}


1816
static virNodeDeviceDriver udevNodeDeviceDriver = {
1817
    .name = "udev",
1818 1819
    .nodeNumOfDevices = nodeNumOfDevices, /* 0.7.3 */
    .nodeListDevices = nodeListDevices, /* 0.7.3 */
1820
    .connectListAllNodeDevices = nodeConnectListAllNodeDevices, /* 0.10.2 */
1821 1822
    .connectNodeDeviceEventRegisterAny = nodeConnectNodeDeviceEventRegisterAny, /* 2.2.0 */
    .connectNodeDeviceEventDeregisterAny = nodeConnectNodeDeviceEventDeregisterAny, /* 2.2.0 */
1823 1824 1825 1826 1827 1828 1829 1830
    .nodeDeviceLookupByName = nodeDeviceLookupByName, /* 0.7.3 */
    .nodeDeviceLookupSCSIHostByWWN = nodeDeviceLookupSCSIHostByWWN, /* 1.0.2 */
    .nodeDeviceGetXMLDesc = nodeDeviceGetXMLDesc, /* 0.7.3 */
    .nodeDeviceGetParent = nodeDeviceGetParent, /* 0.7.3 */
    .nodeDeviceNumOfCaps = nodeDeviceNumOfCaps, /* 0.7.3 */
    .nodeDeviceListCaps = nodeDeviceListCaps, /* 0.7.3 */
    .nodeDeviceCreateXML = nodeDeviceCreateXML, /* 0.7.3 */
    .nodeDeviceDestroy = nodeDeviceDestroy, /* 0.7.3 */
1831 1832 1833
};

static virStateDriver udevStateDriver = {
M
Matthias Bolte 已提交
1834
    .name = "udev",
1835 1836 1837
    .stateInitialize = nodeStateInitialize, /* 0.7.3 */
    .stateCleanup = nodeStateCleanup, /* 0.7.3 */
    .stateReload = nodeStateReload, /* 0.7.3 */
1838 1839 1840 1841
};

int udevNodeRegister(void)
{
1842
    VIR_DEBUG("Registering udev node device backend");
1843

1844
    if (virSetSharedNodeDeviceDriver(&udevNodeDeviceDriver) < 0)
1845 1846 1847 1848
        return -1;

    return virRegisterStateDriver(&udevStateDriver);
}