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