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