From 1da177e4c3f41524e886b7f1b8a0c1fc7321cac2 Mon Sep 17 00:00:00 2001 From: Linus Torvalds Date: Sat, 16 Apr 2005 15:20:36 -0700 Subject: Linux-2.6.12-rc2 Initial git repository build. I'm not bothering with the full history, even though we have it. We can create a separate "historical" git archive of that later if we want to, and in the meantime it's about 3.2GB when imported into git - space that would just make the early git days unnecessarily complicated, when we don't have a lot of good infrastructure for it. Let it rip! --- drivers/pnp/core.c | 180 +++++++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 180 insertions(+) create mode 100644 drivers/pnp/core.c (limited to 'drivers/pnp/core.c') diff --git a/drivers/pnp/core.c b/drivers/pnp/core.c new file mode 100644 index 000000000000..deed92459bc5 --- /dev/null +++ b/drivers/pnp/core.c @@ -0,0 +1,180 @@ +/* + * core.c - contains all core device and protocol registration functions + * + * Copyright 2002 Adam Belay + * + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "base.h" + + +static LIST_HEAD(pnp_protocols); +LIST_HEAD(pnp_global); +DEFINE_SPINLOCK(pnp_lock); + +void *pnp_alloc(long size) +{ + void *result; + + result = kmalloc(size, GFP_KERNEL); + if (!result){ + printk(KERN_ERR "pnp: Out of Memory\n"); + return NULL; + } + memset(result, 0, size); + return result; +} + +/** + * pnp_protocol_register - adds a pnp protocol to the pnp layer + * @protocol: pointer to the corresponding pnp_protocol structure + * + * Ex protocols: ISAPNP, PNPBIOS, etc + */ + +int pnp_register_protocol(struct pnp_protocol *protocol) +{ + int nodenum; + struct list_head * pos; + + if (!protocol) + return -EINVAL; + + INIT_LIST_HEAD(&protocol->devices); + INIT_LIST_HEAD(&protocol->cards); + nodenum = 0; + spin_lock(&pnp_lock); + + /* assign the lowest unused number */ + list_for_each(pos,&pnp_protocols) { + struct pnp_protocol * cur = to_pnp_protocol(pos); + if (cur->number == nodenum){ + pos = &pnp_protocols; + nodenum++; + } + } + + list_add_tail(&protocol->protocol_list, &pnp_protocols); + spin_unlock(&pnp_lock); + + protocol->number = nodenum; + sprintf(protocol->dev.bus_id, "pnp%d", nodenum); + return device_register(&protocol->dev); +} + +/** + * pnp_protocol_unregister - removes a pnp protocol from the pnp layer + * @protocol: pointer to the corresponding pnp_protocol structure + * + */ +void pnp_unregister_protocol(struct pnp_protocol *protocol) +{ + spin_lock(&pnp_lock); + list_del(&protocol->protocol_list); + spin_unlock(&pnp_lock); + device_unregister(&protocol->dev); +} + + +static void pnp_free_ids(struct pnp_dev *dev) +{ + struct pnp_id * id; + struct pnp_id * next; + if (!dev) + return; + id = dev->id; + while (id) { + next = id->next; + kfree(id); + id = next; + } +} + +static void pnp_release_device(struct device *dmdev) +{ + struct pnp_dev * dev = to_pnp_dev(dmdev); + pnp_free_option(dev->independent); + pnp_free_option(dev->dependent); + pnp_free_ids(dev); + kfree(dev); +} + +int __pnp_add_device(struct pnp_dev *dev) +{ + int ret; + pnp_fixup_device(dev); + dev->dev.bus = &pnp_bus_type; + dev->dev.release = &pnp_release_device; + dev->status = PNP_READY; + spin_lock(&pnp_lock); + list_add_tail(&dev->global_list, &pnp_global); + list_add_tail(&dev->protocol_list, &dev->protocol->devices); + spin_unlock(&pnp_lock); + + ret = device_register(&dev->dev); + if (ret == 0) + pnp_interface_attach_device(dev); + return ret; +} + +/* + * pnp_add_device - adds a pnp device to the pnp layer + * @dev: pointer to dev to add + * + * adds to driver model, name database, fixups, interface, etc. + */ + +int pnp_add_device(struct pnp_dev *dev) +{ + if (!dev || !dev->protocol || dev->card) + return -EINVAL; + dev->dev.parent = &dev->protocol->dev; + sprintf(dev->dev.bus_id, "%02x:%02x", dev->protocol->number, dev->number); + return __pnp_add_device(dev); +} + +void __pnp_remove_device(struct pnp_dev *dev) +{ + spin_lock(&pnp_lock); + list_del(&dev->global_list); + list_del(&dev->protocol_list); + spin_unlock(&pnp_lock); + device_unregister(&dev->dev); +} + +/** + * pnp_remove_device - removes a pnp device from the pnp layer + * @dev: pointer to dev to add + * + * this function will free all mem used by dev + */ + +void pnp_remove_device(struct pnp_dev *dev) +{ + if (!dev || dev->card) + return; + __pnp_remove_device(dev); +} + +static int __init pnp_init(void) +{ + printk(KERN_INFO "Linux Plug and Play Support v0.97 (c) Adam Belay\n"); + return bus_register(&pnp_bus_type); +} + +subsys_initcall(pnp_init); + +EXPORT_SYMBOL(pnp_register_protocol); +EXPORT_SYMBOL(pnp_unregister_protocol); +EXPORT_SYMBOL(pnp_add_device); +EXPORT_SYMBOL(pnp_remove_device); -- cgit v1.2.3