[PATCH 2/2] ARM: mxs: TX28: Setup MAC addresses for both FEC MACs from OTP fuses.

[LW@KARO-electronics.de (Lothar Waßmann)]

Signed-off-by: Lothar Wa?mann <LW@KARO-electronics.de>
---
 arch/arm/mach-mxs/module-tx28.c |   39 +++++++++++++++++++++++++++++++++++++++
 1 files changed, 39 insertions(+), 0 deletions(-)

diff --git a/arch/arm/mach-mxs/module-tx28.c b/arch/arm/mach-mxs/module-tx28.c
index 7d44936..7a9e7b6 100644
--- a/arch/arm/mach-mxs/module-tx28.c
+++ b/arch/arm/mach-mxs/module-tx28.c
@@ -74,6 +74,43 @@ static struct fec_platform_data tx28_fec1_data = {
 	.phy = PHY_INTERFACE_MODE_RMII,
 };
 
+#define HW_OCOTP_CUST0			0x20
+#define HW_OCOTP_CUST(n)		(HW_OCOTP_CUST0 + (n) * 0x10)
+#define HW_OCOTP_CTRL			0x00
+#define HW_OCOTP_CTRL_SET		(HW_OCOTP_CTRL + 4)
+#define HW_OCOTP_CTRL_CLR		(HW_OCOTP_CTRL + 8)
+
+#define BM_OCOTP_CTRL_BUSY		(1 << 8)
+#define BM_OCOTP_CTRL_RD_BANK_OPEN	(1 << 12)
+
+static int __init tx28_set_mac(int id, unsigned char mac[])
+{
+	int i;
+	void __iomem *ocotp_base = ioremap(MX28_OCOTP_BASE_ADDR, SZ_4K);
+	u32 reg = 0;
+	long timeout = 1000;
+
+	if (ocotp_base == NULL)
+		return -ENOMEM;
+
+	/* set this bit to open the OTP banks for reading */
+	writel(BM_OCOTP_CTRL_RD_BANK_OPEN, ocotp_base + HW_OCOTP_CTRL_SET);
+
+	while (readl(ocotp_base + HW_OCOTP_CTRL) & BM_OCOTP_CTRL_BUSY) {
+		if (timeout-- < 0)
+			return -ETIMEDOUT;
+		udelay(100);
+	}
+
+	for (i = 0; i < ETH_ALEN; i++) {
+		if (i % 4 == 0)
+			reg = readl(ocotp_base + HW_OCOTP_CUST(id * 2 + i / 4));
+		mac[i] = reg >> (24 - ((i % 4) * 8));
+	}
+	iounmap(ocotp_base);
+	return 0;
+}
+
 int __init tx28_add_fec0(void)
 {
 	int i, ret;
@@ -139,6 +176,7 @@ int __init tx28_add_fec0(void)
 				__func__, ret);
 		goto free_gpios;
 	}
+	tx28_set_mac(0, tx28_fec0_data.mac);
 	pr_debug("%s: Registering FEC0 device\n", __func__);
 	mx28_add_fec(0, &tx28_fec0_data);
 	return 0;
@@ -165,6 +203,7 @@ int __init tx28_add_fec1(void)
 				__func__, ret);
 		return ret;
 	}
+	tx28_set_mac(1, tx28_fec1_data.mac);
 	pr_debug("%s: Registering FEC1 device\n", __func__);
 	mx28_add_fec(1, &tx28_fec1_data);
 	return 0;
-- 
1.5.6.5