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 * 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->extif.dev) { 212 ssb_extif_get_clockcontrol(&bus->extif, &pll_type, &n, &m); 213 } else if (bus->chipco.dev) { 214 ssb_chipco_get_clockcpu(&bus->chipco, &pll_type, &n, &m); 215 } else 216 return 0; 217 218 if ((pll_type == SSB_PLLTYPE_5) || (bus->chip_id == 0x5365)) { 219 rate = 200000000; 220 } else { 221 rate = ssb_calc_clock_rate(pll_type, n, m); 222 } 223 224 if (pll_type == SSB_PLLTYPE_6) { 225 rate *= 2; 226 } 227 228 return rate; 229 } 230 231 void ssb_mipscore_init(struct ssb_mipscore *mcore) 232 { 233 struct ssb_bus *bus; 234 struct ssb_device *dev; 235 unsigned long hz, ns; 236 unsigned int irq, i; 237 238 if (!mcore->dev) 239 return; /* We don't have a MIPS core */ 240 241 ssb_dprintk(KERN_INFO PFX "Initializing MIPS core...\n"); 242 243 bus = mcore->dev->bus; 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 int mips_irq; 257 dev = &(bus->devices[i]); 258 mips_irq = ssb_mips_irq(dev); 259 if (mips_irq > 4) 260 dev->irq = 0; 261 else 262 dev->irq = mips_irq + 2; 263 if (dev->irq > 5) 264 continue; 265 switch (dev->id.coreid) { 266 case SSB_DEV_USB11_HOST: 267 /* shouldn't need a separate irq line for non-4710, most of them have a proper 268 * external usb controller on the pci */ 269 if ((bus->chip_id == 0x4710) && (irq <= 4)) { 270 set_irq(dev, irq++); 271 } 272 break; 273 /* fallthrough */ 274 case SSB_DEV_PCI: 275 case SSB_DEV_ETHERNET: 276 case SSB_DEV_ETHERNET_GBIT: 277 case SSB_DEV_80211: 278 case SSB_DEV_USB20_HOST: 279 /* These devices get their own IRQ line if available, the rest goes on IRQ0 */ 280 if (irq <= 4) { 281 set_irq(dev, irq++); 282 break; 283 } 284 } 285 } 286 ssb_dprintk(KERN_INFO PFX "after irq reconfiguration\n"); 287 dump_irq(bus); 288 289 ssb_mips_serial_init(mcore); 290 ssb_mips_flash_detect(mcore); 291 } 292