git.oblomov.eu Git - linux-2.6/blob - arch/arm/mach-pxa/magician.c

   1 /*
   2  * Support for HTC Magician PDA phones:
   3  * i-mate JAM, O2 Xda mini, Orange SPV M500, Qtek s100, Qtek s110
   4  * and T-Mobile MDA Compact.
   5  *
   6  * Copyright (c) 2006-2007 Philipp Zabel
   7  *
   8  * Based on hx4700.c, spitz.c and others.
   9  *
  10  * This program is free software; you can redistribute it and/or modify
  11  * it under the terms of the GNU General Public License version 2 as
  12  * published by the Free Software Foundation.
  13  *
  14  */
  15
  16 #include <linux/kernel.h>
  17 #include <linux/init.h>
  18 #include <linux/platform_device.h>
  19 #include <linux/delay.h>
  20 #include <linux/gpio.h>
  21 #include <linux/gpio_keys.h>
  22 #include <linux/input.h>
  23 #include <linux/mfd/htc-egpio.h>
  24 #include <linux/mfd/htc-pasic3.h>
  25 #include <linux/mtd/physmap.h>
  26 #include <linux/pda_power.h>
  27 #include <linux/pwm_backlight.h>
  28
  29 #include <mach/hardware.h>
  30 #include <asm/mach-types.h>
  31 #include <asm/mach/arch.h>
  32 #include <mach/magician.h>
  33 #include <mach/mfp-pxa27x.h>
  34 #include <mach/pxa-regs.h>
  35 #include <mach/pxa2xx-regs.h>
  36 #include <mach/pxafb.h>
  37 #include <mach/i2c.h>
  38 #include <mach/mmc.h>
  39 #include <mach/irda.h>
  40 #include <mach/ohci.h>
  41
  42 #include "devices.h"
  43 #include "generic.h"
  44
  45 static unsigned long magician_pin_config[] __initdata = {
  46
  47         /* SDRAM and Static Memory I/O Signals */
  48         GPIO20_nSDCS_2,
  49         GPIO21_nSDCS_3,
  50         GPIO15_nCS_1,
  51         GPIO78_nCS_2,   /* PASIC3 */
  52         GPIO79_nCS_3,   /* EGPIO CPLD */
  53         GPIO80_nCS_4,
  54         GPIO33_nCS_5,
  55
  56         /* I2C */
  57         GPIO117_I2C_SCL,
  58         GPIO118_I2C_SDA,
  59
  60         /* PWM 0 */
  61         GPIO16_PWM0_OUT,
  62
  63         /* I2S */
  64         GPIO28_I2S_BITCLK_OUT,
  65         GPIO29_I2S_SDATA_IN,
  66         GPIO31_I2S_SYNC,
  67         GPIO113_I2S_SYSCLK,
  68
  69         /* SSP 2 */
  70         GPIO19_SSP2_SCLK,
  71         GPIO14_SSP2_SFRM,
  72         GPIO89_SSP2_TXD,
  73         GPIO88_SSP2_RXD,
  74
  75         /* MMC */
  76         GPIO32_MMC_CLK,
  77         GPIO92_MMC_DAT_0,
  78         GPIO109_MMC_DAT_1,
  79         GPIO110_MMC_DAT_2,
  80         GPIO111_MMC_DAT_3,
  81         GPIO112_MMC_CMD,
  82
  83         /* LCD */
  84         GPIO58_LCD_LDD_0,
  85         GPIO59_LCD_LDD_1,
  86         GPIO60_LCD_LDD_2,
  87         GPIO61_LCD_LDD_3,
  88         GPIO62_LCD_LDD_4,
  89         GPIO63_LCD_LDD_5,
  90         GPIO64_LCD_LDD_6,
  91         GPIO65_LCD_LDD_7,
  92         GPIO66_LCD_LDD_8,
  93         GPIO67_LCD_LDD_9,
  94         GPIO68_LCD_LDD_10,
  95         GPIO69_LCD_LDD_11,
  96         GPIO70_LCD_LDD_12,
  97         GPIO71_LCD_LDD_13,
  98         GPIO72_LCD_LDD_14,
  99         GPIO73_LCD_LDD_15,
 100         GPIO74_LCD_FCLK,
 101         GPIO75_LCD_LCLK,
 102         GPIO76_LCD_PCLK,
 103         GPIO77_LCD_BIAS,
 104
 105         /* QCI */
 106         GPIO12_CIF_DD_7,
 107         GPIO17_CIF_DD_6,
 108         GPIO50_CIF_DD_3,
 109         GPIO51_CIF_DD_2,
 110         GPIO52_CIF_DD_4,
 111         GPIO53_CIF_MCLK,
 112         GPIO54_CIF_PCLK,
 113         GPIO55_CIF_DD_1,
 114         GPIO81_CIF_DD_0,
 115         GPIO82_CIF_DD_5,
 116         GPIO84_CIF_FV,
 117         GPIO85_CIF_LV,
 118
 119         /* Magician specific input GPIOs */
 120         GPIO9_GPIO,     /* unknown */
 121         GPIO10_GPIO,    /* GSM_IRQ */
 122         GPIO13_GPIO,    /* CPLD_IRQ */
 123         GPIO107_GPIO,   /* DS1WM_IRQ */
 124         GPIO108_GPIO,   /* GSM_READY */
 125         GPIO115_GPIO,   /* nPEN_IRQ */
 126 };
 127
 128 /*
 129  * IRDA
 130  */
 131
 132 static void magician_irda_transceiver_mode(struct device *dev, int mode)
 133 {
 134         gpio_set_value(GPIO83_MAGICIAN_nIR_EN, mode & IR_OFF);
 135         pxa2xx_transceiver_mode(dev, mode);
 136 }
 137
 138 static struct pxaficp_platform_data magician_ficp_info = {
 139         .transceiver_cap  = IR_SIRMODE | IR_OFF,
 140         .transceiver_mode = magician_irda_transceiver_mode,
 141 };
 142
 143 /*
 144  * GPIO Keys
 145  */
 146
 147 static struct gpio_keys_button magician_button_table[] = {
 148         {KEY_POWER,      GPIO0_MAGICIAN_KEY_POWER,      0, "Power button"},
 149         {KEY_ESC,        GPIO37_MAGICIAN_KEY_HANGUP,    0, "Hangup button"},
 150         {KEY_F10,        GPIO38_MAGICIAN_KEY_CONTACTS,  0, "Contacts button"},
 151         {KEY_CALENDAR,   GPIO90_MAGICIAN_KEY_CALENDAR,  0, "Calendar button"},
 152         {KEY_CAMERA,     GPIO91_MAGICIAN_KEY_CAMERA,    0, "Camera button"},
 153         {KEY_UP,         GPIO93_MAGICIAN_KEY_UP,        0, "Up button"},
 154         {KEY_DOWN,       GPIO94_MAGICIAN_KEY_DOWN,      0, "Down button"},
 155         {KEY_LEFT,       GPIO95_MAGICIAN_KEY_LEFT,      0, "Left button"},
 156         {KEY_RIGHT,      GPIO96_MAGICIAN_KEY_RIGHT,     0, "Right button"},
 157         {KEY_KPENTER,    GPIO97_MAGICIAN_KEY_ENTER,     0, "Action button"},
 158         {KEY_RECORD,     GPIO98_MAGICIAN_KEY_RECORD,    0, "Record button"},
 159         {KEY_VOLUMEUP,   GPIO100_MAGICIAN_KEY_VOL_UP,   0, "Volume up"},
 160         {KEY_VOLUMEDOWN, GPIO101_MAGICIAN_KEY_VOL_DOWN, 0, "Volume down"},
 161         {KEY_PHONE,      GPIO102_MAGICIAN_KEY_PHONE,    0, "Phone button"},
 162         {KEY_PLAY,       GPIO99_MAGICIAN_HEADPHONE_IN,  0, "Headset button"},
 163 };
 164
 165 static struct gpio_keys_platform_data gpio_keys_data = {
 166         .buttons  = magician_button_table,
 167         .nbuttons = ARRAY_SIZE(magician_button_table),
 168 };
 169
 170 static struct platform_device gpio_keys = {
 171         .name = "gpio-keys",
 172         .dev  = {
 173                 .platform_data = &gpio_keys_data,
 174         },
 175         .id   = -1,
 176 };
 177
 178
 179 /*
 180  * EGPIO (Xilinx CPLD)
 181  *
 182  * 7 32-bit aligned 8-bit registers: 3x output, 1x irq, 3x input
 183  */
 184
 185 static struct resource egpio_resources[] = {
 186         [0] = {
 187                 .start = PXA_CS3_PHYS,
 188                 .end   = PXA_CS3_PHYS + 0x20,
 189                 .flags = IORESOURCE_MEM,
 190         },
 191         [1] = {
 192                 .start = gpio_to_irq(GPIO13_MAGICIAN_CPLD_IRQ),
 193                 .end   = gpio_to_irq(GPIO13_MAGICIAN_CPLD_IRQ),
 194                 .flags = IORESOURCE_IRQ,
 195         },
 196 };
 197
 198 static struct htc_egpio_chip egpio_chips[] = {
 199         [0] = {
 200                 .reg_start = 0,
 201                 .gpio_base = MAGICIAN_EGPIO(0, 0),
 202                 .num_gpios = 24,
 203                 .direction = HTC_EGPIO_OUTPUT,
 204                 .initial_values = 0x40, /* EGPIO_MAGICIAN_GSM_RESET */
 205         },
 206         [1] = {
 207                 .reg_start = 4,
 208                 .gpio_base = MAGICIAN_EGPIO(4, 0),
 209                 .num_gpios = 24,
 210                 .direction = HTC_EGPIO_INPUT,
 211         },
 212 };
 213
 214 static struct htc_egpio_platform_data egpio_info = {
 215         .reg_width    = 8,
 216         .bus_width    = 32,
 217         .irq_base     = IRQ_BOARD_START,
 218         .num_irqs     = 4,
 219         .ack_register = 3,
 220         .chip         = egpio_chips,
 221         .num_chips    = ARRAY_SIZE(egpio_chips),
 222 };
 223
 224 static struct platform_device egpio = {
 225         .name          = "htc-egpio",
 226         .id            = -1,
 227         .resource      = egpio_resources,
 228         .num_resources = ARRAY_SIZE(egpio_resources),
 229         .dev = {
 230                 .platform_data = &egpio_info,
 231         },
 232 };
 233
 234 /*
 235  * LCD - Toppoly TD028STEB1 or Samsung LTP280QV
 236  */
 237
 238 static struct pxafb_mode_info toppoly_modes[] = {
 239         {
 240                 .pixclock     = 96153,
 241                 .bpp          = 16,
 242                 .xres         = 240,
 243                 .yres         = 320,
 244                 .hsync_len    = 11,
 245                 .vsync_len    = 3,
 246                 .left_margin  = 19,
 247                 .upper_margin = 2,
 248                 .right_margin = 10,
 249                 .lower_margin = 2,
 250                 .sync         = 0,
 251         },
 252 };
 253
 254 static struct pxafb_mode_info samsung_modes[] = {
 255         {
 256                 .pixclock     = 96153,
 257                 .bpp          = 16,
 258                 .xres         = 240,
 259                 .yres         = 320,
 260                 .hsync_len    = 8,
 261                 .vsync_len    = 4,
 262                 .left_margin  = 9,
 263                 .upper_margin = 4,
 264                 .right_margin = 9,
 265                 .lower_margin = 4,
 266                 .sync         = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
 267         },
 268 };
 269
 270 static void toppoly_lcd_power(int on, struct fb_var_screeninfo *si)
 271 {
 272         pr_debug("Toppoly LCD power\n");
 273
 274         if (on) {
 275                 pr_debug("on\n");
 276                 gpio_set_value(EGPIO_MAGICIAN_TOPPOLY_POWER, 1);
 277                 gpio_set_value(GPIO106_MAGICIAN_LCD_POWER_3, 1);
 278                 udelay(2000);
 279                 gpio_set_value(EGPIO_MAGICIAN_LCD_POWER, 1);
 280                 udelay(2000);
 281                 /* FIXME: enable LCDC here */
 282                 udelay(2000);
 283                 gpio_set_value(GPIO104_MAGICIAN_LCD_POWER_1, 1);
 284                 udelay(2000);
 285                 gpio_set_value(GPIO105_MAGICIAN_LCD_POWER_2, 1);
 286         } else {
 287                 pr_debug("off\n");
 288                 msleep(15);
 289                 gpio_set_value(GPIO105_MAGICIAN_LCD_POWER_2, 0);
 290                 udelay(500);
 291                 gpio_set_value(GPIO104_MAGICIAN_LCD_POWER_1, 0);
 292                 udelay(1000);
 293                 gpio_set_value(GPIO106_MAGICIAN_LCD_POWER_3, 0);
 294                 gpio_set_value(EGPIO_MAGICIAN_LCD_POWER, 0);
 295         }
 296 }
 297
 298 static void samsung_lcd_power(int on, struct fb_var_screeninfo *si)
 299 {
 300         pr_debug("Samsung LCD power\n");
 301
 302         if (on) {
 303                 pr_debug("on\n");
 304                 if (system_rev < 3)
 305                         gpio_set_value(GPIO75_MAGICIAN_SAMSUNG_POWER, 1);
 306                 else
 307                         gpio_set_value(EGPIO_MAGICIAN_LCD_POWER, 1);
 308                 mdelay(10);
 309                 gpio_set_value(GPIO106_MAGICIAN_LCD_POWER_3, 1);
 310                 mdelay(10);
 311                 gpio_set_value(GPIO104_MAGICIAN_LCD_POWER_1, 1);
 312                 mdelay(30);
 313                 gpio_set_value(GPIO105_MAGICIAN_LCD_POWER_2, 1);
 314                 mdelay(10);
 315         } else {
 316                 pr_debug("off\n");
 317                 mdelay(10);
 318                 gpio_set_value(GPIO105_MAGICIAN_LCD_POWER_2, 0);
 319                 mdelay(30);
 320                 gpio_set_value(GPIO104_MAGICIAN_LCD_POWER_1, 0);
 321                 mdelay(10);
 322                 gpio_set_value(GPIO106_MAGICIAN_LCD_POWER_3, 0);
 323                 mdelay(10);
 324                 if (system_rev < 3)
 325                         gpio_set_value(GPIO75_MAGICIAN_SAMSUNG_POWER, 0);
 326                 else
 327                         gpio_set_value(EGPIO_MAGICIAN_LCD_POWER, 0);
 328         }
 329 }
 330
 331 static struct pxafb_mach_info toppoly_info = {
 332         .modes           = toppoly_modes,
 333         .num_modes       = 1,
 334         .fixed_modes     = 1,
 335         .lccr0           = LCCR0_Color | LCCR0_Sngl | LCCR0_Act,
 336         .lccr3           = LCCR3_PixRsEdg,
 337         .pxafb_lcd_power = toppoly_lcd_power,
 338 };
 339
 340 static struct pxafb_mach_info samsung_info = {
 341         .modes           = samsung_modes,
 342         .num_modes       = 1,
 343         .fixed_modes     = 1,
 344         .lccr0           = LCCR0_LDDALT | LCCR0_Color | LCCR0_Sngl | LCCR0_Act,
 345         .lccr3           = LCCR3_PixFlEdg,
 346         .pxafb_lcd_power = samsung_lcd_power,
 347 };
 348
 349 /*
 350  * Backlight
 351  */
 352
 353 static int magician_backlight_init(struct device *dev)
 354 {
 355         int ret;
 356
 357         ret = gpio_request(EGPIO_MAGICIAN_BL_POWER, "BL_POWER");
 358         if (ret)
 359                 goto err;
 360         ret = gpio_request(EGPIO_MAGICIAN_BL_POWER2, "BL_POWER2");
 361         if (ret)
 362                 goto err2;
 363         return 0;
 364
 365 err2:
 366         gpio_free(EGPIO_MAGICIAN_BL_POWER);
 367 err:
 368         return ret;
 369 }
 370
 371 static int magician_backlight_notify(int brightness)
 372 {
 373         gpio_set_value(EGPIO_MAGICIAN_BL_POWER, brightness);
 374         if (brightness >= 200) {
 375                 gpio_set_value(EGPIO_MAGICIAN_BL_POWER2, 1);
 376                 return brightness - 72;
 377         } else {
 378                 gpio_set_value(EGPIO_MAGICIAN_BL_POWER2, 0);
 379                 return brightness;
 380         }
 381 }
 382
 383 static void magician_backlight_exit(struct device *dev)
 384 {
 385         gpio_free(EGPIO_MAGICIAN_BL_POWER);
 386         gpio_free(EGPIO_MAGICIAN_BL_POWER2);
 387 }
 388
 389 static struct platform_pwm_backlight_data backlight_data = {
 390         .pwm_id         = 0,
 391         .max_brightness = 272,
 392         .dft_brightness = 100,
 393         .pwm_period_ns  = 30923,
 394         .init           = magician_backlight_init,
 395         .notify         = magician_backlight_notify,
 396         .exit           = magician_backlight_exit,
 397 };
 398
 399 static struct platform_device backlight = {
 400         .name = "pwm-backlight",
 401         .id   = -1,
 402         .dev  = {
 403                 .parent        = &pxa27x_device_pwm0.dev,
 404                 .platform_data = &backlight_data,
 405         },
 406 };
 407
 408 /*
 409  * LEDs
 410  */
 411
 412 static struct gpio_led gpio_leds[] = {
 413         {
 414                 .name = "magician::vibra",
 415                 .default_trigger = "none",
 416                 .gpio = GPIO22_MAGICIAN_VIBRA_EN,
 417         },
 418         {
 419                 .name = "magician::phone_bl",
 420                 .default_trigger = "none",
 421                 .gpio = GPIO103_MAGICIAN_LED_KP,
 422         },
 423 };
 424
 425 static struct gpio_led_platform_data gpio_led_info = {
 426         .leds = gpio_leds,
 427         .num_leds = ARRAY_SIZE(gpio_leds),
 428 };
 429
 430 static struct platform_device leds_gpio = {
 431         .name = "leds-gpio",
 432         .id   = -1,
 433         .dev  = {
 434                 .platform_data = &gpio_led_info,
 435         },
 436 };
 437
 438 static struct pasic3_led pasic3_leds[] = {
 439         {
 440                 .led = {
 441                         .name            = "magician:red",
 442                         .default_trigger = "ds2760-battery.0-charging",
 443                 },
 444                 .hw_num = 0,
 445                 .bit2   = PASIC3_BIT2_LED0,
 446                 .mask   = PASIC3_MASK_LED0,
 447         },
 448         {
 449                 .led = {
 450                         .name            = "magician:green",
 451                         .default_trigger = "ds2760-battery.0-charging-or-full",
 452                 },
 453                 .hw_num = 1,
 454                 .bit2   = PASIC3_BIT2_LED1,
 455                 .mask   = PASIC3_MASK_LED1,
 456         },
 457         {
 458                 .led = {
 459                         .name            = "magician:blue",
 460                         .default_trigger = "bluetooth",
 461                 },
 462                 .hw_num = 2,
 463                 .bit2   = PASIC3_BIT2_LED2,
 464                 .mask   = PASIC3_MASK_LED2,
 465         },
 466 };
 467
 468 static struct platform_device pasic3;
 469
 470 static struct pasic3_leds_machinfo pasic3_leds_info = {
 471         .num_leds   = ARRAY_SIZE(pasic3_leds),
 472         .power_gpio = EGPIO_MAGICIAN_LED_POWER,
 473         .leds       = pasic3_leds,
 474 };
 475
 476 /*
 477  * PASIC3 with DS1WM
 478  */
 479
 480 static struct resource pasic3_resources[] = {
 481         [0] = {
 482                 .start  = PXA_CS2_PHYS,
 483                 .end    = PXA_CS2_PHYS + 0x1b,
 484                 .flags  = IORESOURCE_MEM,
 485         },
 486         /* No IRQ handler in the PASIC3, DS1WM needs an external IRQ */
 487         [1] = {
 488                 .start  = gpio_to_irq(GPIO107_MAGICIAN_DS1WM_IRQ),
 489                 .end    = gpio_to_irq(GPIO107_MAGICIAN_DS1WM_IRQ),
 490                 .flags  = IORESOURCE_IRQ | IORESOURCE_IRQ_HIGHEDGE,
 491         }
 492 };
 493
 494 static struct pasic3_platform_data pasic3_platform_data = {
 495         .bus_shift  = 2,
 496         .led_pdata  = &pasic3_leds_info,
 497         .clock_rate = 4000000,
 498 };
 499
 500 static struct platform_device pasic3 = {
 501         .name           = "pasic3",
 502         .id             = -1,
 503         .num_resources  = ARRAY_SIZE(pasic3_resources),
 504         .resource       = pasic3_resources,
 505         .dev = {
 506                 .platform_data = &pasic3_platform_data,
 507         },
 508 };
 509
 510 /*
 511  * External power
 512  */
 513
 514 static int power_supply_init(struct device *dev)
 515 {
 516         int ret;
 517
 518         ret = gpio_request(EGPIO_MAGICIAN_CABLE_STATE_AC, "CABLE_STATE_AC");
 519         if (ret)
 520                 goto err_cs_ac;
 521         ret = gpio_request(EGPIO_MAGICIAN_CABLE_STATE_USB, "CABLE_STATE_USB");
 522         if (ret)
 523                 goto err_cs_usb;
 524         ret = gpio_request(EGPIO_MAGICIAN_CHARGE_EN, "CHARGE_EN");
 525         if (ret)
 526                 goto err_chg_en;
 527         ret = gpio_request(GPIO30_MAGICIAN_nCHARGE_EN, "nCHARGE_EN");
 528         if (!ret)
 529                 ret = gpio_direction_output(GPIO30_MAGICIAN_nCHARGE_EN, 0);
 530         if (ret)
 531                 goto err_nchg_en;
 532
 533         return 0;
 534
 535 err_nchg_en:
 536         gpio_free(EGPIO_MAGICIAN_CHARGE_EN);
 537 err_chg_en:
 538         gpio_free(EGPIO_MAGICIAN_CABLE_STATE_USB);
 539 err_cs_usb:
 540         gpio_free(EGPIO_MAGICIAN_CABLE_STATE_AC);
 541 err_cs_ac:
 542         return ret;
 543 }
 544
 545 static int magician_is_ac_online(void)
 546 {
 547         return gpio_get_value(EGPIO_MAGICIAN_CABLE_STATE_AC);
 548 }
 549
 550 static int magician_is_usb_online(void)
 551 {
 552         return gpio_get_value(EGPIO_MAGICIAN_CABLE_STATE_USB);
 553 }
 554
 555 static void magician_set_charge(int flags)
 556 {
 557         gpio_set_value(GPIO30_MAGICIAN_nCHARGE_EN, !flags);
 558         gpio_set_value(EGPIO_MAGICIAN_CHARGE_EN, flags);
 559 }
 560
 561 static void power_supply_exit(struct device *dev)
 562 {
 563         gpio_free(GPIO30_MAGICIAN_nCHARGE_EN);
 564         gpio_free(EGPIO_MAGICIAN_CHARGE_EN);
 565         gpio_free(EGPIO_MAGICIAN_CABLE_STATE_USB);
 566         gpio_free(EGPIO_MAGICIAN_CABLE_STATE_AC);
 567 }
 568
 569 static char *magician_supplicants[] = {
 570         "ds2760-battery.0", "backup-battery"
 571 };
 572
 573 static struct pda_power_pdata power_supply_info = {
 574         .init            = power_supply_init,
 575         .is_ac_online    = magician_is_ac_online,
 576         .is_usb_online   = magician_is_usb_online,
 577         .set_charge      = magician_set_charge,
 578         .exit            = power_supply_exit,
 579         .supplied_to     = magician_supplicants,
 580         .num_supplicants = ARRAY_SIZE(magician_supplicants),
 581 };
 582
 583 static struct resource power_supply_resources[] = {
 584         [0] = {
 585                 .name  = "ac",
 586                 .flags = IORESOURCE_IRQ,
 587                 .start = IRQ_MAGICIAN_AC,
 588                 .end   = IRQ_MAGICIAN_AC,
 589         },
 590         [1] = {
 591                 .name  = "usb",
 592                 .flags = IORESOURCE_IRQ,
 593                 .start = IRQ_MAGICIAN_AC,
 594                 .end   = IRQ_MAGICIAN_AC,
 595         },
 596 };
 597
 598 static struct platform_device power_supply = {
 599         .name = "pda-power",
 600         .id   = -1,
 601         .dev  = {
 602                 .platform_data = &power_supply_info,
 603         },
 604         .resource      = power_supply_resources,
 605         .num_resources = ARRAY_SIZE(power_supply_resources),
 606 };
 607
 608
 609 /*
 610  * MMC/SD
 611  */
 612
 613 static int magician_mci_init(struct device *dev,
 614                                 irq_handler_t detect_irq, void *data)
 615 {
 616         int err;
 617
 618         err = request_irq(IRQ_MAGICIAN_SD, detect_irq,
 619                                 IRQF_DISABLED | IRQF_SAMPLE_RANDOM,
 620                                 "MMC card detect", data);
 621         if (err)
 622                 goto err_request_irq;
 623         err = gpio_request(EGPIO_MAGICIAN_SD_POWER, "SD_POWER");
 624         if (err)
 625                 goto err_request_power;
 626         err = gpio_request(EGPIO_MAGICIAN_nSD_READONLY, "nSD_READONLY");
 627         if (err)
 628                 goto err_request_readonly;
 629
 630         return 0;
 631
 632 err_request_readonly:
 633         gpio_free(EGPIO_MAGICIAN_SD_POWER);
 634 err_request_power:
 635         free_irq(IRQ_MAGICIAN_SD, data);
 636 err_request_irq:
 637         return err;
 638 }
 639
 640 static void magician_mci_setpower(struct device *dev, unsigned int vdd)
 641 {
 642         struct pxamci_platform_data *pdata = dev->platform_data;
 643
 644         gpio_set_value(EGPIO_MAGICIAN_SD_POWER, (1 << vdd) & pdata->ocr_mask);
 645 }
 646
 647 static int magician_mci_get_ro(struct device *dev)
 648 {
 649         return (!gpio_get_value(EGPIO_MAGICIAN_nSD_READONLY));
 650 }
 651
 652 static void magician_mci_exit(struct device *dev, void *data)
 653 {
 654         gpio_free(EGPIO_MAGICIAN_nSD_READONLY);
 655         gpio_free(EGPIO_MAGICIAN_SD_POWER);
 656         free_irq(IRQ_MAGICIAN_SD, data);
 657 }
 658
 659 static struct pxamci_platform_data magician_mci_info = {
 660         .ocr_mask = MMC_VDD_32_33|MMC_VDD_33_34,
 661         .init     = magician_mci_init,
 662         .get_ro   = magician_mci_get_ro,
 663         .setpower = magician_mci_setpower,
 664         .exit     = magician_mci_exit,
 665 };
 666
 667
 668 /*
 669  * USB OHCI
 670  */
 671
 672 static struct pxaohci_platform_data magician_ohci_info = {
 673         .port_mode      = PMM_PERPORT_MODE,
 674         .flags          = ENABLE_PORT1 | ENABLE_PORT3 | POWER_CONTROL_LOW,
 675         .power_budget   = 0,
 676 };
 677
 678
 679 /*
 680  * StrataFlash
 681  */
 682
 683 static void magician_set_vpp(struct map_info *map, int vpp)
 684 {
 685         gpio_set_value(EGPIO_MAGICIAN_FLASH_VPP, vpp);
 686 }
 687
 688 #define PXA_CS_SIZE             0x04000000
 689
 690 static struct resource strataflash_resource = {
 691         .start = PXA_CS0_PHYS,
 692         .end   = PXA_CS0_PHYS + PXA_CS_SIZE - 1,
 693         .flags = IORESOURCE_MEM,
 694 };
 695
 696 static struct physmap_flash_data strataflash_data = {
 697         .width = 4,
 698         .set_vpp = magician_set_vpp,
 699 };
 700
 701 static struct platform_device strataflash = {
 702         .name          = "physmap-flash",
 703         .id            = -1,
 704         .resource      = &strataflash_resource,
 705         .num_resources = 1,
 706         .dev = {
 707                 .platform_data = &strataflash_data,
 708         },
 709 };
 710
 711 /*
 712  * Platform devices
 713  */
 714
 715 static struct platform_device *devices[] __initdata = {
 716         &gpio_keys,
 717         &egpio,
 718         &backlight,
 719         &pasic3,
 720         &power_supply,
 721         &strataflash,
 722         &leds_gpio,
 723 };
 724
 725 static void __init magician_init(void)
 726 {
 727         void __iomem *cpld;
 728         int lcd_select;
 729         int err;
 730
 731         gpio_request(GPIO13_MAGICIAN_CPLD_IRQ, "CPLD_IRQ");
 732         gpio_request(GPIO107_MAGICIAN_DS1WM_IRQ, "DS1WM_IRQ");
 733
 734         pxa2xx_mfp_config(ARRAY_AND_SIZE(magician_pin_config));
 735
 736         platform_add_devices(devices, ARRAY_SIZE(devices));
 737
 738         err = gpio_request(GPIO83_MAGICIAN_nIR_EN, "nIR_EN");
 739         if (!err) {
 740                 gpio_direction_output(GPIO83_MAGICIAN_nIR_EN, 1);
 741                 pxa_set_ficp_info(&magician_ficp_info);
 742         }
 743         pxa_set_i2c_info(NULL);
 744         pxa_set_mci_info(&magician_mci_info);
 745         pxa_set_ohci_info(&magician_ohci_info);
 746
 747         /* Check LCD type we have */
 748         cpld = ioremap_nocache(PXA_CS3_PHYS, 0x1000);
 749         if (cpld) {
 750                 u8 board_id = __raw_readb(cpld+0x14);
 751                 iounmap(cpld);
 752                 system_rev = board_id & 0x7;
 753                 lcd_select = board_id & 0x8;
 754                 pr_info("LCD type: %s\n", lcd_select ? "Samsung" : "Toppoly");
 755                 if (lcd_select && (system_rev < 3)) {
 756                         gpio_request(GPIO75_MAGICIAN_SAMSUNG_POWER, "SAMSUNG_POWER");
 757                         gpio_direction_output(GPIO75_MAGICIAN_SAMSUNG_POWER, 0);
 758                 }
 759                 gpio_request(GPIO104_MAGICIAN_LCD_POWER_1, "LCD_POWER_1");
 760                 gpio_request(GPIO105_MAGICIAN_LCD_POWER_2, "LCD_POWER_2");
 761                 gpio_request(GPIO106_MAGICIAN_LCD_POWER_3, "LCD_POWER_3");
 762                 gpio_direction_output(GPIO104_MAGICIAN_LCD_POWER_1, 0);
 763                 gpio_direction_output(GPIO105_MAGICIAN_LCD_POWER_2, 0);
 764                 gpio_direction_output(GPIO106_MAGICIAN_LCD_POWER_3, 0);
 765                 set_pxa_fb_info(lcd_select ? &samsung_info : &toppoly_info);
 766         } else
 767                 pr_err("LCD detection: CPLD mapping failed\n");
 768 }
 769
 770
 771 MACHINE_START(MAGICIAN, "HTC Magician")
 772         .phys_io = 0x40000000,
 773         .io_pg_offst = (io_p2v(0x40000000) >> 18) & 0xfffc,
 774         .boot_params = 0xa0000100,
 775         .map_io = pxa_map_io,
 776         .init_irq = pxa27x_init_irq,
 777         .init_machine = magician_init,
 778         .timer = &pxa_timer,
 779 MACHINE_END