Merge branch 'x86-fixes-for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git...
[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");
236
237 static struct regulator_consumer_supply beagle_vdvi_supply =
238         REGULATOR_SUPPLY("vdds_dsi", "omapdss");
239
240 static void __init beagle_display_init(void)
241 {
242         int r;
243
244         r = gpio_request(beagle_dvi_device.reset_gpio, "DVI reset");
245         if (r < 0) {
246                 printk(KERN_ERR "Unable to get DVI reset GPIO\n");
247                 return;
248         }
249
250         gpio_direction_output(beagle_dvi_device.reset_gpio, 0);
251 }
252
253 #include "sdram-micron-mt46h32m32lf-6.h"
254
255 static struct omap2_hsmmc_info mmc[] = {
256         {
257                 .mmc            = 1,
258                 .caps           = MMC_CAP_4_BIT_DATA | MMC_CAP_8_BIT_DATA,
259                 .gpio_wp        = 29,
260         },
261         {}      /* Terminator */
262 };
263
264 static struct regulator_consumer_supply beagle_vmmc1_supply = {
265         .supply                 = "vmmc",
266 };
267
268 static struct regulator_consumer_supply beagle_vsim_supply = {
269         .supply                 = "vmmc_aux",
270 };
271
272 static struct gpio_led gpio_leds[];
273
274 static int beagle_twl_gpio_setup(struct device *dev,
275                 unsigned gpio, unsigned ngpio)
276 {
277         int r;
278
279         if (omap3_beagle_get_rev() == OMAP3BEAGLE_BOARD_XM) {
280                 mmc[0].gpio_wp = -EINVAL;
281         } else if ((omap3_beagle_get_rev() == OMAP3BEAGLE_BOARD_C1_3) ||
282                 (omap3_beagle_get_rev() == OMAP3BEAGLE_BOARD_C4)) {
283                 omap_mux_init_gpio(23, OMAP_PIN_INPUT);
284                 mmc[0].gpio_wp = 23;
285         } else {
286                 omap_mux_init_gpio(29, OMAP_PIN_INPUT);
287         }
288         /* gpio + 0 is "mmc0_cd" (input/IRQ) */
289         mmc[0].gpio_cd = gpio + 0;
290         omap2_hsmmc_init(mmc);
291
292         /* link regulators to MMC adapters */
293         beagle_vmmc1_supply.dev = mmc[0].dev;
294         beagle_vsim_supply.dev = mmc[0].dev;
295
296         /* REVISIT: need ehci-omap hooks for external VBUS
297          * power switch and overcurrent detect
298          */
299         if (omap3_beagle_get_rev() != OMAP3BEAGLE_BOARD_XM) {
300                 r = gpio_request(gpio + 1, "EHCI_nOC");
301                 if (!r) {
302                         r = gpio_direction_input(gpio + 1);
303                         if (r)
304                                 gpio_free(gpio + 1);
305                 }
306                 if (r)
307                         pr_err("%s: unable to configure EHCI_nOC\n", __func__);
308         }
309
310         /*
311          * TWL4030_GPIO_MAX + 0 == ledA, EHCI nEN_USB_PWR (out, XM active
312          * high / others active low)
313          */
314         gpio_request(gpio + TWL4030_GPIO_MAX, "nEN_USB_PWR");
315         if (omap3_beagle_get_rev() == OMAP3BEAGLE_BOARD_XM)
316                 gpio_direction_output(gpio + TWL4030_GPIO_MAX, 1);
317         else
318                 gpio_direction_output(gpio + TWL4030_GPIO_MAX, 0);
319
320         /* DVI reset GPIO is different between beagle revisions */
321         if (omap3_beagle_get_rev() == OMAP3BEAGLE_BOARD_XM)
322                 beagle_dvi_device.reset_gpio = 129;
323         else
324                 beagle_dvi_device.reset_gpio = 170;
325
326         /* TWL4030_GPIO_MAX + 1 == ledB, PMU_STAT (out, active low LED) */
327         gpio_leds[2].gpio = gpio + TWL4030_GPIO_MAX + 1;
328
329         /*
330          * gpio + 1 on Xm controls the TFP410's enable line (active low)
331          * gpio + 2 control varies depending on the board rev as follows:
332          * P7/P8 revisions(prototype): Camera EN
333          * A2+ revisions (production): LDO (supplies DVI, serial, led blocks)
334          */
335         if (omap3_beagle_get_rev() == OMAP3BEAGLE_BOARD_XM) {
336                 r = gpio_request(gpio + 1, "nDVI_PWR_EN");
337                 if (!r) {
338                         r = gpio_direction_output(gpio + 1, 0);
339                         if (r)
340                                 gpio_free(gpio + 1);
341                 }
342                 if (r)
343                         pr_err("%s: unable to configure nDVI_PWR_EN\n",
344                                 __func__);
345                 r = gpio_request(gpio + 2, "DVI_LDO_EN");
346                 if (!r) {
347                         r = gpio_direction_output(gpio + 2, 1);
348                         if (r)
349                                 gpio_free(gpio + 2);
350                 }
351                 if (r)
352                         pr_err("%s: unable to configure DVI_LDO_EN\n",
353                                 __func__);
354         }
355
356         return 0;
357 }
358
359 static struct twl4030_gpio_platform_data beagle_gpio_data = {
360         .gpio_base      = OMAP_MAX_GPIO_LINES,
361         .irq_base       = TWL4030_GPIO_IRQ_BASE,
362         .irq_end        = TWL4030_GPIO_IRQ_END,
363         .use_leds       = true,
364         .pullups        = BIT(1),
365         .pulldowns      = BIT(2) | BIT(6) | BIT(7) | BIT(8) | BIT(13)
366                                 | BIT(15) | BIT(16) | BIT(17),
367         .setup          = beagle_twl_gpio_setup,
368 };
369
370 /* VMMC1 for MMC1 pins CMD, CLK, DAT0..DAT3 (20 mA, plus card == max 220 mA) */
371 static struct regulator_init_data beagle_vmmc1 = {
372         .constraints = {
373                 .min_uV                 = 1850000,
374                 .max_uV                 = 3150000,
375                 .valid_modes_mask       = REGULATOR_MODE_NORMAL
376                                         | REGULATOR_MODE_STANDBY,
377                 .valid_ops_mask         = REGULATOR_CHANGE_VOLTAGE
378                                         | REGULATOR_CHANGE_MODE
379                                         | REGULATOR_CHANGE_STATUS,
380         },
381         .num_consumer_supplies  = 1,
382         .consumer_supplies      = &beagle_vmmc1_supply,
383 };
384
385 /* VSIM for MMC1 pins DAT4..DAT7 (2 mA, plus card == max 50 mA) */
386 static struct regulator_init_data beagle_vsim = {
387         .constraints = {
388                 .min_uV                 = 1800000,
389                 .max_uV                 = 3000000,
390                 .valid_modes_mask       = REGULATOR_MODE_NORMAL
391                                         | REGULATOR_MODE_STANDBY,
392                 .valid_ops_mask         = REGULATOR_CHANGE_VOLTAGE
393                                         | REGULATOR_CHANGE_MODE
394                                         | REGULATOR_CHANGE_STATUS,
395         },
396         .num_consumer_supplies  = 1,
397         .consumer_supplies      = &beagle_vsim_supply,
398 };
399
400 /* VDAC for DSS driving S-Video (8 mA unloaded, max 65 mA) */
401 static struct regulator_init_data beagle_vdac = {
402         .constraints = {
403                 .min_uV                 = 1800000,
404                 .max_uV                 = 1800000,
405                 .valid_modes_mask       = REGULATOR_MODE_NORMAL
406                                         | REGULATOR_MODE_STANDBY,
407                 .valid_ops_mask         = REGULATOR_CHANGE_MODE
408                                         | REGULATOR_CHANGE_STATUS,
409         },
410         .num_consumer_supplies  = 1,
411         .consumer_supplies      = &beagle_vdac_supply,
412 };
413
414 /* VPLL2 for digital video outputs */
415 static struct regulator_init_data beagle_vpll2 = {
416         .constraints = {
417                 .name                   = "VDVI",
418                 .min_uV                 = 1800000,
419                 .max_uV                 = 1800000,
420                 .valid_modes_mask       = REGULATOR_MODE_NORMAL
421                                         | REGULATOR_MODE_STANDBY,
422                 .valid_ops_mask         = REGULATOR_CHANGE_MODE
423                                         | REGULATOR_CHANGE_STATUS,
424         },
425         .num_consumer_supplies  = 1,
426         .consumer_supplies      = &beagle_vdvi_supply,
427 };
428
429 static struct twl4030_usb_data beagle_usb_data = {
430         .usb_mode       = T2_USB_MODE_ULPI,
431 };
432
433 static struct twl4030_codec_audio_data beagle_audio_data;
434
435 static struct twl4030_codec_data beagle_codec_data = {
436         .audio_mclk = 26000000,
437         .audio = &beagle_audio_data,
438 };
439
440 static struct twl4030_platform_data beagle_twldata = {
441         .irq_base       = TWL4030_IRQ_BASE,
442         .irq_end        = TWL4030_IRQ_END,
443
444         /* platform_data for children goes here */
445         .usb            = &beagle_usb_data,
446         .gpio           = &beagle_gpio_data,
447         .codec          = &beagle_codec_data,
448         .vmmc1          = &beagle_vmmc1,
449         .vsim           = &beagle_vsim,
450         .vdac           = &beagle_vdac,
451         .vpll2          = &beagle_vpll2,
452 };
453
454 static struct i2c_board_info __initdata beagle_i2c_boardinfo[] = {
455         {
456                 I2C_BOARD_INFO("twl4030", 0x48),
457                 .flags = I2C_CLIENT_WAKE,
458                 .irq = INT_34XX_SYS_NIRQ,
459                 .platform_data = &beagle_twldata,
460         },
461 };
462
463 static struct i2c_board_info __initdata beagle_i2c_eeprom[] = {
464        {
465                I2C_BOARD_INFO("eeprom", 0x50),
466        },
467 };
468
469 static int __init omap3_beagle_i2c_init(void)
470 {
471         omap_register_i2c_bus(1, 2600, beagle_i2c_boardinfo,
472                         ARRAY_SIZE(beagle_i2c_boardinfo));
473         /* Bus 3 is attached to the DVI port where devices like the pico DLP
474          * projector don't work reliably with 400kHz */
475         omap_register_i2c_bus(3, 100, beagle_i2c_eeprom, ARRAY_SIZE(beagle_i2c_eeprom));
476         return 0;
477 }
478
479 static struct gpio_led gpio_leds[] = {
480         {
481                 .name                   = "beagleboard::usr0",
482                 .default_trigger        = "heartbeat",
483                 .gpio                   = 150,
484         },
485         {
486                 .name                   = "beagleboard::usr1",
487                 .default_trigger        = "mmc0",
488                 .gpio                   = 149,
489         },
490         {
491                 .name                   = "beagleboard::pmu_stat",
492                 .gpio                   = -EINVAL,      /* gets replaced */
493                 .active_low             = true,
494         },
495 };
496
497 static struct gpio_led_platform_data gpio_led_info = {
498         .leds           = gpio_leds,
499         .num_leds       = ARRAY_SIZE(gpio_leds),
500 };
501
502 static struct platform_device leds_gpio = {
503         .name   = "leds-gpio",
504         .id     = -1,
505         .dev    = {
506                 .platform_data  = &gpio_led_info,
507         },
508 };
509
510 static struct gpio_keys_button gpio_buttons[] = {
511         {
512                 .code                   = BTN_EXTRA,
513                 .gpio                   = 7,
514                 .desc                   = "user",
515                 .wakeup                 = 1,
516         },
517 };
518
519 static struct gpio_keys_platform_data gpio_key_info = {
520         .buttons        = gpio_buttons,
521         .nbuttons       = ARRAY_SIZE(gpio_buttons),
522 };
523
524 static struct platform_device keys_gpio = {
525         .name   = "gpio-keys",
526         .id     = -1,
527         .dev    = {
528                 .platform_data  = &gpio_key_info,
529         },
530 };
531
532 static void __init omap3_beagle_init_early(void)
533 {
534         omap2_init_common_infrastructure();
535         omap2_init_common_devices(mt46h32m32lf6_sdrc_params,
536                                   mt46h32m32lf6_sdrc_params);
537 }
538
539 static void __init omap3_beagle_init_irq(void)
540 {
541         omap_init_irq();
542 #ifdef CONFIG_OMAP_32K_TIMER
543         omap2_gp_clockevent_set_gptimer(12);
544 #endif
545 }
546
547 static struct platform_device *omap3_beagle_devices[] __initdata = {
548         &leds_gpio,
549         &keys_gpio,
550 };
551
552 static void __init omap3beagle_flash_init(void)
553 {
554         u8 cs = 0;
555         u8 nandcs = GPMC_CS_NUM + 1;
556
557         /* find out the chip-select on which NAND exists */
558         while (cs < GPMC_CS_NUM) {
559                 u32 ret = 0;
560                 ret = gpmc_cs_read_reg(cs, GPMC_CS_CONFIG1);
561
562                 if ((ret & 0xC00) == 0x800) {
563                         printk(KERN_INFO "Found NAND on CS%d\n", cs);
564                         if (nandcs > GPMC_CS_NUM)
565                                 nandcs = cs;
566                 }
567                 cs++;
568         }
569
570         if (nandcs > GPMC_CS_NUM) {
571                 printk(KERN_INFO "NAND: Unable to find configuration "
572                                  "in GPMC\n ");
573                 return;
574         }
575
576         if (nandcs < GPMC_CS_NUM) {
577                 omap3beagle_nand_data.cs = nandcs;
578
579                 printk(KERN_INFO "Registering NAND on CS%d\n", nandcs);
580                 if (gpmc_nand_init(&omap3beagle_nand_data) < 0)
581                         printk(KERN_ERR "Unable to register NAND device\n");
582         }
583 }
584
585 static const struct usbhs_omap_board_data usbhs_bdata __initconst = {
586
587         .port_mode[0] = OMAP_EHCI_PORT_MODE_PHY,
588         .port_mode[1] = OMAP_EHCI_PORT_MODE_PHY,
589         .port_mode[2] = OMAP_USBHS_PORT_MODE_UNUSED,
590
591         .phy_reset  = true,
592         .reset_gpio_port[0]  = -EINVAL,
593         .reset_gpio_port[1]  = 147,
594         .reset_gpio_port[2]  = -EINVAL
595 };
596
597 #ifdef CONFIG_OMAP_MUX
598 static struct omap_board_mux board_mux[] __initdata = {
599         { .reg_offset = OMAP_MUX_TERMINATOR },
600 };
601 #endif
602
603 static struct omap_musb_board_data musb_board_data = {
604         .interface_type         = MUSB_INTERFACE_ULPI,
605         .mode                   = MUSB_OTG,
606         .power                  = 100,
607 };
608
609 static void __init beagle_opp_init(void)
610 {
611         int r = 0;
612
613         /* Initialize the omap3 opp table */
614         if (omap3_opp_init()) {
615                 pr_err("%s: opp default init failed\n", __func__);
616                 return;
617         }
618
619         /* Custom OPP enabled for XM */
620         if (omap3_beagle_get_rev() == OMAP3BEAGLE_BOARD_XM) {
621                 struct omap_hwmod *mh = omap_hwmod_lookup("mpu");
622                 struct omap_hwmod *dh = omap_hwmod_lookup("iva");
623                 struct device *dev;
624
625                 if (!mh || !dh) {
626                         pr_err("%s: Aiee.. no mpu/dsp devices? %p %p\n",
627                                 __func__, mh, dh);
628                         return;
629                 }
630                 /* Enable MPU 1GHz and lower opps */
631                 dev = &mh->od->pdev.dev;
632                 r = opp_enable(dev, 800000000);
633                 /* TODO: MPU 1GHz needs SR and ABB */
634
635                 /* Enable IVA 800MHz and lower opps */
636                 dev = &dh->od->pdev.dev;
637                 r |= opp_enable(dev, 660000000);
638                 /* TODO: DSP 800MHz needs SR and ABB */
639                 if (r) {
640                         pr_err("%s: failed to enable higher opp %d\n",
641                                 __func__, r);
642                         /*
643                          * Cleanup - disable the higher freqs - we dont care
644                          * about the results
645                          */
646                         dev = &mh->od->pdev.dev;
647                         opp_disable(dev, 800000000);
648                         dev = &dh->od->pdev.dev;
649                         opp_disable(dev, 660000000);
650                 }
651         }
652         return;
653 }
654
655 static void __init omap3_beagle_init(void)
656 {
657         omap3_mux_init(board_mux, OMAP_PACKAGE_CBB);
658         omap3_beagle_init_rev();
659         omap3_beagle_i2c_init();
660         platform_add_devices(omap3_beagle_devices,
661                         ARRAY_SIZE(omap3_beagle_devices));
662         omap_display_init(&beagle_dss_data);
663         omap_serial_init();
664
665         omap_mux_init_gpio(170, OMAP_PIN_INPUT);
666         gpio_request(170, "DVI_nPD");
667         /* REVISIT leave DVI powered down until it's needed ... */
668         gpio_direction_output(170, true);
669
670         usb_musb_init(&musb_board_data);
671         usbhs_init(&usbhs_bdata);
672         omap3beagle_flash_init();
673
674         /* Ensure SDRC pins are mux'd for self-refresh */
675         omap_mux_init_signal("sdrc_cke0", OMAP_PIN_OUTPUT);
676         omap_mux_init_signal("sdrc_cke1", OMAP_PIN_OUTPUT);
677
678         beagle_display_init();
679         beagle_opp_init();
680 }
681
682 MACHINE_START(OMAP3_BEAGLE, "OMAP3 Beagle Board")
683         /* Maintainer: Syed Mohammed Khasim - http://beagleboard.org */
684         .boot_params    = 0x80000100,
685         .reserve        = omap_reserve,
686         .map_io         = omap3_map_io,
687         .init_early     = omap3_beagle_init_early,
688         .init_irq       = omap3_beagle_init_irq,
689         .init_machine   = omap3_beagle_init,
690         .timer          = &omap_timer,
691 MACHINE_END