mirror of
https://github.com/torvalds/linux.git
synced 2024-11-28 15:11:31 +00:00
1523508d63
pci_get_slot does a pci_dev_get, so pci_dev_put needs to be called in an error case. An extract of the semantic match used to find the problem is as follows: (http://www.emn.fr/x-info/coccinelle/) // <smpl> @@ type find1.T,T1,T2; identifier find1.E; statement find1.S; expression x1,x2,x3; expression find1.test; int ret != 0; @@ T E; ... ( * E = pci_get_slot(...); if (E == NULL) S | * if ((E = pci_get_slot(...)) == NULL) S ) ... when != pci_dev_put(...,(T1)E,...) when != if (E != NULL) { ... pci_dev_put(...,(T1)E,...); ...} when != x1 = (T1)E when != E = x3; when any if (test) { ... when != pci_dev_put(...,(T2)E,...) when != if (E != NULL) { ... pci_dev_put(...,(T2)E,...); ...} when != x2 = (T2)E ( * return; | * return ret; ) } // </smpl> Signed-off-by: Julia Lawall <julia@diku.dk> Signed-off-by: Andrew Morton <akpm@linux-foundation.org> Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
255 lines
6.2 KiB
C
255 lines
6.2 KiB
C
/*
|
|
* cardbus.c -- 16-bit PCMCIA core support
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
* published by the Free Software Foundation.
|
|
*
|
|
* The initial developer of the original code is David A. Hinds
|
|
* <dahinds@users.sourceforge.net>. Portions created by David A. Hinds
|
|
* are Copyright (C) 1999 David A. Hinds. All Rights Reserved.
|
|
*
|
|
* (C) 1999 David A. Hinds
|
|
*/
|
|
|
|
/*
|
|
* Cardbus handling has been re-written to be more of a PCI bridge thing,
|
|
* and the PCI code basically does all the resource handling.
|
|
*
|
|
* Linus, Jan 2000
|
|
*/
|
|
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/string.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/mm.h>
|
|
#include <linux/pci.h>
|
|
#include <linux/ioport.h>
|
|
#include <asm/irq.h>
|
|
#include <asm/io.h>
|
|
|
|
#define IN_CARD_SERVICES
|
|
#include <pcmcia/cs_types.h>
|
|
#include <pcmcia/ss.h>
|
|
#include <pcmcia/cs.h>
|
|
#include <pcmcia/bulkmem.h>
|
|
#include <pcmcia/cistpl.h>
|
|
#include "cs_internal.h"
|
|
|
|
/*====================================================================*/
|
|
|
|
/* Offsets in the Expansion ROM Image Header */
|
|
#define ROM_SIGNATURE 0x0000 /* 2 bytes */
|
|
#define ROM_DATA_PTR 0x0018 /* 2 bytes */
|
|
|
|
/* Offsets in the CardBus PC Card Data Structure */
|
|
#define PCDATA_SIGNATURE 0x0000 /* 4 bytes */
|
|
#define PCDATA_VPD_PTR 0x0008 /* 2 bytes */
|
|
#define PCDATA_LENGTH 0x000a /* 2 bytes */
|
|
#define PCDATA_REVISION 0x000c
|
|
#define PCDATA_IMAGE_SZ 0x0010 /* 2 bytes */
|
|
#define PCDATA_ROM_LEVEL 0x0012 /* 2 bytes */
|
|
#define PCDATA_CODE_TYPE 0x0014
|
|
#define PCDATA_INDICATOR 0x0015
|
|
|
|
/*=====================================================================
|
|
|
|
Expansion ROM's have a special layout, and pointers specify an
|
|
image number and an offset within that image. xlate_rom_addr()
|
|
converts an image/offset address to an absolute offset from the
|
|
ROM's base address.
|
|
|
|
=====================================================================*/
|
|
|
|
static u_int xlate_rom_addr(void __iomem *b, u_int addr)
|
|
{
|
|
u_int img = 0, ofs = 0, sz;
|
|
u_short data;
|
|
while ((readb(b) == 0x55) && (readb(b + 1) == 0xaa)) {
|
|
if (img == (addr >> 28))
|
|
return (addr & 0x0fffffff) + ofs;
|
|
data = readb(b + ROM_DATA_PTR) + (readb(b + ROM_DATA_PTR + 1) << 8);
|
|
sz = 512 * (readb(b + data + PCDATA_IMAGE_SZ) +
|
|
(readb(b + data + PCDATA_IMAGE_SZ + 1) << 8));
|
|
if ((sz == 0) || (readb(b + data + PCDATA_INDICATOR) & 0x80))
|
|
break;
|
|
b += sz;
|
|
ofs += sz;
|
|
img++;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
/*=====================================================================
|
|
|
|
These are similar to setup_cis_mem and release_cis_mem for 16-bit
|
|
cards. The "result" that is used externally is the cb_cis_virt
|
|
pointer in the struct pcmcia_socket structure.
|
|
|
|
=====================================================================*/
|
|
|
|
static void cb_release_cis_mem(struct pcmcia_socket * s)
|
|
{
|
|
if (s->cb_cis_virt) {
|
|
cs_dbg(s, 1, "cb_release_cis_mem()\n");
|
|
iounmap(s->cb_cis_virt);
|
|
s->cb_cis_virt = NULL;
|
|
s->cb_cis_res = NULL;
|
|
}
|
|
}
|
|
|
|
static int cb_setup_cis_mem(struct pcmcia_socket * s, struct resource *res)
|
|
{
|
|
unsigned int start, size;
|
|
|
|
if (res == s->cb_cis_res)
|
|
return 0;
|
|
|
|
if (s->cb_cis_res)
|
|
cb_release_cis_mem(s);
|
|
|
|
start = res->start;
|
|
size = res->end - start + 1;
|
|
s->cb_cis_virt = ioremap(start, size);
|
|
|
|
if (!s->cb_cis_virt)
|
|
return -1;
|
|
|
|
s->cb_cis_res = res;
|
|
|
|
return 0;
|
|
}
|
|
|
|
/*=====================================================================
|
|
|
|
This is used by the CIS processing code to read CIS information
|
|
from a CardBus device.
|
|
|
|
=====================================================================*/
|
|
|
|
int read_cb_mem(struct pcmcia_socket * s, int space, u_int addr, u_int len, void *ptr)
|
|
{
|
|
struct pci_dev *dev;
|
|
struct resource *res;
|
|
|
|
cs_dbg(s, 3, "read_cb_mem(%d, %#x, %u)\n", space, addr, len);
|
|
|
|
dev = pci_get_slot(s->cb_dev->subordinate, 0);
|
|
if (!dev)
|
|
goto fail;
|
|
|
|
/* Config space? */
|
|
if (space == 0) {
|
|
if (addr + len > 0x100)
|
|
goto failput;
|
|
for (; len; addr++, ptr++, len--)
|
|
pci_read_config_byte(dev, addr, ptr);
|
|
return 0;
|
|
}
|
|
|
|
res = dev->resource + space - 1;
|
|
|
|
pci_dev_put(dev);
|
|
|
|
if (!res->flags)
|
|
goto fail;
|
|
|
|
if (cb_setup_cis_mem(s, res) != 0)
|
|
goto fail;
|
|
|
|
if (space == 7) {
|
|
addr = xlate_rom_addr(s->cb_cis_virt, addr);
|
|
if (addr == 0)
|
|
goto fail;
|
|
}
|
|
|
|
if (addr + len > res->end - res->start)
|
|
goto fail;
|
|
|
|
memcpy_fromio(ptr, s->cb_cis_virt + addr, len);
|
|
return 0;
|
|
|
|
failput:
|
|
pci_dev_put(dev);
|
|
fail:
|
|
memset(ptr, 0xff, len);
|
|
return -1;
|
|
}
|
|
|
|
/*=====================================================================
|
|
|
|
cb_alloc() and cb_free() allocate and free the kernel data
|
|
structures for a Cardbus device, and handle the lowest level PCI
|
|
device setup issues.
|
|
|
|
=====================================================================*/
|
|
|
|
/*
|
|
* Since there is only one interrupt available to CardBus
|
|
* devices, all devices downstream of this device must
|
|
* be using this IRQ.
|
|
*/
|
|
static void cardbus_assign_irqs(struct pci_bus *bus, int irq)
|
|
{
|
|
struct pci_dev *dev;
|
|
|
|
list_for_each_entry(dev, &bus->devices, bus_list) {
|
|
u8 irq_pin;
|
|
|
|
pci_read_config_byte(dev, PCI_INTERRUPT_PIN, &irq_pin);
|
|
if (irq_pin) {
|
|
dev->irq = irq;
|
|
pci_write_config_byte(dev, PCI_INTERRUPT_LINE, dev->irq);
|
|
}
|
|
|
|
if (dev->subordinate)
|
|
cardbus_assign_irqs(dev->subordinate, irq);
|
|
}
|
|
}
|
|
|
|
int cb_alloc(struct pcmcia_socket * s)
|
|
{
|
|
struct pci_bus *bus = s->cb_dev->subordinate;
|
|
struct pci_dev *dev;
|
|
unsigned int max, pass;
|
|
|
|
s->functions = pci_scan_slot(bus, PCI_DEVFN(0, 0));
|
|
// pcibios_fixup_bus(bus);
|
|
|
|
max = bus->secondary;
|
|
for (pass = 0; pass < 2; pass++)
|
|
list_for_each_entry(dev, &bus->devices, bus_list)
|
|
if (dev->hdr_type == PCI_HEADER_TYPE_BRIDGE ||
|
|
dev->hdr_type == PCI_HEADER_TYPE_CARDBUS)
|
|
max = pci_scan_bridge(bus, dev, max, pass);
|
|
|
|
/*
|
|
* Size all resources below the CardBus controller.
|
|
*/
|
|
pci_bus_size_bridges(bus);
|
|
pci_bus_assign_resources(bus);
|
|
cardbus_assign_irqs(bus, s->pci_irq);
|
|
|
|
/* socket specific tune function */
|
|
if (s->tune_bridge)
|
|
s->tune_bridge(s, bus);
|
|
|
|
pci_enable_bridges(bus);
|
|
pci_bus_add_devices(bus);
|
|
|
|
s->irq.AssignedIRQ = s->pci_irq;
|
|
return CS_SUCCESS;
|
|
}
|
|
|
|
void cb_free(struct pcmcia_socket * s)
|
|
{
|
|
struct pci_dev *bridge = s->cb_dev;
|
|
|
|
cb_release_cis_mem(s);
|
|
|
|
if (bridge)
|
|
pci_remove_behind_bridge(bridge);
|
|
}
|