driver_gige.c (7458B)
1/* 2 * Sonics Silicon Backplane 3 * Broadcom Gigabit Ethernet core driver 4 * 5 * Copyright 2008, Broadcom Corporation 6 * Copyright 2008, 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#include <linux/ssb/ssb_driver_gige.h> 13#include <linux/export.h> 14#include <linux/pci.h> 15#include <linux/pci_regs.h> 16#include <linux/slab.h> 17 18 19/* 20MODULE_DESCRIPTION("SSB Broadcom Gigabit Ethernet driver"); 21MODULE_AUTHOR("Michael Buesch"); 22MODULE_LICENSE("GPL"); 23*/ 24 25static const struct ssb_device_id ssb_gige_tbl[] = { 26 SSB_DEVICE(SSB_VENDOR_BROADCOM, SSB_DEV_ETHERNET_GBIT, SSB_ANY_REV), 27 {}, 28}; 29/* MODULE_DEVICE_TABLE(ssb, ssb_gige_tbl); */ 30 31 32static inline u8 gige_read8(struct ssb_gige *dev, u16 offset) 33{ 34 return ssb_read8(dev->dev, offset); 35} 36 37static inline u16 gige_read16(struct ssb_gige *dev, u16 offset) 38{ 39 return ssb_read16(dev->dev, offset); 40} 41 42static inline u32 gige_read32(struct ssb_gige *dev, u16 offset) 43{ 44 return ssb_read32(dev->dev, offset); 45} 46 47static inline void gige_write8(struct ssb_gige *dev, 48 u16 offset, u8 value) 49{ 50 ssb_write8(dev->dev, offset, value); 51} 52 53static inline void gige_write16(struct ssb_gige *dev, 54 u16 offset, u16 value) 55{ 56 ssb_write16(dev->dev, offset, value); 57} 58 59static inline void gige_write32(struct ssb_gige *dev, 60 u16 offset, u32 value) 61{ 62 ssb_write32(dev->dev, offset, value); 63} 64 65static inline 66u8 gige_pcicfg_read8(struct ssb_gige *dev, unsigned int offset) 67{ 68 BUG_ON(offset >= 256); 69 return gige_read8(dev, SSB_GIGE_PCICFG + offset); 70} 71 72static inline 73u16 gige_pcicfg_read16(struct ssb_gige *dev, unsigned int offset) 74{ 75 BUG_ON(offset >= 256); 76 return gige_read16(dev, SSB_GIGE_PCICFG + offset); 77} 78 79static inline 80u32 gige_pcicfg_read32(struct ssb_gige *dev, unsigned int offset) 81{ 82 BUG_ON(offset >= 256); 83 return gige_read32(dev, SSB_GIGE_PCICFG + offset); 84} 85 86static inline 87void gige_pcicfg_write8(struct ssb_gige *dev, 88 unsigned int offset, u8 value) 89{ 90 BUG_ON(offset >= 256); 91 gige_write8(dev, SSB_GIGE_PCICFG + offset, value); 92} 93 94static inline 95void gige_pcicfg_write16(struct ssb_gige *dev, 96 unsigned int offset, u16 value) 97{ 98 BUG_ON(offset >= 256); 99 gige_write16(dev, SSB_GIGE_PCICFG + offset, value); 100} 101 102static inline 103void gige_pcicfg_write32(struct ssb_gige *dev, 104 unsigned int offset, u32 value) 105{ 106 BUG_ON(offset >= 256); 107 gige_write32(dev, SSB_GIGE_PCICFG + offset, value); 108} 109 110static int ssb_gige_pci_read_config(struct pci_bus *bus, unsigned int devfn, 111 int reg, int size, u32 *val) 112{ 113 struct ssb_gige *dev = container_of(bus->ops, struct ssb_gige, pci_ops); 114 unsigned long flags; 115 116 if ((PCI_SLOT(devfn) > 0) || (PCI_FUNC(devfn) > 0)) 117 return PCIBIOS_DEVICE_NOT_FOUND; 118 if (reg >= 256) 119 return PCIBIOS_DEVICE_NOT_FOUND; 120 121 spin_lock_irqsave(&dev->lock, flags); 122 switch (size) { 123 case 1: 124 *val = gige_pcicfg_read8(dev, reg); 125 break; 126 case 2: 127 *val = gige_pcicfg_read16(dev, reg); 128 break; 129 case 4: 130 *val = gige_pcicfg_read32(dev, reg); 131 break; 132 default: 133 WARN_ON(1); 134 } 135 spin_unlock_irqrestore(&dev->lock, flags); 136 137 return PCIBIOS_SUCCESSFUL; 138} 139 140static int ssb_gige_pci_write_config(struct pci_bus *bus, unsigned int devfn, 141 int reg, int size, u32 val) 142{ 143 struct ssb_gige *dev = container_of(bus->ops, struct ssb_gige, pci_ops); 144 unsigned long flags; 145 146 if ((PCI_SLOT(devfn) > 0) || (PCI_FUNC(devfn) > 0)) 147 return PCIBIOS_DEVICE_NOT_FOUND; 148 if (reg >= 256) 149 return PCIBIOS_DEVICE_NOT_FOUND; 150 151 spin_lock_irqsave(&dev->lock, flags); 152 switch (size) { 153 case 1: 154 gige_pcicfg_write8(dev, reg, val); 155 break; 156 case 2: 157 gige_pcicfg_write16(dev, reg, val); 158 break; 159 case 4: 160 gige_pcicfg_write32(dev, reg, val); 161 break; 162 default: 163 WARN_ON(1); 164 } 165 spin_unlock_irqrestore(&dev->lock, flags); 166 167 return PCIBIOS_SUCCESSFUL; 168} 169 170static int ssb_gige_probe(struct ssb_device *sdev, 171 const struct ssb_device_id *id) 172{ 173 struct ssb_gige *dev; 174 u32 base, tmslow, tmshigh; 175 176 dev = kzalloc(sizeof(*dev), GFP_KERNEL); 177 if (!dev) 178 return -ENOMEM; 179 dev->dev = sdev; 180 181 spin_lock_init(&dev->lock); 182 dev->pci_controller.pci_ops = &dev->pci_ops; 183 dev->pci_controller.io_resource = &dev->io_resource; 184 dev->pci_controller.mem_resource = &dev->mem_resource; 185 dev->pci_controller.io_map_base = 0x800; 186 dev->pci_ops.read = ssb_gige_pci_read_config; 187 dev->pci_ops.write = ssb_gige_pci_write_config; 188 189 dev->io_resource.name = SSB_GIGE_IO_RES_NAME; 190 dev->io_resource.start = 0x800; 191 dev->io_resource.end = 0x8FF; 192 dev->io_resource.flags = IORESOURCE_IO | IORESOURCE_PCI_FIXED; 193 194 if (!ssb_device_is_enabled(sdev)) 195 ssb_device_enable(sdev, 0); 196 197 /* Setup BAR0. This is a 64k MMIO region. */ 198 base = ssb_admatch_base(ssb_read32(sdev, SSB_ADMATCH1)); 199 gige_pcicfg_write32(dev, PCI_BASE_ADDRESS_0, base); 200 gige_pcicfg_write32(dev, PCI_BASE_ADDRESS_1, 0); 201 202 dev->mem_resource.name = SSB_GIGE_MEM_RES_NAME; 203 dev->mem_resource.start = base; 204 dev->mem_resource.end = base + 0x10000 - 1; 205 dev->mem_resource.flags = IORESOURCE_MEM | IORESOURCE_PCI_FIXED; 206 207 /* Enable the memory region. */ 208 gige_pcicfg_write16(dev, PCI_COMMAND, 209 gige_pcicfg_read16(dev, PCI_COMMAND) 210 | PCI_COMMAND_MEMORY); 211 212 /* Write flushing is controlled by the Flush Status Control register. 213 * We want to flush every register write with a timeout and we want 214 * to disable the IRQ mask while flushing to avoid concurrency. 215 * Note that automatic write flushing does _not_ work from 216 * an IRQ handler. The driver must flush manually by reading a register. 217 */ 218 gige_write32(dev, SSB_GIGE_SHIM_FLUSHSTAT, 0x00000068); 219 220 /* Check if we have an RGMII or GMII PHY-bus. 221 * On RGMII do not bypass the DLLs */ 222 tmslow = ssb_read32(sdev, SSB_TMSLOW); 223 tmshigh = ssb_read32(sdev, SSB_TMSHIGH); 224 if (tmshigh & SSB_GIGE_TMSHIGH_RGMII) { 225 tmslow &= ~SSB_GIGE_TMSLOW_TXBYPASS; 226 tmslow &= ~SSB_GIGE_TMSLOW_RXBYPASS; 227 dev->has_rgmii = 1; 228 } else { 229 tmslow |= SSB_GIGE_TMSLOW_TXBYPASS; 230 tmslow |= SSB_GIGE_TMSLOW_RXBYPASS; 231 dev->has_rgmii = 0; 232 } 233 tmslow |= SSB_GIGE_TMSLOW_DLLEN; 234 ssb_write32(sdev, SSB_TMSLOW, tmslow); 235 236 ssb_set_drvdata(sdev, dev); 237 register_pci_controller(&dev->pci_controller); 238 239 return 0; 240} 241 242bool pdev_is_ssb_gige_core(struct pci_dev *pdev) 243{ 244 if (!pdev->resource[0].name) 245 return false; 246 return (strcmp(pdev->resource[0].name, SSB_GIGE_MEM_RES_NAME) == 0); 247} 248EXPORT_SYMBOL(pdev_is_ssb_gige_core); 249 250int ssb_gige_pcibios_plat_dev_init(struct ssb_device *sdev, 251 struct pci_dev *pdev) 252{ 253 struct ssb_gige *dev = ssb_get_drvdata(sdev); 254 struct resource *res; 255 256 if (pdev->bus->ops != &dev->pci_ops) { 257 /* The PCI device is not on this SSB GigE bridge device. */ 258 return -ENODEV; 259 } 260 261 /* Fixup the PCI resources. */ 262 res = &(pdev->resource[0]); 263 res->flags = IORESOURCE_MEM | IORESOURCE_PCI_FIXED; 264 res->name = dev->mem_resource.name; 265 res->start = dev->mem_resource.start; 266 res->end = dev->mem_resource.end; 267 268 /* Fixup interrupt lines. */ 269 pdev->irq = ssb_mips_irq(sdev) + 2; 270 pci_write_config_byte(pdev, PCI_INTERRUPT_LINE, pdev->irq); 271 272 return 0; 273} 274 275int ssb_gige_map_irq(struct ssb_device *sdev, 276 const struct pci_dev *pdev) 277{ 278 struct ssb_gige *dev = ssb_get_drvdata(sdev); 279 280 if (pdev->bus->ops != &dev->pci_ops) { 281 /* The PCI device is not on this SSB GigE bridge device. */ 282 return -ENODEV; 283 } 284 285 return ssb_mips_irq(sdev) + 2; 286} 287 288static struct ssb_driver ssb_gige_driver = { 289 .name = "BCM-GigE", 290 .id_table = ssb_gige_tbl, 291 .probe = ssb_gige_probe, 292}; 293 294int ssb_gige_init(void) 295{ 296 return ssb_driver_register(&ssb_gige_driver); 297}