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

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