2d28132c725ba4ee49b0660f6f0cbcfb0dfe811b
[linux-2.6.git] / arch / arm / mach-pxa / mioa701.c
1 /*
2  * Handles the Mitac Mio A701 Board
3  *
4  * Copyright (C) 2008 Robert Jarzmik
5  *
6  * This program is free software; you can redistribute it and/or modify
7  * it under the terms of the GNU General Public License as published by
8  * the Free Software Foundation; either version 2 of the License, or
9  * (at your option) any later version.
10  *
11  * This program is distributed in the hope that it will be useful,
12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14  * GNU General Public License for more details.
15  *
16  * You should have received a copy of the GNU General Public License
17  * along with this program; if not, write to the Free Software
18  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
19  *
20  */
21
22 #include <linux/kernel.h>
23 #include <linux/init.h>
24 #include <linux/platform_device.h>
25 #include <linux/sysdev.h>
26 #include <linux/input.h>
27 #include <linux/delay.h>
28 #include <linux/gpio_keys.h>
29 #include <linux/pwm_backlight.h>
30 #include <linux/rtc.h>
31 #include <linux/leds.h>
32 #include <linux/gpio.h>
33 #include <linux/interrupt.h>
34 #include <linux/irq.h>
35 #include <linux/pda_power.h>
36 #include <linux/power_supply.h>
37 #include <linux/wm97xx_batt.h>
38 #include <linux/mtd/physmap.h>
39 #include <linux/usb/gpio_vbus.h>
40 #include <linux/regulator/max1586.h>
41
42 #include <asm/mach-types.h>
43 #include <asm/mach/arch.h>
44
45 #include <mach/pxa27x.h>
46 #include <mach/regs-rtc.h>
47 #include <mach/pxa27x_keypad.h>
48 #include <mach/pxafb.h>
49 #include <mach/mmc.h>
50 #include <mach/udc.h>
51 #include <mach/pxa27x-udc.h>
52 #include <plat/i2c.h>
53 #include <mach/camera.h>
54 #include <mach/audio.h>
55 #include <media/soc_camera.h>
56
57 #include <mach/mioa701.h>
58
59 #include "generic.h"
60 #include "devices.h"
61
62 static unsigned long mioa701_pin_config[] = {
63         /* Mio global */
64         MIO_CFG_OUT(GPIO9_CHARGE_EN, AF0, DRIVE_LOW),
65         MIO_CFG_OUT(GPIO18_POWEROFF, AF0, DRIVE_LOW),
66         MFP_CFG_OUT(GPIO3, AF0, DRIVE_HIGH),
67         MFP_CFG_OUT(GPIO4, AF0, DRIVE_HIGH),
68         MIO_CFG_IN(GPIO80_MAYBE_CHARGE_VDROP, AF0),
69
70         /* Backlight PWM 0 */
71         GPIO16_PWM0_OUT,
72
73         /* MMC */
74         GPIO32_MMC_CLK,
75         GPIO92_MMC_DAT_0,
76         GPIO109_MMC_DAT_1,
77         GPIO110_MMC_DAT_2,
78         GPIO111_MMC_DAT_3,
79         GPIO112_MMC_CMD,
80         MIO_CFG_IN(GPIO78_SDIO_RO, AF0),
81         MIO_CFG_IN(GPIO15_SDIO_INSERT, AF0),
82         MIO_CFG_OUT(GPIO91_SDIO_EN, AF0, DRIVE_LOW),
83
84         /* USB */
85         MIO_CFG_IN(GPIO13_nUSB_DETECT, AF0),
86         MIO_CFG_OUT(GPIO22_USB_ENABLE, AF0, DRIVE_LOW),
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
109         /* QCI */
110         GPIO12_CIF_DD_7,
111         GPIO17_CIF_DD_6,
112         GPIO50_CIF_DD_3,
113         GPIO51_CIF_DD_2,
114         GPIO52_CIF_DD_4,
115         GPIO53_CIF_MCLK,
116         GPIO54_CIF_PCLK,
117         GPIO55_CIF_DD_1,
118         GPIO81_CIF_DD_0,
119         GPIO82_CIF_DD_5,
120         GPIO84_CIF_FV,
121         GPIO85_CIF_LV,
122
123         /* Bluetooth */
124         MIO_CFG_IN(GPIO14_BT_nACTIVITY, AF0),
125         GPIO44_BTUART_CTS,
126         GPIO42_BTUART_RXD,
127         GPIO45_BTUART_RTS,
128         GPIO43_BTUART_TXD,
129         MIO_CFG_OUT(GPIO83_BT_ON, AF0, DRIVE_LOW),
130         MIO_CFG_OUT(GPIO77_BT_UNKNOWN1, AF0, DRIVE_HIGH),
131         MIO_CFG_OUT(GPIO86_BT_MAYBE_nRESET, AF0, DRIVE_HIGH),
132
133         /* GPS */
134         MIO_CFG_OUT(GPIO23_GPS_UNKNOWN1, AF0, DRIVE_LOW),
135         MIO_CFG_OUT(GPIO26_GPS_ON, AF0, DRIVE_LOW),
136         MIO_CFG_OUT(GPIO27_GPS_RESET, AF0, DRIVE_LOW),
137         MIO_CFG_OUT(GPIO106_GPS_UNKNOWN2, AF0, DRIVE_LOW),
138         MIO_CFG_OUT(GPIO107_GPS_UNKNOWN3, AF0, DRIVE_LOW),
139         GPIO46_STUART_RXD,
140         GPIO47_STUART_TXD,
141
142         /* GSM */
143         MIO_CFG_OUT(GPIO24_GSM_MOD_RESET_CMD, AF0, DRIVE_LOW),
144         MIO_CFG_OUT(GPIO88_GSM_nMOD_ON_CMD, AF0, DRIVE_HIGH),
145         MIO_CFG_OUT(GPIO90_GSM_nMOD_OFF_CMD, AF0, DRIVE_HIGH),
146         MIO_CFG_OUT(GPIO114_GSM_nMOD_DTE_UART_STATE, AF0, DRIVE_HIGH),
147         MIO_CFG_IN(GPIO25_GSM_MOD_ON_STATE, AF0),
148         MIO_CFG_IN(GPIO113_GSM_EVENT, AF0) | WAKEUP_ON_EDGE_BOTH,
149         GPIO34_FFUART_RXD,
150         GPIO35_FFUART_CTS,
151         GPIO36_FFUART_DCD,
152         GPIO37_FFUART_DSR,
153         GPIO39_FFUART_TXD,
154         GPIO40_FFUART_DTR,
155         GPIO41_FFUART_RTS,
156
157         /* Sound */
158         GPIO89_AC97_SYSCLK,
159         MIO_CFG_IN(GPIO12_HPJACK_INSERT, AF0),
160
161         /* Leds */
162         MIO_CFG_OUT(GPIO10_LED_nCharging, AF0, DRIVE_HIGH),
163         MIO_CFG_OUT(GPIO97_LED_nBlue, AF0, DRIVE_HIGH),
164         MIO_CFG_OUT(GPIO98_LED_nOrange, AF0, DRIVE_HIGH),
165         MIO_CFG_OUT(GPIO82_LED_nVibra, AF0, DRIVE_HIGH),
166         MIO_CFG_OUT(GPIO115_LED_nKeyboard, AF0, DRIVE_HIGH),
167
168         /* Keyboard */
169         MIO_CFG_IN(GPIO0_KEY_POWER, AF0) | WAKEUP_ON_EDGE_BOTH,
170         MIO_CFG_IN(GPIO93_KEY_VOLUME_UP, AF0),
171         MIO_CFG_IN(GPIO94_KEY_VOLUME_DOWN, AF0),
172         GPIO100_KP_MKIN_0,
173         GPIO101_KP_MKIN_1,
174         GPIO102_KP_MKIN_2,
175         GPIO103_KP_MKOUT_0,
176         GPIO104_KP_MKOUT_1,
177         GPIO105_KP_MKOUT_2,
178
179         /* I2C */
180         GPIO117_I2C_SCL,
181         GPIO118_I2C_SDA,
182
183         /* Unknown */
184         MFP_CFG_IN(GPIO20, AF0),
185         MFP_CFG_IN(GPIO21, AF0),
186         MFP_CFG_IN(GPIO33, AF0),
187         MFP_CFG_OUT(GPIO49, AF0, DRIVE_HIGH),
188         MFP_CFG_OUT(GPIO57, AF0, DRIVE_HIGH),
189         MFP_CFG_IN(GPIO96, AF0),
190         MFP_CFG_OUT(GPIO116, AF0, DRIVE_HIGH),
191 };
192
193 #define MIO_GPIO_IN(num, _desc) \
194         { .gpio = (num), .dir = 0, .desc = (_desc) }
195 #define MIO_GPIO_OUT(num, _init, _desc) \
196         { .gpio = (num), .dir = 1, .init = (_init), .desc = (_desc) }
197 struct gpio_ress {
198         unsigned gpio : 8;
199         unsigned dir : 1;
200         unsigned init : 1;
201         char *desc;
202 };
203
204 static int mio_gpio_request(struct gpio_ress *gpios, int size)
205 {
206         int i, rc = 0;
207         int gpio;
208         int dir;
209
210         for (i = 0; (!rc) && (i < size); i++) {
211                 gpio = gpios[i].gpio;
212                 dir = gpios[i].dir;
213                 rc = gpio_request(gpio, gpios[i].desc);
214                 if (rc) {
215                         printk(KERN_ERR "Error requesting GPIO %d(%s) : %d\n",
216                                gpio, gpios[i].desc, rc);
217                         continue;
218                 }
219                 if (dir)
220                         gpio_direction_output(gpio, gpios[i].init);
221                 else
222                         gpio_direction_input(gpio);
223         }
224         while ((rc) && (--i >= 0))
225                 gpio_free(gpios[i].gpio);
226         return rc;
227 }
228
229 static void mio_gpio_free(struct gpio_ress *gpios, int size)
230 {
231         int i;
232
233         for (i = 0; i < size; i++)
234                 gpio_free(gpios[i].gpio);
235 }
236
237 /* LCD Screen and Backlight */
238 static struct platform_pwm_backlight_data mioa701_backlight_data = {
239         .pwm_id         = 0,
240         .max_brightness = 100,
241         .dft_brightness = 50,
242         .pwm_period_ns  = 4000 * 1024,  /* Fl = 250kHz */
243 };
244
245 /*
246  * LTM0305A776C LCD panel timings
247  *
248  * see:
249  *  - the LTM0305A776C datasheet,
250  *  - and the PXA27x Programmers' manual
251  */
252 static struct pxafb_mode_info mioa701_ltm0305a776c = {
253         .pixclock               = 220000,       /* CLK=4.545 MHz */
254         .xres                   = 240,
255         .yres                   = 320,
256         .bpp                    = 16,
257         .hsync_len              = 4,
258         .vsync_len              = 2,
259         .left_margin            = 6,
260         .right_margin           = 4,
261         .upper_margin           = 5,
262         .lower_margin           = 3,
263 };
264
265 static void mioa701_lcd_power(int on, struct fb_var_screeninfo *si)
266 {
267         gpio_set_value(GPIO87_LCD_POWER, on);
268 }
269
270 static struct pxafb_mach_info mioa701_pxafb_info = {
271         .modes                  = &mioa701_ltm0305a776c,
272         .num_modes              = 1,
273         .lcd_conn               = LCD_COLOR_TFT_16BPP | LCD_PCLK_EDGE_FALL,
274         .pxafb_lcd_power        = mioa701_lcd_power,
275 };
276
277 /*
278  * Keyboard configuration
279  */
280 static unsigned int mioa701_matrix_keys[] = {
281         KEY(0, 0, KEY_UP),
282         KEY(0, 1, KEY_RIGHT),
283         KEY(0, 2, KEY_MEDIA),
284         KEY(1, 0, KEY_DOWN),
285         KEY(1, 1, KEY_ENTER),
286         KEY(1, 2, KEY_CONNECT), /* GPS key */
287         KEY(2, 0, KEY_LEFT),
288         KEY(2, 1, KEY_PHONE),   /* Phone Green key */
289         KEY(2, 2, KEY_CAMERA)   /* Camera key */
290 };
291 static struct pxa27x_keypad_platform_data mioa701_keypad_info = {
292         .matrix_key_rows = 3,
293         .matrix_key_cols = 3,
294         .matrix_key_map = mioa701_matrix_keys,
295         .matrix_key_map_size = ARRAY_SIZE(mioa701_matrix_keys),
296 };
297
298 /*
299  * GPIO Key Configuration
300  */
301 #define MIO_KEY(key, _gpio, _desc, _wakeup) \
302         { .code = (key), .gpio = (_gpio), .active_low = 0, \
303         .desc = (_desc), .type = EV_KEY, .wakeup = (_wakeup) }
304 static struct gpio_keys_button mioa701_button_table[] = {
305         MIO_KEY(KEY_EXIT, GPIO0_KEY_POWER, "Power button", 1),
306         MIO_KEY(KEY_VOLUMEUP, GPIO93_KEY_VOLUME_UP, "Volume up", 0),
307         MIO_KEY(KEY_VOLUMEDOWN, GPIO94_KEY_VOLUME_DOWN, "Volume down", 0),
308         MIO_KEY(KEY_HP, GPIO12_HPJACK_INSERT, "HP jack detect", 0)
309 };
310
311 static struct gpio_keys_platform_data mioa701_gpio_keys_data = {
312         .buttons  = mioa701_button_table,
313         .nbuttons = ARRAY_SIZE(mioa701_button_table),
314 };
315
316 /*
317  * Leds and vibrator
318  */
319 #define ONE_LED(_gpio, _name) \
320 { .gpio = (_gpio), .name = (_name), .active_low = true }
321 static struct gpio_led gpio_leds[] = {
322         ONE_LED(GPIO10_LED_nCharging, "mioa701:charging"),
323         ONE_LED(GPIO97_LED_nBlue, "mioa701:blue"),
324         ONE_LED(GPIO98_LED_nOrange, "mioa701:orange"),
325         ONE_LED(GPIO82_LED_nVibra, "mioa701:vibra"),
326         ONE_LED(GPIO115_LED_nKeyboard, "mioa701:keyboard")
327 };
328
329 static struct gpio_led_platform_data gpio_led_info = {
330         .leds = gpio_leds,
331         .num_leds = ARRAY_SIZE(gpio_leds),
332 };
333
334 /*
335  * GSM Sagem XS200 chip
336  *
337  * GSM handling was purged from kernel. For history, this is the way to go :
338  *   - init : GPIO24_GSM_MOD_RESET_CMD = 0, GPIO114_GSM_nMOD_DTE_UART_STATE = 1
339  *            GPIO88_GSM_nMOD_ON_CMD = 1, GPIO90_GSM_nMOD_OFF_CMD = 1
340  *   - reset : GPIO24_GSM_MOD_RESET_CMD = 1, msleep(100),
341  *             GPIO24_GSM_MOD_RESET_CMD = 0
342  *   - turn on  : GPIO88_GSM_nMOD_ON_CMD = 0, msleep(1000),
343  *                GPIO88_GSM_nMOD_ON_CMD = 1
344  *   - turn off : GPIO90_GSM_nMOD_OFF_CMD = 0, msleep(1000),
345  *                GPIO90_GSM_nMOD_OFF_CMD = 1
346  */
347 static int is_gsm_on(void)
348 {
349         int is_on;
350
351         is_on = !!gpio_get_value(GPIO25_GSM_MOD_ON_STATE);
352         return is_on;
353 }
354
355 irqreturn_t gsm_on_irq(int irq, void *p)
356 {
357         printk(KERN_DEBUG "Mioa701: GSM status changed to %s\n",
358                is_gsm_on() ? "on" : "off");
359         return IRQ_HANDLED;
360 }
361
362 struct gpio_ress gsm_gpios[] = {
363         MIO_GPIO_IN(GPIO25_GSM_MOD_ON_STATE, "GSM state"),
364         MIO_GPIO_IN(GPIO113_GSM_EVENT, "GSM event"),
365 };
366
367 static int __init gsm_init(void)
368 {
369         int rc;
370
371         rc = mio_gpio_request(ARRAY_AND_SIZE(gsm_gpios));
372         if (rc)
373                 goto err_gpio;
374         rc = request_irq(gpio_to_irq(GPIO25_GSM_MOD_ON_STATE), gsm_on_irq,
375                          IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING,
376                          "GSM XS200 Power Irq", NULL);
377         if (rc)
378                 goto err_irq;
379
380         gpio_set_wake(GPIO113_GSM_EVENT, 1);
381         return 0;
382
383 err_irq:
384         printk(KERN_ERR "Mioa701: Can't request GSM_ON irq\n");
385         mio_gpio_free(ARRAY_AND_SIZE(gsm_gpios));
386 err_gpio:
387         printk(KERN_ERR "Mioa701: gsm not available\n");
388         return rc;
389 }
390
391 static void gsm_exit(void)
392 {
393         free_irq(gpio_to_irq(GPIO25_GSM_MOD_ON_STATE), NULL);
394         mio_gpio_free(ARRAY_AND_SIZE(gsm_gpios));
395 }
396
397 /*
398  * Bluetooth BRF6150 chip
399  *
400  * BT handling was purged from kernel. For history, this is the way to go :
401  * - turn on  : GPIO83_BT_ON = 1
402  * - turn off : GPIO83_BT_ON = 0
403  */
404
405 /*
406  * GPS Sirf Star III chip
407  *
408  * GPS handling was purged from kernel. For history, this is the way to go :
409  * - init : GPIO23_GPS_UNKNOWN1 = 1, GPIO26_GPS_ON = 0, GPIO27_GPS_RESET = 0
410  *          GPIO106_GPS_UNKNOWN2 = 0, GPIO107_GPS_UNKNOWN3 = 0
411  * - turn on  : GPIO27_GPS_RESET = 1, GPIO26_GPS_ON = 1
412  * - turn off : GPIO26_GPS_ON = 0, GPIO27_GPS_RESET = 0
413  */
414
415 /*
416  * USB UDC
417  */
418 static int is_usb_connected(void)
419 {
420         return !gpio_get_value(GPIO13_nUSB_DETECT);
421 }
422
423 static struct pxa2xx_udc_mach_info mioa701_udc_info = {
424         .udc_is_connected = is_usb_connected,
425         .gpio_pullup      = GPIO22_USB_ENABLE,
426 };
427
428 struct gpio_vbus_mach_info gpio_vbus_data = {
429         .gpio_vbus = GPIO13_nUSB_DETECT,
430         .gpio_vbus_inverted = 1,
431         .gpio_pullup = -1,
432 };
433
434 /*
435  * SDIO/MMC Card controller
436  */
437 static void mci_setpower(struct device *dev, unsigned int vdd)
438 {
439         struct pxamci_platform_data *p_d = dev->platform_data;
440
441         if ((1 << vdd) & p_d->ocr_mask)
442                 gpio_set_value(GPIO91_SDIO_EN, 1);      /* enable SDIO power */
443         else
444                 gpio_set_value(GPIO91_SDIO_EN, 0);      /* disable SDIO power */
445 }
446
447 static int mci_get_ro(struct device *dev)
448 {
449         return gpio_get_value(GPIO78_SDIO_RO);
450 }
451
452 struct gpio_ress mci_gpios[] = {
453         MIO_GPIO_IN(GPIO78_SDIO_RO,     "SDIO readonly detect"),
454         MIO_GPIO_IN(GPIO15_SDIO_INSERT, "SDIO insertion detect"),
455         MIO_GPIO_OUT(GPIO91_SDIO_EN, 0, "SDIO power enable")
456 };
457
458 static void mci_exit(struct device *dev, void *data)
459 {
460         mio_gpio_free(ARRAY_AND_SIZE(mci_gpios));
461         free_irq(gpio_to_irq(GPIO15_SDIO_INSERT), data);
462 }
463
464 static struct pxamci_platform_data mioa701_mci_info;
465
466 /**
467  * The card detect interrupt isn't debounced so we delay it by 250ms
468  * to give the card a chance to fully insert/eject.
469  */
470 static int mci_init(struct device *dev, irq_handler_t detect_int, void *data)
471 {
472         int rc;
473         int irq = gpio_to_irq(GPIO15_SDIO_INSERT);
474
475         rc = mio_gpio_request(ARRAY_AND_SIZE(mci_gpios));
476         if (rc)
477                 goto err_gpio;
478         /* enable RE/FE interrupt on card insertion and removal */
479         rc = request_irq(irq, detect_int,
480                          IRQF_DISABLED | IRQF_TRIGGER_RISING |
481                          IRQF_TRIGGER_FALLING,
482                          "MMC card detect", data);
483         if (rc)
484                 goto err_irq;
485
486         mioa701_mci_info.detect_delay = msecs_to_jiffies(250);
487         return 0;
488
489 err_irq:
490         dev_err(dev, "mioa701_mci_init: MMC/SD:"
491                 " can't request MMC card detect IRQ\n");
492         mio_gpio_free(ARRAY_AND_SIZE(mci_gpios));
493 err_gpio:
494         return rc;
495 }
496
497 static struct pxamci_platform_data mioa701_mci_info = {
498         .ocr_mask = MMC_VDD_32_33 | MMC_VDD_33_34,
499         .init     = mci_init,
500         .get_ro   = mci_get_ro,
501         .setpower = mci_setpower,
502         .exit     = mci_exit,
503 };
504
505 /* FlashRAM */
506 static struct resource strataflash_resource = {
507         .start = PXA_CS0_PHYS,
508         .end   = PXA_CS0_PHYS + SZ_64M - 1,
509         .flags = IORESOURCE_MEM,
510 };
511
512 static struct physmap_flash_data strataflash_data = {
513         .width = 2,
514         /* .set_vpp = mioa701_set_vpp, */
515 };
516
517 static struct platform_device strataflash = {
518         .name          = "physmap-flash",
519         .id            = -1,
520         .resource      = &strataflash_resource,
521         .num_resources = 1,
522         .dev = {
523                 .platform_data = &strataflash_data,
524         },
525 };
526
527 /*
528  * Suspend/Resume bootstrap management
529  *
530  * MIO A701 reboot sequence is highly ROM dependant. From the one dissassembled,
531  * this sequence is as follows :
532  *   - disables interrupts
533  *   - initialize SDRAM (self refresh RAM into active RAM)
534  *   - initialize GPIOs (depends on value at 0xa020b020)
535  *   - initialize coprossessors
536  *   - if edge detect on PWR_SCL(GPIO3), then proceed to cold start
537  *   - or if value at 0xa020b000 not equal to 0x0f0f0f0f, proceed to cold start
538  *   - else do a resume, ie. jump to addr 0xa0100000
539  */
540 #define RESUME_ENABLE_ADDR      0xa020b000
541 #define RESUME_ENABLE_VAL       0x0f0f0f0f
542 #define RESUME_BT_ADDR          0xa020b020
543 #define RESUME_UNKNOWN_ADDR     0xa020b024
544 #define RESUME_VECTOR_ADDR      0xa0100000
545 #define BOOTSTRAP_WORDS         mioa701_bootstrap_lg/4
546
547 static u32 *save_buffer;
548
549 static void install_bootstrap(void)
550 {
551         int i;
552         u32 *rom_bootstrap  = phys_to_virt(RESUME_VECTOR_ADDR);
553         u32 *src = &mioa701_bootstrap;
554
555         for (i = 0; i < BOOTSTRAP_WORDS; i++)
556                 rom_bootstrap[i] = src[i];
557 }
558
559
560 static int mioa701_sys_suspend(struct sys_device *sysdev, pm_message_t state)
561 {
562         int i = 0, is_bt_on;
563         u32 *mem_resume_vector  = phys_to_virt(RESUME_VECTOR_ADDR);
564         u32 *mem_resume_enabler = phys_to_virt(RESUME_ENABLE_ADDR);
565         u32 *mem_resume_bt      = phys_to_virt(RESUME_BT_ADDR);
566         u32 *mem_resume_unknown = phys_to_virt(RESUME_UNKNOWN_ADDR);
567
568         /* Devices prepare suspend */
569         is_bt_on = !!gpio_get_value(GPIO83_BT_ON);
570         pxa2xx_mfp_set_lpm(GPIO83_BT_ON,
571                            is_bt_on ? MFP_LPM_DRIVE_HIGH : MFP_LPM_DRIVE_LOW);
572
573         for (i = 0; i < BOOTSTRAP_WORDS; i++)
574                 save_buffer[i] = mem_resume_vector[i];
575         save_buffer[i++] = *mem_resume_enabler;
576         save_buffer[i++] = *mem_resume_bt;
577         save_buffer[i++] = *mem_resume_unknown;
578
579         *mem_resume_enabler = RESUME_ENABLE_VAL;
580         *mem_resume_bt      = is_bt_on;
581
582         install_bootstrap();
583         return 0;
584 }
585
586 static int mioa701_sys_resume(struct sys_device *sysdev)
587 {
588         int i = 0;
589         u32 *mem_resume_vector  = phys_to_virt(RESUME_VECTOR_ADDR);
590         u32 *mem_resume_enabler = phys_to_virt(RESUME_ENABLE_ADDR);
591         u32 *mem_resume_bt      = phys_to_virt(RESUME_BT_ADDR);
592         u32 *mem_resume_unknown = phys_to_virt(RESUME_UNKNOWN_ADDR);
593
594         for (i = 0; i < BOOTSTRAP_WORDS; i++)
595                 mem_resume_vector[i] = save_buffer[i];
596         *mem_resume_enabler = save_buffer[i++];
597         *mem_resume_bt      = save_buffer[i++];
598         *mem_resume_unknown = save_buffer[i++];
599
600         return 0;
601 }
602
603 static struct sysdev_class mioa701_sysclass = {
604         .name = "mioa701",
605 };
606
607 static struct sys_device sysdev_bootstrap = {
608         .cls            = &mioa701_sysclass,
609 };
610
611 static struct sysdev_driver driver_bootstrap = {
612         .suspend        = &mioa701_sys_suspend,
613         .resume         = &mioa701_sys_resume,
614 };
615
616 static int __init bootstrap_init(void)
617 {
618         int rc;
619         int save_size = mioa701_bootstrap_lg + (sizeof(u32) * 3);
620
621         rc = sysdev_class_register(&mioa701_sysclass);
622         if (rc) {
623                 printk(KERN_ERR "Failed registering mioa701 sys class\n");
624                 return -ENODEV;
625         }
626         rc = sysdev_register(&sysdev_bootstrap);
627         if (rc) {
628                 printk(KERN_ERR "Failed registering mioa701 sys device\n");
629                 return -ENODEV;
630         }
631         rc = sysdev_driver_register(&mioa701_sysclass, &driver_bootstrap);
632         if (rc) {
633                 printk(KERN_ERR "Failed registering PMU sys driver\n");
634                 return -ENODEV;
635         }
636
637         save_buffer = kmalloc(save_size, GFP_KERNEL);
638         if (!save_buffer)
639                 return -ENOMEM;
640         printk(KERN_INFO "MioA701: allocated %d bytes for bootstrap\n",
641                save_size);
642         return 0;
643 }
644
645 static void bootstrap_exit(void)
646 {
647         kfree(save_buffer);
648         sysdev_driver_unregister(&mioa701_sysclass, &driver_bootstrap);
649         sysdev_unregister(&sysdev_bootstrap);
650         sysdev_class_unregister(&mioa701_sysclass);
651
652         printk(KERN_CRIT "Unregistering mioa701 suspend will hang next"
653                "resume !!!\n");
654 }
655
656 /*
657  * Power Supply
658  */
659 static char *supplicants[] = {
660         "mioa701_battery"
661 };
662
663 static int is_ac_connected(void)
664 {
665         return gpio_get_value(GPIO96_AC_DETECT);
666 }
667
668 static void mioa701_set_charge(int flags)
669 {
670         gpio_set_value(GPIO9_CHARGE_EN, (flags == PDA_POWER_CHARGE_USB));
671 }
672
673 static struct pda_power_pdata power_pdata = {
674         .is_ac_online   = is_ac_connected,
675         .is_usb_online  = is_usb_connected,
676         .set_charge = mioa701_set_charge,
677         .supplied_to = supplicants,
678         .num_supplicants = ARRAY_SIZE(supplicants),
679 };
680
681 static struct resource power_resources[] = {
682         [0] = {
683                 .name   = "ac",
684                 .start  = gpio_to_irq(GPIO96_AC_DETECT),
685                 .end    = gpio_to_irq(GPIO96_AC_DETECT),
686                 .flags  = IORESOURCE_IRQ | IORESOURCE_IRQ_HIGHEDGE |
687                 IORESOURCE_IRQ_LOWEDGE,
688         },
689         [1] = {
690                 .name   = "usb",
691                 .start  = gpio_to_irq(GPIO13_nUSB_DETECT),
692                 .end    = gpio_to_irq(GPIO13_nUSB_DETECT),
693                 .flags  = IORESOURCE_IRQ | IORESOURCE_IRQ_HIGHEDGE |
694                 IORESOURCE_IRQ_LOWEDGE,
695         },
696 };
697
698 static struct platform_device power_dev = {
699         .name           = "pda-power",
700         .id             = -1,
701         .resource       = power_resources,
702         .num_resources  = ARRAY_SIZE(power_resources),
703         .dev = {
704                 .platform_data  = &power_pdata,
705         },
706 };
707
708 static struct wm97xx_batt_info mioa701_battery_data = {
709         .batt_aux       = WM97XX_AUX_ID1,
710         .temp_aux       = -1,
711         .charge_gpio    = -1,
712         .min_voltage    = 0xc00,
713         .max_voltage    = 0xfc0,
714         .batt_tech      = POWER_SUPPLY_TECHNOLOGY_LION,
715         .batt_div       = 1,
716         .batt_mult      = 1,
717         .batt_name      = "mioa701_battery",
718 };
719
720 /*
721  * Voltage regulation
722  */
723 static struct regulator_consumer_supply max1586_consumers[] = {
724         {
725                 .supply = "vcc_core",
726         }
727 };
728
729 static struct regulator_init_data max1586_v3_info = {
730         .constraints = {
731                 .name = "vcc_core range",
732                 .min_uV = 1000000,
733                 .max_uV = 1705000,
734                 .always_on = 1,
735                 .valid_ops_mask = REGULATOR_CHANGE_VOLTAGE,
736         },
737         .num_consumer_supplies = ARRAY_SIZE(max1586_consumers),
738         .consumer_supplies = max1586_consumers,
739 };
740
741 static struct max1586_subdev_data max1586_subdevs[] = {
742         { .name = "vcc_core", .id = MAX1586_V3,
743           .platform_data = &max1586_v3_info },
744 };
745
746 static struct max1586_platform_data max1586_info = {
747         .subdevs = max1586_subdevs,
748         .num_subdevs = ARRAY_SIZE(max1586_subdevs),
749         .v3_gain = MAX1586_GAIN_NO_R24, /* 700..1475 mV */
750 };
751
752 /*
753  * Camera interface
754  */
755 struct pxacamera_platform_data mioa701_pxacamera_platform_data = {
756         .flags  = PXA_CAMERA_MASTER | PXA_CAMERA_DATAWIDTH_8 |
757                 PXA_CAMERA_PCLK_EN | PXA_CAMERA_MCLK_EN,
758         .mclk_10khz = 5000,
759 };
760
761 static struct i2c_board_info __initdata mioa701_pi2c_devices[] = {
762         {
763                 I2C_BOARD_INFO("max1586", 0x14),
764                 .platform_data = &max1586_info,
765         },
766 };
767
768 static struct soc_camera_link iclink = {
769         .bus_id = 0, /* Must match id in pxa27x_device_camera in device.c */
770 };
771
772 /* Board I2C devices. */
773 static struct i2c_board_info __initdata mioa701_i2c_devices[] = {
774         {
775                 /* Must initialize before the camera(s) */
776                 I2C_BOARD_INFO("mt9m111", 0x5d),
777                 .platform_data = &iclink,
778         },
779 };
780
781 struct i2c_pxa_platform_data i2c_pdata = {
782         .fast_mode = 1,
783 };
784
785 static pxa2xx_audio_ops_t mioa701_ac97_info = {
786         .reset_gpio = 95,
787 };
788
789 /*
790  * Mio global
791  */
792
793 /* Devices */
794 #define MIO_PARENT_DEV(var, strname, tparent, pdata)    \
795 static struct platform_device var = {                   \
796         .name           = strname,                      \
797         .id             = -1,                           \
798         .dev            = {                             \
799                 .platform_data = pdata,                 \
800                 .parent = tparent,                      \
801         },                                              \
802 };
803 #define MIO_SIMPLE_DEV(var, strname, pdata)     \
804         MIO_PARENT_DEV(var, strname, NULL, pdata)
805
806 MIO_SIMPLE_DEV(mioa701_gpio_keys, "gpio-keys",      &mioa701_gpio_keys_data)
807 MIO_PARENT_DEV(mioa701_backlight, "pwm-backlight",  &pxa27x_device_pwm0.dev,
808                 &mioa701_backlight_data);
809 MIO_SIMPLE_DEV(mioa701_led,       "leds-gpio",      &gpio_led_info)
810 MIO_SIMPLE_DEV(pxa2xx_pcm,        "pxa2xx-pcm",     NULL)
811 MIO_SIMPLE_DEV(mioa701_sound,     "mioa701-wm9713", NULL)
812 MIO_SIMPLE_DEV(mioa701_board,     "mioa701-board",  NULL)
813 MIO_SIMPLE_DEV(gpio_vbus,         "gpio-vbus",      &gpio_vbus_data);
814
815 static struct platform_device *devices[] __initdata = {
816         &mioa701_gpio_keys,
817         &mioa701_backlight,
818         &mioa701_led,
819         &pxa2xx_pcm,
820         &mioa701_sound,
821         &power_dev,
822         &strataflash,
823         &gpio_vbus,
824         &mioa701_board,
825 };
826
827 static void mioa701_machine_exit(void);
828
829 static void mioa701_poweroff(void)
830 {
831         mioa701_machine_exit();
832         arm_machine_restart('s', NULL);
833 }
834
835 static void mioa701_restart(char c, const char *cmd)
836 {
837         mioa701_machine_exit();
838         arm_machine_restart('s', cmd);
839 }
840
841 static struct gpio_ress global_gpios[] = {
842         MIO_GPIO_OUT(GPIO9_CHARGE_EN, 1, "Charger enable"),
843         MIO_GPIO_OUT(GPIO18_POWEROFF, 0, "Power Off"),
844         MIO_GPIO_OUT(GPIO87_LCD_POWER, 0, "LCD Power")
845 };
846
847 static void __init mioa701_machine_init(void)
848 {
849         PSLR  = 0xff100000; /* SYSDEL=125ms, PWRDEL=125ms, PSLR_SL_ROD=1 */
850         PCFR = PCFR_DC_EN | PCFR_GPR_EN | PCFR_OPDE;
851         RTTR = 32768 - 1; /* Reset crazy WinCE value */
852         UP2OCR = UP2OCR_HXOE;
853
854         pxa2xx_mfp_config(ARRAY_AND_SIZE(mioa701_pin_config));
855         mio_gpio_request(ARRAY_AND_SIZE(global_gpios));
856         bootstrap_init();
857         set_pxa_fb_info(&mioa701_pxafb_info);
858         pxa_set_mci_info(&mioa701_mci_info);
859         pxa_set_keypad_info(&mioa701_keypad_info);
860         wm97xx_bat_set_pdata(&mioa701_battery_data);
861         pxa_set_udc_info(&mioa701_udc_info);
862         pxa_set_ac97_info(&mioa701_ac97_info);
863         pm_power_off = mioa701_poweroff;
864         arm_pm_restart = mioa701_restart;
865         platform_add_devices(devices, ARRAY_SIZE(devices));
866         gsm_init();
867
868         i2c_register_board_info(1, ARRAY_AND_SIZE(mioa701_pi2c_devices));
869         pxa_set_i2c_info(&i2c_pdata);
870         pxa27x_set_i2c_power_info(NULL);
871         pxa_set_camera_info(&mioa701_pxacamera_platform_data);
872         i2c_register_board_info(0, ARRAY_AND_SIZE(mioa701_i2c_devices));
873 }
874
875 static void mioa701_machine_exit(void)
876 {
877         bootstrap_exit();
878         gsm_exit();
879 }
880
881 MACHINE_START(MIOA701, "MIO A701")
882         .phys_io        = 0x40000000,
883         .io_pg_offst    = (io_p2v(0x40000000) >> 18) & 0xfffc,
884         .boot_params    = 0xa0000100,
885         .map_io         = &pxa_map_io,
886         .init_irq       = &pxa27x_init_irq,
887         .init_machine   = mioa701_machine_init,
888         .timer          = &pxa_timer,
889 MACHINE_END