mirror of
https://github.com/torvalds/linux.git
synced 2024-12-05 02:23:16 +00:00
fc7a6209d5
The driver core ignores the return value of this callback because there is only little it can do when a device disappears. This is the final bit of a long lasting cleanup quest where several buses were converted to also return void from their remove callback. Additionally some resource leaks were fixed that were caused by drivers returning an error code in the expectation that the driver won't go away. With struct bus_type::remove returning void it's prevented that newly implemented buses return an ignored error code and so don't anticipate wrong expectations for driver authors. Reviewed-by: Tom Rix <trix@redhat.com> (For fpga) Reviewed-by: Mathieu Poirier <mathieu.poirier@linaro.org> Reviewed-by: Cornelia Huck <cohuck@redhat.com> (For drivers/s390 and drivers/vfio) Acked-by: Russell King (Oracle) <rmk+kernel@armlinux.org.uk> (For ARM, Amba and related parts) Acked-by: Mark Brown <broonie@kernel.org> Acked-by: Chen-Yu Tsai <wens@csie.org> (for sunxi-rsb) Acked-by: Pali Rohár <pali@kernel.org> Acked-by: Mauro Carvalho Chehab <mchehab@kernel.org> (for media) Acked-by: Hans de Goede <hdegoede@redhat.com> (For drivers/platform) Acked-by: Alexandre Belloni <alexandre.belloni@bootlin.com> Acked-By: Vinod Koul <vkoul@kernel.org> Acked-by: Juergen Gross <jgross@suse.com> (For xen) Acked-by: Lee Jones <lee.jones@linaro.org> (For mfd) Acked-by: Johannes Thumshirn <jth@kernel.org> (For mcb) Acked-by: Johan Hovold <johan@kernel.org> Acked-by: Srinivas Kandagatla <srinivas.kandagatla@linaro.org> (For slimbus) Acked-by: Kirti Wankhede <kwankhede@nvidia.com> (For vfio) Acked-by: Maximilian Luz <luzmaximilian@gmail.com> Acked-by: Heikki Krogerus <heikki.krogerus@linux.intel.com> (For ulpi and typec) Acked-by: Samuel Iglesias Gonsálvez <siglesias@igalia.com> (For ipack) Acked-by: Geoff Levand <geoff@infradead.org> (For ps3) Acked-by: Yehezkel Bernat <YehezkelShB@gmail.com> (For thunderbolt) Acked-by: Alexander Shishkin <alexander.shishkin@linux.intel.com> (For intel_th) Acked-by: Dominik Brodowski <linux@dominikbrodowski.net> (For pcmcia) Acked-by: Rafael J. Wysocki <rafael@kernel.org> (For ACPI) Acked-by: Bjorn Andersson <bjorn.andersson@linaro.org> (rpmsg and apr) Acked-by: Srinivas Pandruvada <srinivas.pandruvada@linux.intel.com> (For intel-ish-hid) Acked-by: Dan Williams <dan.j.williams@intel.com> (For CXL, DAX, and NVDIMM) Acked-by: William Breathitt Gray <vilhelm.gray@gmail.com> (For isa) Acked-by: Stefan Richter <stefanr@s5r6.in-berlin.de> (For firewire) Acked-by: Benjamin Tissoires <benjamin.tissoires@redhat.com> (For hid) Acked-by: Thorsten Scherer <t.scherer@eckelmann.de> (For siox) Acked-by: Sven Van Asbroeck <TheSven73@gmail.com> (For anybuss) Acked-by: Ulf Hansson <ulf.hansson@linaro.org> (For MMC) Acked-by: Wolfram Sang <wsa@kernel.org> # for I2C Acked-by: Sudeep Holla <sudeep.holla@arm.com> Acked-by: Geert Uytterhoeven <geert@linux-m68k.org> Acked-by: Dmitry Torokhov <dmitry.torokhov@gmail.com> Acked-by: Finn Thain <fthain@linux-m68k.org> Signed-off-by: Uwe Kleine-König <u.kleine-koenig@pengutronix.de> Link: https://lore.kernel.org/r/20210713193522.1770306-6-u.kleine-koenig@pengutronix.de Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
316 lines
6.4 KiB
C
316 lines
6.4 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/*
|
|
* driver.c - device id matching, driver model, etc.
|
|
*
|
|
* Copyright 2002 Adam Belay <ambx1@neo.rr.com>
|
|
*/
|
|
|
|
#include <linux/string.h>
|
|
#include <linux/list.h>
|
|
#include <linux/module.h>
|
|
#include <linux/ctype.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/pnp.h>
|
|
#include "base.h"
|
|
|
|
static int compare_func(const char *ida, const char *idb)
|
|
{
|
|
int i;
|
|
|
|
/* we only need to compare the last 4 chars */
|
|
for (i = 3; i < 7; i++) {
|
|
if (ida[i] != 'X' &&
|
|
idb[i] != 'X' && toupper(ida[i]) != toupper(idb[i]))
|
|
return 0;
|
|
}
|
|
return 1;
|
|
}
|
|
|
|
int compare_pnp_id(struct pnp_id *pos, const char *id)
|
|
{
|
|
if (!pos || !id || (strlen(id) != 7))
|
|
return 0;
|
|
if (memcmp(id, "ANYDEVS", 7) == 0)
|
|
return 1;
|
|
while (pos) {
|
|
if (memcmp(pos->id, id, 3) == 0)
|
|
if (compare_func(pos->id, id) == 1)
|
|
return 1;
|
|
pos = pos->next;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static const struct pnp_device_id *match_device(struct pnp_driver *drv,
|
|
struct pnp_dev *dev)
|
|
{
|
|
const struct pnp_device_id *drv_id = drv->id_table;
|
|
|
|
if (!drv_id)
|
|
return NULL;
|
|
|
|
while (*drv_id->id) {
|
|
if (compare_pnp_id(dev->id, drv_id->id))
|
|
return drv_id;
|
|
drv_id++;
|
|
}
|
|
return NULL;
|
|
}
|
|
|
|
int pnp_device_attach(struct pnp_dev *pnp_dev)
|
|
{
|
|
mutex_lock(&pnp_lock);
|
|
if (pnp_dev->status != PNP_READY) {
|
|
mutex_unlock(&pnp_lock);
|
|
return -EBUSY;
|
|
}
|
|
pnp_dev->status = PNP_ATTACHED;
|
|
mutex_unlock(&pnp_lock);
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL(pnp_device_attach);
|
|
|
|
void pnp_device_detach(struct pnp_dev *pnp_dev)
|
|
{
|
|
mutex_lock(&pnp_lock);
|
|
if (pnp_dev->status == PNP_ATTACHED)
|
|
pnp_dev->status = PNP_READY;
|
|
mutex_unlock(&pnp_lock);
|
|
}
|
|
EXPORT_SYMBOL(pnp_device_detach);
|
|
|
|
static int pnp_device_probe(struct device *dev)
|
|
{
|
|
int error;
|
|
struct pnp_driver *pnp_drv;
|
|
struct pnp_dev *pnp_dev;
|
|
const struct pnp_device_id *dev_id = NULL;
|
|
pnp_dev = to_pnp_dev(dev);
|
|
pnp_drv = to_pnp_driver(dev->driver);
|
|
|
|
error = pnp_device_attach(pnp_dev);
|
|
if (error < 0)
|
|
return error;
|
|
|
|
if (pnp_dev->active == 0) {
|
|
if (!(pnp_drv->flags & PNP_DRIVER_RES_DO_NOT_CHANGE)) {
|
|
error = pnp_activate_dev(pnp_dev);
|
|
if (error < 0)
|
|
return error;
|
|
}
|
|
} else if ((pnp_drv->flags & PNP_DRIVER_RES_DISABLE)
|
|
== PNP_DRIVER_RES_DISABLE) {
|
|
error = pnp_disable_dev(pnp_dev);
|
|
if (error < 0)
|
|
return error;
|
|
}
|
|
error = 0;
|
|
if (pnp_drv->probe) {
|
|
dev_id = match_device(pnp_drv, pnp_dev);
|
|
if (dev_id != NULL)
|
|
error = pnp_drv->probe(pnp_dev, dev_id);
|
|
}
|
|
if (error >= 0) {
|
|
pnp_dev->driver = pnp_drv;
|
|
error = 0;
|
|
} else
|
|
goto fail;
|
|
|
|
return error;
|
|
|
|
fail:
|
|
pnp_device_detach(pnp_dev);
|
|
return error;
|
|
}
|
|
|
|
static void pnp_device_remove(struct device *dev)
|
|
{
|
|
struct pnp_dev *pnp_dev = to_pnp_dev(dev);
|
|
struct pnp_driver *drv = pnp_dev->driver;
|
|
|
|
if (drv) {
|
|
if (drv->remove)
|
|
drv->remove(pnp_dev);
|
|
pnp_dev->driver = NULL;
|
|
}
|
|
|
|
if (pnp_dev->active &&
|
|
(!drv || !(drv->flags & PNP_DRIVER_RES_DO_NOT_CHANGE)))
|
|
pnp_disable_dev(pnp_dev);
|
|
|
|
pnp_device_detach(pnp_dev);
|
|
}
|
|
|
|
static void pnp_device_shutdown(struct device *dev)
|
|
{
|
|
struct pnp_dev *pnp_dev = to_pnp_dev(dev);
|
|
struct pnp_driver *drv = pnp_dev->driver;
|
|
|
|
if (drv && drv->shutdown)
|
|
drv->shutdown(pnp_dev);
|
|
}
|
|
|
|
static int pnp_bus_match(struct device *dev, struct device_driver *drv)
|
|
{
|
|
struct pnp_dev *pnp_dev = to_pnp_dev(dev);
|
|
struct pnp_driver *pnp_drv = to_pnp_driver(drv);
|
|
|
|
if (match_device(pnp_drv, pnp_dev) == NULL)
|
|
return 0;
|
|
return 1;
|
|
}
|
|
|
|
static int __pnp_bus_suspend(struct device *dev, pm_message_t state)
|
|
{
|
|
struct pnp_dev *pnp_dev = to_pnp_dev(dev);
|
|
struct pnp_driver *pnp_drv = pnp_dev->driver;
|
|
int error;
|
|
|
|
if (!pnp_drv)
|
|
return 0;
|
|
|
|
if (pnp_drv->driver.pm && pnp_drv->driver.pm->suspend) {
|
|
error = pnp_drv->driver.pm->suspend(dev);
|
|
suspend_report_result(pnp_drv->driver.pm->suspend, error);
|
|
if (error)
|
|
return error;
|
|
}
|
|
|
|
if (pnp_drv->suspend) {
|
|
error = pnp_drv->suspend(pnp_dev, state);
|
|
if (error)
|
|
return error;
|
|
}
|
|
|
|
if (pnp_can_disable(pnp_dev)) {
|
|
error = pnp_stop_dev(pnp_dev);
|
|
if (error)
|
|
return error;
|
|
}
|
|
|
|
if (pnp_can_suspend(pnp_dev))
|
|
pnp_dev->protocol->suspend(pnp_dev, state);
|
|
return 0;
|
|
}
|
|
|
|
static int pnp_bus_suspend(struct device *dev)
|
|
{
|
|
return __pnp_bus_suspend(dev, PMSG_SUSPEND);
|
|
}
|
|
|
|
static int pnp_bus_freeze(struct device *dev)
|
|
{
|
|
return __pnp_bus_suspend(dev, PMSG_FREEZE);
|
|
}
|
|
|
|
static int pnp_bus_poweroff(struct device *dev)
|
|
{
|
|
return __pnp_bus_suspend(dev, PMSG_HIBERNATE);
|
|
}
|
|
|
|
static int pnp_bus_resume(struct device *dev)
|
|
{
|
|
struct pnp_dev *pnp_dev = to_pnp_dev(dev);
|
|
struct pnp_driver *pnp_drv = pnp_dev->driver;
|
|
int error;
|
|
|
|
if (!pnp_drv)
|
|
return 0;
|
|
|
|
if (pnp_dev->protocol->resume) {
|
|
error = pnp_dev->protocol->resume(pnp_dev);
|
|
if (error)
|
|
return error;
|
|
}
|
|
|
|
if (pnp_can_write(pnp_dev)) {
|
|
error = pnp_start_dev(pnp_dev);
|
|
if (error)
|
|
return error;
|
|
}
|
|
|
|
if (pnp_drv->driver.pm && pnp_drv->driver.pm->resume) {
|
|
error = pnp_drv->driver.pm->resume(dev);
|
|
if (error)
|
|
return error;
|
|
}
|
|
|
|
if (pnp_drv->resume) {
|
|
error = pnp_drv->resume(pnp_dev);
|
|
if (error)
|
|
return error;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct dev_pm_ops pnp_bus_dev_pm_ops = {
|
|
/* Suspend callbacks */
|
|
.suspend = pnp_bus_suspend,
|
|
.resume = pnp_bus_resume,
|
|
/* Hibernate callbacks */
|
|
.freeze = pnp_bus_freeze,
|
|
.thaw = pnp_bus_resume,
|
|
.poweroff = pnp_bus_poweroff,
|
|
.restore = pnp_bus_resume,
|
|
};
|
|
|
|
struct bus_type pnp_bus_type = {
|
|
.name = "pnp",
|
|
.match = pnp_bus_match,
|
|
.probe = pnp_device_probe,
|
|
.remove = pnp_device_remove,
|
|
.shutdown = pnp_device_shutdown,
|
|
.pm = &pnp_bus_dev_pm_ops,
|
|
.dev_groups = pnp_dev_groups,
|
|
};
|
|
|
|
int pnp_register_driver(struct pnp_driver *drv)
|
|
{
|
|
drv->driver.name = drv->name;
|
|
drv->driver.bus = &pnp_bus_type;
|
|
|
|
return driver_register(&drv->driver);
|
|
}
|
|
EXPORT_SYMBOL(pnp_register_driver);
|
|
|
|
void pnp_unregister_driver(struct pnp_driver *drv)
|
|
{
|
|
driver_unregister(&drv->driver);
|
|
}
|
|
EXPORT_SYMBOL(pnp_unregister_driver);
|
|
|
|
/**
|
|
* pnp_add_id - adds an EISA id to the specified device
|
|
* @dev: pointer to the desired device
|
|
* @id: pointer to an EISA id string
|
|
*/
|
|
struct pnp_id *pnp_add_id(struct pnp_dev *dev, const char *id)
|
|
{
|
|
struct pnp_id *dev_id, *ptr;
|
|
|
|
dev_id = kzalloc(sizeof(struct pnp_id), GFP_KERNEL);
|
|
if (!dev_id)
|
|
return NULL;
|
|
|
|
dev_id->id[0] = id[0];
|
|
dev_id->id[1] = id[1];
|
|
dev_id->id[2] = id[2];
|
|
dev_id->id[3] = tolower(id[3]);
|
|
dev_id->id[4] = tolower(id[4]);
|
|
dev_id->id[5] = tolower(id[5]);
|
|
dev_id->id[6] = tolower(id[6]);
|
|
dev_id->id[7] = '\0';
|
|
|
|
dev_id->next = NULL;
|
|
ptr = dev->id;
|
|
while (ptr && ptr->next)
|
|
ptr = ptr->next;
|
|
if (ptr)
|
|
ptr->next = dev_id;
|
|
else
|
|
dev->id = dev_id;
|
|
|
|
return dev_id;
|
|
}
|