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