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         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
 206 u32 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
 234 void 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 }