Consolidate all code taking care on CSR offset differences for i210
chips into a single place in the driver and integrate that funcionality
into e1000_{read,write}_reg functions. This way we can get rid of all
those

    if (hw->mac_type == e1000_igb) {
       ....
    } else {
       ....
    }

snippets sprinkled all across the driver code.

Signed-off-by: Andrey Smirnov <[email protected]>
---
 drivers/net/e1000/e1000.h  | 11 ++++++++---
 drivers/net/e1000/eeprom.c | 10 +++-------
 drivers/net/e1000/main.c   | 17 +++++------------
 drivers/net/e1000/regio.c  | 25 +++++++++++++++++++++++++
 4 files changed, 41 insertions(+), 22 deletions(-)

diff --git a/drivers/net/e1000/e1000.h b/drivers/net/e1000/e1000.h
index d75c707..1d0b3c6 100644
--- a/drivers/net/e1000/e1000.h
+++ b/drivers/net/e1000/e1000.h
@@ -389,6 +389,11 @@ struct e1000_tx_desc {
 #define E1000_MC_TBL_SIZE         128  /* Multicast Filter Table (4096 bits) */
 #define E1000_VLAN_FILTER_TBL_SIZE 128 /* VLAN Filter Table (4096 bits) */
 
+#define E1000_MIGHT_BE_REMAPPED 0x80000000  /* Flag indicating that on
+                                              some variants of the chip
+                                              register offset might be
+                                              different */
+
 /* Register Set. (82543, 82544)
  *
  * Registers are defined to be 32 bits and  should be accessed as 32 bit 
values.
@@ -429,17 +434,17 @@ struct e1000_tx_desc {
 #define E1000_LEDCTL   0x00E00 /* LED Control - RW */
 #define E1000_EXTCNF_CTRL  0x00F00  /* Extended Configuration Control */
 #define E1000_EXTCNF_SIZE  0x00F08  /* Extended Configuration Size */
-#define E1000_PHY_CTRL     0x00F10  /* PHY Control Register in CSR */
+#define E1000_PHY_CTRL     (E1000_MIGHT_BE_REMAPPED | 0x00F10)  /* PHY Control 
Register in CSR */
 #define E1000_I210_PHY_CTRL     0x00E14  /* PHY Control Register in CSR */
 #define FEXTNVM_SW_CONFIG  0x0001
 #define E1000_PBA      0x01000 /* Packet Buffer Allocation - RW */
 #define E1000_PBS      0x01008  /* Packet Buffer Size */
-#define E1000_EEMNGCTL 0x01010  /* MNG EEprom Control */
+#define E1000_EEMNGCTL (E1000_MIGHT_BE_REMAPPED | 0x01010)  /* MNG EEprom 
Control */
 #define E1000_I210_EEMNGCTL 0x12030  /* MNG EEprom Control */
 #define E1000_FLASH_UPDATES 1000
 #define E1000_EEARBC   0x01024  /* EEPROM Auto Read Bus Control */
 #define E1000_FLASHT   0x01028  /* FLASH Timer Register */
-#define E1000_EEWR     0x0102C  /* EEPROM Write Register - RW */
+#define E1000_EEWR     (E1000_MIGHT_BE_REMAPPED | 0x0102C)  /* EEPROM Write 
Register - RW */
 #define E1000_I210_EEWR     0x12018  /* EEPROM Write Register - RW */
 #define E1000_FLSWCTL  0x01030  /* FLASH control register */
 #define E1000_FLSWDATA 0x01034  /* FLASH data register */
diff --git a/drivers/net/e1000/eeprom.c b/drivers/net/e1000/eeprom.c
index 497fb7b..c2dfad5 100644
--- a/drivers/net/e1000/eeprom.c
+++ b/drivers/net/e1000/eeprom.c
@@ -451,14 +451,10 @@ static int32_t e1000_poll_eerd_eewr_done(struct e1000_hw 
*hw, int eerd)
        int32_t done = E1000_ERR_EEPROM;
 
        for (i = 0; i < attempts; i++) {
-               if (eerd == E1000_EEPROM_POLL_READ) {
+               if (eerd == E1000_EEPROM_POLL_READ)
                        reg = e1000_read_reg(hw, E1000_EERD);
-               } else {
-                       if (hw->mac_type == e1000_igb)
-                               reg = e1000_read_reg(hw, E1000_I210_EEWR);
-                       else
-                               reg = e1000_read_reg(hw, E1000_EEWR);
-               }
+               else
+                       reg = e1000_read_reg(hw, E1000_EEWR);
 
                if (reg & E1000_EEPROM_RW_REG_DONE) {
                        done = E1000_SUCCESS;
diff --git a/drivers/net/e1000/main.c b/drivers/net/e1000/main.c
index f1055ea..4a527a3 100644
--- a/drivers/net/e1000/main.c
+++ b/drivers/net/e1000/main.c
@@ -1184,14 +1184,11 @@ static int32_t e1000_set_d0_lplu_state_off(struct 
e1000_hw *hw)
        if (hw->mac_type <= e1000_82547_rev_2)
                return E1000_SUCCESS;
 
-       if (hw->mac_type == e1000_ich8lan) {
+       if (hw->mac_type == e1000_ich8lan ||
+           hw->mac_type == e1000_igb) {
                phy_ctrl = e1000_read_reg(hw, E1000_PHY_CTRL);
                phy_ctrl &= ~E1000_PHY_CTRL_D0A_LPLU;
                e1000_write_reg(hw, E1000_PHY_CTRL, phy_ctrl);
-       } else if (hw->mac_type == e1000_igb) {
-               phy_ctrl = e1000_read_reg(hw, E1000_I210_PHY_CTRL);
-               phy_ctrl &= ~E1000_PHY_CTRL_D0A_LPLU;
-               e1000_write_reg(hw, E1000_I210_PHY_CTRL, phy_ctrl);
        } else {
                ret_val = e1000_read_phy_reg(hw, IGP02E1000_PHY_POWER_MGMT,
                                &phy_data);
@@ -2745,13 +2742,9 @@ static int32_t e1000_get_phy_cfg_done(struct e1000_hw 
*hw)
        case e1000_82572:
        case e1000_igb:
                while (timeout) {
-                       if (hw->mac_type == e1000_igb) {
-                               if (e1000_read_reg(hw, E1000_I210_EEMNGCTL) & 
cfg_mask)
-                                       break;
-                       } else {
-                               if (e1000_read_reg(hw, E1000_EEMNGCTL) & 
cfg_mask)
-                                       break;
-                       }
+                       if (e1000_read_reg(hw, E1000_EEMNGCTL) & cfg_mask)
+                               break;
+
                        mdelay(1);
                        timeout--;
                }
diff --git a/drivers/net/e1000/regio.c b/drivers/net/e1000/regio.c
index 8c529f1..4970084 100644
--- a/drivers/net/e1000/regio.c
+++ b/drivers/net/e1000/regio.c
@@ -2,13 +2,38 @@
 
 #include "e1000.h"
 
+static uint32_t e1000_true_offset(struct e1000_hw *hw, uint32_t reg)
+{
+       if (reg & E1000_MIGHT_BE_REMAPPED) {
+               reg &= ~E1000_MIGHT_BE_REMAPPED;
+
+               if (hw->mac_type == e1000_igb) {
+                       switch (reg) {
+                       case E1000_EEWR:
+                               reg = E1000_I210_EEWR;
+                               break;
+                       case E1000_PHY_CTRL:
+                               reg = E1000_I210_PHY_CTRL;
+                               break;
+                       case E1000_EEMNGCTL:
+                               reg = E1000_I210_EEMNGCTL;
+                               break;
+                       }
+               };
+       }
+
+       return reg;
+}
+
 void e1000_write_reg(struct e1000_hw *hw, uint32_t reg, uint32_t value)
 {
+       reg = e1000_true_offset(hw, reg);
        writel(value, hw->hw_addr + reg);
 }
 
 uint32_t e1000_read_reg(struct e1000_hw *hw, uint32_t reg)
 {
+       reg = e1000_true_offset(hw, reg);
        return readl(hw->hw_addr + reg);
 }
 
-- 
2.5.5


_______________________________________________
barebox mailing list
[email protected]
http://lists.infradead.org/mailman/listinfo/barebox

Reply via email to