]> CyberLeo.Net >> Repos - FreeBSD/releng/10.3.git/blob - sys/dev/sfxge/common/siena_vpd.c
- Copy stable/10@296371 to releng/10.3 in preparation for 10.3-RC1
[FreeBSD/releng/10.3.git] / sys / dev / sfxge / common / siena_vpd.c
1 /*-
2  * Copyright (c) 2009-2015 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 <sys/cdefs.h>
32 __FBSDID("$FreeBSD$");
33
34 #include "efx.h"
35 #include "efx_impl.h"
36
37 #if EFSYS_OPT_VPD
38
39 #if EFSYS_OPT_SIENA
40
41 static  __checkReturn                   efx_rc_t
42 siena_vpd_get_static(
43         __in                            efx_nic_t *enp,
44         __in                            uint32_t partn,
45         __deref_out_bcount_opt(*sizep)  caddr_t *svpdp,
46         __out                           size_t *sizep)
47 {
48         siena_mc_static_config_hdr_t *scfg;
49         caddr_t svpd;
50         size_t size;
51         uint8_t cksum;
52         unsigned int vpd_offset;
53         unsigned int vpd_length;
54         unsigned int hdr_length;
55         unsigned int pos;
56         unsigned int region;
57         efx_rc_t rc;
58
59         EFSYS_ASSERT(partn == MC_CMD_NVRAM_TYPE_STATIC_CFG_PORT0 ||
60                     partn == MC_CMD_NVRAM_TYPE_STATIC_CFG_PORT1);
61
62         /* Allocate sufficient memory for the entire static cfg area */
63         if ((rc = siena_nvram_partn_size(enp, partn, &size)) != 0)
64                 goto fail1;
65
66         EFSYS_KMEM_ALLOC(enp->en_esip, size, scfg);
67         if (scfg == NULL) {
68                 rc = ENOMEM;
69                 goto fail2;
70         }
71
72         if ((rc = siena_nvram_partn_read(enp, partn, 0,
73             (caddr_t)scfg, SIENA_NVRAM_CHUNK)) != 0)
74                 goto fail3;
75
76         /* Verify the magic number */
77         if (EFX_DWORD_FIELD(scfg->magic, EFX_DWORD_0) !=
78             SIENA_MC_STATIC_CONFIG_MAGIC) {
79                 rc = EINVAL;
80                 goto fail4;
81         }
82
83         /* All future versions of the structure must be backwards compatable */
84         EFX_STATIC_ASSERT(SIENA_MC_STATIC_CONFIG_VERSION == 0);
85
86         hdr_length = EFX_WORD_FIELD(scfg->length, EFX_WORD_0);
87         vpd_offset = EFX_DWORD_FIELD(scfg->static_vpd_offset, EFX_DWORD_0);
88         vpd_length = EFX_DWORD_FIELD(scfg->static_vpd_length, EFX_DWORD_0);
89
90         /* Verify the hdr doesn't overflow the sector size */
91         if (hdr_length > size || vpd_offset > size || vpd_length > size ||
92             vpd_length + vpd_offset > size) {
93                 rc = EINVAL;
94                 goto fail5;
95         }
96
97         /* Read the remainder of scfg + static vpd */
98         region = vpd_offset + vpd_length;
99         if (region > SIENA_NVRAM_CHUNK) {
100                 if ((rc = siena_nvram_partn_read(enp, partn, SIENA_NVRAM_CHUNK,
101                     (caddr_t)scfg + SIENA_NVRAM_CHUNK,
102                     region - SIENA_NVRAM_CHUNK)) != 0)
103                         goto fail6;
104         }
105
106         /* Verify checksum */
107         cksum = 0;
108         for (pos = 0; pos < hdr_length; pos++)
109                 cksum += ((uint8_t *)scfg)[pos];
110         if (cksum != 0) {
111                 rc = EINVAL;
112                 goto fail7;
113         }
114
115         if (vpd_length == 0)
116                 svpd = NULL;
117         else {
118                 /* Copy the vpd data out */
119                 EFSYS_KMEM_ALLOC(enp->en_esip, vpd_length, svpd);
120                 if (svpd == NULL) {
121                         rc = ENOMEM;
122                         goto fail8;
123                 }
124                 memcpy(svpd, (caddr_t)scfg + vpd_offset, vpd_length);
125         }
126
127         EFSYS_KMEM_FREE(enp->en_esip, size, scfg);
128
129         *svpdp = svpd;
130         *sizep = vpd_length;
131
132         return (0);
133
134 fail8:
135         EFSYS_PROBE(fail8);
136 fail7:
137         EFSYS_PROBE(fail7);
138 fail6:
139         EFSYS_PROBE(fail6);
140 fail5:
141         EFSYS_PROBE(fail5);
142 fail4:
143         EFSYS_PROBE(fail4);
144 fail3:
145         EFSYS_PROBE(fail3);
146
147         EFSYS_KMEM_FREE(enp->en_esip, size, scfg);
148
149 fail2:
150         EFSYS_PROBE(fail2);
151 fail1:
152         EFSYS_PROBE1(fail1, efx_rc_t, rc);
153
154         return (rc);
155 }
156
157         __checkReturn           efx_rc_t
158 siena_vpd_init(
159         __in                    efx_nic_t *enp)
160 {
161         efx_mcdi_iface_t *emip = &(enp->en_mcdi.em_emip);
162         caddr_t svpd = NULL;
163         unsigned partn;
164         size_t size = 0;
165         efx_rc_t rc;
166
167         EFSYS_ASSERT(enp->en_family == EFX_FAMILY_SIENA);
168
169         partn = (emip->emi_port == 1)
170                 ? MC_CMD_NVRAM_TYPE_STATIC_CFG_PORT0
171                 : MC_CMD_NVRAM_TYPE_STATIC_CFG_PORT1;
172
173         /*
174          * We need the static VPD sector to present a unified static+dynamic
175          * VPD, that is, basically on every read, write, verify cycle. Since
176          * it should *never* change we can just cache it here.
177          */
178         if ((rc = siena_vpd_get_static(enp, partn, &svpd, &size)) != 0)
179                 goto fail1;
180
181         if (svpd != NULL && size > 0) {
182                 if ((rc = efx_vpd_hunk_verify(svpd, size, NULL)) != 0)
183                         goto fail2;
184         }
185
186         enp->en_u.siena.enu_svpd = svpd;
187         enp->en_u.siena.enu_svpd_length = size;
188
189         return (0);
190
191 fail2:
192         EFSYS_PROBE(fail2);
193
194         EFSYS_KMEM_FREE(enp->en_esip, size, svpd);
195 fail1:
196         EFSYS_PROBE1(fail1, efx_rc_t, rc);
197
198         return (rc);
199 }
200
201         __checkReturn           efx_rc_t
202 siena_vpd_size(
203         __in                    efx_nic_t *enp,
204         __out                   size_t *sizep)
205 {
206         efx_mcdi_iface_t *emip = &(enp->en_mcdi.em_emip);
207         uint32_t partn;
208         efx_rc_t rc;
209
210         EFSYS_ASSERT(enp->en_family == EFX_FAMILY_SIENA);
211
212         /*
213          * This function returns the total size the user should allocate
214          * for all VPD operations. We've already cached the static vpd,
215          * so we just need to return an upper bound on the dynamic vpd.
216          * Since the dynamic_config structure can change under our feet,
217          * (as version numbers are inserted), just be safe and return the
218          * total size of the dynamic_config *sector*
219          */
220         partn = (emip->emi_port == 1)
221                 ? MC_CMD_NVRAM_TYPE_DYNAMIC_CFG_PORT0
222                 : MC_CMD_NVRAM_TYPE_DYNAMIC_CFG_PORT1;
223
224         if ((rc = siena_nvram_partn_size(enp, partn, sizep)) != 0)
225                 goto fail1;
226
227         return (0);
228
229 fail1:
230         EFSYS_PROBE1(fail1, efx_rc_t, rc);
231
232         return (rc);
233 }
234
235         __checkReturn           efx_rc_t
236 siena_vpd_read(
237         __in                    efx_nic_t *enp,
238         __out_bcount(size)      caddr_t data,
239         __in                    size_t size)
240 {
241         efx_mcdi_iface_t *emip = &(enp->en_mcdi.em_emip);
242         siena_mc_dynamic_config_hdr_t *dcfg = NULL;
243         unsigned int vpd_length;
244         unsigned int vpd_offset;
245         unsigned int dcfg_partn;
246         size_t dcfg_size;
247         efx_rc_t rc;
248
249         EFSYS_ASSERT(enp->en_family == EFX_FAMILY_SIENA);
250
251         dcfg_partn = (emip->emi_port == 1)
252                 ? MC_CMD_NVRAM_TYPE_DYNAMIC_CFG_PORT0
253                 : MC_CMD_NVRAM_TYPE_DYNAMIC_CFG_PORT1;
254
255         if ((rc = siena_nvram_get_dynamic_cfg(enp, dcfg_partn,
256             B_TRUE, &dcfg, &dcfg_size)) != 0)
257                 goto fail1;
258
259         vpd_length = EFX_DWORD_FIELD(dcfg->dynamic_vpd_length, EFX_DWORD_0);
260         vpd_offset = EFX_DWORD_FIELD(dcfg->dynamic_vpd_offset, EFX_DWORD_0);
261
262         if (vpd_length > size) {
263                 rc = EFAULT;    /* Invalid dcfg: header bigger than sector */
264                 goto fail2;
265         }
266
267         EFSYS_ASSERT3U(vpd_length, <=, size);
268         memcpy(data, (caddr_t)dcfg + vpd_offset, vpd_length);
269
270         /* Pad data with all-1s, consistent with update operations */
271         memset(data + vpd_length, 0xff, size - vpd_length);
272
273         EFSYS_KMEM_FREE(enp->en_esip, dcfg_size, dcfg);
274
275         return (0);
276
277 fail2:
278         EFSYS_PROBE(fail2);
279
280         EFSYS_KMEM_FREE(enp->en_esip, dcfg_size, dcfg);
281 fail1:
282         EFSYS_PROBE1(fail1, efx_rc_t, rc);
283
284         return (rc);
285 }
286
287         __checkReturn           efx_rc_t
288 siena_vpd_verify(
289         __in                    efx_nic_t *enp,
290         __in_bcount(size)       caddr_t data,
291         __in                    size_t size)
292 {
293         efx_vpd_tag_t stag;
294         efx_vpd_tag_t dtag;
295         efx_vpd_keyword_t skey;
296         efx_vpd_keyword_t dkey;
297         unsigned int scont;
298         unsigned int dcont;
299
300         efx_rc_t rc;
301
302         EFSYS_ASSERT(enp->en_family == EFX_FAMILY_SIENA);
303
304         /*
305          * Strictly you could take the view that dynamic vpd is optional.
306          * Instead, to conform more closely to the read/verify/reinit()
307          * paradigm, we require dynamic vpd. siena_vpd_reinit() will
308          * reinitialize it as required.
309          */
310         if ((rc = efx_vpd_hunk_verify(data, size, NULL)) != 0)
311                 goto fail1;
312
313         /*
314          * Verify that there is no duplication between the static and
315          * dynamic cfg sectors.
316          */
317         if (enp->en_u.siena.enu_svpd_length == 0)
318                 goto done;
319
320         dcont = 0;
321         _NOTE(CONSTANTCONDITION)
322         while (1) {
323                 if ((rc = efx_vpd_hunk_next(data, size, &dtag,
324                     &dkey, NULL, NULL, &dcont)) != 0)
325                         goto fail2;
326                 if (dcont == 0)
327                         break;
328
329                 /*
330                  * Skip the RV keyword. It should be present in both the static
331                  * and dynamic cfg sectors.
332                  */
333                 if (dtag == EFX_VPD_RO && dkey == EFX_VPD_KEYWORD('R', 'V'))
334                         continue;
335
336                 scont = 0;
337                 _NOTE(CONSTANTCONDITION)
338                 while (1) {
339                         if ((rc = efx_vpd_hunk_next(
340                             enp->en_u.siena.enu_svpd,
341                             enp->en_u.siena.enu_svpd_length, &stag, &skey,
342                             NULL, NULL, &scont)) != 0)
343                                 goto fail3;
344                         if (scont == 0)
345                                 break;
346
347                         if (stag == dtag && skey == dkey) {
348                                 rc = EEXIST;
349                                 goto fail4;
350                         }
351                 }
352         }
353
354 done:
355         return (0);
356
357 fail4:
358         EFSYS_PROBE(fail4);
359 fail3:
360         EFSYS_PROBE(fail3);
361 fail2:
362         EFSYS_PROBE(fail2);
363 fail1:
364         EFSYS_PROBE1(fail1, efx_rc_t, rc);
365
366         return (rc);
367 }
368
369         __checkReturn           efx_rc_t
370 siena_vpd_reinit(
371         __in                    efx_nic_t *enp,
372         __in_bcount(size)       caddr_t data,
373         __in                    size_t size)
374 {
375         boolean_t wantpid;
376         efx_rc_t rc;
377
378         /*
379          * Only create a PID if the dynamic cfg doesn't have one
380          */
381         if (enp->en_u.siena.enu_svpd_length == 0)
382                 wantpid = B_TRUE;
383         else {
384                 unsigned int offset;
385                 uint8_t length;
386
387                 rc = efx_vpd_hunk_get(enp->en_u.siena.enu_svpd,
388                                     enp->en_u.siena.enu_svpd_length,
389                                     EFX_VPD_ID, 0, &offset, &length);
390                 if (rc == 0)
391                         wantpid = B_FALSE;
392                 else if (rc == ENOENT)
393                         wantpid = B_TRUE;
394                 else
395                         goto fail1;
396         }
397
398         if ((rc = efx_vpd_hunk_reinit(data, size, wantpid)) != 0)
399                 goto fail2;
400
401         return (0);
402
403 fail2:
404         EFSYS_PROBE(fail2);
405 fail1:
406         EFSYS_PROBE1(fail1, efx_rc_t, rc);
407
408         return (rc);
409 }
410
411         __checkReturn           efx_rc_t
412 siena_vpd_get(
413         __in                    efx_nic_t *enp,
414         __in_bcount(size)       caddr_t data,
415         __in                    size_t size,
416         __inout                 efx_vpd_value_t *evvp)
417 {
418         unsigned int offset;
419         uint8_t length;
420         efx_rc_t rc;
421
422         EFSYS_ASSERT(enp->en_family == EFX_FAMILY_SIENA);
423
424         /* Attempt to satisfy the request from svpd first */
425         if (enp->en_u.siena.enu_svpd_length > 0) {
426                 if ((rc = efx_vpd_hunk_get(enp->en_u.siena.enu_svpd,
427                     enp->en_u.siena.enu_svpd_length, evvp->evv_tag,
428                     evvp->evv_keyword, &offset, &length)) == 0) {
429                         evvp->evv_length = length;
430                         memcpy(evvp->evv_value,
431                             enp->en_u.siena.enu_svpd + offset, length);
432                         return (0);
433                 } else if (rc != ENOENT)
434                         goto fail1;
435         }
436
437         /* And then from the provided data buffer */
438         if ((rc = efx_vpd_hunk_get(data, size, evvp->evv_tag,
439             evvp->evv_keyword, &offset, &length)) != 0)
440                 goto fail2;
441
442         evvp->evv_length = length;
443         memcpy(evvp->evv_value, data + offset, length);
444
445         return (0);
446
447 fail2:
448         EFSYS_PROBE(fail2);
449 fail1:
450         EFSYS_PROBE1(fail1, efx_rc_t, rc);
451
452         return (rc);
453 }
454
455         __checkReturn           efx_rc_t
456 siena_vpd_set(
457         __in                    efx_nic_t *enp,
458         __in_bcount(size)       caddr_t data,
459         __in                    size_t size,
460         __in                    efx_vpd_value_t *evvp)
461 {
462         efx_rc_t rc;
463
464         EFSYS_ASSERT(enp->en_family == EFX_FAMILY_SIENA);
465
466         /* If the provided (tag,keyword) exists in svpd, then it is readonly */
467         if (enp->en_u.siena.enu_svpd_length > 0) {
468                 unsigned int offset;
469                 uint8_t length;
470
471                 if ((rc = efx_vpd_hunk_get(enp->en_u.siena.enu_svpd,
472                     enp->en_u.siena.enu_svpd_length, evvp->evv_tag,
473                     evvp->evv_keyword, &offset, &length)) == 0) {
474                         rc = EACCES;
475                         goto fail1;
476                 }
477         }
478
479         if ((rc = efx_vpd_hunk_set(data, size, evvp)) != 0)
480                 goto fail2;
481
482         return (0);
483
484 fail2:
485         EFSYS_PROBE(fail2);
486 fail1:
487         EFSYS_PROBE1(fail1, efx_rc_t, rc);
488
489         return (rc);
490 }
491
492         __checkReturn           efx_rc_t
493 siena_vpd_next(
494         __in                    efx_nic_t *enp,
495         __in_bcount(size)       caddr_t data,
496         __in                    size_t size,
497         __out                   efx_vpd_value_t *evvp,
498         __inout                 unsigned int *contp)
499 {
500         _NOTE(ARGUNUSED(enp, data, size, evvp, contp))
501
502         return (ENOTSUP);
503 }
504
505         __checkReturn           efx_rc_t
506 siena_vpd_write(
507         __in                    efx_nic_t *enp,
508         __in_bcount(size)       caddr_t data,
509         __in                    size_t size)
510 {
511         efx_mcdi_iface_t *emip = &(enp->en_mcdi.em_emip);
512         siena_mc_dynamic_config_hdr_t *dcfg = NULL;
513         unsigned int vpd_offset;
514         unsigned int dcfg_partn;
515         unsigned int hdr_length;
516         unsigned int pos;
517         uint8_t cksum;
518         size_t partn_size, dcfg_size;
519         size_t vpd_length;
520         efx_rc_t rc;
521
522         EFSYS_ASSERT(enp->en_family == EFX_FAMILY_SIENA);
523
524         /* Determine total length of all tags */
525         if ((rc = efx_vpd_hunk_length(data, size, &vpd_length)) != 0)
526                 goto fail1;
527
528         /* Lock dynamic config sector for write, and read structure only */
529         dcfg_partn = (emip->emi_port == 1)
530                 ? MC_CMD_NVRAM_TYPE_DYNAMIC_CFG_PORT0
531                 : MC_CMD_NVRAM_TYPE_DYNAMIC_CFG_PORT1;
532
533         if ((rc = siena_nvram_partn_size(enp, dcfg_partn, &partn_size)) != 0)
534                 goto fail2;
535
536         if ((rc = siena_nvram_partn_lock(enp, dcfg_partn)) != 0)
537                 goto fail3;
538
539         if ((rc = siena_nvram_get_dynamic_cfg(enp, dcfg_partn,
540             B_FALSE, &dcfg, &dcfg_size)) != 0)
541                 goto fail4;
542
543         hdr_length = EFX_WORD_FIELD(dcfg->length, EFX_WORD_0);
544
545         /* Allocated memory should have room for the new VPD */
546         if (hdr_length + vpd_length > dcfg_size) {
547                 rc = ENOSPC;
548                 goto fail5;
549         }
550
551         /* Copy in new vpd and update header */
552         vpd_offset = dcfg_size - vpd_length;
553         EFX_POPULATE_DWORD_1(dcfg->dynamic_vpd_offset, EFX_DWORD_0, vpd_offset);
554         memcpy((caddr_t)dcfg + vpd_offset, data, vpd_length);
555         EFX_POPULATE_DWORD_1(dcfg->dynamic_vpd_length, EFX_DWORD_0, vpd_length);
556
557         /* Update the checksum */
558         cksum = 0;
559         for (pos = 0; pos < hdr_length; pos++)
560                 cksum += ((uint8_t *)dcfg)[pos];
561         dcfg->csum.eb_u8[0] -= cksum;
562
563         /* Erase and write the new sector */
564         if ((rc = siena_nvram_partn_erase(enp, dcfg_partn, 0, partn_size)) != 0)
565                 goto fail6;
566
567         /* Write out the new structure to nvram */
568         if ((rc = siena_nvram_partn_write(enp, dcfg_partn, 0, (caddr_t)dcfg,
569             vpd_offset + vpd_length)) != 0)
570                 goto fail7;
571
572         EFSYS_KMEM_FREE(enp->en_esip, dcfg_size, dcfg);
573
574         siena_nvram_partn_unlock(enp, dcfg_partn);
575
576         return (0);
577
578 fail7:
579         EFSYS_PROBE(fail7);
580 fail6:
581         EFSYS_PROBE(fail6);
582 fail5:
583         EFSYS_PROBE(fail5);
584
585         EFSYS_KMEM_FREE(enp->en_esip, dcfg_size, dcfg);
586 fail4:
587         EFSYS_PROBE(fail4);
588
589         siena_nvram_partn_unlock(enp, dcfg_partn);
590 fail3:
591         EFSYS_PROBE(fail3);
592 fail2:
593         EFSYS_PROBE(fail2);
594 fail1:
595         EFSYS_PROBE1(fail1, efx_rc_t, rc);
596
597         return (rc);
598 }
599
600                                 void
601 siena_vpd_fini(
602         __in                    efx_nic_t *enp)
603 {
604         EFSYS_ASSERT(enp->en_family == EFX_FAMILY_SIENA);
605
606         if (enp->en_u.siena.enu_svpd_length > 0) {
607                 EFSYS_KMEM_FREE(enp->en_esip, enp->en_u.siena.enu_svpd_length,
608                                 enp->en_u.siena.enu_svpd);
609
610                 enp->en_u.siena.enu_svpd = NULL;
611                 enp->en_u.siena.enu_svpd_length = 0;
612         }
613 }
614
615 #endif  /* EFSYS_OPT_SIENA */
616
617 #endif  /* EFSYS_OPT_VPD */