Blame view

kernel/linux-imx6_3.14.28/arch/frv/mb93090-mb00/pci-frv.c 5.95 KB
6b13f685e   김민수   BSP 최초 추가
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
  /* pci-frv.c: low-level PCI access routines
   *
   * Copyright (C) 2003-5 Red Hat, Inc. All Rights Reserved.
   * Written by David Howells (dhowells@redhat.com)
   * - Derived from the i386 equivalent stuff
   *
   * This program is free software; you can redistribute it and/or
   * modify it under the terms of the GNU General Public License
   * as published by the Free Software Foundation; either version
   * 2 of the License, or (at your option) any later version.
   */
  
  #include <linux/types.h>
  #include <linux/kernel.h>
  #include <linux/pci.h>
  #include <linux/init.h>
  #include <linux/ioport.h>
  #include <linux/errno.h>
  
  #include "pci-frv.h"
  
  /*
   * We need to avoid collisions with `mirrored' VGA ports
   * and other strange ISA hardware, so we always want the
   * addresses to be allocated in the 0x000-0x0ff region
   * modulo 0x400.
   *
   * Why? Because some silly external IO cards only decode
   * the low 10 bits of the IO address. The 0x00-0xff region
   * is reserved for motherboard devices that decode all 16
   * bits, so it's ok to allocate at, say, 0x2800-0x28ff,
   * but we want to try to avoid allocating at 0x2900-0x2bff
   * which might have be mirrored at 0x0100-0x03ff..
   */
  resource_size_t
  pcibios_align_resource(void *data, const struct resource *res,
  		       resource_size_t size, resource_size_t align)
  {
  	resource_size_t start = res->start;
  
  	if ((res->flags & IORESOURCE_IO) && (start & 0x300))
  		start = (start + 0x3ff) & ~0x3ff;
  
  	return start;
  }
  
  
  /*
   *  Handle resources of PCI devices.  If the world were perfect, we could
   *  just allocate all the resource regions and do nothing more.  It isn't.
   *  On the other hand, we cannot just re-allocate all devices, as it would
   *  require us to know lots of host bridge internals.  So we attempt to
   *  keep as much of the original configuration as possible, but tweak it
   *  when it's found to be wrong.
   *
   *  Known BIOS problems we have to work around:
   *	- I/O or memory regions not configured
   *	- regions configured, but not enabled in the command register
   *	- bogus I/O addresses above 64K used
   *	- expansion ROMs left enabled (this may sound harmless, but given
   *	  the fact the PCI specs explicitly allow address decoders to be
   *	  shared between expansion ROMs and other resource regions, it's
   *	  at least dangerous)
   *
   *  Our solution:
   *	(1) Allocate resources for all buses behind PCI-to-PCI bridges.
   *	    This gives us fixed barriers on where we can allocate.
   *	(2) Allocate resources for all enabled devices.  If there is
   *	    a collision, just mark the resource as unallocated. Also
   *	    disable expansion ROMs during this step.
   *	(3) Try to allocate resources for disabled devices.  If the
   *	    resources were assigned correctly, everything goes well,
   *	    if they weren't, they won't disturb allocation of other
   *	    resources.
   *	(4) Assign new addresses to resources which were either
   *	    not configured at all or misconfigured.  If explicitly
   *	    requested by the user, configure expansion ROM address
   *	    as well.
   */
  
  static void __init pcibios_allocate_bus_resources(struct list_head *bus_list)
  {
  	struct list_head *ln;
  	struct pci_bus *bus;
  	struct pci_dev *dev;
  	int idx;
  	struct resource *r;
  
  	/* Depth-First Search on bus tree */
  	for (ln=bus_list->next; ln != bus_list; ln=ln->next) {
  		bus = pci_bus_b(ln);
  		if ((dev = bus->self)) {
  			for (idx = PCI_BRIDGE_RESOURCES; idx < PCI_NUM_RESOURCES; idx++) {
  				r = &dev->resource[idx];
  				if (!r->start)
  					continue;
  				pci_claim_resource(dev, idx);
  			}
  		}
  		pcibios_allocate_bus_resources(&bus->children);
  	}
  }
  
  static void __init pcibios_allocate_resources(int pass)
  {
  	struct pci_dev *dev = NULL;
  	int idx, disabled;
  	u16 command;
  	struct resource *r;
  
  	for_each_pci_dev(dev) {
  		pci_read_config_word(dev, PCI_COMMAND, &command);
  		for(idx = 0; idx < 6; idx++) {
  			r = &dev->resource[idx];
  			if (r->parent)		/* Already allocated */
  				continue;
  			if (!r->start)		/* Address not assigned at all */
  				continue;
  			if (r->flags & IORESOURCE_IO)
  				disabled = !(command & PCI_COMMAND_IO);
  			else
  				disabled = !(command & PCI_COMMAND_MEMORY);
  			if (pass == disabled) {
  				DBG("PCI: Resource %08lx-%08lx (f=%lx, d=%d, p=%d)
  ",
  				    r->start, r->end, r->flags, disabled, pass);
  				if (pci_claim_resource(dev, idx) < 0) {
  					/* We'll assign a new address later */
  					r->end -= r->start;
  					r->start = 0;
  				}
  			}
  		}
  		if (!pass) {
  			r = &dev->resource[PCI_ROM_RESOURCE];
  			if (r->flags & IORESOURCE_ROM_ENABLE) {
  				/* Turn the ROM off, leave the resource region, but keep it unregistered. */
  				u32 reg;
  				DBG("PCI: Switching off ROM of %s
  ", pci_name(dev));
  				r->flags &= ~IORESOURCE_ROM_ENABLE;
  				pci_read_config_dword(dev, dev->rom_base_reg, &reg);
  				pci_write_config_dword(dev, dev->rom_base_reg, reg & ~PCI_ROM_ADDRESS_ENABLE);
  			}
  		}
  	}
  }
  
  static void __init pcibios_assign_resources(void)
  {
  	struct pci_dev *dev = NULL;
  	int idx;
  	struct resource *r;
  
  	for_each_pci_dev(dev) {
  		int class = dev->class >> 8;
  
  		/* Don't touch classless devices and host bridges */
  		if (!class || class == PCI_CLASS_BRIDGE_HOST)
  			continue;
  
  		for(idx=0; idx<6; idx++) {
  			r = &dev->resource[idx];
  
  			/*
  			 *  Don't touch IDE controllers and I/O ports of video cards!
  			 */
  			if ((class == PCI_CLASS_STORAGE_IDE && idx < 4) ||
  			    (class == PCI_CLASS_DISPLAY_VGA && (r->flags & IORESOURCE_IO)))
  				continue;
  
  			/*
  			 *  We shall assign a new address to this resource, either because
  			 *  the BIOS forgot to do so or because we have decided the old
  			 *  address was unusable for some reason.
  			 */
  			if (!r->start && r->end)
  				pci_assign_resource(dev, idx);
  		}
  
  		if (pci_probe & PCI_ASSIGN_ROMS) {
  			r = &dev->resource[PCI_ROM_RESOURCE];
  			r->end -= r->start;
  			r->start = 0;
  			if (r->end)
  				pci_assign_resource(dev, PCI_ROM_RESOURCE);
  		}
  	}
  }
  
  void __init pcibios_resource_survey(void)
  {
  	DBG("PCI: Allocating resources
  ");
  	pcibios_allocate_bus_resources(&pci_root_buses);
  	pcibios_allocate_resources(0);
  	pcibios_allocate_resources(1);
  	pcibios_assign_resources();
  }