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