Loading...
1/*
2 * Sonics Silicon Backplane
3 * Broadcom MIPS core driver
4 *
5 * Copyright 2005, Broadcom Corporation
6 * Copyright 2006, 2007, Michael Buesch <m@bues.ch>
7 *
8 * Licensed under the GNU/GPL. See COPYING for details.
9 */
10
11#include <linux/ssb/ssb.h>
12
13#include <linux/mtd/physmap.h>
14#include <linux/serial.h>
15#include <linux/serial_core.h>
16#include <linux/serial_reg.h>
17#include <linux/time.h>
18#ifdef CONFIG_BCM47XX
19#include <linux/bcm47xx_nvram.h>
20#endif
21
22#include "ssb_private.h"
23
24static const char * const part_probes[] = { "bcm47xxpart", NULL };
25
26static struct physmap_flash_data ssb_pflash_data = {
27 .part_probe_types = part_probes,
28};
29
30static struct resource ssb_pflash_resource = {
31 .name = "ssb_pflash",
32 .flags = IORESOURCE_MEM,
33};
34
35struct platform_device ssb_pflash_dev = {
36 .name = "physmap-flash",
37 .dev = {
38 .platform_data = &ssb_pflash_data,
39 },
40 .resource = &ssb_pflash_resource,
41 .num_resources = 1,
42};
43
44static inline u32 mips_read32(struct ssb_mipscore *mcore,
45 u16 offset)
46{
47 return ssb_read32(mcore->dev, offset);
48}
49
50static inline void mips_write32(struct ssb_mipscore *mcore,
51 u16 offset,
52 u32 value)
53{
54 ssb_write32(mcore->dev, offset, value);
55}
56
57static const u32 ipsflag_irq_mask[] = {
58 0,
59 SSB_IPSFLAG_IRQ1,
60 SSB_IPSFLAG_IRQ2,
61 SSB_IPSFLAG_IRQ3,
62 SSB_IPSFLAG_IRQ4,
63};
64
65static const u32 ipsflag_irq_shift[] = {
66 0,
67 SSB_IPSFLAG_IRQ1_SHIFT,
68 SSB_IPSFLAG_IRQ2_SHIFT,
69 SSB_IPSFLAG_IRQ3_SHIFT,
70 SSB_IPSFLAG_IRQ4_SHIFT,
71};
72
73static inline u32 ssb_irqflag(struct ssb_device *dev)
74{
75 u32 tpsflag = ssb_read32(dev, SSB_TPSFLAG);
76 if (tpsflag)
77 return ssb_read32(dev, SSB_TPSFLAG) & SSB_TPSFLAG_BPFLAG;
78 else
79 /* not irq supported */
80 return 0x3f;
81}
82
83static struct ssb_device *find_device(struct ssb_device *rdev, int irqflag)
84{
85 struct ssb_bus *bus = rdev->bus;
86 int i;
87 for (i = 0; i < bus->nr_devices; i++) {
88 struct ssb_device *dev;
89 dev = &(bus->devices[i]);
90 if (ssb_irqflag(dev) == irqflag)
91 return dev;
92 }
93 return NULL;
94}
95
96/* Get the MIPS IRQ assignment for a specified device.
97 * If unassigned, 0 is returned.
98 * If disabled, 5 is returned.
99 * If not supported, 6 is returned.
100 */
101unsigned int ssb_mips_irq(struct ssb_device *dev)
102{
103 struct ssb_bus *bus = dev->bus;
104 struct ssb_device *mdev = bus->mipscore.dev;
105 u32 irqflag;
106 u32 ipsflag;
107 u32 tmp;
108 unsigned int irq;
109
110 irqflag = ssb_irqflag(dev);
111 if (irqflag == 0x3f)
112 return 6;
113 ipsflag = ssb_read32(bus->mipscore.dev, SSB_IPSFLAG);
114 for (irq = 1; irq <= 4; irq++) {
115 tmp = ((ipsflag & ipsflag_irq_mask[irq]) >> ipsflag_irq_shift[irq]);
116 if (tmp == irqflag)
117 break;
118 }
119 if (irq == 5) {
120 if ((1 << irqflag) & ssb_read32(mdev, SSB_INTVEC))
121 irq = 0;
122 }
123
124 return irq;
125}
126
127static void clear_irq(struct ssb_bus *bus, unsigned int irq)
128{
129 struct ssb_device *dev = bus->mipscore.dev;
130
131 /* Clear the IRQ in the MIPScore backplane registers */
132 if (irq == 0) {
133 ssb_write32(dev, SSB_INTVEC, 0);
134 } else {
135 ssb_write32(dev, SSB_IPSFLAG,
136 ssb_read32(dev, SSB_IPSFLAG) |
137 ipsflag_irq_mask[irq]);
138 }
139}
140
141static void set_irq(struct ssb_device *dev, unsigned int irq)
142{
143 unsigned int oldirq = ssb_mips_irq(dev);
144 struct ssb_bus *bus = dev->bus;
145 struct ssb_device *mdev = bus->mipscore.dev;
146 u32 irqflag = ssb_irqflag(dev);
147
148 BUG_ON(oldirq == 6);
149
150 dev->irq = irq + 2;
151
152 /* clear the old irq */
153 if (oldirq == 0)
154 ssb_write32(mdev, SSB_INTVEC, (~(1 << irqflag) & ssb_read32(mdev, SSB_INTVEC)));
155 else if (oldirq != 5)
156 clear_irq(bus, oldirq);
157
158 /* assign the new one */
159 if (irq == 0) {
160 ssb_write32(mdev, SSB_INTVEC, ((1 << irqflag) | ssb_read32(mdev, SSB_INTVEC)));
161 } else {
162 u32 ipsflag = ssb_read32(mdev, SSB_IPSFLAG);
163 if ((ipsflag & ipsflag_irq_mask[irq]) != ipsflag_irq_mask[irq]) {
164 u32 oldipsflag = (ipsflag & ipsflag_irq_mask[irq]) >> ipsflag_irq_shift[irq];
165 struct ssb_device *olddev = find_device(dev, oldipsflag);
166 if (olddev)
167 set_irq(olddev, 0);
168 }
169 irqflag <<= ipsflag_irq_shift[irq];
170 irqflag |= (ipsflag & ~ipsflag_irq_mask[irq]);
171 ssb_write32(mdev, SSB_IPSFLAG, irqflag);
172 }
173 ssb_dbg("set_irq: core 0x%04x, irq %d => %d\n",
174 dev->id.coreid, oldirq+2, irq+2);
175}
176
177static void print_irq(struct ssb_device *dev, unsigned int irq)
178{
179 static const char *irq_name[] = {"2(S)", "3", "4", "5", "6", "D", "I"};
180 ssb_dbg("core 0x%04x, irq : %s%s %s%s %s%s %s%s %s%s %s%s %s%s\n",
181 dev->id.coreid,
182 irq_name[0], irq == 0 ? "*" : " ",
183 irq_name[1], irq == 1 ? "*" : " ",
184 irq_name[2], irq == 2 ? "*" : " ",
185 irq_name[3], irq == 3 ? "*" : " ",
186 irq_name[4], irq == 4 ? "*" : " ",
187 irq_name[5], irq == 5 ? "*" : " ",
188 irq_name[6], irq == 6 ? "*" : " ");
189}
190
191static void dump_irq(struct ssb_bus *bus)
192{
193 int i;
194 for (i = 0; i < bus->nr_devices; i++) {
195 struct ssb_device *dev;
196 dev = &(bus->devices[i]);
197 print_irq(dev, ssb_mips_irq(dev));
198 }
199}
200
201static void ssb_mips_serial_init(struct ssb_mipscore *mcore)
202{
203 struct ssb_bus *bus = mcore->dev->bus;
204
205 if (ssb_extif_available(&bus->extif))
206 mcore->nr_serial_ports = ssb_extif_serial_init(&bus->extif, mcore->serial_ports);
207 else if (ssb_chipco_available(&bus->chipco))
208 mcore->nr_serial_ports = ssb_chipco_serial_init(&bus->chipco, mcore->serial_ports);
209 else
210 mcore->nr_serial_ports = 0;
211}
212
213static void ssb_mips_flash_detect(struct ssb_mipscore *mcore)
214{
215 struct ssb_bus *bus = mcore->dev->bus;
216 struct ssb_sflash *sflash = &mcore->sflash;
217 struct ssb_pflash *pflash = &mcore->pflash;
218
219 /* When there is no chipcommon on the bus there is 4MB flash */
220 if (!ssb_chipco_available(&bus->chipco)) {
221 pflash->present = true;
222 pflash->buswidth = 2;
223 pflash->window = SSB_FLASH1;
224 pflash->window_size = SSB_FLASH1_SZ;
225 goto ssb_pflash;
226 }
227
228 /* There is ChipCommon, so use it to read info about flash */
229 switch (bus->chipco.capabilities & SSB_CHIPCO_CAP_FLASHT) {
230 case SSB_CHIPCO_FLASHT_STSER:
231 case SSB_CHIPCO_FLASHT_ATSER:
232 pr_debug("Found serial flash\n");
233 ssb_sflash_init(&bus->chipco);
234 break;
235 case SSB_CHIPCO_FLASHT_PARA:
236 pr_debug("Found parallel flash\n");
237 pflash->present = true;
238 pflash->window = SSB_FLASH2;
239 pflash->window_size = SSB_FLASH2_SZ;
240 if ((ssb_read32(bus->chipco.dev, SSB_CHIPCO_FLASH_CFG)
241 & SSB_CHIPCO_CFG_DS16) == 0)
242 pflash->buswidth = 1;
243 else
244 pflash->buswidth = 2;
245 break;
246 }
247
248ssb_pflash:
249 if (sflash->present) {
250#ifdef CONFIG_BCM47XX
251 bcm47xx_nvram_init_from_mem(sflash->window, sflash->size);
252#endif
253 } else if (pflash->present) {
254#ifdef CONFIG_BCM47XX
255 bcm47xx_nvram_init_from_mem(pflash->window, pflash->window_size);
256#endif
257
258 ssb_pflash_data.width = pflash->buswidth;
259 ssb_pflash_resource.start = pflash->window;
260 ssb_pflash_resource.end = pflash->window + pflash->window_size;
261 }
262}
263
264u32 ssb_cpu_clock(struct ssb_mipscore *mcore)
265{
266 struct ssb_bus *bus = mcore->dev->bus;
267 u32 pll_type, n, m, rate = 0;
268
269 if (bus->chipco.capabilities & SSB_CHIPCO_CAP_PMU)
270 return ssb_pmu_get_cpu_clock(&bus->chipco);
271
272 if (ssb_extif_available(&bus->extif)) {
273 ssb_extif_get_clockcontrol(&bus->extif, &pll_type, &n, &m);
274 } else if (ssb_chipco_available(&bus->chipco)) {
275 ssb_chipco_get_clockcpu(&bus->chipco, &pll_type, &n, &m);
276 } else
277 return 0;
278
279 if ((pll_type == SSB_PLLTYPE_5) || (bus->chip_id == 0x5365)) {
280 rate = 200000000;
281 } else {
282 rate = ssb_calc_clock_rate(pll_type, n, m);
283 }
284
285 if (pll_type == SSB_PLLTYPE_6) {
286 rate *= 2;
287 }
288
289 return rate;
290}
291
292void ssb_mipscore_init(struct ssb_mipscore *mcore)
293{
294 struct ssb_bus *bus;
295 struct ssb_device *dev;
296 unsigned long hz, ns;
297 unsigned int irq, i;
298
299 if (!mcore->dev)
300 return; /* We don't have a MIPS core */
301
302 ssb_dbg("Initializing MIPS core...\n");
303
304 bus = mcore->dev->bus;
305 hz = ssb_clockspeed(bus);
306 if (!hz)
307 hz = 100000000;
308 ns = 1000000000 / hz;
309
310 if (ssb_extif_available(&bus->extif))
311 ssb_extif_timing_init(&bus->extif, ns);
312 else if (ssb_chipco_available(&bus->chipco))
313 ssb_chipco_timing_init(&bus->chipco, ns);
314
315 /* Assign IRQs to all cores on the bus, start with irq line 2, because serial usually takes 1 */
316 for (irq = 2, i = 0; i < bus->nr_devices; i++) {
317 int mips_irq;
318 dev = &(bus->devices[i]);
319 mips_irq = ssb_mips_irq(dev);
320 if (mips_irq > 4)
321 dev->irq = 0;
322 else
323 dev->irq = mips_irq + 2;
324 if (dev->irq > 5)
325 continue;
326 switch (dev->id.coreid) {
327 case SSB_DEV_USB11_HOST:
328 /* shouldn't need a separate irq line for non-4710, most of them have a proper
329 * external usb controller on the pci */
330 if ((bus->chip_id == 0x4710) && (irq <= 4)) {
331 set_irq(dev, irq++);
332 }
333 break;
334 case SSB_DEV_PCI:
335 case SSB_DEV_ETHERNET:
336 case SSB_DEV_ETHERNET_GBIT:
337 case SSB_DEV_80211:
338 case SSB_DEV_USB20_HOST:
339 /* These devices get their own IRQ line if available, the rest goes on IRQ0 */
340 if (irq <= 4) {
341 set_irq(dev, irq++);
342 break;
343 }
344 /* fallthrough */
345 case SSB_DEV_EXTIF:
346 set_irq(dev, 0);
347 break;
348 }
349 }
350 ssb_dbg("after irq reconfiguration\n");
351 dump_irq(bus);
352
353 ssb_mips_serial_init(mcore);
354 ssb_mips_flash_detect(mcore);
355}
1/*
2 * Sonics Silicon Backplane
3 * Broadcom MIPS core driver
4 *
5 * Copyright 2005, Broadcom Corporation
6 * Copyright 2006, 2007, Michael Buesch <m@bues.ch>
7 *
8 * Licensed under the GNU/GPL. See COPYING for details.
9 */
10
11#include <linux/ssb/ssb.h>
12
13#include <linux/serial.h>
14#include <linux/serial_core.h>
15#include <linux/serial_reg.h>
16#include <linux/time.h>
17
18#include "ssb_private.h"
19
20
21static inline u32 mips_read32(struct ssb_mipscore *mcore,
22 u16 offset)
23{
24 return ssb_read32(mcore->dev, offset);
25}
26
27static inline void mips_write32(struct ssb_mipscore *mcore,
28 u16 offset,
29 u32 value)
30{
31 ssb_write32(mcore->dev, offset, value);
32}
33
34static const u32 ipsflag_irq_mask[] = {
35 0,
36 SSB_IPSFLAG_IRQ1,
37 SSB_IPSFLAG_IRQ2,
38 SSB_IPSFLAG_IRQ3,
39 SSB_IPSFLAG_IRQ4,
40};
41
42static const u32 ipsflag_irq_shift[] = {
43 0,
44 SSB_IPSFLAG_IRQ1_SHIFT,
45 SSB_IPSFLAG_IRQ2_SHIFT,
46 SSB_IPSFLAG_IRQ3_SHIFT,
47 SSB_IPSFLAG_IRQ4_SHIFT,
48};
49
50static inline u32 ssb_irqflag(struct ssb_device *dev)
51{
52 u32 tpsflag = ssb_read32(dev, SSB_TPSFLAG);
53 if (tpsflag)
54 return ssb_read32(dev, SSB_TPSFLAG) & SSB_TPSFLAG_BPFLAG;
55 else
56 /* not irq supported */
57 return 0x3f;
58}
59
60static struct ssb_device *find_device(struct ssb_device *rdev, int irqflag)
61{
62 struct ssb_bus *bus = rdev->bus;
63 int i;
64 for (i = 0; i < bus->nr_devices; i++) {
65 struct ssb_device *dev;
66 dev = &(bus->devices[i]);
67 if (ssb_irqflag(dev) == irqflag)
68 return dev;
69 }
70 return NULL;
71}
72
73/* Get the MIPS IRQ assignment for a specified device.
74 * If unassigned, 0 is returned.
75 * If disabled, 5 is returned.
76 * If not supported, 6 is returned.
77 */
78unsigned int ssb_mips_irq(struct ssb_device *dev)
79{
80 struct ssb_bus *bus = dev->bus;
81 struct ssb_device *mdev = bus->mipscore.dev;
82 u32 irqflag;
83 u32 ipsflag;
84 u32 tmp;
85 unsigned int irq;
86
87 irqflag = ssb_irqflag(dev);
88 if (irqflag == 0x3f)
89 return 6;
90 ipsflag = ssb_read32(bus->mipscore.dev, SSB_IPSFLAG);
91 for (irq = 1; irq <= 4; irq++) {
92 tmp = ((ipsflag & ipsflag_irq_mask[irq]) >> ipsflag_irq_shift[irq]);
93 if (tmp == irqflag)
94 break;
95 }
96 if (irq == 5) {
97 if ((1 << irqflag) & ssb_read32(mdev, SSB_INTVEC))
98 irq = 0;
99 }
100
101 return irq;
102}
103
104static void clear_irq(struct ssb_bus *bus, unsigned int irq)
105{
106 struct ssb_device *dev = bus->mipscore.dev;
107
108 /* Clear the IRQ in the MIPScore backplane registers */
109 if (irq == 0) {
110 ssb_write32(dev, SSB_INTVEC, 0);
111 } else {
112 ssb_write32(dev, SSB_IPSFLAG,
113 ssb_read32(dev, SSB_IPSFLAG) |
114 ipsflag_irq_mask[irq]);
115 }
116}
117
118static void set_irq(struct ssb_device *dev, unsigned int irq)
119{
120 unsigned int oldirq = ssb_mips_irq(dev);
121 struct ssb_bus *bus = dev->bus;
122 struct ssb_device *mdev = bus->mipscore.dev;
123 u32 irqflag = ssb_irqflag(dev);
124
125 BUG_ON(oldirq == 6);
126
127 dev->irq = irq + 2;
128
129 /* clear the old irq */
130 if (oldirq == 0)
131 ssb_write32(mdev, SSB_INTVEC, (~(1 << irqflag) & ssb_read32(mdev, SSB_INTVEC)));
132 else if (oldirq != 5)
133 clear_irq(bus, oldirq);
134
135 /* assign the new one */
136 if (irq == 0) {
137 ssb_write32(mdev, SSB_INTVEC, ((1 << irqflag) | ssb_read32(mdev, SSB_INTVEC)));
138 } else {
139 u32 ipsflag = ssb_read32(mdev, SSB_IPSFLAG);
140 if ((ipsflag & ipsflag_irq_mask[irq]) != ipsflag_irq_mask[irq]) {
141 u32 oldipsflag = (ipsflag & ipsflag_irq_mask[irq]) >> ipsflag_irq_shift[irq];
142 struct ssb_device *olddev = find_device(dev, oldipsflag);
143 if (olddev)
144 set_irq(olddev, 0);
145 }
146 irqflag <<= ipsflag_irq_shift[irq];
147 irqflag |= (ipsflag & ~ipsflag_irq_mask[irq]);
148 ssb_write32(mdev, SSB_IPSFLAG, irqflag);
149 }
150 ssb_dprintk(KERN_INFO PFX
151 "set_irq: core 0x%04x, irq %d => %d\n",
152 dev->id.coreid, oldirq+2, irq+2);
153}
154
155static void print_irq(struct ssb_device *dev, unsigned int irq)
156{
157 int i;
158 static const char *irq_name[] = {"2(S)", "3", "4", "5", "6", "D", "I"};
159 ssb_dprintk(KERN_INFO PFX
160 "core 0x%04x, irq :", dev->id.coreid);
161 for (i = 0; i <= 6; i++) {
162 ssb_dprintk(" %s%s", irq_name[i], i==irq?"*":" ");
163 }
164 ssb_dprintk("\n");
165}
166
167static void dump_irq(struct ssb_bus *bus)
168{
169 int i;
170 for (i = 0; i < bus->nr_devices; i++) {
171 struct ssb_device *dev;
172 dev = &(bus->devices[i]);
173 print_irq(dev, ssb_mips_irq(dev));
174 }
175}
176
177static void ssb_mips_serial_init(struct ssb_mipscore *mcore)
178{
179 struct ssb_bus *bus = mcore->dev->bus;
180
181 if (bus->extif.dev)
182 mcore->nr_serial_ports = ssb_extif_serial_init(&bus->extif, mcore->serial_ports);
183 else if (bus->chipco.dev)
184 mcore->nr_serial_ports = ssb_chipco_serial_init(&bus->chipco, mcore->serial_ports);
185 else
186 mcore->nr_serial_ports = 0;
187}
188
189static void ssb_mips_flash_detect(struct ssb_mipscore *mcore)
190{
191 struct ssb_bus *bus = mcore->dev->bus;
192
193 mcore->flash_buswidth = 2;
194 if (bus->chipco.dev) {
195 mcore->flash_window = 0x1c000000;
196 mcore->flash_window_size = 0x02000000;
197 if ((ssb_read32(bus->chipco.dev, SSB_CHIPCO_FLASH_CFG)
198 & SSB_CHIPCO_CFG_DS16) == 0)
199 mcore->flash_buswidth = 1;
200 } else {
201 mcore->flash_window = 0x1fc00000;
202 mcore->flash_window_size = 0x00400000;
203 }
204}
205
206u32 ssb_cpu_clock(struct ssb_mipscore *mcore)
207{
208 struct ssb_bus *bus = mcore->dev->bus;
209 u32 pll_type, n, m, rate = 0;
210
211 if (bus->chipco.capabilities & SSB_CHIPCO_CAP_PMU)
212 return ssb_pmu_get_cpu_clock(&bus->chipco);
213
214 if (bus->extif.dev) {
215 ssb_extif_get_clockcontrol(&bus->extif, &pll_type, &n, &m);
216 } else if (bus->chipco.dev) {
217 ssb_chipco_get_clockcpu(&bus->chipco, &pll_type, &n, &m);
218 } else
219 return 0;
220
221 if ((pll_type == SSB_PLLTYPE_5) || (bus->chip_id == 0x5365)) {
222 rate = 200000000;
223 } else {
224 rate = ssb_calc_clock_rate(pll_type, n, m);
225 }
226
227 if (pll_type == SSB_PLLTYPE_6) {
228 rate *= 2;
229 }
230
231 return rate;
232}
233
234void ssb_mipscore_init(struct ssb_mipscore *mcore)
235{
236 struct ssb_bus *bus;
237 struct ssb_device *dev;
238 unsigned long hz, ns;
239 unsigned int irq, i;
240
241 if (!mcore->dev)
242 return; /* We don't have a MIPS core */
243
244 ssb_dprintk(KERN_INFO PFX "Initializing MIPS core...\n");
245
246 bus = mcore->dev->bus;
247 hz = ssb_clockspeed(bus);
248 if (!hz)
249 hz = 100000000;
250 ns = 1000000000 / hz;
251
252 if (bus->extif.dev)
253 ssb_extif_timing_init(&bus->extif, ns);
254 else if (bus->chipco.dev)
255 ssb_chipco_timing_init(&bus->chipco, ns);
256
257 /* Assign IRQs to all cores on the bus, start with irq line 2, because serial usually takes 1 */
258 for (irq = 2, i = 0; i < bus->nr_devices; i++) {
259 int mips_irq;
260 dev = &(bus->devices[i]);
261 mips_irq = ssb_mips_irq(dev);
262 if (mips_irq > 4)
263 dev->irq = 0;
264 else
265 dev->irq = mips_irq + 2;
266 if (dev->irq > 5)
267 continue;
268 switch (dev->id.coreid) {
269 case SSB_DEV_USB11_HOST:
270 /* shouldn't need a separate irq line for non-4710, most of them have a proper
271 * external usb controller on the pci */
272 if ((bus->chip_id == 0x4710) && (irq <= 4)) {
273 set_irq(dev, irq++);
274 }
275 break;
276 case SSB_DEV_PCI:
277 case SSB_DEV_ETHERNET:
278 case SSB_DEV_ETHERNET_GBIT:
279 case SSB_DEV_80211:
280 case SSB_DEV_USB20_HOST:
281 /* These devices get their own IRQ line if available, the rest goes on IRQ0 */
282 if (irq <= 4) {
283 set_irq(dev, irq++);
284 break;
285 }
286 /* fallthrough */
287 case SSB_DEV_EXTIF:
288 set_irq(dev, 0);
289 break;
290 }
291 }
292 ssb_dprintk(KERN_INFO PFX "after irq reconfiguration\n");
293 dump_irq(bus);
294
295 ssb_mips_serial_init(mcore);
296 ssb_mips_flash_detect(mcore);
297}