target/linux/mvebu/patches-4.9/418-sfp-display-SFP-module-information.patch

   1 From: Russell King <rmk+kernel@arm.linux.org.uk>
   2 Date: Sun, 13 Sep 2015 01:06:31 +0100
   3 Subject: [PATCH] sfp: display SFP module information
   4
   5 Signed-off-by: Russell King <rmk+kernel@arm.linux.org.uk>
   6 ---
   7
   8 --- a/drivers/net/phy/sfp.c
   9 +++ b/drivers/net/phy/sfp.c
  10 @@ -251,6 +251,182 @@ static unsigned int sfp_check(void *buf,
  11         return check;
  12  }
  13
  14 +static const char *sfp_link_len(char *buf, size_t size, unsigned int length,
  15 +       unsigned int multiplier)
  16 +{
  17 +       if (length == 0)
  18 +               return "unsupported/unspecified";
  19 +
  20 +       if (length == 255) {
  21 +               *buf++ = '>';
  22 +               size -= 1;
  23 +               length -= 1;
  24 +       }
  25 +
  26 +       length *= multiplier;
  27 +
  28 +       if (length >= 1000)
  29 +               snprintf(buf, size, "%u.%0*ukm",
  30 +                       length / 1000,
  31 +                       multiplier > 100 ? 1 :
  32 +                       multiplier > 10 ? 2 : 3,
  33 +                       length % 1000);
  34 +       else
  35 +               snprintf(buf, size, "%um", length);
  36 +
  37 +       return buf;
  38 +}
  39 +
  40 +struct bitfield {
  41 +       unsigned int mask;
  42 +       unsigned int val;
  43 +       const char *str;
  44 +};
  45 +
  46 +static const struct bitfield sfp_options[] = {
  47 +       {
  48 +               .mask = SFP_OPTIONS_HIGH_POWER_LEVEL,
  49 +               .val = SFP_OPTIONS_HIGH_POWER_LEVEL,
  50 +               .str = "hpl",
  51 +       }, {
  52 +               .mask = SFP_OPTIONS_PAGING_A2,
  53 +               .val = SFP_OPTIONS_PAGING_A2,
  54 +               .str = "paginga2",
  55 +       }, {
  56 +               .mask = SFP_OPTIONS_RETIMER,
  57 +               .val = SFP_OPTIONS_RETIMER,
  58 +               .str = "retimer",
  59 +       }, {
  60 +               .mask = SFP_OPTIONS_COOLED_XCVR,
  61 +               .val = SFP_OPTIONS_COOLED_XCVR,
  62 +               .str = "cooled",
  63 +       }, {
  64 +               .mask = SFP_OPTIONS_POWER_DECL,
  65 +               .val = SFP_OPTIONS_POWER_DECL,
  66 +               .str = "powerdecl",
  67 +       }, {
  68 +               .mask = SFP_OPTIONS_RX_LINEAR_OUT,
  69 +               .val = SFP_OPTIONS_RX_LINEAR_OUT,
  70 +               .str = "rxlinear",
  71 +       }, {
  72 +               .mask = SFP_OPTIONS_RX_DECISION_THRESH,
  73 +               .val = SFP_OPTIONS_RX_DECISION_THRESH,
  74 +               .str = "rxthresh",
  75 +       }, {
  76 +               .mask = SFP_OPTIONS_TUNABLE_TX,
  77 +               .val = SFP_OPTIONS_TUNABLE_TX,
  78 +               .str = "tunabletx",
  79 +       }, {
  80 +               .mask = SFP_OPTIONS_RATE_SELECT,
  81 +               .val = SFP_OPTIONS_RATE_SELECT,
  82 +               .str = "ratesel",
  83 +       }, {
  84 +               .mask = SFP_OPTIONS_TX_DISABLE,
  85 +               .val = SFP_OPTIONS_TX_DISABLE,
  86 +               .str = "txdisable",
  87 +       }, {
  88 +               .mask = SFP_OPTIONS_TX_FAULT,
  89 +               .val = SFP_OPTIONS_TX_FAULT,
  90 +               .str = "txfault",
  91 +       }, {
  92 +               .mask = SFP_OPTIONS_LOS_INVERTED,
  93 +               .val = SFP_OPTIONS_LOS_INVERTED,
  94 +               .str = "los-",
  95 +       }, {
  96 +               .mask = SFP_OPTIONS_LOS_NORMAL,
  97 +               .val = SFP_OPTIONS_LOS_NORMAL,
  98 +               .str = "los+",
  99 +       }, { }
 100 +};
 101 +
 102 +static const struct bitfield diagmon[] = {
 103 +       {
 104 +               .mask = SFP_DIAGMON_DDM,
 105 +               .val = SFP_DIAGMON_DDM,
 106 +               .str = "ddm",
 107 +       }, {
 108 +               .mask = SFP_DIAGMON_INT_CAL,
 109 +               .val = SFP_DIAGMON_INT_CAL,
 110 +               .str = "intcal",
 111 +       }, {
 112 +               .mask = SFP_DIAGMON_EXT_CAL,
 113 +               .val = SFP_DIAGMON_EXT_CAL,
 114 +               .str = "extcal",
 115 +       }, {
 116 +               .mask = SFP_DIAGMON_RXPWR_AVG,
 117 +               .val = SFP_DIAGMON_RXPWR_AVG,
 118 +               .str = "rxpwravg",
 119 +       }, { }
 120 +};
 121 +
 122 +static const char *sfp_bitfield(char *out, size_t outsz, const struct bitfield *bits, unsigned int val)
 123 +{
 124 +       char *p = out;
 125 +       int n;
 126 +
 127 +       *p = '\0';
 128 +       while (bits->mask) {
 129 +               if ((val & bits->mask) == bits->val) {
 130 +                       n = snprintf(p, outsz, "%s%s",
 131 +                                    out != p ? ", " : "",
 132 +                                    bits->str);
 133 +                       if (n == outsz)
 134 +                               break;
 135 +                       p += n;
 136 +                       outsz -= n;
 137 +               }
 138 +               bits++;
 139 +       }
 140 +
 141 +       return out;
 142 +}
 143 +
 144 +static const char *sfp_connector(unsigned int connector)
 145 +{
 146 +       switch (connector) {
 147 +       case SFP_CONNECTOR_UNSPEC:
 148 +               return "unknown/unspecified";
 149 +       case SFP_CONNECTOR_SC:
 150 +               return "SC";
 151 +       case SFP_CONNECTOR_FIBERJACK:
 152 +               return "Fiberjack";
 153 +       case SFP_CONNECTOR_LC:
 154 +               return "LC";
 155 +       case SFP_CONNECTOR_MT_RJ:
 156 +               return "MT-RJ";
 157 +       case SFP_CONNECTOR_MU:
 158 +               return "MU";
 159 +       case SFP_CONNECTOR_SG:
 160 +               return "SG";
 161 +       case SFP_CONNECTOR_OPTICAL_PIGTAIL:
 162 +               return "Optical pigtail";
 163 +       case SFP_CONNECTOR_HSSDC_II:
 164 +               return "HSSDC II";
 165 +       case SFP_CONNECTOR_COPPER_PIGTAIL:
 166 +               return "Copper pigtail";
 167 +       default:
 168 +               return "unknown";
 169 +       }
 170 +}
 171 +
 172 +static const char *sfp_encoding(unsigned int encoding)
 173 +{
 174 +       switch (encoding) {
 175 +       case SFP_ENCODING_UNSPEC:
 176 +               return "unspecified";
 177 +       case SFP_ENCODING_8B10B:
 178 +               return "8b10b";
 179 +       case SFP_ENCODING_4B5B:
 180 +               return "4b5b";
 181 +       case SFP_ENCODING_NRZ:
 182 +               return "NRZ";
 183 +       case SFP_ENCODING_MANCHESTER:
 184 +               return "MANCHESTER";
 185 +       default:
 186 +               return "unknown";
 187 +       }
 188 +}
 189 +
 190  /* Helpers */
 191  static void sfp_module_tx_disable(struct sfp *sfp)
 192  {
 193 @@ -428,6 +604,7 @@ static int sfp_sm_mod_probe(struct sfp *
 194         char sn[17];
 195         char date[9];
 196         char rev[5];
 197 +       char options[80];
 198         u8 check;
 199         int err;
 200
 201 @@ -471,10 +648,78 @@ static int sfp_sm_mod_probe(struct sfp *
 202         rev[4] = '\0';
 203         memcpy(sn, sfp->id.ext.vendor_sn, 16);
 204         sn[16] = '\0';
 205 -       memcpy(date, sfp->id.ext.datecode, 8);
 206 +       date[0] = sfp->id.ext.datecode[4];
 207 +       date[1] = sfp->id.ext.datecode[5];
 208 +       date[2] = '-';
 209 +       date[3] = sfp->id.ext.datecode[2];
 210 +       date[4] = sfp->id.ext.datecode[3];
 211 +       date[5] = '-';
 212 +       date[6] = sfp->id.ext.datecode[0];
 213 +       date[7] = sfp->id.ext.datecode[1];
 214         date[8] = '\0';
 215
 216         dev_info(sfp->dev, "module %s %s rev %s sn %s dc %s\n", vendor, part, rev, sn, date);
 217 +       dev_info(sfp->dev, "  %s connector, encoding %s, nominal bitrate %u.%uGbps +%u%% -%u%%\n",
 218 +                sfp_connector(sfp->id.base.connector),
 219 +                sfp_encoding(sfp->id.base.encoding),
 220 +                sfp->id.base.br_nominal / 10,
 221 +                sfp->id.base.br_nominal % 10,
 222 +                sfp->id.ext.br_max, sfp->id.ext.br_min);
 223 +       dev_info(sfp->dev, "  1000BaseSX%c 1000BaseLX%c 1000BaseCX%c 1000BaseT%c 100BaseTLX%c 1000BaseFX%c BaseBX10%c BasePX%c\n",
 224 +                sfp->id.base.e1000_base_sx ? '+' : '-',
 225 +                sfp->id.base.e1000_base_lx ? '+' : '-',
 226 +                sfp->id.base.e1000_base_cx ? '+' : '-',
 227 +                sfp->id.base.e1000_base_t ? '+' : '-',
 228 +                sfp->id.base.e100_base_lx ? '+' : '-',
 229 +                sfp->id.base.e100_base_fx ? '+' : '-',
 230 +                sfp->id.base.e_base_bx10 ? '+' : '-',
 231 +                sfp->id.base.e_base_px ? '+' : '-');
 232 +
 233 +       if (!sfp->id.base.sfp_ct_passive && !sfp->id.base.sfp_ct_active &&
 234 +           !sfp->id.base.e1000_base_t) {
 235 +               char len_9um[16], len_om[16];
 236 +
 237 +               dev_info(sfp->dev, "  Wavelength %unm, fiber lengths:\n",
 238 +                        be16_to_cpup(&sfp->id.base.optical_wavelength));
 239 +
 240 +               if (sfp->id.base.link_len[0] == 255)
 241 +                       strcpy(len_9um, ">254km");
 242 +               else if (sfp->id.base.link_len[1] && sfp->id.base.link_len[1] != 255)
 243 +                       sprintf(len_9um, "%um",
 244 +                               sfp->id.base.link_len[1] * 100);
 245 +               else if (sfp->id.base.link_len[0])
 246 +                       sprintf(len_9um, "%ukm", sfp->id.base.link_len[0]);
 247 +               else if (sfp->id.base.link_len[1] == 255)
 248 +                       strcpy(len_9um, ">25.4km");
 249 +               else
 250 +                       strcpy(len_9um, "unsupported");
 251 +
 252 +               dev_info(sfp->dev, "    9µm SM    : %s\n", len_9um);
 253 +               dev_info(sfp->dev, " 62.5µm MM OM1: %s\n",
 254 +                        sfp_link_len(len_om, sizeof(len_om),
 255 +                                     sfp->id.base.link_len[3], 10));
 256 +               dev_info(sfp->dev, "   50µm MM OM2: %s\n",
 257 +                        sfp_link_len(len_om, sizeof(len_om),
 258 +                                     sfp->id.base.link_len[2], 10));
 259 +               dev_info(sfp->dev, "   50µm MM OM3: %s\n",
 260 +                        sfp_link_len(len_om, sizeof(len_om),
 261 +                                     sfp->id.base.link_len[5], 10));
 262 +               dev_info(sfp->dev, "   50µm MM OM4: %s\n",
 263 +                        sfp_link_len(len_om, sizeof(len_om),
 264 +                                     sfp->id.base.link_len[4], 10));
 265 +       } else {
 266 +               char len[16];
 267 +               dev_info(sfp->dev, "  Copper length: %s\n",
 268 +                        sfp_link_len(len, sizeof(len),
 269 +                                     sfp->id.base.link_len[4], 1));
 270 +       }
 271 +
 272 +       dev_info(sfp->dev, "  Options: %s\n",
 273 +                sfp_bitfield(options, sizeof(options), sfp_options,
 274 +                             be16_to_cpu(sfp->id.ext.options)));
 275 +       dev_info(sfp->dev, "  Diagnostics: %s\n",
 276 +                sfp_bitfield(options, sizeof(options), diagmon,
 277 +                             sfp->id.ext.diagmon));
 278
 279         /* We only support SFP modules, not the legacy GBIC modules. */
 280         if (sfp->id.base.phys_id != SFP_PHYS_ID_SFP ||