9e1b9c2d97aed93cfb79c90fbac383933696bdd2
[dpdk.git] / drivers / net / sfc / base / ef10_phy.c
1 /*
2  * Copyright (c) 2012-2016 Solarflare Communications Inc.
3  * All rights reserved.
4  *
5  * Redistribution and use in source and binary forms, with or without
6  * modification, are permitted provided that the following conditions are met:
7  *
8  * 1. Redistributions of source code must retain the above copyright notice,
9  *    this list of conditions and the following disclaimer.
10  * 2. Redistributions in binary form must reproduce the above copyright notice,
11  *    this list of conditions and the following disclaimer in the documentation
12  *    and/or other materials provided with the distribution.
13  *
14  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
15  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
16  * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
17  * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR
18  * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
19  * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
20  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
21  * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
22  * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
23  * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
24  * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
25  *
26  * The views and conclusions contained in the software and documentation are
27  * those of the authors and should not be interpreted as representing official
28  * policies, either expressed or implied, of the FreeBSD Project.
29  */
30
31 #include "efx.h"
32 #include "efx_impl.h"
33
34 #if EFSYS_OPT_HUNTINGTON || EFSYS_OPT_MEDFORD
35
36 static                  void
37 mcdi_phy_decode_cap(
38         __in            uint32_t mcdi_cap,
39         __out           uint32_t *maskp)
40 {
41         uint32_t mask;
42
43         mask = 0;
44         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_10HDX_LBN))
45                 mask |= (1 << EFX_PHY_CAP_10HDX);
46         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_10FDX_LBN))
47                 mask |= (1 << EFX_PHY_CAP_10FDX);
48         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_100HDX_LBN))
49                 mask |= (1 << EFX_PHY_CAP_100HDX);
50         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_100FDX_LBN))
51                 mask |= (1 << EFX_PHY_CAP_100FDX);
52         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_1000HDX_LBN))
53                 mask |= (1 << EFX_PHY_CAP_1000HDX);
54         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_1000FDX_LBN))
55                 mask |= (1 << EFX_PHY_CAP_1000FDX);
56         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_10000FDX_LBN))
57                 mask |= (1 << EFX_PHY_CAP_10000FDX);
58         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_40000FDX_LBN))
59                 mask |= (1 << EFX_PHY_CAP_40000FDX);
60         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_PAUSE_LBN))
61                 mask |= (1 << EFX_PHY_CAP_PAUSE);
62         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_ASYM_LBN))
63                 mask |= (1 << EFX_PHY_CAP_ASYM);
64         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_AN_LBN))
65                 mask |= (1 << EFX_PHY_CAP_AN);
66
67         *maskp = mask;
68 }
69
70 static                  void
71 mcdi_phy_decode_link_mode(
72         __in            efx_nic_t *enp,
73         __in            uint32_t link_flags,
74         __in            unsigned int speed,
75         __in            unsigned int fcntl,
76         __out           efx_link_mode_t *link_modep,
77         __out           unsigned int *fcntlp)
78 {
79         boolean_t fd = !!(link_flags &
80                     (1 << MC_CMD_GET_LINK_OUT_FULL_DUPLEX_LBN));
81         boolean_t up = !!(link_flags &
82                     (1 << MC_CMD_GET_LINK_OUT_LINK_UP_LBN));
83
84         _NOTE(ARGUNUSED(enp))
85
86         if (!up)
87                 *link_modep = EFX_LINK_DOWN;
88         else if (speed == 40000 && fd)
89                 *link_modep = EFX_LINK_40000FDX;
90         else if (speed == 10000 && fd)
91                 *link_modep = EFX_LINK_10000FDX;
92         else if (speed == 1000)
93                 *link_modep = fd ? EFX_LINK_1000FDX : EFX_LINK_1000HDX;
94         else if (speed == 100)
95                 *link_modep = fd ? EFX_LINK_100FDX : EFX_LINK_100HDX;
96         else if (speed == 10)
97                 *link_modep = fd ? EFX_LINK_10FDX : EFX_LINK_10HDX;
98         else
99                 *link_modep = EFX_LINK_UNKNOWN;
100
101         if (fcntl == MC_CMD_FCNTL_OFF)
102                 *fcntlp = 0;
103         else if (fcntl == MC_CMD_FCNTL_RESPOND)
104                 *fcntlp = EFX_FCNTL_RESPOND;
105         else if (fcntl == MC_CMD_FCNTL_GENERATE)
106                 *fcntlp = EFX_FCNTL_GENERATE;
107         else if (fcntl == MC_CMD_FCNTL_BIDIR)
108                 *fcntlp = EFX_FCNTL_RESPOND | EFX_FCNTL_GENERATE;
109         else {
110                 EFSYS_PROBE1(mc_pcol_error, int, fcntl);
111                 *fcntlp = 0;
112         }
113 }
114
115
116                         void
117 ef10_phy_link_ev(
118         __in            efx_nic_t *enp,
119         __in            efx_qword_t *eqp,
120         __out           efx_link_mode_t *link_modep)
121 {
122         efx_port_t *epp = &(enp->en_port);
123         unsigned int link_flags;
124         unsigned int speed;
125         unsigned int fcntl;
126         efx_link_mode_t link_mode;
127         uint32_t lp_cap_mask;
128
129         /*
130          * Convert the LINKCHANGE speed enumeration into mbit/s, in the
131          * same way as GET_LINK encodes the speed
132          */
133         switch (MCDI_EV_FIELD(eqp, LINKCHANGE_SPEED)) {
134         case MCDI_EVENT_LINKCHANGE_SPEED_100M:
135                 speed = 100;
136                 break;
137         case MCDI_EVENT_LINKCHANGE_SPEED_1G:
138                 speed = 1000;
139                 break;
140         case MCDI_EVENT_LINKCHANGE_SPEED_10G:
141                 speed = 10000;
142                 break;
143         case MCDI_EVENT_LINKCHANGE_SPEED_40G:
144                 speed = 40000;
145                 break;
146         default:
147                 speed = 0;
148                 break;
149         }
150
151         link_flags = MCDI_EV_FIELD(eqp, LINKCHANGE_LINK_FLAGS);
152         mcdi_phy_decode_link_mode(enp, link_flags, speed,
153                                     MCDI_EV_FIELD(eqp, LINKCHANGE_FCNTL),
154                                     &link_mode, &fcntl);
155         mcdi_phy_decode_cap(MCDI_EV_FIELD(eqp, LINKCHANGE_LP_CAP),
156                             &lp_cap_mask);
157
158         /*
159          * It's safe to update ep_lp_cap_mask without the driver's port lock
160          * because presumably any concurrently running efx_port_poll() is
161          * only going to arrive at the same value.
162          *
163          * ep_fcntl has two meanings. It's either the link common fcntl
164          * (if the PHY supports AN), or it's the forced link state. If
165          * the former, it's safe to update the value for the same reason as
166          * for ep_lp_cap_mask. If the latter, then just ignore the value,
167          * because we can race with efx_mac_fcntl_set().
168          */
169         epp->ep_lp_cap_mask = lp_cap_mask;
170         epp->ep_fcntl = fcntl;
171
172         *link_modep = link_mode;
173 }
174
175         __checkReturn   efx_rc_t
176 ef10_phy_power(
177         __in            efx_nic_t *enp,
178         __in            boolean_t power)
179 {
180         efx_rc_t rc;
181
182         if (!power)
183                 return (0);
184
185         /* Check if the PHY is a zombie */
186         if ((rc = ef10_phy_verify(enp)) != 0)
187                 goto fail1;
188
189         enp->en_reset_flags |= EFX_RESET_PHY;
190
191         return (0);
192
193 fail1:
194         EFSYS_PROBE1(fail1, efx_rc_t, rc);
195
196         return (rc);
197 }
198
199         __checkReturn   efx_rc_t
200 ef10_phy_get_link(
201         __in            efx_nic_t *enp,
202         __out           ef10_link_state_t *elsp)
203 {
204         efx_mcdi_req_t req;
205         uint8_t payload[MAX(MC_CMD_GET_LINK_IN_LEN,
206                             MC_CMD_GET_LINK_OUT_LEN)];
207         efx_rc_t rc;
208
209         (void) memset(payload, 0, sizeof (payload));
210         req.emr_cmd = MC_CMD_GET_LINK;
211         req.emr_in_buf = payload;
212         req.emr_in_length = MC_CMD_GET_LINK_IN_LEN;
213         req.emr_out_buf = payload;
214         req.emr_out_length = MC_CMD_GET_LINK_OUT_LEN;
215
216         efx_mcdi_execute(enp, &req);
217
218         if (req.emr_rc != 0) {
219                 rc = req.emr_rc;
220                 goto fail1;
221         }
222
223         if (req.emr_out_length_used < MC_CMD_GET_LINK_OUT_LEN) {
224                 rc = EMSGSIZE;
225                 goto fail2;
226         }
227
228         mcdi_phy_decode_cap(MCDI_OUT_DWORD(req, GET_LINK_OUT_CAP),
229                             &elsp->els_adv_cap_mask);
230         mcdi_phy_decode_cap(MCDI_OUT_DWORD(req, GET_LINK_OUT_LP_CAP),
231                             &elsp->els_lp_cap_mask);
232
233         mcdi_phy_decode_link_mode(enp, MCDI_OUT_DWORD(req, GET_LINK_OUT_FLAGS),
234                             MCDI_OUT_DWORD(req, GET_LINK_OUT_LINK_SPEED),
235                             MCDI_OUT_DWORD(req, GET_LINK_OUT_FCNTL),
236                             &elsp->els_link_mode, &elsp->els_fcntl);
237
238         elsp->els_mac_up = MCDI_OUT_DWORD(req, GET_LINK_OUT_MAC_FAULT) == 0;
239
240         return (0);
241
242 fail2:
243         EFSYS_PROBE(fail2);
244 fail1:
245         EFSYS_PROBE1(fail1, efx_rc_t, rc);
246
247         return (rc);
248 }
249
250         __checkReturn   efx_rc_t
251 ef10_phy_reconfigure(
252         __in            efx_nic_t *enp)
253 {
254         efx_port_t *epp = &(enp->en_port);
255         efx_mcdi_req_t req;
256         uint8_t payload[MAX(MC_CMD_SET_LINK_IN_LEN,
257                             MC_CMD_SET_LINK_OUT_LEN)];
258         uint32_t cap_mask;
259         unsigned int led_mode;
260         unsigned int speed;
261         boolean_t supported;
262         efx_rc_t rc;
263
264         if ((rc = efx_mcdi_link_control_supported(enp, &supported)) != 0)
265                 goto fail1;
266         if (supported == B_FALSE)
267                 goto out;
268
269         (void) memset(payload, 0, sizeof (payload));
270         req.emr_cmd = MC_CMD_SET_LINK;
271         req.emr_in_buf = payload;
272         req.emr_in_length = MC_CMD_SET_LINK_IN_LEN;
273         req.emr_out_buf = payload;
274         req.emr_out_length = MC_CMD_SET_LINK_OUT_LEN;
275
276         cap_mask = epp->ep_adv_cap_mask;
277         MCDI_IN_POPULATE_DWORD_10(req, SET_LINK_IN_CAP,
278                 PHY_CAP_10HDX, (cap_mask >> EFX_PHY_CAP_10HDX) & 0x1,
279                 PHY_CAP_10FDX, (cap_mask >> EFX_PHY_CAP_10FDX) & 0x1,
280                 PHY_CAP_100HDX, (cap_mask >> EFX_PHY_CAP_100HDX) & 0x1,
281                 PHY_CAP_100FDX, (cap_mask >> EFX_PHY_CAP_100FDX) & 0x1,
282                 PHY_CAP_1000HDX, (cap_mask >> EFX_PHY_CAP_1000HDX) & 0x1,
283                 PHY_CAP_1000FDX, (cap_mask >> EFX_PHY_CAP_1000FDX) & 0x1,
284                 PHY_CAP_10000FDX, (cap_mask >> EFX_PHY_CAP_10000FDX) & 0x1,
285                 PHY_CAP_PAUSE, (cap_mask >> EFX_PHY_CAP_PAUSE) & 0x1,
286                 PHY_CAP_ASYM, (cap_mask >> EFX_PHY_CAP_ASYM) & 0x1,
287                 PHY_CAP_AN, (cap_mask >> EFX_PHY_CAP_AN) & 0x1);
288         /* Too many fields for for POPULATE macros, so insert this afterwards */
289         MCDI_IN_SET_DWORD_FIELD(req, SET_LINK_IN_CAP,
290             PHY_CAP_40000FDX, (cap_mask >> EFX_PHY_CAP_40000FDX) & 0x1);
291
292         MCDI_IN_SET_DWORD(req, SET_LINK_IN_LOOPBACK_MODE, MC_CMD_LOOPBACK_NONE);
293         speed = 0;
294         MCDI_IN_SET_DWORD(req, SET_LINK_IN_LOOPBACK_SPEED, speed);
295
296         MCDI_IN_SET_DWORD(req, SET_LINK_IN_FLAGS, 0);
297
298         efx_mcdi_execute(enp, &req);
299
300         if (req.emr_rc != 0) {
301                 rc = req.emr_rc;
302                 goto fail2;
303         }
304
305         /* And set the blink mode */
306         (void) memset(payload, 0, sizeof (payload));
307         req.emr_cmd = MC_CMD_SET_ID_LED;
308         req.emr_in_buf = payload;
309         req.emr_in_length = MC_CMD_SET_ID_LED_IN_LEN;
310         req.emr_out_buf = payload;
311         req.emr_out_length = MC_CMD_SET_ID_LED_OUT_LEN;
312
313         MCDI_IN_SET_DWORD(req, SET_ID_LED_IN_STATE, MC_CMD_LED_DEFAULT);
314
315         efx_mcdi_execute(enp, &req);
316
317         if (req.emr_rc != 0) {
318                 rc = req.emr_rc;
319                 goto fail3;
320         }
321 out:
322         return (0);
323
324 fail3:
325         EFSYS_PROBE(fail3);
326 fail2:
327         EFSYS_PROBE(fail2);
328 fail1:
329         EFSYS_PROBE1(fail1, efx_rc_t, rc);
330
331         return (rc);
332 }
333
334         __checkReturn   efx_rc_t
335 ef10_phy_verify(
336         __in            efx_nic_t *enp)
337 {
338         efx_mcdi_req_t req;
339         uint8_t payload[MAX(MC_CMD_GET_PHY_STATE_IN_LEN,
340                             MC_CMD_GET_PHY_STATE_OUT_LEN)];
341         uint32_t state;
342         efx_rc_t rc;
343
344         (void) memset(payload, 0, sizeof (payload));
345         req.emr_cmd = MC_CMD_GET_PHY_STATE;
346         req.emr_in_buf = payload;
347         req.emr_in_length = MC_CMD_GET_PHY_STATE_IN_LEN;
348         req.emr_out_buf = payload;
349         req.emr_out_length = MC_CMD_GET_PHY_STATE_OUT_LEN;
350
351         efx_mcdi_execute(enp, &req);
352
353         if (req.emr_rc != 0) {
354                 rc = req.emr_rc;
355                 goto fail1;
356         }
357
358         if (req.emr_out_length_used < MC_CMD_GET_PHY_STATE_OUT_LEN) {
359                 rc = EMSGSIZE;
360                 goto fail2;
361         }
362
363         state = MCDI_OUT_DWORD(req, GET_PHY_STATE_OUT_STATE);
364         if (state != MC_CMD_PHY_STATE_OK) {
365                 if (state != MC_CMD_PHY_STATE_ZOMBIE)
366                         EFSYS_PROBE1(mc_pcol_error, int, state);
367                 rc = ENOTACTIVE;
368                 goto fail3;
369         }
370
371         return (0);
372
373 fail3:
374         EFSYS_PROBE(fail3);
375 fail2:
376         EFSYS_PROBE(fail2);
377 fail1:
378         EFSYS_PROBE1(fail1, efx_rc_t, rc);
379
380         return (rc);
381 }
382
383         __checkReturn   efx_rc_t
384 ef10_phy_oui_get(
385         __in            efx_nic_t *enp,
386         __out           uint32_t *ouip)
387 {
388         _NOTE(ARGUNUSED(enp, ouip))
389
390         return (ENOTSUP);
391 }
392
393 #if EFSYS_OPT_BIST
394
395         __checkReturn           efx_rc_t
396 ef10_bist_enable_offline(
397         __in                    efx_nic_t *enp)
398 {
399         efx_rc_t rc;
400
401         if ((rc = efx_mcdi_bist_enable_offline(enp)) != 0)
402                 goto fail1;
403
404         return (0);
405
406 fail1:
407         EFSYS_PROBE1(fail1, efx_rc_t, rc);
408
409         return (rc);
410 }
411
412         __checkReturn           efx_rc_t
413 ef10_bist_start(
414         __in                    efx_nic_t *enp,
415         __in                    efx_bist_type_t type)
416 {
417         efx_rc_t rc;
418
419         if ((rc = efx_mcdi_bist_start(enp, type)) != 0)
420                 goto fail1;
421
422         return (0);
423
424 fail1:
425         EFSYS_PROBE1(fail1, efx_rc_t, rc);
426
427         return (rc);
428 }
429
430         __checkReturn           efx_rc_t
431 ef10_bist_poll(
432         __in                    efx_nic_t *enp,
433         __in                    efx_bist_type_t type,
434         __out                   efx_bist_result_t *resultp,
435         __out_opt __drv_when(count > 0, __notnull)
436         uint32_t *value_maskp,
437         __out_ecount_opt(count) __drv_when(count > 0, __notnull)
438         unsigned long *valuesp,
439         __in                    size_t count)
440 {
441         efx_nic_cfg_t *encp = &(enp->en_nic_cfg);
442         efx_mcdi_req_t req;
443         uint8_t payload[MAX(MC_CMD_POLL_BIST_IN_LEN,
444                             MCDI_CTL_SDU_LEN_MAX)];
445         uint32_t value_mask = 0;
446         uint32_t result;
447         efx_rc_t rc;
448
449         _NOTE(ARGUNUSED(type))
450
451         (void) memset(payload, 0, sizeof (payload));
452         req.emr_cmd = MC_CMD_POLL_BIST;
453         req.emr_in_buf = payload;
454         req.emr_in_length = MC_CMD_POLL_BIST_IN_LEN;
455         req.emr_out_buf = payload;
456         req.emr_out_length = MCDI_CTL_SDU_LEN_MAX;
457
458         efx_mcdi_execute(enp, &req);
459
460         if (req.emr_rc != 0) {
461                 rc = req.emr_rc;
462                 goto fail1;
463         }
464
465         if (req.emr_out_length_used < MC_CMD_POLL_BIST_OUT_RESULT_OFST + 4) {
466                 rc = EMSGSIZE;
467                 goto fail2;
468         }
469
470         if (count > 0)
471                 (void) memset(valuesp, '\0', count * sizeof (unsigned long));
472
473         result = MCDI_OUT_DWORD(req, POLL_BIST_OUT_RESULT);
474
475         if (result == MC_CMD_POLL_BIST_FAILED &&
476             req.emr_out_length >= MC_CMD_POLL_BIST_OUT_MEM_LEN &&
477             count > EFX_BIST_MEM_ECC_FATAL) {
478                 if (valuesp != NULL) {
479                         valuesp[EFX_BIST_MEM_TEST] =
480                             MCDI_OUT_DWORD(req, POLL_BIST_OUT_MEM_TEST);
481                         valuesp[EFX_BIST_MEM_ADDR] =
482                             MCDI_OUT_DWORD(req, POLL_BIST_OUT_MEM_ADDR);
483                         valuesp[EFX_BIST_MEM_BUS] =
484                             MCDI_OUT_DWORD(req, POLL_BIST_OUT_MEM_BUS);
485                         valuesp[EFX_BIST_MEM_EXPECT] =
486                             MCDI_OUT_DWORD(req, POLL_BIST_OUT_MEM_EXPECT);
487                         valuesp[EFX_BIST_MEM_ACTUAL] =
488                             MCDI_OUT_DWORD(req, POLL_BIST_OUT_MEM_ACTUAL);
489                         valuesp[EFX_BIST_MEM_ECC] =
490                             MCDI_OUT_DWORD(req, POLL_BIST_OUT_MEM_ECC);
491                         valuesp[EFX_BIST_MEM_ECC_PARITY] =
492                             MCDI_OUT_DWORD(req, POLL_BIST_OUT_MEM_ECC_PARITY);
493                         valuesp[EFX_BIST_MEM_ECC_FATAL] =
494                             MCDI_OUT_DWORD(req, POLL_BIST_OUT_MEM_ECC_FATAL);
495                 }
496                 value_mask |= (1 << EFX_BIST_MEM_TEST) |
497                     (1 << EFX_BIST_MEM_ADDR) |
498                     (1 << EFX_BIST_MEM_BUS) |
499                     (1 << EFX_BIST_MEM_EXPECT) |
500                     (1 << EFX_BIST_MEM_ACTUAL) |
501                     (1 << EFX_BIST_MEM_ECC) |
502                     (1 << EFX_BIST_MEM_ECC_PARITY) |
503                     (1 << EFX_BIST_MEM_ECC_FATAL);
504         } else if (result == MC_CMD_POLL_BIST_FAILED &&
505             encp->enc_phy_type == EFX_PHY_XFI_FARMI &&
506             req.emr_out_length >= MC_CMD_POLL_BIST_OUT_MRSFP_LEN &&
507             count > EFX_BIST_FAULT_CODE) {
508                 if (valuesp != NULL)
509                         valuesp[EFX_BIST_FAULT_CODE] =
510                             MCDI_OUT_DWORD(req, POLL_BIST_OUT_MRSFP_TEST);
511                 value_mask |= 1 << EFX_BIST_FAULT_CODE;
512         }
513
514         if (value_maskp != NULL)
515                 *value_maskp = value_mask;
516
517         EFSYS_ASSERT(resultp != NULL);
518         if (result == MC_CMD_POLL_BIST_RUNNING)
519                 *resultp = EFX_BIST_RESULT_RUNNING;
520         else if (result == MC_CMD_POLL_BIST_PASSED)
521                 *resultp = EFX_BIST_RESULT_PASSED;
522         else
523                 *resultp = EFX_BIST_RESULT_FAILED;
524
525         return (0);
526
527 fail2:
528         EFSYS_PROBE(fail2);
529 fail1:
530         EFSYS_PROBE1(fail1, efx_rc_t, rc);
531
532         return (rc);
533 }
534
535                         void
536 ef10_bist_stop(
537         __in            efx_nic_t *enp,
538         __in            efx_bist_type_t type)
539 {
540         /* There is no way to stop BIST on EF10. */
541         _NOTE(ARGUNUSED(enp, type))
542 }
543
544 #endif  /* EFSYS_OPT_BIST */
545
546 #endif  /* EFSYS_OPT_HUNTINGTON || EFSYS_OPT_MEDFORD */