2 * Driver for (BCM4706)? GBit MAC core on BCMA bus.
4 * Copyright (C) 2012 Rafał Miłecki <zajec5@gmail.com>
6 * Licensed under the GNU/GPL. See COPYING for details.
9 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
11 #include <linux/bcma/bcma.h>
12 #include <linux/brcmphy.h>
13 #include <linux/etherdevice.h>
16 static inline bool bgmac_is_bcm4707_family(struct bcma_device *core)
18 switch (core->bus->chipinfo.id) {
19 case BCMA_CHIP_ID_BCM4707:
20 case BCMA_CHIP_ID_BCM47094:
21 case BCMA_CHIP_ID_BCM53018:
28 /**************************************************
30 **************************************************/
32 static u32 bcma_bgmac_read(struct bgmac *bgmac, u16 offset)
34 return bcma_read32(bgmac->bcma.core, offset);
37 static void bcma_bgmac_write(struct bgmac *bgmac, u16 offset, u32 value)
39 bcma_write32(bgmac->bcma.core, offset, value);
42 static u32 bcma_bgmac_idm_read(struct bgmac *bgmac, u16 offset)
44 return bcma_aread32(bgmac->bcma.core, offset);
47 static void bcma_bgmac_idm_write(struct bgmac *bgmac, u16 offset, u32 value)
49 return bcma_awrite32(bgmac->bcma.core, offset, value);
52 static bool bcma_bgmac_clk_enabled(struct bgmac *bgmac)
54 return bcma_core_is_enabled(bgmac->bcma.core);
57 static void bcma_bgmac_clk_enable(struct bgmac *bgmac, u32 flags)
59 bcma_core_enable(bgmac->bcma.core, flags);
62 static void bcma_bgmac_cco_ctl_maskset(struct bgmac *bgmac, u32 offset,
65 struct bcma_drv_cc *cc = &bgmac->bcma.core->bus->drv_cc;
67 bcma_chipco_chipctl_maskset(cc, offset, mask, set);
70 static u32 bcma_bgmac_get_bus_clock(struct bgmac *bgmac)
72 struct bcma_drv_cc *cc = &bgmac->bcma.core->bus->drv_cc;
74 return bcma_pmu_get_bus_clock(cc);
77 static void bcma_bgmac_cmn_maskset32(struct bgmac *bgmac, u16 offset, u32 mask,
80 bcma_maskset32(bgmac->bcma.cmn, offset, mask, set);
83 static int bcma_phy_connect(struct bgmac *bgmac)
85 struct phy_device *phy_dev;
86 char bus_id[MII_BUS_ID_SIZE + 3];
88 /* Connect to the PHY */
89 snprintf(bus_id, sizeof(bus_id), PHY_ID_FMT, bgmac->mii_bus->id,
91 phy_dev = phy_connect(bgmac->net_dev, bus_id, bgmac_adjust_link,
92 PHY_INTERFACE_MODE_MII);
93 if (IS_ERR(phy_dev)) {
94 dev_err(bgmac->dev, "PHY connection failed\n");
95 return PTR_ERR(phy_dev);
101 static const struct bcma_device_id bgmac_bcma_tbl[] = {
102 BCMA_CORE(BCMA_MANUF_BCM, BCMA_CORE_4706_MAC_GBIT,
103 BCMA_ANY_REV, BCMA_ANY_CLASS),
104 BCMA_CORE(BCMA_MANUF_BCM, BCMA_CORE_MAC_GBIT, BCMA_ANY_REV,
108 MODULE_DEVICE_TABLE(bcma, bgmac_bcma_tbl);
110 /* http://bcm-v4.sipsolutions.net/mac-gbit/gmac/chipattach */
111 static int bgmac_probe(struct bcma_device *core)
113 struct bcma_chipinfo *ci = &core->bus->chipinfo;
114 struct ssb_sprom *sprom = &core->bus->sprom;
115 struct mii_bus *mii_bus;
120 bgmac = bgmac_alloc(&core->dev);
124 bgmac->bcma.core = core;
125 bgmac->dma_dev = core->dma_dev;
126 bgmac->irq = core->irq;
128 bcma_set_drvdata(core, bgmac);
130 switch (core->core_unit) {
141 dev_err(bgmac->dev, "Unsupported core_unit %d\n",
147 ether_addr_copy(bgmac->net_dev->dev_addr, mac);
149 /* On BCM4706 we need common core to access PHY */
150 if (core->id.id == BCMA_CORE_4706_MAC_GBIT &&
151 !core->bus->drv_gmac_cmn.core) {
152 dev_err(bgmac->dev, "GMAC CMN core not found (required for BCM4706)\n");
156 bgmac->bcma.cmn = core->bus->drv_gmac_cmn.core;
158 switch (core->core_unit) {
160 bgmac->phyaddr = sprom->et0phyaddr;
163 bgmac->phyaddr = sprom->et1phyaddr;
166 bgmac->phyaddr = sprom->et2phyaddr;
169 bgmac->phyaddr &= BGMAC_PHY_MASK;
170 if (bgmac->phyaddr == BGMAC_PHY_MASK) {
171 dev_err(bgmac->dev, "No PHY found\n");
175 dev_info(bgmac->dev, "Found PHY addr: %d%s\n", bgmac->phyaddr,
176 bgmac->phyaddr == BGMAC_PHY_NOREGS ? " (NOREGS)" : "");
178 if (!bgmac_is_bcm4707_family(core) &&
179 !(ci->id == BCMA_CHIP_ID_BCM53573 && core->core_unit == 1)) {
180 mii_bus = bcma_mdio_mii_register(bgmac);
181 if (IS_ERR(mii_bus)) {
182 err = PTR_ERR(mii_bus);
186 bgmac->mii_bus = mii_bus;
189 if (core->bus->hosttype == BCMA_HOSTTYPE_PCI) {
190 dev_err(bgmac->dev, "PCI setup not implemented\n");
195 bgmac->has_robosw = !!(core->bus->sprom.boardflags_lo &
197 if (bgmac->has_robosw)
198 dev_warn(bgmac->dev, "Support for Roboswitch not implemented\n");
200 if (core->bus->sprom.boardflags_lo & BGMAC_BFL_ENETADM)
201 dev_warn(bgmac->dev, "Support for ADMtek ethernet switch not implemented\n");
204 switch (core->bus->chipinfo.id) {
205 case BCMA_CHIP_ID_BCM5357:
206 bgmac->feature_flags |= BGMAC_FEAT_SET_RXQ_CLK;
207 bgmac->feature_flags |= BGMAC_FEAT_CLKCTLST;
208 bgmac->feature_flags |= BGMAC_FEAT_FLW_CTRL1;
209 bgmac->feature_flags |= BGMAC_FEAT_SW_TYPE_PHY;
210 if (core->bus->chipinfo.pkg == BCMA_PKG_ID_BCM47186) {
211 bgmac->feature_flags |= BGMAC_FEAT_IOST_ATTACHED;
212 bgmac->feature_flags |= BGMAC_FEAT_SW_TYPE_RGMII;
214 if (core->bus->chipinfo.pkg == BCMA_PKG_ID_BCM5358)
215 bgmac->feature_flags |= BGMAC_FEAT_SW_TYPE_EPHYRMII;
217 case BCMA_CHIP_ID_BCM53572:
218 bgmac->feature_flags |= BGMAC_FEAT_SET_RXQ_CLK;
219 bgmac->feature_flags |= BGMAC_FEAT_CLKCTLST;
220 bgmac->feature_flags |= BGMAC_FEAT_FLW_CTRL1;
221 bgmac->feature_flags |= BGMAC_FEAT_SW_TYPE_PHY;
222 if (core->bus->chipinfo.pkg == BCMA_PKG_ID_BCM47188) {
223 bgmac->feature_flags |= BGMAC_FEAT_SW_TYPE_RGMII;
224 bgmac->feature_flags |= BGMAC_FEAT_IOST_ATTACHED;
227 case BCMA_CHIP_ID_BCM4749:
228 bgmac->feature_flags |= BGMAC_FEAT_SET_RXQ_CLK;
229 bgmac->feature_flags |= BGMAC_FEAT_CLKCTLST;
230 bgmac->feature_flags |= BGMAC_FEAT_FLW_CTRL1;
231 bgmac->feature_flags |= BGMAC_FEAT_SW_TYPE_PHY;
232 if (core->bus->chipinfo.pkg == 10) {
233 bgmac->feature_flags |= BGMAC_FEAT_SW_TYPE_RGMII;
234 bgmac->feature_flags |= BGMAC_FEAT_IOST_ATTACHED;
237 case BCMA_CHIP_ID_BCM4716:
238 bgmac->feature_flags |= BGMAC_FEAT_CLKCTLST;
240 case BCMA_CHIP_ID_BCM47162:
241 bgmac->feature_flags |= BGMAC_FEAT_FLW_CTRL2;
242 bgmac->feature_flags |= BGMAC_FEAT_SET_RXQ_CLK;
245 case BCMA_CHIP_ID_BCM4707:
246 case BCMA_CHIP_ID_BCM47094:
247 case BCMA_CHIP_ID_BCM53018:
248 bgmac->feature_flags |= BGMAC_FEAT_CLKCTLST;
249 bgmac->feature_flags |= BGMAC_FEAT_NO_RESET;
250 bgmac->feature_flags |= BGMAC_FEAT_FORCE_SPEED_2500;
252 case BCMA_CHIP_ID_BCM53573:
253 bgmac->feature_flags |= BGMAC_FEAT_CLKCTLST;
254 bgmac->feature_flags |= BGMAC_FEAT_SET_RXQ_CLK;
255 if (ci->pkg == BCMA_PKG_ID_BCM47189)
256 bgmac->feature_flags |= BGMAC_FEAT_IOST_ATTACHED;
257 if (core->core_unit == 0) {
258 bgmac->feature_flags |= BGMAC_FEAT_CC4_IF_SW_TYPE;
259 if (ci->pkg == BCMA_PKG_ID_BCM47189)
260 bgmac->feature_flags |=
261 BGMAC_FEAT_CC4_IF_SW_TYPE_RGMII;
262 } else if (core->core_unit == 1) {
263 bgmac->feature_flags |= BGMAC_FEAT_IRQ_ID_OOB_6;
264 bgmac->feature_flags |= BGMAC_FEAT_CC7_IF_TYPE_RGMII;
268 bgmac->feature_flags |= BGMAC_FEAT_CLKCTLST;
269 bgmac->feature_flags |= BGMAC_FEAT_SET_RXQ_CLK;
272 if (!bgmac_is_bcm4707_family(core) && core->id.rev > 2)
273 bgmac->feature_flags |= BGMAC_FEAT_MISC_PLL_REQ;
275 if (core->id.id == BCMA_CORE_4706_MAC_GBIT) {
276 bgmac->feature_flags |= BGMAC_FEAT_CMN_PHY_CTL;
277 bgmac->feature_flags |= BGMAC_FEAT_NO_CLR_MIB;
280 if (core->id.rev >= 4) {
281 bgmac->feature_flags |= BGMAC_FEAT_CMDCFG_SR_REV4;
282 bgmac->feature_flags |= BGMAC_FEAT_TX_MASK_SETUP;
283 bgmac->feature_flags |= BGMAC_FEAT_RX_MASK_SETUP;
286 bgmac->read = bcma_bgmac_read;
287 bgmac->write = bcma_bgmac_write;
288 bgmac->idm_read = bcma_bgmac_idm_read;
289 bgmac->idm_write = bcma_bgmac_idm_write;
290 bgmac->clk_enabled = bcma_bgmac_clk_enabled;
291 bgmac->clk_enable = bcma_bgmac_clk_enable;
292 bgmac->cco_ctl_maskset = bcma_bgmac_cco_ctl_maskset;
293 bgmac->get_bus_clock = bcma_bgmac_get_bus_clock;
294 bgmac->cmn_maskset32 = bcma_bgmac_cmn_maskset32;
296 bgmac->phy_connect = bcma_phy_connect;
298 bgmac->phy_connect = bgmac_phy_connect_direct;
300 err = bgmac_enet_probe(bgmac);
307 bcma_mdio_mii_unregister(bgmac->mii_bus);
309 bcma_set_drvdata(core, NULL);
314 static void bgmac_remove(struct bcma_device *core)
316 struct bgmac *bgmac = bcma_get_drvdata(core);
318 bcma_mdio_mii_unregister(bgmac->mii_bus);
319 bgmac_enet_remove(bgmac);
320 bcma_set_drvdata(core, NULL);
324 static struct bcma_driver bgmac_bcma_driver = {
325 .name = KBUILD_MODNAME,
326 .id_table = bgmac_bcma_tbl,
327 .probe = bgmac_probe,
328 .remove = bgmac_remove,
331 static int __init bgmac_init(void)
335 err = bcma_driver_register(&bgmac_bcma_driver);
338 pr_info("Broadcom 47xx GBit MAC driver loaded\n");
343 static void __exit bgmac_exit(void)
345 bcma_driver_unregister(&bgmac_bcma_driver);
348 module_init(bgmac_init)
349 module_exit(bgmac_exit)
351 MODULE_AUTHOR("Rafał Miłecki");
352 MODULE_LICENSE("GPL");