board: ge: bx50v3: move FEC MAC address programming to driver

[u-boot] / board / ge / bx50v3 / bx50v3.c

diff --git a/board/ge/bx50v3/bx50v3.c b/board/ge/bx50v3/bx50v3.c
index cb4deb04340623218127dcfd1c113ea78984727c..0468dcfa8e265e113f7c7d78f63c762e8b80f5a0 100644 (file)
--- a/board/ge/bx50v3/bx50v3.c
+++ b/board/ge/bx50v3/bx50v3.c
@@ -19,6 +19,7 @@
 #include <mmc.h>
 #include <fsl_esdhc.h>
 #include <miiphy.h>
+#include <net.h>
 #include <netdev.h>
 #include <asm/arch/mxc_hdmi.h>
 #include <asm/arch/crm_regs.h>
@@ -546,63 +547,54 @@ int overwrite_console(void)
 #define VPD_PRODUCT_B850 1
 #define VPD_PRODUCT_B650 2
 #define VPD_PRODUCT_B450 3
+#define VPD_HAS_MAC1 0x1
+#define VPD_MAC_ADDRESS_LENGTH 6
 
 struct vpd_cache {
-       uint8_t product_id;
-       uint8_t macbits;
-       unsigned char mac1[6];
+       u8 product_id;
+       u8 has;
+       unsigned char mac1[VPD_MAC_ADDRESS_LENGTH];
 };
 
 /*
  * Extracts MAC and product information from the VPD.
  */
-static int vpd_callback(
-       void *userdata,
-       uint8_t id,
-       uint8_t version,
-       uint8_t type,
-       size_t size,
-       uint8_t const *data)
+static int vpd_callback(void *userdata, u8 id, u8 version, u8 type,
+                       size_t size, u8 const *data)
 {
        struct vpd_cache *vpd = (struct vpd_cache *)userdata;
 
-       if (   id == VPD_BLOCK_HWID
-           && version == 1
-           && type != VPD_TYPE_INVALID
-           && size >= 1) {
+       if (id == VPD_BLOCK_HWID && version == 1 && type != VPD_TYPE_INVALID &&
+           size >= 1) {
                vpd->product_id = data[0];
-
-       } else if (   id == VPD_BLOCK_NETWORK
-                  && version == 1
-                  && type != VPD_TYPE_INVALID
-                  && size >= 6) {
-               vpd->macbits |= 1;
-               memcpy(vpd->mac1, data, 6);
+       } else if (id == VPD_BLOCK_NETWORK && version == 1 &&
+                  type != VPD_TYPE_INVALID) {
+               if (size >= 6) {
+                       vpd->has |= VPD_HAS_MAC1;
+                       memcpy(vpd->mac1, data, VPD_MAC_ADDRESS_LENGTH);
+               }
        }
 
        return 0;
 }
 
-static void set_eth0_mac_address(unsigned char * mac)
-{
-       uint32_t *ENET_TCR = (uint32_t*)0x21880c4;
-       uint32_t *ENET_PALR = (uint32_t*)0x21880e4;
-       uint32_t *ENET_PAUR = (uint32_t*)0x21880e8;
-
-       *ENET_TCR |= 0x100;  /* ADDINS */
-       *ENET_PALR |= (mac[0] << 24) | (mac[1] << 16) | (mac[2] << 8) | mac[3];
-       *ENET_PAUR |= (mac[4] << 24) | (mac[5] << 16);
-}
-
 static void process_vpd(struct vpd_cache *vpd)
 {
-       if (   vpd->product_id == VPD_PRODUCT_B850
-           || vpd->product_id == VPD_PRODUCT_B650
-           || vpd->product_id == VPD_PRODUCT_B450) {
-               if (vpd->macbits & 1) {
-                       set_eth0_mac_address(vpd->mac1);
-               }
+       int fec_index = -1;
+
+       switch (vpd->product_id) {
+       case VPD_PRODUCT_B450:
+               /* fall thru */
+       case VPD_PRODUCT_B650:
+               fec_index = 1;
+               break;
+       case VPD_PRODUCT_B850:
+               fec_index = 2;
+               break;
        }
+
+       if (fec_index >= 0 && (vpd->has & VPD_HAS_MAC1))
+               eth_env_set_enetaddr_by_index("eth", fec_index, vpd->mac1);
 }
 
 static int read_vpd(uint eeprom_bus)
@@ -694,8 +686,6 @@ int board_init(void)
        setup_i2c(2, CONFIG_SYS_I2C_SPEED, 0x7f, &i2c_pad_info2);
        setup_i2c(3, CONFIG_SYS_I2C_SPEED, 0x7f, &i2c_pad_info3);
 
-       read_vpd(CONFIG_SYS_I2C_EEPROM_BUS);
-
        return 0;
 }
 
@@ -761,6 +751,8 @@ void pmic_init(void)
 
 int board_late_init(void)
 {
+       read_vpd(CONFIG_SYS_I2C_EEPROM_BUS);
+
 #ifdef CONFIG_CMD_BMODE
        add_board_boot_modes(board_boot_modes);
 #endif
@@ -788,6 +780,13 @@ int board_late_init(void)
        return 0;
 }
 
+int last_stage_init(void)
+{
+       env_set("ethaddr", NULL);
+
+       return 0;
+}
+
 int checkboard(void)
 {
        printf("BOARD: %s\n", CONFIG_BOARD_NAME);