diff options
Diffstat (limited to 'drivers/pnp/resource.c')
-rw-r--r-- | drivers/pnp/resource.c | 542 |
1 files changed, 542 insertions, 0 deletions
diff --git a/drivers/pnp/resource.c b/drivers/pnp/resource.c new file mode 100644 index 00000000000..2d1322dd7e1 --- /dev/null +++ b/drivers/pnp/resource.c @@ -0,0 +1,542 @@ +/* + * resource.c - Contains functions for registering and analyzing resource information + * + * based on isapnp.c resource management (c) Jaroslav Kysela <perex@suse.cz> + * Copyright 2003 Adam Belay <ambx1@neo.rr.com> + * + */ + +#include <linux/config.h> +#include <linux/module.h> +#include <linux/errno.h> +#include <linux/interrupt.h> +#include <linux/kernel.h> +#include <asm/io.h> +#include <asm/dma.h> +#include <asm/irq.h> +#include <linux/pci.h> +#include <linux/ioport.h> +#include <linux/init.h> + +#include <linux/pnp.h> +#include "base.h" + +static int pnp_reserve_irq[16] = { [0 ... 15] = -1 }; /* reserve (don't use) some IRQ */ +static int pnp_reserve_dma[8] = { [0 ... 7] = -1 }; /* reserve (don't use) some DMA */ +static int pnp_reserve_io[16] = { [0 ... 15] = -1 }; /* reserve (don't use) some I/O region */ +static int pnp_reserve_mem[16] = { [0 ... 15] = -1 }; /* reserve (don't use) some memory region */ + + +/* + * option registration + */ + +static struct pnp_option * pnp_build_option(int priority) +{ + struct pnp_option *option = pnp_alloc(sizeof(struct pnp_option)); + + /* check if pnp_alloc ran out of memory */ + if (!option) + return NULL; + + option->priority = priority & 0xff; + /* make sure the priority is valid */ + if (option->priority > PNP_RES_PRIORITY_FUNCTIONAL) + option->priority = PNP_RES_PRIORITY_INVALID; + + return option; +} + +struct pnp_option * pnp_register_independent_option(struct pnp_dev *dev) +{ + struct pnp_option *option; + if (!dev) + return NULL; + + option = pnp_build_option(PNP_RES_PRIORITY_PREFERRED); + + /* this should never happen but if it does we'll try to continue */ + if (dev->independent) + pnp_err("independent resource already registered"); + dev->independent = option; + return option; +} + +struct pnp_option * pnp_register_dependent_option(struct pnp_dev *dev, int priority) +{ + struct pnp_option *option; + if (!dev) + return NULL; + + option = pnp_build_option(priority); + + if (dev->dependent) { + struct pnp_option *parent = dev->dependent; + while (parent->next) + parent = parent->next; + parent->next = option; + } else + dev->dependent = option; + return option; +} + +int pnp_register_irq_resource(struct pnp_option *option, struct pnp_irq *data) +{ + struct pnp_irq *ptr; + if (!option) + return -EINVAL; + if (!data) + return -EINVAL; + + ptr = option->irq; + while (ptr && ptr->next) + ptr = ptr->next; + if (ptr) + ptr->next = data; + else + option->irq = data; + +#ifdef CONFIG_PCI + { + int i; + + for (i = 0; i < 16; i++) + if (test_bit(i, data->map)) + pcibios_penalize_isa_irq(i); + } +#endif + return 0; +} + +int pnp_register_dma_resource(struct pnp_option *option, struct pnp_dma *data) +{ + struct pnp_dma *ptr; + if (!option) + return -EINVAL; + if (!data) + return -EINVAL; + + ptr = option->dma; + while (ptr && ptr->next) + ptr = ptr->next; + if (ptr) + ptr->next = data; + else + option->dma = data; + + return 0; +} + +int pnp_register_port_resource(struct pnp_option *option, struct pnp_port *data) +{ + struct pnp_port *ptr; + if (!option) + return -EINVAL; + if (!data) + return -EINVAL; + + ptr = option->port; + while (ptr && ptr->next) + ptr = ptr->next; + if (ptr) + ptr->next = data; + else + option->port = data; + + return 0; +} + +int pnp_register_mem_resource(struct pnp_option *option, struct pnp_mem *data) +{ + struct pnp_mem *ptr; + if (!option) + return -EINVAL; + if (!data) + return -EINVAL; + + ptr = option->mem; + while (ptr && ptr->next) + ptr = ptr->next; + if (ptr) + ptr->next = data; + else + option->mem = data; + return 0; +} + +static void pnp_free_port(struct pnp_port *port) +{ + struct pnp_port *next; + + while (port) { + next = port->next; + kfree(port); + port = next; + } +} + +static void pnp_free_irq(struct pnp_irq *irq) +{ + struct pnp_irq *next; + + while (irq) { + next = irq->next; + kfree(irq); + irq = next; + } +} + +static void pnp_free_dma(struct pnp_dma *dma) +{ + struct pnp_dma *next; + + while (dma) { + next = dma->next; + kfree(dma); + dma = next; + } +} + +static void pnp_free_mem(struct pnp_mem *mem) +{ + struct pnp_mem *next; + + while (mem) { + next = mem->next; + kfree(mem); + mem = next; + } +} + +void pnp_free_option(struct pnp_option *option) +{ + struct pnp_option *next; + + while (option) { + next = option->next; + pnp_free_port(option->port); + pnp_free_irq(option->irq); + pnp_free_dma(option->dma); + pnp_free_mem(option->mem); + kfree(option); + option = next; + } +} + + +/* + * resource validity checking + */ + +#define length(start, end) (*(end) - *(start) + 1) + +/* Two ranges conflict if one doesn't end before the other starts */ +#define ranged_conflict(starta, enda, startb, endb) \ + !((*(enda) < *(startb)) || (*(endb) < *(starta))) + +#define cannot_compare(flags) \ +((flags) & (IORESOURCE_UNSET | IORESOURCE_DISABLED)) + +int pnp_check_port(struct pnp_dev * dev, int idx) +{ + int tmp; + struct pnp_dev *tdev; + unsigned long *port, *end, *tport, *tend; + port = &dev->res.port_resource[idx].start; + end = &dev->res.port_resource[idx].end; + + /* if the resource doesn't exist, don't complain about it */ + if (cannot_compare(dev->res.port_resource[idx].flags)) + return 1; + + /* check if the resource is already in use, skip if the + * device is active because it itself may be in use */ + if(!dev->active) { + if (__check_region(&ioport_resource, *port, length(port,end))) + return 0; + } + + /* check if the resource is reserved */ + for (tmp = 0; tmp < 8; tmp++) { + int rport = pnp_reserve_io[tmp << 1]; + int rend = pnp_reserve_io[(tmp << 1) + 1] + rport - 1; + if (ranged_conflict(port,end,&rport,&rend)) + return 0; + } + + /* check for internal conflicts */ + for (tmp = 0; tmp < PNP_MAX_PORT && tmp != idx; tmp++) { + if (dev->res.port_resource[tmp].flags & IORESOURCE_IO) { + tport = &dev->res.port_resource[tmp].start; + tend = &dev->res.port_resource[tmp].end; + if (ranged_conflict(port,end,tport,tend)) + return 0; + } + } + + /* check for conflicts with other pnp devices */ + pnp_for_each_dev(tdev) { + if (tdev == dev) + continue; + for (tmp = 0; tmp < PNP_MAX_PORT; tmp++) { + if (tdev->res.port_resource[tmp].flags & IORESOURCE_IO) { + if (cannot_compare(tdev->res.port_resource[tmp].flags)) + continue; + tport = &tdev->res.port_resource[tmp].start; + tend = &tdev->res.port_resource[tmp].end; + if (ranged_conflict(port,end,tport,tend)) + return 0; + } + } + } + + return 1; +} + +int pnp_check_mem(struct pnp_dev * dev, int idx) +{ + int tmp; + struct pnp_dev *tdev; + unsigned long *addr, *end, *taddr, *tend; + addr = &dev->res.mem_resource[idx].start; + end = &dev->res.mem_resource[idx].end; + + /* if the resource doesn't exist, don't complain about it */ + if (cannot_compare(dev->res.mem_resource[idx].flags)) + return 1; + + /* check if the resource is already in use, skip if the + * device is active because it itself may be in use */ + if(!dev->active) { + if (check_mem_region(*addr, length(addr,end))) + return 0; + } + + /* check if the resource is reserved */ + for (tmp = 0; tmp < 8; tmp++) { + int raddr = pnp_reserve_mem[tmp << 1]; + int rend = pnp_reserve_mem[(tmp << 1) + 1] + raddr - 1; + if (ranged_conflict(addr,end,&raddr,&rend)) + return 0; + } + + /* check for internal conflicts */ + for (tmp = 0; tmp < PNP_MAX_MEM && tmp != idx; tmp++) { + if (dev->res.mem_resource[tmp].flags & IORESOURCE_MEM) { + taddr = &dev->res.mem_resource[tmp].start; + tend = &dev->res.mem_resource[tmp].end; + if (ranged_conflict(addr,end,taddr,tend)) + return 0; + } + } + + /* check for conflicts with other pnp devices */ + pnp_for_each_dev(tdev) { + if (tdev == dev) + continue; + for (tmp = 0; tmp < PNP_MAX_MEM; tmp++) { + if (tdev->res.mem_resource[tmp].flags & IORESOURCE_MEM) { + if (cannot_compare(tdev->res.mem_resource[tmp].flags)) + continue; + taddr = &tdev->res.mem_resource[tmp].start; + tend = &tdev->res.mem_resource[tmp].end; + if (ranged_conflict(addr,end,taddr,tend)) + return 0; + } + } + } + + return 1; +} + +static irqreturn_t pnp_test_handler(int irq, void *dev_id, struct pt_regs *regs) +{ + return IRQ_HANDLED; +} + +int pnp_check_irq(struct pnp_dev * dev, int idx) +{ + int tmp; + struct pnp_dev *tdev; + unsigned long * irq = &dev->res.irq_resource[idx].start; + + /* if the resource doesn't exist, don't complain about it */ + if (cannot_compare(dev->res.irq_resource[idx].flags)) + return 1; + + /* check if the resource is valid */ + if (*irq < 0 || *irq > 15) + return 0; + + /* check if the resource is reserved */ + for (tmp = 0; tmp < 16; tmp++) { + if (pnp_reserve_irq[tmp] == *irq) + return 0; + } + + /* check for internal conflicts */ + for (tmp = 0; tmp < PNP_MAX_IRQ && tmp != idx; tmp++) { + if (dev->res.irq_resource[tmp].flags & IORESOURCE_IRQ) { + if (dev->res.irq_resource[tmp].start == *irq) + return 0; + } + } + +#ifdef CONFIG_PCI + /* check if the resource is being used by a pci device */ + { + struct pci_dev *pci = NULL; + for_each_pci_dev(pci) { + if (pci->irq == *irq) + return 0; + } + } +#endif + + /* check if the resource is already in use, skip if the + * device is active because it itself may be in use */ + if(!dev->active) { + if (request_irq(*irq, pnp_test_handler, SA_INTERRUPT, "pnp", NULL)) + return 0; + free_irq(*irq, NULL); + } + + /* check for conflicts with other pnp devices */ + pnp_for_each_dev(tdev) { + if (tdev == dev) + continue; + for (tmp = 0; tmp < PNP_MAX_IRQ; tmp++) { + if (tdev->res.irq_resource[tmp].flags & IORESOURCE_IRQ) { + if (cannot_compare(tdev->res.irq_resource[tmp].flags)) + continue; + if ((tdev->res.irq_resource[tmp].start == *irq)) + return 0; + } + } + } + + return 1; +} + +int pnp_check_dma(struct pnp_dev * dev, int idx) +{ +#ifndef CONFIG_IA64 + int tmp; + struct pnp_dev *tdev; + unsigned long * dma = &dev->res.dma_resource[idx].start; + + /* if the resource doesn't exist, don't complain about it */ + if (cannot_compare(dev->res.dma_resource[idx].flags)) + return 1; + + /* check if the resource is valid */ + if (*dma < 0 || *dma == 4 || *dma > 7) + return 0; + + /* check if the resource is reserved */ + for (tmp = 0; tmp < 8; tmp++) { + if (pnp_reserve_dma[tmp] == *dma) + return 0; + } + + /* check for internal conflicts */ + for (tmp = 0; tmp < PNP_MAX_DMA && tmp != idx; tmp++) { + if (dev->res.dma_resource[tmp].flags & IORESOURCE_DMA) { + if (dev->res.dma_resource[tmp].start == *dma) + return 0; + } + } + + /* check if the resource is already in use, skip if the + * device is active because it itself may be in use */ + if(!dev->active) { + if (request_dma(*dma, "pnp")) + return 0; + free_dma(*dma); + } + + /* check for conflicts with other pnp devices */ + pnp_for_each_dev(tdev) { + if (tdev == dev) + continue; + for (tmp = 0; tmp < PNP_MAX_DMA; tmp++) { + if (tdev->res.dma_resource[tmp].flags & IORESOURCE_DMA) { + if (cannot_compare(tdev->res.dma_resource[tmp].flags)) + continue; + if ((tdev->res.dma_resource[tmp].start == *dma)) + return 0; + } + } + } + + return 1; +#else + /* IA64 hasn't legacy DMA */ + return 0; +#endif +} + + +EXPORT_SYMBOL(pnp_register_dependent_option); +EXPORT_SYMBOL(pnp_register_independent_option); +EXPORT_SYMBOL(pnp_register_irq_resource); +EXPORT_SYMBOL(pnp_register_dma_resource); +EXPORT_SYMBOL(pnp_register_port_resource); +EXPORT_SYMBOL(pnp_register_mem_resource); + + +/* format is: pnp_reserve_irq=irq1[,irq2] .... */ + +static int __init pnp_setup_reserve_irq(char *str) +{ + int i; + + for (i = 0; i < 16; i++) + if (get_option(&str,&pnp_reserve_irq[i]) != 2) + break; + return 1; +} + +__setup("pnp_reserve_irq=", pnp_setup_reserve_irq); + +/* format is: pnp_reserve_dma=dma1[,dma2] .... */ + +static int __init pnp_setup_reserve_dma(char *str) +{ + int i; + + for (i = 0; i < 8; i++) + if (get_option(&str,&pnp_reserve_dma[i]) != 2) + break; + return 1; +} + +__setup("pnp_reserve_dma=", pnp_setup_reserve_dma); + +/* format is: pnp_reserve_io=io1,size1[,io2,size2] .... */ + +static int __init pnp_setup_reserve_io(char *str) +{ + int i; + + for (i = 0; i < 16; i++) + if (get_option(&str,&pnp_reserve_io[i]) != 2) + break; + return 1; +} + +__setup("pnp_reserve_io=", pnp_setup_reserve_io); + +/* format is: pnp_reserve_mem=mem1,size1[,mem2,size2] .... */ + +static int __init pnp_setup_reserve_mem(char *str) +{ + int i; + + for (i = 0; i < 16; i++) + if (get_option(&str,&pnp_reserve_mem[i]) != 2) + break; + return 1; +} + +__setup("pnp_reserve_mem=", pnp_setup_reserve_mem); |