common/sfc_efx/base: factor out wrapper to set PHY link
[dpdk.git] / drivers / common / sfc_efx / base / ef10_phy.c
1 /* SPDX-License-Identifier: BSD-3-Clause
2  *
3  * Copyright(c) 2019-2020 Xilinx, Inc.
4  * Copyright(c) 2012-2019 Solarflare Communications Inc.
5  */
6
7 #include "efx.h"
8 #include "efx_impl.h"
9
10 #if EFSYS_OPT_RIVERHEAD || EFX_OPTS_EF10()
11
12 static                  void
13 mcdi_phy_decode_cap(
14         __in            uint32_t mcdi_cap,
15         __out           uint32_t *maskp)
16 {
17         uint32_t mask;
18
19 #define CHECK_CAP(_cap) \
20         EFX_STATIC_ASSERT(EFX_PHY_CAP_##_cap == MC_CMD_PHY_CAP_##_cap##_LBN)
21
22         CHECK_CAP(10HDX);
23         CHECK_CAP(10FDX);
24         CHECK_CAP(100HDX);
25         CHECK_CAP(100FDX);
26         CHECK_CAP(1000HDX);
27         CHECK_CAP(1000FDX);
28         CHECK_CAP(10000FDX);
29         CHECK_CAP(25000FDX);
30         CHECK_CAP(40000FDX);
31         CHECK_CAP(50000FDX);
32         CHECK_CAP(100000FDX);
33         CHECK_CAP(PAUSE);
34         CHECK_CAP(ASYM);
35         CHECK_CAP(AN);
36         CHECK_CAP(DDM);
37         CHECK_CAP(BASER_FEC);
38         CHECK_CAP(BASER_FEC_REQUESTED);
39         CHECK_CAP(RS_FEC);
40         CHECK_CAP(RS_FEC_REQUESTED);
41         CHECK_CAP(25G_BASER_FEC);
42         CHECK_CAP(25G_BASER_FEC_REQUESTED);
43 #undef CHECK_CAP
44
45         mask = 0;
46         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_10HDX_LBN))
47                 mask |= (1 << EFX_PHY_CAP_10HDX);
48         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_10FDX_LBN))
49                 mask |= (1 << EFX_PHY_CAP_10FDX);
50         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_100HDX_LBN))
51                 mask |= (1 << EFX_PHY_CAP_100HDX);
52         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_100FDX_LBN))
53                 mask |= (1 << EFX_PHY_CAP_100FDX);
54         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_1000HDX_LBN))
55                 mask |= (1 << EFX_PHY_CAP_1000HDX);
56         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_1000FDX_LBN))
57                 mask |= (1 << EFX_PHY_CAP_1000FDX);
58         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_10000FDX_LBN))
59                 mask |= (1 << EFX_PHY_CAP_10000FDX);
60         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_25000FDX_LBN))
61                 mask |= (1 << EFX_PHY_CAP_25000FDX);
62         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_40000FDX_LBN))
63                 mask |= (1 << EFX_PHY_CAP_40000FDX);
64         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_50000FDX_LBN))
65                 mask |= (1 << EFX_PHY_CAP_50000FDX);
66         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_100000FDX_LBN))
67                 mask |= (1 << EFX_PHY_CAP_100000FDX);
68
69         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_PAUSE_LBN))
70                 mask |= (1 << EFX_PHY_CAP_PAUSE);
71         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_ASYM_LBN))
72                 mask |= (1 << EFX_PHY_CAP_ASYM);
73         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_AN_LBN))
74                 mask |= (1 << EFX_PHY_CAP_AN);
75
76         /* FEC caps (supported on Medford2 and later) */
77         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_BASER_FEC_LBN))
78                 mask |= (1 << EFX_PHY_CAP_BASER_FEC);
79         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_BASER_FEC_REQUESTED_LBN))
80                 mask |= (1 << EFX_PHY_CAP_BASER_FEC_REQUESTED);
81
82         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_RS_FEC_LBN))
83                 mask |= (1 << EFX_PHY_CAP_RS_FEC);
84         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_RS_FEC_REQUESTED_LBN))
85                 mask |= (1 << EFX_PHY_CAP_RS_FEC_REQUESTED);
86
87         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_25G_BASER_FEC_LBN))
88                 mask |= (1 << EFX_PHY_CAP_25G_BASER_FEC);
89         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_25G_BASER_FEC_REQUESTED_LBN))
90                 mask |= (1 << EFX_PHY_CAP_25G_BASER_FEC_REQUESTED);
91
92         *maskp = mask;
93 }
94
95 static                  void
96 mcdi_phy_decode_link_mode(
97         __in            efx_nic_t *enp,
98         __in            uint32_t link_flags,
99         __in            unsigned int speed,
100         __in            unsigned int fcntl,
101         __in            uint32_t fec,
102         __out           efx_link_mode_t *link_modep,
103         __out           unsigned int *fcntlp,
104         __out           efx_phy_fec_type_t *fecp)
105 {
106         boolean_t fd = !!(link_flags &
107                     (1 << MC_CMD_GET_LINK_OUT_FULL_DUPLEX_LBN));
108         boolean_t up = !!(link_flags &
109                     (1 << MC_CMD_GET_LINK_OUT_LINK_UP_LBN));
110
111         _NOTE(ARGUNUSED(enp))
112
113         if (!up)
114                 *link_modep = EFX_LINK_DOWN;
115         else if (speed == 100000 && fd)
116                 *link_modep = EFX_LINK_100000FDX;
117         else if (speed == 50000 && fd)
118                 *link_modep = EFX_LINK_50000FDX;
119         else if (speed == 40000 && fd)
120                 *link_modep = EFX_LINK_40000FDX;
121         else if (speed == 25000 && fd)
122                 *link_modep = EFX_LINK_25000FDX;
123         else if (speed == 10000 && fd)
124                 *link_modep = EFX_LINK_10000FDX;
125         else if (speed == 1000)
126                 *link_modep = fd ? EFX_LINK_1000FDX : EFX_LINK_1000HDX;
127         else if (speed == 100)
128                 *link_modep = fd ? EFX_LINK_100FDX : EFX_LINK_100HDX;
129         else if (speed == 10)
130                 *link_modep = fd ? EFX_LINK_10FDX : EFX_LINK_10HDX;
131         else
132                 *link_modep = EFX_LINK_UNKNOWN;
133
134         if (fcntl == MC_CMD_FCNTL_OFF)
135                 *fcntlp = 0;
136         else if (fcntl == MC_CMD_FCNTL_RESPOND)
137                 *fcntlp = EFX_FCNTL_RESPOND;
138         else if (fcntl == MC_CMD_FCNTL_GENERATE)
139                 *fcntlp = EFX_FCNTL_GENERATE;
140         else if (fcntl == MC_CMD_FCNTL_BIDIR)
141                 *fcntlp = EFX_FCNTL_RESPOND | EFX_FCNTL_GENERATE;
142         else {
143                 EFSYS_PROBE1(mc_pcol_error, int, fcntl);
144                 *fcntlp = 0;
145         }
146
147         switch (fec) {
148         case MC_CMD_FEC_NONE:
149                 *fecp = EFX_PHY_FEC_NONE;
150                 break;
151         case MC_CMD_FEC_BASER:
152                 *fecp = EFX_PHY_FEC_BASER;
153                 break;
154         case MC_CMD_FEC_RS:
155                 *fecp = EFX_PHY_FEC_RS;
156                 break;
157         default:
158                 EFSYS_PROBE1(mc_pcol_error, int, fec);
159                 *fecp = EFX_PHY_FEC_NONE;
160                 break;
161         }
162 }
163
164
165                         void
166 ef10_phy_link_ev(
167         __in            efx_nic_t *enp,
168         __in            efx_qword_t *eqp,
169         __out           efx_link_mode_t *link_modep)
170 {
171         efx_port_t *epp = &(enp->en_port);
172         unsigned int link_flags;
173         unsigned int speed;
174         unsigned int fcntl;
175         efx_phy_fec_type_t fec = MC_CMD_FEC_NONE;
176         efx_link_mode_t link_mode;
177         uint32_t lp_cap_mask;
178
179         /*
180          * Convert the LINKCHANGE speed enumeration into mbit/s, in the
181          * same way as GET_LINK encodes the speed
182          */
183         switch (MCDI_EV_FIELD(eqp, LINKCHANGE_SPEED)) {
184         case MCDI_EVENT_LINKCHANGE_SPEED_100M:
185                 speed = 100;
186                 break;
187         case MCDI_EVENT_LINKCHANGE_SPEED_1G:
188                 speed = 1000;
189                 break;
190         case MCDI_EVENT_LINKCHANGE_SPEED_10G:
191                 speed = 10000;
192                 break;
193         case MCDI_EVENT_LINKCHANGE_SPEED_25G:
194                 speed = 25000;
195                 break;
196         case MCDI_EVENT_LINKCHANGE_SPEED_40G:
197                 speed = 40000;
198                 break;
199         case MCDI_EVENT_LINKCHANGE_SPEED_50G:
200                 speed = 50000;
201                 break;
202         case MCDI_EVENT_LINKCHANGE_SPEED_100G:
203                 speed = 100000;
204                 break;
205         default:
206                 speed = 0;
207                 break;
208         }
209
210         link_flags = MCDI_EV_FIELD(eqp, LINKCHANGE_LINK_FLAGS);
211         mcdi_phy_decode_link_mode(enp, link_flags, speed,
212                                     MCDI_EV_FIELD(eqp, LINKCHANGE_FCNTL),
213                                     MC_CMD_FEC_NONE, &link_mode,
214                                     &fcntl, &fec);
215         mcdi_phy_decode_cap(MCDI_EV_FIELD(eqp, LINKCHANGE_LP_CAP),
216                             &lp_cap_mask);
217
218         /*
219          * It's safe to update ep_lp_cap_mask without the driver's port lock
220          * because presumably any concurrently running efx_port_poll() is
221          * only going to arrive at the same value.
222          *
223          * ep_fcntl has two meanings. It's either the link common fcntl
224          * (if the PHY supports AN), or it's the forced link state. If
225          * the former, it's safe to update the value for the same reason as
226          * for ep_lp_cap_mask. If the latter, then just ignore the value,
227          * because we can race with efx_mac_fcntl_set().
228          */
229         epp->ep_lp_cap_mask = lp_cap_mask;
230         epp->ep_fcntl = fcntl;
231
232         *link_modep = link_mode;
233 }
234
235         __checkReturn   efx_rc_t
236 ef10_phy_power(
237         __in            efx_nic_t *enp,
238         __in            boolean_t power)
239 {
240         efx_rc_t rc;
241
242         if (!power)
243                 return (0);
244
245         /* Check if the PHY is a zombie */
246         if ((rc = ef10_phy_verify(enp)) != 0)
247                 goto fail1;
248
249         enp->en_reset_flags |= EFX_RESET_PHY;
250
251         return (0);
252
253 fail1:
254         EFSYS_PROBE1(fail1, efx_rc_t, rc);
255
256         return (rc);
257 }
258
259         __checkReturn   efx_rc_t
260 ef10_phy_get_link(
261         __in            efx_nic_t *enp,
262         __out           ef10_link_state_t *elsp)
263 {
264         efx_mcdi_req_t req;
265         uint32_t fec;
266         EFX_MCDI_DECLARE_BUF(payload, MC_CMD_GET_LINK_IN_LEN,
267                 MC_CMD_GET_LINK_OUT_V2_LEN);
268         efx_rc_t rc;
269
270         req.emr_cmd = MC_CMD_GET_LINK;
271         req.emr_in_buf = payload;
272         req.emr_in_length = MC_CMD_GET_LINK_IN_LEN;
273         req.emr_out_buf = payload;
274         req.emr_out_length = MC_CMD_GET_LINK_OUT_V2_LEN;
275
276         efx_mcdi_execute(enp, &req);
277
278         if (req.emr_rc != 0) {
279                 rc = req.emr_rc;
280                 goto fail1;
281         }
282
283         if (req.emr_out_length_used < MC_CMD_GET_LINK_OUT_LEN) {
284                 rc = EMSGSIZE;
285                 goto fail2;
286         }
287
288         mcdi_phy_decode_cap(MCDI_OUT_DWORD(req, GET_LINK_OUT_CAP),
289                             &elsp->epls.epls_adv_cap_mask);
290         mcdi_phy_decode_cap(MCDI_OUT_DWORD(req, GET_LINK_OUT_LP_CAP),
291                             &elsp->epls.epls_lp_cap_mask);
292
293         if (req.emr_out_length_used < MC_CMD_GET_LINK_OUT_V2_LEN)
294                 fec = MC_CMD_FEC_NONE;
295         else
296                 fec = MCDI_OUT_DWORD(req, GET_LINK_OUT_V2_FEC_TYPE);
297
298         mcdi_phy_decode_link_mode(enp, MCDI_OUT_DWORD(req, GET_LINK_OUT_FLAGS),
299                             MCDI_OUT_DWORD(req, GET_LINK_OUT_LINK_SPEED),
300                             MCDI_OUT_DWORD(req, GET_LINK_OUT_FCNTL),
301                             fec, &elsp->epls.epls_link_mode,
302                             &elsp->epls.epls_fcntl, &elsp->epls.epls_fec);
303
304         if (req.emr_out_length_used < MC_CMD_GET_LINK_OUT_V2_LEN) {
305                 elsp->epls.epls_ld_cap_mask = 0;
306         } else {
307                 mcdi_phy_decode_cap(MCDI_OUT_DWORD(req, GET_LINK_OUT_V2_LD_CAP),
308                                     &elsp->epls.epls_ld_cap_mask);
309         }
310
311
312 #if EFSYS_OPT_LOOPBACK
313         /*
314          * MC_CMD_LOOPBACK and EFX_LOOPBACK names are equivalent, so use the
315          * MCDI value directly. Agreement is checked in efx_loopback_mask().
316          */
317         elsp->els_loopback = MCDI_OUT_DWORD(req, GET_LINK_OUT_LOOPBACK_MODE);
318 #endif  /* EFSYS_OPT_LOOPBACK */
319
320         elsp->els_mac_up = MCDI_OUT_DWORD(req, GET_LINK_OUT_MAC_FAULT) == 0;
321
322         return (0);
323
324 fail2:
325         EFSYS_PROBE(fail2);
326 fail1:
327         EFSYS_PROBE1(fail1, efx_rc_t, rc);
328
329         return (rc);
330 }
331
332 static  __checkReturn   efx_rc_t
333 efx_mcdi_phy_set_link(
334         __in            efx_nic_t *enp,
335         __in            uint32_t cap_mask,
336         __in            efx_loopback_type_t loopback_type,
337         __in            efx_link_mode_t loopback_link_mode,
338         __in            uint32_t phy_flags)
339 {
340         efx_mcdi_req_t req;
341         EFX_MCDI_DECLARE_BUF(payload, MC_CMD_SET_LINK_IN_LEN,
342                 MC_CMD_SET_LINK_OUT_LEN);
343         unsigned int speed;
344         efx_rc_t rc;
345
346         req.emr_cmd = MC_CMD_SET_LINK;
347         req.emr_in_buf = payload;
348         req.emr_in_length = MC_CMD_SET_LINK_IN_LEN;
349         req.emr_out_buf = payload;
350         req.emr_out_length = MC_CMD_SET_LINK_OUT_LEN;
351
352         MCDI_IN_POPULATE_DWORD_10(req, SET_LINK_IN_CAP,
353                 PHY_CAP_10HDX, (cap_mask >> EFX_PHY_CAP_10HDX) & 0x1,
354                 PHY_CAP_10FDX, (cap_mask >> EFX_PHY_CAP_10FDX) & 0x1,
355                 PHY_CAP_100HDX, (cap_mask >> EFX_PHY_CAP_100HDX) & 0x1,
356                 PHY_CAP_100FDX, (cap_mask >> EFX_PHY_CAP_100FDX) & 0x1,
357                 PHY_CAP_1000HDX, (cap_mask >> EFX_PHY_CAP_1000HDX) & 0x1,
358                 PHY_CAP_1000FDX, (cap_mask >> EFX_PHY_CAP_1000FDX) & 0x1,
359                 PHY_CAP_10000FDX, (cap_mask >> EFX_PHY_CAP_10000FDX) & 0x1,
360                 PHY_CAP_PAUSE, (cap_mask >> EFX_PHY_CAP_PAUSE) & 0x1,
361                 PHY_CAP_ASYM, (cap_mask >> EFX_PHY_CAP_ASYM) & 0x1,
362                 PHY_CAP_AN, (cap_mask >> EFX_PHY_CAP_AN) & 0x1);
363         /* Too many fields for for POPULATE macros, so insert this afterwards */
364         MCDI_IN_SET_DWORD_FIELD(req, SET_LINK_IN_CAP,
365             PHY_CAP_25000FDX, (cap_mask >> EFX_PHY_CAP_25000FDX) & 0x1);
366         MCDI_IN_SET_DWORD_FIELD(req, SET_LINK_IN_CAP,
367             PHY_CAP_40000FDX, (cap_mask >> EFX_PHY_CAP_40000FDX) & 0x1);
368         MCDI_IN_SET_DWORD_FIELD(req, SET_LINK_IN_CAP,
369             PHY_CAP_50000FDX, (cap_mask >> EFX_PHY_CAP_50000FDX) & 0x1);
370         MCDI_IN_SET_DWORD_FIELD(req, SET_LINK_IN_CAP,
371             PHY_CAP_100000FDX, (cap_mask >> EFX_PHY_CAP_100000FDX) & 0x1);
372
373         MCDI_IN_SET_DWORD_FIELD(req, SET_LINK_IN_CAP,
374             PHY_CAP_BASER_FEC, (cap_mask >> EFX_PHY_CAP_BASER_FEC) & 0x1);
375         MCDI_IN_SET_DWORD_FIELD(req, SET_LINK_IN_CAP,
376             PHY_CAP_BASER_FEC_REQUESTED,
377             (cap_mask >> EFX_PHY_CAP_BASER_FEC_REQUESTED) & 0x1);
378
379         MCDI_IN_SET_DWORD_FIELD(req, SET_LINK_IN_CAP,
380             PHY_CAP_RS_FEC, (cap_mask >> EFX_PHY_CAP_RS_FEC) & 0x1);
381         MCDI_IN_SET_DWORD_FIELD(req, SET_LINK_IN_CAP,
382             PHY_CAP_RS_FEC_REQUESTED,
383             (cap_mask >> EFX_PHY_CAP_RS_FEC_REQUESTED) & 0x1);
384
385         MCDI_IN_SET_DWORD_FIELD(req, SET_LINK_IN_CAP,
386             PHY_CAP_25G_BASER_FEC,
387             (cap_mask >> EFX_PHY_CAP_25G_BASER_FEC) & 0x1);
388         MCDI_IN_SET_DWORD_FIELD(req, SET_LINK_IN_CAP,
389             PHY_CAP_25G_BASER_FEC_REQUESTED,
390             (cap_mask >> EFX_PHY_CAP_25G_BASER_FEC_REQUESTED) & 0x1);
391
392         MCDI_IN_SET_DWORD(req, SET_LINK_IN_LOOPBACK_MODE, loopback_type);
393
394         switch (loopback_link_mode) {
395         case EFX_LINK_100FDX:
396                 speed = 100;
397                 break;
398         case EFX_LINK_1000FDX:
399                 speed = 1000;
400                 break;
401         case EFX_LINK_10000FDX:
402                 speed = 10000;
403                 break;
404         case EFX_LINK_25000FDX:
405                 speed = 25000;
406                 break;
407         case EFX_LINK_40000FDX:
408                 speed = 40000;
409                 break;
410         case EFX_LINK_50000FDX:
411                 speed = 50000;
412                 break;
413         case EFX_LINK_100000FDX:
414                 speed = 100000;
415                 break;
416         default:
417                 speed = 0;
418                 break;
419         }
420         MCDI_IN_SET_DWORD(req, SET_LINK_IN_LOOPBACK_SPEED, speed);
421
422         MCDI_IN_SET_DWORD(req, SET_LINK_IN_FLAGS, phy_flags);
423
424         efx_mcdi_execute(enp, &req);
425
426         if (req.emr_rc != 0) {
427                 rc = req.emr_rc;
428                 goto fail1;
429         }
430
431         return (0);
432
433 fail1:
434         EFSYS_PROBE1(fail1, efx_rc_t, rc);
435
436         return (rc);
437 }
438
439         __checkReturn   efx_rc_t
440 ef10_phy_reconfigure(
441         __in            efx_nic_t *enp)
442 {
443         efx_port_t *epp = &(enp->en_port);
444         efx_mcdi_req_t req;
445         EFX_MCDI_DECLARE_BUF(payload, MC_CMD_SET_ID_LED_IN_LEN,
446                 MC_CMD_SET_ID_LED_OUT_LEN);
447         efx_loopback_type_t loopback_type;
448         efx_link_mode_t loopback_link_mode;
449         uint32_t phy_flags;
450 #if EFSYS_OPT_PHY_LED_CONTROL
451         unsigned int led_mode;
452 #endif
453         boolean_t supported;
454         efx_rc_t rc;
455
456         if ((rc = efx_mcdi_link_control_supported(enp, &supported)) != 0)
457                 goto fail1;
458         if (supported == B_FALSE)
459                 goto out;
460
461 #if EFSYS_OPT_LOOPBACK
462         loopback_type = epp->ep_loopback_type;
463         loopback_link_mode = epp->ep_loopback_link_mode;
464 #else
465         loopback_type = EFX_LOOPBACK_OFF;
466         loopback_link_mode = EFX_LINK_UNKNOWN;
467 #endif
468 #if EFSYS_OPT_PHY_FLAGS
469         phy_flags = epp->ep_phy_flags;
470 #else
471         phy_flags = 0;
472 #endif
473
474         rc = efx_mcdi_phy_set_link(enp, epp->ep_adv_cap_mask,
475             loopback_type, loopback_link_mode, phy_flags);
476         if (rc != 0)
477                 goto fail2;
478
479         /* And set the blink mode */
480         (void) memset(payload, 0, sizeof (payload));
481         req.emr_cmd = MC_CMD_SET_ID_LED;
482         req.emr_in_buf = payload;
483         req.emr_in_length = MC_CMD_SET_ID_LED_IN_LEN;
484         req.emr_out_buf = payload;
485         req.emr_out_length = MC_CMD_SET_ID_LED_OUT_LEN;
486
487 #if EFSYS_OPT_PHY_LED_CONTROL
488         switch (epp->ep_phy_led_mode) {
489         case EFX_PHY_LED_DEFAULT:
490                 led_mode = MC_CMD_LED_DEFAULT;
491                 break;
492         case EFX_PHY_LED_OFF:
493                 led_mode = MC_CMD_LED_OFF;
494                 break;
495         case EFX_PHY_LED_ON:
496                 led_mode = MC_CMD_LED_ON;
497                 break;
498         default:
499                 EFSYS_ASSERT(0);
500                 led_mode = MC_CMD_LED_DEFAULT;
501         }
502
503         MCDI_IN_SET_DWORD(req, SET_ID_LED_IN_STATE, led_mode);
504 #else
505         MCDI_IN_SET_DWORD(req, SET_ID_LED_IN_STATE, MC_CMD_LED_DEFAULT);
506 #endif  /* EFSYS_OPT_PHY_LED_CONTROL */
507
508         efx_mcdi_execute(enp, &req);
509
510         if (req.emr_rc != 0) {
511                 rc = req.emr_rc;
512                 goto fail3;
513         }
514 out:
515         return (0);
516
517 fail3:
518         EFSYS_PROBE(fail3);
519 fail2:
520         EFSYS_PROBE(fail2);
521 fail1:
522         EFSYS_PROBE1(fail1, efx_rc_t, rc);
523
524         return (rc);
525 }
526
527         __checkReturn   efx_rc_t
528 ef10_phy_verify(
529         __in            efx_nic_t *enp)
530 {
531         efx_mcdi_req_t req;
532         EFX_MCDI_DECLARE_BUF(payload, MC_CMD_GET_PHY_STATE_IN_LEN,
533                 MC_CMD_GET_PHY_STATE_OUT_LEN);
534         uint32_t state;
535         efx_rc_t rc;
536
537         req.emr_cmd = MC_CMD_GET_PHY_STATE;
538         req.emr_in_buf = payload;
539         req.emr_in_length = MC_CMD_GET_PHY_STATE_IN_LEN;
540         req.emr_out_buf = payload;
541         req.emr_out_length = MC_CMD_GET_PHY_STATE_OUT_LEN;
542
543         efx_mcdi_execute(enp, &req);
544
545         if (req.emr_rc != 0) {
546                 rc = req.emr_rc;
547                 goto fail1;
548         }
549
550         if (req.emr_out_length_used < MC_CMD_GET_PHY_STATE_OUT_LEN) {
551                 rc = EMSGSIZE;
552                 goto fail2;
553         }
554
555         state = MCDI_OUT_DWORD(req, GET_PHY_STATE_OUT_STATE);
556         if (state != MC_CMD_PHY_STATE_OK) {
557                 if (state != MC_CMD_PHY_STATE_ZOMBIE)
558                         EFSYS_PROBE1(mc_pcol_error, int, state);
559                 rc = ENOTACTIVE;
560                 goto fail3;
561         }
562
563         return (0);
564
565 fail3:
566         EFSYS_PROBE(fail3);
567 fail2:
568         EFSYS_PROBE(fail2);
569 fail1:
570         EFSYS_PROBE1(fail1, efx_rc_t, rc);
571
572         return (rc);
573 }
574
575         __checkReturn   efx_rc_t
576 ef10_phy_oui_get(
577         __in            efx_nic_t *enp,
578         __out           uint32_t *ouip)
579 {
580         _NOTE(ARGUNUSED(enp, ouip))
581
582         return (ENOTSUP);
583 }
584
585         __checkReturn   efx_rc_t
586 ef10_phy_link_state_get(
587         __in            efx_nic_t *enp,
588         __out           efx_phy_link_state_t  *eplsp)
589 {
590         efx_rc_t rc;
591         ef10_link_state_t els;
592
593         /* Obtain the active link state */
594         if ((rc = ef10_phy_get_link(enp, &els)) != 0)
595                 goto fail1;
596
597         *eplsp = els.epls;
598
599         return (0);
600
601 fail1:
602         EFSYS_PROBE1(fail1, efx_rc_t, rc);
603
604         return (rc);
605 }
606
607
608 #if EFSYS_OPT_PHY_STATS
609
610         __checkReturn                           efx_rc_t
611 ef10_phy_stats_update(
612         __in                                    efx_nic_t *enp,
613         __in                                    efsys_mem_t *esmp,
614         __inout_ecount(EFX_PHY_NSTATS)          uint32_t *stat)
615 {
616         /* TBD: no stats support in firmware yet */
617         _NOTE(ARGUNUSED(enp, esmp))
618         memset(stat, 0, EFX_PHY_NSTATS * sizeof (*stat));
619
620         return (0);
621 }
622
623 #endif  /* EFSYS_OPT_PHY_STATS */
624
625 #if EFSYS_OPT_BIST
626
627         __checkReturn           efx_rc_t
628 ef10_bist_enable_offline(
629         __in                    efx_nic_t *enp)
630 {
631         efx_rc_t rc;
632
633         if ((rc = efx_mcdi_bist_enable_offline(enp)) != 0)
634                 goto fail1;
635
636         return (0);
637
638 fail1:
639         EFSYS_PROBE1(fail1, efx_rc_t, rc);
640
641         return (rc);
642 }
643
644         __checkReturn           efx_rc_t
645 ef10_bist_start(
646         __in                    efx_nic_t *enp,
647         __in                    efx_bist_type_t type)
648 {
649         efx_rc_t rc;
650
651         if ((rc = efx_mcdi_bist_start(enp, type)) != 0)
652                 goto fail1;
653
654         return (0);
655
656 fail1:
657         EFSYS_PROBE1(fail1, efx_rc_t, rc);
658
659         return (rc);
660 }
661
662         __checkReturn           efx_rc_t
663 ef10_bist_poll(
664         __in                    efx_nic_t *enp,
665         __in                    efx_bist_type_t type,
666         __out                   efx_bist_result_t *resultp,
667         __out_opt __drv_when(count > 0, __notnull)
668         uint32_t *value_maskp,
669         __out_ecount_opt(count) __drv_when(count > 0, __notnull)
670         unsigned long *valuesp,
671         __in                    size_t count)
672 {
673         /*
674          * MCDI_CTL_SDU_LEN_MAX_V1 is large enough cover all BIST results,
675          * whilst not wasting stack.
676          */
677         EFX_MCDI_DECLARE_BUF(payload, MC_CMD_POLL_BIST_IN_LEN,
678                 MCDI_CTL_SDU_LEN_MAX_V1);
679         efx_nic_cfg_t *encp = &(enp->en_nic_cfg);
680         efx_mcdi_req_t req;
681         uint32_t value_mask = 0;
682         uint32_t result;
683         efx_rc_t rc;
684
685         EFX_STATIC_ASSERT(MC_CMD_POLL_BIST_OUT_LEN <=
686             MCDI_CTL_SDU_LEN_MAX_V1);
687         EFX_STATIC_ASSERT(MC_CMD_POLL_BIST_OUT_SFT9001_LEN <=
688             MCDI_CTL_SDU_LEN_MAX_V1);
689         EFX_STATIC_ASSERT(MC_CMD_POLL_BIST_OUT_MRSFP_LEN <=
690             MCDI_CTL_SDU_LEN_MAX_V1);
691         EFX_STATIC_ASSERT(MC_CMD_POLL_BIST_OUT_MEM_LEN <=
692             MCDI_CTL_SDU_LEN_MAX_V1);
693
694         _NOTE(ARGUNUSED(type))
695
696         req.emr_cmd = MC_CMD_POLL_BIST;
697         req.emr_in_buf = payload;
698         req.emr_in_length = MC_CMD_POLL_BIST_IN_LEN;
699         req.emr_out_buf = payload;
700         req.emr_out_length = MCDI_CTL_SDU_LEN_MAX_V1;
701
702         efx_mcdi_execute(enp, &req);
703
704         if (req.emr_rc != 0) {
705                 rc = req.emr_rc;
706                 goto fail1;
707         }
708
709         if (req.emr_out_length_used < MC_CMD_POLL_BIST_OUT_RESULT_OFST + 4) {
710                 rc = EMSGSIZE;
711                 goto fail2;
712         }
713
714         if (count > 0)
715                 (void) memset(valuesp, '\0', count * sizeof (unsigned long));
716
717         result = MCDI_OUT_DWORD(req, POLL_BIST_OUT_RESULT);
718
719         if (result == MC_CMD_POLL_BIST_FAILED &&
720             req.emr_out_length >= MC_CMD_POLL_BIST_OUT_MEM_LEN &&
721             count > EFX_BIST_MEM_ECC_FATAL) {
722                 if (valuesp != NULL) {
723                         valuesp[EFX_BIST_MEM_TEST] =
724                             MCDI_OUT_DWORD(req, POLL_BIST_OUT_MEM_TEST);
725                         valuesp[EFX_BIST_MEM_ADDR] =
726                             MCDI_OUT_DWORD(req, POLL_BIST_OUT_MEM_ADDR);
727                         valuesp[EFX_BIST_MEM_BUS] =
728                             MCDI_OUT_DWORD(req, POLL_BIST_OUT_MEM_BUS);
729                         valuesp[EFX_BIST_MEM_EXPECT] =
730                             MCDI_OUT_DWORD(req, POLL_BIST_OUT_MEM_EXPECT);
731                         valuesp[EFX_BIST_MEM_ACTUAL] =
732                             MCDI_OUT_DWORD(req, POLL_BIST_OUT_MEM_ACTUAL);
733                         valuesp[EFX_BIST_MEM_ECC] =
734                             MCDI_OUT_DWORD(req, POLL_BIST_OUT_MEM_ECC);
735                         valuesp[EFX_BIST_MEM_ECC_PARITY] =
736                             MCDI_OUT_DWORD(req, POLL_BIST_OUT_MEM_ECC_PARITY);
737                         valuesp[EFX_BIST_MEM_ECC_FATAL] =
738                             MCDI_OUT_DWORD(req, POLL_BIST_OUT_MEM_ECC_FATAL);
739                 }
740                 value_mask |= (1 << EFX_BIST_MEM_TEST) |
741                     (1 << EFX_BIST_MEM_ADDR) |
742                     (1 << EFX_BIST_MEM_BUS) |
743                     (1 << EFX_BIST_MEM_EXPECT) |
744                     (1 << EFX_BIST_MEM_ACTUAL) |
745                     (1 << EFX_BIST_MEM_ECC) |
746                     (1 << EFX_BIST_MEM_ECC_PARITY) |
747                     (1 << EFX_BIST_MEM_ECC_FATAL);
748         } else if (result == MC_CMD_POLL_BIST_FAILED &&
749             encp->enc_phy_type == EFX_PHY_XFI_FARMI &&
750             req.emr_out_length >= MC_CMD_POLL_BIST_OUT_MRSFP_LEN &&
751             count > EFX_BIST_FAULT_CODE) {
752                 if (valuesp != NULL)
753                         valuesp[EFX_BIST_FAULT_CODE] =
754                             MCDI_OUT_DWORD(req, POLL_BIST_OUT_MRSFP_TEST);
755                 value_mask |= 1 << EFX_BIST_FAULT_CODE;
756         }
757
758         if (value_maskp != NULL)
759                 *value_maskp = value_mask;
760
761         EFSYS_ASSERT(resultp != NULL);
762         if (result == MC_CMD_POLL_BIST_RUNNING)
763                 *resultp = EFX_BIST_RESULT_RUNNING;
764         else if (result == MC_CMD_POLL_BIST_PASSED)
765                 *resultp = EFX_BIST_RESULT_PASSED;
766         else
767                 *resultp = EFX_BIST_RESULT_FAILED;
768
769         return (0);
770
771 fail2:
772         EFSYS_PROBE(fail2);
773 fail1:
774         EFSYS_PROBE1(fail1, efx_rc_t, rc);
775
776         return (rc);
777 }
778
779                         void
780 ef10_bist_stop(
781         __in            efx_nic_t *enp,
782         __in            efx_bist_type_t type)
783 {
784         /* There is no way to stop BIST on EF10. */
785         _NOTE(ARGUNUSED(enp, type))
786 }
787
788 #endif  /* EFSYS_OPT_BIST */
789
790 #endif  /* EFSYS_OPT_RIVERHEAD || EFX_OPTS_EF10() */