node_device_udev.c 48.2 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 896 897 898 899 900 901 902 903 904 905 906 907 908
    return ret;
}

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

    if ((udevGetIntProperty(device, "DKD_MEDIA_AVAILABLE",
                            &tmp_int, 0) == PROPERTY_FOUND))
        /* USB floppy */
        has_media = tmp_int;
    else if (udevGetStringProperty(device, "ID_FS_LABEL",
                                   &tmp_str) == PROPERTY_FOUND) {
        /* Legacy floppy */
        has_media = 1;
        VIR_FREE(tmp_str);
    }

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

910 911 912 913

static int udevProcessSD(struct udev_device *device,
                         virNodeDeviceDefPtr def)
{
914
    virNodeDevCapDataPtr data = &def->caps->data;
915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932
    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;

933
 out:
934 935 936 937 938
    return ret;
}



939 940 941 942 943 944 945 946
/* 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;

947 948 949
    VIR_DEBUG("Could not find definitive storage type for device "
              "with sysfs path '%s', trying to guess it",
              def->sysfs_path);
950 951 952

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

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

    return ret;
}


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

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

    return;
}


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

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

    if (VIR_STRDUP(data->storage.block, devnode) < 0)
        goto out;
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 1026 1027 1028
    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",
1029 1030
                              &data->storage.drive_type) != PROPERTY_FOUND ||
        STREQ(def->caps->data.storage.drive_type, "generic")) {
1031 1032 1033 1034
        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 */
1035 1036 1037
        if (udevGetIntProperty(device, "ID_DRIVE_FLOPPY",
                               &tmp_int, 0) == PROPERTY_FOUND &&
            tmp_int == 1) {
1038

1039
            if (VIR_STRDUP(data->storage.drive_type, "floppy") < 0)
1040
                goto out;
1041 1042 1043 1044 1045 1046 1047 1048 1049
        } 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) {
1050

1051
            if (VIR_STRDUP(data->storage.drive_type, "sd") < 0)
1052
                goto out;
1053 1054 1055
        } else {

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

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

1075
    if (udevGenerateDeviceName(device, def, data->storage.serial) != 0)
1076 1077
        goto out;

1078
 out:
1079
    VIR_DEBUG("Storage ret=%d", ret);
1080 1081 1082
    return ret;
}

1083
static int
1084
udevProcessSCSIGeneric(struct udev_device *dev,
1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097
                       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;
}

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

1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125
    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. */
1126
        if (udevHasDeviceProperty(device, "PCI_CLASS"))
1127
            *type = VIR_NODE_DEV_CAP_PCI_DEV;
1128

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

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

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

    return ret;
}


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

1160
    switch (def->caps->data.type) {
1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178
    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 已提交
1179 1180 1181
    case VIR_NODE_DEV_CAP_SCSI_TARGET:
        ret = udevProcessSCSITarget(device, def);
        break;
1182 1183 1184 1185 1186 1187
    case VIR_NODE_DEV_CAP_SCSI:
        ret = udevProcessSCSIDevice(device, def);
        break;
    case VIR_NODE_DEV_CAP_STORAGE:
        ret = udevProcessStorage(device, def);
        break;
1188
    case VIR_NODE_DEV_CAP_SCSI_GENERIC:
1189
        ret = udevProcessSCSIGeneric(device, def);
1190
        break;
1191
    default:
1192
        VIR_ERROR(_("Unknown device type %d"), def->caps->data.type);
1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207
        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);
1208
    dev = virNodeDeviceFindBySysfsPath(&driver->devs, name);
1209

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

1232 1233
    parent_device = device;
    do {
1234

1235
        parent_device = udev_device_get_parent(parent_device);
1236
        if (parent_device == NULL)
1237
            break;
1238

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

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

1256
            if (VIR_STRDUP(def->parent_sysfs_path, parent_sysfs_path) < 0)
1257 1258 1259 1260 1261
                goto out;
        }

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

1262
    if (!def->parent && VIR_STRDUP(def->parent, "computer") < 0)
1263 1264 1265 1266
        goto out;

    ret = 0;

1267
 out:
1268 1269 1270 1271 1272 1273 1274 1275 1276 1277
    return ret;
}


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

1278
    if (VIR_ALLOC(def) != 0)
1279 1280
        goto out;

1281 1282 1283
    if (VIR_STRDUP(def->sysfs_path, udev_device_get_syspath(device)) < 0)
        goto out;

1284 1285 1286 1287 1288 1289
    if (udevGetStringProperty(device,
                              "DRIVER",
                              &def->driver) == PROPERTY_ERROR) {
        goto out;
    }

1290
    if (VIR_ALLOC(def->caps) != 0)
1291 1292
        goto out;

1293
    if (udevGetDeviceType(device, &def->caps->data.type) != 0)
1294 1295
        goto out;

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

1299
    if (udevSetParent(device, def) != 0)
1300 1301
        goto out;

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

    virNodeDeviceObjUnlock(dev);

    ret = 0;

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

1319 1320 1321 1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332
    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);
1333

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

1342 1343
    udev_device_unref(device);

1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357
    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) {
1358
        VIR_ERROR(_("udev scan devices returned %d"), ret);
1359 1360 1361 1362 1363 1364 1365 1366 1367
        goto out;
    }

    udev_list_entry_foreach(list_entry,
                            udev_enumerate_get_list_entry(udev_enumerate)) {

        udevProcessDeviceListEntry(udev, list_entry);
    }

1368
 out:
1369 1370 1371 1372 1373
    udev_enumerate_unref(udev_enumerate);
    return ret;
}


1374 1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385
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;
}


1386
static int nodeStateCleanup(void)
1387
{
1388
    udevPrivate *priv = NULL;
1389 1390 1391
    struct udev_monitor *udev_monitor = NULL;
    struct udev *udev = NULL;

J
Ján Tomko 已提交
1392 1393
    if (!driver)
        return -1;
1394

J
Ján Tomko 已提交
1395
    nodeDeviceLock();
1396

J
Ján Tomko 已提交
1397
    priv = driver->privateData;
1398

1399 1400 1401
    if (priv) {
        if (priv->watch != -1)
            virEventRemoveHandle(priv->watch);
1402

1403
        udev_monitor = DRV_STATE_UDEV_MONITOR(driver);
1404

1405 1406 1407 1408
        if (udev_monitor != NULL) {
            udev = udev_monitor_get_udev(udev_monitor);
            udev_monitor_unref(udev_monitor);
        }
J
Ján Tomko 已提交
1409
    }
1410

J
Ján Tomko 已提交
1411 1412
    if (udev != NULL)
        udev_unref(udev);
1413

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

J
Ján Tomko 已提交
1420 1421
    udevPCITranslateDeinit();
    return 0;
1422 1423 1424 1425 1426 1427 1428 1429 1430
}


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

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

    device = udev_monitor_receive_device(udev_monitor);
    if (device == NULL) {
1445
        VIR_ERROR(_("udev_monitor_receive_device returned NULL"));
1446 1447 1448 1449
        goto out;
    }

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

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

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

1462
 out:
1463
    udev_device_unref(device);
1464
    nodeDeviceUnlock();
1465 1466 1467 1468
    return;
}


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

1477
    udev = udev_monitor_get_udev(DRV_STATE_UDEV_MONITOR(driver));
1478

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

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

1513
    if (virGetHostUUID(data->system.hardware.uuid))
1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534
        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;
    }

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


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

1549
    if (VIR_ALLOC(def) != 0)
1550 1551
        goto out;

1552
    if (VIR_STRDUP(def->name, "computer") < 0)
1553 1554
        goto out;

1555
    if (VIR_ALLOC(def->caps) != 0)
1556 1557
        goto out;

1558
#if defined(__x86_64__) || defined(__i386__) || defined(__amd64__)
1559
    udevGetDMIData(&def->caps->data);
1560
#endif
1561

1562
    dev = virNodeDeviceAssignDef(&driver->devs, def);
1563
    if (dev == NULL)
1564 1565 1566 1567 1568 1569
        goto out;

    virNodeDeviceObjUnlock(dev);

    ret = 0;

1570
 out:
1571
    if (ret == -1)
1572 1573
        virNodeDeviceDefFree(def);

1574 1575 1576
    return ret;
}

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

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

1608
    if (VIR_ALLOC(priv) < 0)
1609
        return -1;
1610 1611

    priv->watch = -1;
1612
    priv->privileged = privileged;
1613

1614
    if (VIR_ALLOC(driver) < 0) {
1615
        VIR_FREE(priv);
1616
        return -1;
1617 1618
    }

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

1626
    driver->privateData = priv;
1627
    nodeDeviceLock();
1628

1629
    if (udevPCITranslateInit(privileged) < 0)
1630 1631
        goto out_unlock;

1632 1633 1634 1635 1636 1637 1638
    /*
     * 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();
1639
#if HAVE_UDEV_LOGGING
J
Ján Tomko 已提交
1640 1641
    /* cast to get rid of missing-format-attribute warning */
    udev_set_log_fn(udev, (udevLogFunctionPtr) udevLogFunction);
1642
#endif
1643

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

1650
    udev_monitor_enable_receiving(priv->udev_monitor);
1651 1652 1653 1654 1655 1656 1657 1658 1659

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

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

    /* Populate with known devices */

1672
    if (udevEnumerateDevices(udev) != 0)
1673
        goto out_unlock;
1674 1675

    ret = 0;
1676

1677
 out_unlock:
1678
    nodeDeviceUnlock();
1679

1680
    if (ret == -1)
1681
        nodeStateCleanup();
1682 1683 1684 1685
    return ret;
}


1686
static int nodeStateReload(void)
1687 1688 1689 1690 1691
{
    return 0;
}


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

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

int udevNodeRegister(void)
{
1716
    VIR_DEBUG("Registering udev node device backend");
1717

1718
    if (virSetSharedNodeDeviceDriver(&udevNodeDeviceDriver) < 0)
1719 1720 1721 1722
        return -1;

    return virRegisterStateDriver(&udevStateDriver);
}