[PATCH] Fix softmac scan
[sfrench/cifs-2.6.git] / arch / arm / mach-iop3xx / iq80332-pci.c
1 /*
2  * arch/arm/mach-iop3xx/iq80332-pci.c
3  *
4  * PCI support for the Intel IQ80332 reference board
5  *
6  * Author: Dave Jiang <dave.jiang@intel.com>
7  * Copyright (C) 2004 Intel Corp.
8  *
9  * This program is free software; you can redistribute it and/or modify
10  * it under the terms of the GNU General Public License version 2 as
11  * published by the Free Software Foundation.
12  */
13 #include <linux/kernel.h>
14 #include <linux/pci.h>
15 #include <linux/init.h>
16 #include <linux/string.h>
17 #include <linux/slab.h>
18
19 #include <asm/hardware.h>
20 #include <asm/irq.h>
21 #include <asm/mach/pci.h>
22 #include <asm/mach-types.h>
23
24 /*
25  * The following macro is used to lookup irqs in a standard table
26  * format for those systems that do not already have PCI
27  * interrupts properly routed.  We assume 1 <= pin <= 4
28  */
29 #define PCI_IRQ_TABLE_LOOKUP(minid,maxid)       \
30 ({ int _ctl_ = -1;                              \
31    unsigned int _idsel = idsel - minid;         \
32    if (_idsel <= maxid)                         \
33       _ctl_ = pci_irq_table[_idsel][pin-1];     \
34    _ctl_; })
35
36 #define INTA    IRQ_IQ80332_INTA
37 #define INTB    IRQ_IQ80332_INTB
38 #define INTC    IRQ_IQ80332_INTC
39 #define INTD    IRQ_IQ80332_INTD
40
41 //#define INTE  IRQ_IQ80332_I82544
42
43 static inline int __init
44 iq80332_map_irq(struct pci_dev *dev, u8 idsel, u8 pin)
45 {
46         static int pci_irq_table[][8] = {
47                 /*
48                  * PCI IDSEL/INTPIN->INTLINE
49                  * A       B       C       D
50                  */
51                 {-1,   -1,   -1,   -1},
52                 {-1,   -1,   -1,   -1},
53                 {-1,   -1,   -1,   -1},
54                 {INTA, INTB, INTC, INTD}, /* PCI-X Slot */
55                 {-1,   -1,   -1,   -1},
56                 {INTC, INTC, INTC, INTC}, /* GigE  */
57                 {-1,   -1,   -1,   -1},
58                 {-1,   -1,   -1,   -1},
59         };
60
61         BUG_ON(pin < 1 || pin > 4);
62
63         return PCI_IRQ_TABLE_LOOKUP(1, 7);
64 }
65
66 static int iq80332_setup(int nr, struct pci_sys_data *sys)
67 {
68         struct resource *res;
69
70         if(nr != 0)
71                 return 0;
72
73         res = kmalloc(sizeof(struct resource) * 2, GFP_KERNEL);
74         if (!res)
75                 panic("PCI: unable to alloc resources");
76
77         memset(res, 0, sizeof(struct resource) * 2);
78
79         res[0].start = IOP331_PCI_LOWER_IO_VA;
80         res[0].end   = IOP331_PCI_UPPER_IO_VA;
81         res[0].name  = "IQ80332 PCI I/O Space";
82         res[0].flags = IORESOURCE_IO;
83
84         res[1].start = IOP331_PCI_LOWER_MEM_PA;
85         res[1].end   = IOP331_PCI_UPPER_MEM_PA;
86         res[1].name  = "IQ80332 PCI Memory Space";
87         res[1].flags = IORESOURCE_MEM;
88
89         request_resource(&ioport_resource, &res[0]);
90         request_resource(&iomem_resource, &res[1]);
91
92         sys->mem_offset = IOP331_PCI_MEM_OFFSET;
93         sys->io_offset  = IOP331_PCI_IO_OFFSET;
94
95         sys->resource[0] = &res[0];
96         sys->resource[1] = &res[1];
97         sys->resource[2] = NULL;
98
99         return 1;
100 }
101
102 static void iq80332_preinit(void)
103 {
104         iop331_init();
105 }
106
107 static struct hw_pci iq80332_pci __initdata = {
108         .swizzle        = pci_std_swizzle,
109         .nr_controllers = 1,
110         .setup          = iq80332_setup,
111         .scan           = iop331_scan_bus,
112         .preinit        = iq80332_preinit,
113         .map_irq        = iq80332_map_irq
114 };
115
116 static int __init iq80332_pci_init(void)
117 {
118         if (machine_is_iq80332())
119                 pci_common_init(&iq80332_pci);
120         return 0;
121 }
122
123 subsys_initcall(iq80332_pci_init);
124
125
126
127