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