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