56 lines
1.5 KiB
Diff
56 lines
1.5 KiB
Diff
diff --git a/arch/arm/mach-ixp4xx/fsg-setup.c b/arch/arm/mach-ixp4xx/fsg-setup.c
|
|
index ec3d517..7cc7201 100644
|
|
--- a/arch/arm/mach-ixp4xx/fsg-setup.c
|
|
+++ b/arch/arm/mach-ixp4xx/fsg-setup.c
|
|
@@ -16,6 +16,7 @@
|
|
#include <linux/serial_8250.h>
|
|
#include <linux/leds.h>
|
|
#include <linux/i2c-gpio.h>
|
|
+#include <linux/mtd/mtd.h>
|
|
|
|
#include <asm/mach-types.h>
|
|
#include <asm/mach/arch.h>
|
|
@@ -177,6 +178,34 @@ static struct platform_device *fsg_devices[] __initdata = {
|
|
&fsg_eth[1],
|
|
};
|
|
|
|
+static void fsg_flash_add(struct mtd_info *mtd)
|
|
+{
|
|
+ if (strcmp(mtd->name, "RedBoot config") == 0) {
|
|
+ size_t retlen;
|
|
+ u_char mac[6];
|
|
+
|
|
+ if (mtd->read(mtd, 0x0422, 6, &retlen, mac) == 0 && retlen == 6) {
|
|
+ printk(KERN_INFO "eth0 mac: %.2x:%.2x:%.2x:%.2x:%.2x:%.2x\n",
|
|
+ mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]);
|
|
+ memcpy(fsg_plat_eth[0].hwaddr, mac, 6);
|
|
+ mac[5]++;
|
|
+ printk(KERN_INFO "eth1 mac: %.2x:%.2x:%.2x:%.2x:%.2x:%.2x\n",
|
|
+ mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]);
|
|
+ memcpy(fsg_plat_eth[1].hwaddr, mac, 6);
|
|
+ } else {
|
|
+ printk(KERN_ERR "fsg mac: read failed\n");
|
|
+ }
|
|
+ }
|
|
+}
|
|
+
|
|
+static void fsg_flash_remove(struct mtd_info *mtd) {
|
|
+}
|
|
+
|
|
+static struct mtd_notifier fsg_flash_notifier = {
|
|
+ .add = fsg_flash_add,
|
|
+ .remove = fsg_flash_remove,
|
|
+};
|
|
+
|
|
static void __init fsg_init(void)
|
|
{
|
|
ixp4xx_sys_init();
|
|
@@ -198,6 +227,8 @@ static void __init fsg_init(void)
|
|
(void)platform_device_register(&fsg_uart);
|
|
|
|
platform_add_devices(fsg_devices, ARRAY_SIZE(fsg_devices));
|
|
+
|
|
+ register_mtd_user(&fsg_flash_notifier);
|
|
}
|
|
|
|
MACHINE_START(FSG, "Freecom FSG-3")
|