struct net_device *netdev = bus->priv;
struct et131x_adapter *adapter = netdev_priv(netdev);
- et1310_phy_reset(adapter);
+ et131x_mii_write(adapter, PHY_CONTROL, 0x8000);
return 0;
}
return status;
}
-void et1310_phy_reset(struct et131x_adapter *adapter)
-{
- et131x_mii_write(adapter, PHY_CONTROL, 0x8000);
-}
-
/**
* et1310_phy_power_down - PHY power control
* @adapter: device to control
et131x_mii_write(adapter, PHY_CONTROL, data);
}
-/**
- * et1310_phy_auto_neg - autonegotiate control
- * @adapter: device to control
- * @enabe: autoneg on/off
- *
- * Set up the autonegotiation state according to whether we will be
- * negotiating the state or forcing a speed.
- */
-static void et1310_phy_auto_neg(struct et131x_adapter *adapter, bool enable)
-{
- u16 data;
-
- et131x_mii_read(adapter, PHY_CONTROL, &data);
- data &= ~0x1000; /* Autonegotiation OFF */
- if (enable)
- data |= 0x1000; /* Autonegotiation ON */
- et131x_mii_write(adapter, PHY_CONTROL, data);
-}
-
-/**
- * et1310_phy_duplex_mode - duplex control
- * @adapter: device to control
- * @duplex: duplex on/off
- *
- * Set up the duplex state on the PHY
- */
-static void et1310_phy_duplex_mode(struct et131x_adapter *adapter, u16 duplex)
-{
- u16 data;
-
- et131x_mii_read(adapter, PHY_CONTROL, &data);
- data &= ~0x100; /* Set Half Duplex */
- if (duplex == TRUEPHY_DUPLEX_FULL)
- data |= 0x100; /* Set Full Duplex */
- et131x_mii_write(adapter, PHY_CONTROL, data);
-}
-
-/**
- * et1310_phy_speed_select - speed control
- * @adapter: device to control
- * @duplex: duplex on/off
- *
- * Set the speed of our PHY.
- */
-static void et1310_phy_speed_select(struct et131x_adapter *adapter, u16 speed)
-{
- u16 data;
- static const u16 bits[3] = {0x0000, 0x2000, 0x0040};
-
- /* Read the PHY control register */
- et131x_mii_read(adapter, PHY_CONTROL, &data);
- /* Clear all Speed settings (Bits 6, 13) */
- data &= ~0x2040;
- /* Write back the new speed */
- et131x_mii_write(adapter, PHY_CONTROL, data | bits[speed]);
-}
-
/**
* et1310_phy_link_status - read link state
* @adapter: device to read
}
}
-void et1310_phy_advertise_1000BaseT(struct et131x_adapter *adapter,
- u16 duplex)
-{
- u16 data;
-
- /* Read the PHY 1000 Base-T Control Register */
- et131x_mii_read(adapter, PHY_1000_CONTROL, &data);
-
- /* Clear Bits 8,9 */
- data &= ~0x0300;
-
- switch (duplex) {
- case TRUEPHY_ADV_DUPLEX_NONE:
- /* Duplex already cleared, do nothing */
- break;
-
- case TRUEPHY_ADV_DUPLEX_FULL:
- /* Set Bit 9 */
- data |= 0x0200;
- break;
-
- case TRUEPHY_ADV_DUPLEX_HALF:
- /* Set Bit 8 */
- data |= 0x0100;
- break;
-
- case TRUEPHY_ADV_DUPLEX_BOTH:
- default:
- data |= 0x0300;
- break;
- }
-
- /* Write back advertisement */
- et131x_mii_write(adapter, PHY_1000_CONTROL, data);
-}
-
-static void et1310_phy_advertise_100BaseT(struct et131x_adapter *adapter,
- u16 duplex)
-{
- u16 data;
-
- /* Read the Autonegotiation Register (10/100) */
- et131x_mii_read(adapter, PHY_AUTO_ADVERTISEMENT, &data);
-
- /* Clear bits 7,8 */
- data &= ~0x0180;
-
- switch (duplex) {
- case TRUEPHY_ADV_DUPLEX_NONE:
- /* Duplex already cleared, do nothing */
- break;
-
- case TRUEPHY_ADV_DUPLEX_FULL:
- /* Set Bit 8 */
- data |= 0x0100;
- break;
-
- case TRUEPHY_ADV_DUPLEX_HALF:
- /* Set Bit 7 */
- data |= 0x0080;
- break;
-
- case TRUEPHY_ADV_DUPLEX_BOTH:
- default:
- /* Set Bits 7,8 */
- data |= 0x0180;
- break;
- }
-
- /* Write back advertisement */
- et131x_mii_write(adapter, PHY_AUTO_ADVERTISEMENT, data);
-}
-
-static void et1310_phy_advertise_10BaseT(struct et131x_adapter *adapter,
- u16 duplex)
-{
- u16 data;
-
- /* Read the Autonegotiation Register (10/100) */
- et131x_mii_read(adapter, PHY_AUTO_ADVERTISEMENT, &data);
-
- /* Clear bits 5,6 */
- data &= ~0x0060;
-
- switch (duplex) {
- case TRUEPHY_ADV_DUPLEX_NONE:
- /* Duplex already cleared, do nothing */
- break;
-
- case TRUEPHY_ADV_DUPLEX_FULL:
- /* Set Bit 6 */
- data |= 0x0040;
- break;
-
- case TRUEPHY_ADV_DUPLEX_HALF:
- /* Set Bit 5 */
- data |= 0x0020;
- break;
-
- case TRUEPHY_ADV_DUPLEX_BOTH:
- default:
- /* Set Bits 5,6 */
- data |= 0x0060;
- break;
- }
-
- /* Write back advertisement */
- et131x_mii_write(adapter, PHY_AUTO_ADVERTISEMENT, data);
-}
-
/**
* et131x_xcvr_init - Init the phy if we are setting it into force mode
* @adapter: pointer to our private adapter structure
*
*/
-static void et131x_xcvr_init(struct et131x_adapter *adapter)
+void et131x_xcvr_init(struct et131x_adapter *adapter)
{
u16 imr;
u16 isr;
et131x_mii_write(adapter, (u8) offsetof(struct mi_regs, lcr2),
lcr2);
}
-
- /* Determine if we need to go into a force mode and set it */
- if (adapter->ai_force_speed == 0 && adapter->ai_force_duplex == 0) {
- if (adapter->wanted_flow == FLOW_TXONLY ||
- adapter->wanted_flow == FLOW_BOTH)
- et1310_phy_access_mii_bit(adapter,
- TRUEPHY_BIT_SET, 4, 11, NULL);
- else
- et1310_phy_access_mii_bit(adapter,
- TRUEPHY_BIT_CLEAR, 4, 11, NULL);
-
- if (adapter->wanted_flow == FLOW_BOTH)
- et1310_phy_access_mii_bit(adapter,
- TRUEPHY_BIT_SET, 4, 10, NULL);
- else
- et1310_phy_access_mii_bit(adapter,
- TRUEPHY_BIT_CLEAR, 4, 10, NULL);
-
- /* Set the phy to autonegotiation */
- et1310_phy_auto_neg(adapter, true);
-
- /* NOTE - Do we need this? */
- et1310_phy_access_mii_bit(adapter, TRUEPHY_BIT_SET, 0, 9, NULL);
- return;
- }
-
- et1310_phy_auto_neg(adapter, false);
-
- /* Set to the correct force mode. */
- if (adapter->ai_force_duplex != 1) {
- if (adapter->wanted_flow == FLOW_TXONLY ||
- adapter->wanted_flow == FLOW_BOTH)
- et1310_phy_access_mii_bit(adapter,
- TRUEPHY_BIT_SET, 4, 11, NULL);
- else
- et1310_phy_access_mii_bit(adapter,
- TRUEPHY_BIT_CLEAR, 4, 11, NULL);
-
- if (adapter->wanted_flow == FLOW_BOTH)
- et1310_phy_access_mii_bit(adapter,
- TRUEPHY_BIT_SET, 4, 10, NULL);
- else
- et1310_phy_access_mii_bit(adapter,
- TRUEPHY_BIT_CLEAR, 4, 10, NULL);
- } else {
- et1310_phy_access_mii_bit(adapter, TRUEPHY_BIT_CLEAR,
- 4, 10, NULL);
- et1310_phy_access_mii_bit(adapter, TRUEPHY_BIT_CLEAR,
- 4, 11, NULL);
- }
- et1310_phy_power_down(adapter, 1);
- switch (adapter->ai_force_speed) {
- case 10:
- /* First we need to turn off all other advertisement */
- et1310_phy_advertise_1000BaseT(adapter, TRUEPHY_ADV_DUPLEX_NONE);
- et1310_phy_advertise_100BaseT(adapter, TRUEPHY_ADV_DUPLEX_NONE);
- if (adapter->ai_force_duplex == 1) {
- /* Set our advertise values accordingly */
- et1310_phy_advertise_10BaseT(adapter,
- TRUEPHY_ADV_DUPLEX_HALF);
- } else if (adapter->ai_force_duplex == 2) {
- /* Set our advertise values accordingly */
- et1310_phy_advertise_10BaseT(adapter,
- TRUEPHY_ADV_DUPLEX_FULL);
- } else {
- /* Disable autoneg */
- et1310_phy_auto_neg(adapter, false);
- /* Disable rest of the advertisements */
- et1310_phy_advertise_10BaseT(adapter,
- TRUEPHY_ADV_DUPLEX_NONE);
- /* Force 10 Mbps */
- et1310_phy_speed_select(adapter, TRUEPHY_SPEED_10MBPS);
- /* Force Full duplex */
- et1310_phy_duplex_mode(adapter, TRUEPHY_DUPLEX_FULL);
- }
- break;
- case 100:
- /* first we need to turn off all other advertisement */
- et1310_phy_advertise_1000BaseT(adapter, TRUEPHY_ADV_DUPLEX_NONE);
- et1310_phy_advertise_10BaseT(adapter, TRUEPHY_ADV_DUPLEX_NONE);
- if (adapter->ai_force_duplex == 1) {
- /* Set our advertise values accordingly */
- et1310_phy_advertise_100BaseT(adapter,
- TRUEPHY_ADV_DUPLEX_HALF);
- /* Set speed */
- et1310_phy_speed_select(adapter, TRUEPHY_SPEED_100MBPS);
- } else if (adapter->ai_force_duplex == 2) {
- /* Set our advertise values accordingly */
- et1310_phy_advertise_100BaseT(adapter,
- TRUEPHY_ADV_DUPLEX_FULL);
- } else {
- /* Disable autoneg */
- et1310_phy_auto_neg(adapter, false);
- /* Disable other advertisement */
- et1310_phy_advertise_100BaseT(adapter,
- TRUEPHY_ADV_DUPLEX_NONE);
- /* Force 100 Mbps */
- et1310_phy_speed_select(adapter, TRUEPHY_SPEED_100MBPS);
- /* Force Full duplex */
- et1310_phy_duplex_mode(adapter, TRUEPHY_DUPLEX_FULL);
- }
- break;
- case 1000:
- /* first we need to turn off all other advertisement */
- et1310_phy_advertise_100BaseT(adapter, TRUEPHY_ADV_DUPLEX_NONE);
- et1310_phy_advertise_10BaseT(adapter, TRUEPHY_ADV_DUPLEX_NONE);
- /* set our advertise values accordingly */
- et1310_phy_advertise_1000BaseT(adapter, TRUEPHY_ADV_DUPLEX_FULL);
- break;
- }
- et1310_phy_power_down(adapter, 0);
-}
-
-/**
- * et131x_setphy_normal - Set PHY for normal operation.
- * @adapter: pointer to our private adapter structure
- *
- * Used by Power Management to force the PHY into 10 Base T half-duplex mode,
- * when going to D3 in WOL mode. Also used during initialization to set the
- * PHY for normal operation.
- */
-void et131x_setphy_normal(struct et131x_adapter *adapter)
-{
- /* Make sure the PHY is powered up */
- et1310_phy_power_down(adapter, 0);
- et131x_xcvr_init(adapter);
}
void et131x_mii_check(struct et131x_adapter *adapter,
}
}
-/*
- * The routines which follow provide low-level access to the PHY, and are used
- * primarily by the routines above (although there are a few places elsewhere
- * in the driver where this level of access is required).
- */
-static const u16 config_phy[25][2] = {
- /* Reg Value Register */
- /* Addr */
- {0x880B, 0x0926}, /* AfeIfCreg4B1000Msbs */
- {0x880C, 0x0926}, /* AfeIfCreg4B100Msbs */
- {0x880D, 0x0926}, /* AfeIfCreg4B10Msbs */
-
- {0x880E, 0xB4D3}, /* AfeIfCreg4B1000Lsbs */
- {0x880F, 0xB4D3}, /* AfeIfCreg4B100Lsbs */
- {0x8810, 0xB4D3}, /* AfeIfCreg4B10Lsbs */
-
- {0x8805, 0xB03E}, /* AfeIfCreg3B1000Msbs */
- {0x8806, 0xB03E}, /* AfeIfCreg3B100Msbs */
- {0x8807, 0xFF00}, /* AfeIfCreg3B10Msbs */
-
- {0x8808, 0xE090}, /* AfeIfCreg3B1000Lsbs */
- {0x8809, 0xE110}, /* AfeIfCreg3B100Lsbs */
- {0x880A, 0x0000}, /* AfeIfCreg3B10Lsbs */
-
- {0x300D, 1}, /* DisableNorm */
-
- {0x280C, 0x0180}, /* LinkHoldEnd */
-
- {0x1C21, 0x0002}, /* AlphaM */
-
- {0x3821, 6}, /* FfeLkgTx0 */
- {0x381D, 1}, /* FfeLkg1g4 */
- {0x381E, 1}, /* FfeLkg1g5 */
- {0x381F, 1}, /* FfeLkg1g6 */
- {0x3820, 1}, /* FfeLkg1g7 */
-
- {0x8402, 0x01F0}, /* Btinact */
- {0x800E, 20}, /* LftrainTime */
- {0x800F, 24}, /* DvguardTime */
- {0x8010, 46}, /* IdlguardTime */
-
- {0, 0}
-};
-
-/* condensed version of the phy initialization routine */
-void et1310_phy_init(struct et131x_adapter *adapter)
-{
- u16 data, index;
-
- /* get the identity (again ?) */
- et131x_mii_read(adapter, PHY_ID_1, &data);
- et131x_mii_read(adapter, PHY_ID_2, &data);
-
- /* what does this do/achieve ? */
- /* should read 0002 */
- et131x_mii_read(adapter, PHY_MPHY_CONTROL_REG, &data);
- et131x_mii_write(adapter, PHY_MPHY_CONTROL_REG, 0x0006);
-
- /* read modem register 0402, should I do something with the return
- data ? */
- et131x_mii_write(adapter, PHY_INDEX_REG, 0x0402);
- et131x_mii_read(adapter, PHY_DATA_REG, &data);
-
- /* what does this do/achieve ? */
- et131x_mii_write(adapter, PHY_MPHY_CONTROL_REG, 0x0002);
-
- /* get the identity (again ?) */
- et131x_mii_read(adapter, PHY_ID_1, &data);
- et131x_mii_read(adapter, PHY_ID_2, &data);
-
- /* what does this achieve ? */
- /* should read 0002 */
- et131x_mii_read(adapter, PHY_MPHY_CONTROL_REG, &data);
- et131x_mii_write(adapter, PHY_MPHY_CONTROL_REG, 0x0006);
-
- /* read modem register 0402, should I do something with
- the return data? */
- et131x_mii_write(adapter, PHY_INDEX_REG, 0x0402);
- et131x_mii_read(adapter, PHY_DATA_REG, &data);
-
- et131x_mii_write(adapter, PHY_MPHY_CONTROL_REG, 0x0002);
-
- /* what does this achieve (should return 0x1040) */
- et131x_mii_read(adapter, PHY_CONTROL, &data);
- /* should read 0002 */
- et131x_mii_read(adapter, PHY_MPHY_CONTROL_REG, &data);
- et131x_mii_write(adapter, PHY_CONTROL, 0x1840);
-
- et131x_mii_write(adapter, PHY_MPHY_CONTROL_REG, 0x0007);
-
- /* here the writing of the array starts.... */
- index = 0;
- while (config_phy[index][0] != 0x0000) {
- /* write value */
- et131x_mii_write(adapter, PHY_INDEX_REG, config_phy[index][0]);
- et131x_mii_write(adapter, PHY_DATA_REG, config_phy[index][1]);
-
- /* read it back */
- et131x_mii_write(adapter, PHY_INDEX_REG, config_phy[index][0]);
- et131x_mii_read(adapter, PHY_DATA_REG, &data);
-
- /* do a check on the value read back ? */
- index++;
- }
- /* here the writing of the array ends... */
-
- et131x_mii_read(adapter, PHY_CONTROL, &data); /* 0x1840 */
- /* should read 0007 */
- et131x_mii_read(adapter, PHY_MPHY_CONTROL_REG, &data);
- et131x_mii_write(adapter, PHY_CONTROL, 0x1040);
- et131x_mii_write(adapter, PHY_MPHY_CONTROL_REG, 0x0002);
-}
-