1
2
3
4
5
6
7
8
9
10
11#include "ops.h"
12#include "stdio.h"
13#include "cuboot.h"
14#include "io.h"
15#include "fsl-soc.h"
16
17#define TARGET_CPM2
18#define TARGET_HAS_ETH1
19#include "ppcboot.h"
20
21static bd_t bd;
22
23struct cs_range {
24 u32 csnum;
25 u32 base;
26 u32 addr;
27 u32 size;
28};
29
30struct pci_range {
31 u32 flags;
32 u32 pci_addr[2];
33 u32 phys_addr;
34 u32 size[2];
35};
36
37struct cs_range cs_ranges_buf[MAX_PROP_LEN / sizeof(struct cs_range)];
38struct pci_range pci_ranges_buf[MAX_PROP_LEN / sizeof(struct pci_range)];
39
40
41
42
43
44
45
46
47
48static void update_cs_ranges(void)
49{
50 void *bus_node, *parent_node;
51 u32 *ctrl_addr;
52 unsigned long ctrl_size;
53 u32 naddr, nsize;
54 int len;
55 int i;
56
57 bus_node = finddevice("/localbus");
58 if (!bus_node || !dt_is_compatible(bus_node, "fsl,pq2-localbus"))
59 return;
60
61 dt_get_reg_format(bus_node, &naddr, &nsize);
62 if (naddr != 2 || nsize != 1)
63 goto err;
64
65 parent_node = get_parent(bus_node);
66 if (!parent_node)
67 goto err;
68
69 dt_get_reg_format(parent_node, &naddr, &nsize);
70 if (naddr != 1 || nsize != 1)
71 goto err;
72
73 if (!dt_xlate_reg(bus_node, 0, (unsigned long *)&ctrl_addr,
74 &ctrl_size))
75 goto err;
76
77 len = getprop(bus_node, "ranges", cs_ranges_buf, sizeof(cs_ranges_buf));
78
79 for (i = 0; i < len / sizeof(struct cs_range); i++) {
80 u32 base, option;
81 int cs = cs_ranges_buf[i].csnum;
82 if (cs >= ctrl_size / 8)
83 goto err;
84
85 if (cs_ranges_buf[i].base != 0)
86 goto err;
87
88 base = in_be32(&ctrl_addr[cs * 2]);
89
90
91
92
93 if (base & 1) {
94 base &= 0x7fff;
95 option = in_be32(&ctrl_addr[cs * 2 + 1]) & 0x7fff;
96 } else {
97 base = 0x1801;
98 option = 0x10;
99 }
100
101 out_be32(&ctrl_addr[cs * 2], 0);
102 out_be32(&ctrl_addr[cs * 2 + 1],
103 option | ~(cs_ranges_buf[i].size - 1));
104 out_be32(&ctrl_addr[cs * 2], base | cs_ranges_buf[i].addr);
105 }
106
107 return;
108
109err:
110 printf("Bad /localbus node\r\n");
111}
112
113
114
115
116
117
118
119
120static void fixup_pci(void)
121{
122 struct pci_range *mem = NULL, *mmio = NULL,
123 *io = NULL, *mem_base = NULL;
124 u32 *pci_regs[3];
125 u8 *soc_regs;
126 int i, len;
127 void *node, *parent_node;
128 u32 naddr, nsize, mem_pow2, mem_mask;
129
130 node = finddevice("/pci");
131 if (!node || !dt_is_compatible(node, "fsl,pq2-pci"))
132 return;
133
134 for (i = 0; i < 3; i++)
135 if (!dt_xlate_reg(node, i,
136 (unsigned long *)&pci_regs[i], NULL))
137 goto err;
138
139 soc_regs = (u8 *)fsl_get_immr();
140 if (!soc_regs)
141 goto unhandled;
142
143 dt_get_reg_format(node, &naddr, &nsize);
144 if (naddr != 3 || nsize != 2)
145 goto err;
146
147 parent_node = get_parent(node);
148 if (!parent_node)
149 goto err;
150
151 dt_get_reg_format(parent_node, &naddr, &nsize);
152 if (naddr != 1 || nsize != 1)
153 goto unhandled;
154
155 len = getprop(node, "ranges", pci_ranges_buf,
156 sizeof(pci_ranges_buf));
157
158 for (i = 0; i < len / sizeof(struct pci_range); i++) {
159 u32 flags = pci_ranges_buf[i].flags & 0x43000000;
160
161 if (flags == 0x42000000)
162 mem = &pci_ranges_buf[i];
163 else if (flags == 0x02000000)
164 mmio = &pci_ranges_buf[i];
165 else if (flags == 0x01000000)
166 io = &pci_ranges_buf[i];
167 }
168
169 if (!mem || !mmio || !io)
170 goto unhandled;
171 if (mem->size[1] != mmio->size[1])
172 goto unhandled;
173 if (mem->size[1] & (mem->size[1] - 1))
174 goto unhandled;
175 if (io->size[1] & (io->size[1] - 1))
176 goto unhandled;
177
178 if (mem->phys_addr + mem->size[1] == mmio->phys_addr)
179 mem_base = mem;
180 else if (mmio->phys_addr + mmio->size[1] == mem->phys_addr)
181 mem_base = mmio;
182 else
183 goto unhandled;
184
185 out_be32(&pci_regs[1][0], mem_base->phys_addr | 1);
186 out_be32(&pci_regs[2][0], ~(mem->size[1] + mmio->size[1] - 1));
187
188 out_be32(&pci_regs[1][1], io->phys_addr | 1);
189 out_be32(&pci_regs[2][1], ~(io->size[1] - 1));
190
191 out_le32(&pci_regs[0][0], mem->pci_addr[1] >> 12);
192 out_le32(&pci_regs[0][2], mem->phys_addr >> 12);
193 out_le32(&pci_regs[0][4], (~(mem->size[1] - 1) >> 12) | 0xa0000000);
194
195 out_le32(&pci_regs[0][6], mmio->pci_addr[1] >> 12);
196 out_le32(&pci_regs[0][8], mmio->phys_addr >> 12);
197 out_le32(&pci_regs[0][10], (~(mmio->size[1] - 1) >> 12) | 0x80000000);
198
199 out_le32(&pci_regs[0][12], io->pci_addr[1] >> 12);
200 out_le32(&pci_regs[0][14], io->phys_addr >> 12);
201 out_le32(&pci_regs[0][16], (~(io->size[1] - 1) >> 12) | 0xc0000000);
202
203
204 out_le32(&pci_regs[0][58], 0);
205 out_le32(&pci_regs[0][60], 0);
206
207 mem_pow2 = 1 << (__ilog2_u32(bd.bi_memsize - 1) + 1);
208 mem_mask = ~(mem_pow2 - 1) >> 12;
209 out_le32(&pci_regs[0][62], 0xa0000000 | mem_mask);
210
211
212 if (!(in_le32(&pci_regs[0][32]) & 1)) {
213
214 udelay(100000);
215
216 out_le32(&pci_regs[0][32], 1);
217
218
219 udelay(1020000);
220 }
221
222
223 out_le32(&pci_regs[0][64], 0x80000004);
224 out_le32(&pci_regs[0][65], in_le32(&pci_regs[0][65]) | 6);
225
226
227
228
229 out_8(&soc_regs[0x10028], 3);
230 out_be32((u32 *)&soc_regs[0x1002c], 0x01236745);
231
232 return;
233
234err:
235 printf("Bad PCI node -- using existing firmware setup.\r\n");
236 return;
237
238unhandled:
239 printf("Unsupported PCI node -- using existing firmware setup.\r\n");
240}
241
242static void pq2_platform_fixups(void)
243{
244 void *node;
245
246 dt_fixup_memory(bd.bi_memstart, bd.bi_memsize);
247 dt_fixup_mac_addresses(bd.bi_enetaddr, bd.bi_enet1addr);
248 dt_fixup_cpu_clocks(bd.bi_intfreq, bd.bi_busfreq / 4, bd.bi_busfreq);
249
250 node = finddevice("/soc/cpm");
251 if (node)
252 setprop(node, "clock-frequency", &bd.bi_cpmfreq, 4);
253
254 node = finddevice("/soc/cpm/brg");
255 if (node)
256 setprop(node, "clock-frequency", &bd.bi_brgfreq, 4);
257
258 update_cs_ranges();
259 fixup_pci();
260}
261
262void platform_init(unsigned long r3, unsigned long r4, unsigned long r5,
263 unsigned long r6, unsigned long r7)
264{
265 CUBOOT_INIT();
266 fdt_init(_dtb_start);
267 serial_console_init();
268 platform_ops.fixups = pq2_platform_fixups;
269}
270