linux-imx

// SPDX-License-Identifier: GPL-2.0

/*

 * (C) Copyright 2002-2004, 2007 Greg Kroah-Hartman <greg@kroah.com>

 * (C) Copyright 2007 Novell Inc.

 */

​

#include <linux/pci.h>

#include <linux/module.h>

#include <linux/init.h>

#include <linux/device.h>

#include <linux/mempolicy.h>

#include <linux/string.h>

#include <linux/slab.h>

#include <linux/sched.h>

#include <linux/cpu.h>

#include <linux/pm_runtime.h>

#include <linux/suspend.h>

#include <linux/kexec.h>

#include <linux/of_device.h>

#include <linux/acpi.h>

#include "pci.h"

#include "pcie/portdrv.h"

​

struct pci_dynid {

    struct list_head node;

    struct pci_device_id id;

};

​

/**

 * pci_add_dynid - add a new PCI device ID to this driver and re-probe devices

 * @drv: target pci driver

 * @vendor: PCI vendor ID

 * @device: PCI device ID

 * @subvendor: PCI subvendor ID

 * @subdevice: PCI subdevice ID

 * @class: PCI class

 * @class_mask: PCI class mask

 * @driver_data: private driver data

 *

 * Adds a new dynamic pci device ID to this driver and causes the

 * driver to probe for all devices again.  @drv must have been

 * registered prior to calling this function.

 *

 * CONTEXT:

 * Does GFP_KERNEL allocation.

 *

 * RETURNS:

 * 0 on success, -errno on failure.

 */

int pci_add_dynid(struct pci_driver *drv,

          unsigned int vendor, unsigned int device,

          unsigned int subvendor, unsigned int subdevice,

          unsigned int class, unsigned int class_mask,

          unsigned long driver_data)

{

    struct pci_dynid *dynid;

​

    dynid = kzalloc(sizeof(*dynid), GFP_KERNEL);

    if (!dynid)

        return -ENOMEM;

​

    dynid->id.vendor = vendor;

    dynid->id.device = device;

    dynid->id.subvendor = subvendor;

    dynid->id.subdevice = subdevice;

    dynid->id.class = class;

    dynid->id.class_mask = class_mask;

    dynid->id.driver_data = driver_data;

​

    spin_lock(&drv->dynids.lock);

    list_add_tail(&dynid->node, &drv->dynids.list);

    spin_unlock(&drv->dynids.lock);

​

    return driver_attach(&drv->driver);

}

EXPORT_SYMBOL_GPL(pci_add_dynid);

​

static void pci_free_dynids(struct pci_driver *drv)

{

    struct pci_dynid *dynid, *n;

​

    spin_lock(&drv->dynids.lock);

    list_for_each_entry_safe(dynid, n, &drv->dynids.list, node) {

        list_del(&dynid->node);

        kfree(dynid);

    }

    spin_unlock(&drv->dynids.lock);

}

​

/**

 * store_new_id - sysfs frontend to pci_add_dynid()

 * @driver: target device driver