Merge branch 'for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/viro/signal
[sfrench/cifs-2.6.git] / arch / arm / mach-s3c24xx / mach-h1940.c
1 /*
2  * Copyright (c) 2003-2005 Simtec Electronics
3  *   Ben Dooks <ben@simtec.co.uk>
4  *
5  * http://www.handhelds.org/projects/h1940.html
6  *
7  * This program is free software; you can redistribute it and/or modify
8  * it under the terms of the GNU General Public License version 2 as
9  * published by the Free Software Foundation.
10  *
11 */
12
13 #include <linux/kernel.h>
14 #include <linux/types.h>
15 #include <linux/interrupt.h>
16 #include <linux/list.h>
17 #include <linux/memblock.h>
18 #include <linux/timer.h>
19 #include <linux/init.h>
20 #include <linux/device.h>
21 #include <linux/serial_core.h>
22 #include <linux/platform_device.h>
23 #include <linux/io.h>
24 #include <linux/gpio.h>
25 #include <linux/input.h>
26 #include <linux/gpio_keys.h>
27 #include <linux/pwm_backlight.h>
28 #include <linux/i2c.h>
29 #include <linux/leds.h>
30 #include <linux/pda_power.h>
31 #include <linux/s3c_adc_battery.h>
32 #include <linux/delay.h>
33
34 #include <video/platform_lcd.h>
35
36 #include <linux/mmc/host.h>
37 #include <linux/export.h>
38
39 #include <asm/irq.h>
40 #include <asm/mach-types.h>
41 #include <asm/mach/arch.h>
42 #include <asm/mach/map.h>
43 #include <asm/mach/irq.h>
44
45 #include <linux/platform_data/i2c-s3c2410.h>
46 #include <linux/platform_data/mmc-s3cmci.h>
47 #include <linux/platform_data/touchscreen-s3c2410.h>
48 #include <linux/platform_data/usb-s3c2410_udc.h>
49
50 #include <sound/uda1380.h>
51
52 #include <mach/fb.h>
53 #include <mach/hardware.h>
54 #include <mach/regs-clock.h>
55 #include <mach/regs-gpio.h>
56 #include <mach/regs-lcd.h>
57
58 #include <plat/clock.h>
59 #include <plat/cpu.h>
60 #include <plat/devs.h>
61 #include <plat/gpio-cfg.h>
62 #include <plat/pll.h>
63 #include <plat/pm.h>
64 #include <plat/regs-serial.h>
65
66
67 #include "common.h"
68 #include "h1940.h"
69
70 #define H1940_LATCH             ((void __force __iomem *)0xF8000000)
71
72 #define H1940_PA_LATCH          S3C2410_CS2
73
74 #define H1940_LATCH_BIT(x)      (1 << ((x) + 16 - S3C_GPIO_END))
75
76 static struct map_desc h1940_iodesc[] __initdata = {
77         [0] = {
78                 .virtual        = (unsigned long)H1940_LATCH,
79                 .pfn            = __phys_to_pfn(H1940_PA_LATCH),
80                 .length         = SZ_16K,
81                 .type           = MT_DEVICE
82         },
83 };
84
85 #define UCON S3C2410_UCON_DEFAULT | S3C2410_UCON_UCLK
86 #define ULCON S3C2410_LCON_CS8 | S3C2410_LCON_PNONE | S3C2410_LCON_STOPB
87 #define UFCON S3C2410_UFCON_RXTRIG8 | S3C2410_UFCON_FIFOMODE
88
89 static struct s3c2410_uartcfg h1940_uartcfgs[] __initdata = {
90         [0] = {
91                 .hwport      = 0,
92                 .flags       = 0,
93                 .ucon        = 0x3c5,
94                 .ulcon       = 0x03,
95                 .ufcon       = 0x51,
96         },
97         [1] = {
98                 .hwport      = 1,
99                 .flags       = 0,
100                 .ucon        = 0x245,
101                 .ulcon       = 0x03,
102                 .ufcon       = 0x00,
103         },
104         /* IR port */
105         [2] = {
106                 .hwport      = 2,
107                 .flags       = 0,
108                 .uart_flags  = UPF_CONS_FLOW,
109                 .ucon        = 0x3c5,
110                 .ulcon       = 0x43,
111                 .ufcon       = 0x51,
112         }
113 };
114
115 /* Board control latch control */
116
117 static unsigned int latch_state;
118
119 static void h1940_latch_control(unsigned int clear, unsigned int set)
120 {
121         unsigned long flags;
122
123         local_irq_save(flags);
124
125         latch_state &= ~clear;
126         latch_state |= set;
127
128         __raw_writel(latch_state, H1940_LATCH);
129
130         local_irq_restore(flags);
131 }
132
133 static inline int h1940_gpiolib_to_latch(int offset)
134 {
135         return 1 << (offset + 16);
136 }
137
138 static void h1940_gpiolib_latch_set(struct gpio_chip *chip,
139                                         unsigned offset, int value)
140 {
141         int latch_bit = h1940_gpiolib_to_latch(offset);
142
143         h1940_latch_control(value ? 0 : latch_bit,
144                 value ? latch_bit : 0);
145 }
146
147 static int h1940_gpiolib_latch_output(struct gpio_chip *chip,
148                                         unsigned offset, int value)
149 {
150         h1940_gpiolib_latch_set(chip, offset, value);
151         return 0;
152 }
153
154 static int h1940_gpiolib_latch_get(struct gpio_chip *chip,
155                                         unsigned offset)
156 {
157         return (latch_state >> (offset + 16)) & 1;
158 }
159
160 static struct gpio_chip h1940_latch_gpiochip = {
161         .base                   = H1940_LATCH_GPIO(0),
162         .owner                  = THIS_MODULE,
163         .label                  = "H1940_LATCH",
164         .ngpio                  = 16,
165         .direction_output       = h1940_gpiolib_latch_output,
166         .set                    = h1940_gpiolib_latch_set,
167         .get                    = h1940_gpiolib_latch_get,
168 };
169
170 static struct s3c2410_udc_mach_info h1940_udc_cfg __initdata = {
171         .vbus_pin               = S3C2410_GPG(5),
172         .vbus_pin_inverted      = 1,
173         .pullup_pin             = H1940_LATCH_USB_DP,
174 };
175
176 static struct s3c2410_ts_mach_info h1940_ts_cfg __initdata = {
177                 .delay = 10000,
178                 .presc = 49,
179                 .oversampling_shift = 2,
180                 .cfg_gpio = s3c24xx_ts_cfg_gpio,
181 };
182
183 /**
184  * Set lcd on or off
185  **/
186 static struct s3c2410fb_display h1940_lcd __initdata = {
187         .lcdcon5=       S3C2410_LCDCON5_FRM565 | \
188                         S3C2410_LCDCON5_INVVLINE | \
189                         S3C2410_LCDCON5_HWSWP,
190
191         .type =         S3C2410_LCDCON1_TFT,
192         .width =        240,
193         .height =       320,
194         .pixclock =     260000,
195         .xres =         240,
196         .yres =         320,
197         .bpp =          16,
198         .left_margin =  8,
199         .right_margin = 20,
200         .hsync_len =    4,
201         .upper_margin = 8,
202         .lower_margin = 7,
203         .vsync_len =    1,
204 };
205
206 static struct s3c2410fb_mach_info h1940_fb_info __initdata = {
207         .displays = &h1940_lcd,
208         .num_displays = 1,
209         .default_display = 0,
210
211         .lpcsel =       0x02,
212         .gpccon =       0xaa940659,
213         .gpccon_mask =  0xffffc0f0,
214         .gpcup =        0x0000ffff,
215         .gpcup_mask =   0xffffffff,
216         .gpdcon =       0xaa84aaa0,
217         .gpdcon_mask =  0xffffffff,
218         .gpdup =        0x0000faff,
219         .gpdup_mask =   0xffffffff,
220 };
221
222 static int power_supply_init(struct device *dev)
223 {
224         return gpio_request(S3C2410_GPF(2), "cable plugged");
225 }
226
227 static int h1940_is_ac_online(void)
228 {
229         return !gpio_get_value(S3C2410_GPF(2));
230 }
231
232 static void power_supply_exit(struct device *dev)
233 {
234         gpio_free(S3C2410_GPF(2));
235 }
236
237 static char *h1940_supplicants[] = {
238         "main-battery",
239         "backup-battery",
240 };
241
242 static struct pda_power_pdata power_supply_info = {
243         .init                   = power_supply_init,
244         .is_ac_online           = h1940_is_ac_online,
245         .exit                   = power_supply_exit,
246         .supplied_to            = h1940_supplicants,
247         .num_supplicants        = ARRAY_SIZE(h1940_supplicants),
248 };
249
250 static struct resource power_supply_resources[] = {
251         [0] = DEFINE_RES_NAMED(IRQ_EINT2, 1, "ac", IORESOURCE_IRQ \
252                         | IORESOURCE_IRQ_LOWEDGE | IORESOURCE_IRQ_HIGHEDGE),
253 };
254
255 static struct platform_device power_supply = {
256         .name           = "pda-power",
257         .id             = -1,
258         .dev            = {
259                                 .platform_data =
260                                         &power_supply_info,
261         },
262         .resource       = power_supply_resources,
263         .num_resources  = ARRAY_SIZE(power_supply_resources),
264 };
265
266 static const struct s3c_adc_bat_thresh bat_lut_noac[] = {
267         { .volt = 4070, .cur = 162, .level = 100},
268         { .volt = 4040, .cur = 165, .level = 95},
269         { .volt = 4016, .cur = 164, .level = 90},
270         { .volt = 3996, .cur = 166, .level = 85},
271         { .volt = 3971, .cur = 168, .level = 80},
272         { .volt = 3951, .cur = 168, .level = 75},
273         { .volt = 3931, .cur = 170, .level = 70},
274         { .volt = 3903, .cur = 172, .level = 65},
275         { .volt = 3886, .cur = 172, .level = 60},
276         { .volt = 3858, .cur = 176, .level = 55},
277         { .volt = 3842, .cur = 176, .level = 50},
278         { .volt = 3818, .cur = 176, .level = 45},
279         { .volt = 3789, .cur = 180, .level = 40},
280         { .volt = 3769, .cur = 180, .level = 35},
281         { .volt = 3749, .cur = 184, .level = 30},
282         { .volt = 3732, .cur = 184, .level = 25},
283         { .volt = 3716, .cur = 184, .level = 20},
284         { .volt = 3708, .cur = 184, .level = 15},
285         { .volt = 3716, .cur = 96, .level = 10},
286         { .volt = 3700, .cur = 96, .level = 5},
287         { .volt = 3684, .cur = 96, .level = 0},
288 };
289
290 static const struct s3c_adc_bat_thresh bat_lut_acin[] = {
291         { .volt = 4130, .cur = 0, .level = 100},
292         { .volt = 3982, .cur = 0, .level = 50},
293         { .volt = 3854, .cur = 0, .level = 10},
294         { .volt = 3841, .cur = 0, .level = 0},
295 };
296
297 static int h1940_bat_init(void)
298 {
299         int ret;
300
301         ret = gpio_request(H1940_LATCH_SM803_ENABLE, "h1940-charger-enable");
302         if (ret)
303                 return ret;
304         gpio_direction_output(H1940_LATCH_SM803_ENABLE, 0);
305
306         return 0;
307
308 }
309
310 static void h1940_bat_exit(void)
311 {
312         gpio_free(H1940_LATCH_SM803_ENABLE);
313 }
314
315 static void h1940_enable_charger(void)
316 {
317         gpio_set_value(H1940_LATCH_SM803_ENABLE, 1);
318 }
319
320 static void h1940_disable_charger(void)
321 {
322         gpio_set_value(H1940_LATCH_SM803_ENABLE, 0);
323 }
324
325 static struct s3c_adc_bat_pdata h1940_bat_cfg = {
326         .init = h1940_bat_init,
327         .exit = h1940_bat_exit,
328         .enable_charger = h1940_enable_charger,
329         .disable_charger = h1940_disable_charger,
330         .gpio_charge_finished = S3C2410_GPF(3),
331         .gpio_inverted = 1,
332         .lut_noac = bat_lut_noac,
333         .lut_noac_cnt = ARRAY_SIZE(bat_lut_noac),
334         .lut_acin = bat_lut_acin,
335         .lut_acin_cnt = ARRAY_SIZE(bat_lut_acin),
336         .volt_channel = 0,
337         .current_channel = 1,
338         .volt_mult = 4056,
339         .current_mult = 1893,
340         .internal_impedance = 200,
341         .backup_volt_channel = 3,
342         /* TODO Check backup volt multiplier */
343         .backup_volt_mult = 4056,
344         .backup_volt_min = 0,
345         .backup_volt_max = 4149288
346 };
347
348 static struct platform_device h1940_battery = {
349         .name             = "s3c-adc-battery",
350         .id               = -1,
351         .dev = {
352                 .parent = &s3c_device_adc.dev,
353                 .platform_data = &h1940_bat_cfg,
354         },
355 };
356
357 static DEFINE_SPINLOCK(h1940_blink_spin);
358
359 int h1940_led_blink_set(unsigned gpio, int state,
360         unsigned long *delay_on, unsigned long *delay_off)
361 {
362         int blink_gpio, check_gpio1, check_gpio2;
363
364         switch (gpio) {
365         case H1940_LATCH_LED_GREEN:
366                 blink_gpio = S3C2410_GPA(7);
367                 check_gpio1 = S3C2410_GPA(1);
368                 check_gpio2 = S3C2410_GPA(3);
369                 break;
370         case H1940_LATCH_LED_RED:
371                 blink_gpio = S3C2410_GPA(1);
372                 check_gpio1 = S3C2410_GPA(7);
373                 check_gpio2 = S3C2410_GPA(3);
374                 break;
375         default:
376                 blink_gpio = S3C2410_GPA(3);
377                 check_gpio1 = S3C2410_GPA(1);
378                 check_gpio2 = S3C2410_GPA(7);
379                 break;
380         }
381
382         if (delay_on && delay_off && !*delay_on && !*delay_off)
383                 *delay_on = *delay_off = 500;
384
385         spin_lock(&h1940_blink_spin);
386
387         switch (state) {
388         case GPIO_LED_NO_BLINK_LOW:
389         case GPIO_LED_NO_BLINK_HIGH:
390                 if (!gpio_get_value(check_gpio1) &&
391                     !gpio_get_value(check_gpio2))
392                         gpio_set_value(H1940_LATCH_LED_FLASH, 0);
393                 gpio_set_value(blink_gpio, 0);
394                 if (gpio_is_valid(gpio))
395                         gpio_set_value(gpio, state);
396                 break;
397         case GPIO_LED_BLINK:
398                 if (gpio_is_valid(gpio))
399                         gpio_set_value(gpio, 0);
400                 gpio_set_value(H1940_LATCH_LED_FLASH, 1);
401                 gpio_set_value(blink_gpio, 1);
402                 break;
403         }
404
405         spin_unlock(&h1940_blink_spin);
406
407         return 0;
408 }
409 EXPORT_SYMBOL(h1940_led_blink_set);
410
411 static struct gpio_led h1940_leds_desc[] = {
412         {
413                 .name                   = "Green",
414                 .default_trigger        = "main-battery-full",
415                 .gpio                   = H1940_LATCH_LED_GREEN,
416                 .retain_state_suspended = 1,
417         },
418         {
419                 .name                   = "Red",
420                 .default_trigger
421                         = "main-battery-charging-blink-full-solid",
422                 .gpio                   = H1940_LATCH_LED_RED,
423                 .retain_state_suspended = 1,
424         },
425 };
426
427 static struct gpio_led_platform_data h1940_leds_pdata = {
428         .num_leds       = ARRAY_SIZE(h1940_leds_desc),
429         .leds           = h1940_leds_desc,
430         .gpio_blink_set = h1940_led_blink_set,
431 };
432
433 static struct platform_device h1940_device_leds = {
434         .name   = "leds-gpio",
435         .id     = -1,
436         .dev    = {
437                         .platform_data = &h1940_leds_pdata,
438         },
439 };
440
441 static struct platform_device h1940_device_bluetooth = {
442         .name             = "h1940-bt",
443         .id               = -1,
444 };
445
446 static void h1940_set_mmc_power(unsigned char power_mode, unsigned short vdd)
447 {
448         switch (power_mode) {
449         case MMC_POWER_OFF:
450                 gpio_set_value(H1940_LATCH_SD_POWER, 0);
451                 break;
452         case MMC_POWER_UP:
453         case MMC_POWER_ON:
454                 gpio_set_value(H1940_LATCH_SD_POWER, 1);
455                 break;
456         default:
457                 break;
458         }
459 }
460
461 static struct s3c24xx_mci_pdata h1940_mmc_cfg __initdata = {
462         .gpio_detect   = S3C2410_GPF(5),
463         .gpio_wprotect = S3C2410_GPH(8),
464         .set_power     = h1940_set_mmc_power,
465         .ocr_avail     = MMC_VDD_32_33,
466 };
467
468 static int h1940_backlight_init(struct device *dev)
469 {
470         gpio_request(S3C2410_GPB(0), "Backlight");
471
472         gpio_direction_output(S3C2410_GPB(0), 0);
473         s3c_gpio_setpull(S3C2410_GPB(0), S3C_GPIO_PULL_NONE);
474         s3c_gpio_cfgpin(S3C2410_GPB(0), S3C2410_GPB0_TOUT0);
475         gpio_set_value(H1940_LATCH_MAX1698_nSHUTDOWN, 1);
476
477         return 0;
478 }
479
480 static int h1940_backlight_notify(struct device *dev, int brightness)
481 {
482         if (!brightness) {
483                 gpio_direction_output(S3C2410_GPB(0), 1);
484                 gpio_set_value(H1940_LATCH_MAX1698_nSHUTDOWN, 0);
485         } else {
486                 gpio_direction_output(S3C2410_GPB(0), 0);
487                 s3c_gpio_setpull(S3C2410_GPB(0), S3C_GPIO_PULL_NONE);
488                 s3c_gpio_cfgpin(S3C2410_GPB(0), S3C2410_GPB0_TOUT0);
489                 gpio_set_value(H1940_LATCH_MAX1698_nSHUTDOWN, 1);
490         }
491         return brightness;
492 }
493
494 static void h1940_backlight_exit(struct device *dev)
495 {
496         gpio_direction_output(S3C2410_GPB(0), 1);
497         gpio_set_value(H1940_LATCH_MAX1698_nSHUTDOWN, 0);
498 }
499
500
501 static struct platform_pwm_backlight_data backlight_data = {
502         .pwm_id         = 0,
503         .max_brightness = 100,
504         .dft_brightness = 50,
505         /* tcnt = 0x31 */
506         .pwm_period_ns  = 36296,
507         .init           = h1940_backlight_init,
508         .notify         = h1940_backlight_notify,
509         .exit           = h1940_backlight_exit,
510 };
511
512 static struct platform_device h1940_backlight = {
513         .name = "pwm-backlight",
514         .dev  = {
515                 .parent = &s3c_device_timer[0].dev,
516                 .platform_data = &backlight_data,
517         },
518         .id   = -1,
519 };
520
521 static void h1940_lcd_power_set(struct plat_lcd_data *pd,
522                                         unsigned int power)
523 {
524         int value, retries = 100;
525
526         if (!power) {
527                 gpio_set_value(S3C2410_GPC(0), 0);
528                 /* wait for 3ac */
529                 do {
530                         value = gpio_get_value(S3C2410_GPC(6));
531                 } while (value && retries--);
532
533                 gpio_set_value(H1940_LATCH_LCD_P2, 0);
534                 gpio_set_value(H1940_LATCH_LCD_P3, 0);
535                 gpio_set_value(H1940_LATCH_LCD_P4, 0);
536
537                 gpio_direction_output(S3C2410_GPC(1), 0);
538                 gpio_direction_output(S3C2410_GPC(4), 0);
539
540                 gpio_set_value(H1940_LATCH_LCD_P1, 0);
541                 gpio_set_value(H1940_LATCH_LCD_P0, 0);
542
543                 gpio_set_value(S3C2410_GPC(5), 0);
544
545         } else {
546                 gpio_set_value(H1940_LATCH_LCD_P0, 1);
547                 gpio_set_value(H1940_LATCH_LCD_P1, 1);
548
549                 gpio_direction_input(S3C2410_GPC(1));
550                 gpio_direction_input(S3C2410_GPC(4));
551                 mdelay(10);
552                 s3c_gpio_cfgpin(S3C2410_GPC(1), S3C_GPIO_SFN(2));
553                 s3c_gpio_cfgpin(S3C2410_GPC(4), S3C_GPIO_SFN(2));
554
555                 gpio_set_value(S3C2410_GPC(5), 1);
556                 gpio_set_value(S3C2410_GPC(0), 1);
557
558                 gpio_set_value(H1940_LATCH_LCD_P3, 1);
559                 gpio_set_value(H1940_LATCH_LCD_P2, 1);
560                 gpio_set_value(H1940_LATCH_LCD_P4, 1);
561         }
562 }
563
564 static struct plat_lcd_data h1940_lcd_power_data = {
565         .set_power      = h1940_lcd_power_set,
566 };
567
568 static struct platform_device h1940_lcd_powerdev = {
569         .name                   = "platform-lcd",
570         .dev.parent             = &s3c_device_lcd.dev,
571         .dev.platform_data      = &h1940_lcd_power_data,
572 };
573
574 static struct uda1380_platform_data uda1380_info = {
575         .gpio_power     = H1940_LATCH_UDA_POWER,
576         .gpio_reset     = S3C2410_GPA(12),
577         .dac_clk        = UDA1380_DAC_CLK_SYSCLK,
578 };
579
580 static struct i2c_board_info h1940_i2c_devices[] = {
581         {
582                 I2C_BOARD_INFO("uda1380", 0x1a),
583                 .platform_data = &uda1380_info,
584         },
585 };
586
587 #define DECLARE_BUTTON(p, k, n, w)      \
588         {                               \
589                 .gpio           = p,    \
590                 .code           = k,    \
591                 .desc           = n,    \
592                 .wakeup         = w,    \
593                 .active_low     = 1,    \
594         }
595
596 static struct gpio_keys_button h1940_buttons[] = {
597         DECLARE_BUTTON(S3C2410_GPF(0),       KEY_POWER,          "Power", 1),
598         DECLARE_BUTTON(S3C2410_GPF(6),       KEY_ENTER,         "Select", 1),
599         DECLARE_BUTTON(S3C2410_GPF(7),      KEY_RECORD,         "Record", 0),
600         DECLARE_BUTTON(S3C2410_GPG(0),         KEY_F11,       "Calendar", 0),
601         DECLARE_BUTTON(S3C2410_GPG(2),         KEY_F12,       "Contacts", 0),
602         DECLARE_BUTTON(S3C2410_GPG(3),        KEY_MAIL,           "Mail", 0),
603         DECLARE_BUTTON(S3C2410_GPG(6),        KEY_LEFT,     "Left_arrow", 0),
604         DECLARE_BUTTON(S3C2410_GPG(7),    KEY_HOMEPAGE,           "Home", 0),
605         DECLARE_BUTTON(S3C2410_GPG(8),       KEY_RIGHT,    "Right_arrow", 0),
606         DECLARE_BUTTON(S3C2410_GPG(9),          KEY_UP,       "Up_arrow", 0),
607         DECLARE_BUTTON(S3C2410_GPG(10),       KEY_DOWN,     "Down_arrow", 0),
608 };
609
610 static struct gpio_keys_platform_data h1940_buttons_data = {
611         .buttons        = h1940_buttons,
612         .nbuttons       = ARRAY_SIZE(h1940_buttons),
613 };
614
615 static struct platform_device h1940_dev_buttons = {
616         .name           = "gpio-keys",
617         .id             = -1,
618         .dev            = {
619                 .platform_data  = &h1940_buttons_data,
620         }
621 };
622
623 static struct platform_device *h1940_devices[] __initdata = {
624         &h1940_dev_buttons,
625         &s3c_device_ohci,
626         &s3c_device_lcd,
627         &s3c_device_wdt,
628         &s3c_device_i2c0,
629         &s3c_device_iis,
630         &s3c_device_usbgadget,
631         &h1940_device_leds,
632         &h1940_device_bluetooth,
633         &s3c_device_sdi,
634         &s3c_device_rtc,
635         &s3c_device_timer[0],
636         &h1940_backlight,
637         &h1940_lcd_powerdev,
638         &s3c_device_adc,
639         &s3c_device_ts,
640         &power_supply,
641         &h1940_battery,
642 };
643
644 static void __init h1940_map_io(void)
645 {
646         s3c24xx_init_io(h1940_iodesc, ARRAY_SIZE(h1940_iodesc));
647         s3c24xx_init_clocks(0);
648         s3c24xx_init_uarts(h1940_uartcfgs, ARRAY_SIZE(h1940_uartcfgs));
649
650         /* setup PM */
651
652 #ifdef CONFIG_PM_H1940
653         memcpy(phys_to_virt(H1940_SUSPEND_RESUMEAT), h1940_pm_return, 1024);
654 #endif
655         s3c_pm_init();
656
657         /* Add latch gpio chip, set latch initial value */
658         h1940_latch_control(0, 0);
659         WARN_ON(gpiochip_add(&h1940_latch_gpiochip));
660 }
661
662 /* H1940 and RX3715 need to reserve this for suspend */
663 static void __init h1940_reserve(void)
664 {
665         memblock_reserve(0x30003000, 0x1000);
666         memblock_reserve(0x30081000, 0x1000);
667 }
668
669 static void __init h1940_init_irq(void)
670 {
671         s3c24xx_init_irq();
672 }
673
674 static void __init h1940_init(void)
675 {
676         u32 tmp;
677
678         s3c24xx_fb_set_platdata(&h1940_fb_info);
679         s3c24xx_mci_set_platdata(&h1940_mmc_cfg);
680         s3c24xx_udc_set_platdata(&h1940_udc_cfg);
681         s3c24xx_ts_set_platdata(&h1940_ts_cfg);
682         s3c_i2c0_set_platdata(NULL);
683
684         /* Turn off suspend on both USB ports, and switch the
685          * selectable USB port to USB device mode. */
686
687         s3c2410_modify_misccr(S3C2410_MISCCR_USBHOST |
688                               S3C2410_MISCCR_USBSUSPND0 |
689                               S3C2410_MISCCR_USBSUSPND1, 0x0);
690
691         tmp =   (0x78 << S3C24XX_PLL_MDIV_SHIFT)
692               | (0x02 << S3C24XX_PLL_PDIV_SHIFT)
693               | (0x03 << S3C24XX_PLL_SDIV_SHIFT);
694         writel(tmp, S3C2410_UPLLCON);
695
696         gpio_request(S3C2410_GPC(0), "LCD power");
697         gpio_request(S3C2410_GPC(1), "LCD power");
698         gpio_request(S3C2410_GPC(4), "LCD power");
699         gpio_request(S3C2410_GPC(5), "LCD power");
700         gpio_request(S3C2410_GPC(6), "LCD power");
701         gpio_request(H1940_LATCH_LCD_P0, "LCD power");
702         gpio_request(H1940_LATCH_LCD_P1, "LCD power");
703         gpio_request(H1940_LATCH_LCD_P2, "LCD power");
704         gpio_request(H1940_LATCH_LCD_P3, "LCD power");
705         gpio_request(H1940_LATCH_LCD_P4, "LCD power");
706         gpio_request(H1940_LATCH_MAX1698_nSHUTDOWN, "LCD power");
707         gpio_direction_output(S3C2410_GPC(0), 0);
708         gpio_direction_output(S3C2410_GPC(1), 0);
709         gpio_direction_output(S3C2410_GPC(4), 0);
710         gpio_direction_output(S3C2410_GPC(5), 0);
711         gpio_direction_input(S3C2410_GPC(6));
712         gpio_direction_output(H1940_LATCH_LCD_P0, 0);
713         gpio_direction_output(H1940_LATCH_LCD_P1, 0);
714         gpio_direction_output(H1940_LATCH_LCD_P2, 0);
715         gpio_direction_output(H1940_LATCH_LCD_P3, 0);
716         gpio_direction_output(H1940_LATCH_LCD_P4, 0);
717         gpio_direction_output(H1940_LATCH_MAX1698_nSHUTDOWN, 0);
718
719         gpio_request(H1940_LATCH_SD_POWER, "SD power");
720         gpio_direction_output(H1940_LATCH_SD_POWER, 0);
721
722         platform_add_devices(h1940_devices, ARRAY_SIZE(h1940_devices));
723
724         gpio_request(S3C2410_GPA(1), "Red LED blink");
725         gpio_request(S3C2410_GPA(3), "Blue LED blink");
726         gpio_request(S3C2410_GPA(7), "Green LED blink");
727         gpio_request(H1940_LATCH_LED_FLASH, "LED blink");
728         gpio_direction_output(S3C2410_GPA(1), 0);
729         gpio_direction_output(S3C2410_GPA(3), 0);
730         gpio_direction_output(S3C2410_GPA(7), 0);
731         gpio_direction_output(H1940_LATCH_LED_FLASH, 0);
732
733         i2c_register_board_info(0, h1940_i2c_devices,
734                 ARRAY_SIZE(h1940_i2c_devices));
735 }
736
737 MACHINE_START(H1940, "IPAQ-H1940")
738         /* Maintainer: Ben Dooks <ben-linux@fluff.org> */
739         .atag_offset    = 0x100,
740         .map_io         = h1940_map_io,
741         .reserve        = h1940_reserve,
742         .init_irq       = h1940_init_irq,
743         .init_machine   = h1940_init,
744         .init_time      = s3c24xx_timer_init,
745         .restart        = s3c2410_restart,
746 MACHINE_END