node_device_udev.c 48.1 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 31
#include "node_device_conf.h"
#include "node_device_driver.h"
32 33 34
#include "node_device_linux_sysfs.h"
#include "node_device_udev.h"
#include "virerror.h"
35 36
#include "driver.h"
#include "datatypes.h"
37
#include "virlog.h"
38
#include "viralloc.h"
39
#include "viruuid.h"
40
#include "virbuffer.h"
41
#include "virfile.h"
42
#include "virpci.h"
43
#include "virstring.h"
44
#include "virnetdev.h"
45 46 47

#define VIR_FROM_THIS VIR_FROM_NODEDEV

48 49
VIR_LOG_INIT("node_device.node_device_udev");

50 51 52 53
#ifndef TYPE_RAID
# define TYPE_RAID 12
#endif

54 55 56
struct _udevPrivate {
    struct udev_monitor *udev_monitor;
    int watch;
57
    bool privileged;
58 59
};

60

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

    return false;
}


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

77
    ret = udev_device_get_property_value(udev_device, property_key);
78

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

    return ret;
}


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

    return *value == NULL ? PROPERTY_MISSING : PROPERTY_FOUND;
95 96 97 98 99 100 101 102
}


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

105
    str = udevGetDeviceProperty(udev_device, property_key);
106

107 108 109
    if (str && virStrToLong_i(str, NULL, base, value) < 0) {
        VIR_ERROR(_("Failed to convert '%s' to int"), str);
        return PROPERTY_ERROR;
110
    }
111
    return str == NULL ? PROPERTY_MISSING : PROPERTY_FOUND;
112 113 114 115 116 117 118 119
}


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

122
    str = udevGetDeviceProperty(udev_device, property_key);
123

124 125 126
    if (str && virStrToLong_ui(str, NULL, base, value) < 0) {
        VIR_ERROR(_("Failed to convert '%s' to int"), str);
        return PROPERTY_ERROR;
127
    }
128
    return str == NULL ? PROPERTY_MISSING : PROPERTY_FOUND;
129 130 131 132
}


/* This function allocates memory from the heap for the property
133 134 135
 * value.  That memory must be later freed by some other code.
 * Any control characters that cannot be printed in the XML are stripped
 * from the string */
136 137 138 139 140 141 142 143 144
static int udevGetDeviceSysfsAttr(struct udev_device *udev_device,
                                  const char *attr_name,
                                  char **attr_value)
{
    const char *udev_value = NULL;
    int ret = PROPERTY_FOUND;

    udev_value = udev_device_get_sysattr_value(udev_device, attr_name);
    if (udev_value == NULL) {
145 146
        VIR_DEBUG("udev reports device '%s' does not have sysfs attr '%s'",
                  udev_device_get_sysname(udev_device), attr_name);
147 148 149 150 151 152
        ret = PROPERTY_MISSING;
        goto out;
    }

    /* If this allocation is changed, the comment at the beginning
     * of the function must also be changed. */
153
    if (VIR_STRDUP(*attr_value, udev_value) < 0) {
154 155 156 157 158
        ret = PROPERTY_ERROR;
        goto out;
    }

    VIR_DEBUG("Found sysfs attribute '%s' value '%s' "
159
              "for device with sysname '%s'",
160 161 162
              attr_name, *attr_value,
              udev_device_get_sysname(udev_device));

163
 out:
164 165 166 167 168 169 170 171 172 173 174 175 176
    return ret;
}


static int udevGetStringSysfsAttr(struct udev_device *udev_device,
                                  const char *attr_name,
                                  char **value)
{
    char *tmp = NULL;
    int ret = PROPERTY_MISSING;

    ret = udevGetDeviceSysfsAttr(udev_device, attr_name, &tmp);

177 178
    virStringStripControlChars(tmp);

179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201
    if (tmp != NULL && (STREQ(tmp, ""))) {
        VIR_FREE(tmp);
        tmp = NULL;
        ret = PROPERTY_MISSING;
    }

    *value = tmp;

    return ret;
}


static int udevGetIntSysfsAttr(struct udev_device *udev_device,
                               const char *attr_name,
                               int *value,
                               int base)
{
    char *udev_value = NULL;
    int ret = PROPERTY_FOUND;

    ret = udevGetDeviceSysfsAttr(udev_device, attr_name, &udev_value);

    if (ret == PROPERTY_FOUND) {
J
Ján Tomko 已提交
202 203
        if (virStrToLong_i(udev_value, NULL, base, value) < 0) {
            VIR_ERROR(_("Failed to convert '%s' to int"), udev_value);
204
            ret = PROPERTY_ERROR;
J
Ján Tomko 已提交
205
        }
206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223
    }

    VIR_FREE(udev_value);
    return ret;
}


static int udevGetUintSysfsAttr(struct udev_device *udev_device,
                                const char *attr_name,
                                unsigned int *value,
                                int base)
{
    char *udev_value = NULL;
    int ret = PROPERTY_FOUND;

    ret = udevGetDeviceSysfsAttr(udev_device, attr_name, &udev_value);

    if (ret == PROPERTY_FOUND) {
J
Ján Tomko 已提交
224 225
        if (virStrToLong_ui(udev_value, NULL, base, value) < 0) {
            VIR_ERROR(_("Failed to convert '%s' to unsigned int"), udev_value);
226
            ret = PROPERTY_ERROR;
J
Ján Tomko 已提交
227
        }
228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244
    }

    VIR_FREE(udev_value);
    return ret;
}


static int udevGetUint64SysfsAttr(struct udev_device *udev_device,
                                  const char *attr_name,
                                  unsigned long long *value)
{
    char *udev_value = NULL;
    int ret = PROPERTY_FOUND;

    ret = udevGetDeviceSysfsAttr(udev_device, attr_name, &udev_value);

    if (ret == PROPERTY_FOUND) {
J
Ján Tomko 已提交
245 246
        if (virStrToLong_ull(udev_value, NULL, 0, value) < 0) {
            VIR_ERROR(_("Failed to convert '%s' to unsigned long long"), udev_value);
247
            ret = PROPERTY_ERROR;
J
Ján Tomko 已提交
248
        }
249 250 251 252 253 254 255 256 257 258 259
    }

    VIR_FREE(udev_value);
    return ret;
}


static int udevGenerateDeviceName(struct udev_device *device,
                                  virNodeDeviceDefPtr def,
                                  const char *s)
{
260 261
    int ret = 0;
    size_t i;
262 263
    virBuffer buf = VIR_BUFFER_INITIALIZER;

264
    virBufferAsprintf(&buf, "%s_%s",
265 266 267
                      udev_device_get_subsystem(device),
                      udev_device_get_sysname(device));

268
    if (s != NULL)
269
        virBufferAsprintf(&buf, "_%s", s);
270

271 272
    if (virBufferCheckError(&buf) < 0)
        return -1;
273 274 275

    def->name = virBufferContentAndReset(&buf);

276
    for (i = 0; i < strlen(def->name); i++) {
277
        if (!(c_isalnum(*(def->name + i))))
278 279 280 281 282 283
            *(def->name + i) = '_';
    }

    return ret;
}

284
#if HAVE_UDEV_LOGGING
J
Ján Tomko 已提交
285 286 287 288 289 290 291 292 293
typedef void (*udevLogFunctionPtr)(struct udev *udev,
                                   int priority,
                                   const char *file,
                                   int line,
                                   const char *fn,
                                   const char *format,
                                   va_list args);

static void
294
ATTRIBUTE_FMT_PRINTF(6, 0)
J
Ján Tomko 已提交
295 296 297 298 299 300 301
udevLogFunction(struct udev *udev ATTRIBUTE_UNUSED,
                int priority,
                const char *file,
                int line,
                const char *fn,
                const char *fmt,
                va_list args)
302
{
J
Ján Tomko 已提交
303
    virBuffer buf = VIR_BUFFER_INITIALIZER;
304
    char *format = NULL;
J
Ján Tomko 已提交
305 306 307 308 309 310

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

    format = virBufferContentAndReset(&buf);

311
    virLogVMessage(&virLogSelf,
J
Ján Tomko 已提交
312 313 314 315
                   virLogPriorityFromSyslog(priority),
                   file, line, fn, NULL, format ? format : fmt, args);

    VIR_FREE(format);
316
}
317
#endif
318 319


320 321 322 323 324
static int udevTranslatePCIIds(unsigned int vendor,
                               unsigned int product,
                               char **vendor_string,
                               char **product_string)
{
325
    int ret = -1;
326 327 328 329 330 331 332 333 334 335 336 337 338 339
    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,
340
                    &vendor_name,
341 342 343
                    NULL,
                    NULL);

344 345 346
    if (VIR_STRDUP(*vendor_string, vendor_name) < 0||
        VIR_STRDUP(*product_string, device_name) < 0)
        goto out;
347 348 349

    ret = 0;

350
 out:
351 352 353 354
    return ret;
}


355 356 357
static int udevProcessPCI(struct udev_device *device,
                          virNodeDeviceDefPtr def)
{
358
    const char *syspath = NULL;
359
    virNodeDevCapDataPtr data = &def->caps->data;
360 361
    virPCIEDeviceInfoPtr pci_express = NULL;
    virPCIDevicePtr pciDev = NULL;
362
    udevPrivate *priv = driver->privateData;
363
    int ret = -1;
364
    char *p;
365
    int rc;
366

367
    syspath = udev_device_get_syspath(device);
368 369 370 371 372 373 374 375

    if (udevGetUintProperty(device,
                            "PCI_CLASS",
                            &data->pci_dev.class,
                            16) == PROPERTY_ERROR) {
        goto out;
    }

376 377 378 379 380 381 382 383
    if ((p = strrchr(syspath, '/')) == NULL ||
        virStrToLong_ui(p + 1, &p, 16, &data->pci_dev.domain) < 0 || p == NULL ||
        virStrToLong_ui(p + 1, &p, 16, &data->pci_dev.bus) < 0 || p == NULL ||
        virStrToLong_ui(p + 1, &p, 16, &data->pci_dev.slot) < 0 || p == NULL ||
        virStrToLong_ui(p + 1, &p, 16, &data->pci_dev.function) < 0) {
        virReportError(VIR_ERR_INTERNAL_ERROR,
                       _("failed to parse the PCI address from sysfs path: '%s'"),
                       syspath);
384 385 386 387 388 389
        goto out;
    }

    if (udevGetUintSysfsAttr(device,
                             "vendor",
                             &data->pci_dev.vendor,
390
                             16) == PROPERTY_ERROR) {
391 392 393 394 395 396
        goto out;
    }

    if (udevGetUintSysfsAttr(device,
                             "device",
                             &data->pci_dev.product,
397
                             16) == PROPERTY_ERROR) {
398 399 400
        goto out;
    }

401 402 403 404 405 406
    if (udevTranslatePCIIds(data->pci_dev.vendor,
                            data->pci_dev.product,
                            &data->pci_dev.vendor_name,
                            &data->pci_dev.product_name) != 0) {
        goto out;
    }
407

408
    if (udevGenerateDeviceName(device, def, NULL) != 0)
409 410
        goto out;

411 412 413 414 415 416 417 418 419 420 421 422
    rc = udevGetIntSysfsAttr(device,
                            "numa_node",
                            &data->pci_dev.numa_node,
                            10);
    if (rc == PROPERTY_ERROR) {
        goto out;
    } else if (rc == PROPERTY_MISSING) {
        /* The default value is -1, because it can't be 0
         * as zero is valid node number. */
        data->pci_dev.numa_node = -1;
    }

423
    if (nodeDeviceSysfsGetPCIRelatedDevCaps(syspath, data) < 0)
424 425
        goto out;

426 427 428 429 430 431
    if (!(pciDev = virPCIDeviceNew(data->pci_dev.domain,
                                   data->pci_dev.bus,
                                   data->pci_dev.slot,
                                   data->pci_dev.function)))
        goto out;

432
    /* We need to be root to read PCI device configs */
433
    if (priv->privileged) {
434 435 436
        if (virPCIGetHeaderType(pciDev, &data->pci_dev.hdrType) < 0)
            goto out;

437 438
        if (virPCIDeviceIsPCIExpress(pciDev) > 0) {
            if (VIR_ALLOC(pci_express) < 0)
439 440
                goto out;

441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458
            if (virPCIDeviceHasPCIExpressLink(pciDev) > 0) {
                if (VIR_ALLOC(pci_express->link_cap) < 0 ||
                    VIR_ALLOC(pci_express->link_sta) < 0)
                    goto out;

                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)
                    goto out;

                pci_express->link_sta->port = -1; /* PCIe can't negotiate port. Yet :) */
            }
            data->pci_dev.flags |= VIR_NODE_DEV_CAP_FLAG_PCIE;
            data->pci_dev.pci_express = pci_express;
            pci_express = NULL;
459 460 461
        }
    }

462 463
    ret = 0;

464
 out:
465
    virPCIDeviceFree(pciDev);
466
    virPCIEDeviceInfoFree(pci_express);
467 468 469 470 471 472 473
    return ret;
}


static int udevProcessUSBDevice(struct udev_device *device,
                                virNodeDeviceDefPtr def)
{
474
    virNodeDevCapDataPtr data = &def->caps->data;
475
    int ret = -1;
476
    int err;
477 478 479 480

    if (udevGetUintProperty(device,
                            "BUSNUM",
                            &data->usb_dev.bus,
481
                            10) == PROPERTY_ERROR) {
482 483 484 485 486 487
        goto out;
    }

    if (udevGetUintProperty(device,
                            "DEVNUM",
                            &data->usb_dev.device,
488
                            10) == PROPERTY_ERROR) {
489 490 491 492 493 494 495 496 497 498
        goto out;
    }

    if (udevGetUintProperty(device,
                            "ID_VENDOR_ID",
                            &data->usb_dev.vendor,
                            16) == PROPERTY_ERROR) {
        goto out;
    }

499 500 501 502
    err = udevGetStringProperty(device,
                                "ID_VENDOR_FROM_DATABASE",
                                &data->usb_dev.vendor_name);
    if (err == PROPERTY_ERROR)
503
        goto out;
504 505 506 507 508 509
    if (err == PROPERTY_MISSING) {
        if (udevGetStringSysfsAttr(device,
                                  "manufacturer",
                                  &data->usb_dev.vendor_name) == PROPERTY_ERROR) {
            goto out;
        }
510 511 512 513 514
    }

    if (udevGetUintProperty(device,
                            "ID_MODEL_ID",
                            &data->usb_dev.product,
515
                            16) == PROPERTY_ERROR) {
516 517 518
        goto out;
    }

519 520 521 522
    err = udevGetStringProperty(device,
                                "ID_MODEL_FROM_DATABASE",
                                &data->usb_dev.product_name);
    if (err == PROPERTY_ERROR)
523
        goto out;
524 525 526 527 528 529
    if (err == PROPERTY_MISSING) {
        if (udevGetStringSysfsAttr(device,
                                  "product",
                                  &data->usb_dev.product_name) == PROPERTY_ERROR) {
            goto out;
        }
530 531
    }

532
    if (udevGenerateDeviceName(device, def, NULL) != 0)
533 534 535 536
        goto out;

    ret = 0;

537
 out:
538 539 540 541 542 543 544 545
    return ret;
}


static int udevProcessUSBInterface(struct udev_device *device,
                                   virNodeDeviceDefPtr def)
{
    int ret = -1;
546
    virNodeDevCapDataPtr data = &def->caps->data;
547 548 549 550

    if (udevGetUintSysfsAttr(device,
                             "bInterfaceNumber",
                             &data->usb_if.number,
551
                             16) == PROPERTY_ERROR) {
552 553 554 555 556 557
        goto out;
    }

    if (udevGetUintSysfsAttr(device,
                             "bInterfaceClass",
                             &data->usb_if._class,
558
                             16) == PROPERTY_ERROR) {
559 560 561 562 563 564
        goto out;
    }

    if (udevGetUintSysfsAttr(device,
                             "bInterfaceSubClass",
                             &data->usb_if.subclass,
565
                             16) == PROPERTY_ERROR) {
566 567 568 569 570 571
        goto out;
    }

    if (udevGetUintSysfsAttr(device,
                             "bInterfaceProtocol",
                             &data->usb_if.protocol,
572
                             16) == PROPERTY_ERROR) {
573 574 575
        goto out;
    }

576
    if (udevGenerateDeviceName(device, def, NULL) != 0)
577 578 579 580
        goto out;

    ret = 0;

581
 out:
582 583 584 585 586 587 588 589
    return ret;
}


static int udevProcessNetworkInterface(struct udev_device *device,
                                       virNodeDeviceDefPtr def)
{
    int ret = -1;
D
David Allan 已提交
590
    const char *devtype = udev_device_get_devtype(device);
591
    virNodeDevCapDataPtr data = &def->caps->data;
592

D
David Allan 已提交
593 594 595 596 597 598
    if (devtype && STREQ(devtype, "wlan")) {
        data->net.subtype = VIR_NODE_DEV_CAP_NET_80211;
    } else {
        data->net.subtype = VIR_NODE_DEV_CAP_NET_80203;
    }

599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617
    if (udevGetStringProperty(device,
                              "INTERFACE",
                              &data->net.ifname) == PROPERTY_ERROR) {
        goto out;
    }

    if (udevGetStringSysfsAttr(device,
                               "address",
                               &data->net.address) == PROPERTY_ERROR) {
        goto out;
    }

    if (udevGetUintSysfsAttr(device,
                             "addr_len",
                             &data->net.address_len,
                             0) == PROPERTY_ERROR) {
        goto out;
    }

618
    if (udevGenerateDeviceName(device, def, data->net.address) != 0)
619 620
        goto out;

621 622 623
    if (virNetDevGetLinkInfo(data->net.ifname, &data->net.lnk) < 0)
        goto out;

624 625 626
    if (virNetDevGetFeatures(data->net.ifname, &data->net.features) < 0)
        goto out;

627 628
    ret = 0;

629
 out:
630 631 632 633 634 635 636 637
    return ret;
}


static int udevProcessSCSIHost(struct udev_device *device ATTRIBUTE_UNUSED,
                               virNodeDeviceDefPtr def)
{
    int ret = -1;
638
    virNodeDevCapDataPtr data = &def->caps->data;
639
    char *filename = NULL;
J
Ján Tomko 已提交
640
    char *str;
641

642
    filename = last_component(def->sysfs_path);
643

644 645 646 647 648
    if (!(str = STRSKIP(filename, "host")) ||
        virStrToLong_ui(str, NULL, 0, &data->scsi_host.host) < 0) {
        virReportError(VIR_ERR_INTERNAL_ERROR,
                       _("failed to parse SCSI host '%s'"),
                       filename);
649 650 651
        goto out;
    }

652
    nodeDeviceSysfsGetSCSIHostCaps(&def->caps->data);
653

654
    if (udevGenerateDeviceName(device, def, NULL) != 0)
655 656 657 658
        goto out;

    ret = 0;

659
 out:
660 661 662 663
    return ret;
}


D
David Allan 已提交
664 665 666 667 668
static int udevProcessSCSITarget(struct udev_device *device ATTRIBUTE_UNUSED,
                                 virNodeDeviceDefPtr def)
{
    int ret = -1;
    const char *sysname = NULL;
669
    virNodeDevCapDataPtr data = &def->caps->data;
D
David Allan 已提交
670 671 672

    sysname = udev_device_get_sysname(device);

673
    if (VIR_STRDUP(data->scsi_target.name, sysname) < 0)
D
David Allan 已提交
674 675
        goto out;

676
    if (udevGenerateDeviceName(device, def, NULL) != 0)
D
David Allan 已提交
677 678 679 680
        goto out;

    ret = 0;

681
 out:
D
David Allan 已提交
682 683 684 685
    return ret;
}


686
static int udevGetSCSIType(virNodeDeviceDefPtr def ATTRIBUTE_UNUSED,
687
                           unsigned int type, char **typestring)
688 689 690 691 692 693 694 695
{
    int ret = 0;
    int foundtype = 1;

    *typestring = NULL;

    switch (type) {
    case TYPE_DISK:
696
        ignore_value(VIR_STRDUP(*typestring, "disk"));
697 698
        break;
    case TYPE_TAPE:
699
        ignore_value(VIR_STRDUP(*typestring, "tape"));
700 701
        break;
    case TYPE_PROCESSOR:
702
        ignore_value(VIR_STRDUP(*typestring, "processor"));
703 704
        break;
    case TYPE_WORM:
705
        ignore_value(VIR_STRDUP(*typestring, "worm"));
706 707
        break;
    case TYPE_ROM:
708
        ignore_value(VIR_STRDUP(*typestring, "cdrom"));
709 710
        break;
    case TYPE_SCANNER:
711
        ignore_value(VIR_STRDUP(*typestring, "scanner"));
712 713
        break;
    case TYPE_MOD:
714
        ignore_value(VIR_STRDUP(*typestring, "mod"));
715 716
        break;
    case TYPE_MEDIUM_CHANGER:
717
        ignore_value(VIR_STRDUP(*typestring, "changer"));
718 719
        break;
    case TYPE_ENCLOSURE:
720
        ignore_value(VIR_STRDUP(*typestring, "enclosure"));
721
        break;
722
    case TYPE_RAID:
723
        ignore_value(VIR_STRDUP(*typestring, "raid"));
724
        break;
725 726 727 728 729 730 731 732 733 734
    case TYPE_NO_LUN:
    default:
        foundtype = 0;
        break;
    }

    if (*typestring == NULL) {
        if (foundtype == 1) {
            ret = -1;
        } else {
735 736
            VIR_DEBUG("Failed to find SCSI device type %d for %s",
                      type, def->sysfs_path);
737 738 739 740 741 742 743 744 745 746 747 748
        }
    }

    return ret;
}


static int udevProcessSCSIDevice(struct udev_device *device ATTRIBUTE_UNUSED,
                                 virNodeDeviceDefPtr def)
{
    int ret = -1;
    unsigned int tmp = 0;
749
    virNodeDevCapDataPtr data = &def->caps->data;
750 751
    char *filename = NULL, *p = NULL;

752
    filename = last_component(def->sysfs_path);
753

754 755 756 757 758 759 760 761
    if (virStrToLong_ui(filename, &p, 10, &data->scsi.host) < 0 || p == NULL ||
        virStrToLong_ui(p + 1, &p, 10, &data->scsi.bus) < 0 || p == NULL ||
        virStrToLong_ui(p + 1, &p, 10, &data->scsi.target) < 0 || p == NULL ||
        virStrToLong_ui(p + 1, &p, 10, &data->scsi.lun) < 0) {
        virReportError(VIR_ERR_INTERNAL_ERROR,
                       _("failed to parse the SCSI address from filename: '%s'"),
                       filename);
        return -1;
762 763 764 765
    }

    switch (udevGetUintSysfsAttr(device, "type", &tmp, 0)) {
    case PROPERTY_FOUND:
766
        if (udevGetSCSIType(def, tmp, &data->scsi.type) == -1)
767 768 769 770 771 772 773 774 775 776
            goto out;
        break;
    case PROPERTY_MISSING:
        break; /* No type is not an error */
    case PROPERTY_ERROR:
    default:
        goto out;
        break;
    }

777
    if (udevGenerateDeviceName(device, def, NULL) != 0)
778 779 780 781
        goto out;

    ret = 0;

782
 out:
783
    if (ret != 0) {
784
        VIR_ERROR(_("Failed to process SCSI device with sysfs path '%s'"),
785 786 787 788 789 790 791 792 793
                  def->sysfs_path);
    }
    return ret;
}


static int udevProcessDisk(struct udev_device *device,
                           virNodeDeviceDefPtr def)
{
794
    virNodeDevCapDataPtr data = &def->caps->data;
795 796 797 798 799 800 801 802 803 804 805 806 807 808 809 810 811 812
    int ret = 0;

    if (udevGetUint64SysfsAttr(device,
                               "size",
                               &data->storage.num_blocks) == PROPERTY_ERROR) {
        goto out;
    }

    if (udevGetUint64SysfsAttr(device,
                               "queue/logical_block_size",
                               &data->storage.logical_block_size)
        == PROPERTY_ERROR) {
        goto out;
    }

    data->storage.size = data->storage.num_blocks *
        data->storage.logical_block_size;

813
 out:
814 815 816 817
    return ret;
}


818 819 820
static int udevProcessRemoveableMedia(struct udev_device *device,
                                      virNodeDeviceDefPtr def,
                                      int has_media)
821
{
822
    virNodeDevCapDataPtr data = &def->caps->data;
823 824 825 826 827 828 829
    int tmp_int = 0, ret = 0;

    if ((udevGetIntSysfsAttr(device, "removable", &tmp_int, 0) == PROPERTY_FOUND) &&
        (tmp_int == 1)) {
        def->caps->data.storage.flags |= VIR_NODE_DEV_CAP_STORAGE_REMOVABLE;
    }

830
    if (has_media) {
831 832 833 834

        def->caps->data.storage.flags |=
            VIR_NODE_DEV_CAP_STORAGE_REMOVABLE_MEDIA_AVAILABLE;

835 836 837 838 839
        if (udevGetStringProperty(device, "ID_FS_LABEL",
                                  &data->storage.media_label) == PROPERTY_ERROR) {
            goto out;
        }

840 841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858 859 860
        if (udevGetUint64SysfsAttr(device,
                                   "size",
                                   &data->storage.num_blocks) == PROPERTY_ERROR) {
            goto out;
        }

        if (udevGetUint64SysfsAttr(device,
                                   "queue/logical_block_size",
                                   &data->storage.logical_block_size) == PROPERTY_ERROR) {
            goto out;
        }

        /* 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;
    }

861
 out:
862 863 864
    return ret;
}

865 866 867 868 869 870 871 872 873 874 875 876
static int udevProcessCDROM(struct udev_device *device,
                            virNodeDeviceDefPtr def)
{
    int ret = -1;
    int tmp_int = 0;
    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);
877
    if (VIR_STRDUP(def->caps->data.storage.drive_type, "cdrom") < 0)
878 879 880 881 882 883 884
        goto out;

    if ((udevGetIntProperty(device, "ID_CDROM_MEDIA",
                            &tmp_int, 0) == PROPERTY_FOUND))
        has_media = tmp_int;

    ret = udevProcessRemoveableMedia(device, def, has_media);
885
 out:
886 887 888 889 890 891 892 893 894 895
    return ret;
}

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

    if ((udevGetIntProperty(device, "DKD_MEDIA_AVAILABLE",
896
                            &tmp_int, 0) == PROPERTY_FOUND)) {
897 898
        /* USB floppy */
        has_media = tmp_int;
899
    } else if (udevHasDeviceProperty(device, "ID_FS_LABEL")) {
900 901 902 903 904 905
        /* Legacy floppy */
        has_media = 1;
    }

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

907 908 909 910

static int udevProcessSD(struct udev_device *device,
                         virNodeDeviceDefPtr def)
{
911
    virNodeDevCapDataPtr data = &def->caps->data;
912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929
    int ret = 0;

    if (udevGetUint64SysfsAttr(device,
                               "size",
                               &data->storage.num_blocks) == PROPERTY_ERROR) {
        goto out;
    }

    if (udevGetUint64SysfsAttr(device,
                               "queue/logical_block_size",
                               &data->storage.logical_block_size)
        == PROPERTY_ERROR) {
        goto out;
    }

    data->storage.size = data->storage.num_blocks *
        data->storage.logical_block_size;

930
 out:
931 932 933 934 935
    return ret;
}



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)
{
    int ret = -1;

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

    if (STRPREFIX(def->caps->data.storage.block, "/dev/vd")) {
        /* virtio disk */
950
        ret = VIR_STRDUP(def->caps->data.storage.drive_type, "disk");
951 952 953
    }

    if (ret != 0) {
954 955
        VIR_DEBUG("Could not determine storage type for device "
                  "with sysfs path '%s'", def->sysfs_path);
956 957
    } else {
        VIR_DEBUG("Found storage type '%s' for device "
958
                  "with sysfs path '%s'",
959 960 961 962 963 964 965 966 967 968
                  def->caps->data.storage.drive_type,
                  def->sysfs_path);
    }

    return ret;
}


static void udevStripSpaces(char *s)
{
969
    if (s == NULL)
970 971 972 973 974 975 976 977 978 979 980 981 982 983
        return;

    while (virFileStripSuffix(s, " ")) {
        /* do nothing */
        ;
    }

    return;
}


static int udevProcessStorage(struct udev_device *device,
                              virNodeDeviceDefPtr def)
{
984
    virNodeDevCapDataPtr data = &def->caps->data;
985
    int ret = -1;
986
    const char* devnode;
987

988
    devnode = udev_device_get_devnode(device);
989
    if (!devnode) {
990
        VIR_DEBUG("No devnode for '%s'", udev_device_get_devpath(device));
991 992
        goto out;
    }
993 994 995

    if (VIR_STRDUP(data->storage.block, devnode) < 0)
        goto out;
996

997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025
    if (udevGetStringProperty(device,
                              "ID_BUS",
                              &data->storage.bus) == PROPERTY_ERROR) {
        goto out;
    }
    if (udevGetStringProperty(device,
                              "ID_SERIAL",
                              &data->storage.serial) == PROPERTY_ERROR) {
        goto out;
    }
    if (udevGetStringSysfsAttr(device,
                               "device/vendor",
                               &data->storage.vendor) == PROPERTY_ERROR) {
        goto out;
    }
    udevStripSpaces(def->caps->data.storage.vendor);
    if (udevGetStringSysfsAttr(device,
                               "device/model",
                               &data->storage.model) == PROPERTY_ERROR) {
        goto out;
    }
    udevStripSpaces(def->caps->data.storage.model);
    /* 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. */

    if (udevGetStringProperty(device,
                              "ID_TYPE",
1026 1027
                              &data->storage.drive_type) != PROPERTY_FOUND ||
        STREQ(def->caps->data.storage.drive_type, "generic")) {
1028 1029 1030 1031
        int tmp_int = 0;

        /* All floppy drives have the ID_DRIVE_FLOPPY prop. This is
         * needed since legacy floppies don't have a drive_type */
1032 1033 1034
        if (udevGetIntProperty(device, "ID_DRIVE_FLOPPY",
                               &tmp_int, 0) == PROPERTY_FOUND &&
            tmp_int == 1) {
1035

1036
            if (VIR_STRDUP(data->storage.drive_type, "floppy") < 0)
1037
                goto out;
1038 1039 1040 1041 1042 1043 1044 1045 1046
        } else if (udevGetIntProperty(device, "ID_CDROM",
                                      &tmp_int, 0) == PROPERTY_FOUND &&
                   tmp_int == 1) {

            if (VIR_STRDUP(data->storage.drive_type, "cd") < 0)
                goto out;
        } else if (udevGetIntProperty(device, "ID_DRIVE_FLASH_SD",
                                      &tmp_int, 0) == PROPERTY_FOUND &&
                   tmp_int == 1) {
1047

1048
            if (VIR_STRDUP(data->storage.drive_type, "sd") < 0)
1049
                goto out;
1050 1051 1052
        } else {

            /* If udev doesn't have it, perhaps we can guess it. */
1053
            if (udevKludgeStorageType(def) != 0)
1054
                goto out;
1055 1056 1057 1058 1059 1060 1061
        }
    }

    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);
1062 1063
    } else if (STREQ(def->caps->data.storage.drive_type, "floppy")) {
        ret = udevProcessFloppy(device, def);
1064 1065
    } else if (STREQ(def->caps->data.storage.drive_type, "sd")) {
        ret = udevProcessSD(device, def);
1066
    } else {
1067 1068
        VIR_DEBUG("Unsupported storage type '%s'",
                  def->caps->data.storage.drive_type);
1069 1070 1071
        goto out;
    }

1072
    if (udevGenerateDeviceName(device, def, data->storage.serial) != 0)
1073 1074
        goto out;

1075
 out:
1076
    VIR_DEBUG("Storage ret=%d", ret);
1077 1078 1079
    return ret;
}

1080
static int
1081
udevProcessSCSIGeneric(struct udev_device *dev,
1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094
                       virNodeDeviceDefPtr def)
{
    if (udevGetStringProperty(dev,
                              "DEVNAME",
                              &def->caps->data.sg.path) != PROPERTY_FOUND)
        return -1;

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

    return 0;
}

1095 1096
static int
udevGetDeviceType(struct udev_device *device,
1097
                  virNodeDevCapType *type)
1098 1099
{
    const char *devtype = NULL;
1100
    char *subsystem = NULL;
1101
    int ret = -1;
D
David Allan 已提交
1102

1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122
    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;
    } else {
        /* PCI devices don't set the DEVTYPE property. */
1123
        if (udevHasDeviceProperty(device, "PCI_CLASS"))
1124
            *type = VIR_NODE_DEV_CAP_PCI_DEV;
1125

1126 1127 1128 1129
        /* 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. */
1130
        if (udevHasDeviceProperty(device, "INTERFACE"))
1131
            *type = VIR_NODE_DEV_CAP_NET;
1132 1133 1134 1135 1136 1137 1138

        /* SCSI generic device doesn't set DEVTYPE property */
        if (udevGetStringProperty(device, "SUBSYSTEM", &subsystem) ==
            PROPERTY_FOUND &&
            STREQ(subsystem, "scsi_generic"))
            *type = VIR_NODE_DEV_CAP_SCSI_GENERIC;
        VIR_FREE(subsystem);
1139 1140
    }

1141 1142 1143 1144 1145 1146
    if (!*type)
        VIR_DEBUG("Could not determine device type for device "
                  "with sysfs name '%s'",
                  udev_device_get_sysname(device));
    else
        ret = 0;
1147 1148 1149 1150 1151 1152 1153 1154 1155 1156

    return ret;
}


static int udevGetDeviceDetails(struct udev_device *device,
                                virNodeDeviceDefPtr def)
{
    int ret = 0;

1157
    switch (def->caps->data.type) {
1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175
    case VIR_NODE_DEV_CAP_SYSTEM:
        /* There's no libudev equivalent of system, so ignore it. */
        break;
    case VIR_NODE_DEV_CAP_PCI_DEV:
        ret = udevProcessPCI(device, def);
        break;
    case VIR_NODE_DEV_CAP_USB_DEV:
        ret = udevProcessUSBDevice(device, def);
        break;
    case VIR_NODE_DEV_CAP_USB_INTERFACE:
        ret = udevProcessUSBInterface(device, def);
        break;
    case VIR_NODE_DEV_CAP_NET:
        ret = udevProcessNetworkInterface(device, def);
        break;
    case VIR_NODE_DEV_CAP_SCSI_HOST:
        ret = udevProcessSCSIHost(device, def);
        break;
D
David Allan 已提交
1176 1177 1178
    case VIR_NODE_DEV_CAP_SCSI_TARGET:
        ret = udevProcessSCSITarget(device, def);
        break;
1179 1180 1181 1182 1183 1184
    case VIR_NODE_DEV_CAP_SCSI:
        ret = udevProcessSCSIDevice(device, def);
        break;
    case VIR_NODE_DEV_CAP_STORAGE:
        ret = udevProcessStorage(device, def);
        break;
1185
    case VIR_NODE_DEV_CAP_SCSI_GENERIC:
1186
        ret = udevProcessSCSIGeneric(device, def);
1187
        break;
1188
    default:
1189
        VIR_ERROR(_("Unknown device type %d"), def->caps->data.type);
1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203 1204
        ret = -1;
        break;
    }

    return ret;
}


static int udevRemoveOneDevice(struct udev_device *device)
{
    virNodeDeviceObjPtr dev = NULL;
    const char *name = NULL;
    int ret = 0;

    name = udev_device_get_syspath(device);
1205
    dev = virNodeDeviceFindBySysfsPath(&driver->devs, name);
1206

1207
    if (dev != NULL) {
1208
        VIR_DEBUG("Removing device '%s' with sysfs path '%s'",
1209
                  dev->def->name, name);
1210
        virNodeDeviceObjRemove(&driver->devs, dev);
1211
    } else {
1212 1213
        VIR_DEBUG("Failed to find device to remove that has udev name '%s'",
                  name);
1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228
        ret = -1;
    }

    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;

1229 1230
    parent_device = device;
    do {
1231

1232
        parent_device = udev_device_get_parent(parent_device);
1233
        if (parent_device == NULL)
1234
            break;
1235

1236 1237
        parent_sysfs_path = udev_device_get_syspath(parent_device);
        if (parent_sysfs_path == NULL) {
1238 1239 1240
            virReportError(VIR_ERR_INTERNAL_ERROR,
                           _("Could not get syspath for parent of '%s'"),
                           udev_device_get_syspath(parent_device));
1241
            goto out;
1242 1243
        }

1244
        dev = virNodeDeviceFindBySysfsPath(&driver->devs,
1245 1246
                                           parent_sysfs_path);
        if (dev != NULL) {
1247 1248
            if (VIR_STRDUP(def->parent, dev->def->name) < 0) {
                virNodeDeviceObjUnlock(dev);
1249 1250
                goto out;
            }
1251
            virNodeDeviceObjUnlock(dev);
1252

1253
            if (VIR_STRDUP(def->parent_sysfs_path, parent_sysfs_path) < 0)
1254 1255 1256 1257 1258
                goto out;
        }

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

1259
    if (!def->parent && VIR_STRDUP(def->parent, "computer") < 0)
1260 1261 1262 1263
        goto out;

    ret = 0;

1264
 out:
1265 1266 1267 1268 1269 1270 1271 1272 1273 1274
    return ret;
}


static int udevAddOneDevice(struct udev_device *device)
{
    virNodeDeviceDefPtr def = NULL;
    virNodeDeviceObjPtr dev = NULL;
    int ret = -1;

1275
    if (VIR_ALLOC(def) != 0)
1276 1277
        goto out;

1278 1279 1280
    if (VIR_STRDUP(def->sysfs_path, udev_device_get_syspath(device)) < 0)
        goto out;

1281 1282 1283 1284 1285 1286
    if (udevGetStringProperty(device,
                              "DRIVER",
                              &def->driver) == PROPERTY_ERROR) {
        goto out;
    }

1287
    if (VIR_ALLOC(def->caps) != 0)
1288 1289
        goto out;

1290
    if (udevGetDeviceType(device, &def->caps->data.type) != 0)
1291 1292
        goto out;

1293
    if (udevGetDeviceDetails(device, def) != 0)
1294 1295
        goto out;

1296
    if (udevSetParent(device, def) != 0)
1297 1298
        goto out;

1299 1300
    /* If this is a device change, the old definition will be freed
     * and the current definition will take its place. */
1301
    dev = virNodeDeviceAssignDef(&driver->devs, def);
1302
    if (dev == NULL)
1303 1304 1305 1306 1307 1308
        goto out;

    virNodeDeviceObjUnlock(dev);

    ret = 0;

1309
 out:
1310
    if (ret != 0) {
1311
        VIR_DEBUG("Discarding device %d %p %s", ret, def,
1312
                  def ? NULLSTR(def->sysfs_path) : "");
1313 1314 1315
        virNodeDeviceDefFree(def);
    }

1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327 1328 1329
    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);
1330

1331 1332
    if (device != NULL) {
        if (udevAddOneDevice(device) != 0) {
1333 1334
            VIR_DEBUG("Failed to create node device for udev device '%s'",
                      name);
1335 1336 1337 1338
        }
        ret = 0;
    }

1339 1340
    udev_device_unref(device);

1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354
    return ret;
}


static int udevEnumerateDevices(struct udev *udev)
{
    struct udev_enumerate *udev_enumerate = NULL;
    struct udev_list_entry *list_entry = NULL;
    int ret = 0;

    udev_enumerate = udev_enumerate_new(udev);

    ret = udev_enumerate_scan_devices(udev_enumerate);
    if (0 != ret) {
1355
        VIR_ERROR(_("udev scan devices returned %d"), ret);
1356 1357 1358 1359 1360 1361 1362 1363 1364
        goto out;
    }

    udev_list_entry_foreach(list_entry,
                            udev_enumerate_get_list_entry(udev_enumerate)) {

        udevProcessDeviceListEntry(udev, list_entry);
    }

1365
 out:
1366 1367 1368 1369 1370
    udev_enumerate_unref(udev_enumerate);
    return ret;
}


1371 1372 1373 1374 1375 1376 1377 1378 1379 1380 1381 1382
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;
}


1383
static int nodeStateCleanup(void)
1384
{
1385
    udevPrivate *priv = NULL;
1386 1387 1388
    struct udev_monitor *udev_monitor = NULL;
    struct udev *udev = NULL;

J
Ján Tomko 已提交
1389 1390
    if (!driver)
        return -1;
1391

J
Ján Tomko 已提交
1392
    nodeDeviceLock();
1393

J
Ján Tomko 已提交
1394
    priv = driver->privateData;
1395

1396 1397 1398
    if (priv) {
        if (priv->watch != -1)
            virEventRemoveHandle(priv->watch);
1399

1400
        udev_monitor = DRV_STATE_UDEV_MONITOR(driver);
1401

1402 1403 1404 1405
        if (udev_monitor != NULL) {
            udev = udev_monitor_get_udev(udev_monitor);
            udev_monitor_unref(udev_monitor);
        }
J
Ján Tomko 已提交
1406
    }
1407

J
Ján Tomko 已提交
1408 1409
    if (udev != NULL)
        udev_unref(udev);
1410

J
Ján Tomko 已提交
1411 1412 1413 1414 1415
    virNodeDeviceObjListFree(&driver->devs);
    nodeDeviceUnlock();
    virMutexDestroy(&driver->lock);
    VIR_FREE(driver);
    VIR_FREE(priv);
1416

J
Ján Tomko 已提交
1417 1418
    udevPCITranslateDeinit();
    return 0;
1419 1420 1421 1422 1423 1424 1425 1426 1427
}


static void udevEventHandleCallback(int watch ATTRIBUTE_UNUSED,
                                    int fd,
                                    int events ATTRIBUTE_UNUSED,
                                    void *data ATTRIBUTE_UNUSED)
{
    struct udev_device *device = NULL;
1428
    struct udev_monitor *udev_monitor = DRV_STATE_UDEV_MONITOR(driver);
1429 1430 1431
    const char *action = NULL;
    int udev_fd = -1;

1432
    nodeDeviceLock();
1433 1434
    udev_fd = udev_monitor_get_fd(udev_monitor);
    if (fd != udev_fd) {
1435 1436
        VIR_ERROR(_("File descriptor returned by udev %d does not "
                    "match node device file descriptor %d"), fd, udev_fd);
1437 1438 1439 1440 1441
        goto out;
    }

    device = udev_monitor_receive_device(udev_monitor);
    if (device == NULL) {
1442
        VIR_ERROR(_("udev_monitor_receive_device returned NULL"));
1443 1444 1445 1446
        goto out;
    }

    action = udev_device_get_action(device);
1447
    VIR_DEBUG("udev action: '%s'", action);
1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458

    if (STREQ(action, "add") || STREQ(action, "change")) {
        udevAddOneDevice(device);
        goto out;
    }

    if (STREQ(action, "remove")) {
        udevRemoveOneDevice(device);
        goto out;
    }

1459
 out:
1460
    udev_device_unref(device);
1461
    nodeDeviceUnlock();
1462 1463 1464 1465
    return;
}


1466 1467
/* DMI is intel-compatible specific */
#if defined(__x86_64__) || defined(__i386__) || defined(__amd64__)
1468
static void
1469
udevGetDMIData(virNodeDevCapDataPtr data)
1470 1471 1472 1473
{
    struct udev *udev = NULL;
    struct udev_device *device = NULL;

1474
    udev = udev_monitor_get_udev(DRV_STATE_UDEV_MONITOR(driver));
1475

1476 1477
    device = udev_device_new_from_syspath(udev, DMI_DEVPATH);
    if (device == NULL) {
1478 1479
        device = udev_device_new_from_syspath(udev, DMI_DEVPATH_FALLBACK);
        if (device == NULL) {
1480
            VIR_ERROR(_("Failed to get udev device for syspath '%s' or '%s'"),
1481
                      DMI_DEVPATH, DMI_DEVPATH_FALLBACK);
1482 1483
            goto out;
        }
1484 1485 1486 1487 1488 1489 1490 1491 1492 1493 1494 1495 1496 1497 1498 1499 1500 1501 1502 1503 1504 1505 1506 1507 1508 1509
    }

    if (udevGetStringSysfsAttr(device,
                               "product_name",
                               &data->system.product_name) == PROPERTY_ERROR) {
        goto out;
    }
    if (udevGetStringSysfsAttr(device,
                               "sys_vendor",
                               &data->system.hardware.vendor_name)
        == PROPERTY_ERROR) {
        goto out;
    }
    if (udevGetStringSysfsAttr(device,
                               "product_version",
                               &data->system.hardware.version)
        == PROPERTY_ERROR) {
        goto out;
    }
    if (udevGetStringSysfsAttr(device,
                               "product_serial",
                               &data->system.hardware.serial)
        == PROPERTY_ERROR) {
        goto out;
    }

1510
    if (virGetHostUUID(data->system.hardware.uuid))
1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531
        goto out;

    if (udevGetStringSysfsAttr(device,
                               "bios_vendor",
                               &data->system.firmware.vendor_name)
        == PROPERTY_ERROR) {
        goto out;
    }
    if (udevGetStringSysfsAttr(device,
                               "bios_version",
                               &data->system.firmware.version)
        == PROPERTY_ERROR) {
        goto out;
    }
    if (udevGetStringSysfsAttr(device,
                               "bios_date",
                               &data->system.firmware.release_date)
        == PROPERTY_ERROR) {
        goto out;
    }

1532
 out:
1533
    if (device != NULL)
1534 1535 1536
        udev_device_unref(device);
    return;
}
1537
#endif
1538 1539 1540 1541 1542 1543 1544 1545


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

1546
    if (VIR_ALLOC(def) != 0)
1547 1548
        goto out;

1549
    if (VIR_STRDUP(def->name, "computer") < 0)
1550 1551
        goto out;

1552
    if (VIR_ALLOC(def->caps) != 0)
1553 1554
        goto out;

1555
#if defined(__x86_64__) || defined(__i386__) || defined(__amd64__)
1556
    udevGetDMIData(&def->caps->data);
1557
#endif
1558

1559
    dev = virNodeDeviceAssignDef(&driver->devs, def);
1560
    if (dev == NULL)
1561 1562 1563 1564 1565 1566
        goto out;

    virNodeDeviceObjUnlock(dev);

    ret = 0;

1567
 out:
1568
    if (ret == -1)
1569 1570
        virNodeDeviceDefFree(def);

1571 1572 1573
    return ret;
}

1574
static int udevPCITranslateInit(bool privileged ATTRIBUTE_UNUSED)
1575
{
1576 1577 1578 1579
#if defined __s390__ || defined __s390x_
    /* On s390(x) system there is no PCI bus.
     * Therefore there is nothing to initialize here. */
#else
1580 1581 1582
    int pciret;

    if ((pciret = pci_system_init()) != 0) {
1583 1584 1585
        /* 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.  */
1586
        if (errno != ENOENT && (privileged  || errno != EACCES)) {
1587 1588
            char ebuf[256];
            VIR_ERROR(_("Failed to initialize libpciaccess: %s"),
1589
                      virStrerror(pciret, ebuf, sizeof(ebuf)));
1590
            return -1;
1591
        }
1592
    }
1593
#endif
1594 1595 1596 1597 1598 1599 1600 1601 1602 1603 1604
    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;

1605
    if (VIR_ALLOC(priv) < 0)
1606
        return -1;
1607 1608

    priv->watch = -1;
1609
    priv->privileged = privileged;
1610

1611
    if (VIR_ALLOC(driver) < 0) {
1612
        VIR_FREE(priv);
1613
        return -1;
1614 1615
    }

1616 1617
    if (virMutexInit(&driver->lock) < 0) {
        VIR_ERROR(_("Failed to initialize mutex for driver"));
1618
        VIR_FREE(priv);
1619
        VIR_FREE(driver);
1620
        return -1;
1621 1622
    }

1623
    driver->privateData = priv;
1624
    nodeDeviceLock();
1625

1626
    if (udevPCITranslateInit(privileged) < 0)
1627 1628
        goto out_unlock;

1629 1630 1631 1632 1633 1634 1635
    /*
     * http://www.kernel.org/pub/linux/utils/kernel/hotplug/libudev/libudev-udev.html#udev-new
     *
     * indicates no return value other than success, so we don't check
     * its return value.
     */
    udev = udev_new();
1636
#if HAVE_UDEV_LOGGING
J
Ján Tomko 已提交
1637 1638
    /* cast to get rid of missing-format-attribute warning */
    udev_set_log_fn(udev, (udevLogFunctionPtr) udevLogFunction);
1639
#endif
1640

1641 1642
    priv->udev_monitor = udev_monitor_new_from_netlink(udev, "udev");
    if (priv->udev_monitor == NULL) {
1643
        VIR_ERROR(_("udev_monitor_new_from_netlink returned NULL"));
1644
        goto out_unlock;
1645 1646
    }

1647
    udev_monitor_enable_receiving(priv->udev_monitor);
1648 1649 1650 1651 1652 1653 1654 1655 1656

    /* 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.  */
1657 1658 1659
    priv->watch = virEventAddHandle(udev_monitor_get_fd(priv->udev_monitor),
                                    VIR_EVENT_HANDLE_READABLE,
                                    udevEventHandleCallback, NULL, NULL);
1660
    if (priv->watch == -1)
1661
        goto out_unlock;
1662 1663

    /* Create a fictional 'computer' device to root the device tree. */
1664
    if (udevSetupSystemDev() != 0)
1665
        goto out_unlock;
1666 1667 1668

    /* Populate with known devices */

1669
    if (udevEnumerateDevices(udev) != 0)
1670
        goto out_unlock;
1671 1672

    ret = 0;
1673

1674
 out_unlock:
1675
    nodeDeviceUnlock();
1676

1677
    if (ret == -1)
1678
        nodeStateCleanup();
1679 1680 1681 1682
    return ret;
}


1683
static int nodeStateReload(void)
1684 1685 1686 1687 1688
{
    return 0;
}


1689
static virNodeDeviceDriver udevNodeDeviceDriver = {
1690
    .name = "udev",
1691 1692
    .nodeNumOfDevices = nodeNumOfDevices, /* 0.7.3 */
    .nodeListDevices = nodeListDevices, /* 0.7.3 */
1693
    .connectListAllNodeDevices = nodeConnectListAllNodeDevices, /* 0.10.2 */
1694 1695 1696 1697 1698 1699 1700 1701
    .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 */
1702 1703 1704
};

static virStateDriver udevStateDriver = {
M
Matthias Bolte 已提交
1705
    .name = "udev",
1706 1707 1708
    .stateInitialize = nodeStateInitialize, /* 0.7.3 */
    .stateCleanup = nodeStateCleanup, /* 0.7.3 */
    .stateReload = nodeStateReload, /* 0.7.3 */
1709 1710 1711 1712
};

int udevNodeRegister(void)
{
1713
    VIR_DEBUG("Registering udev node device backend");
1714

1715
    if (virSetSharedNodeDeviceDriver(&udevNodeDeviceDriver) < 0)
1716 1717 1718 1719
        return -1;

    return virRegisterStateDriver(&udevStateDriver);
}