1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
|
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")
|
