target/linux/brcm47xx-2.6/files/drivers/ssb/driver_mips/mips.c

   1 /*
   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  * Copyright 2006, 2007, Felix Fietkau <nbd@openwrt.org>
   8  *
   9  * Licensed under the GNU/GPL. See COPYING for details.
  10  */
  11
  12 #include <linux/ssb/ssb.h>
  13
  14 #include <linux/serial.h>
  15 #include <linux/serial_core.h>
  16 #include <linux/serial_reg.h>
  17 #include <asm/time.h>
  18
  19 #include "../ssb_private.h"
  20
  21 #define mips_read32(mcore, offset) ssb_read32((mcore)->dev, offset)
  22 #define mips_write32(mcore, offset, value) ssb_write32((mcore)->dev, offset, value)
  23 #define extif_read32(extif, offset) ssb_read32((extif)->dev, offset)
  24 #define extif_write32(extif, offset, value) ssb_write32((extif)->dev, offset, value)
  25
  26 static const u32 ipsflag_irq_mask[] = {
  27         0,
  28         SSB_IPSFLAG_IRQ1,
  29         SSB_IPSFLAG_IRQ2,
  30         SSB_IPSFLAG_IRQ3,
  31         SSB_IPSFLAG_IRQ4,
  32 };
  33
  34 static const u32 ipsflag_irq_shift[] = {
  35         0,
  36         SSB_IPSFLAG_IRQ1_SHIFT,
  37         SSB_IPSFLAG_IRQ2_SHIFT,
  38         SSB_IPSFLAG_IRQ3_SHIFT,
  39         SSB_IPSFLAG_IRQ4_SHIFT,
  40 };
  41
  42 static inline u32 ssb_irqflag(struct ssb_device *dev)
  43 {
  44         return ssb_read32(dev, SSB_TPSFLAG) & SSB_TPSFLAG_BPFLAG;
  45 }
  46
  47 /* Get the MIPS IRQ assignment for a specified device.
  48  * If unassigned, 0 is returned.
  49  */
  50 unsigned int ssb_mips_irq(struct ssb_device *dev)
  51 {
  52         struct ssb_bus *bus = dev->bus;
  53         u32 irqflag;
  54         u32 ipsflag;
  55         u32 tmp;
  56         unsigned int irq;
  57
  58         irqflag = ssb_irqflag(dev);
  59         ipsflag = ssb_read32(bus->mipscore.dev, SSB_IPSFLAG);
  60         for (irq = 1; irq <= 4; irq++) {
  61                 tmp = ((ipsflag & ipsflag_irq_mask[irq]) >> ipsflag_irq_shift[irq]);
  62                 if (tmp == irqflag)
  63                         break;
  64         }
  65         if (irq == 5)
  66                 irq = 0;
  67
  68         return irq;
  69 }
  70
  71 static void clear_irq(struct ssb_bus *bus, unsigned int irq)
  72 {
  73         struct ssb_device *dev = bus->mipscore.dev;
  74
  75         /* Clear the IRQ in the MIPScore backplane registers */
  76         if (irq == 0) {
  77                 ssb_write32(dev, SSB_INTVEC, 0);
  78         } else {
  79                 ssb_write32(dev, SSB_IPSFLAG,
  80                             ssb_read32(dev, SSB_IPSFLAG) |
  81                             ipsflag_irq_mask[irq]);
  82         }
  83 }
  84
  85 static void set_irq(struct ssb_device *dev, unsigned int irq)
  86 {
  87         unsigned int oldirq = ssb_mips_irq(dev);
  88         struct ssb_bus *bus = dev->bus;
  89         struct ssb_device *mdev = bus->mipscore.dev;
  90         u32 irqflag = ssb_irqflag(dev);
  91
  92         dev->irq = irq + 2;
  93
  94         ssb_dprintk(KERN_INFO PFX
  95                     "set_irq: core 0x%04x, irq %d => %d\n",
  96                     dev->id.coreid, oldirq, irq);
  97         /* clear the old irq */
  98         if (oldirq == 0)
  99                 ssb_write32(mdev, SSB_INTVEC, (~(1 << irqflag) & ssb_read32(mdev, SSB_INTVEC)));
 100         else
 101                 clear_irq(bus, oldirq);
 102
 103         /* assign the new one */
 104         if (irq == 0)
 105                 ssb_write32(mdev, SSB_INTVEC, ((1 << irqflag) & ssb_read32(mdev, SSB_INTVEC)));
 106
 107         irqflag <<= ipsflag_irq_shift[irq];
 108         irqflag |= (ssb_read32(mdev, SSB_IPSFLAG) & ~ipsflag_irq_mask[irq]);
 109         ssb_write32(mdev, SSB_IPSFLAG, irqflag);
 110 }
 111
 112 static int ssb_extif_serial_init(struct ssb_extif *dev, struct ssb_serial_port *ports)
 113 {
 114         //TODO if (EXTIF available
 115 #if 0
 116                 extifregs_t *eir = (extifregs_t *) regs;
 117                 sbconfig_t *sb;
 118
 119                 /* Determine external UART register base */
 120                 sb = (sbconfig_t *)((ulong) eir + SBCONFIGOFF);
 121                 base = EXTIF_CFGIF_BASE(sb_base(R_REG(&sb->sbadmatch1)));
 122
 123                 /* Determine IRQ */
 124                 irq = sb_irq(sbh);
 125
 126                 /* Disable GPIO interrupt initially */
 127                 W_REG(&eir->gpiointpolarity, 0);
 128                 W_REG(&eir->gpiointmask, 0);
 129
 130                 /* Search for external UARTs */
 131                 n = 2;
 132                 for (i = 0; i < 2; i++) {
 133                         regs = (void *) REG_MAP(base + (i * 8), 8);
 134                         if (BCMINIT(serial_exists)(regs)) {
 135                                 /* Set GPIO 1 to be the external UART IRQ */
 136                                 W_REG(&eir->gpiointmask, 2);
 137                                 if (add)
 138                                         add(regs, irq, 13500000, 0);
 139                         }
 140                 }
 141
 142                 /* Add internal UART if enabled */
 143                 if (R_REG(&eir->corecontrol) & CC_UE)
 144                         if (add)
 145                                 add((void *) &eir->uartdata, irq, sb_clock(sbh), 2);
 146
 147 #endif
 148
 149 }
 150
 151
 152 static void ssb_mips_serial_init(struct ssb_mipscore *mcore)
 153 {
 154         struct ssb_bus *bus = mcore->dev->bus;
 155
 156         if (bus->extif.dev)
 157                 mcore->nr_serial_ports = ssb_extif_serial_init(&bus->extif, mcore->serial_ports);
 158         else if (bus->chipco.dev)
 159                 mcore->nr_serial_ports = ssb_chipco_serial_init(&bus->chipco, mcore->serial_ports);
 160         else
 161                 mcore->nr_serial_ports = 0;
 162 }
 163
 164 static void ssb_mips_flash_detect(struct ssb_mipscore *mcore)
 165 {
 166         struct ssb_bus *bus = mcore->dev->bus;
 167
 168         mcore->flash_buswidth = 2;
 169         if (bus->chipco.dev) {
 170                 mcore->flash_window = 0x1c000000;
 171                 mcore->flash_window_size = 0x02000000;
 172                 if ((ssb_read32(bus->chipco.dev, SSB_CHIPCO_FLASH_CFG)
 173                                 & SSB_CHIPCO_CFG_DS16) == 0)
 174                         mcore->flash_buswidth = 1;
 175         } else {
 176                 mcore->flash_window = 0x1fc00000;
 177                 mcore->flash_window_size = 0x00400000;
 178         }
 179 }
 180
 181 static void ssb_extif_timing_init(struct ssb_extif *extif, u32 ns)
 182 {
 183         u32 tmp;
 184
 185         /* Initialize extif so we can get to the LEDs and external UART */
 186         extif_write32(extif, SSB_EXTIF_PROG_CFG, SSB_EXTCFG_EN);
 187
 188         /* Set timing for the flash */
 189         tmp  = ceildiv(10, ns) << SSB_PROG_WCNT_3_SHIFT;
 190         tmp |= ceildiv(40, ns) << SSB_PROG_WCNT_1_SHIFT;
 191         tmp |= ceildiv(120, ns);
 192         extif_write32(extif, SSB_EXTIF_PROG_WAITCNT, tmp);
 193
 194         /* Set programmable interface timing for external uart */
 195         tmp  = ceildiv(10, ns) << SSB_PROG_WCNT_3_SHIFT;
 196         tmp |= ceildiv(20, ns) << SSB_PROG_WCNT_2_SHIFT;
 197         tmp |= ceildiv(100, ns) << SSB_PROG_WCNT_1_SHIFT;
 198         tmp |= ceildiv(120, ns);
 199         extif_write32(extif, SSB_EXTIF_PROG_WAITCNT, tmp);
 200 }
 201
 202 static inline void ssb_extif_get_clockcontrol(struct ssb_extif *extif,
 203                                  u32 *pll_type, u32 *n, u32 *m)
 204 {
 205         *pll_type = SSB_PLLTYPE_1;
 206         *n = extif_read32(extif, SSB_EXTIF_CLOCK_N);
 207         *m = extif_read32(extif, SSB_EXTIF_CLOCK_SB);
 208 }
 209
 210 u32 ssb_cpu_clock(struct ssb_mipscore *mcore)
 211 {
 212         struct ssb_bus *bus = mcore->dev->bus;
 213         u32 pll_type, n, m, rate = 0;
 214
 215         if (bus->extif.dev) {
 216                 ssb_extif_get_clockcontrol(&bus->extif, &pll_type, &n, &m);
 217         } else if (bus->chipco.dev) {
 218                 ssb_chipco_get_clockcpu(&bus->chipco, bus->chip_id, &rate,
 219                         &pll_type, &n, &m);
 220         } else
 221                 return 0;
 222
 223         if (rate == 0)
 224                 rate = ssb_calc_clock_rate(pll_type, n, m);
 225
 226         if (pll_type == SSB_PLLTYPE_6)
 227                 rate *= 2;
 228
 229         return rate;
 230 }
 231
 232 void ssb_mipscore_init(struct ssb_mipscore *mcore)
 233 {
 234         struct ssb_bus *bus = mcore->dev->bus;
 235         struct ssb_device *dev;
 236         unsigned long hz, ns;
 237         unsigned int irq, i;
 238
 239         if (!mcore->dev)
 240                 return; /* We don't have a MIPS core */
 241
 242         ssb_dprintk(KERN_INFO PFX "Initializing MIPS core...\n");
 243
 244         hz = ssb_clockspeed(bus);
 245         if (!hz)
 246                 hz = 100000000;
 247         ns = 1000000000 / hz;
 248
 249         if (bus->extif.dev)
 250                 ssb_extif_timing_init(&bus->extif, ns);
 251         else if (bus->chipco.dev)
 252                 ssb_chipco_timing_init(&bus->chipco, ns);
 253
 254         /* Assign IRQs to all cores on the bus, start with irq line 2, because serial usually takes 1 */
 255         for (irq = 2, i = 0; i < bus->nr_devices; i++) {
 256                 dev = &(bus->devices[i]);
 257                 dev->irq = ssb_mips_irq(dev) + 2;
 258                 switch(dev->id.coreid) {
 259                         case SSB_DEV_USB11_HOST:
 260                                 /* shouldn't need a separate irq line for non-4710, most of them have a proper
 261                                  * external usb controller on the pci */
 262                                 if ((bus->chip_id == 0x4710) && (irq <= 4)) {
 263                                         set_irq(dev, irq++);
 264                                         break;
 265                                 }
 266                         case SSB_DEV_PCI:
 267                         case SSB_DEV_ETHERNET:
 268                         case SSB_DEV_80211:
 269                         case SSB_DEV_USB20_HOST:
 270                                 /* These devices get their own IRQ line if available, the rest goes on IRQ0 */
 271                                 if (irq <= 4) {
 272                                         set_irq(dev, irq++);
 273                                         break;
 274                                 }
 275                 }
 276         }
 277
 278         ssb_mips_serial_init(mcore);
 279         ssb_mips_flash_detect(mcore);
 280 }
 281
 282 EXPORT_SYMBOL(ssb_mips_irq);