drivers/net/sfc/falcon_boards.c

   1 /****************************************************************************
   2  * Driver for Solarflare Solarstorm network controllers and boards
   3  * Copyright 2007-2008 Solarflare Communications Inc.
   4  *
   5  * This program is free software; you can redistribute it and/or modify it
   6  * under the terms of the GNU General Public License version 2 as published
   7  * by the Free Software Foundation, incorporated herein by reference.
   8  */
   9
  10 #include <linux/rtnetlink.h>
  11
  12 #include "net_driver.h"
  13 #include "phy.h"
  14 #include "efx.h"
  15 #include "falcon.h"
  16 #include "regs.h"
  17 #include "io.h"
  18 #include "workarounds.h"
  19
  20 /* Macros for unpacking the board revision */
  21 /* The revision info is in host byte order. */
  22 #define FALCON_BOARD_TYPE(_rev) (_rev >> 8)
  23 #define FALCON_BOARD_MAJOR(_rev) ((_rev >> 4) & 0xf)
  24 #define FALCON_BOARD_MINOR(_rev) (_rev & 0xf)
  25
  26 /* Board types */
  27 #define FALCON_BOARD_SFE4001 0x01
  28 #define FALCON_BOARD_SFE4002 0x02
  29 #define FALCON_BOARD_SFN4111T 0x51
  30 #define FALCON_BOARD_SFN4112F 0x52
  31
  32 /*****************************************************************************
  33  * Support for LM87 sensor chip used on several boards
  34  */
  35 #define LM87_REG_ALARMS1                0x41
  36 #define LM87_REG_ALARMS2                0x42
  37 #define LM87_IN_LIMITS(nr, _min, _max)                  \
  38         0x2B + (nr) * 2, _max, 0x2C + (nr) * 2, _min
  39 #define LM87_AIN_LIMITS(nr, _min, _max)                 \
  40         0x3B + (nr), _max, 0x1A + (nr), _min
  41 #define LM87_TEMP_INT_LIMITS(_min, _max)                \
  42         0x39, _max, 0x3A, _min
  43 #define LM87_TEMP_EXT1_LIMITS(_min, _max)               \
  44         0x37, _max, 0x38, _min
  45
  46 #define LM87_ALARM_TEMP_INT             0x10
  47 #define LM87_ALARM_TEMP_EXT1            0x20
  48
  49 #if defined(CONFIG_SENSORS_LM87) || defined(CONFIG_SENSORS_LM87_MODULE)
  50
  51 static int efx_init_lm87(struct efx_nic *efx, struct i2c_board_info *info,
  52                          const u8 *reg_values)
  53 {
  54         struct falcon_board *board = falcon_board(efx);
  55         struct i2c_client *client = i2c_new_device(&board->i2c_adap, info);
  56         int rc;
  57
  58         if (!client)
  59                 return -EIO;
  60
  61         while (*reg_values) {
  62                 u8 reg = *reg_values++;
  63                 u8 value = *reg_values++;
  64                 rc = i2c_smbus_write_byte_data(client, reg, value);
  65                 if (rc)
  66                         goto err;
  67         }
  68
  69         board->hwmon_client = client;
  70         return 0;
  71
  72 err:
  73         i2c_unregister_device(client);
  74         return rc;
  75 }
  76
  77 static void efx_fini_lm87(struct efx_nic *efx)
  78 {
  79         i2c_unregister_device(falcon_board(efx)->hwmon_client);
  80 }
  81
  82 static int efx_check_lm87(struct efx_nic *efx, unsigned mask)
  83 {
  84         struct i2c_client *client = falcon_board(efx)->hwmon_client;
  85         s32 alarms1, alarms2;
  86
  87         /* If link is up then do not monitor temperature */
  88         if (EFX_WORKAROUND_7884(efx) && efx->link_state.up)
  89                 return 0;
  90
  91         alarms1 = i2c_smbus_read_byte_data(client, LM87_REG_ALARMS1);
  92         alarms2 = i2c_smbus_read_byte_data(client, LM87_REG_ALARMS2);
  93         if (alarms1 < 0)
  94                 return alarms1;
  95         if (alarms2 < 0)
  96                 return alarms2;
  97         alarms1 &= mask;
  98         alarms2 &= mask >> 8;
  99         if (alarms1 || alarms2) {
 100                 EFX_ERR(efx,
 101                         "LM87 detected a hardware failure (status %02x:%02x)"
 102                         "%s%s\n",
 103                         alarms1, alarms2,
 104                         (alarms1 & LM87_ALARM_TEMP_INT) ? " INTERNAL" : "",
 105                         (alarms1 & LM87_ALARM_TEMP_EXT1) ? " EXTERNAL" : "");
 106                 return -ERANGE;
 107         }
 108
 109         return 0;
 110 }
 111
 112 #else /* !CONFIG_SENSORS_LM87 */
 113
 114 static inline int
 115 efx_init_lm87(struct efx_nic *efx, struct i2c_board_info *info,
 116               const u8 *reg_values)
 117 {
 118         return 0;
 119 }
 120 static inline void efx_fini_lm87(struct efx_nic *efx)
 121 {
 122 }
 123 static inline int efx_check_lm87(struct efx_nic *efx, unsigned mask)
 124 {
 125         return 0;
 126 }
 127
 128 #endif /* CONFIG_SENSORS_LM87 */
 129
 130 /*****************************************************************************
 131  * Support for the SFE4001 and SFN4111T NICs.
 132  *
 133  * The SFE4001 does not power-up fully at reset due to its high power
 134  * consumption.  We control its power via a PCA9539 I/O expander.
 135  * Both boards have a MAX6647 temperature monitor which we expose to
 136  * the lm90 driver.
 137  *
 138  * This also provides minimal support for reflashing the PHY, which is
 139  * initiated by resetting it with the FLASH_CFG_1 pin pulled down.
 140  * On SFE4001 rev A2 and later this is connected to the 3V3X output of
 141  * the IO-expander; on the SFN4111T it is connected to Falcon's GPIO3.
 142  * We represent reflash mode as PHY_MODE_SPECIAL and make it mutually
 143  * exclusive with the network device being open.
 144  */
 145
 146 /**************************************************************************
 147  * Support for I2C IO Expander device on SFE4001
 148  */
 149 #define PCA9539 0x74
 150
 151 #define P0_IN 0x00
 152 #define P0_OUT 0x02
 153 #define P0_INVERT 0x04
 154 #define P0_CONFIG 0x06
 155
 156 #define P0_EN_1V0X_LBN 0
 157 #define P0_EN_1V0X_WIDTH 1
 158 #define P0_EN_1V2_LBN 1
 159 #define P0_EN_1V2_WIDTH 1
 160 #define P0_EN_2V5_LBN 2
 161 #define P0_EN_2V5_WIDTH 1
 162 #define P0_EN_3V3X_LBN 3
 163 #define P0_EN_3V3X_WIDTH 1
 164 #define P0_EN_5V_LBN 4
 165 #define P0_EN_5V_WIDTH 1
 166 #define P0_SHORTEN_JTAG_LBN 5
 167 #define P0_SHORTEN_JTAG_WIDTH 1
 168 #define P0_X_TRST_LBN 6
 169 #define P0_X_TRST_WIDTH 1
 170 #define P0_DSP_RESET_LBN 7
 171 #define P0_DSP_RESET_WIDTH 1
 172
 173 #define P1_IN 0x01
 174 #define P1_OUT 0x03
 175 #define P1_INVERT 0x05
 176 #define P1_CONFIG 0x07
 177
 178 #define P1_AFE_PWD_LBN 0
 179 #define P1_AFE_PWD_WIDTH 1
 180 #define P1_DSP_PWD25_LBN 1
 181 #define P1_DSP_PWD25_WIDTH 1
 182 #define P1_RESERVED_LBN 2
 183 #define P1_RESERVED_WIDTH 2
 184 #define P1_SPARE_LBN 4
 185 #define P1_SPARE_WIDTH 4
 186
 187 /* Temperature Sensor */
 188 #define MAX664X_REG_RSL         0x02
 189 #define MAX664X_REG_WLHO        0x0B
 190
 191 static void sfe4001_poweroff(struct efx_nic *efx)
 192 {
 193         struct i2c_client *ioexp_client = falcon_board(efx)->ioexp_client;
 194         struct i2c_client *hwmon_client = falcon_board(efx)->hwmon_client;
 195
 196         /* Turn off all power rails and disable outputs */
 197         i2c_smbus_write_byte_data(ioexp_client, P0_OUT, 0xff);
 198         i2c_smbus_write_byte_data(ioexp_client, P1_CONFIG, 0xff);
 199         i2c_smbus_write_byte_data(ioexp_client, P0_CONFIG, 0xff);
 200
 201         /* Clear any over-temperature alert */
 202         i2c_smbus_read_byte_data(hwmon_client, MAX664X_REG_RSL);
 203 }
 204
 205 static int sfe4001_poweron(struct efx_nic *efx)
 206 {
 207         struct i2c_client *ioexp_client = falcon_board(efx)->ioexp_client;
 208         struct i2c_client *hwmon_client = falcon_board(efx)->hwmon_client;
 209         unsigned int i, j;
 210         int rc;
 211         u8 out;
 212
 213         /* Clear any previous over-temperature alert */
 214         rc = i2c_smbus_read_byte_data(hwmon_client, MAX664X_REG_RSL);
 215         if (rc < 0)
 216                 return rc;
 217
 218         /* Enable port 0 and port 1 outputs on IO expander */
 219         rc = i2c_smbus_write_byte_data(ioexp_client, P0_CONFIG, 0x00);
 220         if (rc)
 221                 return rc;
 222         rc = i2c_smbus_write_byte_data(ioexp_client, P1_CONFIG,
 223                                        0xff & ~(1 << P1_SPARE_LBN));
 224         if (rc)
 225                 goto fail_on;
 226
 227         /* If PHY power is on, turn it all off and wait 1 second to
 228          * ensure a full reset.
 229          */
 230         rc = i2c_smbus_read_byte_data(ioexp_client, P0_OUT);
 231         if (rc < 0)
 232                 goto fail_on;
 233         out = 0xff & ~((0 << P0_EN_1V2_LBN) | (0 << P0_EN_2V5_LBN) |
 234                        (0 << P0_EN_3V3X_LBN) | (0 << P0_EN_5V_LBN) |
 235                        (0 << P0_EN_1V0X_LBN));
 236         if (rc != out) {
 237                 EFX_INFO(efx, "power-cycling PHY\n");
 238                 rc = i2c_smbus_write_byte_data(ioexp_client, P0_OUT, out);
 239                 if (rc)
 240                         goto fail_on;
 241                 schedule_timeout_uninterruptible(HZ);
 242         }
 243
 244         for (i = 0; i < 20; ++i) {
 245                 /* Turn on 1.2V, 2.5V, 3.3V and 5V power rails */
 246                 out = 0xff & ~((1 << P0_EN_1V2_LBN) | (1 << P0_EN_2V5_LBN) |
 247                                (1 << P0_EN_3V3X_LBN) | (1 << P0_EN_5V_LBN) |
 248                                (1 << P0_X_TRST_LBN));
 249                 if (efx->phy_mode & PHY_MODE_SPECIAL)
 250                         out |= 1 << P0_EN_3V3X_LBN;
 251
 252                 rc = i2c_smbus_write_byte_data(ioexp_client, P0_OUT, out);
 253                 if (rc)
 254                         goto fail_on;
 255                 msleep(10);
 256
 257                 /* Turn on 1V power rail */
 258                 out &= ~(1 << P0_EN_1V0X_LBN);
 259                 rc = i2c_smbus_write_byte_data(ioexp_client, P0_OUT, out);
 260                 if (rc)
 261                         goto fail_on;
 262
 263                 EFX_INFO(efx, "waiting for DSP boot (attempt %d)...\n", i);
 264
 265                 /* In flash config mode, DSP does not turn on AFE, so
 266                  * just wait 1 second.
 267                  */
 268                 if (efx->phy_mode & PHY_MODE_SPECIAL) {
 269                         schedule_timeout_uninterruptible(HZ);
 270                         return 0;
 271                 }
 272
 273                 for (j = 0; j < 10; ++j) {
 274                         msleep(100);
 275
 276                         /* Check DSP has asserted AFE power line */
 277                         rc = i2c_smbus_read_byte_data(ioexp_client, P1_IN);
 278                         if (rc < 0)
 279                                 goto fail_on;
 280                         if (rc & (1 << P1_AFE_PWD_LBN))
 281                                 return 0;
 282                 }
 283         }
 284
 285         EFX_INFO(efx, "timed out waiting for DSP boot\n");
 286         rc = -ETIMEDOUT;
 287 fail_on:
 288         sfe4001_poweroff(efx);
 289         return rc;
 290 }
 291
 292 static int sfn4111t_reset(struct efx_nic *efx)
 293 {
 294         struct falcon_board *board = falcon_board(efx);
 295         efx_oword_t reg;
 296
 297         /* GPIO 3 and the GPIO register are shared with I2C, so block that */
 298         i2c_lock_adapter(&board->i2c_adap);
 299
 300         /* Pull RST_N (GPIO 2) low then let it up again, setting the
 301          * FLASH_CFG_1 strap (GPIO 3) appropriately.  Only change the
 302          * output enables; the output levels should always be 0 (low)
 303          * and we rely on external pull-ups. */
 304         efx_reado(efx, &reg, FR_AB_GPIO_CTL);
 305         EFX_SET_OWORD_FIELD(reg, FRF_AB_GPIO2_OEN, true);
 306         efx_writeo(efx, &reg, FR_AB_GPIO_CTL);
 307         msleep(1000);
 308         EFX_SET_OWORD_FIELD(reg, FRF_AB_GPIO2_OEN, false);
 309         EFX_SET_OWORD_FIELD(reg, FRF_AB_GPIO3_OEN,
 310                             !!(efx->phy_mode & PHY_MODE_SPECIAL));
 311         efx_writeo(efx, &reg, FR_AB_GPIO_CTL);
 312         msleep(1);
 313
 314         i2c_unlock_adapter(&board->i2c_adap);
 315
 316         ssleep(1);
 317         return 0;
 318 }
 319
 320 static ssize_t show_phy_flash_cfg(struct device *dev,
 321                                   struct device_attribute *attr, char *buf)
 322 {
 323         struct efx_nic *efx = pci_get_drvdata(to_pci_dev(dev));
 324         return sprintf(buf, "%d\n", !!(efx->phy_mode & PHY_MODE_SPECIAL));
 325 }
 326
 327 static ssize_t set_phy_flash_cfg(struct device *dev,
 328                                  struct device_attribute *attr,
 329                                  const char *buf, size_t count)
 330 {
 331         struct efx_nic *efx = pci_get_drvdata(to_pci_dev(dev));
 332         enum efx_phy_mode old_mode, new_mode;
 333         int err;
 334
 335         rtnl_lock();
 336         old_mode = efx->phy_mode;
 337         if (count == 0 || *buf == '0')
 338                 new_mode = old_mode & ~PHY_MODE_SPECIAL;
 339         else
 340                 new_mode = PHY_MODE_SPECIAL;
 341         if (old_mode == new_mode) {
 342                 err = 0;
 343         } else if (efx->state != STATE_RUNNING || netif_running(efx->net_dev)) {
 344                 err = -EBUSY;
 345         } else {
 346                 /* Reset the PHY, reconfigure the MAC and enable/disable
 347                  * MAC stats accordingly. */
 348                 efx->phy_mode = new_mode;
 349                 if (new_mode & PHY_MODE_SPECIAL)
 350                         falcon_stop_nic_stats(efx);
 351                 if (falcon_board(efx)->type->id == FALCON_BOARD_SFE4001)
 352                         err = sfe4001_poweron(efx);
 353                 else
 354                         err = sfn4111t_reset(efx);
 355                 efx_reconfigure_port(efx);
 356                 if (!(new_mode & PHY_MODE_SPECIAL))
 357                         falcon_start_nic_stats(efx);
 358         }
 359         rtnl_unlock();
 360
 361         return err ? err : count;
 362 }
 363
 364 static DEVICE_ATTR(phy_flash_cfg, 0644, show_phy_flash_cfg, set_phy_flash_cfg);
 365
 366 static void sfe4001_fini(struct efx_nic *efx)
 367 {
 368         struct falcon_board *board = falcon_board(efx);
 369
 370         EFX_INFO(efx, "%s\n", __func__);
 371
 372         device_remove_file(&efx->pci_dev->dev, &dev_attr_phy_flash_cfg);
 373         sfe4001_poweroff(efx);
 374         i2c_unregister_device(board->ioexp_client);
 375         i2c_unregister_device(board->hwmon_client);
 376 }
 377
 378 static int sfe4001_check_hw(struct efx_nic *efx)
 379 {
 380         s32 status;
 381
 382         /* If XAUI link is up then do not monitor */
 383         if (EFX_WORKAROUND_7884(efx) && efx->mac_up)
 384                 return 0;
 385
 386         /* Check the powered status of the PHY. Lack of power implies that
 387          * the MAX6647 has shut down power to it, probably due to a temp.
 388          * alarm. Reading the power status rather than the MAX6647 status
 389          * directly because the later is read-to-clear and would thus
 390          * start to power up the PHY again when polled, causing us to blip
 391          * the power undesirably.
 392          * We know we can read from the IO expander because we did
 393          * it during power-on. Assume failure now is bad news. */
 394         status = i2c_smbus_read_byte_data(falcon_board(efx)->ioexp_client, P1_IN);
 395         if (status >= 0 &&
 396             (status & ((1 << P1_AFE_PWD_LBN) | (1 << P1_DSP_PWD25_LBN))) != 0)
 397                 return 0;
 398
 399         /* Use board power control, not PHY power control */
 400         sfe4001_poweroff(efx);
 401         efx->phy_mode = PHY_MODE_OFF;
 402
 403         return (status < 0) ? -EIO : -ERANGE;
 404 }
 405
 406 static struct i2c_board_info sfe4001_hwmon_info = {
 407         I2C_BOARD_INFO("max6647", 0x4e),
 408 };
 409
 410 /* This board uses an I2C expander to provider power to the PHY, which needs to
 411  * be turned on before the PHY can be used.
 412  * Context: Process context, rtnl lock held
 413  */
 414 static int sfe4001_init(struct efx_nic *efx)
 415 {
 416         struct falcon_board *board = falcon_board(efx);
 417         int rc;
 418
 419 #if defined(CONFIG_SENSORS_LM90) || defined(CONFIG_SENSORS_LM90_MODULE)
 420         board->hwmon_client =
 421                 i2c_new_device(&board->i2c_adap, &sfe4001_hwmon_info);
 422 #else
 423         board->hwmon_client =
 424                 i2c_new_dummy(&board->i2c_adap, sfe4001_hwmon_info.addr);
 425 #endif
 426         if (!board->hwmon_client)
 427                 return -EIO;
 428
 429         /* Raise board/PHY high limit from 85 to 90 degrees Celsius */
 430         rc = i2c_smbus_write_byte_data(board->hwmon_client,
 431                                        MAX664X_REG_WLHO, 90);
 432         if (rc)
 433                 goto fail_hwmon;
 434
 435         board->ioexp_client = i2c_new_dummy(&board->i2c_adap, PCA9539);
 436         if (!board->ioexp_client) {
 437                 rc = -EIO;
 438                 goto fail_hwmon;
 439         }
 440
 441         if (efx->phy_mode & PHY_MODE_SPECIAL) {
 442                 /* PHY won't generate a 156.25 MHz clock and MAC stats fetch
 443                  * will fail. */
 444                 falcon_stop_nic_stats(efx);
 445         }
 446         rc = sfe4001_poweron(efx);
 447         if (rc)
 448                 goto fail_ioexp;
 449
 450         rc = device_create_file(&efx->pci_dev->dev, &dev_attr_phy_flash_cfg);
 451         if (rc)
 452                 goto fail_on;
 453
 454         EFX_INFO(efx, "PHY is powered on\n");
 455         return 0;
 456
 457 fail_on:
 458         sfe4001_poweroff(efx);
 459 fail_ioexp:
 460         i2c_unregister_device(board->ioexp_client);
 461 fail_hwmon:
 462         i2c_unregister_device(board->hwmon_client);
 463         return rc;
 464 }
 465
 466 static int sfn4111t_check_hw(struct efx_nic *efx)
 467 {
 468         s32 status;
 469
 470         /* If XAUI link is up then do not monitor */
 471         if (EFX_WORKAROUND_7884(efx) && efx->mac_up)
 472                 return 0;
 473
 474         /* Test LHIGH, RHIGH, FAULT, EOT and IOT alarms */
 475         status = i2c_smbus_read_byte_data(falcon_board(efx)->hwmon_client,
 476                                           MAX664X_REG_RSL);
 477         if (status < 0)
 478                 return -EIO;
 479         if (status & 0x57)
 480                 return -ERANGE;
 481         return 0;
 482 }
 483
 484 static void sfn4111t_fini(struct efx_nic *efx)
 485 {
 486         EFX_INFO(efx, "%s\n", __func__);
 487
 488         device_remove_file(&efx->pci_dev->dev, &dev_attr_phy_flash_cfg);
 489         i2c_unregister_device(falcon_board(efx)->hwmon_client);
 490 }
 491
 492 static struct i2c_board_info sfn4111t_a0_hwmon_info = {
 493         I2C_BOARD_INFO("max6647", 0x4e),
 494 };
 495
 496 static struct i2c_board_info sfn4111t_r5_hwmon_info = {
 497         I2C_BOARD_INFO("max6646", 0x4d),
 498 };
 499
 500 static void sfn4111t_init_phy(struct efx_nic *efx)
 501 {
 502         if (!(efx->phy_mode & PHY_MODE_SPECIAL)) {
 503                 if (sft9001_wait_boot(efx) != -EINVAL)
 504                         return;
 505
 506                 efx->phy_mode = PHY_MODE_SPECIAL;
 507                 falcon_stop_nic_stats(efx);
 508         }
 509
 510         sfn4111t_reset(efx);
 511         sft9001_wait_boot(efx);
 512 }
 513
 514 static int sfn4111t_init(struct efx_nic *efx)
 515 {
 516         struct falcon_board *board = falcon_board(efx);
 517         int rc;
 518
 519         board->hwmon_client =
 520                 i2c_new_device(&board->i2c_adap,
 521                                (board->minor < 5) ?
 522                                &sfn4111t_a0_hwmon_info :
 523                                &sfn4111t_r5_hwmon_info);
 524         if (!board->hwmon_client)
 525                 return -EIO;
 526
 527         rc = device_create_file(&efx->pci_dev->dev, &dev_attr_phy_flash_cfg);
 528         if (rc)
 529                 goto fail_hwmon;
 530
 531         if (efx->phy_mode & PHY_MODE_SPECIAL)
 532                 /* PHY may not generate a 156.25 MHz clock and MAC
 533                  * stats fetch will fail. */
 534                 falcon_stop_nic_stats(efx);
 535
 536         return 0;
 537
 538 fail_hwmon:
 539         i2c_unregister_device(board->hwmon_client);
 540         return rc;
 541 }
 542
 543 /*****************************************************************************
 544  * Support for the SFE4002
 545  *
 546  */
 547 static u8 sfe4002_lm87_channel = 0x03; /* use AIN not FAN inputs */
 548
 549 static const u8 sfe4002_lm87_regs[] = {
 550         LM87_IN_LIMITS(0, 0x83, 0x91),          /* 2.5V:  1.8V +/- 5% */
 551         LM87_IN_LIMITS(1, 0x51, 0x5a),          /* Vccp1: 1.2V +/- 5% */
 552         LM87_IN_LIMITS(2, 0xb6, 0xca),          /* 3.3V:  3.3V +/- 5% */
 553         LM87_IN_LIMITS(3, 0xb0, 0xc9),          /* 5V:    4.6-5.2V */
 554         LM87_IN_LIMITS(4, 0xb0, 0xe0),          /* 12V:   11-14V */
 555         LM87_IN_LIMITS(5, 0x44, 0x4b),          /* Vccp2: 1.0V +/- 5% */
 556         LM87_AIN_LIMITS(0, 0xa0, 0xb2),         /* AIN1:  1.66V +/- 5% */
 557         LM87_AIN_LIMITS(1, 0x91, 0xa1),         /* AIN2:  1.5V +/- 5% */
 558         LM87_TEMP_INT_LIMITS(10, 60),           /* board */
 559         LM87_TEMP_EXT1_LIMITS(10, 70),          /* Falcon */
 560         0
 561 };
 562
 563 static struct i2c_board_info sfe4002_hwmon_info = {
 564         I2C_BOARD_INFO("lm87", 0x2e),
 565         .platform_data  = &sfe4002_lm87_channel,
 566 };
 567
 568 /****************************************************************************/
 569 /* LED allocations. Note that on rev A0 boards the schematic and the reality
 570  * differ: red and green are swapped. Below is the fixed (A1) layout (there
 571  * are only 3 A0 boards in existence, so no real reason to make this
 572  * conditional).
 573  */
 574 #define SFE4002_FAULT_LED (2)   /* Red */
 575 #define SFE4002_RX_LED    (0)   /* Green */
 576 #define SFE4002_TX_LED    (1)   /* Amber */
 577
 578 static void sfe4002_init_phy(struct efx_nic *efx)
 579 {
 580         /* Set the TX and RX LEDs to reflect status and activity, and the
 581          * fault LED off */
 582         falcon_qt202x_set_led(efx, SFE4002_TX_LED,
 583                               QUAKE_LED_TXLINK | QUAKE_LED_LINK_ACTSTAT);
 584         falcon_qt202x_set_led(efx, SFE4002_RX_LED,
 585                               QUAKE_LED_RXLINK | QUAKE_LED_LINK_ACTSTAT);
 586         falcon_qt202x_set_led(efx, SFE4002_FAULT_LED, QUAKE_LED_OFF);
 587 }
 588
 589 static void sfe4002_set_id_led(struct efx_nic *efx, enum efx_led_mode mode)
 590 {
 591         falcon_qt202x_set_led(
 592                 efx, SFE4002_FAULT_LED,
 593                 (mode == EFX_LED_ON) ? QUAKE_LED_ON : QUAKE_LED_OFF);
 594 }
 595
 596 static int sfe4002_check_hw(struct efx_nic *efx)
 597 {
 598         struct falcon_board *board = falcon_board(efx);
 599
 600         /* A0 board rev. 4002s report a temperature fault the whole time
 601          * (bad sensor) so we mask it out. */
 602         unsigned alarm_mask =
 603                 (board->major == 0 && board->minor == 0) ?
 604                 ~LM87_ALARM_TEMP_EXT1 : ~0;
 605
 606         return efx_check_lm87(efx, alarm_mask);
 607 }
 608
 609 static int sfe4002_init(struct efx_nic *efx)
 610 {
 611         return efx_init_lm87(efx, &sfe4002_hwmon_info, sfe4002_lm87_regs);
 612 }
 613
 614 /*****************************************************************************
 615  * Support for the SFN4112F
 616  *
 617  */
 618 static u8 sfn4112f_lm87_channel = 0x03; /* use AIN not FAN inputs */
 619
 620 static const u8 sfn4112f_lm87_regs[] = {
 621         LM87_IN_LIMITS(0, 0x83, 0x91),          /* 2.5V:  1.8V +/- 5% */
 622         LM87_IN_LIMITS(1, 0x51, 0x5a),          /* Vccp1: 1.2V +/- 5% */
 623         LM87_IN_LIMITS(2, 0xb6, 0xca),          /* 3.3V:  3.3V +/- 5% */
 624         LM87_IN_LIMITS(4, 0xb0, 0xe0),          /* 12V:   11-14V */
 625         LM87_IN_LIMITS(5, 0x44, 0x4b),          /* Vccp2: 1.0V +/- 5% */
 626         LM87_AIN_LIMITS(1, 0x91, 0xa1),         /* AIN2:  1.5V +/- 5% */
 627         LM87_TEMP_INT_LIMITS(10, 60),           /* board */
 628         LM87_TEMP_EXT1_LIMITS(10, 70),          /* Falcon */
 629         0
 630 };
 631
 632 static struct i2c_board_info sfn4112f_hwmon_info = {
 633         I2C_BOARD_INFO("lm87", 0x2e),
 634         .platform_data  = &sfn4112f_lm87_channel,
 635 };
 636
 637 #define SFN4112F_ACT_LED        0
 638 #define SFN4112F_LINK_LED       1
 639
 640 static void sfn4112f_init_phy(struct efx_nic *efx)
 641 {
 642         falcon_qt202x_set_led(efx, SFN4112F_ACT_LED,
 643                               QUAKE_LED_RXLINK | QUAKE_LED_LINK_ACT);
 644         falcon_qt202x_set_led(efx, SFN4112F_LINK_LED,
 645                               QUAKE_LED_RXLINK | QUAKE_LED_LINK_STAT);
 646 }
 647
 648 static void sfn4112f_set_id_led(struct efx_nic *efx, enum efx_led_mode mode)
 649 {
 650         int reg;
 651
 652         switch (mode) {
 653         case EFX_LED_OFF:
 654                 reg = QUAKE_LED_OFF;
 655                 break;
 656         case EFX_LED_ON:
 657                 reg = QUAKE_LED_ON;
 658                 break;
 659         default:
 660                 reg = QUAKE_LED_RXLINK | QUAKE_LED_LINK_STAT;
 661                 break;
 662         }
 663
 664         falcon_qt202x_set_led(efx, SFN4112F_LINK_LED, reg);
 665 }
 666
 667 static int sfn4112f_check_hw(struct efx_nic *efx)
 668 {
 669         /* Mask out unused sensors */
 670         return efx_check_lm87(efx, ~0x48);
 671 }
 672
 673 static int sfn4112f_init(struct efx_nic *efx)
 674 {
 675         return efx_init_lm87(efx, &sfn4112f_hwmon_info, sfn4112f_lm87_regs);
 676 }
 677
 678 static const struct falcon_board_type board_types[] = {
 679         {
 680                 .id             = FALCON_BOARD_SFE4001,
 681                 .ref_model      = "SFE4001",
 682                 .gen_type       = "10GBASE-T adapter",
 683                 .init           = sfe4001_init,
 684                 .init_phy       = efx_port_dummy_op_void,
 685                 .fini           = sfe4001_fini,
 686                 .set_id_led     = tenxpress_set_id_led,
 687                 .monitor        = sfe4001_check_hw,
 688         },
 689         {
 690                 .id             = FALCON_BOARD_SFE4002,
 691                 .ref_model      = "SFE4002",
 692                 .gen_type       = "XFP adapter",
 693                 .init           = sfe4002_init,
 694                 .init_phy       = sfe4002_init_phy,
 695                 .fini           = efx_fini_lm87,
 696                 .set_id_led     = sfe4002_set_id_led,
 697                 .monitor        = sfe4002_check_hw,
 698         },
 699         {
 700                 .id             = FALCON_BOARD_SFN4111T,
 701                 .ref_model      = "SFN4111T",
 702                 .gen_type       = "100/1000/10GBASE-T adapter",
 703                 .init           = sfn4111t_init,
 704                 .init_phy       = sfn4111t_init_phy,
 705                 .fini           = sfn4111t_fini,
 706                 .set_id_led     = tenxpress_set_id_led,
 707                 .monitor        = sfn4111t_check_hw,
 708         },
 709         {
 710                 .id             = FALCON_BOARD_SFN4112F,
 711                 .ref_model      = "SFN4112F",
 712                 .gen_type       = "SFP+ adapter",
 713                 .init           = sfn4112f_init,
 714                 .init_phy       = sfn4112f_init_phy,
 715                 .fini           = efx_fini_lm87,
 716                 .set_id_led     = sfn4112f_set_id_led,
 717                 .monitor        = sfn4112f_check_hw,
 718         },
 719 };
 720
 721 static const struct falcon_board_type falcon_dummy_board = {
 722         .init           = efx_port_dummy_op_int,
 723         .init_phy       = efx_port_dummy_op_void,
 724         .fini           = efx_port_dummy_op_void,
 725         .set_id_led     = efx_port_dummy_op_set_id_led,
 726         .monitor        = efx_port_dummy_op_int,
 727 };
 728
 729 void falcon_probe_board(struct efx_nic *efx, u16 revision_info)
 730 {
 731         struct falcon_board *board = falcon_board(efx);
 732         u8 type_id = FALCON_BOARD_TYPE(revision_info);
 733         int i;
 734
 735         board->major = FALCON_BOARD_MAJOR(revision_info);
 736         board->minor = FALCON_BOARD_MINOR(revision_info);
 737
 738         for (i = 0; i < ARRAY_SIZE(board_types); i++)
 739                 if (board_types[i].id == type_id)
 740                         board->type = &board_types[i];
 741
 742         if (board->type) {
 743                 EFX_INFO(efx, "board is %s rev %c%d\n",
 744                          (efx->pci_dev->subsystem_vendor == EFX_VENDID_SFC)
 745                          ? board->type->ref_model : board->type->gen_type,
 746                          'A' + board->major, board->minor);
 747         } else {
 748                 EFX_ERR(efx, "unknown board type %d\n", type_id);
 749                 board->type = &falcon_dummy_board;
 750         }
 751 }