2
* Support PCI IO workaround
4
* Copyright (C) 2006 Benjamin Herrenschmidt <benh@kernel.crashing.org>
6
* (C) Copyright 2007-2008 TOSHIBA CORPORATION
8
* This program is free software; you can redistribute it and/or modify
9
* it under the terms of the GNU General Public License version 2 as
10
* published by the Free Software Foundation.
14
#include <linux/kernel.h>
17
#include <asm/machdep.h>
18
#include <asm/pgtable.h>
19
#include <asm/ppc-pci.h>
21
#include "io-workarounds.h"
23
#define IOWA_MAX_BUS 8
25
static struct iowa_bus iowa_busses[IOWA_MAX_BUS];
26
static unsigned int iowa_bus_count;
28
static struct iowa_bus *iowa_pci_find(unsigned long vaddr, unsigned long paddr)
32
unsigned long vstart, vend;
34
for (i = 0; i < iowa_bus_count; i++) {
35
struct iowa_bus *bus = &iowa_busses[i];
36
struct pci_controller *phb = bus->phb;
39
vstart = (unsigned long)phb->io_base_virt;
40
vend = vstart + phb->pci_io_size - 1;
41
if ((vaddr >= vstart) && (vaddr <= vend))
46
for (j = 0; j < 3; j++) {
47
res = &phb->mem_resources[j];
48
if (paddr >= res->start && paddr <= res->end)
56
struct iowa_bus *iowa_mem_find_bus(const PCI_IO_ADDR addr)
61
token = PCI_GET_ADDR_TOKEN(addr);
63
if (token && token <= iowa_bus_count)
64
bus = &iowa_busses[token - 1];
66
unsigned long vaddr, paddr;
69
vaddr = (unsigned long)PCI_FIX_ADDR(addr);
70
if (vaddr < PHB_IO_BASE || vaddr >= PHB_IO_END)
73
ptep = find_linux_pte(init_mm.pgd, vaddr);
77
paddr = pte_pfn(*ptep) << PAGE_SHIFT;
78
bus = iowa_pci_find(vaddr, paddr);
87
struct iowa_bus *iowa_pio_find_bus(unsigned long port)
89
unsigned long vaddr = (unsigned long)pci_io_base + port;
90
return iowa_pci_find(vaddr, 0);
94
#define DEF_PCI_AC_RET(name, ret, at, al, space, aa) \
95
static ret iowa_##name at \
97
struct iowa_bus *bus; \
98
bus = iowa_##space##_find_bus(aa); \
99
if (bus && bus->ops && bus->ops->name) \
100
return bus->ops->name al; \
101
return __do_##name al; \
104
#define DEF_PCI_AC_NORET(name, at, al, space, aa) \
105
static void iowa_##name at \
107
struct iowa_bus *bus; \
108
bus = iowa_##space##_find_bus(aa); \
109
if (bus && bus->ops && bus->ops->name) { \
116
#include <asm/io-defs.h>
118
#undef DEF_PCI_AC_RET
119
#undef DEF_PCI_AC_NORET
121
static const struct ppc_pci_io __devinitconst iowa_pci_io = {
123
#define DEF_PCI_AC_RET(name, ret, at, al, space, aa) .name = iowa_##name,
124
#define DEF_PCI_AC_NORET(name, at, al, space, aa) .name = iowa_##name,
126
#include <asm/io-defs.h>
128
#undef DEF_PCI_AC_RET
129
#undef DEF_PCI_AC_NORET
133
static void __iomem *iowa_ioremap(phys_addr_t addr, unsigned long size,
134
unsigned long flags, void *caller)
136
struct iowa_bus *bus;
137
void __iomem *res = __ioremap_caller(addr, size, flags, caller);
140
bus = iowa_pci_find(0, (unsigned long)addr);
142
busno = bus - iowa_busses;
143
PCI_SET_ADDR_TOKEN(res, busno + 1);
148
/* Regist new bus to support workaround */
149
void __devinit iowa_register_bus(struct pci_controller *phb,
150
struct ppc_pci_io *ops,
151
int (*initfunc)(struct iowa_bus *, void *), void *data)
153
struct iowa_bus *bus;
154
struct device_node *np = phb->dn;
156
if (iowa_bus_count >= IOWA_MAX_BUS) {
157
pr_err("IOWA:Too many pci bridges, "
158
"workarounds disabled for %s\n", np->full_name);
162
bus = &iowa_busses[iowa_bus_count];
167
if ((*initfunc)(bus, data))
172
pr_debug("IOWA:[%d]Add bus, %s.\n", iowa_bus_count-1, np->full_name);
175
/* enable IO workaround */
176
void __devinit io_workaround_init(void)
178
static int io_workaround_inited;
180
if (io_workaround_inited)
182
ppc_pci_io = iowa_pci_io;
183
ppc_md.ioremap = iowa_ioremap;
184
io_workaround_inited = 1;