virpcimock.c 26.5 KB
Newer Older
M
Michal Privoznik 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23
/*
 * Copyright (C) 2013 Red Hat, Inc.
 *
 * 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
 * License along with this library.  If not, see
 * <http://www.gnu.org/licenses/>.
 *
 * Author: Michal Privoznik <mprivozn@redhat.com>
 */

#include <config.h>

#ifdef __linux__
24
# include "virmock.h"
M
Michal Privoznik 已提交
25 26 27 28 29 30
# include <stdio.h>
# include <stdlib.h>
# include <unistd.h>
# include <fcntl.h>
# include <sys/stat.h>
# include <stdarg.h>
31
# include <dirent.h>
M
Michal Privoznik 已提交
32 33 34
# include "viralloc.h"
# include "virstring.h"
# include "virfile.h"
35
# include "dirname.h"
M
Michal Privoznik 已提交
36

37 38 39 40 41 42 43 44 45
static int (*real_access)(const char *path, int mode);
static int (*real_lstat)(const char *path, struct stat *sb);
static int (*real___lxstat)(int ver, const char *path, struct stat *sb);
static int (*real_stat)(const char *path, struct stat *sb);
static int (*real___xstat)(int ver, const char *path, struct stat *sb);
static char *(*real_canonicalize_file_name)(const char *path);
static int (*real_open)(const char *path, int flags, ...);
static int (*real_close)(int fd);
static DIR * (*real_opendir)(const char *name);
M
Michal Privoznik 已提交
46 47 48 49 50

/* Don't make static, since it causes problems with clang
 * when passed as an arg to virAsprintf()
 * vircgroupmock.c:462:22: error: static variable 'fakesysfsdir' is used in an inline function with external linkage [-Werror,-Wstatic-in-inline]
 */
51
char *fakerootdir;
52
char *fakesysfspcidir;
M
Michal Privoznik 已提交
53

54
# define SYSFS_PCI_PREFIX "/sys/bus/pci/"
M
Michal Privoznik 已提交
55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72

# define STDERR(...)                                                    \
    fprintf(stderr, "%s %zu: ", __FUNCTION__, (size_t) __LINE__);       \
    fprintf(stderr, __VA_ARGS__);                                       \
    fprintf(stderr, "\n");                                              \

# define ABORT(...)                                                     \
    do {                                                                \
        STDERR(__VA_ARGS__);                                            \
        abort();                                                        \
    } while (0)

# define ABORT_OOM()                                                    \
    ABORT("Out of memory")
/*
 * The plan:
 *
 * Mock some file handling functions. Redirect them into a stub tree passed via
73
 * LIBVIRT_FAKE_ROOT_DIR env variable. All files and links within stub tree is
74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93
 * created by us. There are some actions that we must take if some special
 * files are written to. Here's the list of files we watch:
 *
 * /sys/bus/pci/drivers/<driver>/new_id:
 *   Learn the driver new vendor and device combination.
 *   Data in format "VVVV DDDD".
 *
 * /sys/bus/pci/drivers/<driver>/remove_id
 *   Make the driver forget about vendor and device.
 *   Data in format "VVVV DDDD".
 *
 * /sys/bus/pci/drivers/<driver>/bind
 *   Check if driver supports the device and bind driver to it (create symlink
 *   called 'driver' pointing to the /sys/but/pci/drivers/<driver>).
 *   Data in format "DDDD:BB:DD.F" (Domain:Bus:Device.Function).
 *
 * /sys/bus/pci/drivers/<driver>/unbind
 *   Unbind driver from the device.
 *   Data in format "DDDD:BB:DD.F" (Domain:Bus:Device.Function).
 *
94 95 96 97
 * /sys/bus/pci/drivers_probe
 *   Probe for a driver that handles the specified device.
 *   Data in format "DDDD:BB:DD.F" (Domain:Bus:Device.Function).
 *
98 99 100 101
 * As a little hack, we are not mocking write to these files, but close()
 * instead. The advantage is we don't need any self growing array to hold the
 * partial writes and construct them back. We can let all the writes finish,
 * and then just read the file content back.
M
Michal Privoznik 已提交
102 103 104 105 106 107 108 109
 */

/*
 *
 * Functions to model kernel behavior
 *
 */

110 111 112 113 114 115 116
enum driverActions {
    PCI_ACTION_BIND         = 1 << 0,
    PCI_ACTION_UNBIND       = 1 << 1,
    PCI_ACTION_NEW_ID       = 1 << 2,
    PCI_ACTION_REMOVE_ID    = 1 << 3,
};

117 118 119 120 121
struct pciDriver {
    char *name;
    int *vendor;        /* List of vendor:device IDs the driver can handle */
    int *device;
    size_t len;            /* @len is used for both @vendor and @device */
122
    unsigned int fail;  /* Bitwise-OR of driverActions that should fail */
123 124
};

M
Michal Privoznik 已提交
125 126 127 128
struct pciDevice {
    char *id;
    int vendor;
    int device;
129
    int class;
A
Andrea Bolognani 已提交
130
    int iommuGroup;
131 132 133 134 135 136
    struct pciDriver *driver;   /* Driver attached. NULL if attached to no driver */
};

struct fdCallback {
    int fd;
    char *path;
M
Michal Privoznik 已提交
137 138 139
};

struct pciDevice **pciDevices = NULL;
140
size_t nPCIDevices = 0;
M
Michal Privoznik 已提交
141

142
struct pciDriver **pciDrivers = NULL;
143
size_t nPCIDrivers = 0;
144 145 146 147

struct fdCallback *callbacks = NULL;
size_t nCallbacks = 0;

M
Michal Privoznik 已提交
148 149
static void init_env(void);

150
static int pci_device_autobind(struct pciDevice *dev);
M
Michal Privoznik 已提交
151
static void pci_device_new_from_stub(const struct pciDevice *data);
152 153 154
static struct pciDevice *pci_device_find_by_id(const char *id);
static struct pciDevice *pci_device_find_by_content(const char *path);

155
static void pci_driver_new(const char *name, int fail, ...);
156 157 158 159 160 161 162 163 164
static struct pciDriver *pci_driver_find_by_dev(struct pciDevice *dev);
static struct pciDriver *pci_driver_find_by_path(const char *path);
static int pci_driver_bind(struct pciDriver *driver, struct pciDevice *dev);
static int pci_driver_unbind(struct pciDriver *driver, struct pciDevice *dev);
static int pci_driver_handle_change(int fd, const char *path);
static int pci_driver_handle_bind(const char *path);
static int pci_driver_handle_unbind(const char *path);
static int pci_driver_handle_new_id(const char *path);
static int pci_driver_handle_remove_id(const char *path);
M
Michal Privoznik 已提交
165 166 167 168 169 170 171 172


/*
 * Helper functions
 */
static void
make_file(const char *path,
          const char *name,
173 174
          const char *value,
          ssize_t len)
M
Michal Privoznik 已提交
175 176 177
{
    int fd = -1;
    char *filepath = NULL;
178 179
    if (value && len == -1)
        len = strlen(value);
M
Michal Privoznik 已提交
180 181 182 183

    if (virAsprintfQuiet(&filepath, "%s/%s", path, name) < 0)
        ABORT_OOM();

184
    if ((fd = real_open(filepath, O_CREAT|O_WRONLY, 0666)) < 0)
M
Michal Privoznik 已提交
185 186
        ABORT("Unable to open: %s", filepath);

187
    if (value && safewrite(fd, value, len) != len)
M
Michal Privoznik 已提交
188 189 190 191 192 193
        ABORT("Unable to write: %s", filepath);

    VIR_FORCE_CLOSE(fd);
    VIR_FREE(filepath);
}

A
Andrea Bolognani 已提交
194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209
static void
make_symlink(const char *path,
          const char *name,
          const char *target)
{
    char *filepath = NULL;

    if (virAsprintfQuiet(&filepath, "%s/%s", path, name) < 0)
        ABORT_OOM();

    if (symlink(target, filepath) < 0)
        ABORT("Unable to create symlink filepath -> target");

    VIR_FREE(filepath);
}

210 211 212 213 214 215 216 217 218 219
static int
pci_read_file(const char *path,
              char *buf,
              size_t buf_size)
{
    int ret = -1;
    int fd = -1;
    char *newpath;

    if (virAsprintfQuiet(&newpath, "%s/%s",
220 221
                         fakesysfspcidir,
                         path + strlen(SYSFS_PCI_PREFIX)) < 0) {
222 223 224 225
        errno = ENOMEM;
        goto cleanup;
    }

226
    if ((fd = real_open(newpath, O_RDWR)) < 0)
227 228 229 230 231 232 233 234 235 236 237 238
        goto cleanup;

    bzero(buf, buf_size);
    if (saferead(fd, buf, buf_size - 1) < 0) {
        STDERR("Unable to read from %s", newpath);
        goto cleanup;
    }

    if (ftruncate(fd, 0) < 0)
        goto cleanup;

    ret = 0;
239
 cleanup:
240
    VIR_FREE(newpath);
241
    real_close(fd);
242 243 244
    return ret;
}

M
Michal Privoznik 已提交
245 246 247 248
static int
getrealpath(char **newpath,
            const char *path)
{
249
    init_env();
M
Michal Privoznik 已提交
250

251
    if (STRPREFIX(path, SYSFS_PCI_PREFIX)) {
M
Michal Privoznik 已提交
252
        if (virAsprintfQuiet(newpath, "%s/%s",
253 254
                             fakesysfspcidir,
                             path + strlen(SYSFS_PCI_PREFIX)) < 0) {
M
Michal Privoznik 已提交
255 256 257 258 259 260 261 262 263 264 265
            errno = ENOMEM;
            return -1;
        }
    } else {
        if (VIR_STRDUP_QUIET(*newpath, path) < 0)
            return -1;
    }

    return 0;
}

266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301
static bool
find_fd(int fd, size_t *indx)
{
    size_t i;

    for (i = 0; i < nCallbacks; i++) {
        if (callbacks[i].fd == fd) {
            if (indx)
                *indx = i;
            return true;
        }
    }

    return false;
}

static int
add_fd(int fd, const char *path)
{
    int ret = -1;
    size_t i;

    if (find_fd(fd, &i)) {
        struct fdCallback cb = callbacks[i];
        ABORT("FD %d %s already present in the array as %d %s",
              fd, path, cb.fd, cb.path);
    }

    if (VIR_REALLOC_N_QUIET(callbacks, nCallbacks + 1) < 0 ||
        VIR_STRDUP_QUIET(callbacks[nCallbacks].path, path) < 0) {
        errno = ENOMEM;
        goto cleanup;
    }

    callbacks[nCallbacks++].fd = fd;
    ret = 0;
302
 cleanup:
303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325
    return ret;
}

static int
remove_fd(int fd)
{
    int ret = -1;
    size_t i;

    if (find_fd(fd, &i)) {
        struct fdCallback cb = callbacks[i];

        if (pci_driver_handle_change(cb.fd, cb.path) < 0)
            goto cleanup;

        VIR_FREE(cb.path);
        if (VIR_DELETE_ELEMENT(callbacks, i, nCallbacks) < 0) {
            errno = EINVAL;
            goto cleanup;
        }
    }

    ret = 0;
326
 cleanup:
327 328 329
    return ret;
}

M
Michal Privoznik 已提交
330 331 332 333 334 335 336 337 338

/*
 * PCI Device functions
 */
static void
pci_device_new_from_stub(const struct pciDevice *data)
{
    struct pciDevice *dev;
    char *devpath;
339 340
    char *id;
    char *c;
341
    char *configSrc;
A
Andrea Bolognani 已提交
342
    char tmp[256];
343
    struct stat sb;
M
Michal Privoznik 已提交
344

345 346 347 348 349 350 351 352 353 354 355 356 357 358
    if (VIR_STRDUP_QUIET(id, data->id) < 0)
        ABORT_OOM();

    /* Replace ':' with '-' to create the config filename from the
     * device ID. The device ID cannot be used directly as filename
     * because it contains ':' and Windows does not allow ':' in
     * filenames. */
    c = strchr(id, ':');

    while (c) {
        *c = '-';
        c = strchr(c, ':');
    }

M
Michal Privoznik 已提交
359
    if (VIR_ALLOC_QUIET(dev) < 0 ||
360
        virAsprintfQuiet(&configSrc, "%s/virpcitestdata/%s.config",
361
                         abs_srcdir, id) < 0 ||
362
        virAsprintfQuiet(&devpath, "%s/devices/%s", fakesysfspcidir, data->id) < 0)
M
Michal Privoznik 已提交
363 364
        ABORT_OOM();

365
    VIR_FREE(id);
M
Michal Privoznik 已提交
366 367 368 369 370
    memcpy(dev, data, sizeof(*dev));

    if (virFileMakePath(devpath) < 0)
        ABORT("Unable to create: %s", devpath);

371 372
    /* If there is a config file for the device within virpcitestdata dir,
     * symlink it. Otherwise create a dummy config file. */
373 374
    if ((real_stat && real_stat(configSrc, &sb) == 0) ||
        (real___xstat && real___xstat(_STAT_VER, configSrc, &sb) == 0)) {
375 376 377 378 379 380 381 382 383 384 385 386 387
        /* On success, copy @configSrc into the destination (a copy,
         * rather than a symlink, is required since we write into the
         * file, and parallel VPATH builds must not stomp on the
         * original; besides, 'make distcheck' requires the original
         * to be read-only */
        char *buf;
        ssize_t len;

        if ((len = virFileReadAll(configSrc, 4096, &buf)) < 0)
            ABORT("Unable to read config file '%s'", configSrc);

        make_file(devpath, "config", buf, len);
        VIR_FREE(buf);
388 389 390
    } else {
        /* If there's no config data in the virpcitestdata dir, create a dummy
         * config file */
391
        make_file(devpath, "config", "some dummy config", -1);
392
    }
M
Michal Privoznik 已提交
393 394 395

    if (snprintf(tmp, sizeof(tmp),  "0x%.4x", dev->vendor) < 0)
        ABORT("@tmp overflow");
396
    make_file(devpath, "vendor", tmp, -1);
M
Michal Privoznik 已提交
397 398 399

    if (snprintf(tmp, sizeof(tmp),  "0x%.4x", dev->device) < 0)
        ABORT("@tmp overflow");
400
    make_file(devpath, "device", tmp, -1);
M
Michal Privoznik 已提交
401

402 403 404 405
    if (snprintf(tmp, sizeof(tmp),  "0x%.4x", dev->class) < 0)
        ABORT("@tmp overflow");
    make_file(devpath, "class", tmp, -1);

A
Andrea Bolognani 已提交
406 407 408 409 410 411 412 413 414 415 416 417 418 419
    if (snprintf(tmp, sizeof(tmp),
                 "%s/../../../kernel/iommu_groups/%d",
                 devpath, dev->iommuGroup) < 0) {
        ABORT("@tmp overflow");
    }
    if (virFileMakePath(tmp) < 0)
        ABORT("Unable to create %s", tmp);

    if (snprintf(tmp, sizeof(tmp),
                 "../../../kernel/iommu_groups/%d", dev->iommuGroup) < 0) {
        ABORT("@tmp overflow");
    }
    make_symlink(devpath, "iommu_group", tmp);

420 421 422
    if (pci_device_autobind(dev) < 0)
        ABORT("Unable to bind: %s", data->id);

423
    if (VIR_APPEND_ELEMENT_QUIET(pciDevices, nPCIDevices, dev) < 0)
M
Michal Privoznik 已提交
424 425 426
        ABORT_OOM();

    VIR_FREE(devpath);
427
    VIR_FREE(configSrc);
M
Michal Privoznik 已提交
428 429
}

430 431 432 433
static struct pciDevice *
pci_device_find_by_id(const char *id)
{
    size_t i;
434
    for (i = 0; i < nPCIDevices; i++) {
435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472
        struct pciDevice *dev = pciDevices[i];

        if (STREQ(dev->id, id))
            return dev;
    }

    return NULL;
}

static struct pciDevice *
pci_device_find_by_content(const char *path)
{
    char tmp[32];

    if (pci_read_file(path, tmp, sizeof(tmp)) < 0)
        return NULL;

    return pci_device_find_by_id(tmp);
}

static int
pci_device_autobind(struct pciDevice *dev)
{
    struct pciDriver *driver = pci_driver_find_by_dev(dev);

    if (!driver) {
        /* No driver found. Nothing to do */
        return 0;
    }

    return pci_driver_bind(driver, dev);
}


/*
 * PCI Driver functions
 */
static void
473
pci_driver_new(const char *name, int fail, ...)
474 475 476 477 478 479 480 481
{
    struct pciDriver *driver;
    va_list args;
    int vendor, device;
    char *driverpath;

    if (VIR_ALLOC_QUIET(driver) < 0 ||
        VIR_STRDUP_QUIET(driver->name, name) < 0 ||
482
        virAsprintfQuiet(&driverpath, "%s/drivers/%s", fakesysfspcidir, name) < 0)
483 484
        ABORT_OOM();

485 486
    driver->fail = fail;

487 488 489
    if (virFileMakePath(driverpath) < 0)
        ABORT("Unable to create: %s", driverpath);

490
    va_start(args, fail);
491 492 493 494 495 496 497 498 499 500 501 502 503 504

    while ((vendor = va_arg(args, int)) != -1) {
        if ((device = va_arg(args, int)) == -1)
            ABORT("Invalid vendor device pair for driver %s", name);

        if (VIR_REALLOC_N_QUIET(driver->vendor, driver->len + 1) < 0 ||
            VIR_REALLOC_N_QUIET(driver->device, driver->len + 1) < 0)
            ABORT_OOM();

        driver->vendor[driver->len] = vendor;
        driver->device[driver->len] = device;
        driver->len++;
    }

505 506
    va_end(args);

507 508 509 510
    make_file(driverpath, "bind", NULL, -1);
    make_file(driverpath, "unbind", NULL, -1);
    make_file(driverpath, "new_id", NULL, -1);
    make_file(driverpath, "remove_id", NULL, -1);
511

512
    if (VIR_APPEND_ELEMENT_QUIET(pciDrivers, nPCIDrivers, driver) < 0)
513
        ABORT_OOM();
514 515

    VIR_FREE(driverpath);
516 517 518 519 520 521 522
}

static struct pciDriver *
pci_driver_find_by_dev(struct pciDevice *dev)
{
    size_t i;

523
    for (i = 0; i < nPCIDrivers; i++) {
524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541
        struct pciDriver *driver = pciDrivers[i];
        size_t j;

        for (j = 0; j < driver->len; j++) {
            if (driver->vendor[j] == dev->vendor &&
                driver->device[j] == dev->device)
                return driver;
        }
    }

    return NULL;
}

static struct pciDriver *
pci_driver_find_by_path(const char *path)
{
    size_t i;

542
    for (i = 0; i < nPCIDrivers; i++) {
543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558
        struct pciDriver *driver = pciDrivers[i];

        if (strstr(path, driver->name))
            return driver;
    }

    return NULL;
}

static int
pci_driver_bind(struct pciDriver *driver,
                struct pciDevice *dev)
{
    int ret = -1;
    char *devpath = NULL, *driverpath = NULL;

559 560
    if (dev->driver || PCI_ACTION_BIND & driver->fail) {
        /* Device already bound or failing driver requested */
561 562 563 564 565 566
        errno = ENODEV;
        return ret;
    }

    /* Make symlink under device tree */
    if (virAsprintfQuiet(&devpath, "%s/devices/%s/driver",
567
                         fakesysfspcidir, dev->id) < 0 ||
568
        virAsprintfQuiet(&driverpath, "%s/drivers/%s",
569
                         fakesysfspcidir, driver->name) < 0) {
570 571 572 573 574 575 576 577 578 579 580
        errno = ENOMEM;
        goto cleanup;
    }

    if (symlink(driverpath, devpath) < 0)
        goto cleanup;

    /* Make symlink under driver tree */
    VIR_FREE(devpath);
    VIR_FREE(driverpath);
    if (virAsprintfQuiet(&devpath, "%s/devices/%s",
581
                         fakesysfspcidir, dev->id) < 0 ||
582
        virAsprintfQuiet(&driverpath, "%s/drivers/%s/%s",
583
                         fakesysfspcidir, driver->name, dev->id) < 0) {
584 585 586 587 588 589 590 591 592
        errno = ENOMEM;
        goto cleanup;
    }

    if (symlink(devpath, driverpath) < 0)
        goto cleanup;

    dev->driver = driver;
    ret = 0;
593
 cleanup:
594 595 596 597 598 599 600 601 602 603 604 605
    VIR_FREE(devpath);
    VIR_FREE(driverpath);
    return ret;
}

static int
pci_driver_unbind(struct pciDriver *driver,
                  struct pciDevice *dev)
{
    int ret = -1;
    char *devpath = NULL, *driverpath = NULL;

606 607
    if (dev->driver != driver || PCI_ACTION_UNBIND & driver->fail) {
        /* Device not bound to the @driver or failing driver used */
608 609 610 611 612 613
        errno = ENODEV;
        return ret;
    }

    /* Make symlink under device tree */
    if (virAsprintfQuiet(&devpath, "%s/devices/%s/driver",
614
                         fakesysfspcidir, dev->id) < 0 ||
615
        virAsprintfQuiet(&driverpath, "%s/drivers/%s/%s",
616
                         fakesysfspcidir, driver->name, dev->id) < 0) {
617 618 619 620 621 622 623 624 625 626
        errno = ENOMEM;
        goto cleanup;
    }

    if (unlink(devpath) < 0 ||
        unlink(driverpath) < 0)
        goto cleanup;

    dev->driver = NULL;
    ret = 0;
627
 cleanup:
628 629 630 631 632
    VIR_FREE(devpath);
    VIR_FREE(driverpath);
    return ret;
}

633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648
static int
pci_driver_handle_drivers_probe(const char *path)
{
    struct pciDevice *dev;

    if (!(dev = pci_device_find_by_content(path))) {
        errno = ENODEV;
        return -1;
    }

    if (dev->driver)
        return 0;

    return pci_device_autobind(dev);
}

649 650 651 652 653 654
static int
pci_driver_handle_change(int fd ATTRIBUTE_UNUSED, const char *path)
{
    int ret;
    const char *file = last_component(path);

655
    if (STREQ(file, "bind"))
656
        ret = pci_driver_handle_bind(path);
657
    else if (STREQ(file, "unbind"))
658
        ret = pci_driver_handle_unbind(path);
659
    else if (STREQ(file, "new_id"))
660
        ret = pci_driver_handle_new_id(path);
661
    else if (STREQ(file, "remove_id"))
662
        ret = pci_driver_handle_remove_id(path);
663 664 665
    else if (STREQ(file, "drivers_probe"))
        ret = pci_driver_handle_drivers_probe(path);
    else
666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683
        ABORT("Not handled write to: %s", path);
    return ret;
}

static int
pci_driver_handle_bind(const char *path)
{
    int ret = -1;
    struct pciDevice *dev = pci_device_find_by_content(path);
    struct pciDriver *driver = pci_driver_find_by_path(path);

    if (!driver || !dev) {
        /* This should never happen (TM) */
        errno = ENODEV;
        goto cleanup;
    }

    ret = pci_driver_bind(driver, dev);
684
 cleanup:
685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700
    return ret;
}

static int
pci_driver_handle_unbind(const char *path)
{
    int ret = -1;
    struct pciDevice *dev = pci_device_find_by_content(path);

    if (!dev || !dev->driver) {
        /* This should never happen (TM) */
        errno = ENODEV;
        goto cleanup;
    }

    ret = pci_driver_unbind(dev->driver, dev);
701
 cleanup:
702 703 704 705 706 707 708 709 710 711 712
    return ret;
}
static int
pci_driver_handle_new_id(const char *path)
{
    int ret = -1;
    struct pciDriver *driver = pci_driver_find_by_path(path);
    size_t i;
    int vendor, device;
    char buf[32];

713
    if (!driver || PCI_ACTION_NEW_ID & driver->fail) {
714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743
        errno = ENODEV;
        goto cleanup;
    }

    if (pci_read_file(path, buf, sizeof(buf)) < 0)
        goto cleanup;

    if (sscanf(buf, "%x %x", &vendor, &device) < 2) {
        errno = EINVAL;
        goto cleanup;
    }

    for (i = 0; i < driver->len; i++) {
        if (driver->vendor[i] == vendor &&
            driver->device[i] == device)
            break;
    }

    if (i == driver->len) {
        if (VIR_REALLOC_N_QUIET(driver->vendor, driver->len + 1) < 0 ||
            VIR_REALLOC_N_QUIET(driver->device, driver->len + 1) < 0) {
            errno = ENOMEM;
            goto cleanup;
        }

        driver->vendor[driver->len] = vendor;
        driver->device[driver->len] = device;
        driver->len++;
    }

744
    for (i = 0; i < nPCIDevices; i++) {
745 746 747 748 749 750 751 752 753 754
        struct pciDevice *dev = pciDevices[i];

        if (!dev->driver &&
            dev->vendor == vendor &&
            dev->device == device &&
            pci_driver_bind(driver, dev) < 0)
                goto cleanup;
    }

    ret = 0;
755
 cleanup:
756 757 758 759 760 761 762 763 764 765 766 767
    return ret;
}

static int
pci_driver_handle_remove_id(const char *path)
{
    int ret = -1;
    struct pciDriver *driver = pci_driver_find_by_path(path);
    size_t i;
    int vendor, device;
    char buf[32];

768
    if (!driver || PCI_ACTION_REMOVE_ID & driver->fail) {
769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795
        errno = ENODEV;
        goto cleanup;
    }

    if (pci_read_file(path, buf, sizeof(buf)) < 0)
        goto cleanup;

    if (sscanf(buf, "%x %x", &vendor, &device) < 2) {
        errno = EINVAL;
        goto cleanup;
    }

    for (i = 0; i < driver->len; i++) {
        if (driver->vendor[i] == vendor &&
            driver->device[i] == device)
            continue;
    }

    if (i != driver->len) {
        if (VIR_DELETE_ELEMENT(driver->vendor, i, driver->len) < 0)
            goto cleanup;
        driver->len++;
        if (VIR_DELETE_ELEMENT(driver->device, i, driver->len) < 0)
            goto cleanup;
    }

    ret = 0;
796
 cleanup:
797 798 799
    return ret;
}

M
Michal Privoznik 已提交
800 801 802 803 804 805 806

/*
 * Functions to load the symbols and init the environment
 */
static void
init_syms(void)
{
807
    if (real_access)
M
Michal Privoznik 已提交
808 809
        return;

810 811 812 813 814 815 816
    VIR_MOCK_REAL_INIT(access);
    VIR_MOCK_REAL_INIT_ALT(lstat, __lxstat);
    VIR_MOCK_REAL_INIT_ALT(stat, __xstat);
    VIR_MOCK_REAL_INIT(canonicalize_file_name);
    VIR_MOCK_REAL_INIT(open);
    VIR_MOCK_REAL_INIT(close);
    VIR_MOCK_REAL_INIT(opendir);
M
Michal Privoznik 已提交
817 818 819 820 821
}

static void
init_env(void)
{
822
    if (fakerootdir && fakesysfspcidir)
M
Michal Privoznik 已提交
823 824
        return;

825 826
    if (!(fakerootdir = getenv("LIBVIRT_FAKE_ROOT_DIR")))
        ABORT("Missing LIBVIRT_FAKE_ROOT_DIR env variable\n");
M
Michal Privoznik 已提交
827

828 829
    if (virAsprintfQuiet(&fakesysfspcidir, "%s%s",
                         fakerootdir, SYSFS_PCI_PREFIX) < 0)
830 831
        ABORT_OOM();

832 833
    if (virFileMakePath(fakesysfspcidir) < 0)
        ABORT("Unable to create: %s", fakesysfspcidir);
834

835
    make_file(fakesysfspcidir, "drivers_probe", NULL, -1);
836

837
# define MAKE_PCI_DRIVER(name, ...)                                     \
838
    pci_driver_new(name, 0, __VA_ARGS__, -1, -1)
839 840 841 842

    MAKE_PCI_DRIVER("iwlwifi", 0x8086, 0x0044);
    MAKE_PCI_DRIVER("i915", 0x8086, 0x0046, 0x8086, 0x0047);
    MAKE_PCI_DRIVER("pci-stub", -1, -1);
843
    pci_driver_new("vfio-pci", PCI_ACTION_BIND, -1, -1);
844

M
Michal Privoznik 已提交
845 846 847 848 849 850 851 852
# define MAKE_PCI_DEVICE(Id, Vendor, Device, ...)                       \
    do {                                                                \
        struct pciDevice dev = {.id = (char *)Id, .vendor = Vendor,     \
                                .device = Device, __VA_ARGS__};         \
        pci_device_new_from_stub(&dev);                                 \
    } while (0)

    MAKE_PCI_DEVICE("0000:00:00.0", 0x8086, 0x0044);
853 854 855
    MAKE_PCI_DEVICE("0000:00:01.0", 0x8086, 0x0044);
    MAKE_PCI_DEVICE("0000:00:02.0", 0x8086, 0x0046);
    MAKE_PCI_DEVICE("0000:00:03.0", 0x8086, 0x0048);
856
    MAKE_PCI_DEVICE("0001:00:00.0", 0x1014, 0x03b9, .class = 0x060400);
A
Andrea Bolognani 已提交
857 858
    MAKE_PCI_DEVICE("0001:01:00.0", 0x8086, 0x105e, .iommuGroup = 0);
    MAKE_PCI_DEVICE("0001:01:00.1", 0x8086, 0x105e, .iommuGroup = 0);
859
    MAKE_PCI_DEVICE("0005:80:00.0", 0x10b5, 0x8112, .class = 0x060400);
A
Andrea Bolognani 已提交
860 861 862
    MAKE_PCI_DEVICE("0005:90:01.0", 0x1033, 0x0035, .iommuGroup = 1);
    MAKE_PCI_DEVICE("0005:90:01.1", 0x1033, 0x0035, .iommuGroup = 1);
    MAKE_PCI_DEVICE("0005:90:01.2", 0x1033, 0x00e0, .iommuGroup = 1);
863 864 865
    MAKE_PCI_DEVICE("0000:0a:01.0", 0x8086, 0x0047);
    MAKE_PCI_DEVICE("0000:0a:02.0", 0x8286, 0x0048);
    MAKE_PCI_DEVICE("0000:0a:03.0", 0x8386, 0x0048);
M
Michal Privoznik 已提交
866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881
}


/*
 *
 * Mocked functions
 *
 */

int
access(const char *path, int mode)
{
    int ret;

    init_syms();

882
    if (STRPREFIX(path, SYSFS_PCI_PREFIX)) {
M
Michal Privoznik 已提交
883 884 885
        char *newpath;
        if (getrealpath(&newpath, path) < 0)
            return -1;
886
        ret = real_access(newpath, mode);
M
Michal Privoznik 已提交
887 888
        VIR_FREE(newpath);
    } else {
889
        ret = real_access(path, mode);
M
Michal Privoznik 已提交
890 891 892 893 894 895 896 897 898 899 900
    }
    return ret;
}

int
__lxstat(int ver, const char *path, struct stat *sb)
{
    int ret;

    init_syms();

901
    if (STRPREFIX(path, SYSFS_PCI_PREFIX)) {
M
Michal Privoznik 已提交
902 903 904
        char *newpath;
        if (getrealpath(&newpath, path) < 0)
            return -1;
905
        ret = real___lxstat(ver, newpath, sb);
M
Michal Privoznik 已提交
906 907
        VIR_FREE(newpath);
    } else {
908
        ret = real___lxstat(ver, path, sb);
M
Michal Privoznik 已提交
909 910 911 912 913 914 915 916 917 918 919
    }
    return ret;
}

int
lstat(const char *path, struct stat *sb)
{
    int ret;

    init_syms();

920
    if (STRPREFIX(path, SYSFS_PCI_PREFIX)) {
M
Michal Privoznik 已提交
921 922 923
        char *newpath;
        if (getrealpath(&newpath, path) < 0)
            return -1;
924
        ret = real_lstat(newpath, sb);
M
Michal Privoznik 已提交
925 926
        VIR_FREE(newpath);
    } else {
927
        ret = real_lstat(path, sb);
M
Michal Privoznik 已提交
928 929 930 931
    }
    return ret;
}

932 933 934 935 936 937 938
int
__xstat(int ver, const char *path, struct stat *sb)
{
    int ret;

    init_syms();

939
    if (STRPREFIX(path, SYSFS_PCI_PREFIX)) {
940 941 942
        char *newpath;
        if (getrealpath(&newpath, path) < 0)
            return -1;
943
        ret = real___xstat(ver, newpath, sb);
944 945
        VIR_FREE(newpath);
    } else {
946
        ret = real___xstat(ver, path, sb);
947 948 949 950 951 952 953 954 955 956 957
    }
    return ret;
}

int
stat(const char *path, struct stat *sb)
{
    int ret;

    init_syms();

958
    if (STRPREFIX(path, SYSFS_PCI_PREFIX)) {
959 960 961
        char *newpath;
        if (getrealpath(&newpath, path) < 0)
            return -1;
962
        ret = real_stat(newpath, sb);
963 964
        VIR_FREE(newpath);
    } else {
965
        ret = real_stat(path, sb);
966 967 968 969 970 971 972 973 974 975 976
    }
    return ret;
}

char *
canonicalize_file_name(const char *path)
{
    char *ret;

    init_syms();

977
    if (STRPREFIX(path, SYSFS_PCI_PREFIX)) {
978 979 980
        char *newpath;
        if (getrealpath(&newpath, path) < 0)
            return NULL;
981
        ret = real_canonicalize_file_name(newpath);
982 983
        VIR_FREE(newpath);
    } else {
984
        ret = real_canonicalize_file_name(path);
985 986 987 988
    }
    return ret;
}

M
Michal Privoznik 已提交
989 990 991 992 993 994 995 996
int
open(const char *path, int flags, ...)
{
    int ret;
    char *newpath = NULL;

    init_syms();

997
    if (STRPREFIX(path, SYSFS_PCI_PREFIX) &&
M
Michal Privoznik 已提交
998 999 1000 1001 1002 1003 1004 1005 1006
        getrealpath(&newpath, path) < 0)
        return -1;

    if (flags & O_CREAT) {
        va_list ap;
        mode_t mode;
        va_start(ap, flags);
        mode = va_arg(ap, mode_t);
        va_end(ap);
1007
        ret = real_open(newpath ? newpath : path, flags, mode);
M
Michal Privoznik 已提交
1008
    } else {
1009
        ret = real_open(newpath ? newpath : path, flags);
M
Michal Privoznik 已提交
1010
    }
1011 1012 1013

    /* Catch both: /sys/bus/pci/drivers/... and
     * /sys/bus/pci/device/.../driver/... */
1014
    if (ret >= 0 && STRPREFIX(path, SYSFS_PCI_PREFIX) &&
1015
        strstr(path, "driver") && add_fd(ret, path) < 0) {
1016
        real_close(ret);
1017 1018 1019
        ret = -1;
    }

M
Michal Privoznik 已提交
1020 1021 1022 1023
    VIR_FREE(newpath);
    return ret;
}

1024 1025 1026 1027 1028 1029 1030 1031
DIR *
opendir(const char *path)
{
    DIR *ret;
    char *newpath = NULL;

    init_syms();

1032
    if (STRPREFIX(path, SYSFS_PCI_PREFIX) &&
1033 1034 1035
        getrealpath(&newpath, path) < 0)
        return NULL;

1036
    ret = real_opendir(newpath ? newpath : path);
1037 1038 1039 1040 1041

    VIR_FREE(newpath);
    return ret;
}

1042 1043 1044 1045 1046
int
close(int fd)
{
    if (remove_fd(fd) < 0)
        return -1;
1047
    return real_close(fd);
1048
}
M
Michal Privoznik 已提交
1049 1050 1051
#else
/* Nothing to override on non-__linux__ platforms */
#endif