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