sfc: Add support for SFE4003 board and TXC43128 PHY
authorBen Hutchings <bhutchings@solarflare.com>
Wed, 22 Sep 2010 10:00:47 +0000 (10:00 +0000)
committerDavid S. Miller <davem@davemloft.net>
Wed, 22 Sep 2010 20:26:45 +0000 (13:26 -0700)
This board never went into production, but some engineering samples
are in use.

Signed-off-by: Ben Hutchings <bhutchings@solarflare.com>
Signed-off-by: David S. Miller <davem@davemloft.net>
drivers/net/sfc/Makefile
drivers/net/sfc/falcon.c
drivers/net/sfc/falcon_boards.c
drivers/net/sfc/phy.h
drivers/net/sfc/txc43128_phy.c [new file with mode: 0644]

index 39f7c1bc240596e48e84936cf651e59968f6738d..ab31c7124db1898ed58460fb7c7593c89498fcac 100644 (file)
@@ -1,7 +1,8 @@
 sfc-y                  += efx.o nic.o falcon.o siena.o tx.o rx.o filter.o \
                           falcon_xmac.o mcdi_mac.o \
                           selftest.o ethtool.o qt202x_phy.o mdio_10g.o \
-                          tenxpress.o falcon_boards.o mcdi.o mcdi_phy.o
+                          tenxpress.o txc43128_phy.o falcon_boards.o \
+                          mcdi.o mcdi_phy.o
 sfc-$(CONFIG_SFC_MTD)  += mtd.o
 
 obj-$(CONFIG_SFC)      += sfc.o
index 254a599935c1adbf899d4901bd7cab49b91d18bb..267019bb2b156815f269a9ae4429ceec6d4e2d7a 100644 (file)
@@ -831,6 +831,9 @@ static int falcon_probe_port(struct efx_nic *efx)
        case PHY_TYPE_QT2025C:
                efx->phy_op = &falcon_qt202x_phy_ops;
                break;
+       case PHY_TYPE_TXC43128:
+               efx->phy_op = &falcon_txc_phy_ops;
+               break;
        default:
                netif_err(efx, probe, efx->net_dev, "Unknown PHY type %d\n",
                          efx->phy_type);
index bf029b3d3b0adfd09771a47e751da88c50904426..cfc6a5b5a4770a3e2c48446b7dc168dbba318ceb 100644 (file)
@@ -26,6 +26,7 @@
 /* Board types */
 #define FALCON_BOARD_SFE4001 0x01
 #define FALCON_BOARD_SFE4002 0x02
+#define FALCON_BOARD_SFE4003 0x03
 #define FALCON_BOARD_SFN4112F 0x52
 
 /* Board temperature is about 15°C above ambient when air flow is
@@ -582,6 +583,75 @@ static int sfn4112f_init(struct efx_nic *efx)
        return efx_init_lm87(efx, &sfn4112f_hwmon_info, sfn4112f_lm87_regs);
 }
 
+/*****************************************************************************
+ * Support for the SFE4003
+ *
+ */
+static u8 sfe4003_lm87_channel = 0x03; /* use AIN not FAN inputs */
+
+static const u8 sfe4003_lm87_regs[] = {
+       LM87_IN_LIMITS(0, 0x67, 0x7f),          /* 2.5V:  1.5V +/- 10% */
+       LM87_IN_LIMITS(1, 0x4c, 0x5e),          /* Vccp1: 1.2V +/- 10% */
+       LM87_IN_LIMITS(2, 0xac, 0xd4),          /* 3.3V:  3.3V +/- 10% */
+       LM87_IN_LIMITS(4, 0xac, 0xe0),          /* 12V:   10.8-14V */
+       LM87_IN_LIMITS(5, 0x3f, 0x4f),          /* Vccp2: 1.0V +/- 10% */
+       LM87_TEMP_INT_LIMITS(0, 70 + FALCON_BOARD_TEMP_BIAS),
+       0
+};
+
+static struct i2c_board_info sfe4003_hwmon_info = {
+       I2C_BOARD_INFO("lm87", 0x2e),
+       .platform_data  = &sfe4003_lm87_channel,
+};
+
+/* Board-specific LED info. */
+#define SFE4003_RED_LED_GPIO   11
+#define SFE4003_LED_ON         1
+#define SFE4003_LED_OFF                0
+
+static void sfe4003_set_id_led(struct efx_nic *efx, enum efx_led_mode mode)
+{
+       struct falcon_board *board = falcon_board(efx);
+
+       /* The LEDs were not wired to GPIOs before A3 */
+       if (board->minor < 3 && board->major == 0)
+               return;
+
+       falcon_txc_set_gpio_val(
+               efx, SFE4003_RED_LED_GPIO,
+               (mode == EFX_LED_ON) ? SFE4003_LED_ON : SFE4003_LED_OFF);
+}
+
+static void sfe4003_init_phy(struct efx_nic *efx)
+{
+       struct falcon_board *board = falcon_board(efx);
+
+       /* The LEDs were not wired to GPIOs before A3 */
+       if (board->minor < 3 && board->major == 0)
+               return;
+
+       falcon_txc_set_gpio_dir(efx, SFE4003_RED_LED_GPIO, TXC_GPIO_DIR_OUTPUT);
+       falcon_txc_set_gpio_val(efx, SFE4003_RED_LED_GPIO, SFE4003_LED_OFF);
+}
+
+static int sfe4003_check_hw(struct efx_nic *efx)
+{
+       struct falcon_board *board = falcon_board(efx);
+
+       /* A0/A1/A2 board rev. 4003s  report a temperature fault the whole time
+        * (bad sensor) so we mask it out. */
+       unsigned alarm_mask =
+               (board->major == 0 && board->minor <= 2) ?
+               ~LM87_ALARM_TEMP_EXT1 : ~0;
+
+       return efx_check_lm87(efx, alarm_mask);
+}
+
+static int sfe4003_init(struct efx_nic *efx)
+{
+       return efx_init_lm87(efx, &sfe4003_hwmon_info, sfe4003_lm87_regs);
+}
+
 static const struct falcon_board_type board_types[] = {
        {
                .id             = FALCON_BOARD_SFE4001,
@@ -603,6 +673,16 @@ static const struct falcon_board_type board_types[] = {
                .set_id_led     = sfe4002_set_id_led,
                .monitor        = sfe4002_check_hw,
        },
+       {
+               .id             = FALCON_BOARD_SFE4003,
+               .ref_model      = "SFE4003",
+               .gen_type       = "10GBASE-CX4 adapter",
+               .init           = sfe4003_init,
+               .init_phy       = sfe4003_init_phy,
+               .fini           = efx_fini_lm87,
+               .set_id_led     = sfe4003_set_id_led,
+               .monitor        = sfe4003_check_hw,
+       },
        {
                .id             = FALCON_BOARD_SFN4112F,
                .ref_model      = "SFN4112F",
index 7ab07575c6d386d42bc17396fc8b72e596f0ac5e..1dab609757fb5490a7bf8af68f34acc81aac99d4 100644 (file)
@@ -36,6 +36,17 @@ extern struct efx_phy_operations falcon_qt202x_phy_ops;
 
 extern void falcon_qt202x_set_led(struct efx_nic *p, int led, int state);
 
+/****************************************************************************
+* Transwitch CX4 retimer
+*/
+extern struct efx_phy_operations falcon_txc_phy_ops;
+
+#define TXC_GPIO_DIR_INPUT     0
+#define TXC_GPIO_DIR_OUTPUT    1
+
+extern void falcon_txc_set_gpio_dir(struct efx_nic *efx, int pin, int dir);
+extern void falcon_txc_set_gpio_val(struct efx_nic *efx, int pin, int val);
+
 /****************************************************************************
  * Siena managed PHYs
  */
diff --git a/drivers/net/sfc/txc43128_phy.c b/drivers/net/sfc/txc43128_phy.c
new file mode 100644 (file)
index 0000000..351794a
--- /dev/null
@@ -0,0 +1,560 @@
+/****************************************************************************
+ * Driver for Solarflare Solarstorm network controllers and boards
+ * Copyright 2006-2010 Solarflare Communications Inc.
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms of the GNU General Public License version 2 as published
+ * by the Free Software Foundation, incorporated herein by reference.
+ */
+
+/*
+ * Driver for Transwitch/Mysticom CX4 retimer
+ * see www.transwitch.com, part is TXC-43128
+ */
+
+#include <linux/delay.h>
+#include <linux/slab.h>
+#include "efx.h"
+#include "mdio_10g.h"
+#include "phy.h"
+#include "nic.h"
+
+/* We expect these MMDs to be in the package */
+#define TXC_REQUIRED_DEVS (MDIO_DEVS_PCS |     \
+                          MDIO_DEVS_PMAPMD |   \
+                          MDIO_DEVS_PHYXS)
+
+#define TXC_LOOPBACKS ((1 << LOOPBACK_PCS) |   \
+                      (1 << LOOPBACK_PMAPMD) | \
+                      (1 << LOOPBACK_PHYXS_WS))
+
+/**************************************************************************
+ *
+ * Compile-time config
+ *
+ **************************************************************************
+ */
+#define TXCNAME "TXC43128"
+/* Total length of time we'll wait for the PHY to come out of reset (ms) */
+#define TXC_MAX_RESET_TIME     500
+/* Interval between checks (ms) */
+#define TXC_RESET_WAIT         10
+/* How long to run BIST (us) */
+#define TXC_BIST_DURATION      50
+
+/**************************************************************************
+ *
+ * Register definitions
+ *
+ **************************************************************************
+ */
+
+/* Command register */
+#define TXC_GLRGS_GLCMD                0xc004
+/* Useful bits in command register */
+/* Lane power-down */
+#define TXC_GLCMD_L01PD_LBN    5
+#define TXC_GLCMD_L23PD_LBN    6
+/* Limited SW reset: preserves configuration but
+ * initiates a logic reset. Self-clearing */
+#define TXC_GLCMD_LMTSWRST_LBN 14
+
+/* Signal Quality Control */
+#define TXC_GLRGS_GSGQLCTL     0xc01a
+/* Enable bit */
+#define TXC_GSGQLCT_SGQLEN_LBN 15
+/* Lane selection */
+#define TXC_GSGQLCT_LNSL_LBN   13
+#define TXC_GSGQLCT_LNSL_WIDTH 2
+
+/* Analog TX control */
+#define TXC_ALRGS_ATXCTL       0xc040
+/* Lane power-down */
+#define TXC_ATXCTL_TXPD3_LBN   15
+#define TXC_ATXCTL_TXPD2_LBN   14
+#define TXC_ATXCTL_TXPD1_LBN   13
+#define TXC_ATXCTL_TXPD0_LBN   12
+
+/* Amplitude on lanes 0, 1 */
+#define TXC_ALRGS_ATXAMP0      0xc041
+/* Amplitude on lanes 2, 3 */
+#define TXC_ALRGS_ATXAMP1      0xc042
+/* Bit position of value for lane 0 (or 2) */
+#define TXC_ATXAMP_LANE02_LBN  3
+/* Bit position of value for lane 1 (or 3) */
+#define TXC_ATXAMP_LANE13_LBN  11
+
+#define TXC_ATXAMP_1280_mV     0
+#define TXC_ATXAMP_1200_mV     8
+#define TXC_ATXAMP_1120_mV     12
+#define TXC_ATXAMP_1060_mV     14
+#define TXC_ATXAMP_0820_mV     25
+#define TXC_ATXAMP_0720_mV     26
+#define TXC_ATXAMP_0580_mV     27
+#define TXC_ATXAMP_0440_mV     28
+
+#define TXC_ATXAMP_0820_BOTH                                   \
+       ((TXC_ATXAMP_0820_mV << TXC_ATXAMP_LANE02_LBN)          \
+        | (TXC_ATXAMP_0820_mV << TXC_ATXAMP_LANE13_LBN))
+
+#define TXC_ATXAMP_DEFAULT     0x6060 /* From databook */
+
+/* Preemphasis on lanes 0, 1 */
+#define TXC_ALRGS_ATXPRE0      0xc043
+/* Preemphasis on lanes 2, 3 */
+#define TXC_ALRGS_ATXPRE1      0xc044
+
+#define TXC_ATXPRE_NONE 0
+#define TXC_ATXPRE_DEFAULT     0x1010 /* From databook */
+
+#define TXC_ALRGS_ARXCTL       0xc045
+/* Lane power-down */
+#define TXC_ARXCTL_RXPD3_LBN   15
+#define TXC_ARXCTL_RXPD2_LBN   14
+#define TXC_ARXCTL_RXPD1_LBN   13
+#define TXC_ARXCTL_RXPD0_LBN   12
+
+/* Main control */
+#define TXC_MRGS_CTL           0xc340
+/* Bits in main control */
+#define TXC_MCTL_RESET_LBN     15      /* Self clear */
+#define TXC_MCTL_TXLED_LBN     14      /* 1 to show align status */
+#define TXC_MCTL_RXLED_LBN     13      /* 1 to show align status */
+
+/* GPIO output */
+#define TXC_GPIO_OUTPUT                0xc346
+#define TXC_GPIO_DIR           0xc348
+
+/* Vendor-specific BIST registers */
+#define TXC_BIST_CTL           0xc280
+#define TXC_BIST_TXFRMCNT      0xc281
+#define TXC_BIST_RX0FRMCNT     0xc282
+#define TXC_BIST_RX1FRMCNT     0xc283
+#define TXC_BIST_RX2FRMCNT     0xc284
+#define TXC_BIST_RX3FRMCNT     0xc285
+#define TXC_BIST_RX0ERRCNT     0xc286
+#define TXC_BIST_RX1ERRCNT     0xc287
+#define TXC_BIST_RX2ERRCNT     0xc288
+#define TXC_BIST_RX3ERRCNT     0xc289
+
+/* BIST type (controls bit patter in test) */
+#define TXC_BIST_CTRL_TYPE_LBN 10
+#define TXC_BIST_CTRL_TYPE_TSD 0       /* TranSwitch Deterministic */
+#define TXC_BIST_CTRL_TYPE_CRP 1       /* CRPAT standard */
+#define TXC_BIST_CTRL_TYPE_CJP 2       /* CJPAT standard */
+#define TXC_BIST_CTRL_TYPE_TSR 3       /* TranSwitch pseudo-random */
+/* Set this to 1 for 10 bit and 0 for 8 bit */
+#define TXC_BIST_CTRL_B10EN_LBN        12
+/* Enable BIST (write 0 to disable) */
+#define TXC_BIST_CTRL_ENAB_LBN 13
+/* Stop BIST (self-clears when stop complete) */
+#define TXC_BIST_CTRL_STOP_LBN 14
+/* Start BIST (cleared by writing 1 to STOP) */
+#define TXC_BIST_CTRL_STRT_LBN 15
+
+/* Mt. Diablo test configuration */
+#define TXC_MTDIABLO_CTRL      0xc34f
+#define TXC_MTDIABLO_CTRL_PMA_LOOP_LBN 10
+
+struct txc43128_data {
+       unsigned long bug10934_timer;
+       enum efx_phy_mode phy_mode;
+       enum efx_loopback_mode loopback_mode;
+};
+
+/* The PHY sometimes needs a reset to bring the link back up.  So long as
+ * it reports link down, we reset it every 5 seconds.
+ */
+#define BUG10934_RESET_INTERVAL (5 * HZ)
+
+/* Perform a reset that doesn't clear configuration changes */
+static void txc_reset_logic(struct efx_nic *efx);
+
+/* Set the output value of a gpio */
+void falcon_txc_set_gpio_val(struct efx_nic *efx, int pin, int on)
+{
+       efx_mdio_set_flag(efx, MDIO_MMD_PHYXS, TXC_GPIO_OUTPUT, 1 << pin, on);
+}
+
+/* Set up the GPIO direction register */
+void falcon_txc_set_gpio_dir(struct efx_nic *efx, int pin, int dir)
+{
+       efx_mdio_set_flag(efx, MDIO_MMD_PHYXS, TXC_GPIO_DIR, 1 << pin, dir);
+}
+
+/* Reset the PMA/PMD MMD. The documentation is explicit that this does a
+ * global reset (it's less clear what reset of other MMDs does).*/
+static int txc_reset_phy(struct efx_nic *efx)
+{
+       int rc = efx_mdio_reset_mmd(efx, MDIO_MMD_PMAPMD,
+                                   TXC_MAX_RESET_TIME / TXC_RESET_WAIT,
+                                   TXC_RESET_WAIT);
+       if (rc < 0)
+               goto fail;
+
+       /* Check that all the MMDs we expect are present and responding. */
+       rc = efx_mdio_check_mmds(efx, TXC_REQUIRED_DEVS, 0);
+       if (rc < 0)
+               goto fail;
+
+       return 0;
+
+fail:
+       netif_err(efx, hw, efx->net_dev, TXCNAME ": reset timed out!\n");
+       return rc;
+}
+
+/* Run a single BIST on one MMD */
+static int txc_bist_one(struct efx_nic *efx, int mmd, int test)
+{
+       int ctrl, bctl;
+       int lane;
+       int rc = 0;
+
+       /* Set PMA to test into loopback using Mt Diablo reg as per app note */
+       ctrl = efx_mdio_read(efx, MDIO_MMD_PCS, TXC_MTDIABLO_CTRL);
+       ctrl |= (1 << TXC_MTDIABLO_CTRL_PMA_LOOP_LBN);
+       efx_mdio_write(efx, MDIO_MMD_PCS, TXC_MTDIABLO_CTRL, ctrl);
+
+       /* The BIST app. note lists these  as 3 distinct steps. */
+       /* Set the BIST type */
+       bctl = (test << TXC_BIST_CTRL_TYPE_LBN);
+       efx_mdio_write(efx, mmd, TXC_BIST_CTL, bctl);
+
+       /* Set the BSTEN bit in the BIST Control register to enable */
+       bctl |= (1 << TXC_BIST_CTRL_ENAB_LBN);
+       efx_mdio_write(efx, mmd, TXC_BIST_CTL, bctl);
+
+       /* Set the BSTRT bit in the BIST Control register */
+       efx_mdio_write(efx, mmd, TXC_BIST_CTL,
+                      bctl | (1 << TXC_BIST_CTRL_STRT_LBN));
+
+       /* Wait. */
+       udelay(TXC_BIST_DURATION);
+
+       /* Set the BSTOP bit in the BIST Control register */
+       bctl |= (1 << TXC_BIST_CTRL_STOP_LBN);
+       efx_mdio_write(efx, mmd, TXC_BIST_CTL, bctl);
+
+       /* The STOP bit should go off when things have stopped */
+       while (bctl & (1 << TXC_BIST_CTRL_STOP_LBN))
+               bctl = efx_mdio_read(efx, mmd, TXC_BIST_CTL);
+
+       /* Check all the error counts are 0 and all the frame counts are
+          non-zero */
+       for (lane = 0; lane < 4; lane++) {
+               int count = efx_mdio_read(efx, mmd, TXC_BIST_RX0ERRCNT + lane);
+               if (count != 0) {
+                       netif_err(efx, hw, efx->net_dev, TXCNAME": BIST error. "
+                                 "Lane %d had %d errs\n", lane, count);
+                       rc = -EIO;
+               }
+               count = efx_mdio_read(efx, mmd, TXC_BIST_RX0FRMCNT + lane);
+               if (count == 0) {
+                       netif_err(efx, hw, efx->net_dev, TXCNAME": BIST error. "
+                                 "Lane %d got 0 frames\n", lane);
+                       rc = -EIO;
+               }
+       }
+
+       if (rc == 0)
+               netif_info(efx, hw, efx->net_dev, TXCNAME": BIST pass\n");
+
+       /* Disable BIST */
+       efx_mdio_write(efx, mmd, TXC_BIST_CTL, 0);
+
+       /* Turn off loopback */
+       ctrl &= ~(1 << TXC_MTDIABLO_CTRL_PMA_LOOP_LBN);
+       efx_mdio_write(efx, MDIO_MMD_PCS, TXC_MTDIABLO_CTRL, ctrl);
+
+       return rc;
+}
+
+static int txc_bist(struct efx_nic *efx)
+{
+       return txc_bist_one(efx, MDIO_MMD_PCS, TXC_BIST_CTRL_TYPE_TSD);
+}
+
+/* Push the non-configurable defaults into the PHY. This must be
+ * done after every full reset */
+static void txc_apply_defaults(struct efx_nic *efx)
+{
+       int mctrl;
+
+       /* Turn amplitude down and preemphasis off on the host side
+        * (PHY<->MAC) as this is believed less likely to upset Falcon
+        * and no adverse effects have been noted. It probably also
+        * saves a picowatt or two */
+
+       /* Turn off preemphasis */
+       efx_mdio_write(efx, MDIO_MMD_PHYXS, TXC_ALRGS_ATXPRE0, TXC_ATXPRE_NONE);
+       efx_mdio_write(efx, MDIO_MMD_PHYXS, TXC_ALRGS_ATXPRE1, TXC_ATXPRE_NONE);
+
+       /* Turn down the amplitude */
+       efx_mdio_write(efx, MDIO_MMD_PHYXS,
+                      TXC_ALRGS_ATXAMP0, TXC_ATXAMP_0820_BOTH);
+       efx_mdio_write(efx, MDIO_MMD_PHYXS,
+                      TXC_ALRGS_ATXAMP1, TXC_ATXAMP_0820_BOTH);
+
+       /* Set the line side amplitude and preemphasis to the databook
+        * defaults as an erratum causes them to be 0 on at least some
+        * PHY rev.s */
+       efx_mdio_write(efx, MDIO_MMD_PMAPMD,
+                      TXC_ALRGS_ATXPRE0, TXC_ATXPRE_DEFAULT);
+       efx_mdio_write(efx, MDIO_MMD_PMAPMD,
+                      TXC_ALRGS_ATXPRE1, TXC_ATXPRE_DEFAULT);
+       efx_mdio_write(efx, MDIO_MMD_PMAPMD,
+                      TXC_ALRGS_ATXAMP0, TXC_ATXAMP_DEFAULT);
+       efx_mdio_write(efx, MDIO_MMD_PMAPMD,
+                      TXC_ALRGS_ATXAMP1, TXC_ATXAMP_DEFAULT);
+
+       /* Set up the LEDs  */
+       mctrl = efx_mdio_read(efx, MDIO_MMD_PHYXS, TXC_MRGS_CTL);
+
+       /* Set the Green and Red LEDs to their default modes */
+       mctrl &= ~((1 << TXC_MCTL_TXLED_LBN) | (1 << TXC_MCTL_RXLED_LBN));
+       efx_mdio_write(efx, MDIO_MMD_PHYXS, TXC_MRGS_CTL, mctrl);
+
+       /* Databook recommends doing this after configuration changes */
+       txc_reset_logic(efx);
+
+       falcon_board(efx)->type->init_phy(efx);
+}
+
+static int txc43128_phy_probe(struct efx_nic *efx)
+{
+       struct txc43128_data *phy_data;
+
+       /* Allocate phy private storage */
+       phy_data = kzalloc(sizeof(*phy_data), GFP_KERNEL);
+       if (!phy_data)
+               return -ENOMEM;
+       efx->phy_data = phy_data;
+       phy_data->phy_mode = efx->phy_mode;
+
+       efx->mdio.mmds = TXC_REQUIRED_DEVS;
+       efx->mdio.mode_support = MDIO_SUPPORTS_C45 | MDIO_EMULATE_C22;
+
+       efx->loopback_modes = TXC_LOOPBACKS | FALCON_XMAC_LOOPBACKS;
+
+       return 0;
+}
+
+/* Initialisation entry point for this PHY driver */
+static int txc43128_phy_init(struct efx_nic *efx)
+{
+       int rc;
+
+       rc = txc_reset_phy(efx);
+       if (rc < 0)
+               return rc;
+
+       rc = txc_bist(efx);
+       if (rc < 0)
+               return rc;
+
+       txc_apply_defaults(efx);
+
+       return 0;
+}
+
+/* Set the lane power down state in the global registers */
+static void txc_glrgs_lane_power(struct efx_nic *efx, int mmd)
+{
+       int pd = (1 << TXC_GLCMD_L01PD_LBN) | (1 << TXC_GLCMD_L23PD_LBN);
+       int ctl = efx_mdio_read(efx, mmd, TXC_GLRGS_GLCMD);
+
+       if (!(efx->phy_mode & PHY_MODE_LOW_POWER))
+               ctl &= ~pd;
+       else
+               ctl |= pd;
+
+       efx_mdio_write(efx, mmd, TXC_GLRGS_GLCMD, ctl);
+}
+
+/* Set the lane power down state in the analog control registers */
+static void txc_analog_lane_power(struct efx_nic *efx, int mmd)
+{
+       int txpd = (1 << TXC_ATXCTL_TXPD3_LBN) | (1 << TXC_ATXCTL_TXPD2_LBN)
+               | (1 << TXC_ATXCTL_TXPD1_LBN) | (1 << TXC_ATXCTL_TXPD0_LBN);
+       int rxpd = (1 << TXC_ARXCTL_RXPD3_LBN) | (1 << TXC_ARXCTL_RXPD2_LBN)
+               | (1 << TXC_ARXCTL_RXPD1_LBN) | (1 << TXC_ARXCTL_RXPD0_LBN);
+       int txctl = efx_mdio_read(efx, mmd, TXC_ALRGS_ATXCTL);
+       int rxctl = efx_mdio_read(efx, mmd, TXC_ALRGS_ARXCTL);
+
+       if (!(efx->phy_mode & PHY_MODE_LOW_POWER)) {
+               txctl &= ~txpd;
+               rxctl &= ~rxpd;
+       } else {
+               txctl |= txpd;
+               rxctl |= rxpd;
+       }
+
+       efx_mdio_write(efx, mmd, TXC_ALRGS_ATXCTL, txctl);
+       efx_mdio_write(efx, mmd, TXC_ALRGS_ARXCTL, rxctl);
+}
+
+static void txc_set_power(struct efx_nic *efx)
+{
+       /* According to the data book, all the MMDs can do low power */
+       efx_mdio_set_mmds_lpower(efx,
+                                !!(efx->phy_mode & PHY_MODE_LOW_POWER),
+                                TXC_REQUIRED_DEVS);
+
+       /* Global register bank is in PCS, PHY XS. These control the host
+        * side and line side settings respectively. */
+       txc_glrgs_lane_power(efx, MDIO_MMD_PCS);
+       txc_glrgs_lane_power(efx, MDIO_MMD_PHYXS);
+
+       /* Analog register bank in PMA/PMD, PHY XS */
+       txc_analog_lane_power(efx, MDIO_MMD_PMAPMD);
+       txc_analog_lane_power(efx, MDIO_MMD_PHYXS);
+}
+
+static void txc_reset_logic_mmd(struct efx_nic *efx, int mmd)
+{
+       int val = efx_mdio_read(efx, mmd, TXC_GLRGS_GLCMD);
+       int tries = 50;
+
+       val |= (1 << TXC_GLCMD_LMTSWRST_LBN);
+       efx_mdio_write(efx, mmd, TXC_GLRGS_GLCMD, val);
+       while (tries--) {
+               val = efx_mdio_read(efx, mmd, TXC_GLRGS_GLCMD);
+               if (!(val & (1 << TXC_GLCMD_LMTSWRST_LBN)))
+                       break;
+               udelay(1);
+       }
+       if (!tries)
+               netif_info(efx, hw, efx->net_dev,
+                          TXCNAME " Logic reset timed out!\n");
+}
+
+/* Perform a logic reset. This preserves the configuration registers
+ * and is needed for some configuration changes to take effect */
+static void txc_reset_logic(struct efx_nic *efx)
+{
+       /* The data sheet claims we can do the logic reset on either the
+        * PCS or the PHYXS and the result is a reset of both host- and
+        * line-side logic. */
+       txc_reset_logic_mmd(efx, MDIO_MMD_PCS);
+}
+
+static bool txc43128_phy_read_link(struct efx_nic *efx)
+{
+       return efx_mdio_links_ok(efx, TXC_REQUIRED_DEVS);
+}
+
+static int txc43128_phy_reconfigure(struct efx_nic *efx)
+{
+       struct txc43128_data *phy_data = efx->phy_data;
+       enum efx_phy_mode mode_change = efx->phy_mode ^ phy_data->phy_mode;
+       bool loop_change = LOOPBACK_CHANGED(phy_data, efx, TXC_LOOPBACKS);
+
+       if (efx->phy_mode & mode_change & PHY_MODE_TX_DISABLED) {
+               txc_reset_phy(efx);
+               txc_apply_defaults(efx);
+               falcon_reset_xaui(efx);
+               mode_change &= ~PHY_MODE_TX_DISABLED;
+       }
+
+       efx_mdio_transmit_disable(efx);
+       efx_mdio_phy_reconfigure(efx);
+       if (mode_change & PHY_MODE_LOW_POWER)
+               txc_set_power(efx);
+
+       /* The data sheet claims this is required after every reconfiguration
+        * (note at end of 7.1), but we mustn't do it when nothing changes as
+        * it glitches the link, and reconfigure gets called on link change,
+        * so we get an IRQ storm on link up. */
+       if (loop_change || mode_change)
+               txc_reset_logic(efx);
+
+       phy_data->phy_mode = efx->phy_mode;
+       phy_data->loopback_mode = efx->loopback_mode;
+
+       return 0;
+}
+
+static void txc43128_phy_fini(struct efx_nic *efx)
+{
+       /* Disable link events */
+       efx_mdio_write(efx, MDIO_MMD_PMAPMD, MDIO_PMA_LASI_CTRL, 0);
+}
+
+static void txc43128_phy_remove(struct efx_nic *efx)
+{
+       kfree(efx->phy_data);
+       efx->phy_data = NULL;
+}
+
+/* Periodic callback: this exists mainly to poll link status as we
+ * don't use LASI interrupts */
+static bool txc43128_phy_poll(struct efx_nic *efx)
+{
+       struct txc43128_data *data = efx->phy_data;
+       bool was_up = efx->link_state.up;
+
+       efx->link_state.up = txc43128_phy_read_link(efx);
+       efx->link_state.speed = 10000;
+       efx->link_state.fd = true;
+       efx->link_state.fc = efx->wanted_fc;
+
+       if (efx->link_state.up || (efx->loopback_mode != LOOPBACK_NONE)) {
+               data->bug10934_timer = jiffies;
+       } else {
+               if (time_after_eq(jiffies, (data->bug10934_timer +
+                                           BUG10934_RESET_INTERVAL))) {
+                       data->bug10934_timer = jiffies;
+                       txc_reset_logic(efx);
+               }
+       }
+
+       return efx->link_state.up != was_up;
+}
+
+static const char *txc43128_test_names[] = {
+       "bist"
+};
+
+static const char *txc43128_test_name(struct efx_nic *efx, unsigned int index)
+{
+       if (index < ARRAY_SIZE(txc43128_test_names))
+               return txc43128_test_names[index];
+       return NULL;
+}
+
+static int txc43128_run_tests(struct efx_nic *efx, int *results, unsigned flags)
+{
+       int rc;
+
+       if (!(flags & ETH_TEST_FL_OFFLINE))
+               return 0;
+
+       rc = txc_reset_phy(efx);
+       if (rc < 0)
+               return rc;
+
+       rc = txc_bist(efx);
+       txc_apply_defaults(efx);
+       results[0] = rc ? -1 : 1;
+       return rc;
+}
+
+static void txc43128_get_settings(struct efx_nic *efx, struct ethtool_cmd *ecmd)
+{
+       mdio45_ethtool_gset(&efx->mdio, ecmd);
+}
+
+struct efx_phy_operations falcon_txc_phy_ops = {
+       .probe          = txc43128_phy_probe,
+       .init           = txc43128_phy_init,
+       .reconfigure    = txc43128_phy_reconfigure,
+       .poll           = txc43128_phy_poll,
+       .fini           = txc43128_phy_fini,
+       .remove         = txc43128_phy_remove,
+       .get_settings   = txc43128_get_settings,
+       .set_settings   = efx_mdio_set_settings,
+       .test_alive     = efx_mdio_test_alive,
+       .run_tests      = txc43128_run_tests,
+       .test_name      = txc43128_test_name,
+};