arch/arm/mach-orion5x/dns323-setup.c

   1 /*
   2  * arch/arm/mach-orion5x/dns323-setup.c
   3  *
   4  * Copyright (C) 2007 Herbert Valerio Riedel <hvr@gnu.org>
   5  *
   6  * Support for HW Rev C1:
   7  *
   8  * Copyright (C) 2010 Benjamin Herrenschmidt <benh@kernel.crashing.org>
   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 #include <linux/gpio.h>
  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/mach/arch.h>
  34 #include <asm/mach/pci.h>
  35 #include <mach/orion5x.h>
  36 #include "common.h"
  37 #include "mpp.h"
  38
  39 /* Rev A1 and B1 */
  40 #define DNS323_GPIO_LED_RIGHT_AMBER     1
  41 #define DNS323_GPIO_LED_LEFT_AMBER      2
  42 #define DNS323_GPIO_SYSTEM_UP           3
  43 #define DNS323_GPIO_LED_POWER1          4
  44 #define DNS323_GPIO_LED_POWER2          5
  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
  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
  68 /****************************************************************************
  69  * PCI setup
  70  */
  71
  72 static int __init dns323_pci_map_irq(const struct pci_dev *dev, u8 slot, u8 pin)
  73 {
  74         int irq;
  75
  76         /*
  77          * Check for devices with hard-wired IRQs.
  78          */
  79         irq = orion5x_pci_map_irq(dev, slot, pin);
  80         if (irq != -1)
  81                 return irq;
  82
  83         return -1;
  84 }
  85
  86 static struct hw_pci dns323_pci __initdata = {
  87         .nr_controllers = 2,
  88         .swizzle        = pci_std_swizzle,
  89         .setup          = orion5x_pci_sys_setup,
  90         .scan           = orion5x_pci_sys_scan_bus,
  91         .map_irq        = dns323_pci_map_irq,
  92 };
  93
  94 static int __init dns323_pci_init(void)
  95 {
  96         /* Rev B1 and C1 doesn't really use its PCI bus, and initialising PCI
  97          * gets in the way of initialising the SATA controller.
  98          */
  99         if (machine_is_dns323() && system_rev == DNS323_REV_A1)
 100                 pci_common_init(&dns323_pci);
 101
 102         return 0;
 103 }
 104
 105 subsys_initcall(dns323_pci_init);
 106
 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,
 142         },
 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,
 160         .dev            = {
 161                 .platform_data  = &dns323_nor_flash_data,
 162         },
 163         .resource       = &dns323_nor_flash_resource,
 164         .num_resources  = 1,
 165 };
 166
 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);
 238         printk("DNS-323: Found ethernet MAC address: ");
 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
 251 /****************************************************************************
 252  * GPIO LEDs (simple - doesn't use hardware blinking support)
 253  */
 254
 255 #define ORION_BLINK_HALF_PERIOD 100 /* ms */
 256
 257 static int dns323_gpio_blink_set(unsigned gpio, int state,
 258         unsigned long *delay_on, unsigned long *delay_off)
 259 {
 260
 261         if (delay_on && delay_off && !*delay_on && !*delay_off)
 262                 *delay_on = *delay_off = ORION_BLINK_HALF_PERIOD;
 263
 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);
 272         }
 273         return 0;
 274 }
 275
 276 static struct gpio_led dns323ab_leds[] = {
 277         {
 278                 .name = "power:blue",
 279                 .gpio = DNS323_GPIO_LED_POWER2,
 280                 .default_trigger = "default-on",
 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
 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,
 320         .gpio_blink_set = dns323_gpio_blink_set,
 321 };
 322
 323 static struct platform_device dns323_gpio_leds = {
 324         .name           = "leds-gpio",
 325         .id             = -1,
 326         .dev            = {
 327                 .platform_data  = &dns323ab_led_data,
 328         },
 329 };
 330
 331 /****************************************************************************
 332  * GPIO Attached Keys
 333  */
 334
 335 static struct gpio_keys_button dns323ab_buttons[] = {
 336         {
 337                 .code           = KEY_RESTART,
 338                 .gpio           = DNS323_GPIO_KEY_RESET,
 339                 .desc           = "Reset Button",
 340                 .active_low     = 1,
 341         }, {
 342                 .code           = KEY_POWER,
 343                 .gpio           = DNS323_GPIO_KEY_POWER,
 344                 .desc           = "Power Button",
 345                 .active_low     = 1,
 346         },
 347 };
 348
 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),
 366 };
 367
 368 static struct platform_device dns323_button_device = {
 369         .name           = "gpio-keys",
 370         .id             = -1,
 371         .num_resources  = 0,
 372         .dev            = {
 373                 .platform_data  = &dns323ab_button_data,
 374         },
 375 };
 376
 377 /*****************************************************************************
 378  * SATA
 379  */
 380 static struct mv_sata_platform_data dns323_sata_data = {
 381        .n_ports        = 2,
 382 };
 383
 384 /****************************************************************************
 385  * General Setup
 386  */
 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,
 409 };
 410
 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,
 433 };
 434
 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,
 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
 477 /*
 478  * On the DNS-323 A1 and B1 the following devices are attached via I2C:
 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  */
 485 static struct i2c_board_info __initdata dns323ab_i2c_devices[] = {
 486         {
 487                 I2C_BOARD_INFO("g760a", 0x3e),
 488         }, {
 489                 I2C_BOARD_INFO("lm75", 0x48),
 490         }, {
 491                 I2C_BOARD_INFO("m41t80", 0x68),
 492         },
 493 };
 494
 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
 510 /* DNS-323 rev. A specific power off method */
 511 static void dns323a_power_off(void)
 512 {
 513         pr_info("DNS-323: Triggering power-off...\n");
 514         gpio_set_value(DNS323_GPIO_POWER_OFF, 1);
 515 }
 516
 517 /* DNS-323 rev B specific power off method */
 518 static void dns323b_power_off(void)
 519 {
 520         pr_info("DNS-323: Triggering power-off...\n");
 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
 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
 606 static void __init dns323_init(void)
 607 {
 608         /* Setup basic Orion functions. Need to be called early. */
 609         orion5x_init();
 610
 611         /* Identify revision */
 612         system_rev = dns323_identify_rev();
 613         pr_info("DNS-323: Identified HW revision %c1\n", 'A' + system_rev);
 614
 615         /* Just to be tricky, the 5182 has a completely different
 616          * set of MPP modes to the 5181.
 617          */
 618         switch(system_rev) {
 619         case DNS323_REV_A1:
 620                 orion5x_mpp_conf(dns323a_mpp_modes);
 621                 writel(0, MPP_DEV_CTRL);                /* DEV_D[31:16] */
 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;
 629         }
 630
 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
 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);
 665         }
 666
 667         platform_device_register(&dns323_gpio_leds);
 668         platform_device_register(&dns323_button_device);
 669
 670         /*
 671          * Configure peripherals.
 672          */
 673         if (dns323_read_mac_addr() < 0)
 674                 printk("DNS-323: Failed to read MAC address\n");
 675         orion5x_ehci0_init();
 676         orion5x_eth_init(&dns323_eth_data);
 677         orion5x_i2c_init();
 678         orion5x_uart0_init();
 679
 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 */
 691                 orion5x_sata_init(&dns323_sata_data);
 692
 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");
 704                 pm_power_off = dns323b_power_off;
 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         }
 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> */
 732         .boot_params    = 0x00000100,
 733         .init_machine   = dns323_init,
 734         .map_io         = orion5x_map_io,
 735         .init_early     = orion5x_init_early,
 736         .init_irq       = orion5x_init_irq,
 737         .timer          = &orion5x_timer,
 738         .fixup          = tag_fixup_mem32,
 739 MACHINE_END