arch/arm/mach-omap1/board-htcherald.c

   1 // SPDX-License-Identifier: GPL-2.0-or-later
   2 /*
   3  * HTC Herald board configuration
   4  * Copyright (C) 2009 Cory Maccarrone <darkstar6262@gmail.com>
   5  * Copyright (C) 2009 Wing Linux
   6  *
   7  * Based on the board-htcwizard.c file from the linwizard project:
   8  * Copyright (C) 2006 Unai Uribarri
   9  * Copyright (C) 2008 linwizard.sourceforge.net
  10  */
  11 #include <linux/kernel.h>
  12 #include <linux/init.h>
  13 #include <linux/platform_device.h>
  14 #include <linux/input.h>
  15 #include <linux/delay.h>
  16 #include <linux/gpio.h>
  17 #include <linux/gpio_keys.h>
  18 #include <linux/i2c.h>
  19 #include <linux/platform_data/i2c-gpio.h>
  20 #include <linux/htcpld.h>
  21 #include <linux/leds.h>
  22 #include <linux/spi/spi.h>
  23 #include <linux/spi/ads7846.h>
  24 #include <linux/omapfb.h>
  25 #include <linux/platform_data/keypad-omap.h>
  26 #include <linux/soc/ti/omap1-io.h>
  27
  28 #include <asm/mach-types.h>
  29 #include <asm/mach/arch.h>
  30
  31 #include "hardware.h"
  32 #include "omap7xx.h"
  33 #include "mmc.h"
  34 #include "irqs.h"
  35 #include "usb.h"
  36 #include "common.h"
  37
  38 /* LCD register definition */
  39 #define       OMAP_LCDC_CONTROL               (0xfffec000 + 0x00)
  40 #define       OMAP_LCDC_STATUS                (0xfffec000 + 0x10)
  41 #define       OMAP_DMA_LCD_CCR                (0xfffee300 + 0xc2)
  42 #define       OMAP_DMA_LCD_CTRL               (0xfffee300 + 0xc4)
  43 #define       OMAP_LCDC_CTRL_LCD_EN           (1 << 0)
  44 #define       OMAP_LCDC_STAT_DONE             (1 << 0)
  45
  46 /* GPIO definitions for the power button and keyboard slide switch */
  47 #define HTCHERALD_GPIO_POWER 139
  48 #define HTCHERALD_GPIO_SLIDE 174
  49 #define HTCHERALD_GIRQ_BTNS 141
  50
  51 /* GPIO definitions for the touchscreen */
  52 #define HTCHERALD_GPIO_TS 76
  53
  54 /* HTCPLD definitions */
  55
  56 /*
  57  * CPLD Logic
  58  *
  59  * Chip 3 - 0x03
  60  *
  61  * Function            7 6 5 4  3 2 1 0
  62  * ------------------------------------
  63  * DPAD light          x x x x  x x x 1
  64  * SoundDev            x x x x  1 x x x
  65  * Screen white        1 x x x  x x x x
  66  * MMC power on        x x x x  x 1 x x
  67  * Happy times (n)     0 x x x  x 1 x x
  68  *
  69  * Chip 4 - 0x04
  70  *
  71  * Function            7 6 5 4  3 2 1 0
  72  * ------------------------------------
  73  * Keyboard light      x x x x  x x x 1
  74  * LCD Bright (4)      x x x x  x 1 1 x
  75  * LCD Bright (3)      x x x x  x 0 1 x
  76  * LCD Bright (2)      x x x x  x 1 0 x
  77  * LCD Bright (1)      x x x x  x 0 0 x
  78  * LCD Off             x x x x  0 x x x
  79  * LCD image (fb)      1 x x x  x x x x
  80  * LCD image (white)   0 x x x  x x x x
  81  * Caps lock LED       x x 1 x  x x x x
  82  *
  83  * Chip 5 - 0x05
  84  *
  85  * Function            7 6 5 4  3 2 1 0
  86  * ------------------------------------
  87  * Red (solid)         x x x x  x 1 x x
  88  * Red (flash)         x x x x  x x 1 x
  89  * Green (GSM flash)   x x x x  1 x x x
  90  * Green (GSM solid)   x x x 1  x x x x
  91  * Green (wifi flash)  x x 1 x  x x x x
  92  * Blue (bt flash)     x 1 x x  x x x x
  93  * DPAD Int Enable     1 x x x  x x x 0
  94  *
  95  * (Combinations of the above can be made for different colors.)
  96  * The direction pad interrupt enable must be set each time the
  97  * interrupt is handled.
  98  *
  99  * Chip 6 - 0x06
 100  *
 101  * Function            7 6 5 4  3 2 1 0
 102  * ------------------------------------
 103  * Vibrator            x x x x  1 x x x
 104  * Alt LED             x x x 1  x x x x
 105  * Screen white        1 x x x  x x x x
 106  * Screen white        x x 1 x  x x x x
 107  * Screen white        x 0 x x  x x x x
 108  * Enable kbd dpad     x x x x  x x 0 x
 109  * Happy Times         0 1 0 x  x x 0 x
 110  */
 111
 112 /*
 113  * HTCPLD GPIO lines start 16 after OMAP_MAX_GPIO_LINES to account
 114  * for the 16 MPUIO lines.
 115  */
 116 #define HTCPLD_GPIO_START_OFFSET        (OMAP_MAX_GPIO_LINES + 16)
 117 #define HTCPLD_IRQ(chip, offset)        (OMAP_IRQ_END + 8 * (chip) + (offset))
 118 #define HTCPLD_BASE(chip, offset)       \
 119         (HTCPLD_GPIO_START_OFFSET + 8 * (chip) + (offset))
 120
 121 #define HTCPLD_GPIO_LED_DPAD            HTCPLD_BASE(0, 0)
 122 #define HTCPLD_GPIO_LED_KBD             HTCPLD_BASE(1, 0)
 123 #define HTCPLD_GPIO_LED_CAPS            HTCPLD_BASE(1, 5)
 124 #define HTCPLD_GPIO_LED_RED_FLASH       HTCPLD_BASE(2, 1)
 125 #define HTCPLD_GPIO_LED_RED_SOLID       HTCPLD_BASE(2, 2)
 126 #define HTCPLD_GPIO_LED_GREEN_FLASH     HTCPLD_BASE(2, 3)
 127 #define HTCPLD_GPIO_LED_GREEN_SOLID     HTCPLD_BASE(2, 4)
 128 #define HTCPLD_GPIO_LED_WIFI            HTCPLD_BASE(2, 5)
 129 #define HTCPLD_GPIO_LED_BT              HTCPLD_BASE(2, 6)
 130 #define HTCPLD_GPIO_LED_VIBRATE         HTCPLD_BASE(3, 3)
 131 #define HTCPLD_GPIO_LED_ALT             HTCPLD_BASE(3, 4)
 132
 133 #define HTCPLD_GPIO_RIGHT_KBD           HTCPLD_BASE(6, 7)
 134 #define HTCPLD_GPIO_UP_KBD              HTCPLD_BASE(6, 6)
 135 #define HTCPLD_GPIO_LEFT_KBD            HTCPLD_BASE(6, 5)
 136 #define HTCPLD_GPIO_DOWN_KBD            HTCPLD_BASE(6, 4)
 137
 138 #define HTCPLD_GPIO_RIGHT_DPAD          HTCPLD_BASE(7, 7)
 139 #define HTCPLD_GPIO_UP_DPAD             HTCPLD_BASE(7, 6)
 140 #define HTCPLD_GPIO_LEFT_DPAD           HTCPLD_BASE(7, 5)
 141 #define HTCPLD_GPIO_DOWN_DPAD           HTCPLD_BASE(7, 4)
 142 #define HTCPLD_GPIO_ENTER_DPAD          HTCPLD_BASE(7, 3)
 143
 144 /* Chip 5 */
 145 #define HTCPLD_IRQ_RIGHT_KBD            HTCPLD_IRQ(0, 7)
 146 #define HTCPLD_IRQ_UP_KBD               HTCPLD_IRQ(0, 6)
 147 #define HTCPLD_IRQ_LEFT_KBD             HTCPLD_IRQ(0, 5)
 148 #define HTCPLD_IRQ_DOWN_KBD             HTCPLD_IRQ(0, 4)
 149
 150 /* Chip 6 */
 151 #define HTCPLD_IRQ_RIGHT_DPAD           HTCPLD_IRQ(1, 7)
 152 #define HTCPLD_IRQ_UP_DPAD              HTCPLD_IRQ(1, 6)
 153 #define HTCPLD_IRQ_LEFT_DPAD            HTCPLD_IRQ(1, 5)
 154 #define HTCPLD_IRQ_DOWN_DPAD            HTCPLD_IRQ(1, 4)
 155 #define HTCPLD_IRQ_ENTER_DPAD           HTCPLD_IRQ(1, 3)
 156
 157 /* Keyboard definition */
 158
 159 static const unsigned int htc_herald_keymap[] = {
 160         KEY(0, 0, KEY_RECORD), /* Mail button */
 161         KEY(1, 0, KEY_CAMERA), /* Camera */
 162         KEY(2, 0, KEY_PHONE), /* Send key */
 163         KEY(3, 0, KEY_VOLUMEUP), /* Volume up */
 164         KEY(4, 0, KEY_F2),  /* Right bar (landscape) */
 165         KEY(5, 0, KEY_MAIL), /* Win key (portrait) */
 166         KEY(6, 0, KEY_DIRECTORY), /* Right bar (portrait) */
 167         KEY(0, 1, KEY_LEFTCTRL), /* Windows key */
 168         KEY(1, 1, KEY_COMMA),
 169         KEY(2, 1, KEY_M),
 170         KEY(3, 1, KEY_K),
 171         KEY(4, 1, KEY_SLASH), /* OK key */
 172         KEY(5, 1, KEY_I),
 173         KEY(6, 1, KEY_U),
 174         KEY(0, 2, KEY_LEFTALT),
 175         KEY(1, 2, KEY_TAB),
 176         KEY(2, 2, KEY_N),
 177         KEY(3, 2, KEY_J),
 178         KEY(4, 2, KEY_ENTER),
 179         KEY(5, 2, KEY_H),
 180         KEY(6, 2, KEY_Y),
 181         KEY(0, 3, KEY_SPACE),
 182         KEY(1, 3, KEY_L),
 183         KEY(2, 3, KEY_B),
 184         KEY(3, 3, KEY_V),
 185         KEY(4, 3, KEY_BACKSPACE),
 186         KEY(5, 3, KEY_G),
 187         KEY(6, 3, KEY_T),
 188         KEY(0, 4, KEY_CAPSLOCK), /* Shift */
 189         KEY(1, 4, KEY_C),
 190         KEY(2, 4, KEY_F),
 191         KEY(3, 4, KEY_R),
 192         KEY(4, 4, KEY_O),
 193         KEY(5, 4, KEY_E),
 194         KEY(6, 4, KEY_D),
 195         KEY(0, 5, KEY_X),
 196         KEY(1, 5, KEY_Z),
 197         KEY(2, 5, KEY_S),
 198         KEY(3, 5, KEY_W),
 199         KEY(4, 5, KEY_P),
 200         KEY(5, 5, KEY_Q),
 201         KEY(6, 5, KEY_A),
 202         KEY(0, 6, KEY_CONNECT), /* Voice button */
 203         KEY(2, 6, KEY_CANCEL), /* End key */
 204         KEY(3, 6, KEY_VOLUMEDOWN), /* Volume down */
 205         KEY(4, 6, KEY_F1), /* Left bar (landscape) */
 206         KEY(5, 6, KEY_WWW), /* OK button (portrait) */
 207         KEY(6, 6, KEY_CALENDAR), /* Left bar (portrait) */
 208 };
 209
 210 static const struct matrix_keymap_data htc_herald_keymap_data = {
 211         .keymap         = htc_herald_keymap,
 212         .keymap_size    = ARRAY_SIZE(htc_herald_keymap),
 213 };
 214
 215 static struct omap_kp_platform_data htcherald_kp_data = {
 216         .rows   = 7,
 217         .cols   = 7,
 218         .delay = 20,
 219         .rep = true,
 220         .keymap_data = &htc_herald_keymap_data,
 221 };
 222
 223 static struct resource kp_resources[] = {
 224         [0] = {
 225                 .start  = INT_7XX_MPUIO_KEYPAD,
 226                 .end    = INT_7XX_MPUIO_KEYPAD,
 227                 .flags  = IORESOURCE_IRQ,
 228         },
 229 };
 230
 231 static struct platform_device kp_device = {
 232         .name           = "omap-keypad",
 233         .id             = -1,
 234         .dev            = {
 235                 .platform_data = &htcherald_kp_data,
 236         },
 237         .num_resources  = ARRAY_SIZE(kp_resources),
 238         .resource       = kp_resources,
 239 };
 240
 241 /* GPIO buttons for keyboard slide and power button */
 242 static struct gpio_keys_button herald_gpio_keys_table[] = {
 243         {BTN_0,  HTCHERALD_GPIO_POWER, 1, "POWER", EV_KEY, 1, 20},
 244         {SW_LID, HTCHERALD_GPIO_SLIDE, 0, "SLIDE", EV_SW,  1, 20},
 245
 246         {KEY_LEFT,  HTCPLD_GPIO_LEFT_KBD,  1, "LEFT",  EV_KEY, 1, 20},
 247         {KEY_RIGHT, HTCPLD_GPIO_RIGHT_KBD, 1, "RIGHT", EV_KEY, 1, 20},
 248         {KEY_UP,    HTCPLD_GPIO_UP_KBD,    1, "UP",    EV_KEY, 1, 20},
 249         {KEY_DOWN,  HTCPLD_GPIO_DOWN_KBD,  1, "DOWN",  EV_KEY, 1, 20},
 250
 251         {KEY_LEFT,  HTCPLD_GPIO_LEFT_DPAD,   1, "DLEFT",  EV_KEY, 1, 20},
 252         {KEY_RIGHT, HTCPLD_GPIO_RIGHT_DPAD,  1, "DRIGHT", EV_KEY, 1, 20},
 253         {KEY_UP,    HTCPLD_GPIO_UP_DPAD,     1, "DUP",    EV_KEY, 1, 20},
 254         {KEY_DOWN,  HTCPLD_GPIO_DOWN_DPAD,   1, "DDOWN",  EV_KEY, 1, 20},
 255         {KEY_ENTER, HTCPLD_GPIO_ENTER_DPAD,  1, "DENTER", EV_KEY, 1, 20},
 256 };
 257
 258 static struct gpio_keys_platform_data herald_gpio_keys_data = {
 259         .buttons        = herald_gpio_keys_table,
 260         .nbuttons       = ARRAY_SIZE(herald_gpio_keys_table),
 261         .rep            = true,
 262 };
 263
 264 static struct platform_device herald_gpiokeys_device = {
 265         .name      = "gpio-keys",
 266         .id             = -1,
 267         .dev = {
 268                 .platform_data = &herald_gpio_keys_data,
 269         },
 270 };
 271
 272 /* LEDs for the Herald.  These connect to the HTCPLD GPIO device. */
 273 static const struct gpio_led gpio_leds[] = {
 274         {"dpad",        NULL, HTCPLD_GPIO_LED_DPAD,        0, 0, LEDS_GPIO_DEFSTATE_OFF},
 275         {"kbd",         NULL, HTCPLD_GPIO_LED_KBD,         0, 0, LEDS_GPIO_DEFSTATE_OFF},
 276         {"vibrate",     NULL, HTCPLD_GPIO_LED_VIBRATE,     0, 0, LEDS_GPIO_DEFSTATE_OFF},
 277         {"green_solid", NULL, HTCPLD_GPIO_LED_GREEN_SOLID, 0, 0, LEDS_GPIO_DEFSTATE_OFF},
 278         {"green_flash", NULL, HTCPLD_GPIO_LED_GREEN_FLASH, 0, 0, LEDS_GPIO_DEFSTATE_OFF},
 279         {"red_solid",   "mmc0", HTCPLD_GPIO_LED_RED_SOLID, 0, 0, LEDS_GPIO_DEFSTATE_OFF},
 280         {"red_flash",   NULL, HTCPLD_GPIO_LED_RED_FLASH,   0, 0, LEDS_GPIO_DEFSTATE_OFF},
 281         {"wifi",        NULL, HTCPLD_GPIO_LED_WIFI,        0, 0, LEDS_GPIO_DEFSTATE_OFF},
 282         {"bt",          NULL, HTCPLD_GPIO_LED_BT,          0, 0, LEDS_GPIO_DEFSTATE_OFF},
 283         {"caps",        NULL, HTCPLD_GPIO_LED_CAPS,        0, 0, LEDS_GPIO_DEFSTATE_OFF},
 284         {"alt",         NULL, HTCPLD_GPIO_LED_ALT,         0, 0, LEDS_GPIO_DEFSTATE_OFF},
 285 };
 286
 287 static struct gpio_led_platform_data gpio_leds_data = {
 288         .leds           = gpio_leds,
 289         .num_leds       = ARRAY_SIZE(gpio_leds),
 290 };
 291
 292 static struct platform_device gpio_leds_device = {
 293         .name           = "leds-gpio",
 294         .id             = 0,
 295         .dev    = {
 296                 .platform_data  = &gpio_leds_data,
 297         },
 298 };
 299
 300 /* HTC PLD chips */
 301
 302 static struct resource htcpld_resources[] = {
 303         [0] = {
 304                 .flags  = IORESOURCE_IRQ,
 305         },
 306 };
 307
 308 static struct htcpld_chip_platform_data htcpld_chips[] = {
 309         [0] = {
 310                 .addr           = 0x03,
 311                 .reset          = 0x04,
 312                 .num_gpios      = 8,
 313                 .gpio_out_base  = HTCPLD_BASE(0, 0),
 314                 .gpio_in_base   = HTCPLD_BASE(4, 0),
 315         },
 316         [1] = {
 317                 .addr           = 0x04,
 318                 .reset          = 0x8e,
 319                 .num_gpios      = 8,
 320                 .gpio_out_base  = HTCPLD_BASE(1, 0),
 321                 .gpio_in_base   = HTCPLD_BASE(5, 0),
 322         },
 323         [2] = {
 324                 .addr           = 0x05,
 325                 .reset          = 0x80,
 326                 .num_gpios      = 8,
 327                 .gpio_out_base  = HTCPLD_BASE(2, 0),
 328                 .gpio_in_base   = HTCPLD_BASE(6, 0),
 329                 .irq_base       = HTCPLD_IRQ(0, 0),
 330                 .num_irqs       = 8,
 331         },
 332         [3] = {
 333                 .addr           = 0x06,
 334                 .reset          = 0x40,
 335                 .num_gpios      = 8,
 336                 .gpio_out_base  = HTCPLD_BASE(3, 0),
 337                 .gpio_in_base   = HTCPLD_BASE(7, 0),
 338                 .irq_base       = HTCPLD_IRQ(1, 0),
 339                 .num_irqs       = 8,
 340         },
 341 };
 342
 343 static struct htcpld_core_platform_data htcpld_pfdata = {
 344         .i2c_adapter_id    = 1,
 345
 346         .chip              = htcpld_chips,
 347         .num_chip          = ARRAY_SIZE(htcpld_chips),
 348 };
 349
 350 static struct platform_device htcpld_device = {
 351         .name           = "i2c-htcpld",
 352         .id             = -1,
 353         .resource       = htcpld_resources,
 354         .num_resources  = ARRAY_SIZE(htcpld_resources),
 355         .dev    = {
 356                 .platform_data  = &htcpld_pfdata,
 357         },
 358 };
 359
 360 /* USB Device */
 361 static struct omap_usb_config htcherald_usb_config __initdata = {
 362         .otg = 0,
 363         .register_host = 0,
 364         .register_dev  = 1,
 365         .hmc_mode = 4,
 366         .pins[0] = 2,
 367 };
 368
 369 /* LCD Device resources */
 370 static const struct omap_lcd_config htcherald_lcd_config __initconst = {
 371         .ctrl_name      = "internal",
 372 };
 373
 374 static struct platform_device lcd_device = {
 375         .name           = "lcd_htcherald",
 376         .id             = -1,
 377 };
 378
 379 /* MMC Card */
 380 #if IS_ENABLED(CONFIG_MMC_OMAP)
 381 static struct omap_mmc_platform_data htc_mmc1_data = {
 382         .nr_slots                       = 1,
 383         .switch_slot                    = NULL,
 384         .slots[0]       = {
 385                 .ocr_mask               = MMC_VDD_32_33 | MMC_VDD_33_34,
 386                 .name                   = "mmcblk",
 387                 .nomux                  = 1,
 388                 .wires                  = 4,
 389                 .switch_pin             = -1,
 390         },
 391 };
 392
 393 static struct omap_mmc_platform_data *htc_mmc_data[1];
 394 #endif
 395
 396
 397 /* Platform devices for the Herald */
 398 static struct platform_device *devices[] __initdata = {
 399         &kp_device,
 400         &lcd_device,
 401         &htcpld_device,
 402         &gpio_leds_device,
 403         &herald_gpiokeys_device,
 404 };
 405
 406 /*
 407  * Touchscreen
 408  */
 409 static const struct ads7846_platform_data htcherald_ts_platform_data = {
 410         .model                  = 7846,
 411         .keep_vref_on           = 1,
 412         .x_plate_ohms           = 496,
 413         .gpio_pendown           = HTCHERALD_GPIO_TS,
 414         .pressure_max           = 10000,
 415         .pressure_min           = 5000,
 416         .x_min                  = 528,
 417         .x_max                  = 3760,
 418         .y_min                  = 624,
 419         .y_max                  = 3760,
 420 };
 421
 422 static struct spi_board_info __initdata htcherald_spi_board_info[] = {
 423         {
 424                 .modalias               = "ads7846",
 425                 .platform_data          = &htcherald_ts_platform_data,
 426                 .max_speed_hz           = 2500000,
 427                 .bus_num                = 2,
 428                 .chip_select            = 1,
 429         }
 430 };
 431
 432 /*
 433  * Init functions from here on
 434  */
 435
 436 static void __init htcherald_lcd_init(void)
 437 {
 438         u32 reg;
 439         unsigned int tries = 200;
 440
 441         /* disable controller if active */
 442         reg = omap_readl(OMAP_LCDC_CONTROL);
 443         if (reg & OMAP_LCDC_CTRL_LCD_EN) {
 444                 reg &= ~OMAP_LCDC_CTRL_LCD_EN;
 445                 omap_writel(reg, OMAP_LCDC_CONTROL);
 446
 447                 /* wait for end of frame */
 448                 while (!(omap_readl(OMAP_LCDC_STATUS) & OMAP_LCDC_STAT_DONE)) {
 449                         tries--;
 450                         if (!tries)
 451                                 break;
 452                 }
 453                 if (!tries)
 454                         pr_err("Timeout waiting for end of frame -- LCD may not be available\n");
 455
 456                 /* turn off DMA */
 457                 reg = omap_readw(OMAP_DMA_LCD_CCR);
 458                 reg &= ~(1 << 7);
 459                 omap_writew(reg, OMAP_DMA_LCD_CCR);
 460
 461                 reg = omap_readw(OMAP_DMA_LCD_CTRL);
 462                 reg &= ~(1 << 8);
 463                 omap_writew(reg, OMAP_DMA_LCD_CTRL);
 464         }
 465 }
 466
 467 static void __init htcherald_map_io(void)
 468 {
 469         omap7xx_map_io();
 470
 471         /*
 472          * The LCD panel must be disabled and DMA turned off here, as doing
 473          * it later causes the LCD never to reinitialize.
 474          */
 475         htcherald_lcd_init();
 476
 477         printk(KERN_INFO "htcherald_map_io done.\n");
 478 }
 479
 480 static void __init htcherald_disable_watchdog(void)
 481 {
 482         /* Disable watchdog if running */
 483         if (omap_readl(OMAP_WDT_TIMER_MODE) & 0x8000) {
 484                 /*
 485                  * disable a potentially running watchdog timer before
 486                  * it kills us.
 487                  */
 488                 printk(KERN_WARNING "OMAP850 Watchdog seems to be activated, disabling it for now.\n");
 489                 omap_writel(0xF5, OMAP_WDT_TIMER_MODE);
 490                 omap_writel(0xA0, OMAP_WDT_TIMER_MODE);
 491         }
 492 }
 493
 494 #define HTCHERALD_GPIO_USB_EN1 33
 495 #define HTCHERALD_GPIO_USB_EN2 73
 496 #define HTCHERALD_GPIO_USB_DM  35
 497 #define HTCHERALD_GPIO_USB_DP  36
 498
 499 static void __init htcherald_usb_enable(void)
 500 {
 501         unsigned int tries = 20;
 502         unsigned int value = 0;
 503
 504         /* Request the GPIOs we need to control here */
 505         if (gpio_request(HTCHERALD_GPIO_USB_EN1, "herald_usb") < 0)
 506                 goto err1;
 507
 508         if (gpio_request(HTCHERALD_GPIO_USB_EN2, "herald_usb") < 0)
 509                 goto err2;
 510
 511         if (gpio_request(HTCHERALD_GPIO_USB_DM, "herald_usb") < 0)
 512                 goto err3;
 513
 514         if (gpio_request(HTCHERALD_GPIO_USB_DP, "herald_usb") < 0)
 515                 goto err4;
 516
 517         /* force USB_EN GPIO to 0 */
 518         do {
 519                 /* output low */
 520                 gpio_direction_output(HTCHERALD_GPIO_USB_EN1, 0);
 521         } while ((value = gpio_get_value(HTCHERALD_GPIO_USB_EN1)) == 1 &&
 522                         --tries);
 523
 524         if (value == 1)
 525                 printk(KERN_WARNING "Unable to reset USB, trying to continue\n");
 526
 527         gpio_direction_output(HTCHERALD_GPIO_USB_EN2, 0); /* output low */
 528         gpio_direction_input(HTCHERALD_GPIO_USB_DM); /* input */
 529         gpio_direction_input(HTCHERALD_GPIO_USB_DP); /* input */
 530
 531         goto done;
 532
 533 err4:
 534         gpio_free(HTCHERALD_GPIO_USB_DM);
 535 err3:
 536         gpio_free(HTCHERALD_GPIO_USB_EN2);
 537 err2:
 538         gpio_free(HTCHERALD_GPIO_USB_EN1);
 539 err1:
 540         printk(KERN_ERR "Unabled to request GPIO for USB\n");
 541 done:
 542         printk(KERN_INFO "USB setup complete.\n");
 543 }
 544
 545 static void __init htcherald_init(void)
 546 {
 547         printk(KERN_INFO "HTC Herald init.\n");
 548
 549         /* Do board initialization before we register all the devices */
 550         htcpld_resources[0].start = gpio_to_irq(HTCHERALD_GIRQ_BTNS);
 551         htcpld_resources[0].end = gpio_to_irq(HTCHERALD_GIRQ_BTNS);
 552         platform_add_devices(devices, ARRAY_SIZE(devices));
 553
 554         htcherald_disable_watchdog();
 555
 556         htcherald_usb_enable();
 557         omap1_usb_init(&htcherald_usb_config);
 558
 559         htcherald_spi_board_info[0].irq = gpio_to_irq(HTCHERALD_GPIO_TS);
 560         spi_register_board_info(htcherald_spi_board_info,
 561                 ARRAY_SIZE(htcherald_spi_board_info));
 562
 563         omap_register_i2c_bus(1, 100, NULL, 0);
 564
 565 #if IS_ENABLED(CONFIG_MMC_OMAP)
 566         htc_mmc_data[0] = &htc_mmc1_data;
 567         omap1_init_mmc(htc_mmc_data, 1);
 568 #endif
 569
 570         omapfb_set_lcd_config(&htcherald_lcd_config);
 571 }
 572
 573 MACHINE_START(HERALD, "HTC Herald")
 574         /* Maintainer: Cory Maccarrone <darkstar6262@gmail.com> */
 575         /* Maintainer: wing-linux.sourceforge.net */
 576         .atag_offset    = 0x100,
 577         .map_io         = htcherald_map_io,
 578         .init_early     = omap1_init_early,
 579         .init_irq       = omap1_init_irq,
 580         .handle_irq     = omap1_handle_irq,
 581         .init_machine   = htcherald_init,
 582         .init_late      = omap1_init_late,
 583         .init_time      = omap1_timer_init,
 584         .restart        = omap1_restart,
 585 MACHINE_END