| 1 | --- a/drivers/net/tg3.c |
| 2 | +++ b/drivers/net/tg3.c |
| 3 | @@ -43,6 +43,7 @@ |
| 4 | #include <linux/prefetch.h> |
| 5 | #include <linux/dma-mapping.h> |
| 6 | #include <linux/firmware.h> |
| 7 | +#include <linux/ssb/ssb_driver_gige.h> |
| 8 | |
| 9 | #include <net/checksum.h> |
| 10 | #include <net/ip.h> |
| 11 | @@ -515,7 +516,8 @@ static void _tw32_flush(struct tg3 *tp, |
| 12 | static inline void tw32_mailbox_flush(struct tg3 *tp, u32 off, u32 val) |
| 13 | { |
| 14 | tp->write32_mbox(tp, off, val); |
| 15 | - if (!tg3_flag(tp, MBOX_WRITE_REORDER) && !tg3_flag(tp, ICH_WORKAROUND)) |
| 16 | + if (tg3_flag(tp, FLUSH_POSTED_WRITES) || |
| 17 | + (!tg3_flag(tp, MBOX_WRITE_REORDER) && !tg3_flag(tp, ICH_WORKAROUND))) |
| 18 | tp->read32_mbox(tp, off); |
| 19 | } |
| 20 | |
| 21 | @@ -525,7 +527,7 @@ static void tg3_write32_tx_mbox(struct t |
| 22 | writel(val, mbox); |
| 23 | if (tg3_flag(tp, TXD_MBOX_HWBUG)) |
| 24 | writel(val, mbox); |
| 25 | - if (tg3_flag(tp, MBOX_WRITE_REORDER)) |
| 26 | + if (tg3_flag(tp, MBOX_WRITE_REORDER) || tg3_flag(tp, FLUSH_POSTED_WRITES)) |
| 27 | readl(mbox); |
| 28 | } |
| 29 | |
| 30 | @@ -804,7 +806,7 @@ static void tg3_switch_clocks(struct tg3 |
| 31 | |
| 32 | #define PHY_BUSY_LOOPS 5000 |
| 33 | |
| 34 | -static int tg3_readphy(struct tg3 *tp, int reg, u32 *val) |
| 35 | +static int __tg3_readphy(struct tg3 *tp, unsigned int phy_addr, int reg, u32 *val) |
| 36 | { |
| 37 | u32 frame_val; |
| 38 | unsigned int loops; |
| 39 | @@ -818,7 +820,7 @@ static int tg3_readphy(struct tg3 *tp, i |
| 40 | |
| 41 | *val = 0x0; |
| 42 | |
| 43 | - frame_val = ((tp->phy_addr << MI_COM_PHY_ADDR_SHIFT) & |
| 44 | + frame_val = ((phy_addr << MI_COM_PHY_ADDR_SHIFT) & |
| 45 | MI_COM_PHY_ADDR_MASK); |
| 46 | frame_val |= ((reg << MI_COM_REG_ADDR_SHIFT) & |
| 47 | MI_COM_REG_ADDR_MASK); |
| 48 | @@ -853,7 +855,12 @@ static int tg3_readphy(struct tg3 *tp, i |
| 49 | return ret; |
| 50 | } |
| 51 | |
| 52 | -static int tg3_writephy(struct tg3 *tp, int reg, u32 val) |
| 53 | +static int tg3_readphy(struct tg3 *tp, int reg, u32 *val) |
| 54 | +{ |
| 55 | + return __tg3_readphy(tp, tp->phy_addr, reg, val); |
| 56 | +} |
| 57 | + |
| 58 | +static int __tg3_writephy(struct tg3 *tp, unsigned int phy_addr, int reg, u32 val) |
| 59 | { |
| 60 | u32 frame_val; |
| 61 | unsigned int loops; |
| 62 | @@ -869,7 +876,7 @@ static int tg3_writephy(struct tg3 *tp, |
| 63 | udelay(80); |
| 64 | } |
| 65 | |
| 66 | - frame_val = ((tp->phy_addr << MI_COM_PHY_ADDR_SHIFT) & |
| 67 | + frame_val = ((phy_addr << MI_COM_PHY_ADDR_SHIFT) & |
| 68 | MI_COM_PHY_ADDR_MASK); |
| 69 | frame_val |= ((reg << MI_COM_REG_ADDR_SHIFT) & |
| 70 | MI_COM_REG_ADDR_MASK); |
| 71 | @@ -902,6 +909,11 @@ static int tg3_writephy(struct tg3 *tp, |
| 72 | return ret; |
| 73 | } |
| 74 | |
| 75 | +static int tg3_writephy(struct tg3 *tp, int reg, u32 val) |
| 76 | +{ |
| 77 | + return __tg3_writephy(tp, tp->phy_addr, reg, val); |
| 78 | +} |
| 79 | + |
| 80 | static int tg3_phy_cl45_write(struct tg3 *tp, u32 devad, u32 addr, u32 val) |
| 81 | { |
| 82 | int err; |
| 83 | @@ -2532,6 +2544,9 @@ static int tg3_nvram_read(struct tg3 *tp |
| 84 | { |
| 85 | int ret; |
| 86 | |
| 87 | + if (tg3_flag(tp, IS_SSB_CORE)) |
| 88 | + return -ENODEV; |
| 89 | + |
| 90 | if (!tg3_flag(tp, NVRAM)) |
| 91 | return tg3_nvram_read_using_eeprom(tp, offset, val); |
| 92 | |
| 93 | @@ -2855,8 +2870,10 @@ static int tg3_power_down_prepare(struct |
| 94 | tg3_frob_aux_power(tp); |
| 95 | |
| 96 | /* Workaround for unstable PLL clock */ |
| 97 | - if ((GET_CHIP_REV(tp->pci_chip_rev_id) == CHIPREV_5750_AX) || |
| 98 | - (GET_CHIP_REV(tp->pci_chip_rev_id) == CHIPREV_5750_BX)) { |
| 99 | + if ((tp->phy_id & TG3_PHY_ID_MASK) != TG3_PHY_ID_BCM5750_2 && |
| 100 | + /* !!! FIXME !!! */ |
| 101 | + ((GET_CHIP_REV(tp->pci_chip_rev_id) == CHIPREV_5750_AX) || |
| 102 | + (GET_CHIP_REV(tp->pci_chip_rev_id) == CHIPREV_5750_BX))) { |
| 103 | u32 val = tr32(0x7d00); |
| 104 | |
| 105 | val &= ~((1 << 16) | (1 << 4) | (1 << 2) | (1 << 1) | 1); |
| 106 | @@ -3377,6 +3394,14 @@ relink: |
| 107 | if (current_link_up == 0 || (tp->phy_flags & TG3_PHYFLG_IS_LOW_POWER)) { |
| 108 | tg3_phy_copper_begin(tp); |
| 109 | |
| 110 | + if (tg3_flag(tp, ROBOSWITCH)) { |
| 111 | + current_link_up = 1; |
| 112 | + current_speed = SPEED_1000; /* FIXME */ |
| 113 | + current_duplex = DUPLEX_FULL; |
| 114 | + tp->link_config.active_speed = current_speed; |
| 115 | + tp->link_config.active_duplex = current_duplex; |
| 116 | + } |
| 117 | + |
| 118 | tg3_readphy(tp, MII_BMSR, &bmsr); |
| 119 | if ((!tg3_readphy(tp, MII_BMSR, &bmsr) && (bmsr & BMSR_LSTATUS)) || |
| 120 | (tp->mac_mode & MAC_MODE_PORT_INT_LPBACK)) |
| 121 | @@ -6962,6 +6987,11 @@ static int tg3_poll_fw(struct tg3 *tp) |
| 122 | int i; |
| 123 | u32 val; |
| 124 | |
| 125 | + if (tg3_flag(tp, IS_SSB_CORE)) { |
| 126 | + /* We don't use firmware. */ |
| 127 | + return 0; |
| 128 | + } |
| 129 | + |
| 130 | if (GET_ASIC_REV(tp->pci_chip_rev_id) == ASIC_REV_5906) { |
| 131 | /* Wait up to 20ms for init done. */ |
| 132 | for (i = 0; i < 200; i++) { |
| 133 | @@ -7251,6 +7281,14 @@ static int tg3_chip_reset(struct tg3 *tp |
| 134 | tw32(0x5000, 0x400); |
| 135 | } |
| 136 | |
| 137 | + if (tg3_flag(tp, IS_SSB_CORE)) { |
| 138 | + /* BCM4785: In order to avoid repercussions from using potentially |
| 139 | + * defective internal ROM, stop the Rx RISC CPU, which is not |
| 140 | + * required. */ |
| 141 | + tg3_stop_fw(tp); |
| 142 | + tg3_halt_cpu(tp, RX_CPU_BASE); |
| 143 | + } |
| 144 | + |
| 145 | tw32(GRC_MODE, tp->grc_mode); |
| 146 | |
| 147 | if (tp->pci_chip_rev_id == CHIPREV_ID_5705_A0) { |
| 148 | @@ -7403,9 +7441,12 @@ static int tg3_halt_cpu(struct tg3 *tp, |
| 149 | return -ENODEV; |
| 150 | } |
| 151 | |
| 152 | - /* Clear firmware's nvram arbitration. */ |
| 153 | - if (tg3_flag(tp, NVRAM)) |
| 154 | - tw32(NVRAM_SWARB, SWARB_REQ_CLR0); |
| 155 | + if (!tg3_flag(tp, IS_SSB_CORE)) { |
| 156 | + /* Clear firmware's nvram arbitration. */ |
| 157 | + if (tg3_flag(tp, NVRAM)) |
| 158 | + tw32(NVRAM_SWARB, SWARB_REQ_CLR0); |
| 159 | + } |
| 160 | + |
| 161 | return 0; |
| 162 | } |
| 163 | |
| 164 | @@ -7467,6 +7508,11 @@ static int tg3_load_5701_a0_firmware_fix |
| 165 | const __be32 *fw_data; |
| 166 | int err, i; |
| 167 | |
| 168 | + if (tg3_flag(tp, IS_SSB_CORE)) { |
| 169 | + /* We don't use firmware. */ |
| 170 | + return 0; |
| 171 | + } |
| 172 | + |
| 173 | fw_data = (void *)tp->fw->data; |
| 174 | |
| 175 | /* Firmware blob starts with version numbers, followed by |
| 176 | @@ -7523,6 +7569,11 @@ static int tg3_load_tso_firmware(struct |
| 177 | unsigned long cpu_base, cpu_scratch_base, cpu_scratch_size; |
| 178 | int err, i; |
| 179 | |
| 180 | + if (tg3_flag(tp, IS_SSB_CORE)) { |
| 181 | + /* We don't use firmware. */ |
| 182 | + return 0; |
| 183 | + } |
| 184 | + |
| 185 | if (tg3_flag(tp, HW_TSO_1) || |
| 186 | tg3_flag(tp, HW_TSO_2) || |
| 187 | tg3_flag(tp, HW_TSO_3)) |
| 188 | @@ -8819,6 +8870,11 @@ static void tg3_timer(unsigned long __op |
| 189 | |
| 190 | spin_lock(&tp->lock); |
| 191 | |
| 192 | + if (tg3_flag(tp, FLUSH_POSTED_WRITES)) { |
| 193 | + /* BCM4785: Flush posted writes from GbE to host memory. */ |
| 194 | + tr32(HOSTCC_MODE); |
| 195 | + } |
| 196 | + |
| 197 | if (!tg3_flag(tp, TAGGED_STATUS)) { |
| 198 | /* All of this garbage is because when using non-tagged |
| 199 | * IRQ status the mailbox/status_block protocol the chip |
| 200 | @@ -10446,6 +10502,11 @@ static int tg3_test_nvram(struct tg3 *tp |
| 201 | if (tg3_flag(tp, NO_NVRAM)) |
| 202 | return 0; |
| 203 | |
| 204 | + if (tg3_flag(tp, IS_SSB_CORE)) { |
| 205 | + /* We don't have NVRAM. */ |
| 206 | + return 0; |
| 207 | + } |
| 208 | + |
| 209 | if (tg3_nvram_read(tp, 0, &magic) != 0) |
| 210 | return -EIO; |
| 211 | |
| 212 | @@ -11440,7 +11501,7 @@ static int tg3_ioctl(struct net_device * |
| 213 | return -EAGAIN; |
| 214 | |
| 215 | spin_lock_bh(&tp->lock); |
| 216 | - err = tg3_readphy(tp, data->reg_num & 0x1f, &mii_regval); |
| 217 | + err = __tg3_readphy(tp, data->phy_id & 0x1f, data->reg_num & 0x1f, &mii_regval); |
| 218 | spin_unlock_bh(&tp->lock); |
| 219 | |
| 220 | data->val_out = mii_regval; |
| 221 | @@ -11456,7 +11517,7 @@ static int tg3_ioctl(struct net_device * |
| 222 | return -EAGAIN; |
| 223 | |
| 224 | spin_lock_bh(&tp->lock); |
| 225 | - err = tg3_writephy(tp, data->reg_num & 0x1f, data->val_in); |
| 226 | + err = __tg3_writephy(tp, data->phy_id & 0x1f, data->reg_num & 0x1f, data->val_in); |
| 227 | spin_unlock_bh(&tp->lock); |
| 228 | |
| 229 | return err; |
| 230 | @@ -12186,6 +12247,13 @@ static void __devinit tg3_get_5720_nvram |
| 231 | /* Chips other than 5700/5701 use the NVRAM for fetching info. */ |
| 232 | static void __devinit tg3_nvram_init(struct tg3 *tp) |
| 233 | { |
| 234 | + if (tg3_flag(tp, IS_SSB_CORE)) { |
| 235 | + /* No NVRAM and EEPROM on the SSB Broadcom GigE core. */ |
| 236 | + tg3_flag_clear(tp, NVRAM); |
| 237 | + tg3_flag_clear(tp, NVRAM_BUFFERED); |
| 238 | + return; |
| 239 | + } |
| 240 | + |
| 241 | tw32_f(GRC_EEPROM_ADDR, |
| 242 | (EEPROM_ADDR_FSM_RESET | |
| 243 | (EEPROM_DEFAULT_CLOCK_PERIOD << |
| 244 | @@ -12452,6 +12520,9 @@ static int tg3_nvram_write_block(struct |
| 245 | { |
| 246 | int ret; |
| 247 | |
| 248 | + if (tg3_flag(tp, IS_SSB_CORE)) |
| 249 | + return -ENODEV; |
| 250 | + |
| 251 | if (tg3_flag(tp, EEPROM_WRITE_PROT)) { |
| 252 | tw32_f(GRC_LOCAL_CTRL, tp->grc_local_ctrl & |
| 253 | ~GRC_LCLCTRL_GPIO_OUTPUT1); |
| 254 | @@ -13863,6 +13934,11 @@ static int __devinit tg3_get_invariants( |
| 255 | GET_ASIC_REV(tp->pci_chip_rev_id) == ASIC_REV_5701))) |
| 256 | tg3_flag_set(tp, SRAM_USE_CONFIG); |
| 257 | |
| 258 | + if (tg3_flag(tp, FLUSH_POSTED_WRITES)) { |
| 259 | + tp->write32_tx_mbox = tg3_write_flush_reg32; |
| 260 | + tp->write32_rx_mbox = tg3_write_flush_reg32; |
| 261 | + } |
| 262 | + |
| 263 | /* Get eeprom hw config before calling tg3_set_power_state(). |
| 264 | * In particular, the TG3_FLAG_IS_NIC flag must be |
| 265 | * determined before calling tg3_set_power_state() so that |
| 266 | @@ -14274,6 +14350,8 @@ static int __devinit tg3_get_device_addr |
| 267 | } |
| 268 | |
| 269 | if (!is_valid_ether_addr(&dev->dev_addr[0])) { |
| 270 | + if (tg3_flag(tp, IS_SSB_CORE)) |
| 271 | + ssb_gige_get_macaddr(tp->pdev, &dev->dev_addr[0]); |
| 272 | #ifdef CONFIG_SPARC |
| 273 | if (!tg3_get_default_macaddr_sparc(tp)) |
| 274 | return 0; |
| 275 | @@ -14772,6 +14850,7 @@ static char * __devinit tg3_phy_string(s |
| 276 | case TG3_PHY_ID_BCM5704: return "5704"; |
| 277 | case TG3_PHY_ID_BCM5705: return "5705"; |
| 278 | case TG3_PHY_ID_BCM5750: return "5750"; |
| 279 | + case TG3_PHY_ID_BCM5750_2: return "5750-2"; |
| 280 | case TG3_PHY_ID_BCM5752: return "5752"; |
| 281 | case TG3_PHY_ID_BCM5714: return "5714"; |
| 282 | case TG3_PHY_ID_BCM5780: return "5780"; |
| 283 | @@ -14961,6 +15040,13 @@ static int __devinit tg3_init_one(struct |
| 284 | tp->msg_enable = tg3_debug; |
| 285 | else |
| 286 | tp->msg_enable = TG3_DEF_MSG_ENABLE; |
| 287 | + if (pdev_is_ssb_gige_core(pdev)) { |
| 288 | + tg3_flag_set(tp, IS_SSB_CORE); |
| 289 | + if (ssb_gige_must_flush_posted_writes(pdev)) |
| 290 | + tg3_flag_set(tp, FLUSH_POSTED_WRITES); |
| 291 | + if (ssb_gige_have_roboswitch(pdev)) |
| 292 | + tg3_flag_set(tp, ROBOSWITCH); |
| 293 | + } |
| 294 | |
| 295 | /* The word/byte swap controls here control register access byte |
| 296 | * swapping. DMA data byte swapping is controlled in the GRC_MODE |
| 297 | --- a/drivers/net/tg3.h |
| 298 | +++ b/drivers/net/tg3.h |
| 299 | @@ -2901,6 +2901,9 @@ enum TG3_FLAGS { |
| 300 | TG3_FLAG_57765_PLUS, |
| 301 | TG3_FLAG_APE_HAS_NCSI, |
| 302 | TG3_FLAG_5717_PLUS, |
| 303 | + TG3_FLAG_IS_SSB_CORE, |
| 304 | + TG3_FLAG_FLUSH_POSTED_WRITES, |
| 305 | + TG3_FLAG_ROBOSWITCH, |
| 306 | |
| 307 | /* Add new flags before this comment and TG3_FLAG_NUMBER_OF_FLAGS */ |
| 308 | TG3_FLAG_NUMBER_OF_FLAGS, /* Last entry in enum TG3_FLAGS */ |
| 309 | @@ -3051,6 +3054,7 @@ struct tg3 { |
| 310 | #define TG3_PHY_ID_BCM5704 0x60008190 |
| 311 | #define TG3_PHY_ID_BCM5705 0x600081a0 |
| 312 | #define TG3_PHY_ID_BCM5750 0x60008180 |
| 313 | +#define TG3_PHY_ID_BCM5750_2 0xbc050cd0 |
| 314 | #define TG3_PHY_ID_BCM5752 0x60008100 |
| 315 | #define TG3_PHY_ID_BCM5714 0x60008340 |
| 316 | #define TG3_PHY_ID_BCM5780 0x60008350 |
| 317 | @@ -3088,7 +3092,7 @@ struct tg3 { |
| 318 | (X) == TG3_PHY_ID_BCM5906 || (X) == TG3_PHY_ID_BCM5761 || \ |
| 319 | (X) == TG3_PHY_ID_BCM5718C || (X) == TG3_PHY_ID_BCM5718S || \ |
| 320 | (X) == TG3_PHY_ID_BCM57765 || (X) == TG3_PHY_ID_BCM5719C || \ |
| 321 | - (X) == TG3_PHY_ID_BCM8002) |
| 322 | + (X) == TG3_PHY_ID_BCM8002 || (X) == TG3_PHY_ID_BCM5750_2) |
| 323 | |
| 324 | u32 phy_flags; |
| 325 | #define TG3_PHYFLG_IS_LOW_POWER 0x00000001 |
| 326 | |
