drivers/net/ethernet/netronome/nfp/nfp_net_ctrl.c

   1 // SPDX-License-Identifier: (GPL-2.0-only OR BSD-2-Clause)
   2 /* Copyright (C) 2018 Netronome Systems, Inc. */
   3
   4 #include <linux/bitfield.h>
   5 #include <linux/device.h>
   6 #include <linux/kernel.h>
   7 #include <linux/types.h>
   8
   9 #include "nfp_net_ctrl.h"
  10 #include "nfp_net.h"
  11
  12 static void nfp_net_tlv_caps_reset(struct nfp_net_tlv_caps *caps)
  13 {
  14         memset(caps, 0, sizeof(*caps));
  15         caps->me_freq_mhz = 1200;
  16         caps->mbox_off = NFP_NET_CFG_MBOX_BASE;
  17         caps->mbox_len = NFP_NET_CFG_MBOX_VAL_MAX_SZ;
  18 }
  19
  20 static bool
  21 nfp_net_tls_parse_crypto_ops(struct device *dev, struct nfp_net_tlv_caps *caps,
  22                              u8 __iomem *ctrl_mem, u8 __iomem *data,
  23                              unsigned int length, unsigned int offset,
  24                              bool rx_stream_scan)
  25 {
  26         /* Ignore the legacy TLV if new one was already parsed */
  27         if (caps->tls_resync_ss && !rx_stream_scan)
  28                 return true;
  29
  30         if (length < 32) {
  31                 dev_err(dev,
  32                         "CRYPTO OPS TLV should be at least 32B, is %dB offset:%u\n",
  33                         length, offset);
  34                 return false;
  35         }
  36
  37         caps->crypto_ops = readl(data);
  38         caps->crypto_enable_off = data - ctrl_mem + 16;
  39         caps->tls_resync_ss = rx_stream_scan;
  40
  41         return true;
  42 }
  43
  44 int nfp_net_tlv_caps_parse(struct device *dev, u8 __iomem *ctrl_mem,
  45                            struct nfp_net_tlv_caps *caps)
  46 {
  47         u8 __iomem *data = ctrl_mem + NFP_NET_CFG_TLV_BASE;
  48         u8 __iomem *end = ctrl_mem + NFP_NET_CFG_BAR_SZ;
  49         u32 hdr;
  50
  51         nfp_net_tlv_caps_reset(caps);
  52
  53         hdr = readl(data);
  54         if (!hdr)
  55                 return 0;
  56
  57         while (true) {
  58                 unsigned int length, offset;
  59                 u32 hdr = readl(data);
  60
  61                 length = FIELD_GET(NFP_NET_CFG_TLV_HEADER_LENGTH, hdr);
  62                 offset = data - ctrl_mem;
  63
  64                 /* Advance past the header */
  65                 data += 4;
  66
  67                 if (length % NFP_NET_CFG_TLV_LENGTH_INC) {
  68                         dev_err(dev, "TLV size not multiple of %u offset:%u len:%u\n",
  69                                 NFP_NET_CFG_TLV_LENGTH_INC, offset, length);
  70                         return -EINVAL;
  71                 }
  72                 if (data + length > end) {
  73                         dev_err(dev, "oversized TLV offset:%u len:%u\n",
  74                                 offset, length);
  75                         return -EINVAL;
  76                 }
  77
  78                 switch (FIELD_GET(NFP_NET_CFG_TLV_HEADER_TYPE, hdr)) {
  79                 case NFP_NET_CFG_TLV_TYPE_UNKNOWN:
  80                         dev_err(dev, "NULL TLV at offset:%u\n", offset);
  81                         return -EINVAL;
  82                 case NFP_NET_CFG_TLV_TYPE_RESERVED:
  83                         break;
  84                 case NFP_NET_CFG_TLV_TYPE_END:
  85                         if (!length)
  86                                 return 0;
  87
  88                         dev_err(dev, "END TLV should be empty, has offset:%u len:%d\n",
  89                                 offset, length);
  90                         return -EINVAL;
  91                 case NFP_NET_CFG_TLV_TYPE_ME_FREQ:
  92                         if (length != 4) {
  93                                 dev_err(dev,
  94                                         "ME FREQ TLV should be 4B, is %dB offset:%u\n",
  95                                         length, offset);
  96                                 return -EINVAL;
  97                         }
  98
  99                         caps->me_freq_mhz = readl(data);
 100                         break;
 101                 case NFP_NET_CFG_TLV_TYPE_MBOX:
 102                         if (!length) {
 103                                 caps->mbox_off = 0;
 104                                 caps->mbox_len = 0;
 105                         } else {
 106                                 caps->mbox_off = data - ctrl_mem;
 107                                 caps->mbox_len = length;
 108                         }
 109                         break;
 110                 case NFP_NET_CFG_TLV_TYPE_EXPERIMENTAL0:
 111                 case NFP_NET_CFG_TLV_TYPE_EXPERIMENTAL1:
 112                         dev_warn(dev,
 113                                  "experimental TLV type:%u offset:%u len:%u\n",
 114                                  FIELD_GET(NFP_NET_CFG_TLV_HEADER_TYPE, hdr),
 115                                  offset, length);
 116                         break;
 117                 case NFP_NET_CFG_TLV_TYPE_REPR_CAP:
 118                         if (length < 4) {
 119                                 dev_err(dev, "REPR CAP TLV short %dB < 4B offset:%u\n",
 120                                         length, offset);
 121                                 return -EINVAL;
 122                         }
 123
 124                         caps->repr_cap = readl(data);
 125                         break;
 126                 case NFP_NET_CFG_TLV_TYPE_MBOX_CMSG_TYPES:
 127                         if (length >= 4)
 128                                 caps->mbox_cmsg_types = readl(data);
 129                         break;
 130                 case NFP_NET_CFG_TLV_TYPE_CRYPTO_OPS:
 131                         if (!nfp_net_tls_parse_crypto_ops(dev, caps, ctrl_mem,
 132                                                           data, length, offset,
 133                                                           false))
 134                                 return -EINVAL;
 135                         break;
 136                 case NFP_NET_CFG_TLV_TYPE_VNIC_STATS:
 137                         if ((data - ctrl_mem) % 8) {
 138                                 dev_warn(dev, "VNIC STATS TLV misaligned, ignoring offset:%u len:%u\n",
 139                                          offset, length);
 140                                 break;
 141                         }
 142                         caps->vnic_stats_off = data - ctrl_mem;
 143                         caps->vnic_stats_cnt = length / 10;
 144                         break;
 145                 case NFP_NET_CFG_TLV_TYPE_CRYPTO_OPS_RX_SCAN:
 146                         if (!nfp_net_tls_parse_crypto_ops(dev, caps, ctrl_mem,
 147                                                           data, length, offset,
 148                                                           true))
 149                                 return -EINVAL;
 150                         break;
 151                 default:
 152                         if (!FIELD_GET(NFP_NET_CFG_TLV_HEADER_REQUIRED, hdr))
 153                                 break;
 154
 155                         dev_err(dev, "unknown TLV type:%u offset:%u len:%u\n",
 156                                 FIELD_GET(NFP_NET_CFG_TLV_HEADER_TYPE, hdr),
 157                                 offset, length);
 158                         return -EINVAL;
 159                 }
 160
 161                 data += length;
 162                 if (data + 4 > end) {
 163                         dev_err(dev, "reached end of BAR without END TLV\n");
 164                         return -EINVAL;
 165                 }
 166         }
 167
 168         /* Not reached */
 169         return -EINVAL;
 170 }