mirror of https://github.com/hak5/openwrt.git
311 lines
9.6 KiB
Diff
311 lines
9.6 KiB
Diff
--- a/drivers/net/tg3.c
|
|
+++ b/drivers/net/tg3.c
|
|
@@ -41,6 +41,7 @@
|
|
#include <linux/prefetch.h>
|
|
#include <linux/dma-mapping.h>
|
|
#include <linux/firmware.h>
|
|
+#include <linux/ssb/ssb_driver_gige.h>
|
|
|
|
#include <net/checksum.h>
|
|
#include <net/ip.h>
|
|
@@ -457,8 +458,9 @@ static void _tw32_flush(struct tg3 *tp,
|
|
static inline void tw32_mailbox_flush(struct tg3 *tp, u32 off, u32 val)
|
|
{
|
|
tp->write32_mbox(tp, off, val);
|
|
- if (!(tp->tg3_flags & TG3_FLAG_MBOX_WRITE_REORDER) &&
|
|
- !(tp->tg3_flags2 & TG3_FLG2_ICH_WORKAROUND))
|
|
+ if ((tp->tg3_flags3 & TG3_FLG3_FLUSH_POSTED_WRITES) ||
|
|
+ (!(tp->tg3_flags & TG3_FLAG_MBOX_WRITE_REORDER) &&
|
|
+ !(tp->tg3_flags2 & TG3_FLG2_ICH_WORKAROUND)))
|
|
tp->read32_mbox(tp, off);
|
|
}
|
|
|
|
@@ -468,7 +470,7 @@ static void tg3_write32_tx_mbox(struct t
|
|
writel(val, mbox);
|
|
if (tp->tg3_flags & TG3_FLAG_TXD_MBOX_HWBUG)
|
|
writel(val, mbox);
|
|
- if (tp->tg3_flags & TG3_FLAG_MBOX_WRITE_REORDER)
|
|
+ if ((tp->tg3_flags & TG3_FLAG_MBOX_WRITE_REORDER) || (tp->tg3_flags3 & TG3_FLG3_FLUSH_POSTED_WRITES))
|
|
readl(mbox);
|
|
}
|
|
|
|
@@ -768,7 +770,7 @@ static void tg3_switch_clocks(struct tg3
|
|
|
|
#define PHY_BUSY_LOOPS 5000
|
|
|
|
-static int tg3_readphy(struct tg3 *tp, int reg, u32 *val)
|
|
+static int __tg3_readphy(struct tg3 *tp, unsigned int phy_addr, int reg, u32 *val)
|
|
{
|
|
u32 frame_val;
|
|
unsigned int loops;
|
|
@@ -817,7 +819,12 @@ static int tg3_readphy(struct tg3 *tp, i
|
|
return ret;
|
|
}
|
|
|
|
-static int tg3_writephy(struct tg3 *tp, int reg, u32 val)
|
|
+static int tg3_readphy(struct tg3 *tp, int reg, u32 *val)
|
|
+{
|
|
+ return __tg3_readphy(tp, PHY_ADDR, reg, val);
|
|
+}
|
|
+
|
|
+static int __tg3_writephy(struct tg3 *tp, unsigned int phy_addr, int reg, u32 val)
|
|
{
|
|
u32 frame_val;
|
|
unsigned int loops;
|
|
@@ -866,6 +873,11 @@ static int tg3_writephy(struct tg3 *tp,
|
|
return ret;
|
|
}
|
|
|
|
+static int tg3_writephy(struct tg3 *tp, int reg, u32 val)
|
|
+{
|
|
+ return __tg3_writephy(tp, PHY_ADDR, reg, val);
|
|
+}
|
|
+
|
|
static int tg3_bmcr_reset(struct tg3 *tp)
|
|
{
|
|
u32 phy_control;
|
|
@@ -2337,6 +2349,9 @@ static int tg3_nvram_read(struct tg3 *tp
|
|
{
|
|
int ret;
|
|
|
|
+ if (tp->tg3_flags3 & TG3_FLG3_IS_SSB_CORE)
|
|
+ return -ENODEV;
|
|
+
|
|
if (!(tp->tg3_flags & TG3_FLAG_NVRAM))
|
|
return tg3_nvram_read_using_eeprom(tp, offset, val);
|
|
|
|
@@ -2668,8 +2683,10 @@ static int tg3_set_power_state(struct tg
|
|
tg3_frob_aux_power(tp);
|
|
|
|
/* Workaround for unstable PLL clock */
|
|
- if ((GET_CHIP_REV(tp->pci_chip_rev_id) == CHIPREV_5750_AX) ||
|
|
- (GET_CHIP_REV(tp->pci_chip_rev_id) == CHIPREV_5750_BX)) {
|
|
+ if ((tp->phy_id & PHY_ID_MASK) != PHY_ID_BCM5750_2 &&
|
|
+ /* !!! FIXME !!! */
|
|
+ ((GET_CHIP_REV(tp->pci_chip_rev_id) == CHIPREV_5750_AX) ||
|
|
+ (GET_CHIP_REV(tp->pci_chip_rev_id) == CHIPREV_5750_BX))) {
|
|
u32 val = tr32(0x7d00);
|
|
|
|
val &= ~((1 << 16) | (1 << 4) | (1 << 2) | (1 << 1) | 1);
|
|
@@ -3161,6 +3178,14 @@ relink:
|
|
|
|
tg3_phy_copper_begin(tp);
|
|
|
|
+ if (tp->tg3_flags3 & TG3_FLG3_ROBOSWITCH) {
|
|
+ current_link_up = 1;
|
|
+ current_speed = SPEED_1000; //FIXME
|
|
+ current_duplex = DUPLEX_FULL;
|
|
+ tp->link_config.active_speed = current_speed;
|
|
+ tp->link_config.active_duplex = current_duplex;
|
|
+ }
|
|
+
|
|
tg3_readphy(tp, MII_BMSR, &tmp);
|
|
if (!tg3_readphy(tp, MII_BMSR, &tmp) &&
|
|
(tmp & BMSR_LSTATUS))
|
|
@@ -6273,6 +6298,11 @@ static int tg3_poll_fw(struct tg3 *tp)
|
|
int i;
|
|
u32 val;
|
|
|
|
+ if (tp->tg3_flags3 & TG3_FLG3_IS_SSB_CORE) {
|
|
+ /* We don't use firmware. */
|
|
+ return 0;
|
|
+ }
|
|
+
|
|
if (GET_ASIC_REV(tp->pci_chip_rev_id) == ASIC_REV_5906) {
|
|
/* Wait up to 20ms for init done. */
|
|
for (i = 0; i < 200; i++) {
|
|
@@ -6550,6 +6580,14 @@ static int tg3_chip_reset(struct tg3 *tp
|
|
tw32(0x5000, 0x400);
|
|
}
|
|
|
|
+ if (tp->tg3_flags3 & TG3_FLG3_IS_SSB_CORE) {
|
|
+ /* BCM4785: In order to avoid repercussions from using potentially
|
|
+ * defective internal ROM, stop the Rx RISC CPU, which is not
|
|
+ * required. */
|
|
+ tg3_stop_fw(tp);
|
|
+ tg3_halt_cpu(tp, RX_CPU_BASE);
|
|
+ }
|
|
+
|
|
tw32(GRC_MODE, tp->grc_mode);
|
|
|
|
if (tp->pci_chip_rev_id == CHIPREV_ID_5705_A0) {
|
|
@@ -6704,9 +6742,12 @@ static int tg3_halt_cpu(struct tg3 *tp,
|
|
return -ENODEV;
|
|
}
|
|
|
|
- /* Clear firmware's nvram arbitration. */
|
|
- if (tp->tg3_flags & TG3_FLAG_NVRAM)
|
|
- tw32(NVRAM_SWARB, SWARB_REQ_CLR0);
|
|
+ if (!(tp->tg3_flags3 & TG3_FLG3_IS_SSB_CORE)) {
|
|
+ /* Clear firmware's nvram arbitration. */
|
|
+ if (tp->tg3_flags & TG3_FLAG_NVRAM)
|
|
+ tw32(NVRAM_SWARB, SWARB_REQ_CLR0);
|
|
+ }
|
|
+
|
|
return 0;
|
|
}
|
|
|
|
@@ -6769,6 +6810,11 @@ static int tg3_load_5701_a0_firmware_fix
|
|
const __be32 *fw_data;
|
|
int err, i;
|
|
|
|
+ if (tp->tg3_flags3 & TG3_FLG3_IS_SSB_CORE) {
|
|
+ /* We don't use firmware. */
|
|
+ return 0;
|
|
+ }
|
|
+
|
|
fw_data = (void *)tp->fw->data;
|
|
|
|
/* Firmware blob starts with version numbers, followed by
|
|
@@ -6828,6 +6874,11 @@ static int tg3_load_tso_firmware(struct
|
|
unsigned long cpu_base, cpu_scratch_base, cpu_scratch_size;
|
|
int err, i;
|
|
|
|
+ if (tp->tg3_flags3 & TG3_FLG3_IS_SSB_CORE) {
|
|
+ /* We don't use firmware. */
|
|
+ return 0;
|
|
+ }
|
|
+
|
|
if (tp->tg3_flags2 & TG3_FLG2_HW_TSO)
|
|
return 0;
|
|
|
|
@@ -7915,6 +7966,11 @@ static void tg3_timer(unsigned long __op
|
|
|
|
spin_lock(&tp->lock);
|
|
|
|
+ if (tp->tg3_flags3 & TG3_FLG3_FLUSH_POSTED_WRITES) {
|
|
+ /* BCM4785: Flush posted writes from GbE to host memory. */
|
|
+ tr32(HOSTCC_MODE);
|
|
+ }
|
|
+
|
|
if (!(tp->tg3_flags & TG3_FLAG_TAGGED_STATUS)) {
|
|
/* All of this garbage is because when using non-tagged
|
|
* IRQ status the mailbox/status_block protocol the chip
|
|
@@ -9801,6 +9857,11 @@ static int tg3_test_nvram(struct tg3 *tp
|
|
if (tp->tg3_flags3 & TG3_FLG3_NO_NVRAM)
|
|
return 0;
|
|
|
|
+ if (tp->tg3_flags3 & TG3_FLG3_IS_SSB_CORE) {
|
|
+ /* We don't have NVRAM. */
|
|
+ return 0;
|
|
+ }
|
|
+
|
|
if (tg3_nvram_read(tp, 0, &magic) != 0)
|
|
return -EIO;
|
|
|
|
@@ -10595,7 +10656,7 @@ static int tg3_ioctl(struct net_device *
|
|
return -EAGAIN;
|
|
|
|
spin_lock_bh(&tp->lock);
|
|
- err = tg3_readphy(tp, data->reg_num & 0x1f, &mii_regval);
|
|
+ err = __tg3_readphy(tp, data->phy_id & 0x1f, data->reg_num & 0x1f, &mii_regval);
|
|
spin_unlock_bh(&tp->lock);
|
|
|
|
data->val_out = mii_regval;
|
|
@@ -10611,7 +10672,7 @@ static int tg3_ioctl(struct net_device *
|
|
return -EAGAIN;
|
|
|
|
spin_lock_bh(&tp->lock);
|
|
- err = tg3_writephy(tp, data->reg_num & 0x1f, data->val_in);
|
|
+ err = __tg3_writephy(tp, data->phy_id & 0x1f, data->reg_num & 0x1f, data->val_in);
|
|
spin_unlock_bh(&tp->lock);
|
|
|
|
return err;
|
|
@@ -11256,6 +11317,12 @@ static void __devinit tg3_get_5717_nvram
|
|
/* Chips other than 5700/5701 use the NVRAM for fetching info. */
|
|
static void __devinit tg3_nvram_init(struct tg3 *tp)
|
|
{
|
|
+ if (tp->tg3_flags3 & TG3_FLG3_IS_SSB_CORE) {
|
|
+ /* No NVRAM and EEPROM on the SSB Broadcom GigE core. */
|
|
+ tp->tg3_flags &= ~(TG3_FLAG_NVRAM | TG3_FLAG_NVRAM_BUFFERED);
|
|
+ return;
|
|
+ }
|
|
+
|
|
tw32_f(GRC_EEPROM_ADDR,
|
|
(EEPROM_ADDR_FSM_RESET |
|
|
(EEPROM_DEFAULT_CLOCK_PERIOD <<
|
|
@@ -11516,6 +11583,9 @@ static int tg3_nvram_write_block(struct
|
|
{
|
|
int ret;
|
|
|
|
+ if (tp->tg3_flags3 & TG3_FLG3_IS_SSB_CORE)
|
|
+ return -ENODEV;
|
|
+
|
|
if (tp->tg3_flags & TG3_FLAG_EEPROM_WRITE_PROT) {
|
|
tw32_f(GRC_LOCAL_CTRL, tp->grc_local_ctrl &
|
|
~GRC_LCLCTRL_GPIO_OUTPUT1);
|
|
@@ -12801,6 +12871,11 @@ static int __devinit tg3_get_invariants(
|
|
GET_ASIC_REV(tp->pci_chip_rev_id) == ASIC_REV_5701)))
|
|
tp->tg3_flags |= TG3_FLAG_SRAM_USE_CONFIG;
|
|
|
|
+ if (tp->tg3_flags3 & TG3_FLG3_FLUSH_POSTED_WRITES) {
|
|
+ tp->write32_tx_mbox = tg3_write_flush_reg32;
|
|
+ tp->write32_rx_mbox = tg3_write_flush_reg32;
|
|
+ }
|
|
+
|
|
/* Get eeprom hw config before calling tg3_set_power_state().
|
|
* In particular, the TG3_FLG2_IS_NIC flag must be
|
|
* determined before calling tg3_set_power_state() so that
|
|
@@ -13190,6 +13265,10 @@ static int __devinit tg3_get_device_addr
|
|
}
|
|
|
|
if (!is_valid_ether_addr(&dev->dev_addr[0])) {
|
|
+ if (tp->tg3_flags3 & TG3_FLG3_IS_SSB_CORE)
|
|
+ ssb_gige_get_macaddr(tp->pdev, &dev->dev_addr[0]);
|
|
+ }
|
|
+ if (!is_valid_ether_addr(&dev->dev_addr[0])) {
|
|
#ifdef CONFIG_SPARC
|
|
if (!tg3_get_default_macaddr_sparc(tp))
|
|
return 0;
|
|
@@ -13682,6 +13761,7 @@ static char * __devinit tg3_phy_string(s
|
|
case PHY_ID_BCM5704: return "5704";
|
|
case PHY_ID_BCM5705: return "5705";
|
|
case PHY_ID_BCM5750: return "5750";
|
|
+ case PHY_ID_BCM5750_2: return "5750-2";
|
|
case PHY_ID_BCM5752: return "5752";
|
|
case PHY_ID_BCM5714: return "5714";
|
|
case PHY_ID_BCM5780: return "5780";
|
|
@@ -13893,6 +13973,13 @@ static int __devinit tg3_init_one(struct
|
|
tp->msg_enable = tg3_debug;
|
|
else
|
|
tp->msg_enable = TG3_DEF_MSG_ENABLE;
|
|
+ if (pdev_is_ssb_gige_core(pdev)) {
|
|
+ tp->tg3_flags3 |= TG3_FLG3_IS_SSB_CORE;
|
|
+ if (ssb_gige_must_flush_posted_writes(pdev))
|
|
+ tp->tg3_flags3 |= TG3_FLG3_FLUSH_POSTED_WRITES;
|
|
+ if (ssb_gige_have_roboswitch(pdev))
|
|
+ tp->tg3_flags3 |= TG3_FLG3_ROBOSWITCH;
|
|
+ }
|
|
|
|
/* The word/byte swap controls here control register access byte
|
|
* swapping. DMA data byte swapping is controlled in the GRC_MODE
|
|
--- a/drivers/net/tg3.h
|
|
+++ b/drivers/net/tg3.h
|
|
@@ -1939,6 +1939,9 @@
|
|
#define NIC_SRAM_RGMII_STD_IBND_DISABLE 0x00000004
|
|
#define NIC_SRAM_RGMII_EXT_IBND_RX_EN 0x00000008
|
|
#define NIC_SRAM_RGMII_EXT_IBND_TX_EN 0x00000010
|
|
+#define TG3_FLG3_IS_SSB_CORE 0x00000800
|
|
+#define TG3_FLG3_FLUSH_POSTED_WRITES 0x00001000
|
|
+#define TG3_FLG3_ROBOSWITCH 0x00002000
|
|
|
|
#define NIC_SRAM_RX_MINI_BUFFER_DESC 0x00001000
|
|
|
|
@@ -2824,6 +2827,7 @@ struct tg3 {
|
|
#define PHY_ID_BCM5714 0x60008340
|
|
#define PHY_ID_BCM5780 0x60008350
|
|
#define PHY_ID_BCM5755 0xbc050cc0
|
|
+#define PHY_ID_BCM5750_2 0xbc050cd0
|
|
#define PHY_ID_BCM5787 0xbc050ce0
|
|
#define PHY_ID_BCM5756 0xbc050ed0
|
|
#define PHY_ID_BCM5784 0xbc050fa0
|
|
@@ -2868,7 +2872,7 @@ struct tg3 {
|
|
(X) == PHY_ID_BCM5780 || (X) == PHY_ID_BCM5787 || \
|
|
(X) == PHY_ID_BCM5755 || (X) == PHY_ID_BCM5756 || \
|
|
(X) == PHY_ID_BCM5906 || (X) == PHY_ID_BCM5761 || \
|
|
- (X) == PHY_ID_BCM8002)
|
|
+ (X) == PHY_ID_BCM8002 || (X) == PHY_ID_BCM5750_2)
|
|
|
|
struct tg3_hw_stats *hw_stats;
|
|
dma_addr_t stats_mapping;
|