blob: 3fd3e3b412b6598d0c32a70bc691ced97769a596 [file] [log] [blame]
Michael Buesch61e115a2007-09-18 15:12:50 -04001/*
2 * Sonics Silicon Backplane
3 * Broadcom MIPS core driver
4 *
5 * Copyright 2005, Broadcom Corporation
6 * Copyright 2006, 2007, Michael Buesch <mb@bu3sch.de>
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 return ssb_read32(dev, SSB_TPSFLAG) & SSB_TPSFLAG_BPFLAG;
53}
54
55/* Get the MIPS IRQ assignment for a specified device.
56 * If unassigned, 0 is returned.
57 */
58unsigned int ssb_mips_irq(struct ssb_device *dev)
59{
60 struct ssb_bus *bus = dev->bus;
61 u32 irqflag;
62 u32 ipsflag;
63 u32 tmp;
64 unsigned int irq;
65
66 irqflag = ssb_irqflag(dev);
67 ipsflag = ssb_read32(bus->mipscore.dev, SSB_IPSFLAG);
68 for (irq = 1; irq <= 4; irq++) {
69 tmp = ((ipsflag & ipsflag_irq_mask[irq]) >> ipsflag_irq_shift[irq]);
70 if (tmp == irqflag)
71 break;
72 }
73 if (irq == 5)
74 irq = 0;
75
76 return irq;
77}
78
79static void clear_irq(struct ssb_bus *bus, unsigned int irq)
80{
81 struct ssb_device *dev = bus->mipscore.dev;
82
83 /* Clear the IRQ in the MIPScore backplane registers */
84 if (irq == 0) {
85 ssb_write32(dev, SSB_INTVEC, 0);
86 } else {
87 ssb_write32(dev, SSB_IPSFLAG,
88 ssb_read32(dev, SSB_IPSFLAG) |
89 ipsflag_irq_mask[irq]);
90 }
91}
92
93static void set_irq(struct ssb_device *dev, unsigned int irq)
94{
95 unsigned int oldirq = ssb_mips_irq(dev);
96 struct ssb_bus *bus = dev->bus;
97 struct ssb_device *mdev = bus->mipscore.dev;
98 u32 irqflag = ssb_irqflag(dev);
99
100 dev->irq = irq + 2;
101
102 ssb_dprintk(KERN_INFO PFX
103 "set_irq: core 0x%04x, irq %d => %d\n",
104 dev->id.coreid, oldirq, irq);
105 /* clear the old irq */
106 if (oldirq == 0)
107 ssb_write32(mdev, SSB_INTVEC, (~(1 << irqflag) & ssb_read32(mdev, SSB_INTVEC)));
108 else
109 clear_irq(bus, oldirq);
110
111 /* assign the new one */
Michael Buesch2633da22008-04-08 11:17:29 +0200112 if (irq == 0) {
113 ssb_write32(mdev, SSB_INTVEC, ((1 << irqflag) | ssb_read32(mdev, SSB_INTVEC)));
114 } else {
115 irqflag <<= ipsflag_irq_shift[irq];
116 irqflag |= (ssb_read32(mdev, SSB_IPSFLAG) & ~ipsflag_irq_mask[irq]);
117 ssb_write32(mdev, SSB_IPSFLAG, irqflag);
118 }
Michael Buesch61e115a2007-09-18 15:12:50 -0400119}
120
121static void ssb_mips_serial_init(struct ssb_mipscore *mcore)
122{
123 struct ssb_bus *bus = mcore->dev->bus;
124
125 if (bus->extif.dev)
126 mcore->nr_serial_ports = ssb_extif_serial_init(&bus->extif, mcore->serial_ports);
127 else if (bus->chipco.dev)
128 mcore->nr_serial_ports = ssb_chipco_serial_init(&bus->chipco, mcore->serial_ports);
129 else
130 mcore->nr_serial_ports = 0;
131}
132
133static void ssb_mips_flash_detect(struct ssb_mipscore *mcore)
134{
135 struct ssb_bus *bus = mcore->dev->bus;
136
137 mcore->flash_buswidth = 2;
138 if (bus->chipco.dev) {
139 mcore->flash_window = 0x1c000000;
140 mcore->flash_window_size = 0x02000000;
141 if ((ssb_read32(bus->chipco.dev, SSB_CHIPCO_FLASH_CFG)
142 & SSB_CHIPCO_CFG_DS16) == 0)
143 mcore->flash_buswidth = 1;
144 } else {
145 mcore->flash_window = 0x1fc00000;
146 mcore->flash_window_size = 0x00400000;
147 }
148}
149
150u32 ssb_cpu_clock(struct ssb_mipscore *mcore)
151{
152 struct ssb_bus *bus = mcore->dev->bus;
153 u32 pll_type, n, m, rate = 0;
154
155 if (bus->extif.dev) {
156 ssb_extif_get_clockcontrol(&bus->extif, &pll_type, &n, &m);
157 } else if (bus->chipco.dev) {
158 ssb_chipco_get_clockcpu(&bus->chipco, &pll_type, &n, &m);
159 } else
160 return 0;
161
162 if ((pll_type == SSB_PLLTYPE_5) || (bus->chip_id == 0x5365)) {
163 rate = 200000000;
164 } else {
165 rate = ssb_calc_clock_rate(pll_type, n, m);
166 }
167
168 if (pll_type == SSB_PLLTYPE_6) {
169 rate *= 2;
170 }
171
172 return rate;
173}
174
175void ssb_mipscore_init(struct ssb_mipscore *mcore)
176{
Felix Fietkau7007d00ca2007-10-14 21:04:22 +0200177 struct ssb_bus *bus;
Michael Buesch61e115a2007-09-18 15:12:50 -0400178 struct ssb_device *dev;
179 unsigned long hz, ns;
180 unsigned int irq, i;
181
182 if (!mcore->dev)
183 return; /* We don't have a MIPS core */
184
185 ssb_dprintk(KERN_INFO PFX "Initializing MIPS core...\n");
186
Felix Fietkau7007d00ca2007-10-14 21:04:22 +0200187 bus = mcore->dev->bus;
Michael Buesch61e115a2007-09-18 15:12:50 -0400188 hz = ssb_clockspeed(bus);
189 if (!hz)
190 hz = 100000000;
191 ns = 1000000000 / hz;
192
193 if (bus->extif.dev)
194 ssb_extif_timing_init(&bus->extif, ns);
195 else if (bus->chipco.dev)
196 ssb_chipco_timing_init(&bus->chipco, ns);
197
198 /* Assign IRQs to all cores on the bus, start with irq line 2, because serial usually takes 1 */
199 for (irq = 2, i = 0; i < bus->nr_devices; i++) {
200 dev = &(bus->devices[i]);
201 dev->irq = ssb_mips_irq(dev) + 2;
202 switch (dev->id.coreid) {
203 case SSB_DEV_USB11_HOST:
204 /* shouldn't need a separate irq line for non-4710, most of them have a proper
205 * external usb controller on the pci */
206 if ((bus->chip_id == 0x4710) && (irq <= 4)) {
207 set_irq(dev, irq++);
208 break;
209 }
210 /* fallthrough */
211 case SSB_DEV_PCI:
212 case SSB_DEV_ETHERNET:
Michael Bueschaab547c2008-02-29 11:36:12 +0100213 case SSB_DEV_ETHERNET_GBIT:
Michael Buesch61e115a2007-09-18 15:12:50 -0400214 case SSB_DEV_80211:
215 case SSB_DEV_USB20_HOST:
216 /* These devices get their own IRQ line if available, the rest goes on IRQ0 */
217 if (irq <= 4) {
218 set_irq(dev, irq++);
219 break;
220 }
221 }
222 }
223
224 ssb_mips_serial_init(mcore);
225 ssb_mips_flash_detect(mcore);
226}