Showing error 812

User: Jiri Slaby
Error type: Resource Leak
Error type description: The code omits to put the resource to the system for reuse
File location: drivers/pcmcia/cardbus.c
Line in file: 138
Project: Linux Kernel
Project version: 2.6.28
Tools: Stanse (1.2)
Entered: 2011-11-07 22:40:13 UTC


Source:

  1/*
  2 * cardbus.c -- 16-bit PCMCIA core support
  3 *
  4 * This program is free software; you can redistribute it and/or modify
  5 * it under the terms of the GNU General Public License version 2 as
  6 * published by the Free Software Foundation.
  7 *
  8 * The initial developer of the original code is David A. Hinds
  9 * <dahinds@users.sourceforge.net>.  Portions created by David A. Hinds
 10 * are Copyright (C) 1999 David A. Hinds.  All Rights Reserved.
 11 *
 12 * (C) 1999                David A. Hinds
 13 */
 14
 15/*
 16 * Cardbus handling has been re-written to be more of a PCI bridge thing,
 17 * and the PCI code basically does all the resource handling.
 18 *
 19 *                Linus, Jan 2000
 20 */
 21
 22
 23#include <linux/module.h>
 24#include <linux/kernel.h>
 25#include <linux/string.h>
 26#include <linux/slab.h>
 27#include <linux/mm.h>
 28#include <linux/pci.h>
 29#include <linux/ioport.h>
 30#include <asm/irq.h>
 31#include <asm/io.h>
 32
 33#include <pcmcia/cs_types.h>
 34#include <pcmcia/ss.h>
 35#include <pcmcia/cs.h>
 36#include <pcmcia/cistpl.h>
 37#include "cs_internal.h"
 38
 39/*====================================================================*/
 40
 41/* Offsets in the Expansion ROM Image Header */
 42#define ROM_SIGNATURE                0x0000        /* 2 bytes */
 43#define ROM_DATA_PTR                0x0018        /* 2 bytes */
 44
 45/* Offsets in the CardBus PC Card Data Structure */
 46#define PCDATA_SIGNATURE        0x0000        /* 4 bytes */
 47#define PCDATA_VPD_PTR                0x0008        /* 2 bytes */
 48#define PCDATA_LENGTH                0x000a        /* 2 bytes */
 49#define PCDATA_REVISION                0x000c
 50#define PCDATA_IMAGE_SZ                0x0010        /* 2 bytes */
 51#define PCDATA_ROM_LEVEL        0x0012        /* 2 bytes */
 52#define PCDATA_CODE_TYPE        0x0014
 53#define PCDATA_INDICATOR        0x0015
 54
 55/*=====================================================================
 56
 57    Expansion ROM's have a special layout, and pointers specify an
 58    image number and an offset within that image.  xlate_rom_addr()
 59    converts an image/offset address to an absolute offset from the
 60    ROM's base address.
 61    
 62=====================================================================*/
 63
 64static u_int xlate_rom_addr(void __iomem *b, u_int addr)
 65{
 66        u_int img = 0, ofs = 0, sz;
 67        u_short data;
 68        while ((readb(b) == 0x55) && (readb(b + 1) == 0xaa)) {
 69                if (img == (addr >> 28))
 70                        return (addr & 0x0fffffff) + ofs;
 71                data = readb(b + ROM_DATA_PTR) + (readb(b + ROM_DATA_PTR + 1) << 8);
 72                sz = 512 * (readb(b + data + PCDATA_IMAGE_SZ) +
 73                            (readb(b + data + PCDATA_IMAGE_SZ + 1) << 8));
 74                if ((sz == 0) || (readb(b + data + PCDATA_INDICATOR) & 0x80))
 75                        break;
 76                b += sz;
 77                ofs += sz;
 78                img++;
 79        }
 80        return 0;
 81}
 82
 83/*=====================================================================
 84
 85    These are similar to setup_cis_mem and release_cis_mem for 16-bit
 86    cards.  The "result" that is used externally is the cb_cis_virt
 87    pointer in the struct pcmcia_socket structure.
 88    
 89=====================================================================*/
 90
 91static void cb_release_cis_mem(struct pcmcia_socket * s)
 92{
 93        if (s->cb_cis_virt) {
 94                cs_dbg(s, 1, "cb_release_cis_mem()\n");
 95                iounmap(s->cb_cis_virt);
 96                s->cb_cis_virt = NULL;
 97                s->cb_cis_res = NULL;
 98        }
 99}
100
101static int cb_setup_cis_mem(struct pcmcia_socket * s, struct resource *res)
102{
103        unsigned int start, size;
104
105        if (res == s->cb_cis_res)
106                return 0;
107
108        if (s->cb_cis_res)
109                cb_release_cis_mem(s);
110
111        start = res->start;
112        size = res->end - start + 1;
113        s->cb_cis_virt = ioremap(start, size);
114
115        if (!s->cb_cis_virt)
116                return -1;
117
118        s->cb_cis_res = res;
119
120        return 0;
121}
122
123/*=====================================================================
124
125    This is used by the CIS processing code to read CIS information
126    from a CardBus device.
127    
128=====================================================================*/
129
130int read_cb_mem(struct pcmcia_socket * s, int space, u_int addr, u_int len, void *ptr)
131{
132        struct pci_dev *dev;
133        struct resource *res;
134
135        cs_dbg(s, 3, "read_cb_mem(%d, %#x, %u)\n", space, addr, len);
136
137        dev = pci_get_slot(s->cb_dev->subordinate, 0);
138        if (!dev)
139                goto fail;
140
141        /* Config space? */
142        if (space == 0) {
143                if (addr + len > 0x100)
144                        goto failput;
145                for (; len; addr++, ptr++, len--)
146                        pci_read_config_byte(dev, addr, ptr);
147                return 0;
148        }
149
150        res = dev->resource + space - 1;
151
152        pci_dev_put(dev);
153
154        if (!res->flags)
155                goto fail;
156
157        if (cb_setup_cis_mem(s, res) != 0)
158                goto fail;
159
160        if (space == 7) {
161                addr = xlate_rom_addr(s->cb_cis_virt, addr);
162                if (addr == 0)
163                        goto fail;
164        }
165
166        if (addr + len > res->end - res->start)
167                goto fail;
168
169        memcpy_fromio(ptr, s->cb_cis_virt + addr, len);
170        return 0;
171
172failput:
173        pci_dev_put(dev);
174fail:
175        memset(ptr, 0xff, len);
176        return -1;
177}
178
179/*=====================================================================
180
181    cb_alloc() and cb_free() allocate and free the kernel data
182    structures for a Cardbus device, and handle the lowest level PCI
183    device setup issues.
184    
185=====================================================================*/
186
187/*
188 * Since there is only one interrupt available to CardBus
189 * devices, all devices downstream of this device must
190 * be using this IRQ.
191 */
192static void cardbus_assign_irqs(struct pci_bus *bus, int irq)
193{
194        struct pci_dev *dev;
195
196        list_for_each_entry(dev, &bus->devices, bus_list) {
197                u8 irq_pin;
198
199                pci_read_config_byte(dev, PCI_INTERRUPT_PIN, &irq_pin);
200                if (irq_pin) {
201                        dev->irq = irq;
202                        pci_write_config_byte(dev, PCI_INTERRUPT_LINE, dev->irq);
203                }
204
205                if (dev->subordinate)
206                        cardbus_assign_irqs(dev->subordinate, irq);
207        }
208}
209
210int __ref cb_alloc(struct pcmcia_socket * s)
211{
212        struct pci_bus *bus = s->cb_dev->subordinate;
213        struct pci_dev *dev;
214        unsigned int max, pass;
215
216        s->functions = pci_scan_slot(bus, PCI_DEVFN(0, 0));
217//        pcibios_fixup_bus(bus);
218
219        max = bus->secondary;
220        for (pass = 0; pass < 2; pass++)
221                list_for_each_entry(dev, &bus->devices, bus_list)
222                        if (dev->hdr_type == PCI_HEADER_TYPE_BRIDGE ||
223                            dev->hdr_type == PCI_HEADER_TYPE_CARDBUS)
224                                max = pci_scan_bridge(bus, dev, max, pass);
225
226        /*
227         * Size all resources below the CardBus controller.
228         */
229        pci_bus_size_bridges(bus);
230        pci_bus_assign_resources(bus);
231        cardbus_assign_irqs(bus, s->pci_irq);
232
233        /* socket specific tune function */
234        if (s->tune_bridge)
235                s->tune_bridge(s, bus);
236
237        pci_enable_bridges(bus);
238        pci_bus_add_devices(bus);
239
240        s->irq.AssignedIRQ = s->pci_irq;
241        return 0;
242}
243
244void cb_free(struct pcmcia_socket * s)
245{
246        struct pci_dev *bridge = s->cb_dev;
247
248        cb_release_cis_mem(s);
249
250        if (bridge)
251                pci_remove_behind_bridge(bridge);
252}