cm-t54: add EEPROM support and MAC address handling

cm-t54 Eth MAC address is stored in onboard EEPROM.
Add EEPROM support and setup stored Eth MAC address.

If EEPROM does not contain a valid MAC, then generate it from the
processor ID code (reference code is taken from OMAP5 uEvm board file).

Modify Device Tree blob MAC address field with retrieved data.

Signed-off-by: Dmitry Lifshitz <lifshitz@compulab.co.il>
Acked-by: Igor Grinberg <grinberg@compulab.co.il>

diff --git a/board/compulab/cm_t54/cm_t54.c b/board/compulab/cm_t54/cm_t54.c
index e0df47e72ba231367b0f6880c0c4e1eb0c9fb6d5..6b18b93e91dec9bfe2fd2bad0835490dae7b0372 100644 (file)
--- a/board/compulab/cm_t54/cm_t54.c
+++ b/board/compulab/cm_t54/cm_t54.c
@@ -9,6 +9,7 @@
  */
 
 #include <common.h>
+#include <fdt_support.h>
 #include <usb.h>
 #include <mmc.h>
 #include <palmas.h>
@@ -20,6 +21,8 @@
 #include <asm/arch/ehci.h>
 #include <asm/ehci-omap.h>
 
+#include "../common/eeprom.h"
+
 #define DIE_ID_REG_BASE                (OMAP54XX_L4_CORE_BASE + 0x2000)
 #define DIE_ID_REG_OFFSET      0x200
 
@@ -99,6 +102,66 @@ int board_mmc_init(bd_t *bis)
 }
 #endif
 
+#ifdef CONFIG_USB_HOST_ETHER
+
+void ft_board_setup(void *blob, bd_t *bd)
+{
+       uint8_t enetaddr[6];
+
+       /* MAC addr */
+       if (eth_getenv_enetaddr("usbethaddr", enetaddr)) {
+               fdt_find_and_setprop(blob, "/smsc95xx@0", "mac-address",
+                                    enetaddr, 6, 1);
+       }
+}
+
+static void generate_mac_addr(uint8_t *enetaddr)
+{
+       int reg;
+
+       reg = DIE_ID_REG_BASE + DIE_ID_REG_OFFSET;
+
+       /*
+        * create a fake MAC address from the processor ID code.
+        * first byte is 0x02 to signify locally administered.
+        */
+       enetaddr[0] = 0x02;
+       enetaddr[1] = readl(reg + 0x10) & 0xff;
+       enetaddr[2] = readl(reg + 0xC) & 0xff;
+       enetaddr[3] = readl(reg + 0x8) & 0xff;
+       enetaddr[4] = readl(reg) & 0xff;
+       enetaddr[5] = (readl(reg) >> 8) & 0xff;
+}
+
+/*
+ * Routine: handle_mac_address
+ * Description: prepare MAC address for on-board Ethernet.
+ */
+static int handle_mac_address(void)
+{
+       uint8_t enetaddr[6];
+       int ret;
+
+       ret = eth_getenv_enetaddr("usbethaddr", enetaddr);
+       if (ret)
+               return 0;
+
+       ret = cl_eeprom_read_mac_addr(enetaddr);
+       if (!ret || !is_valid_ether_addr(enetaddr))
+               generate_mac_addr(enetaddr);
+
+       if (!is_valid_ether_addr(enetaddr))
+               return -1;
+
+       return eth_setenv_enetaddr("usbethaddr", enetaddr);
+}
+
+int board_eth_init(bd_t *bis)
+{
+       return handle_mac_address();
+}
+#endif
+
 #ifdef CONFIG_USB_EHCI
 static struct omap_usbhs_board_data usbhs_bdata = {
        .port_mode[0] = OMAP_USBHS_PORT_MODE_UNUSED,

diff --git a/include/configs/cm_t54.h b/include/configs/cm_t54.h
index 4dcac4004ec2c4505a153291fe38c45ffb6d397b..5e805c401930bd9890e9f9fffd67c607d1178fba 100644 (file)
--- a/include/configs/cm_t54.h
+++ b/include/configs/cm_t54.h
@@ -19,6 +19,15 @@
 #undef CONFIG_MISC_INIT_R
 #undef CONFIG_SPL_OS_BOOT
 
+/* Device Tree defines */
+#define CONFIG_OF_LIBFDT
+#define CONFIG_OF_BOARD_SETUP
+
+/* EEPROM related defines */
+#define CONFIG_SYS_I2C_OMAP34XX
+#define CONFIG_SYS_I2C_EEPROM_ADDR     0x50
+#define CONFIG_SYS_I2C_EEPROM_ADDR_LEN 1
+
 /* Enable SD/MMC CD and WP GPIOs */
 #define OMAP_HSMMC_USE_GPIO