Commit 9624fb0e authored by Adam Belay's avatar Adam Belay

[PATCH] PnP cleanups and resource changes - 2.5.44 (1/4)

This patch fixes a number of things pointed out by Arne Thomassen.  Also it
makes a few changes to the resource checking functions in that they now check to
make sure that resources do not conflict within the same device instead of only
other devices.  Although it is rare for this to be a factor it's nice to be able
to deal with such situations properly.
parent 4485c0d7
...@@ -82,7 +82,6 @@ void pnp_protocol_unregister(struct pnp_protocol *protocol) ...@@ -82,7 +82,6 @@ void pnp_protocol_unregister(struct pnp_protocol *protocol)
list_del_init(&protocol->protocol_list); list_del_init(&protocol->protocol_list);
spin_unlock(&pnp_lock); spin_unlock(&pnp_lock);
device_unregister(&protocol->dev); device_unregister(&protocol->dev);
return;
} }
/** /**
...@@ -105,7 +104,6 @@ static void pnp_release_device(struct device *dmdev) ...@@ -105,7 +104,6 @@ static void pnp_release_device(struct device *dmdev)
pnp_free_resources(dev->res); pnp_free_resources(dev->res);
pnp_free_ids(dev); pnp_free_ids(dev);
kfree(dev); kfree(dev);
return;
} }
/** /**
...@@ -118,7 +116,7 @@ static void pnp_release_device(struct device *dmdev) ...@@ -118,7 +116,7 @@ static void pnp_release_device(struct device *dmdev)
int pnp_add_device(struct pnp_dev *dev) int pnp_add_device(struct pnp_dev *dev)
{ {
int error = 0; int error = 0;
if (!dev && !dev->protocol) if (!dev || !dev->protocol)
return -EINVAL; return -EINVAL;
if (dev->card) if (dev->card)
sprintf(dev->dev.bus_id, "%02x:%02x.%02x", dev->protocol->number, sprintf(dev->dev.bus_id, "%02x:%02x.%02x", dev->protocol->number,
...@@ -158,7 +156,6 @@ void pnp_remove_device(struct pnp_dev *dev) ...@@ -158,7 +156,6 @@ void pnp_remove_device(struct pnp_dev *dev)
list_del_init(&dev->global_list); list_del_init(&dev->global_list);
list_del_init(&dev->dev_list); list_del_init(&dev->dev_list);
spin_unlock(&pnp_lock); spin_unlock(&pnp_lock);
return;
} }
static int __init pnp_init(void) static int __init pnp_init(void)
......
...@@ -150,7 +150,7 @@ struct bus_type pnp_bus_type = { ...@@ -150,7 +150,7 @@ struct bus_type pnp_bus_type = {
int pnp_register_driver(struct pnp_driver *drv) int pnp_register_driver(struct pnp_driver *drv)
{ {
int count = 0; int count;
pnp_dbg("the driver '%s' has been registered", drv->name); pnp_dbg("the driver '%s' has been registered", drv->name);
drv->driver.name = drv->name; drv->driver.name = drv->name;
...@@ -194,7 +194,6 @@ void pnp_free_ids(struct pnp_dev *dev) ...@@ -194,7 +194,6 @@ void pnp_free_ids(struct pnp_dev *dev)
struct pnp_id *pnp_id = to_pnp_id(pos); struct pnp_id *pnp_id = to_pnp_id(pos);
kfree(pnp_id); kfree(pnp_id);
} }
return;
} }
EXPORT_SYMBOL(pnp_register_driver); EXPORT_SYMBOL(pnp_register_driver);
......
...@@ -23,7 +23,6 @@ static void pnp_convert_id(char *buf, unsigned short vendor, unsigned short devi ...@@ -23,7 +23,6 @@ static void pnp_convert_id(char *buf, unsigned short vendor, unsigned short devi
device & 0x0f, device & 0x0f,
(device >> 12) & 0x0f, (device >> 12) & 0x0f,
(device >> 8) & 0x0f); (device >> 8) & 0x0f);
return;
} }
struct pnp_card *pnp_find_card(unsigned short vendor, struct pnp_card *pnp_find_card(unsigned short vendor,
......
...@@ -37,7 +37,6 @@ pnp_name_device(struct pnp_dev *dev) ...@@ -37,7 +37,6 @@ pnp_name_device(struct pnp_dev *dev)
return; return;
} }
} }
return;
} }
#else #else
......
...@@ -164,6 +164,5 @@ void pnp_fixup_device(struct pnp_dev *dev) ...@@ -164,6 +164,5 @@ void pnp_fixup_device(struct pnp_dev *dev)
} }
i++; i++;
} }
return;
} }
...@@ -308,7 +308,7 @@ void pnp_free_resources(struct pnp_resources *resources) ...@@ -308,7 +308,7 @@ void pnp_free_resources(struct pnp_resources *resources)
/* resource validity checking functions */ /* resource validity checking functions */
static int pnp_check_port(int port, int size) static int pnp_check_port(int port, int size, int idx, struct pnp_cfg *config)
{ {
int i, tmp, rport, rsize; int i, tmp, rport, rsize;
struct pnp_dev *dev; struct pnp_dev *dev;
...@@ -338,10 +338,20 @@ static int pnp_check_port(int port, int size) ...@@ -338,10 +338,20 @@ static int pnp_check_port(int port, int size)
} }
} }
} }
for (tmp = 0; tmp < 8 && tmp != idx; tmp++) {
if (dev->resource[tmp].flags) {
rport = config->request.resource[tmp].start;
rsize = (config->request.resource[tmp].end - rport) + 1;
if (port >= rport && port < rport + rsize)
return 1;
if (port + size > rport && port + size < (rport + rsize) - 1)
return 1;
}
}
return 0; return 0;
} }
static int pnp_check_mem(unsigned int addr, unsigned int size) static int pnp_check_mem(unsigned int addr, unsigned int size, int idx, struct pnp_cfg *config)
{ {
int i, tmp; int i, tmp;
unsigned int raddr, rsize; unsigned int raddr, rsize;
...@@ -360,7 +370,7 @@ static int pnp_check_mem(unsigned int addr, unsigned int size) ...@@ -360,7 +370,7 @@ static int pnp_check_mem(unsigned int addr, unsigned int size)
pnp_for_each_dev(dev) { pnp_for_each_dev(dev) {
if (dev->active) { if (dev->active) {
for (tmp = 0; tmp < 4; tmp++) { for (tmp = 0; tmp < 4; tmp++) {
if (dev->resource[tmp].flags) { if (dev->resource[tmp + 8].flags) {
raddr = dev->resource[tmp + 8].start; raddr = dev->resource[tmp + 8].start;
rsize = (dev->resource[tmp + 8].end - raddr) + 1; rsize = (dev->resource[tmp + 8].end - raddr) + 1;
if (addr >= raddr && addr < raddr + rsize) if (addr >= raddr && addr < raddr + rsize)
...@@ -371,6 +381,16 @@ static int pnp_check_mem(unsigned int addr, unsigned int size) ...@@ -371,6 +381,16 @@ static int pnp_check_mem(unsigned int addr, unsigned int size)
} }
} }
} }
for (tmp = 0; tmp < 4 && tmp != idx; tmp++) {
if (dev->resource[tmp + 8].flags) {
raddr = config->request.resource[tmp + 8].start;
rsize = (config->request.resource[tmp + 8].end - raddr) + 1;
if (addr >= raddr && addr < raddr + rsize)
return 1;
if (addr + size > raddr && addr + size < (raddr + rsize) - 1)
return 1;
}
}
return 0; return 0;
} }
...@@ -453,10 +473,11 @@ static int pnp_check_dma(int dma, struct pnp_cfg *config) ...@@ -453,10 +473,11 @@ static int pnp_check_dma(int dma, struct pnp_cfg *config)
/* config generation functions */ /* config generation functions */
static int pnp_generate_port(struct pnp_cfg *config, int num) static int pnp_generate_port(struct pnp_cfg *config, int num)
{ {
struct pnp_port *port = config->port[num]; struct pnp_port *port;
unsigned long *value1, *value2, *value3; unsigned long *value1, *value2, *value3;
if (!config || num < 0 || num > 7) if (!config || num < 0 || num > 7)
return -EINVAL; return -EINVAL;
port = config->port[num];
if (!port) if (!port)
return 0; return 0;
value1 = &config->request.resource[num].start; value1 = &config->request.resource[num].start;
...@@ -465,7 +486,7 @@ static int pnp_generate_port(struct pnp_cfg *config, int num) ...@@ -465,7 +486,7 @@ static int pnp_generate_port(struct pnp_cfg *config, int num)
*value1 = port->min; *value1 = port->min;
*value2 = *value1 + port->size -1; *value2 = *value1 + port->size -1;
*value3 = port->flags | IORESOURCE_IO; *value3 = port->flags | IORESOURCE_IO;
while (pnp_check_port(*value1, port->size)) { while (pnp_check_port(*value1, port->size, num, config)) {
*value1 += port->align; *value1 += port->align;
*value2 = *value1 + port->size - 1; *value2 = *value1 + port->size - 1;
if (*value1 > port->max || !port->align) if (*value1 > port->max || !port->align)
...@@ -476,10 +497,11 @@ static int pnp_generate_port(struct pnp_cfg *config, int num) ...@@ -476,10 +497,11 @@ static int pnp_generate_port(struct pnp_cfg *config, int num)
static int pnp_generate_mem(struct pnp_cfg *config, int num) static int pnp_generate_mem(struct pnp_cfg *config, int num)
{ {
struct pnp_mem *mem = config->mem[num]; struct pnp_mem *mem;
unsigned long *value1, *value2, *value3; unsigned long *value1, *value2, *value3;
if (!config || num < 0 || num > 3) if (!config || num < 0 || num > 3)
return -EINVAL; return -EINVAL;
mem = config->mem[num];
if (!mem) if (!mem)
return 0; return 0;
value1 = &config->request.resource[num + 8].start; value1 = &config->request.resource[num + 8].start;
...@@ -496,7 +518,7 @@ static int pnp_generate_mem(struct pnp_cfg *config, int num) ...@@ -496,7 +518,7 @@ static int pnp_generate_mem(struct pnp_cfg *config, int num)
*value3 |= IORESOURCE_RANGELENGTH; *value3 |= IORESOURCE_RANGELENGTH;
if (mem->flags & IORESOURCE_MEM_SHADOWABLE) if (mem->flags & IORESOURCE_MEM_SHADOWABLE)
*value3 |= IORESOURCE_SHADOWABLE; *value3 |= IORESOURCE_SHADOWABLE;
while (pnp_check_mem(*value1, mem->size)) { while (pnp_check_mem(*value1, mem->size, num, config)) {
*value1 += mem->align; *value1 += mem->align;
*value2 = *value1 + mem->size - 1; *value2 = *value1 + mem->size - 1;
if (*value1 > mem->max || !mem->align) if (*value1 > mem->max || !mem->align)
...@@ -507,7 +529,7 @@ static int pnp_generate_mem(struct pnp_cfg *config, int num) ...@@ -507,7 +529,7 @@ static int pnp_generate_mem(struct pnp_cfg *config, int num)
static int pnp_generate_irq(struct pnp_cfg *config, int num) static int pnp_generate_irq(struct pnp_cfg *config, int num)
{ {
struct pnp_irq *irq = config->irq[num]; struct pnp_irq *irq;
unsigned long *value1, *value2, *value3; unsigned long *value1, *value2, *value3;
/* IRQ priority: this table is good for i386 */ /* IRQ priority: this table is good for i386 */
static unsigned short xtab[16] = { static unsigned short xtab[16] = {
...@@ -516,6 +538,7 @@ static int pnp_generate_irq(struct pnp_cfg *config, int num) ...@@ -516,6 +538,7 @@ static int pnp_generate_irq(struct pnp_cfg *config, int num)
int i; int i;
if (!config || num < 0 || num > 1) if (!config || num < 0 || num > 1)
return -EINVAL; return -EINVAL;
irq = config->irq[num];
if (!irq) if (!irq)
return 0; return 0;
value1 = &config->request.irq_resource[num].start; value1 = &config->request.irq_resource[num].start;
...@@ -536,16 +559,16 @@ static int pnp_generate_irq(struct pnp_cfg *config, int num) ...@@ -536,16 +559,16 @@ static int pnp_generate_irq(struct pnp_cfg *config, int num)
static int pnp_generate_dma(struct pnp_cfg *config, int num) static int pnp_generate_dma(struct pnp_cfg *config, int num)
{ {
struct pnp_dma *dma = config->dma[num]; struct pnp_dma *dma;
unsigned long *value1, *value2, *value3; unsigned long *value1, *value2, *value3;
/* DMA priority: this table is good for i386 */ /* DMA priority: this table is good for i386 */
static unsigned short xtab[16] = { static unsigned short xtab[16] = {
1, 3, 5, 6, 7, 0, 2, 4 1, 3, 5, 6, 7, 0, 2, 4
}; };
int i; int i;
if (!config || num < 0 || num > 1) if (!config || num < 0 || num > 1)
return -EINVAL; return -EINVAL;
dma = config->dma[num];
if (!dma) if (!dma)
return 0; return 0;
value1 = &config->request.dma_resource[num].start; value1 = &config->request.dma_resource[num].start;
...@@ -566,10 +589,11 @@ static int pnp_generate_dma(struct pnp_cfg *config, int num) ...@@ -566,10 +589,11 @@ static int pnp_generate_dma(struct pnp_cfg *config, int num)
static int pnp_prepare_request(struct pnp_cfg *config) static int pnp_prepare_request(struct pnp_cfg *config)
{ {
struct pnp_dev *dev = &config->request; struct pnp_dev *dev;
int idx; int idx;
if (!config) if (!config)
return -EINVAL; return -EINVAL;
dev = &config->request;
if (dev == NULL) if (dev == NULL)
return -EINVAL; return -EINVAL;
if (dev->active || dev->ro) if (dev->active || dev->ro)
...@@ -629,21 +653,29 @@ static int pnp_generate_request(struct pnp_cfg *config) ...@@ -629,21 +653,29 @@ static int pnp_generate_request(struct pnp_cfg *config)
static struct pnp_cfg * pnp_generate_config(struct pnp_dev *dev, int depnum) static struct pnp_cfg * pnp_generate_config(struct pnp_dev *dev, int depnum)
{ {
struct pnp_cfg * config = pnp_alloc(sizeof(struct pnp_cfg)); struct pnp_cfg * config;
int nport = 0, nirq = 0, ndma = 0, nmem = 0; int nport = 0, nirq = 0, ndma = 0, nmem = 0;
struct pnp_resources * res = dev->res; struct pnp_resources * res;
struct pnp_port * port = res->port; struct pnp_port * port;
struct pnp_mem * mem = res->mem; struct pnp_mem * mem;
struct pnp_irq * irq = res->irq; struct pnp_irq * irq;
struct pnp_dma * dma = res->dma; struct pnp_dma * dma;
if (!dev) if (!dev)
return NULL; return NULL;
if (depnum < 0) if (depnum < 0)
return NULL; return NULL;
config = pnp_alloc(sizeof(struct pnp_cfg));
if (!config) if (!config)
return NULL; return NULL;
/* independent */ /* independent */
res = pnp_find_resources(dev, 0);
if (!res)
goto fail;
port = res->port;
mem = res->mem;
irq = res->irq;
dma = res->dma;
while (port){ while (port){
config->port[nport] = port; config->port[nport] = port;
nport++; nport++;
...@@ -669,6 +701,8 @@ static struct pnp_cfg * pnp_generate_config(struct pnp_dev *dev, int depnum) ...@@ -669,6 +701,8 @@ static struct pnp_cfg * pnp_generate_config(struct pnp_dev *dev, int depnum)
if (depnum == 0) if (depnum == 0)
return config; return config;
res = pnp_find_resources(dev, depnum); res = pnp_find_resources(dev, depnum);
if (!res)
goto fail;
port = res->port; port = res->port;
mem = res->mem; mem = res->mem;
irq = res->irq; irq = res->irq;
...@@ -695,6 +729,10 @@ static struct pnp_cfg * pnp_generate_config(struct pnp_dev *dev, int depnum) ...@@ -695,6 +729,10 @@ static struct pnp_cfg * pnp_generate_config(struct pnp_dev *dev, int depnum)
dma = dma->next; dma = dma->next;
} }
return config; return config;
fail:
kfree(config);
return NULL;
} }
/* PnP Device Resource Management */ /* PnP Device Resource Management */
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment