Root/drivers/net/fec_mpc52xx_phy.c

1/*
2 * Driver for the MPC5200 Fast Ethernet Controller - MDIO bus driver
3 *
4 * Copyright (C) 2007 Domen Puncer, Telargo, Inc.
5 * Copyright (C) 2008 Wolfram Sang, Pengutronix
6 *
7 * This file is licensed under the terms of the GNU General Public License
8 * version 2. This program is licensed "as is" without any warranty of any
9 * kind, whether express or implied.
10 */
11
12#include <linux/kernel.h>
13#include <linux/module.h>
14#include <linux/netdevice.h>
15#include <linux/phy.h>
16#include <linux/of_platform.h>
17#include <linux/of_mdio.h>
18#include <asm/io.h>
19#include <asm/mpc52xx.h>
20#include "fec_mpc52xx.h"
21
22struct mpc52xx_fec_mdio_priv {
23    struct mpc52xx_fec __iomem *regs;
24    int mdio_irqs[PHY_MAX_ADDR];
25};
26
27static int mpc52xx_fec_mdio_transfer(struct mii_bus *bus, int phy_id,
28        int reg, u32 value)
29{
30    struct mpc52xx_fec_mdio_priv *priv = bus->priv;
31    struct mpc52xx_fec __iomem *fec;
32    int tries = 3;
33
34    value |= (phy_id << FEC_MII_DATA_PA_SHIFT) & FEC_MII_DATA_PA_MSK;
35    value |= (reg << FEC_MII_DATA_RA_SHIFT) & FEC_MII_DATA_RA_MSK;
36
37    fec = priv->regs;
38    out_be32(&fec->ievent, FEC_IEVENT_MII);
39    out_be32(&priv->regs->mii_data, value);
40
41    /* wait for it to finish, this takes about 23 us on lite5200b */
42    while (!(in_be32(&fec->ievent) & FEC_IEVENT_MII) && --tries)
43        msleep(1);
44
45    if (!tries)
46        return -ETIMEDOUT;
47
48    return value & FEC_MII_DATA_OP_RD ?
49        in_be32(&priv->regs->mii_data) & FEC_MII_DATA_DATAMSK : 0;
50}
51
52static int mpc52xx_fec_mdio_read(struct mii_bus *bus, int phy_id, int reg)
53{
54    return mpc52xx_fec_mdio_transfer(bus, phy_id, reg, FEC_MII_READ_FRAME);
55}
56
57static int mpc52xx_fec_mdio_write(struct mii_bus *bus, int phy_id, int reg,
58        u16 data)
59{
60    return mpc52xx_fec_mdio_transfer(bus, phy_id, reg,
61        data | FEC_MII_WRITE_FRAME);
62}
63
64static int mpc52xx_fec_mdio_probe(struct of_device *of,
65        const struct of_device_id *match)
66{
67    struct device *dev = &of->dev;
68    struct device_node *np = of->node;
69    struct mii_bus *bus;
70    struct mpc52xx_fec_mdio_priv *priv;
71    struct resource res = {};
72    int err;
73    int i;
74
75    bus = mdiobus_alloc();
76    if (bus == NULL)
77        return -ENOMEM;
78    priv = kzalloc(sizeof(*priv), GFP_KERNEL);
79    if (priv == NULL) {
80        err = -ENOMEM;
81        goto out_free;
82    }
83
84    bus->name = "mpc52xx MII bus";
85    bus->read = mpc52xx_fec_mdio_read;
86    bus->write = mpc52xx_fec_mdio_write;
87
88    /* setup irqs */
89    bus->irq = priv->mdio_irqs;
90
91    /* setup registers */
92    err = of_address_to_resource(np, 0, &res);
93    if (err)
94        goto out_free;
95    priv->regs = ioremap(res.start, res.end - res.start + 1);
96    if (priv->regs == NULL) {
97        err = -ENOMEM;
98        goto out_free;
99    }
100
101    snprintf(bus->id, MII_BUS_ID_SIZE, "%x", res.start);
102    bus->priv = priv;
103
104    bus->parent = dev;
105    dev_set_drvdata(dev, bus);
106
107    /* set MII speed */
108    out_be32(&priv->regs->mii_speed,
109        ((mpc5xxx_get_bus_frequency(of->node) >> 20) / 5) << 1);
110
111    err = of_mdiobus_register(bus, np);
112    if (err)
113        goto out_unmap;
114
115    return 0;
116
117 out_unmap:
118    iounmap(priv->regs);
119 out_free:
120    for (i=0; i<PHY_MAX_ADDR; i++)
121        if (bus->irq[i] != PHY_POLL)
122            irq_dispose_mapping(bus->irq[i]);
123    kfree(bus->irq);
124    kfree(priv);
125    mdiobus_free(bus);
126
127    return err;
128}
129
130static int mpc52xx_fec_mdio_remove(struct of_device *of)
131{
132    struct device *dev = &of->dev;
133    struct mii_bus *bus = dev_get_drvdata(dev);
134    struct mpc52xx_fec_mdio_priv *priv = bus->priv;
135    int i;
136
137    mdiobus_unregister(bus);
138    dev_set_drvdata(dev, NULL);
139
140    iounmap(priv->regs);
141    for (i=0; i<PHY_MAX_ADDR; i++)
142        if (bus->irq[i] != PHY_POLL)
143            irq_dispose_mapping(bus->irq[i]);
144    kfree(priv);
145    kfree(bus->irq);
146    mdiobus_free(bus);
147
148    return 0;
149}
150
151
152static struct of_device_id mpc52xx_fec_mdio_match[] = {
153    { .compatible = "fsl,mpc5200b-mdio", },
154    { .compatible = "fsl,mpc5200-mdio", },
155    { .compatible = "mpc5200b-fec-phy", },
156    {}
157};
158
159struct of_platform_driver mpc52xx_fec_mdio_driver = {
160    .name = "mpc5200b-fec-phy",
161    .probe = mpc52xx_fec_mdio_probe,
162    .remove = mpc52xx_fec_mdio_remove,
163    .match_table = mpc52xx_fec_mdio_match,
164};
165
166/* let fec driver call it, since this has to be registered before it */
167EXPORT_SYMBOL_GPL(mpc52xx_fec_mdio_driver);
168
169
170MODULE_LICENSE("Dual BSD/GPL");
171

Archive Download this file

Branches:
ben-wpan
ben-wpan-stefan
javiroman/ks7010
jz-2.6.34
jz-2.6.34-rc5
jz-2.6.34-rc6
jz-2.6.34-rc7
jz-2.6.35
jz-2.6.36
jz-2.6.37
jz-2.6.38
jz-2.6.39
jz-3.0
jz-3.1
jz-3.2
jz-3.3
jz-3.4
jz47xx
jz47xx-2.6.38
master
xiangfu/openwrt/v3.0.0
xiangfu/openwrt/v3.2.1

Tags:
od-2011-09-04
od-2011-09-18
v2.6.34-rc5
v2.6.34-rc6
v2.6.34-rc7



interactive