Merge branch 'for-davem' of git://git.kernel.org/pub/scm/linux/kernel/git/linville...
[pandora-kernel.git] / drivers / ssb / driver_mipscore.c
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
21 static inline u32 mips_read32(struct ssb_mipscore *mcore,
22                               u16 offset)
23 {
24         return ssb_read32(mcore->dev, offset);
25 }
26
27 static inline void mips_write32(struct ssb_mipscore *mcore,
28                                 u16 offset,
29                                 u32 value)
30 {
31         ssb_write32(mcore->dev, offset, value);
32 }
33
34 static 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
42 static 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
50 static 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
60 static 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  */
78 unsigned 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
104 static 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
118 static 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
155 static 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
167 static 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
177 static 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
189 static void ssb_mips_flash_detect(struct ssb_mipscore *mcore)
190 {
191         struct ssb_bus *bus = mcore->dev->bus;
192
193         /* When there is no chipcommon on the bus there is 4MB flash */
194         if (!bus->chipco.dev) {
195                 mcore->flash_buswidth = 2;
196                 mcore->flash_window = SSB_FLASH1;
197                 mcore->flash_window_size = SSB_FLASH1_SZ;
198                 return;
199         }
200
201         /* There is ChipCommon, so use it to read info about flash */
202         switch (bus->chipco.capabilities & SSB_CHIPCO_CAP_FLASHT) {
203         case SSB_CHIPCO_FLASHT_STSER:
204         case SSB_CHIPCO_FLASHT_ATSER:
205                 pr_err("Serial flash not supported\n");
206                 break;
207         case SSB_CHIPCO_FLASHT_PARA:
208                 pr_debug("Found parallel flash\n");
209                 mcore->flash_window = SSB_FLASH2;
210                 mcore->flash_window_size = SSB_FLASH2_SZ;
211                 if ((ssb_read32(bus->chipco.dev, SSB_CHIPCO_FLASH_CFG)
212                                & SSB_CHIPCO_CFG_DS16) == 0)
213                         mcore->flash_buswidth = 1;
214                 else
215                         mcore->flash_buswidth = 2;
216                 break;
217         }
218 }
219
220 u32 ssb_cpu_clock(struct ssb_mipscore *mcore)
221 {
222         struct ssb_bus *bus = mcore->dev->bus;
223         u32 pll_type, n, m, rate = 0;
224
225         if (bus->chipco.capabilities & SSB_CHIPCO_CAP_PMU)
226                 return ssb_pmu_get_cpu_clock(&bus->chipco);
227
228         if (bus->extif.dev) {
229                 ssb_extif_get_clockcontrol(&bus->extif, &pll_type, &n, &m);
230         } else if (bus->chipco.dev) {
231                 ssb_chipco_get_clockcpu(&bus->chipco, &pll_type, &n, &m);
232         } else
233                 return 0;
234
235         if ((pll_type == SSB_PLLTYPE_5) || (bus->chip_id == 0x5365)) {
236                 rate = 200000000;
237         } else {
238                 rate = ssb_calc_clock_rate(pll_type, n, m);
239         }
240
241         if (pll_type == SSB_PLLTYPE_6) {
242                 rate *= 2;
243         }
244
245         return rate;
246 }
247
248 void ssb_mipscore_init(struct ssb_mipscore *mcore)
249 {
250         struct ssb_bus *bus;
251         struct ssb_device *dev;
252         unsigned long hz, ns;
253         unsigned int irq, i;
254
255         if (!mcore->dev)
256                 return; /* We don't have a MIPS core */
257
258         ssb_dprintk(KERN_INFO PFX "Initializing MIPS core...\n");
259
260         bus = mcore->dev->bus;
261         hz = ssb_clockspeed(bus);
262         if (!hz)
263                 hz = 100000000;
264         ns = 1000000000 / hz;
265
266         if (bus->extif.dev)
267                 ssb_extif_timing_init(&bus->extif, ns);
268         else if (bus->chipco.dev)
269                 ssb_chipco_timing_init(&bus->chipco, ns);
270
271         /* Assign IRQs to all cores on the bus, start with irq line 2, because serial usually takes 1 */
272         for (irq = 2, i = 0; i < bus->nr_devices; i++) {
273                 int mips_irq;
274                 dev = &(bus->devices[i]);
275                 mips_irq = ssb_mips_irq(dev);
276                 if (mips_irq > 4)
277                         dev->irq = 0;
278                 else
279                         dev->irq = mips_irq + 2;
280                 if (dev->irq > 5)
281                         continue;
282                 switch (dev->id.coreid) {
283                 case SSB_DEV_USB11_HOST:
284                         /* shouldn't need a separate irq line for non-4710, most of them have a proper
285                          * external usb controller on the pci */
286                         if ((bus->chip_id == 0x4710) && (irq <= 4)) {
287                                 set_irq(dev, irq++);
288                         }
289                         break;
290                 case SSB_DEV_PCI:
291                 case SSB_DEV_ETHERNET:
292                 case SSB_DEV_ETHERNET_GBIT:
293                 case SSB_DEV_80211:
294                 case SSB_DEV_USB20_HOST:
295                         /* These devices get their own IRQ line if available, the rest goes on IRQ0 */
296                         if (irq <= 4) {
297                                 set_irq(dev, irq++);
298                                 break;
299                         }
300                         /* fallthrough */
301                 case SSB_DEV_EXTIF:
302                         set_irq(dev, 0);
303                         break;
304                 }
305         }
306         ssb_dprintk(KERN_INFO PFX "after irq reconfiguration\n");
307         dump_irq(bus);
308
309         ssb_mips_serial_init(mcore);
310         ssb_mips_flash_detect(mcore);
311 }