mac80211: share sta->supp_rates
[linux/fpc-iii.git] / arch / mips / pmc-sierra / yosemite / ht.c
blob678388fd34b1a9e521d812c307a0aec42478fbc4
1 /*
2 * Copyright 2003 PMC-Sierra
3 * Author: Manish Lachwani (lachwani@pmc-sierra.com)
5 * This program is free software; you can redistribute it and/or modify it
6 * under the terms of the GNU General Public License as published by the
7 * Free Software Foundation; either version 2 of the License, or (at your
8 * option) any later version.
10 * THIS SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED
11 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
12 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN
13 * NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
14 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
15 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF
16 * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
17 * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
18 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
19 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
21 * You should have received a copy of the GNU General Public License along
22 * with this program; if not, write to the Free Software Foundation, Inc.,
23 * 675 Mass Ave, Cambridge, MA 02139, USA.
26 #include <linux/types.h>
27 #include <linux/pci.h>
28 #include <linux/kernel.h>
29 #include <linux/slab.h>
30 #include <asm/pci.h>
31 #include <asm/io.h>
33 #include <linux/init.h>
34 #include <asm/titan_dep.h>
36 #ifdef CONFIG_HYPERTRANSPORT
40 * This function check if the Hypertransport Link Initialization completed. If
41 * it did, then proceed further with scanning bus #2
43 static __inline__ int check_titan_htlink(void)
45 u32 val;
47 val = *(volatile uint32_t *)(RM9000x2_HTLINK_REG);
48 if (val & 0x00000020)
49 /* HT Link Initialization completed */
50 return 1;
51 else
52 return 0;
55 static int titan_ht_config_read_dword(struct pci_dev *device,
56 int offset, u32* val)
58 int dev, bus, func;
59 uint32_t address_reg, data_reg;
60 uint32_t address;
62 bus = device->bus->number;
63 dev = PCI_SLOT(device->devfn);
64 func = PCI_FUNC(device->devfn);
66 /* XXX Need to change the Bus # */
67 if (bus > 2)
68 address = (bus << 16) | (dev << 11) | (func << 8) | (offset & 0xfc) |
69 0x80000000 | 0x1;
70 else
71 address = (dev << 11) | (func << 8) | (offset & 0xfc) | 0x80000000;
73 address_reg = RM9000x2_OCD_HTCFGA;
74 data_reg = RM9000x2_OCD_HTCFGD;
76 RM9K_WRITE(address_reg, address);
77 RM9K_READ(data_reg, val);
79 return PCIBIOS_SUCCESSFUL;
83 static int titan_ht_config_read_word(struct pci_dev *device,
84 int offset, u16* val)
86 int dev, bus, func;
87 uint32_t address_reg, data_reg;
88 uint32_t address;
90 bus = device->bus->number;
91 dev = PCI_SLOT(device->devfn);
92 func = PCI_FUNC(device->devfn);
94 /* XXX Need to change the Bus # */
95 if (bus > 2)
96 address = (bus << 16) | (dev << 11) | (func << 8) | (offset & 0xfc) |
97 0x80000000 | 0x1;
98 else
99 address = (dev << 11) | (func << 8) | (offset & 0xfc) | 0x80000000;
101 address_reg = RM9000x2_OCD_HTCFGA;
102 data_reg = RM9000x2_OCD_HTCFGD;
104 if ((offset & 0x3) == 0)
105 offset = 0x2;
106 else
107 offset = 0x0;
109 RM9K_WRITE(address_reg, address);
110 RM9K_READ_16(data_reg + offset, val);
112 return PCIBIOS_SUCCESSFUL;
116 u32 longswap(unsigned long l)
118 unsigned char b1, b2, b3, b4;
120 b1 = l&255;
121 b2 = (l>>8)&255;
122 b3 = (l>>16)&255;
123 b4 = (l>>24)&255;
125 return ((b1<<24) + (b2<<16) + (b3<<8) + b4);
129 static int titan_ht_config_read_byte(struct pci_dev *device,
130 int offset, u8* val)
132 int dev, bus, func;
133 uint32_t address_reg, data_reg;
134 uint32_t address;
135 int offset1;
137 bus = device->bus->number;
138 dev = PCI_SLOT(device->devfn);
139 func = PCI_FUNC(device->devfn);
141 /* XXX Need to change the Bus # */
142 if (bus > 2)
143 address = (bus << 16) | (dev << 11) | (func << 8) | (offset & 0xfc) |
144 0x80000000 | 0x1;
145 else
146 address = (dev << 11) | (func << 8) | (offset & 0xfc) | 0x80000000;
148 address_reg = RM9000x2_OCD_HTCFGA;
149 data_reg = RM9000x2_OCD_HTCFGD;
151 RM9K_WRITE(address_reg, address);
153 if ((offset & 0x3) == 0) {
154 offset1 = 0x3;
156 if ((offset & 0x3) == 1) {
157 offset1 = 0x2;
159 if ((offset & 0x3) == 2) {
160 offset1 = 0x1;
162 if ((offset & 0x3) == 3) {
163 offset1 = 0x0;
165 RM9K_READ_8(data_reg + offset1, val);
167 return PCIBIOS_SUCCESSFUL;
171 static int titan_ht_config_write_dword(struct pci_dev *device,
172 int offset, u8 val)
174 int dev, bus, func;
175 uint32_t address_reg, data_reg;
176 uint32_t address;
178 bus = device->bus->number;
179 dev = PCI_SLOT(device->devfn);
180 func = PCI_FUNC(device->devfn);
182 /* XXX Need to change the Bus # */
183 if (bus > 2)
184 address = (bus << 16) | (dev << 11) | (func << 8) | (offset & 0xfc) |
185 0x80000000 | 0x1;
186 else
187 address = (dev << 11) | (func << 8) | (offset & 0xfc) | 0x80000000;
189 address_reg = RM9000x2_OCD_HTCFGA;
190 data_reg = RM9000x2_OCD_HTCFGD;
192 RM9K_WRITE(address_reg, address);
193 RM9K_WRITE(data_reg, val);
195 return PCIBIOS_SUCCESSFUL;
198 static int titan_ht_config_write_word(struct pci_dev *device,
199 int offset, u8 val)
201 int dev, bus, func;
202 uint32_t address_reg, data_reg;
203 uint32_t address;
205 bus = device->bus->number;
206 dev = PCI_SLOT(device->devfn);
207 func = PCI_FUNC(device->devfn);
209 /* XXX Need to change the Bus # */
210 if (bus > 2)
211 address = (bus << 16) | (dev << 11) | (func << 8) | (offset & 0xfc) |
212 0x80000000 | 0x1;
213 else
214 address = (dev << 11) | (func << 8) | (offset & 0xfc) | 0x80000000;
216 address_reg = RM9000x2_OCD_HTCFGA;
217 data_reg = RM9000x2_OCD_HTCFGD;
219 if ((offset & 0x3) == 0)
220 offset = 0x2;
221 else
222 offset = 0x0;
224 RM9K_WRITE(address_reg, address);
225 RM9K_WRITE_16(data_reg + offset, val);
227 return PCIBIOS_SUCCESSFUL;
230 static int titan_ht_config_write_byte(struct pci_dev *device,
231 int offset, u8 val)
233 int dev, bus, func;
234 uint32_t address_reg, data_reg;
235 uint32_t address;
236 int offset1;
238 bus = device->bus->number;
239 dev = PCI_SLOT(device->devfn);
240 func = PCI_FUNC(device->devfn);
242 /* XXX Need to change the Bus # */
243 if (bus > 2)
244 address = (bus << 16) | (dev << 11) | (func << 8) | (offset & 0xfc) |
245 0x80000000 | 0x1;
246 else
247 address = (dev << 11) | (func << 8) | (offset & 0xfc) | 0x80000000;
249 address_reg = RM9000x2_OCD_HTCFGA;
250 data_reg = RM9000x2_OCD_HTCFGD;
252 RM9K_WRITE(address_reg, address);
254 if ((offset & 0x3) == 0) {
255 offset1 = 0x3;
257 if ((offset & 0x3) == 1) {
258 offset1 = 0x2;
260 if ((offset & 0x3) == 2) {
261 offset1 = 0x1;
263 if ((offset & 0x3) == 3) {
264 offset1 = 0x0;
267 RM9K_WRITE_8(data_reg + offset1, val);
268 return PCIBIOS_SUCCESSFUL;
272 static void titan_pcibios_set_master(struct pci_dev *dev)
274 u16 cmd;
275 int bus = dev->bus->number;
277 if (check_titan_htlink())
278 titan_ht_config_read_word(dev, PCI_COMMAND, &cmd);
280 cmd |= PCI_COMMAND_MASTER;
282 if (check_titan_htlink())
283 titan_ht_config_write_word(dev, PCI_COMMAND, cmd);
287 int pcibios_enable_resources(struct pci_dev *dev)
289 u16 cmd, old_cmd;
290 u8 tmp1;
291 int idx;
292 struct resource *r;
293 int bus = dev->bus->number;
295 if (check_titan_htlink())
296 titan_ht_config_read_word(dev, PCI_COMMAND, &cmd);
298 old_cmd = cmd;
299 for (idx = 0; idx < 6; idx++) {
300 r = &dev->resource[idx];
301 if (!r->start && r->end) {
302 printk(KERN_ERR
303 "PCI: Device %s not available because of "
304 "resource collisions\n", pci_name(dev));
305 return -EINVAL;
307 if (r->flags & IORESOURCE_IO)
308 cmd |= PCI_COMMAND_IO;
309 if (r->flags & IORESOURCE_MEM)
310 cmd |= PCI_COMMAND_MEMORY;
312 if (cmd != old_cmd) {
313 if (check_titan_htlink())
314 titan_ht_config_write_word(dev, PCI_COMMAND, cmd);
317 if (check_titan_htlink())
318 titan_ht_config_read_byte(dev, PCI_CACHE_LINE_SIZE, &tmp1);
320 if (tmp1 != 8) {
321 printk(KERN_WARNING "PCI setting cache line size to 8 from "
322 "%d\n", tmp1);
325 if (check_titan_htlink())
326 titan_ht_config_write_byte(dev, PCI_CACHE_LINE_SIZE, 8);
328 if (check_titan_htlink())
329 titan_ht_config_read_byte(dev, PCI_LATENCY_TIMER, &tmp1);
331 if (tmp1 < 32 || tmp1 == 0xff) {
332 printk(KERN_WARNING "PCI setting latency timer to 32 from %d\n",
333 tmp1);
336 if (check_titan_htlink())
337 titan_ht_config_write_byte(dev, PCI_LATENCY_TIMER, 32);
339 return 0;
343 int pcibios_enable_device(struct pci_dev *dev, int mask)
345 return pcibios_enable_resources(dev);
348 void pcibios_align_resource(void *data, struct resource *res,
349 resource_size_t size, resource_size_t align)
351 struct pci_dev *dev = data;
353 if (res->flags & IORESOURCE_IO) {
354 resource_size_t start = res->start;
356 /* We need to avoid collisions with `mirrored' VGA ports
357 and other strange ISA hardware, so we always want the
358 addresses kilobyte aligned. */
359 if (size > 0x100) {
360 printk(KERN_ERR "PCI: I/O Region %s/%d too large"
361 " (%ld bytes)\n", pci_name(dev),
362 dev->resource - res, size);
365 start = (start + 1024 - 1) & ~(1024 - 1);
366 res->start = start;
370 struct pci_ops titan_pci_ops = {
371 titan_ht_config_read_byte,
372 titan_ht_config_read_word,
373 titan_ht_config_read_dword,
374 titan_ht_config_write_byte,
375 titan_ht_config_write_word,
376 titan_ht_config_write_dword
379 void __init pcibios_fixup_bus(struct pci_bus *c)
381 titan_ht_pcibios_fixup_bus(c);
384 void __init pcibios_init(void)
387 /* Reset PCI I/O and PCI MEM values */
388 /* XXX Need to add the proper values here */
389 ioport_resource.start = 0xe0000000;
390 ioport_resource.end = 0xe0000000 + 0x20000000 - 1;
391 iomem_resource.start = 0xc0000000;
392 iomem_resource.end = 0xc0000000 + 0x20000000 - 1;
394 /* XXX Need to add bus values */
395 pci_scan_bus(2, &titan_pci_ops, NULL);
396 pci_scan_bus(3, &titan_pci_ops, NULL);
400 * for parsing "pci=" kernel boot arguments.
402 char *pcibios_setup(char *str)
404 printk(KERN_INFO "rr: pcibios_setup\n");
405 /* Nothing to do for now. */
407 return str;
410 unsigned __init int pcibios_assign_all_busses(void)
412 /* We want to use the PCI bus detection done by PMON */
413 return 0;
416 #endif /* CONFIG_HYPERTRANSPORT */