Commit | Line | Data |
---|---|---|
555a3656 | 1 | /* |
9dd0b194 | 2 | * arch/arm/mach-orion5x/dns323-setup.c |
555a3656 HVR |
3 | * |
4 | * Copyright (C) 2007 Herbert Valerio Riedel <hvr@gnu.org> | |
5 | * | |
6e2daa49 BH |
6 | * Support for HW Rev C1: |
7 | * | |
8 | * Copyright (C) 2010 Benjamin Herrenschmidt <benh@kernel.crashing.org> | |
9 | * | |
555a3656 HVR |
10 | * This program is free software; you can redistribute it and/or modify |
11 | * it under the terms of the GNU Lesser General Public License as | |
12 | * published by the Free Software Foundation; either version 2 of the | |
13 | * License, or (at your option) any later version. | |
14 | * | |
15 | */ | |
2f8163ba | 16 | #include <linux/gpio.h> |
555a3656 HVR |
17 | #include <linux/kernel.h> |
18 | #include <linux/init.h> | |
cf11052a | 19 | #include <linux/delay.h> |
555a3656 HVR |
20 | #include <linux/platform_device.h> |
21 | #include <linux/pci.h> | |
22 | #include <linux/irq.h> | |
23 | #include <linux/mtd/physmap.h> | |
24 | #include <linux/mv643xx_eth.h> | |
25 | #include <linux/leds.h> | |
26 | #include <linux/gpio_keys.h> | |
27 | #include <linux/input.h> | |
28 | #include <linux/i2c.h> | |
f93e4159 | 29 | #include <linux/ata_platform.h> |
6e2daa49 BH |
30 | #include <linux/phy.h> |
31 | #include <linux/marvell_phy.h> | |
555a3656 | 32 | #include <asm/mach-types.h> |
555a3656 HVR |
33 | #include <asm/mach/arch.h> |
34 | #include <asm/mach/pci.h> | |
a09e64fb | 35 | #include <mach/orion5x.h> |
555a3656 | 36 | #include "common.h" |
19cfd5c0 | 37 | #include "mpp.h" |
555a3656 | 38 | |
6e2daa49 | 39 | /* Rev A1 and B1 */ |
555a3656 HVR |
40 | #define DNS323_GPIO_LED_RIGHT_AMBER 1 |
41 | #define DNS323_GPIO_LED_LEFT_AMBER 2 | |
cf11052a | 42 | #define DNS323_GPIO_SYSTEM_UP 3 |
b2a731aa LB |
43 | #define DNS323_GPIO_LED_POWER1 4 |
44 | #define DNS323_GPIO_LED_POWER2 5 | |
555a3656 HVR |
45 | #define DNS323_GPIO_OVERTEMP 6 |
46 | #define DNS323_GPIO_RTC 7 | |
47 | #define DNS323_GPIO_POWER_OFF 8 | |
48 | #define DNS323_GPIO_KEY_POWER 9 | |
49 | #define DNS323_GPIO_KEY_RESET 10 | |
50 | ||
6e2daa49 BH |
51 | /* Rev C1 */ |
52 | #define DNS323C_GPIO_KEY_POWER 1 | |
53 | #define DNS323C_GPIO_POWER_OFF 2 | |
54 | #define DNS323C_GPIO_LED_RIGHT_AMBER 8 | |
55 | #define DNS323C_GPIO_LED_LEFT_AMBER 9 | |
56 | #define DNS323C_GPIO_LED_POWER 17 | |
57 | #define DNS323C_GPIO_FAN_BIT1 18 | |
58 | #define DNS323C_GPIO_FAN_BIT0 19 | |
59 | ||
60 | /* Exposed to userspace, do not change */ | |
61 | enum { | |
62 | DNS323_REV_A1, /* 0 */ | |
63 | DNS323_REV_B1, /* 1 */ | |
64 | DNS323_REV_C1, /* 2 */ | |
65 | }; | |
66 | ||
67 | ||
555a3656 HVR |
68 | /**************************************************************************** |
69 | * PCI setup | |
70 | */ | |
71 | ||
d5341942 | 72 | static int __init dns323_pci_map_irq(const struct pci_dev *dev, u8 slot, u8 pin) |
555a3656 | 73 | { |
92b913b0 | 74 | int irq; |
555a3656 | 75 | |
92b913b0 LB |
76 | /* |
77 | * Check for devices with hard-wired IRQs. | |
78 | */ | |
5166793f | 79 | irq = orion5x_pci_map_irq(dev, slot, pin); |
92b913b0 LB |
80 | if (irq != -1) |
81 | return irq; | |
82 | ||
555a3656 HVR |
83 | return -1; |
84 | } | |
85 | ||
86 | static struct hw_pci dns323_pci __initdata = { | |
bbdf1c1e | 87 | .nr_controllers = 2, |
555a3656 | 88 | .swizzle = pci_std_swizzle, |
9dd0b194 LB |
89 | .setup = orion5x_pci_sys_setup, |
90 | .scan = orion5x_pci_sys_scan_bus, | |
555a3656 HVR |
91 | .map_irq = dns323_pci_map_irq, |
92 | }; | |
93 | ||
94 | static int __init dns323_pci_init(void) | |
95 | { | |
6e2daa49 | 96 | /* Rev B1 and C1 doesn't really use its PCI bus, and initialising PCI |
f93e4159 MP |
97 | * gets in the way of initialising the SATA controller. |
98 | */ | |
6e2daa49 | 99 | if (machine_is_dns323() && system_rev == DNS323_REV_A1) |
555a3656 HVR |
100 | pci_common_init(&dns323_pci); |
101 | ||
102 | return 0; | |
103 | } | |
104 | ||
105 | subsys_initcall(dns323_pci_init); | |
106 | ||
555a3656 HVR |
107 | /**************************************************************************** |
108 | * 8MiB NOR flash (Spansion S29GL064M90TFIR4) | |
109 | * | |
110 | * Layout as used by D-Link: | |
111 | * 0x00000000-0x00010000 : "MTD1" | |
112 | * 0x00010000-0x00020000 : "MTD2" | |
113 | * 0x00020000-0x001a0000 : "Linux Kernel" | |
114 | * 0x001a0000-0x007d0000 : "File System" | |
115 | * 0x007d0000-0x00800000 : "u-boot" | |
116 | */ | |
117 | ||
118 | #define DNS323_NOR_BOOT_BASE 0xf4000000 | |
119 | #define DNS323_NOR_BOOT_SIZE SZ_8M | |
120 | ||
121 | static struct mtd_partition dns323_partitions[] = { | |
122 | { | |
123 | .name = "MTD1", | |
124 | .size = 0x00010000, | |
125 | .offset = 0, | |
126 | }, { | |
127 | .name = "MTD2", | |
128 | .size = 0x00010000, | |
129 | .offset = 0x00010000, | |
130 | }, { | |
131 | .name = "Linux Kernel", | |
132 | .size = 0x00180000, | |
133 | .offset = 0x00020000, | |
134 | }, { | |
135 | .name = "File System", | |
136 | .size = 0x00630000, | |
137 | .offset = 0x001A0000, | |
138 | }, { | |
139 | .name = "u-boot", | |
140 | .size = 0x00030000, | |
141 | .offset = 0x007d0000, | |
e7068ad3 | 142 | }, |
555a3656 HVR |
143 | }; |
144 | ||
145 | static struct physmap_flash_data dns323_nor_flash_data = { | |
146 | .width = 1, | |
147 | .parts = dns323_partitions, | |
148 | .nr_parts = ARRAY_SIZE(dns323_partitions) | |
149 | }; | |
150 | ||
151 | static struct resource dns323_nor_flash_resource = { | |
152 | .flags = IORESOURCE_MEM, | |
153 | .start = DNS323_NOR_BOOT_BASE, | |
154 | .end = DNS323_NOR_BOOT_BASE + DNS323_NOR_BOOT_SIZE - 1, | |
155 | }; | |
156 | ||
157 | static struct platform_device dns323_nor_flash = { | |
158 | .name = "physmap-flash", | |
159 | .id = 0, | |
e7068ad3 LB |
160 | .dev = { |
161 | .platform_data = &dns323_nor_flash_data, | |
162 | }, | |
555a3656 HVR |
163 | .resource = &dns323_nor_flash_resource, |
164 | .num_resources = 1, | |
165 | }; | |
166 | ||
a93f44c1 MP |
167 | /**************************************************************************** |
168 | * Ethernet | |
169 | */ | |
170 | ||
171 | static struct mv643xx_eth_platform_data dns323_eth_data = { | |
172 | .phy_addr = MV643XX_ETH_PHY_ADDR(8), | |
173 | }; | |
174 | ||
175 | /* dns323_parse_hex_*() taken from tsx09-common.c; should a common copy of these | |
176 | * functions be kept somewhere? | |
177 | */ | |
178 | static int __init dns323_parse_hex_nibble(char n) | |
179 | { | |
180 | if (n >= '0' && n <= '9') | |
181 | return n - '0'; | |
182 | ||
183 | if (n >= 'A' && n <= 'F') | |
184 | return n - 'A' + 10; | |
185 | ||
186 | if (n >= 'a' && n <= 'f') | |
187 | return n - 'a' + 10; | |
188 | ||
189 | return -1; | |
190 | } | |
191 | ||
192 | static int __init dns323_parse_hex_byte(const char *b) | |
193 | { | |
194 | int hi; | |
195 | int lo; | |
196 | ||
197 | hi = dns323_parse_hex_nibble(b[0]); | |
198 | lo = dns323_parse_hex_nibble(b[1]); | |
199 | ||
200 | if (hi < 0 || lo < 0) | |
201 | return -1; | |
202 | ||
203 | return (hi << 4) | lo; | |
204 | } | |
205 | ||
206 | static int __init dns323_read_mac_addr(void) | |
207 | { | |
208 | u_int8_t addr[6]; | |
209 | int i; | |
210 | char *mac_page; | |
211 | ||
212 | /* MAC address is stored as a regular ol' string in /dev/mtdblock4 | |
213 | * (0x007d0000-0x00800000) starting at offset 196480 (0x2ff80). | |
214 | */ | |
215 | mac_page = ioremap(DNS323_NOR_BOOT_BASE + 0x7d0000 + 196480, 1024); | |
216 | if (!mac_page) | |
217 | return -ENOMEM; | |
218 | ||
219 | /* Sanity check the string we're looking at */ | |
220 | for (i = 0; i < 5; i++) { | |
221 | if (*(mac_page + (i * 3) + 2) != ':') { | |
222 | goto error_fail; | |
223 | } | |
224 | } | |
225 | ||
226 | for (i = 0; i < 6; i++) { | |
227 | int byte; | |
228 | ||
229 | byte = dns323_parse_hex_byte(mac_page + (i * 3)); | |
230 | if (byte < 0) { | |
231 | goto error_fail; | |
232 | } | |
233 | ||
234 | addr[i] = byte; | |
235 | } | |
236 | ||
237 | iounmap(mac_page); | |
6e2daa49 | 238 | printk("DNS-323: Found ethernet MAC address: "); |
a93f44c1 MP |
239 | for (i = 0; i < 6; i++) |
240 | printk("%.2x%s", addr[i], (i < 5) ? ":" : ".\n"); | |
241 | ||
242 | memcpy(dns323_eth_data.mac_addr, addr, 6); | |
243 | ||
244 | return 0; | |
245 | ||
246 | error_fail: | |
247 | iounmap(mac_page); | |
248 | return -EINVAL; | |
249 | } | |
250 | ||
555a3656 HVR |
251 | /**************************************************************************** |
252 | * GPIO LEDs (simple - doesn't use hardware blinking support) | |
253 | */ | |
254 | ||
b2a731aa LB |
255 | #define ORION_BLINK_HALF_PERIOD 100 /* ms */ |
256 | ||
2146325d | 257 | static int dns323_gpio_blink_set(unsigned gpio, int state, |
b2a731aa LB |
258 | unsigned long *delay_on, unsigned long *delay_off) |
259 | { | |
b2a731aa | 260 | |
2146325d | 261 | if (delay_on && delay_off && !*delay_on && !*delay_off) |
b2a731aa LB |
262 | *delay_on = *delay_off = ORION_BLINK_HALF_PERIOD; |
263 | ||
2146325d BH |
264 | switch(state) { |
265 | case GPIO_LED_NO_BLINK_LOW: | |
266 | case GPIO_LED_NO_BLINK_HIGH: | |
267 | orion_gpio_set_blink(gpio, 0); | |
268 | gpio_set_value(gpio, state); | |
269 | break; | |
270 | case GPIO_LED_BLINK: | |
271 | orion_gpio_set_blink(gpio, 1); | |
b2a731aa | 272 | } |
2146325d | 273 | return 0; |
b2a731aa LB |
274 | } |
275 | ||
6e2daa49 | 276 | static struct gpio_led dns323ab_leds[] = { |
555a3656 HVR |
277 | { |
278 | .name = "power:blue", | |
b2a731aa | 279 | .gpio = DNS323_GPIO_LED_POWER2, |
f8e00530 | 280 | .default_trigger = "default-on", |
555a3656 HVR |
281 | }, { |
282 | .name = "right:amber", | |
283 | .gpio = DNS323_GPIO_LED_RIGHT_AMBER, | |
284 | .active_low = 1, | |
285 | }, { | |
286 | .name = "left:amber", | |
287 | .gpio = DNS323_GPIO_LED_LEFT_AMBER, | |
288 | .active_low = 1, | |
289 | }, | |
290 | }; | |
291 | ||
6e2daa49 BH |
292 | |
293 | static struct gpio_led dns323c_leds[] = { | |
294 | { | |
295 | .name = "power:blue", | |
296 | .gpio = DNS323C_GPIO_LED_POWER, | |
297 | .default_trigger = "timer", | |
298 | .active_low = 1, | |
299 | }, { | |
300 | .name = "right:amber", | |
301 | .gpio = DNS323C_GPIO_LED_RIGHT_AMBER, | |
302 | .active_low = 1, | |
303 | }, { | |
304 | .name = "left:amber", | |
305 | .gpio = DNS323C_GPIO_LED_LEFT_AMBER, | |
306 | .active_low = 1, | |
307 | }, | |
308 | }; | |
309 | ||
310 | ||
311 | static struct gpio_led_platform_data dns323ab_led_data = { | |
312 | .num_leds = ARRAY_SIZE(dns323ab_leds), | |
313 | .leds = dns323ab_leds, | |
314 | .gpio_blink_set = dns323_gpio_blink_set, | |
315 | }; | |
316 | ||
317 | static struct gpio_led_platform_data dns323c_led_data = { | |
318 | .num_leds = ARRAY_SIZE(dns323c_leds), | |
319 | .leds = dns323c_leds, | |
b2a731aa | 320 | .gpio_blink_set = dns323_gpio_blink_set, |
555a3656 HVR |
321 | }; |
322 | ||
323 | static struct platform_device dns323_gpio_leds = { | |
324 | .name = "leds-gpio", | |
325 | .id = -1, | |
e7068ad3 | 326 | .dev = { |
6e2daa49 | 327 | .platform_data = &dns323ab_led_data, |
e7068ad3 | 328 | }, |
555a3656 HVR |
329 | }; |
330 | ||
331 | /**************************************************************************** | |
332 | * GPIO Attached Keys | |
333 | */ | |
334 | ||
6e2daa49 | 335 | static struct gpio_keys_button dns323ab_buttons[] = { |
555a3656 HVR |
336 | { |
337 | .code = KEY_RESTART, | |
338 | .gpio = DNS323_GPIO_KEY_RESET, | |
339 | .desc = "Reset Button", | |
340 | .active_low = 1, | |
e7068ad3 | 341 | }, { |
555a3656 HVR |
342 | .code = KEY_POWER, |
343 | .gpio = DNS323_GPIO_KEY_POWER, | |
344 | .desc = "Power Button", | |
345 | .active_low = 1, | |
e7068ad3 | 346 | }, |
555a3656 HVR |
347 | }; |
348 | ||
6e2daa49 BH |
349 | static struct gpio_keys_platform_data dns323ab_button_data = { |
350 | .buttons = dns323ab_buttons, | |
351 | .nbuttons = ARRAY_SIZE(dns323ab_buttons), | |
352 | }; | |
353 | ||
354 | static struct gpio_keys_button dns323c_buttons[] = { | |
355 | { | |
356 | .code = KEY_POWER, | |
357 | .gpio = DNS323C_GPIO_KEY_POWER, | |
358 | .desc = "Power Button", | |
359 | .active_low = 1, | |
360 | }, | |
361 | }; | |
362 | ||
363 | static struct gpio_keys_platform_data dns323c_button_data = { | |
364 | .buttons = dns323c_buttons, | |
365 | .nbuttons = ARRAY_SIZE(dns323c_buttons), | |
555a3656 HVR |
366 | }; |
367 | ||
368 | static struct platform_device dns323_button_device = { | |
369 | .name = "gpio-keys", | |
370 | .id = -1, | |
371 | .num_resources = 0, | |
e7068ad3 | 372 | .dev = { |
6e2daa49 | 373 | .platform_data = &dns323ab_button_data, |
e7068ad3 | 374 | }, |
555a3656 HVR |
375 | }; |
376 | ||
f93e4159 MP |
377 | /***************************************************************************** |
378 | * SATA | |
379 | */ | |
380 | static struct mv_sata_platform_data dns323_sata_data = { | |
381 | .n_ports = 2, | |
382 | }; | |
383 | ||
555a3656 HVR |
384 | /**************************************************************************** |
385 | * General Setup | |
386 | */ | |
554cdaef AL |
387 | static unsigned int dns323a_mpp_modes[] __initdata = { |
388 | MPP0_PCIE_RST_OUTn, | |
389 | MPP1_GPIO, /* right amber LED (sata ch0) */ | |
390 | MPP2_GPIO, /* left amber LED (sata ch1) */ | |
391 | MPP3_UNUSED, | |
392 | MPP4_GPIO, /* power button LED */ | |
393 | MPP5_GPIO, /* power button LED */ | |
394 | MPP6_GPIO, /* GMT G751-2f overtemp */ | |
395 | MPP7_GPIO, /* M41T80 nIRQ/OUT/SQW */ | |
396 | MPP8_GPIO, /* triggers power off */ | |
397 | MPP9_GPIO, /* power button switch */ | |
398 | MPP10_GPIO, /* reset button switch */ | |
399 | MPP11_UNUSED, | |
400 | MPP12_UNUSED, | |
401 | MPP13_UNUSED, | |
402 | MPP14_UNUSED, | |
403 | MPP15_UNUSED, | |
404 | MPP16_UNUSED, | |
405 | MPP17_UNUSED, | |
406 | MPP18_UNUSED, | |
407 | MPP19_UNUSED, | |
408 | 0, | |
19cfd5c0 | 409 | }; |
555a3656 | 410 | |
554cdaef AL |
411 | static unsigned int dns323b_mpp_modes[] __initdata = { |
412 | MPP0_UNUSED, | |
413 | MPP1_GPIO, /* right amber LED (sata ch0) */ | |
414 | MPP2_GPIO, /* left amber LED (sata ch1) */ | |
415 | MPP3_GPIO, /* system up flag */ | |
416 | MPP4_GPIO, /* power button LED */ | |
417 | MPP5_GPIO, /* power button LED */ | |
418 | MPP6_GPIO, /* GMT G751-2f overtemp */ | |
419 | MPP7_GPIO, /* M41T80 nIRQ/OUT/SQW */ | |
420 | MPP8_GPIO, /* triggers power off */ | |
421 | MPP9_GPIO, /* power button switch */ | |
422 | MPP10_GPIO, /* reset button switch */ | |
423 | MPP11_UNUSED, | |
424 | MPP12_SATA_LED, | |
425 | MPP13_SATA_LED, | |
426 | MPP14_SATA_LED, | |
427 | MPP15_SATA_LED, | |
428 | MPP16_UNUSED, | |
429 | MPP17_UNUSED, | |
430 | MPP18_UNUSED, | |
431 | MPP19_UNUSED, | |
432 | 0, | |
f93e4159 MP |
433 | }; |
434 | ||
554cdaef AL |
435 | static unsigned int dns323c_mpp_modes[] __initdata = { |
436 | MPP0_GPIO, /* ? input */ | |
437 | MPP1_GPIO, /* input power switch (0 = pressed) */ | |
438 | MPP2_GPIO, /* output power off */ | |
439 | MPP3_UNUSED, /* ? output */ | |
440 | MPP4_UNUSED, /* ? output */ | |
441 | MPP5_UNUSED, /* ? output */ | |
442 | MPP6_UNUSED, /* ? output */ | |
443 | MPP7_UNUSED, /* ? output */ | |
444 | MPP8_GPIO, /* i/o right amber LED */ | |
445 | MPP9_GPIO, /* i/o left amber LED */ | |
446 | MPP10_GPIO, /* input */ | |
447 | MPP11_UNUSED, | |
448 | MPP12_SATA_LED, | |
449 | MPP13_SATA_LED, | |
450 | MPP14_SATA_LED, | |
451 | MPP15_SATA_LED, | |
452 | MPP16_UNUSED, | |
453 | MPP17_GPIO, /* power button LED */ | |
454 | MPP18_GPIO, /* fan speed bit 0 */ | |
455 | MPP19_GPIO, /* fan speed bit 1 */ | |
456 | 0, | |
6e2daa49 BH |
457 | }; |
458 | ||
459 | /* Rev C1 Fan speed notes: | |
460 | * | |
461 | * The fan is controlled by 2 GPIOs on this board. The settings | |
462 | * of the bits is as follow: | |
463 | * | |
464 | * GPIO 18 GPIO 19 Fan | |
465 | * | |
466 | * 0 0 stopped | |
467 | * 0 1 low speed | |
468 | * 1 0 high speed | |
469 | * 1 1 don't do that (*) | |
470 | * | |
471 | * (*) I think the two bits control two feed-in resistors into a fixed | |
472 | * PWN circuit, setting both bits will basically go a 'bit' faster | |
473 | * than high speed, but d-link doesn't do it and you may get out of | |
474 | * HW spec so don't do it. | |
475 | */ | |
476 | ||
555a3656 | 477 | /* |
6e2daa49 | 478 | * On the DNS-323 A1 and B1 the following devices are attached via I2C: |
555a3656 HVR |
479 | * |
480 | * i2c addr | chip | description | |
481 | * 0x3e | GMT G760Af | fan speed PWM controller | |
482 | * 0x48 | GMT G751-2f | temp. sensor and therm. watchdog (LM75 compatible) | |
483 | * 0x68 | ST M41T80 | RTC w/ alarm | |
484 | */ | |
6e2daa49 | 485 | static struct i2c_board_info __initdata dns323ab_i2c_devices[] = { |
555a3656 HVR |
486 | { |
487 | I2C_BOARD_INFO("g760a", 0x3e), | |
e7068ad3 | 488 | }, { |
c0fe819b | 489 | I2C_BOARD_INFO("lm75", 0x48), |
e7068ad3 | 490 | }, { |
3760f736 | 491 | I2C_BOARD_INFO("m41t80", 0x68), |
e7068ad3 | 492 | }, |
555a3656 HVR |
493 | }; |
494 | ||
6e2daa49 BH |
495 | /* |
496 | * On the DNS-323 C1 the following devices are attached via I2C: | |
497 | * | |
498 | * i2c addr | chip | description | |
499 | * 0x48 | GMT G751-2f | temp. sensor and therm. watchdog (LM75 compatible) | |
500 | * 0x68 | ST M41T80 | RTC w/ alarm | |
501 | */ | |
502 | static struct i2c_board_info __initdata dns323c_i2c_devices[] = { | |
503 | { | |
504 | I2C_BOARD_INFO("lm75", 0x48), | |
505 | }, { | |
506 | I2C_BOARD_INFO("m41t80", 0x68), | |
507 | }, | |
508 | }; | |
509 | ||
cf11052a EB |
510 | /* DNS-323 rev. A specific power off method */ |
511 | static void dns323a_power_off(void) | |
555a3656 | 512 | { |
6e2daa49 | 513 | pr_info("DNS-323: Triggering power-off...\n"); |
555a3656 HVR |
514 | gpio_set_value(DNS323_GPIO_POWER_OFF, 1); |
515 | } | |
516 | ||
cf11052a EB |
517 | /* DNS-323 rev B specific power off method */ |
518 | static void dns323b_power_off(void) | |
519 | { | |
6e2daa49 | 520 | pr_info("DNS-323: Triggering power-off...\n"); |
cf11052a EB |
521 | /* Pin has to be changed to 1 and back to 0 to do actual power off. */ |
522 | gpio_set_value(DNS323_GPIO_POWER_OFF, 1); | |
523 | mdelay(100); | |
524 | gpio_set_value(DNS323_GPIO_POWER_OFF, 0); | |
525 | } | |
526 | ||
6e2daa49 BH |
527 | /* DNS-323 rev. C specific power off method */ |
528 | static void dns323c_power_off(void) | |
529 | { | |
530 | pr_info("DNS-323: Triggering power-off...\n"); | |
531 | gpio_set_value(DNS323C_GPIO_POWER_OFF, 1); | |
532 | } | |
533 | ||
534 | static int dns323c_phy_fixup(struct phy_device *phy) | |
535 | { | |
536 | phy->dev_flags |= MARVELL_PHY_M1118_DNS323_LEDS; | |
537 | ||
538 | return 0; | |
539 | } | |
540 | ||
541 | static int __init dns323_identify_rev(void) | |
542 | { | |
543 | u32 dev, rev, i, reg; | |
544 | ||
545 | pr_debug("DNS-323: Identifying board ... \n"); | |
546 | ||
547 | /* Rev A1 has a 5181 */ | |
548 | orion5x_pcie_id(&dev, &rev); | |
549 | if (dev == MV88F5181_DEV_ID) { | |
550 | pr_debug("DNS-323: 5181 found, board is A1\n"); | |
551 | return DNS323_REV_A1; | |
552 | } | |
553 | pr_debug("DNS-323: 5182 found, board is B1 or C1, checking PHY...\n"); | |
554 | ||
555 | /* Rev B1 and C1 both have 5182, let's poke at the eth PHY. This is | |
556 | * a bit gross but we want to do that without links into the eth | |
557 | * driver so let's poke at it directly. We default to rev B1 in | |
558 | * case the accesses fail | |
559 | */ | |
560 | ||
561 | #define ETH_SMI_REG (ORION5X_ETH_VIRT_BASE + 0x2000 + 0x004) | |
562 | #define SMI_BUSY 0x10000000 | |
563 | #define SMI_READ_VALID 0x08000000 | |
564 | #define SMI_OPCODE_READ 0x04000000 | |
565 | #define SMI_OPCODE_WRITE 0x00000000 | |
566 | ||
567 | for (i = 0; i < 1000; i++) { | |
568 | reg = readl(ETH_SMI_REG); | |
569 | if (!(reg & SMI_BUSY)) | |
570 | break; | |
571 | } | |
572 | if (i >= 1000) { | |
573 | pr_warning("DNS-323: Timeout accessing PHY, assuming rev B1\n"); | |
574 | return DNS323_REV_B1; | |
575 | } | |
576 | writel((3 << 21) /* phy ID reg */ | | |
577 | (8 << 16) /* phy addr */ | | |
578 | SMI_OPCODE_READ, ETH_SMI_REG); | |
579 | for (i = 0; i < 1000; i++) { | |
580 | reg = readl(ETH_SMI_REG); | |
581 | if (reg & SMI_READ_VALID) | |
582 | break; | |
583 | } | |
584 | if (i >= 1000) { | |
585 | pr_warning("DNS-323: Timeout reading PHY, assuming rev B1\n"); | |
586 | return DNS323_REV_B1; | |
587 | } | |
588 | pr_debug("DNS-323: Ethernet PHY ID 0x%x\n", reg & 0xffff); | |
589 | ||
590 | /* Note: the Marvell tools mask the ID with 0x3f0 before comparison | |
591 | * but I don't see that making a difference here, at least with | |
592 | * any known Marvell PHY ID | |
593 | */ | |
594 | switch(reg & 0xfff0) { | |
595 | case 0x0cc0: /* MV88E1111 */ | |
596 | return DNS323_REV_B1; | |
597 | case 0x0e10: /* MV88E1118 */ | |
598 | return DNS323_REV_C1; | |
599 | default: | |
600 | pr_warning("DNS-323: Unknown PHY ID 0x%04x, assuming rev B1\n", | |
601 | reg & 0xffff); | |
602 | } | |
603 | return DNS323_REV_B1; | |
604 | } | |
605 | ||
555a3656 HVR |
606 | static void __init dns323_init(void) |
607 | { | |
608 | /* Setup basic Orion functions. Need to be called early. */ | |
9dd0b194 | 609 | orion5x_init(); |
555a3656 | 610 | |
6e2daa49 BH |
611 | /* Identify revision */ |
612 | system_rev = dns323_identify_rev(); | |
613 | pr_info("DNS-323: Identified HW revision %c1\n", 'A' + system_rev); | |
614 | ||
f93e4159 MP |
615 | /* Just to be tricky, the 5182 has a completely different |
616 | * set of MPP modes to the 5181. | |
617 | */ | |
6e2daa49 BH |
618 | switch(system_rev) { |
619 | case DNS323_REV_A1: | |
620 | orion5x_mpp_conf(dns323a_mpp_modes); | |
f93e4159 | 621 | writel(0, MPP_DEV_CTRL); /* DEV_D[31:16] */ |
6e2daa49 BH |
622 | break; |
623 | case DNS323_REV_B1: | |
624 | orion5x_mpp_conf(dns323b_mpp_modes); | |
625 | break; | |
626 | case DNS323_REV_C1: | |
627 | orion5x_mpp_conf(dns323c_mpp_modes); | |
628 | break; | |
f93e4159 | 629 | } |
555a3656 | 630 | |
044f6c7c LB |
631 | /* setup flash mapping |
632 | * CS3 holds a 8 MB Spansion S29GL064M90TFIR4 | |
633 | */ | |
634 | orion5x_setup_dev_boot_win(DNS323_NOR_BOOT_BASE, DNS323_NOR_BOOT_SIZE); | |
635 | platform_device_register(&dns323_nor_flash); | |
636 | ||
6e2daa49 BH |
637 | /* Sort out LEDs, Buttons and i2c devices */ |
638 | switch(system_rev) { | |
639 | case DNS323_REV_A1: | |
640 | /* The 5181 power LED is active low and requires | |
641 | * DNS323_GPIO_LED_POWER1 to also be low. | |
642 | */ | |
643 | dns323ab_leds[0].active_low = 1; | |
644 | gpio_request(DNS323_GPIO_LED_POWER1, "Power Led Enable"); | |
645 | gpio_direction_output(DNS323_GPIO_LED_POWER1, 0); | |
646 | /* Fall through */ | |
647 | case DNS323_REV_B1: | |
648 | i2c_register_board_info(0, dns323ab_i2c_devices, | |
649 | ARRAY_SIZE(dns323ab_i2c_devices)); | |
650 | break; | |
651 | case DNS323_REV_C1: | |
652 | /* Hookup LEDs & Buttons */ | |
653 | dns323_gpio_leds.dev.platform_data = &dns323c_led_data; | |
654 | dns323_button_device.dev.platform_data = &dns323c_button_data; | |
655 | ||
656 | /* Hookup i2c devices and fan driver */ | |
657 | i2c_register_board_info(0, dns323c_i2c_devices, | |
658 | ARRAY_SIZE(dns323c_i2c_devices)); | |
659 | platform_device_register_simple("dns323c-fan", 0, NULL, 0); | |
660 | ||
661 | /* Register fixup for the PHY LEDs */ | |
662 | phy_register_fixup_for_uid(MARVELL_PHY_ID_88E1118, | |
663 | MARVELL_PHY_ID_MASK, | |
664 | dns323c_phy_fixup); | |
b2a731aa LB |
665 | } |
666 | ||
044f6c7c | 667 | platform_device_register(&dns323_gpio_leds); |
044f6c7c | 668 | platform_device_register(&dns323_button_device); |
555a3656 | 669 | |
a93f44c1 MP |
670 | /* |
671 | * Configure peripherals. | |
672 | */ | |
673 | if (dns323_read_mac_addr() < 0) | |
6e2daa49 | 674 | printk("DNS-323: Failed to read MAC address\n"); |
a93f44c1 MP |
675 | orion5x_ehci0_init(); |
676 | orion5x_eth_init(&dns323_eth_data); | |
677 | orion5x_i2c_init(); | |
678 | orion5x_uart0_init(); | |
679 | ||
6e2daa49 BH |
680 | /* Remaining GPIOs */ |
681 | switch(system_rev) { | |
682 | case DNS323_REV_A1: | |
683 | /* Poweroff GPIO */ | |
684 | if (gpio_request(DNS323_GPIO_POWER_OFF, "POWEROFF") != 0 || | |
685 | gpio_direction_output(DNS323_GPIO_POWER_OFF, 0) != 0) | |
686 | pr_err("DNS-323: failed to setup power-off GPIO\n"); | |
687 | pm_power_off = dns323a_power_off; | |
688 | break; | |
689 | case DNS323_REV_B1: | |
690 | /* 5182 built-in SATA init */ | |
f93e4159 MP |
691 | orion5x_sata_init(&dns323_sata_data); |
692 | ||
6e2daa49 BH |
693 | /* The DNS323 rev B1 has flag to indicate the system is up. |
694 | * Without this flag set, power LED will flash and cannot be | |
695 | * controlled via leds-gpio. | |
696 | */ | |
697 | if (gpio_request(DNS323_GPIO_SYSTEM_UP, "SYS_READY") == 0) | |
698 | gpio_direction_output(DNS323_GPIO_SYSTEM_UP, 1); | |
699 | ||
700 | /* Poweroff GPIO */ | |
701 | if (gpio_request(DNS323_GPIO_POWER_OFF, "POWEROFF") != 0 || | |
702 | gpio_direction_output(DNS323_GPIO_POWER_OFF, 0) != 0) | |
703 | pr_err("DNS-323: failed to setup power-off GPIO\n"); | |
cf11052a | 704 | pm_power_off = dns323b_power_off; |
6e2daa49 BH |
705 | break; |
706 | case DNS323_REV_C1: | |
707 | /* 5182 built-in SATA init */ | |
708 | orion5x_sata_init(&dns323_sata_data); | |
709 | ||
710 | /* Poweroff GPIO */ | |
711 | if (gpio_request(DNS323C_GPIO_POWER_OFF, "POWEROFF") != 0 || | |
712 | gpio_direction_output(DNS323C_GPIO_POWER_OFF, 0) != 0) | |
713 | pr_err("DNS-323: failed to setup power-off GPIO\n"); | |
714 | pm_power_off = dns323c_power_off; | |
715 | ||
716 | /* Now, -this- should theorically be done by the sata_mv driver | |
717 | * once I figure out what's going on there. Maybe the behaviour | |
718 | * of the LEDs should be somewhat passed via the platform_data. | |
719 | * for now, just whack the register and make the LEDs happy | |
720 | * | |
721 | * Note: AFAIK, rev B1 needs the same treatement but I'll let | |
722 | * somebody else test it. | |
723 | */ | |
724 | writel(0x5, ORION5X_SATA_VIRT_BASE | 0x2c); | |
725 | break; | |
726 | } | |
555a3656 HVR |
727 | } |
728 | ||
729 | /* Warning: D-Link uses a wrong mach-type (=526) in their bootloader */ | |
730 | MACHINE_START(DNS323, "D-Link DNS-323") | |
731 | /* Maintainer: Herbert Valerio Riedel <hvr@gnu.org> */ | |
65aa1b1e | 732 | .atag_offset = 0x100, |
555a3656 | 733 | .init_machine = dns323_init, |
9dd0b194 | 734 | .map_io = orion5x_map_io, |
4ee1f6b5 | 735 | .init_early = orion5x_init_early, |
9dd0b194 LB |
736 | .init_irq = orion5x_init_irq, |
737 | .timer = &orion5x_timer, | |
be73a347 | 738 | .fixup = tag_fixup_mem32, |
555a3656 | 739 | MACHINE_END |