Merge branch 'linus' into sched-devel
[linux-2.6] / drivers / net / sfc / mdio_10g.c
1 /****************************************************************************
2  * Driver for Solarflare Solarstorm network controllers and boards
3  * Copyright 2006-2008 Solarflare Communications Inc.
4  *
5  * This program is free software; you can redistribute it and/or modify it
6  * under the terms of the GNU General Public License version 2 as published
7  * by the Free Software Foundation, incorporated herein by reference.
8  */
9 /*
10  * Useful functions for working with MDIO clause 45 PHYs
11  */
12 #include <linux/types.h>
13 #include <linux/ethtool.h>
14 #include <linux/delay.h>
15 #include "net_driver.h"
16 #include "mdio_10g.h"
17 #include "boards.h"
18
19 int mdio_clause45_reset_mmd(struct efx_nic *port, int mmd,
20                             int spins, int spintime)
21 {
22         u32 ctrl;
23         int phy_id = port->mii.phy_id;
24
25         /* Catch callers passing values in the wrong units (or just silly) */
26         EFX_BUG_ON_PARANOID(spins * spintime >= 5000);
27
28         mdio_clause45_write(port, phy_id, mmd, MDIO_MMDREG_CTRL1,
29                             (1 << MDIO_MMDREG_CTRL1_RESET_LBN));
30         /* Wait for the reset bit to clear. */
31         do {
32                 msleep(spintime);
33                 ctrl = mdio_clause45_read(port, phy_id, mmd, MDIO_MMDREG_CTRL1);
34                 spins--;
35
36         } while (spins && (ctrl & (1 << MDIO_MMDREG_CTRL1_RESET_LBN)));
37
38         return spins ? spins : -ETIMEDOUT;
39 }
40
41 static int mdio_clause45_check_mmd(struct efx_nic *efx, int mmd,
42                                    int fault_fatal)
43 {
44         int status;
45         int phy_id = efx->mii.phy_id;
46
47         if (LOOPBACK_INTERNAL(efx))
48                 return 0;
49
50         /* Read MMD STATUS2 to check it is responding. */
51         status = mdio_clause45_read(efx, phy_id, mmd, MDIO_MMDREG_STAT2);
52         if (((status >> MDIO_MMDREG_STAT2_PRESENT_LBN) &
53              ((1 << MDIO_MMDREG_STAT2_PRESENT_WIDTH) - 1)) !=
54             MDIO_MMDREG_STAT2_PRESENT_VAL) {
55                 EFX_ERR(efx, "PHY MMD %d not responding.\n", mmd);
56                 return -EIO;
57         }
58
59         /* Read MMD STATUS 1 to check for fault. */
60         status = mdio_clause45_read(efx, phy_id, mmd, MDIO_MMDREG_STAT1);
61         if ((status & (1 << MDIO_MMDREG_STAT1_FAULT_LBN)) != 0) {
62                 if (fault_fatal) {
63                         EFX_ERR(efx, "PHY MMD %d reporting fatal"
64                                 " fault: status %x\n", mmd, status);
65                         return -EIO;
66                 } else {
67                         EFX_LOG(efx, "PHY MMD %d reporting status"
68                                 " %x (expected)\n", mmd, status);
69                 }
70         }
71         return 0;
72 }
73
74 /* This ought to be ridiculous overkill. We expect it to fail rarely */
75 #define MDIO45_RESET_TIME       1000 /* ms */
76 #define MDIO45_RESET_ITERS      100
77
78 int mdio_clause45_wait_reset_mmds(struct efx_nic *efx,
79                                   unsigned int mmd_mask)
80 {
81         const int spintime = MDIO45_RESET_TIME / MDIO45_RESET_ITERS;
82         int tries = MDIO45_RESET_ITERS;
83         int rc = 0;
84         int in_reset;
85
86         while (tries) {
87                 int mask = mmd_mask;
88                 int mmd = 0;
89                 int stat;
90                 in_reset = 0;
91                 while (mask) {
92                         if (mask & 1) {
93                                 stat = mdio_clause45_read(efx,
94                                                           efx->mii.phy_id,
95                                                           mmd,
96                                                           MDIO_MMDREG_CTRL1);
97                                 if (stat < 0) {
98                                         EFX_ERR(efx, "failed to read status of"
99                                                 " MMD %d\n", mmd);
100                                         return -EIO;
101                                 }
102                                 if (stat & (1 << MDIO_MMDREG_CTRL1_RESET_LBN))
103                                         in_reset |= (1 << mmd);
104                         }
105                         mask = mask >> 1;
106                         mmd++;
107                 }
108                 if (!in_reset)
109                         break;
110                 tries--;
111                 msleep(spintime);
112         }
113         if (in_reset != 0) {
114                 EFX_ERR(efx, "not all MMDs came out of reset in time."
115                         " MMDs still in reset: %x\n", in_reset);
116                 rc = -ETIMEDOUT;
117         }
118         return rc;
119 }
120
121 int mdio_clause45_check_mmds(struct efx_nic *efx,
122                              unsigned int mmd_mask, unsigned int fatal_mask)
123 {
124         int devices, mmd = 0;
125         int probe_mmd;
126
127         /* Historically we have probed the PHYXS to find out what devices are
128          * present,but that doesn't work so well if the PHYXS isn't expected
129          * to exist, if so just find the first item in the list supplied. */
130         probe_mmd = (mmd_mask & MDIO_MMDREG_DEVS0_PHYXS) ? MDIO_MMD_PHYXS :
131             __ffs(mmd_mask);
132         devices = mdio_clause45_read(efx, efx->mii.phy_id,
133                                      probe_mmd, MDIO_MMDREG_DEVS0);
134
135         /* Check all the expected MMDs are present */
136         if (devices < 0) {
137                 EFX_ERR(efx, "failed to read devices present\n");
138                 return -EIO;
139         }
140         if ((devices & mmd_mask) != mmd_mask) {
141                 EFX_ERR(efx, "required MMDs not present: got %x, "
142                         "wanted %x\n", devices, mmd_mask);
143                 return -ENODEV;
144         }
145         EFX_TRACE(efx, "Devices present: %x\n", devices);
146
147         /* Check all required MMDs are responding and happy. */
148         while (mmd_mask) {
149                 if (mmd_mask & 1) {
150                         int fault_fatal = fatal_mask & 1;
151                         if (mdio_clause45_check_mmd(efx, mmd, fault_fatal))
152                                 return -EIO;
153                 }
154                 mmd_mask = mmd_mask >> 1;
155                 fatal_mask = fatal_mask >> 1;
156                 mmd++;
157         }
158
159         return 0;
160 }
161
162 int mdio_clause45_links_ok(struct efx_nic *efx, unsigned int mmd_mask)
163 {
164         int phy_id = efx->mii.phy_id;
165         int status;
166         int ok = 1;
167         int mmd = 0;
168         int good;
169
170         /* If the port is in loopback, then we should only consider a subset
171          * of mmd's */
172         if (LOOPBACK_INTERNAL(efx))
173                 return 1;
174         else if (efx->loopback_mode == LOOPBACK_NETWORK)
175                 return 0;
176         else if (efx->loopback_mode == LOOPBACK_PHYXS)
177                 mmd_mask &= ~(MDIO_MMDREG_DEVS0_PHYXS |
178                               MDIO_MMDREG_DEVS0_PCS |
179                               MDIO_MMDREG_DEVS0_PMAPMD);
180         else if (efx->loopback_mode == LOOPBACK_PCS)
181                 mmd_mask &= ~(MDIO_MMDREG_DEVS0_PCS |
182                               MDIO_MMDREG_DEVS0_PMAPMD);
183         else if (efx->loopback_mode == LOOPBACK_PMAPMD)
184                 mmd_mask &= ~MDIO_MMDREG_DEVS0_PMAPMD;
185
186         while (mmd_mask) {
187                 if (mmd_mask & 1) {
188                         /* Double reads because link state is latched, and a
189                          * read moves the current state into the register */
190                         status = mdio_clause45_read(efx, phy_id,
191                                                     mmd, MDIO_MMDREG_STAT1);
192                         status = mdio_clause45_read(efx, phy_id,
193                                                     mmd, MDIO_MMDREG_STAT1);
194
195                         good = status & (1 << MDIO_MMDREG_STAT1_LINK_LBN);
196                         ok = ok && good;
197                 }
198                 mmd_mask = (mmd_mask >> 1);
199                 mmd++;
200         }
201         return ok;
202 }
203
204 void mdio_clause45_transmit_disable(struct efx_nic *efx)
205 {
206         int phy_id = efx->mii.phy_id;
207         int ctrl1, ctrl2;
208
209         ctrl1 = ctrl2 = mdio_clause45_read(efx, phy_id, MDIO_MMD_PMAPMD,
210                                            MDIO_MMDREG_TXDIS);
211         if (efx->tx_disabled)
212                 ctrl2 |= (1 << MDIO_MMDREG_TXDIS_GLOBAL_LBN);
213         else
214                 ctrl1 &= ~(1 << MDIO_MMDREG_TXDIS_GLOBAL_LBN);
215         if (ctrl1 != ctrl2)
216                 mdio_clause45_write(efx, phy_id, MDIO_MMD_PMAPMD,
217                                     MDIO_MMDREG_TXDIS, ctrl2);
218 }
219
220 void mdio_clause45_phy_reconfigure(struct efx_nic *efx)
221 {
222         int phy_id = efx->mii.phy_id;
223         int ctrl1, ctrl2;
224
225         /* Handle (with debouncing) PMA/PMD loopback */
226         ctrl1 = ctrl2 = mdio_clause45_read(efx, phy_id, MDIO_MMD_PMAPMD,
227                                            MDIO_MMDREG_CTRL1);
228
229         if (efx->loopback_mode == LOOPBACK_PMAPMD)
230                 ctrl2 |= (1 << MDIO_PMAPMD_CTRL1_LBACK_LBN);
231         else
232                 ctrl2 &= ~(1 << MDIO_PMAPMD_CTRL1_LBACK_LBN);
233
234         if (ctrl1 != ctrl2)
235                 mdio_clause45_write(efx, phy_id, MDIO_MMD_PMAPMD,
236                                     MDIO_MMDREG_CTRL1, ctrl2);
237
238         /* Handle (with debouncing) PCS loopback */
239         ctrl1 = ctrl2 = mdio_clause45_read(efx, phy_id, MDIO_MMD_PCS,
240                                            MDIO_MMDREG_CTRL1);
241         if (efx->loopback_mode == LOOPBACK_PCS)
242                 ctrl2 |= (1 << MDIO_MMDREG_CTRL1_LBACK_LBN);
243         else
244                 ctrl2 &= ~(1 << MDIO_MMDREG_CTRL1_LBACK_LBN);
245
246         if (ctrl1 != ctrl2)
247                 mdio_clause45_write(efx, phy_id, MDIO_MMD_PCS,
248                                     MDIO_MMDREG_CTRL1, ctrl2);
249
250         /* Handle (with debouncing) PHYXS network loopback */
251         ctrl1 = ctrl2 = mdio_clause45_read(efx, phy_id, MDIO_MMD_PHYXS,
252                                            MDIO_MMDREG_CTRL1);
253         if (efx->loopback_mode == LOOPBACK_NETWORK)
254                 ctrl2 |= (1 << MDIO_MMDREG_CTRL1_LBACK_LBN);
255         else
256                 ctrl2 &= ~(1 << MDIO_MMDREG_CTRL1_LBACK_LBN);
257
258         if (ctrl1 != ctrl2)
259                 mdio_clause45_write(efx, phy_id, MDIO_MMD_PHYXS,
260                                     MDIO_MMDREG_CTRL1, ctrl2);
261 }
262
263 /**
264  * mdio_clause45_get_settings - Read (some of) the PHY settings over MDIO.
265  * @efx:                Efx NIC
266  * @ecmd:               Buffer for settings
267  *
268  * On return the 'port', 'speed', 'supported' and 'advertising' fields of
269  * ecmd have been filled out based on the PMA type.
270  */
271 void mdio_clause45_get_settings(struct efx_nic *efx,
272                                 struct ethtool_cmd *ecmd)
273 {
274         int pma_type;
275
276         /* If no PMA is present we are presumably talking something XAUI-ish
277          * like CX4. Which we report as FIBRE (see below) */
278         if ((efx->phy_op->mmds & DEV_PRESENT_BIT(MDIO_MMD_PMAPMD)) == 0) {
279                 ecmd->speed = SPEED_10000;
280                 ecmd->port = PORT_FIBRE;
281                 ecmd->supported = SUPPORTED_FIBRE;
282                 ecmd->advertising = ADVERTISED_FIBRE;
283                 return;
284         }
285
286         pma_type = mdio_clause45_read(efx, efx->mii.phy_id,
287                                       MDIO_MMD_PMAPMD, MDIO_MMDREG_CTRL2);
288         pma_type &= MDIO_PMAPMD_CTRL2_TYPE_MASK;
289
290         switch (pma_type) {
291                 /* We represent CX4 as fibre in the absence of anything
292                    better. */
293         case MDIO_PMAPMD_CTRL2_10G_CX4:
294                 ecmd->speed = SPEED_10000;
295                 ecmd->port = PORT_FIBRE;
296                 ecmd->supported = SUPPORTED_FIBRE;
297                 ecmd->advertising = ADVERTISED_FIBRE;
298                 break;
299                 /* 10G Base-T */
300         case MDIO_PMAPMD_CTRL2_10G_BT:
301                 ecmd->speed = SPEED_10000;
302                 ecmd->port = PORT_TP;
303                 ecmd->supported = SUPPORTED_TP | SUPPORTED_10000baseT_Full;
304                 ecmd->advertising = (ADVERTISED_FIBRE
305                                      | ADVERTISED_10000baseT_Full);
306                 break;
307         case MDIO_PMAPMD_CTRL2_1G_BT:
308                 ecmd->speed = SPEED_1000;
309                 ecmd->port = PORT_TP;
310                 ecmd->supported = SUPPORTED_TP | SUPPORTED_1000baseT_Full;
311                 ecmd->advertising = (ADVERTISED_FIBRE
312                                      | ADVERTISED_1000baseT_Full);
313                 break;
314         case MDIO_PMAPMD_CTRL2_100_BT:
315                 ecmd->speed = SPEED_100;
316                 ecmd->port = PORT_TP;
317                 ecmd->supported = SUPPORTED_TP | SUPPORTED_100baseT_Full;
318                 ecmd->advertising = (ADVERTISED_FIBRE
319                                      | ADVERTISED_100baseT_Full);
320                 break;
321         case MDIO_PMAPMD_CTRL2_10_BT:
322                 ecmd->speed = SPEED_10;
323                 ecmd->port = PORT_TP;
324                 ecmd->supported = SUPPORTED_TP | SUPPORTED_10baseT_Full;
325                 ecmd->advertising = ADVERTISED_FIBRE | ADVERTISED_10baseT_Full;
326                 break;
327         /* All the other defined modes are flavours of
328          * 10G optical */
329         default:
330                 ecmd->speed = SPEED_10000;
331                 ecmd->port = PORT_FIBRE;
332                 ecmd->supported = SUPPORTED_FIBRE;
333                 ecmd->advertising = ADVERTISED_FIBRE;
334                 break;
335         }
336 }
337
338 /**
339  * mdio_clause45_set_settings - Set (some of) the PHY settings over MDIO.
340  * @efx:                Efx NIC
341  * @ecmd:               New settings
342  *
343  * Currently this just enforces that we are _not_ changing the
344  * 'port', 'speed', 'supported' or 'advertising' settings as these
345  * cannot be changed on any currently supported PHY.
346  */
347 int mdio_clause45_set_settings(struct efx_nic *efx,
348                                struct ethtool_cmd *ecmd)
349 {
350         struct ethtool_cmd tmpcmd;
351         mdio_clause45_get_settings(efx, &tmpcmd);
352         /* None of the current PHYs support more than one mode
353          * of operation (and only 10GBT ever will), so keep things
354          * simple for now */
355         if ((ecmd->speed == tmpcmd.speed) && (ecmd->port == tmpcmd.port) &&
356             (ecmd->supported == tmpcmd.supported) &&
357             (ecmd->advertising == tmpcmd.advertising))
358                 return 0;
359         return -EOPNOTSUPP;
360 }