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