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 #include #include +#include #include #include @@ -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")