1
2
3
4
5
6
7
8#include <common.h>
9#include <miiphy.h>
10#include <phy.h>
11#include <fsl_mdio.h>
12#include <asm/io.h>
13#include <linux/errno.h>
14#include <tsec.h>
15
16#ifdef CONFIG_DM_MDIO
17struct tsec_mdio_priv {
18 struct tsec_mii_mng __iomem *regs;
19};
20#endif
21
22void tsec_local_mdio_write(struct tsec_mii_mng __iomem *phyregs, int port_addr,
23 int dev_addr, int regnum, int value)
24{
25 int timeout = 1000000;
26
27 out_be32(&phyregs->miimadd, (port_addr << 8) | (regnum & 0x1f));
28 out_be32(&phyregs->miimcon, value);
29
30 mb();
31
32 while ((in_be32(&phyregs->miimind) & MIIMIND_BUSY) && timeout--)
33 ;
34}
35
36int tsec_local_mdio_read(struct tsec_mii_mng __iomem *phyregs, int port_addr,
37 int dev_addr, int regnum)
38{
39 int value;
40 int timeout = 1000000;
41
42
43 out_be32(&phyregs->miimadd, (port_addr << 8) | (regnum & 0x1f));
44
45
46 out_be32(&phyregs->miimcom, 0);
47
48 mb();
49
50
51 out_be32(&phyregs->miimcom, MIIMCOM_READ_CYCLE);
52
53 mb();
54
55
56 while ((in_be32(&phyregs->miimind) & (MIIMIND_NOTVALID | MIIMIND_BUSY))
57 && timeout--)
58 ;
59
60
61 value = in_be32(&phyregs->miimstat);
62
63 return value;
64}
65
66#if defined(CONFIG_PHYLIB)
67static int fsl_pq_mdio_reset(struct mii_dev *bus)
68{
69 struct tsec_mii_mng __iomem *regs;
70#ifndef CONFIG_DM_MDIO
71 regs = (struct tsec_mii_mng __iomem *)bus->priv;
72#else
73 struct tsec_mdio_priv *priv;
74
75 if (!bus->priv)
76 return -EINVAL;
77
78 priv = dev_get_priv(bus->priv);
79 regs = priv->regs;
80#endif
81
82
83 out_be32(®s->miimcfg, MIIMCFG_RESET_MGMT);
84
85 out_be32(®s->miimcfg, MIIMCFG_INIT_VALUE);
86
87 while (in_be32(®s->miimind) & MIIMIND_BUSY)
88 ;
89
90 return 0;
91}
92#endif
93
94int tsec_phy_read(struct mii_dev *bus, int addr, int dev_addr, int regnum)
95{
96 struct tsec_mii_mng __iomem *phyregs;
97#ifndef CONFIG_DM_MDIO
98 phyregs = (struct tsec_mii_mng __iomem *)bus->priv;
99#else
100 struct tsec_mdio_priv *priv;
101
102 if (!bus->priv)
103 return -EINVAL;
104
105 priv = dev_get_priv(bus->priv);
106 phyregs = priv->regs;
107#endif
108
109 return tsec_local_mdio_read(phyregs, addr, dev_addr, regnum);
110}
111
112int tsec_phy_write(struct mii_dev *bus, int addr, int dev_addr, int regnum,
113 u16 value)
114{
115 struct tsec_mii_mng __iomem *phyregs;
116#ifndef CONFIG_DM_MDIO
117 phyregs = (struct tsec_mii_mng __iomem *)bus->priv;
118#else
119 struct tsec_mdio_priv *priv;
120
121 if (!bus->priv)
122 return -EINVAL;
123
124 priv = dev_get_priv(bus->priv);
125 phyregs = priv->regs;
126#endif
127
128 tsec_local_mdio_write(phyregs, addr, dev_addr, regnum, value);
129
130 return 0;
131}
132
133#ifndef CONFIG_DM_MDIO
134int fsl_pq_mdio_init(struct bd_info *bis, struct fsl_pq_mdio_info *info)
135{
136 struct mii_dev *bus = mdio_alloc();
137
138 if (!bus) {
139 printf("Failed to allocate FSL MDIO bus\n");
140 return -1;
141 }
142
143 bus->read = tsec_phy_read;
144 bus->write = tsec_phy_write;
145 bus->reset = fsl_pq_mdio_reset;
146 strcpy(bus->name, info->name);
147
148 bus->priv = (void *)info->regs;
149
150 return mdio_register(bus);
151}
152#else
153#if defined(CONFIG_PHYLIB)
154static int tsec_mdio_read(struct udevice *dev, int addr, int devad, int reg)
155{
156 struct mdio_perdev_priv *pdata = (dev) ? dev_get_uclass_priv(dev) :
157 NULL;
158
159 if (pdata && pdata->mii_bus)
160 return tsec_phy_read(pdata->mii_bus, addr, devad, reg);
161
162 return -1;
163}
164
165static int tsec_mdio_write(struct udevice *dev, int addr, int devad, int reg,
166 u16 val)
167{
168 struct mdio_perdev_priv *pdata = (dev) ? dev_get_uclass_priv(dev) :
169 NULL;
170
171 if (pdata && pdata->mii_bus)
172 return tsec_phy_write(pdata->mii_bus, addr, devad, reg, val);
173
174 return -1;
175}
176
177static int tsec_mdio_reset(struct udevice *dev)
178{
179 struct mdio_perdev_priv *pdata = (dev) ? dev_get_uclass_priv(dev) :
180 NULL;
181
182 if (pdata && pdata->mii_bus)
183 return fsl_pq_mdio_reset(pdata->mii_bus);
184
185 return -1;
186}
187
188static const struct mdio_ops tsec_mdio_ops = {
189 .read = tsec_mdio_read,
190 .write = tsec_mdio_write,
191 .reset = tsec_mdio_reset,
192};
193
194static struct fsl_pq_mdio_data etsec2_data = {
195 .mdio_regs_off = TSEC_MDIO_REGS_OFFSET,
196};
197
198static struct fsl_pq_mdio_data gianfar_data = {
199 .mdio_regs_off = 0x0,
200};
201
202static struct fsl_pq_mdio_data fman_data = {
203 .mdio_regs_off = 0x0,
204};
205
206static const struct udevice_id tsec_mdio_ids[] = {
207 { .compatible = "fsl,gianfar-tbi", .data = (ulong)&gianfar_data },
208 { .compatible = "fsl,gianfar-mdio", .data = (ulong)&gianfar_data },
209 { .compatible = "fsl,etsec2-tbi", .data = (ulong)&etsec2_data },
210 { .compatible = "fsl,etsec2-mdio", .data = (ulong)&etsec2_data },
211 { .compatible = "fsl,fman-mdio", .data = (ulong)&fman_data },
212 {}
213};
214
215static int tsec_mdio_probe(struct udevice *dev)
216{
217 struct fsl_pq_mdio_data *data;
218 struct tsec_mdio_priv *priv = (dev) ? dev_get_priv(dev) : NULL;
219 struct mdio_perdev_priv *pdata = (dev) ? dev_get_uclass_priv(dev) :
220 NULL;
221
222 if (!dev) {
223 printf("%s dev = NULL\n", __func__);
224 return -1;
225 }
226 if (!priv) {
227 printf("dev_get_priv(dev %p) = NULL\n", dev);
228 return -1;
229 }
230
231 data = (struct fsl_pq_mdio_data *)dev_get_driver_data(dev);
232 priv->regs = dev_remap_addr(dev) + data->mdio_regs_off;
233 debug("%s priv %p @ regs %p, pdata %p\n", __func__,
234 priv, priv->regs, pdata);
235
236 return 0;
237}
238
239static int tsec_mdio_remove(struct udevice *dev)
240{
241 return 0;
242}
243
244U_BOOT_DRIVER(tsec_mdio) = {
245 .name = "tsec_mdio",
246 .id = UCLASS_MDIO,
247 .of_match = tsec_mdio_ids,
248 .probe = tsec_mdio_probe,
249 .remove = tsec_mdio_remove,
250 .ops = &tsec_mdio_ops,
251 .priv_auto = sizeof(struct tsec_mdio_priv),
252 .plat_auto = sizeof(struct mdio_perdev_priv),
253};
254#endif
255#endif
256