1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39#include "cphy.h"
40#include "elmer0.h"
41
42
43
44
45
46
47#define MV88x2010_LINK_STATUS_BUGS 1
48
49static int led_init(struct cphy *cphy)
50{
51
52
53
54
55 cphy_mdio_write(cphy, MDIO_MMD_PCS, 0x8304, 0xdddd);
56 return 0;
57}
58
59static int led_link(struct cphy *cphy, u32 do_enable)
60{
61 u32 led = 0;
62#define LINK_ENABLE_BIT 0x1
63
64 cphy_mdio_read(cphy, MDIO_MMD_PMAPMD, MDIO_CTRL2, &led);
65
66 if (do_enable & LINK_ENABLE_BIT) {
67 led |= LINK_ENABLE_BIT;
68 cphy_mdio_write(cphy, MDIO_MMD_PMAPMD, MDIO_CTRL2, led);
69 } else {
70 led &= ~LINK_ENABLE_BIT;
71 cphy_mdio_write(cphy, MDIO_MMD_PMAPMD, MDIO_CTRL2, led);
72 }
73 return 0;
74}
75
76
77static int mv88x201x_reset(struct cphy *cphy, int wait)
78{
79
80
81
82 return 0;
83}
84
85static int mv88x201x_interrupt_enable(struct cphy *cphy)
86{
87
88 cphy_mdio_write(cphy, MDIO_MMD_PMAPMD, MDIO_PMA_LASI_CTRL,
89 MDIO_PMA_LASI_LSALARM);
90
91
92 if (t1_is_asic(cphy->adapter)) {
93 u32 elmer;
94
95 t1_tpi_read(cphy->adapter, A_ELMER0_INT_ENABLE, &elmer);
96 elmer |= ELMER0_GP_BIT6;
97 t1_tpi_write(cphy->adapter, A_ELMER0_INT_ENABLE, elmer);
98 }
99 return 0;
100}
101
102static int mv88x201x_interrupt_disable(struct cphy *cphy)
103{
104
105 cphy_mdio_write(cphy, MDIO_MMD_PMAPMD, MDIO_PMA_LASI_CTRL, 0x0);
106
107
108 if (t1_is_asic(cphy->adapter)) {
109 u32 elmer;
110
111 t1_tpi_read(cphy->adapter, A_ELMER0_INT_ENABLE, &elmer);
112 elmer &= ~ELMER0_GP_BIT6;
113 t1_tpi_write(cphy->adapter, A_ELMER0_INT_ENABLE, elmer);
114 }
115 return 0;
116}
117
118static int mv88x201x_interrupt_clear(struct cphy *cphy)
119{
120 u32 elmer;
121 u32 val;
122
123#ifdef MV88x2010_LINK_STATUS_BUGS
124
125 cphy_mdio_read(cphy, MDIO_MMD_PMAPMD, MDIO_PMA_LASI_RXSTAT, &val);
126 cphy_mdio_read(cphy, MDIO_MMD_PMAPMD, MDIO_PMA_LASI_TXSTAT, &val);
127 cphy_mdio_read(cphy, MDIO_MMD_PMAPMD, MDIO_PMA_LASI_STAT, &val);
128
129
130
131
132 cphy_mdio_read(cphy, MDIO_MMD_PMAPMD, MDIO_STAT1, &val);
133#endif
134
135
136 cphy_mdio_read(cphy, MDIO_MMD_PMAPMD, MDIO_STAT1, &val);
137
138 cphy_mdio_read(cphy, MDIO_MMD_PMAPMD, MDIO_PMA_LASI_STAT, &val);
139
140#ifdef MV88x2010_LINK_STATUS_BUGS
141
142 cphy_mdio_read(cphy, MDIO_MMD_PMAPMD, MDIO_PMA_LASI_RXSTAT, &val);
143 cphy_mdio_read(cphy, MDIO_MMD_PMAPMD, MDIO_PMA_LASI_TXSTAT, &val);
144#endif
145
146
147 if (t1_is_asic(cphy->adapter)) {
148 t1_tpi_read(cphy->adapter, A_ELMER0_INT_CAUSE, &elmer);
149 elmer |= ELMER0_GP_BIT6;
150 t1_tpi_write(cphy->adapter, A_ELMER0_INT_CAUSE, elmer);
151 }
152 return 0;
153}
154
155static int mv88x201x_interrupt_handler(struct cphy *cphy)
156{
157
158 mv88x201x_interrupt_clear(cphy);
159
160
161
162
163 return cphy_cause_link_change;
164}
165
166static int mv88x201x_set_loopback(struct cphy *cphy, int on)
167{
168 return 0;
169}
170
171static int mv88x201x_get_link_status(struct cphy *cphy, int *link_ok,
172 int *speed, int *duplex, int *fc)
173{
174 u32 val = 0;
175
176 if (link_ok) {
177
178 cphy_mdio_read(cphy, MDIO_MMD_PMAPMD, MDIO_STAT1, &val);
179 val &= MDIO_STAT1_LSTATUS;
180 *link_ok = (val == MDIO_STAT1_LSTATUS);
181
182 led_link(cphy, *link_ok);
183 }
184 if (speed)
185 *speed = SPEED_10000;
186 if (duplex)
187 *duplex = DUPLEX_FULL;
188 if (fc)
189 *fc = PAUSE_RX | PAUSE_TX;
190 return 0;
191}
192
193static void mv88x201x_destroy(struct cphy *cphy)
194{
195 kfree(cphy);
196}
197
198static const struct cphy_ops mv88x201x_ops = {
199 .destroy = mv88x201x_destroy,
200 .reset = mv88x201x_reset,
201 .interrupt_enable = mv88x201x_interrupt_enable,
202 .interrupt_disable = mv88x201x_interrupt_disable,
203 .interrupt_clear = mv88x201x_interrupt_clear,
204 .interrupt_handler = mv88x201x_interrupt_handler,
205 .get_link_status = mv88x201x_get_link_status,
206 .set_loopback = mv88x201x_set_loopback,
207 .mmds = (MDIO_DEVS_PMAPMD | MDIO_DEVS_PCS |
208 MDIO_DEVS_PHYXS | MDIO_DEVS_WIS),
209};
210
211static struct cphy *mv88x201x_phy_create(struct net_device *dev, int phy_addr,
212 const struct mdio_ops *mdio_ops)
213{
214 u32 val;
215 struct cphy *cphy = kzalloc(sizeof(*cphy), GFP_KERNEL);
216
217 if (!cphy)
218 return NULL;
219
220 cphy_init(cphy, dev, phy_addr, &mv88x201x_ops, mdio_ops);
221
222
223 cphy_mdio_read(cphy, MDIO_MMD_PCS, 0x8300, &val);
224 cphy_mdio_write(cphy, MDIO_MMD_PCS, 0x8300, val | 1);
225
226
227 cphy_mdio_read(cphy, MDIO_MMD_PMAPMD, MDIO_STAT2, &val);
228 cphy_mdio_read(cphy, MDIO_MMD_PCS, MDIO_STAT2, &val);
229
230
231 led_init(cphy);
232 return cphy;
233}
234
235
236static int mv88x201x_phy_reset(adapter_t *adapter)
237{
238 u32 val;
239
240 t1_tpi_read(adapter, A_ELMER0_GPO, &val);
241 val &= ~4;
242 t1_tpi_write(adapter, A_ELMER0_GPO, val);
243 msleep(100);
244
245 t1_tpi_write(adapter, A_ELMER0_GPO, val | 4);
246 msleep(1000);
247
248
249 t1_tpi_read(adapter, A_ELMER0_GPO, &val);
250 val |= 0x8000;
251 t1_tpi_write(adapter, A_ELMER0_GPO, val);
252 udelay(100);
253 return 0;
254}
255
256const struct gphy t1_mv88x201x_ops = {
257 .create = mv88x201x_phy_create,
258 .reset = mv88x201x_phy_reset
259};
260