[PATCH 09/10] ARM: mx28: read fec mac address from ocotp
From: Shawn Guo <hidden>
Date: 2010-12-28 14:55:54
Subsystem:
arm port, the rest · Maintainers:
Russell King, Linus Torvalds
Read fec mac address from ocotp and save it into fec_platform_data mac field for fec driver to use. Signed-off-by: Shawn Guo <redacted> --- arch/arm/mach-mxs/devices/platform-fec.c | 2 +- arch/arm/mach-mxs/include/mach/devices-common.h | 2 +- arch/arm/mach-mxs/mach-mx28evk.c | 31 +++++++++++++++++++++++ 3 files changed, 33 insertions(+), 2 deletions(-)
diff --git a/arch/arm/mach-mxs/devices/platform-fec.c b/arch/arm/mach-mxs/devices/platform-fec.c
index c08168c..dc978ee 100644
--- a/arch/arm/mach-mxs/devices/platform-fec.c
+++ b/arch/arm/mach-mxs/devices/platform-fec.c@@ -31,7 +31,7 @@ const struct mxs_fec_data mx28_fec_data[] __initconst = { struct platform_device *__init mxs_add_fec( const struct mxs_fec_data *data, - const struct fec_platform_data *pdata) + struct fec_platform_data *pdata) { struct resource res[] = { {
diff --git a/arch/arm/mach-mxs/include/mach/devices-common.h b/arch/arm/mach-mxs/include/mach/devices-common.h
index fca0551..d206e0a 100644
--- a/arch/arm/mach-mxs/include/mach/devices-common.h
+++ b/arch/arm/mach-mxs/include/mach/devices-common.h@@ -38,4 +38,4 @@ struct mxs_fec_data { }; struct platform_device *__init mxs_add_fec( const struct mxs_fec_data *data, - const struct fec_platform_data *pdata); + struct fec_platform_data *pdata);
diff --git a/arch/arm/mach-mxs/mach-mx28evk.c b/arch/arm/mach-mxs/mach-mx28evk.c
index def6519..d133733 100644
--- a/arch/arm/mach-mxs/mach-mx28evk.c
+++ b/arch/arm/mach-mxs/mach-mx28evk.c@@ -129,6 +129,36 @@ static struct fec_platform_data mx28_fec_pdata[] = { }, }; +static int __init mx28evk_fec_get_mac(void) +{ + int i, ret; + u32 val; + + /* + * OCOTP only stores the last 4 octets for each mac address, + * so hard-coding the first two octets as Freescale OUI (00:04:9f) + * is needed. + */ + for (i = 0; i < 2; i++) { + ret = mxs_read_ocotp(0x20 + i * 0x10, 1, &val); + if (ret) + goto error; + + mx28_fec_pdata[i].mac[0] = 0x00; + mx28_fec_pdata[i].mac[1] = 0x04; + mx28_fec_pdata[i].mac[2] = (val >> 24) & 0xff; + mx28_fec_pdata[i].mac[3] = (val >> 16) & 0xff; + mx28_fec_pdata[i].mac[4] = (val >> 8) & 0xff; + mx28_fec_pdata[i].mac[5] = (val >> 0) & 0xff; + } + + return 0; + +error: + pr_err("%s: timeout when reading fec mac from OCOTP\n", __func__); + return -ETIMEDOUT; +} + static void __init mx28evk_init(void) { mxs_iomux_setup_multiple_pads(mx28evk_pads, ARRAY_SIZE(mx28evk_pads));
@@ -136,6 +166,7 @@ static void __init mx28evk_init(void) mx28_add_duart(); mx28evk_fec_reset(); + mx28evk_fec_get_mac(); mx28_add_fec(0, &mx28_fec_pdata[0]); #ifdef CONFIG_FEC2 mx28_add_fec(1, &mx28_fec_pdata[1]);
--
1.7.1