Root/target/linux/ixp4xx/patches-2.6.33/300-avila_fetch_mac.patch

1--- a/arch/arm/mach-ixp4xx/avila-setup.c
2+++ b/arch/arm/mach-ixp4xx/avila-setup.c
3@@ -14,10 +14,16 @@
4 #include <linux/kernel.h>
5 #include <linux/init.h>
6 #include <linux/device.h>
7+#include <linux/if_ether.h>
8+#include <linux/socket.h>
9+#include <linux/netdevice.h>
10 #include <linux/serial.h>
11 #include <linux/tty.h>
12 #include <linux/serial_8250.h>
13 #include <linux/slab.h>
14+#include <linux/i2c.h>
15+#include <linux/i2c/at24.h>
16+
17 #include <linux/i2c-gpio.h>
18 
19 #include <asm/types.h>
20@@ -29,6 +35,13 @@
21 #include <asm/mach/arch.h>
22 #include <asm/mach/flash.h>
23 
24+struct avila_board_info {
25+ unsigned char *model;
26+ void (*setup)(void);
27+};
28+
29+static struct avila_board_info *avila_info __initdata;
30+
31 static struct flash_platform_data avila_flash_data = {
32     .map_name = "cfi_probe",
33     .width = 2,
34@@ -132,16 +145,181 @@ static struct platform_device avila_pata
35     .resource = avila_pata_resources,
36 };
37 
38+/* Built-in 10/100 Ethernet MAC interfaces */
39+static struct eth_plat_info avila_npeb_data = {
40+ .phy = 0,
41+ .rxq = 3,
42+ .txreadyq = 20,
43+};
44+
45+static struct eth_plat_info avila_npec_data = {
46+ .phy = 1,
47+ .rxq = 4,
48+ .txreadyq = 21,
49+};
50+
51+static struct platform_device avila_npeb_device = {
52+ .name = "ixp4xx_eth",
53+ .id = IXP4XX_ETH_NPEB,
54+ .dev.platform_data = &avila_npeb_data,
55+};
56+
57+static struct platform_device avila_npec_device = {
58+ .name = "ixp4xx_eth",
59+ .id = IXP4XX_ETH_NPEC,
60+ .dev.platform_data = &avila_npec_data,
61+};
62+
63 static struct platform_device *avila_devices[] __initdata = {
64     &avila_i2c_gpio,
65     &avila_flash,
66     &avila_uart
67 };
68 
69+static void __init avila_gw23xx_setup(void)
70+{
71+ platform_device_register(&avila_npeb_device);
72+ platform_device_register(&avila_npec_device);
73+}
74+
75+static void __init avila_gw2342_setup(void)
76+{
77+ platform_device_register(&avila_npeb_device);
78+ platform_device_register(&avila_npec_device);
79+}
80+
81+static void __init avila_gw2345_setup(void)
82+{
83+ avila_npeb_data.phy = IXP4XX_ETH_PHY_MAX_ADDR;
84+ avila_npeb_data.phy_mask = 0x1e; /* ports 1-4 of the KS8995 switch */
85+ platform_device_register(&avila_npeb_device);
86+
87+ avila_npec_data.phy = 5; /* port 5 of the KS8995 switch */
88+ platform_device_register(&avila_npec_device);
89+}
90+
91+static void __init avila_gw2347_setup(void)
92+{
93+ platform_device_register(&avila_npeb_device);
94+}
95+
96+static void __init avila_gw2348_setup(void)
97+{
98+ platform_device_register(&avila_npeb_device);
99+ platform_device_register(&avila_npec_device);
100+}
101+
102+static void __init avila_gw2353_setup(void)
103+{
104+ platform_device_register(&avila_npeb_device);
105+}
106+
107+static void __init avila_gw2355_setup(void)
108+{
109+ avila_npeb_data.phy = IXP4XX_ETH_PHY_MAX_ADDR;
110+ avila_npeb_data.phy_mask = 0x1e; /* ports 1-4 of the KS8995 switch */
111+ platform_device_register(&avila_npeb_device);
112+
113+ avila_npec_data.phy = 16;
114+ platform_device_register(&avila_npec_device);
115+}
116+
117+static void __init avila_gw2357_setup(void)
118+{
119+ platform_device_register(&avila_npeb_device);
120+}
121+
122+static struct avila_board_info avila_boards[] __initdata = {
123+ {
124+ .model = "GW2342",
125+ .setup = avila_gw2342_setup,
126+ }, {
127+ .model = "GW2345",
128+ .setup = avila_gw2345_setup,
129+ }, {
130+ .model = "GW2347",
131+ .setup = avila_gw2347_setup,
132+ }, {
133+ .model = "GW2348",
134+ .setup = avila_gw2348_setup,
135+ }, {
136+ .model = "GW2353",
137+ .setup = avila_gw2353_setup,
138+ }, {
139+ .model = "GW2355",
140+ .setup = avila_gw2355_setup,
141+ }, {
142+ .model = "GW2357",
143+ .setup = avila_gw2357_setup,
144+ }
145+};
146+
147+static struct avila_board_info * __init avila_find_board_info(char *model)
148+{
149+ int i;
150+ model[6] = '\0';
151+
152+ for (i = 0; i < ARRAY_SIZE(avila_boards); i++) {
153+ struct avila_board_info *info = &avila_boards[i];
154+ if (strcmp(info->model, model) == 0)
155+ return info;
156+ }
157+
158+ return NULL;
159+}
160+
161+static struct memory_accessor *at24_mem_acc;
162+
163+static void at24_setup(struct memory_accessor *mem_acc, void *context)
164+{
165+ char mac_addr[ETH_ALEN];
166+ char model[7];
167+
168+ at24_mem_acc = mem_acc;
169+
170+ /* Read MAC addresses */
171+ if (at24_mem_acc->read(at24_mem_acc, mac_addr, 0x0, 6) == 6) {
172+ memcpy(&avila_npeb_data.hwaddr, mac_addr, ETH_ALEN);
173+ }
174+ if (at24_mem_acc->read(at24_mem_acc, mac_addr, 0x6, 6) == 6) {
175+ memcpy(&avila_npec_data.hwaddr, mac_addr, ETH_ALEN);
176+ }
177+
178+ /* Read the first 6 bytes of the model number */
179+ if (at24_mem_acc->read(at24_mem_acc, model, 0x20, 6) == 6) {
180+ avila_info = avila_find_board_info(model);
181+ }
182+
183+}
184+
185+static struct at24_platform_data avila_eeprom_info = {
186+ .byte_len = 1024,
187+ .page_size = 16,
188+ .flags = AT24_FLAG_READONLY,
189+ .setup = at24_setup,
190+};
191+
192+static struct i2c_board_info __initdata avila_i2c_board_info[] = {
193+ {
194+ I2C_BOARD_INFO("ds1672", 0x68),
195+ },
196+ {
197+ I2C_BOARD_INFO("ad7418", 0x28),
198+ },
199+ {
200+ I2C_BOARD_INFO("24c08", 0x51),
201+ .platform_data = &avila_eeprom_info
202+ },
203+};
204+
205 static void __init avila_init(void)
206 {
207     ixp4xx_sys_init();
208 
209+ /*
210+ * These devices are present on all Avila models and don't need any
211+ * model specific setup.
212+ */
213     avila_flash_resource.start = IXP4XX_EXP_BUS_BASE(0);
214     avila_flash_resource.end =
215         IXP4XX_EXP_BUS_BASE(0) + ixp4xx_exp_bus_size - 1;
216@@ -159,7 +337,28 @@ static void __init avila_init(void)
217 
218     platform_device_register(&avila_pata);
219 
220+ i2c_register_board_info(0, avila_i2c_board_info,
221+ ARRAY_SIZE(avila_i2c_board_info));
222+}
223+
224+static int __init avila_model_setup(void)
225+{
226+ if (!machine_is_avila())
227+ return 0;
228+
229+ if (avila_info) {
230+ printk(KERN_DEBUG "Running on Gateworks Avila %s\n",
231+ avila_info->model);
232+ avila_info->setup();
233+ } else {
234+ printk(KERN_INFO "Unknown/missing Avila model number"
235+ " -- defaults will be used\n");
236+ avila_gw23xx_setup();
237+ }
238+
239+ return 0;
240 }
241+late_initcall(avila_model_setup);
242 
243 MACHINE_START(AVILA, "Gateworks Avila Network Platform")
244     /* Maintainer: Deepak Saxena <dsaxena@plexity.net> */
245

Archive Download this file

Branches:
backfire
history
master
release_2010-11-17
release_2010-12-14
release_2011-02-23
release_2011-05-28
release_2011-08-27
release_2011-11-13
release_2012-03-18
release_2012-04-09
release_2012-10-11
uclibc_nptl



interactive