Merge commit 'v2.6.39-rc6' into x86/cleanups
[pandora-kernel.git] / arch / arm / mach-omap2 / board-omap3beagle.c
1 /*
2  * linux/arch/arm/mach-omap2/board-omap3beagle.c
3  *
4  * Copyright (C) 2008 Texas Instruments
5  *
6  * Modified from mach-omap2/board-3430sdp.c
7  *
8  * Initial code: Syed Mohammed Khasim
9  *
10  * This program is free software; you can redistribute it and/or modify
11  * it under the terms of the GNU General Public License version 2 as
12  * published by the Free Software Foundation.
13  */
14
15 #include <linux/kernel.h>
16 #include <linux/init.h>
17 #include <linux/platform_device.h>
18 #include <linux/delay.h>
19 #include <linux/err.h>
20 #include <linux/clk.h>
21 #include <linux/io.h>
22 #include <linux/leds.h>
23 #include <linux/gpio.h>
24 #include <linux/input.h>
25 #include <linux/gpio_keys.h>
26 #include <linux/opp.h>
27
28 #include <linux/mtd/mtd.h>
29 #include <linux/mtd/partitions.h>
30 #include <linux/mtd/nand.h>
31 #include <linux/mmc/host.h>
32
33 #include <linux/regulator/machine.h>
34 #include <linux/i2c/twl.h>
35
36 #include <mach/hardware.h>
37 #include <asm/mach-types.h>
38 #include <asm/mach/arch.h>
39 #include <asm/mach/map.h>
40 #include <asm/mach/flash.h>
41
42 #include <plat/board.h>
43 #include <plat/common.h>
44 #include <plat/display.h>
45 #include <plat/panel-generic-dpi.h>
46 #include <plat/gpmc.h>
47 #include <plat/nand.h>
48 #include <plat/usb.h>
49 #include <plat/omap_device.h>
50
51 #include "mux.h"
52 #include "hsmmc.h"
53 #include "timer-gp.h"
54 #include "pm.h"
55
56 #define NAND_BLOCK_SIZE         SZ_128K
57
58 /*
59  * OMAP3 Beagle revision
60  * Run time detection of Beagle revision is done by reading GPIO.
61  * GPIO ID -
62  *      AXBX    = GPIO173, GPIO172, GPIO171: 1 1 1
63  *      C1_3    = GPIO173, GPIO172, GPIO171: 1 1 0
64  *      C4      = GPIO173, GPIO172, GPIO171: 1 0 1
65  *      XM      = GPIO173, GPIO172, GPIO171: 0 0 0
66  */
67 enum {
68         OMAP3BEAGLE_BOARD_UNKN = 0,
69         OMAP3BEAGLE_BOARD_AXBX,
70         OMAP3BEAGLE_BOARD_C1_3,
71         OMAP3BEAGLE_BOARD_C4,
72         OMAP3BEAGLE_BOARD_XM,
73 };
74
75 static u8 omap3_beagle_version;
76
77 static u8 omap3_beagle_get_rev(void)
78 {
79         return omap3_beagle_version;
80 }
81
82 static void __init omap3_beagle_init_rev(void)
83 {
84         int ret;
85         u16 beagle_rev = 0;
86
87         omap_mux_init_gpio(171, OMAP_PIN_INPUT_PULLUP);
88         omap_mux_init_gpio(172, OMAP_PIN_INPUT_PULLUP);
89         omap_mux_init_gpio(173, OMAP_PIN_INPUT_PULLUP);
90
91         ret = gpio_request(171, "rev_id_0");
92         if (ret < 0)
93                 goto fail0;
94
95         ret = gpio_request(172, "rev_id_1");
96         if (ret < 0)
97                 goto fail1;
98
99         ret = gpio_request(173, "rev_id_2");
100         if (ret < 0)
101                 goto fail2;
102
103         gpio_direction_input(171);
104         gpio_direction_input(172);
105         gpio_direction_input(173);
106
107         beagle_rev = gpio_get_value(171) | (gpio_get_value(172) << 1)
108                         | (gpio_get_value(173) << 2);
109
110         switch (beagle_rev) {
111         case 7:
112                 printk(KERN_INFO "OMAP3 Beagle Rev: Ax/Bx\n");
113                 omap3_beagle_version = OMAP3BEAGLE_BOARD_AXBX;
114                 break;
115         case 6:
116                 printk(KERN_INFO "OMAP3 Beagle Rev: C1/C2/C3\n");
117                 omap3_beagle_version = OMAP3BEAGLE_BOARD_C1_3;
118                 break;
119         case 5:
120                 printk(KERN_INFO "OMAP3 Beagle Rev: C4\n");
121                 omap3_beagle_version = OMAP3BEAGLE_BOARD_C4;
122                 break;
123         case 0:
124                 printk(KERN_INFO "OMAP3 Beagle Rev: xM\n");
125                 omap3_beagle_version = OMAP3BEAGLE_BOARD_XM;
126                 break;
127         default:
128                 printk(KERN_INFO "OMAP3 Beagle Rev: unknown %hd\n", beagle_rev);
129                 omap3_beagle_version = OMAP3BEAGLE_BOARD_UNKN;
130         }
131
132         return;
133
134 fail2:
135         gpio_free(172);
136 fail1:
137         gpio_free(171);
138 fail0:
139         printk(KERN_ERR "Unable to get revision detection GPIO pins\n");
140         omap3_beagle_version = OMAP3BEAGLE_BOARD_UNKN;
141
142         return;
143 }
144
145 static struct mtd_partition omap3beagle_nand_partitions[] = {
146         /* All the partition sizes are listed in terms of NAND block size */
147         {
148                 .name           = "X-Loader",
149                 .offset         = 0,
150                 .size           = 4 * NAND_BLOCK_SIZE,
151                 .mask_flags     = MTD_WRITEABLE,        /* force read-only */
152         },
153         {
154                 .name           = "U-Boot",
155                 .offset         = MTDPART_OFS_APPEND,   /* Offset = 0x80000 */
156                 .size           = 15 * NAND_BLOCK_SIZE,
157                 .mask_flags     = MTD_WRITEABLE,        /* force read-only */
158         },
159         {
160                 .name           = "U-Boot Env",
161                 .offset         = MTDPART_OFS_APPEND,   /* Offset = 0x260000 */
162                 .size           = 1 * NAND_BLOCK_SIZE,
163         },
164         {
165                 .name           = "Kernel",
166                 .offset         = MTDPART_OFS_APPEND,   /* Offset = 0x280000 */
167                 .size           = 32 * NAND_BLOCK_SIZE,
168         },
169         {
170                 .name           = "File System",
171                 .offset         = MTDPART_OFS_APPEND,   /* Offset = 0x680000 */
172                 .size           = MTDPART_SIZ_FULL,
173         },
174 };
175
176 static struct omap_nand_platform_data omap3beagle_nand_data = {
177         .options        = NAND_BUSWIDTH_16,
178         .parts          = omap3beagle_nand_partitions,
179         .nr_parts       = ARRAY_SIZE(omap3beagle_nand_partitions),
180         .dma_channel    = -1,           /* disable DMA in OMAP NAND driver */
181         .nand_setup     = NULL,
182         .dev_ready      = NULL,
183 };
184
185 /* DSS */
186
187 static int beagle_enable_dvi(struct omap_dss_device *dssdev)
188 {
189         if (gpio_is_valid(dssdev->reset_gpio))
190                 gpio_set_value(dssdev->reset_gpio, 1);
191
192         return 0;
193 }
194
195 static void beagle_disable_dvi(struct omap_dss_device *dssdev)
196 {
197         if (gpio_is_valid(dssdev->reset_gpio))
198                 gpio_set_value(dssdev->reset_gpio, 0);
199 }
200
201 static struct panel_generic_dpi_data dvi_panel = {
202         .name = "generic",
203         .platform_enable = beagle_enable_dvi,
204         .platform_disable = beagle_disable_dvi,
205 };
206
207 static struct omap_dss_device beagle_dvi_device = {
208         .type = OMAP_DISPLAY_TYPE_DPI,
209         .name = "dvi",
210         .driver_name = "generic_dpi_panel",
211         .data = &dvi_panel,
212         .phy.dpi.data_lines = 24,
213         .reset_gpio = -EINVAL,
214 };
215
216 static struct omap_dss_device beagle_tv_device = {
217         .name = "tv",
218         .driver_name = "venc",
219         .type = OMAP_DISPLAY_TYPE_VENC,
220         .phy.venc.type = OMAP_DSS_VENC_TYPE_SVIDEO,
221 };
222
223 static struct omap_dss_device *beagle_dss_devices[] = {
224         &beagle_dvi_device,
225         &beagle_tv_device,
226 };
227
228 static struct omap_dss_board_info beagle_dss_data = {
229         .num_devices = ARRAY_SIZE(beagle_dss_devices),
230         .devices = beagle_dss_devices,
231         .default_device = &beagle_dvi_device,
232 };
233
234 static struct regulator_consumer_supply beagle_vdac_supply =
235         REGULATOR_SUPPLY("vdda_dac", "omapdss_venc");
236
237 static struct regulator_consumer_supply beagle_vdvi_supplies[] = {
238         REGULATOR_SUPPLY("vdds_dsi", "omapdss"),
239         REGULATOR_SUPPLY("vdds_dsi", "omapdss_dsi1"),
240 };
241
242 static void __init beagle_display_init(void)
243 {
244         int r;
245
246         r = gpio_request(beagle_dvi_device.reset_gpio, "DVI reset");
247         if (r < 0) {
248                 printk(KERN_ERR "Unable to get DVI reset GPIO\n");
249                 return;
250         }
251
252         gpio_direction_output(beagle_dvi_device.reset_gpio, 0);
253 }
254
255 #include "sdram-micron-mt46h32m32lf-6.h"
256
257 static struct omap2_hsmmc_info mmc[] = {
258         {
259                 .mmc            = 1,
260                 .caps           = MMC_CAP_4_BIT_DATA | MMC_CAP_8_BIT_DATA,
261                 .gpio_wp        = 29,
262         },
263         {}      /* Terminator */
264 };
265
266 static struct regulator_consumer_supply beagle_vmmc1_supply = {
267         .supply                 = "vmmc",
268 };
269
270 static struct regulator_consumer_supply beagle_vsim_supply = {
271         .supply                 = "vmmc_aux",
272 };
273
274 static struct gpio_led gpio_leds[];
275
276 static int beagle_twl_gpio_setup(struct device *dev,
277                 unsigned gpio, unsigned ngpio)
278 {
279         int r;
280
281         if (omap3_beagle_get_rev() == OMAP3BEAGLE_BOARD_XM) {
282                 mmc[0].gpio_wp = -EINVAL;
283         } else if ((omap3_beagle_get_rev() == OMAP3BEAGLE_BOARD_C1_3) ||
284                 (omap3_beagle_get_rev() == OMAP3BEAGLE_BOARD_C4)) {
285                 omap_mux_init_gpio(23, OMAP_PIN_INPUT);
286                 mmc[0].gpio_wp = 23;
287         } else {
288                 omap_mux_init_gpio(29, OMAP_PIN_INPUT);
289         }
290         /* gpio + 0 is "mmc0_cd" (input/IRQ) */
291         mmc[0].gpio_cd = gpio + 0;
292         omap2_hsmmc_init(mmc);
293
294         /* link regulators to MMC adapters */
295         beagle_vmmc1_supply.dev = mmc[0].dev;
296         beagle_vsim_supply.dev = mmc[0].dev;
297
298         /* REVISIT: need ehci-omap hooks for external VBUS
299          * power switch and overcurrent detect
300          */
301         if (omap3_beagle_get_rev() != OMAP3BEAGLE_BOARD_XM) {
302                 r = gpio_request(gpio + 1, "EHCI_nOC");
303                 if (!r) {
304                         r = gpio_direction_input(gpio + 1);
305                         if (r)
306                                 gpio_free(gpio + 1);
307                 }
308                 if (r)
309                         pr_err("%s: unable to configure EHCI_nOC\n", __func__);
310         }
311
312         /*
313          * TWL4030_GPIO_MAX + 0 == ledA, EHCI nEN_USB_PWR (out, XM active
314          * high / others active low)
315          */
316         gpio_request(gpio + TWL4030_GPIO_MAX, "nEN_USB_PWR");
317         if (omap3_beagle_get_rev() == OMAP3BEAGLE_BOARD_XM)
318                 gpio_direction_output(gpio + TWL4030_GPIO_MAX, 1);
319         else
320                 gpio_direction_output(gpio + TWL4030_GPIO_MAX, 0);
321
322         /* DVI reset GPIO is different between beagle revisions */
323         if (omap3_beagle_get_rev() == OMAP3BEAGLE_BOARD_XM)
324                 beagle_dvi_device.reset_gpio = 129;
325         else
326                 beagle_dvi_device.reset_gpio = 170;
327
328         /* TWL4030_GPIO_MAX + 1 == ledB, PMU_STAT (out, active low LED) */
329         gpio_leds[2].gpio = gpio + TWL4030_GPIO_MAX + 1;
330
331         /*
332          * gpio + 1 on Xm controls the TFP410's enable line (active low)
333          * gpio + 2 control varies depending on the board rev as follows:
334          * P7/P8 revisions(prototype): Camera EN
335          * A2+ revisions (production): LDO (supplies DVI, serial, led blocks)
336          */
337         if (omap3_beagle_get_rev() == OMAP3BEAGLE_BOARD_XM) {
338                 r = gpio_request(gpio + 1, "nDVI_PWR_EN");
339                 if (!r) {
340                         r = gpio_direction_output(gpio + 1, 0);
341                         if (r)
342                                 gpio_free(gpio + 1);
343                 }
344                 if (r)
345                         pr_err("%s: unable to configure nDVI_PWR_EN\n",
346                                 __func__);
347                 r = gpio_request(gpio + 2, "DVI_LDO_EN");
348                 if (!r) {
349                         r = gpio_direction_output(gpio + 2, 1);
350                         if (r)
351                                 gpio_free(gpio + 2);
352                 }
353                 if (r)
354                         pr_err("%s: unable to configure DVI_LDO_EN\n",
355                                 __func__);
356         }
357
358         return 0;
359 }
360
361 static struct twl4030_gpio_platform_data beagle_gpio_data = {
362         .gpio_base      = OMAP_MAX_GPIO_LINES,
363         .irq_base       = TWL4030_GPIO_IRQ_BASE,
364         .irq_end        = TWL4030_GPIO_IRQ_END,
365         .use_leds       = true,
366         .pullups        = BIT(1),
367         .pulldowns      = BIT(2) | BIT(6) | BIT(7) | BIT(8) | BIT(13)
368                                 | BIT(15) | BIT(16) | BIT(17),
369         .setup          = beagle_twl_gpio_setup,
370 };
371
372 /* VMMC1 for MMC1 pins CMD, CLK, DAT0..DAT3 (20 mA, plus card == max 220 mA) */
373 static struct regulator_init_data beagle_vmmc1 = {
374         .constraints = {
375                 .min_uV                 = 1850000,
376                 .max_uV                 = 3150000,
377                 .valid_modes_mask       = REGULATOR_MODE_NORMAL
378                                         | REGULATOR_MODE_STANDBY,
379                 .valid_ops_mask         = REGULATOR_CHANGE_VOLTAGE
380                                         | REGULATOR_CHANGE_MODE
381                                         | REGULATOR_CHANGE_STATUS,
382         },
383         .num_consumer_supplies  = 1,
384         .consumer_supplies      = &beagle_vmmc1_supply,
385 };
386
387 /* VSIM for MMC1 pins DAT4..DAT7 (2 mA, plus card == max 50 mA) */
388 static struct regulator_init_data beagle_vsim = {
389         .constraints = {
390                 .min_uV                 = 1800000,
391                 .max_uV                 = 3000000,
392                 .valid_modes_mask       = REGULATOR_MODE_NORMAL
393                                         | REGULATOR_MODE_STANDBY,
394                 .valid_ops_mask         = REGULATOR_CHANGE_VOLTAGE
395                                         | REGULATOR_CHANGE_MODE
396                                         | REGULATOR_CHANGE_STATUS,
397         },
398         .num_consumer_supplies  = 1,
399         .consumer_supplies      = &beagle_vsim_supply,
400 };
401
402 /* VDAC for DSS driving S-Video (8 mA unloaded, max 65 mA) */
403 static struct regulator_init_data beagle_vdac = {
404         .constraints = {
405                 .min_uV                 = 1800000,
406                 .max_uV                 = 1800000,
407                 .valid_modes_mask       = REGULATOR_MODE_NORMAL
408                                         | REGULATOR_MODE_STANDBY,
409                 .valid_ops_mask         = REGULATOR_CHANGE_MODE
410                                         | REGULATOR_CHANGE_STATUS,
411         },
412         .num_consumer_supplies  = 1,
413         .consumer_supplies      = &beagle_vdac_supply,
414 };
415
416 /* VPLL2 for digital video outputs */
417 static struct regulator_init_data beagle_vpll2 = {
418         .constraints = {
419                 .name                   = "VDVI",
420                 .min_uV                 = 1800000,
421                 .max_uV                 = 1800000,
422                 .valid_modes_mask       = REGULATOR_MODE_NORMAL
423                                         | REGULATOR_MODE_STANDBY,
424                 .valid_ops_mask         = REGULATOR_CHANGE_MODE
425                                         | REGULATOR_CHANGE_STATUS,
426         },
427         .num_consumer_supplies  = ARRAY_SIZE(beagle_vdvi_supplies),
428         .consumer_supplies      = beagle_vdvi_supplies,
429 };
430
431 static struct twl4030_usb_data beagle_usb_data = {
432         .usb_mode       = T2_USB_MODE_ULPI,
433 };
434
435 static struct twl4030_codec_audio_data beagle_audio_data;
436
437 static struct twl4030_codec_data beagle_codec_data = {
438         .audio_mclk = 26000000,
439         .audio = &beagle_audio_data,
440 };
441
442 static struct twl4030_platform_data beagle_twldata = {
443         .irq_base       = TWL4030_IRQ_BASE,
444         .irq_end        = TWL4030_IRQ_END,
445
446         /* platform_data for children goes here */
447         .usb            = &beagle_usb_data,
448         .gpio           = &beagle_gpio_data,
449         .codec          = &beagle_codec_data,
450         .vmmc1          = &beagle_vmmc1,
451         .vsim           = &beagle_vsim,
452         .vdac           = &beagle_vdac,
453         .vpll2          = &beagle_vpll2,
454 };
455
456 static struct i2c_board_info __initdata beagle_i2c_boardinfo[] = {
457         {
458                 I2C_BOARD_INFO("twl4030", 0x48),
459                 .flags = I2C_CLIENT_WAKE,
460                 .irq = INT_34XX_SYS_NIRQ,
461                 .platform_data = &beagle_twldata,
462         },
463 };
464
465 static struct i2c_board_info __initdata beagle_i2c_eeprom[] = {
466        {
467                I2C_BOARD_INFO("eeprom", 0x50),
468        },
469 };
470
471 static int __init omap3_beagle_i2c_init(void)
472 {
473         omap_register_i2c_bus(1, 2600, beagle_i2c_boardinfo,
474                         ARRAY_SIZE(beagle_i2c_boardinfo));
475         /* Bus 3 is attached to the DVI port where devices like the pico DLP
476          * projector don't work reliably with 400kHz */
477         omap_register_i2c_bus(3, 100, beagle_i2c_eeprom, ARRAY_SIZE(beagle_i2c_eeprom));
478         return 0;
479 }
480
481 static struct gpio_led gpio_leds[] = {
482         {
483                 .name                   = "beagleboard::usr0",
484                 .default_trigger        = "heartbeat",
485                 .gpio                   = 150,
486         },
487         {
488                 .name                   = "beagleboard::usr1",
489                 .default_trigger        = "mmc0",
490                 .gpio                   = 149,
491         },
492         {
493                 .name                   = "beagleboard::pmu_stat",
494                 .gpio                   = -EINVAL,      /* gets replaced */
495                 .active_low             = true,
496         },
497 };
498
499 static struct gpio_led_platform_data gpio_led_info = {
500         .leds           = gpio_leds,
501         .num_leds       = ARRAY_SIZE(gpio_leds),
502 };
503
504 static struct platform_device leds_gpio = {
505         .name   = "leds-gpio",
506         .id     = -1,
507         .dev    = {
508                 .platform_data  = &gpio_led_info,
509         },
510 };
511
512 static struct gpio_keys_button gpio_buttons[] = {
513         {
514                 .code                   = BTN_EXTRA,
515                 .gpio                   = 7,
516                 .desc                   = "user",
517                 .wakeup                 = 1,
518         },
519 };
520
521 static struct gpio_keys_platform_data gpio_key_info = {
522         .buttons        = gpio_buttons,
523         .nbuttons       = ARRAY_SIZE(gpio_buttons),
524 };
525
526 static struct platform_device keys_gpio = {
527         .name   = "gpio-keys",
528         .id     = -1,
529         .dev    = {
530                 .platform_data  = &gpio_key_info,
531         },
532 };
533
534 static void __init omap3_beagle_init_early(void)
535 {
536         omap2_init_common_infrastructure();
537         omap2_init_common_devices(mt46h32m32lf6_sdrc_params,
538                                   mt46h32m32lf6_sdrc_params);
539 }
540
541 static void __init omap3_beagle_init_irq(void)
542 {
543         omap_init_irq();
544 #ifdef CONFIG_OMAP_32K_TIMER
545         omap2_gp_clockevent_set_gptimer(12);
546 #endif
547 }
548
549 static struct platform_device *omap3_beagle_devices[] __initdata = {
550         &leds_gpio,
551         &keys_gpio,
552 };
553
554 static void __init omap3beagle_flash_init(void)
555 {
556         u8 cs = 0;
557         u8 nandcs = GPMC_CS_NUM + 1;
558
559         /* find out the chip-select on which NAND exists */
560         while (cs < GPMC_CS_NUM) {
561                 u32 ret = 0;
562                 ret = gpmc_cs_read_reg(cs, GPMC_CS_CONFIG1);
563
564                 if ((ret & 0xC00) == 0x800) {
565                         printk(KERN_INFO "Found NAND on CS%d\n", cs);
566                         if (nandcs > GPMC_CS_NUM)
567                                 nandcs = cs;
568                 }
569                 cs++;
570         }
571
572         if (nandcs > GPMC_CS_NUM) {
573                 printk(KERN_INFO "NAND: Unable to find configuration "
574                                  "in GPMC\n ");
575                 return;
576         }
577
578         if (nandcs < GPMC_CS_NUM) {
579                 omap3beagle_nand_data.cs = nandcs;
580
581                 printk(KERN_INFO "Registering NAND on CS%d\n", nandcs);
582                 if (gpmc_nand_init(&omap3beagle_nand_data) < 0)
583                         printk(KERN_ERR "Unable to register NAND device\n");
584         }
585 }
586
587 static const struct usbhs_omap_board_data usbhs_bdata __initconst = {
588
589         .port_mode[0] = OMAP_EHCI_PORT_MODE_PHY,
590         .port_mode[1] = OMAP_EHCI_PORT_MODE_PHY,
591         .port_mode[2] = OMAP_USBHS_PORT_MODE_UNUSED,
592
593         .phy_reset  = true,
594         .reset_gpio_port[0]  = -EINVAL,
595         .reset_gpio_port[1]  = 147,
596         .reset_gpio_port[2]  = -EINVAL
597 };
598
599 #ifdef CONFIG_OMAP_MUX
600 static struct omap_board_mux board_mux[] __initdata = {
601         { .reg_offset = OMAP_MUX_TERMINATOR },
602 };
603 #endif
604
605 static struct omap_musb_board_data musb_board_data = {
606         .interface_type         = MUSB_INTERFACE_ULPI,
607         .mode                   = MUSB_OTG,
608         .power                  = 100,
609 };
610
611 static void __init beagle_opp_init(void)
612 {
613         int r = 0;
614
615         /* Initialize the omap3 opp table */
616         if (omap3_opp_init()) {
617                 pr_err("%s: opp default init failed\n", __func__);
618                 return;
619         }
620
621         /* Custom OPP enabled for XM */
622         if (omap3_beagle_get_rev() == OMAP3BEAGLE_BOARD_XM) {
623                 struct omap_hwmod *mh = omap_hwmod_lookup("mpu");
624                 struct omap_hwmod *dh = omap_hwmod_lookup("iva");
625                 struct device *dev;
626
627                 if (!mh || !dh) {
628                         pr_err("%s: Aiee.. no mpu/dsp devices? %p %p\n",
629                                 __func__, mh, dh);
630                         return;
631                 }
632                 /* Enable MPU 1GHz and lower opps */
633                 dev = &mh->od->pdev.dev;
634                 r = opp_enable(dev, 800000000);
635                 /* TODO: MPU 1GHz needs SR and ABB */
636
637                 /* Enable IVA 800MHz and lower opps */
638                 dev = &dh->od->pdev.dev;
639                 r |= opp_enable(dev, 660000000);
640                 /* TODO: DSP 800MHz needs SR and ABB */
641                 if (r) {
642                         pr_err("%s: failed to enable higher opp %d\n",
643                                 __func__, r);
644                         /*
645                          * Cleanup - disable the higher freqs - we dont care
646                          * about the results
647                          */
648                         dev = &mh->od->pdev.dev;
649                         opp_disable(dev, 800000000);
650                         dev = &dh->od->pdev.dev;
651                         opp_disable(dev, 660000000);
652                 }
653         }
654         return;
655 }
656
657 static void __init omap3_beagle_init(void)
658 {
659         omap3_mux_init(board_mux, OMAP_PACKAGE_CBB);
660         omap3_beagle_init_rev();
661         omap3_beagle_i2c_init();
662         platform_add_devices(omap3_beagle_devices,
663                         ARRAY_SIZE(omap3_beagle_devices));
664         omap_display_init(&beagle_dss_data);
665         omap_serial_init();
666
667         omap_mux_init_gpio(170, OMAP_PIN_INPUT);
668         gpio_request(170, "DVI_nPD");
669         /* REVISIT leave DVI powered down until it's needed ... */
670         gpio_direction_output(170, true);
671
672         usb_musb_init(&musb_board_data);
673         usbhs_init(&usbhs_bdata);
674         omap3beagle_flash_init();
675
676         /* Ensure SDRC pins are mux'd for self-refresh */
677         omap_mux_init_signal("sdrc_cke0", OMAP_PIN_OUTPUT);
678         omap_mux_init_signal("sdrc_cke1", OMAP_PIN_OUTPUT);
679
680         beagle_display_init();
681         beagle_opp_init();
682 }
683
684 MACHINE_START(OMAP3_BEAGLE, "OMAP3 Beagle Board")
685         /* Maintainer: Syed Mohammed Khasim - http://beagleboard.org */
686         .boot_params    = 0x80000100,
687         .reserve        = omap_reserve,
688         .map_io         = omap3_map_io,
689         .init_early     = omap3_beagle_init_early,
690         .init_irq       = omap3_beagle_init_irq,
691         .init_machine   = omap3_beagle_init,
692         .timer          = &omap_timer,
693 MACHINE_END