Linux-libre 5.4.48-gnu
[librecmc/linux-libre.git] / 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
27 #include <asm/mach-types.h>
28 #include <asm/mach/arch.h>
29
30 #include <mach/omap7xx.h>
31 #include "mmc.h"
32
33 #include <mach/irqs.h>
34 #include <mach/usb.h>
35
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 /*
145  * The htcpld chip requires a gpio write to a specific line
146  * to re-enable interrupts after one has occurred.
147  */
148 #define HTCPLD_GPIO_INT_RESET_HI        HTCPLD_BASE(2, 7)
149 #define HTCPLD_GPIO_INT_RESET_LO        HTCPLD_BASE(2, 0)
150
151 /* Chip 5 */
152 #define HTCPLD_IRQ_RIGHT_KBD            HTCPLD_IRQ(0, 7)
153 #define HTCPLD_IRQ_UP_KBD               HTCPLD_IRQ(0, 6)
154 #define HTCPLD_IRQ_LEFT_KBD             HTCPLD_IRQ(0, 5)
155 #define HTCPLD_IRQ_DOWN_KBD             HTCPLD_IRQ(0, 4)
156
157 /* Chip 6 */
158 #define HTCPLD_IRQ_RIGHT_DPAD           HTCPLD_IRQ(1, 7)
159 #define HTCPLD_IRQ_UP_DPAD              HTCPLD_IRQ(1, 6)
160 #define HTCPLD_IRQ_LEFT_DPAD            HTCPLD_IRQ(1, 5)
161 #define HTCPLD_IRQ_DOWN_DPAD            HTCPLD_IRQ(1, 4)
162 #define HTCPLD_IRQ_ENTER_DPAD           HTCPLD_IRQ(1, 3)
163
164 /* Keyboard definition */
165
166 static const unsigned int htc_herald_keymap[] = {
167         KEY(0, 0, KEY_RECORD), /* Mail button */
168         KEY(1, 0, KEY_CAMERA), /* Camera */
169         KEY(2, 0, KEY_PHONE), /* Send key */
170         KEY(3, 0, KEY_VOLUMEUP), /* Volume up */
171         KEY(4, 0, KEY_F2),  /* Right bar (landscape) */
172         KEY(5, 0, KEY_MAIL), /* Win key (portrait) */
173         KEY(6, 0, KEY_DIRECTORY), /* Right bar (protrait) */
174         KEY(0, 1, KEY_LEFTCTRL), /* Windows key */
175         KEY(1, 1, KEY_COMMA),
176         KEY(2, 1, KEY_M),
177         KEY(3, 1, KEY_K),
178         KEY(4, 1, KEY_SLASH), /* OK key */
179         KEY(5, 1, KEY_I),
180         KEY(6, 1, KEY_U),
181         KEY(0, 2, KEY_LEFTALT),
182         KEY(1, 2, KEY_TAB),
183         KEY(2, 2, KEY_N),
184         KEY(3, 2, KEY_J),
185         KEY(4, 2, KEY_ENTER),
186         KEY(5, 2, KEY_H),
187         KEY(6, 2, KEY_Y),
188         KEY(0, 3, KEY_SPACE),
189         KEY(1, 3, KEY_L),
190         KEY(2, 3, KEY_B),
191         KEY(3, 3, KEY_V),
192         KEY(4, 3, KEY_BACKSPACE),
193         KEY(5, 3, KEY_G),
194         KEY(6, 3, KEY_T),
195         KEY(0, 4, KEY_CAPSLOCK), /* Shift */
196         KEY(1, 4, KEY_C),
197         KEY(2, 4, KEY_F),
198         KEY(3, 4, KEY_R),
199         KEY(4, 4, KEY_O),
200         KEY(5, 4, KEY_E),
201         KEY(6, 4, KEY_D),
202         KEY(0, 5, KEY_X),
203         KEY(1, 5, KEY_Z),
204         KEY(2, 5, KEY_S),
205         KEY(3, 5, KEY_W),
206         KEY(4, 5, KEY_P),
207         KEY(5, 5, KEY_Q),
208         KEY(6, 5, KEY_A),
209         KEY(0, 6, KEY_CONNECT), /* Voice button */
210         KEY(2, 6, KEY_CANCEL), /* End key */
211         KEY(3, 6, KEY_VOLUMEDOWN), /* Volume down */
212         KEY(4, 6, KEY_F1), /* Left bar (landscape) */
213         KEY(5, 6, KEY_WWW), /* OK button (portrait) */
214         KEY(6, 6, KEY_CALENDAR), /* Left bar (portrait) */
215 };
216
217 static const struct matrix_keymap_data htc_herald_keymap_data = {
218         .keymap         = htc_herald_keymap,
219         .keymap_size    = ARRAY_SIZE(htc_herald_keymap),
220 };
221
222 static struct omap_kp_platform_data htcherald_kp_data = {
223         .rows   = 7,
224         .cols   = 7,
225         .delay = 20,
226         .rep = true,
227         .keymap_data = &htc_herald_keymap_data,
228 };
229
230 static struct resource kp_resources[] = {
231         [0] = {
232                 .start  = INT_7XX_MPUIO_KEYPAD,
233                 .end    = INT_7XX_MPUIO_KEYPAD,
234                 .flags  = IORESOURCE_IRQ,
235         },
236 };
237
238 static struct platform_device kp_device = {
239         .name           = "omap-keypad",
240         .id             = -1,
241         .dev            = {
242                 .platform_data = &htcherald_kp_data,
243         },
244         .num_resources  = ARRAY_SIZE(kp_resources),
245         .resource       = kp_resources,
246 };
247
248 /* GPIO buttons for keyboard slide and power button */
249 static struct gpio_keys_button herald_gpio_keys_table[] = {
250         {BTN_0,  HTCHERALD_GPIO_POWER, 1, "POWER", EV_KEY, 1, 20},
251         {SW_LID, HTCHERALD_GPIO_SLIDE, 0, "SLIDE", EV_SW,  1, 20},
252
253         {KEY_LEFT,  HTCPLD_GPIO_LEFT_KBD,  1, "LEFT",  EV_KEY, 1, 20},
254         {KEY_RIGHT, HTCPLD_GPIO_RIGHT_KBD, 1, "RIGHT", EV_KEY, 1, 20},
255         {KEY_UP,    HTCPLD_GPIO_UP_KBD,    1, "UP",    EV_KEY, 1, 20},
256         {KEY_DOWN,  HTCPLD_GPIO_DOWN_KBD,  1, "DOWN",  EV_KEY, 1, 20},
257
258         {KEY_LEFT,  HTCPLD_GPIO_LEFT_DPAD,   1, "DLEFT",  EV_KEY, 1, 20},
259         {KEY_RIGHT, HTCPLD_GPIO_RIGHT_DPAD,  1, "DRIGHT", EV_KEY, 1, 20},
260         {KEY_UP,    HTCPLD_GPIO_UP_DPAD,     1, "DUP",    EV_KEY, 1, 20},
261         {KEY_DOWN,  HTCPLD_GPIO_DOWN_DPAD,   1, "DDOWN",  EV_KEY, 1, 20},
262         {KEY_ENTER, HTCPLD_GPIO_ENTER_DPAD,  1, "DENTER", EV_KEY, 1, 20},
263 };
264
265 static struct gpio_keys_platform_data herald_gpio_keys_data = {
266         .buttons        = herald_gpio_keys_table,
267         .nbuttons       = ARRAY_SIZE(herald_gpio_keys_table),
268         .rep            = true,
269 };
270
271 static struct platform_device herald_gpiokeys_device = {
272         .name      = "gpio-keys",
273         .id             = -1,
274         .dev = {
275                 .platform_data = &herald_gpio_keys_data,
276         },
277 };
278
279 /* LEDs for the Herald.  These connect to the HTCPLD GPIO device. */
280 static const struct gpio_led gpio_leds[] = {
281         {"dpad",        NULL, HTCPLD_GPIO_LED_DPAD,        0, 0, LEDS_GPIO_DEFSTATE_OFF},
282         {"kbd",         NULL, HTCPLD_GPIO_LED_KBD,         0, 0, LEDS_GPIO_DEFSTATE_OFF},
283         {"vibrate",     NULL, HTCPLD_GPIO_LED_VIBRATE,     0, 0, LEDS_GPIO_DEFSTATE_OFF},
284         {"green_solid", NULL, HTCPLD_GPIO_LED_GREEN_SOLID, 0, 0, LEDS_GPIO_DEFSTATE_OFF},
285         {"green_flash", NULL, HTCPLD_GPIO_LED_GREEN_FLASH, 0, 0, LEDS_GPIO_DEFSTATE_OFF},
286         {"red_solid",   "mmc0", HTCPLD_GPIO_LED_RED_SOLID, 0, 0, LEDS_GPIO_DEFSTATE_OFF},
287         {"red_flash",   NULL, HTCPLD_GPIO_LED_RED_FLASH,   0, 0, LEDS_GPIO_DEFSTATE_OFF},
288         {"wifi",        NULL, HTCPLD_GPIO_LED_WIFI,        0, 0, LEDS_GPIO_DEFSTATE_OFF},
289         {"bt",          NULL, HTCPLD_GPIO_LED_BT,          0, 0, LEDS_GPIO_DEFSTATE_OFF},
290         {"caps",        NULL, HTCPLD_GPIO_LED_CAPS,        0, 0, LEDS_GPIO_DEFSTATE_OFF},
291         {"alt",         NULL, HTCPLD_GPIO_LED_ALT,         0, 0, LEDS_GPIO_DEFSTATE_OFF},
292 };
293
294 static struct gpio_led_platform_data gpio_leds_data = {
295         .leds           = gpio_leds,
296         .num_leds       = ARRAY_SIZE(gpio_leds),
297 };
298
299 static struct platform_device gpio_leds_device = {
300         .name           = "leds-gpio",
301         .id             = 0,
302         .dev    = {
303                 .platform_data  = &gpio_leds_data,
304         },
305 };
306
307 /* HTC PLD chips */
308
309 static struct resource htcpld_resources[] = {
310         [0] = {
311                 .flags  = IORESOURCE_IRQ,
312         },
313 };
314
315 static struct htcpld_chip_platform_data htcpld_chips[] = {
316         [0] = {
317                 .addr           = 0x03,
318                 .reset          = 0x04,
319                 .num_gpios      = 8,
320                 .gpio_out_base  = HTCPLD_BASE(0, 0),
321                 .gpio_in_base   = HTCPLD_BASE(4, 0),
322         },
323         [1] = {
324                 .addr           = 0x04,
325                 .reset          = 0x8e,
326                 .num_gpios      = 8,
327                 .gpio_out_base  = HTCPLD_BASE(1, 0),
328                 .gpio_in_base   = HTCPLD_BASE(5, 0),
329         },
330         [2] = {
331                 .addr           = 0x05,
332                 .reset          = 0x80,
333                 .num_gpios      = 8,
334                 .gpio_out_base  = HTCPLD_BASE(2, 0),
335                 .gpio_in_base   = HTCPLD_BASE(6, 0),
336                 .irq_base       = HTCPLD_IRQ(0, 0),
337                 .num_irqs       = 8,
338         },
339         [3] = {
340                 .addr           = 0x06,
341                 .reset          = 0x40,
342                 .num_gpios      = 8,
343                 .gpio_out_base  = HTCPLD_BASE(3, 0),
344                 .gpio_in_base   = HTCPLD_BASE(7, 0),
345                 .irq_base       = HTCPLD_IRQ(1, 0),
346                 .num_irqs       = 8,
347         },
348 };
349
350 static struct htcpld_core_platform_data htcpld_pfdata = {
351         .int_reset_gpio_hi = HTCPLD_GPIO_INT_RESET_HI,
352         .int_reset_gpio_lo = HTCPLD_GPIO_INT_RESET_LO,
353         .i2c_adapter_id    = 1,
354
355         .chip              = htcpld_chips,
356         .num_chip          = ARRAY_SIZE(htcpld_chips),
357 };
358
359 static struct platform_device htcpld_device = {
360         .name           = "i2c-htcpld",
361         .id             = -1,
362         .resource       = htcpld_resources,
363         .num_resources  = ARRAY_SIZE(htcpld_resources),
364         .dev    = {
365                 .platform_data  = &htcpld_pfdata,
366         },
367 };
368
369 /* USB Device */
370 static struct omap_usb_config htcherald_usb_config __initdata = {
371         .otg = 0,
372         .register_host = 0,
373         .register_dev  = 1,
374         .hmc_mode = 4,
375         .pins[0] = 2,
376 };
377
378 /* LCD Device resources */
379 static const struct omap_lcd_config htcherald_lcd_config __initconst = {
380         .ctrl_name      = "internal",
381 };
382
383 static struct platform_device lcd_device = {
384         .name           = "lcd_htcherald",
385         .id             = -1,
386 };
387
388 /* MMC Card */
389 #if IS_ENABLED(CONFIG_MMC_OMAP)
390 static struct omap_mmc_platform_data htc_mmc1_data = {
391         .nr_slots                       = 1,
392         .switch_slot                    = NULL,
393         .slots[0]       = {
394                 .ocr_mask               = MMC_VDD_32_33 | MMC_VDD_33_34,
395                 .name                   = "mmcblk",
396                 .nomux                  = 1,
397                 .wires                  = 4,
398                 .switch_pin             = -1,
399         },
400 };
401
402 static struct omap_mmc_platform_data *htc_mmc_data[1];
403 #endif
404
405
406 /* Platform devices for the Herald */
407 static struct platform_device *devices[] __initdata = {
408         &kp_device,
409         &lcd_device,
410         &htcpld_device,
411         &gpio_leds_device,
412         &herald_gpiokeys_device,
413 };
414
415 /*
416  * Touchscreen
417  */
418 static const struct ads7846_platform_data htcherald_ts_platform_data = {
419         .model                  = 7846,
420         .keep_vref_on           = 1,
421         .x_plate_ohms           = 496,
422         .gpio_pendown           = HTCHERALD_GPIO_TS,
423         .pressure_max           = 10000,
424         .pressure_min           = 5000,
425         .x_min                  = 528,
426         .x_max                  = 3760,
427         .y_min                  = 624,
428         .y_max                  = 3760,
429 };
430
431 static struct spi_board_info __initdata htcherald_spi_board_info[] = {
432         {
433                 .modalias               = "ads7846",
434                 .platform_data          = &htcherald_ts_platform_data,
435                 .max_speed_hz           = 2500000,
436                 .bus_num                = 2,
437                 .chip_select            = 1,
438         }
439 };
440
441 /*
442  * Init functions from here on
443  */
444
445 static void __init htcherald_lcd_init(void)
446 {
447         u32 reg;
448         unsigned int tries = 200;
449
450         /* disable controller if active */
451         reg = omap_readl(OMAP_LCDC_CONTROL);
452         if (reg & OMAP_LCDC_CTRL_LCD_EN) {
453                 reg &= ~OMAP_LCDC_CTRL_LCD_EN;
454                 omap_writel(reg, OMAP_LCDC_CONTROL);
455
456                 /* wait for end of frame */
457                 while (!(omap_readl(OMAP_LCDC_STATUS) & OMAP_LCDC_STAT_DONE)) {
458                         tries--;
459                         if (!tries)
460                                 break;
461                 }
462                 if (!tries)
463                         pr_err("Timeout waiting for end of frame -- LCD may not be available\n");
464
465                 /* turn off DMA */
466                 reg = omap_readw(OMAP_DMA_LCD_CCR);
467                 reg &= ~(1 << 7);
468                 omap_writew(reg, OMAP_DMA_LCD_CCR);
469
470                 reg = omap_readw(OMAP_DMA_LCD_CTRL);
471                 reg &= ~(1 << 8);
472                 omap_writew(reg, OMAP_DMA_LCD_CTRL);
473         }
474 }
475
476 static void __init htcherald_map_io(void)
477 {
478         omap7xx_map_io();
479
480         /*
481          * The LCD panel must be disabled and DMA turned off here, as doing
482          * it later causes the LCD never to reinitialize.
483          */
484         htcherald_lcd_init();
485
486         printk(KERN_INFO "htcherald_map_io done.\n");
487 }
488
489 static void __init htcherald_disable_watchdog(void)
490 {
491         /* Disable watchdog if running */
492         if (omap_readl(OMAP_WDT_TIMER_MODE) & 0x8000) {
493                 /*
494                  * disable a potentially running watchdog timer before
495                  * it kills us.
496                  */
497                 printk(KERN_WARNING "OMAP850 Watchdog seems to be activated, disabling it for now.\n");
498                 omap_writel(0xF5, OMAP_WDT_TIMER_MODE);
499                 omap_writel(0xA0, OMAP_WDT_TIMER_MODE);
500         }
501 }
502
503 #define HTCHERALD_GPIO_USB_EN1 33
504 #define HTCHERALD_GPIO_USB_EN2 73
505 #define HTCHERALD_GPIO_USB_DM  35
506 #define HTCHERALD_GPIO_USB_DP  36
507
508 static void __init htcherald_usb_enable(void)
509 {
510         unsigned int tries = 20;
511         unsigned int value = 0;
512
513         /* Request the GPIOs we need to control here */
514         if (gpio_request(HTCHERALD_GPIO_USB_EN1, "herald_usb") < 0)
515                 goto err1;
516
517         if (gpio_request(HTCHERALD_GPIO_USB_EN2, "herald_usb") < 0)
518                 goto err2;
519
520         if (gpio_request(HTCHERALD_GPIO_USB_DM, "herald_usb") < 0)
521                 goto err3;
522
523         if (gpio_request(HTCHERALD_GPIO_USB_DP, "herald_usb") < 0)
524                 goto err4;
525
526         /* force USB_EN GPIO to 0 */
527         do {
528                 /* output low */
529                 gpio_direction_output(HTCHERALD_GPIO_USB_EN1, 0);
530         } while ((value = gpio_get_value(HTCHERALD_GPIO_USB_EN1)) == 1 &&
531                         --tries);
532
533         if (value == 1)
534                 printk(KERN_WARNING "Unable to reset USB, trying to continue\n");
535
536         gpio_direction_output(HTCHERALD_GPIO_USB_EN2, 0); /* output low */
537         gpio_direction_input(HTCHERALD_GPIO_USB_DM); /* input */
538         gpio_direction_input(HTCHERALD_GPIO_USB_DP); /* input */
539
540         goto done;
541
542 err4:
543         gpio_free(HTCHERALD_GPIO_USB_DM);
544 err3:
545         gpio_free(HTCHERALD_GPIO_USB_EN2);
546 err2:
547         gpio_free(HTCHERALD_GPIO_USB_EN1);
548 err1:
549         printk(KERN_ERR "Unabled to request GPIO for USB\n");
550 done:
551         printk(KERN_INFO "USB setup complete.\n");
552 }
553
554 static void __init htcherald_init(void)
555 {
556         printk(KERN_INFO "HTC Herald init.\n");
557
558         /* Do board initialization before we register all the devices */
559         htcpld_resources[0].start = gpio_to_irq(HTCHERALD_GIRQ_BTNS);
560         htcpld_resources[0].end = gpio_to_irq(HTCHERALD_GIRQ_BTNS);
561         platform_add_devices(devices, ARRAY_SIZE(devices));
562
563         htcherald_disable_watchdog();
564
565         htcherald_usb_enable();
566         omap1_usb_init(&htcherald_usb_config);
567
568         htcherald_spi_board_info[0].irq = gpio_to_irq(HTCHERALD_GPIO_TS);
569         spi_register_board_info(htcherald_spi_board_info,
570                 ARRAY_SIZE(htcherald_spi_board_info));
571
572         omap_register_i2c_bus(1, 100, NULL, 0);
573
574 #if IS_ENABLED(CONFIG_MMC_OMAP)
575         htc_mmc_data[0] = &htc_mmc1_data;
576         omap1_init_mmc(htc_mmc_data, 1);
577 #endif
578
579         omapfb_set_lcd_config(&htcherald_lcd_config);
580 }
581
582 MACHINE_START(HERALD, "HTC Herald")
583         /* Maintainer: Cory Maccarrone <darkstar6262@gmail.com> */
584         /* Maintainer: wing-linux.sourceforge.net */
585         .atag_offset    = 0x100,
586         .map_io         = htcherald_map_io,
587         .init_early     = omap1_init_early,
588         .init_irq       = omap1_init_irq,
589         .handle_irq     = omap1_handle_irq,
590         .init_machine   = htcherald_init,
591         .init_late      = omap1_init_late,
592         .init_time      = omap1_timer_init,
593         .restart        = omap1_restart,
594 MACHINE_END