board/karo/tx28/tx28.c

   1 /*
   2  * Copyright (C) 2011 Lothar Waßmann <LW@KARO-electronics.de>
   3  * based on: board/freesclae/mx28_evk.c (C) 2010 Freescale Semiconductor, Inc.
   4  *
   5  * See file CREDITS for list of people who contributed to this
   6  * project.
   7  *
   8  * This program is free software; you can redistribute it and/or
   9  * modify it under the terms of the GNU General Public License as
  10  * published by the Free Software Foundation; either version 2 of
  11  * the License, or (at your option) any later version.
  12  *
  13  * This program is distributed in the hope that it will be useful,
  14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16  * GNU General Public License for more details.
  17  *
  18  */
  19
  20 #include <common.h>
  21 #include <errno.h>
  22 #include <libfdt.h>
  23 #include <fdt_support.h>
  24 #include <lcd.h>
  25 #include <netdev.h>
  26 #include <mmc.h>
  27 #include <linux/list.h>
  28 #include <linux/fb.h>
  29 #include <asm/io.h>
  30 #include <asm/gpio.h>
  31 #include <asm/arch/iomux-mx28.h>
  32 #include <asm/arch/clock.h>
  33 #include <asm/arch/imx-regs.h>
  34 #include <asm/arch/sys_proto.h>
  35
  36 #include "../common/karo.h"
  37
  38 DECLARE_GLOBAL_DATA_PTR;
  39
  40 #define MXS_GPIO_NR(p, o)      (((p) << 5) | (o))
  41
  42 #define TX28_LCD_PWR_GPIO       MX28_PAD_LCD_ENABLE__GPIO_1_31
  43 #define TX28_LCD_RST_GPIO       MX28_PAD_LCD_RESET__GPIO_3_30
  44 #define TX28_LCD_BACKLIGHT_GPIO MX28_PAD_PWM0__GPIO_3_16
  45
  46 #define TX28_USBH_VBUSEN_GPIO   MX28_PAD_SPDIF__GPIO_3_27
  47 #define TX28_USBH_OC_GPIO       MX28_PAD_JTAG_RTCK__GPIO_4_20
  48 #define TX28_USBOTG_VBUSEN_GPIO MX28_PAD_GPMI_CE2N__GPIO_0_18
  49 #define TX28_USBOTG_OC_GPIO     MX28_PAD_GPMI_CE3N__GPIO_0_19
  50 #define TX28_USBOTG_ID_GPIO     MX28_PAD_PWM2__GPIO_3_18
  51
  52 #define TX28_LED_GPIO           MX28_PAD_ENET0_RXD3__GPIO_4_10
  53
  54 static const struct gpio tx28_gpios[] = {
  55         { TX28_USBH_VBUSEN_GPIO, GPIOF_OUTPUT_INIT_LOW, "USBH VBUSEN", },
  56         { TX28_USBH_OC_GPIO, GPIOF_INPUT, "USBH OC", },
  57         { TX28_USBOTG_VBUSEN_GPIO, GPIOF_OUTPUT_INIT_LOW, "USBOTG VBUSEN", },
  58         { TX28_USBOTG_OC_GPIO, GPIOF_INPUT, "USBOTG OC", },
  59         { TX28_USBOTG_ID_GPIO, GPIOF_INPUT, "USBOTG ID", },
  60 };
  61
  62 static const iomux_cfg_t tx28_pads[] = {
  63         /* UART pads */
  64 #if CONFIG_CONS_INDEX == 0
  65         MX28_PAD_AUART0_RX__DUART_CTS,
  66         MX28_PAD_AUART0_TX__DUART_RTS,
  67         MX28_PAD_AUART0_CTS__DUART_RX,
  68         MX28_PAD_AUART0_RTS__DUART_TX,
  69 #elif CONFIG_CONS_INDEX == 1
  70         MX28_PAD_AUART1_RX__AUART1_RX,
  71         MX28_PAD_AUART1_TX__AUART1_TX,
  72         MX28_PAD_AUART1_CTS__AUART1_CTS,
  73         MX28_PAD_AUART1_RTS__AUART1_RTS,
  74 #elif CONFIG_CONS_INDEX == 2
  75         MX28_PAD_AUART3_RX__AUART3_RX,
  76         MX28_PAD_AUART3_TX__AUART3_TX,
  77         MX28_PAD_AUART3_CTS__AUART3_CTS,
  78         MX28_PAD_AUART3_RTS__AUART3_RTS,
  79 #endif
  80         /* I2C bus for internal DS1339, PCA9554 and on DIMM pins 40/41 */
  81         MX28_PAD_I2C0_SCL__I2C0_SCL,
  82         MX28_PAD_I2C0_SDA__I2C0_SDA,
  83
  84         /* USBH VBUSEN, OC */
  85         MX28_PAD_SPDIF__GPIO_3_27,
  86         MX28_PAD_JTAG_RTCK__GPIO_4_20,
  87
  88         /* USBOTG VBUSEN, OC, ID */
  89         MX28_PAD_GPMI_CE2N__GPIO_0_18,
  90         MX28_PAD_GPMI_CE3N__GPIO_0_19,
  91         MX28_PAD_PWM2__GPIO_3_18,
  92 };
  93
  94 /*
  95  * Functions
  96  */
  97
  98 /* provide at least _some_ sort of randomness */
  99 #define MAX_LOOPS       100
 100
 101 static u32 random;
 102
 103 static inline void random_init(void)
 104 {
 105         struct mxs_digctl_regs *digctl_regs = (void *)MXS_DIGCTL_BASE;
 106         u32 seed = 0;
 107         int i;
 108
 109         for (i = 0; i < MAX_LOOPS; i++) {
 110                 unsigned int usec = readl(&digctl_regs->hw_digctl_microseconds);
 111
 112                 seed = get_timer(usec + random + seed);
 113                 srand(seed);
 114                 random = rand();
 115         }
 116 }
 117
 118 #define RTC_PERSISTENT0_CLK32_MASK      (RTC_PERSISTENT0_CLOCKSOURCE |  \
 119                                         RTC_PERSISTENT0_XTAL32KHZ_PWRUP)
 120 static u32 boot_cause __attribute__((section("data")));
 121
 122 int board_early_init_f(void)
 123 {
 124         struct mxs_rtc_regs *rtc_regs = (void *)MXS_RTC_BASE;
 125         u32 rtc_stat;
 126         int timeout = 5000;
 127
 128         random_init();
 129
 130         /* IO0 clock at 480MHz */
 131         mxs_set_ioclk(MXC_IOCLK0, 480000);
 132         /* IO1 clock at 480MHz */
 133         mxs_set_ioclk(MXC_IOCLK1, 480000);
 134
 135         /* SSP0 clock at 96MHz */
 136         mxs_set_sspclk(MXC_SSPCLK0, 96000, 0);
 137         /* SSP2 clock at 96MHz */
 138         mxs_set_sspclk(MXC_SSPCLK2, 96000, 0);
 139
 140         gpio_request_array(tx28_gpios, ARRAY_SIZE(tx28_gpios));
 141         mxs_iomux_setup_multiple_pads(tx28_pads, ARRAY_SIZE(tx28_pads));
 142
 143         while ((rtc_stat = readl(&rtc_regs->hw_rtc_stat)) &
 144                 RTC_STAT_STALE_REGS_PERSISTENT0) {
 145                 if (timeout-- < 0)
 146                         return 0;
 147                 udelay(1);
 148         }
 149         boot_cause = readl(&rtc_regs->hw_rtc_persistent0);
 150         if ((boot_cause & RTC_PERSISTENT0_CLK32_MASK) !=
 151                 RTC_PERSISTENT0_CLK32_MASK) {
 152                 if (boot_cause & RTC_PERSISTENT0_CLOCKSOURCE)
 153                         goto rtc_err;
 154                 writel(RTC_PERSISTENT0_CLK32_MASK,
 155                         &rtc_regs->hw_rtc_persistent0_set);
 156         }
 157         return 0;
 158
 159 rtc_err:
 160         serial_puts("Inconsistent value in RTC_PERSISTENT0 register; power-on-reset required\n");
 161         return 0;
 162 }
 163
 164 int board_init(void)
 165 {
 166         /* Address of boot parameters */
 167 #ifdef CONFIG_OF_LIBFDT
 168         gd->bd->bi_arch_number = -1;
 169 #endif
 170         gd->bd->bi_boot_params = PHYS_SDRAM_1 + 0x1000;
 171         return 0;
 172 }
 173
 174 int dram_init(void)
 175 {
 176         return mxs_dram_init();
 177 }
 178
 179 #ifdef  CONFIG_CMD_MMC
 180 static int tx28_mmc_wp(int dev_no)
 181 {
 182         return 0;
 183 }
 184
 185 int board_mmc_init(bd_t *bis)
 186 {
 187         return mxsmmc_initialize(bis, 0, tx28_mmc_wp, NULL);
 188 }
 189 #endif /* CONFIG_CMD_MMC */
 190
 191 #ifdef CONFIG_FEC_MXC
 192 #ifdef CONFIG_GET_FEC_MAC_ADDR_FROM_IIM
 193
 194 #ifdef CONFIG_FEC_MXC_MULTI
 195 #define FEC_MAX_IDX                     1
 196 #else
 197 #define FEC_MAX_IDX                     0
 198 #endif
 199 #ifndef ETH_ALEN
 200 #define ETH_ALEN                        6
 201 #endif
 202
 203 static int fec_get_mac_addr(int index)
 204 {
 205         int timeout = 1000;
 206         struct mxs_ocotp_regs *ocotp_regs =
 207                 (struct mxs_ocotp_regs *)MXS_OCOTP_BASE;
 208         u32 *cust = &ocotp_regs->hw_ocotp_cust0;
 209         u8 mac[ETH_ALEN];
 210         char env_name[] = "eth.addr";
 211         u32 val = 0;
 212         int i;
 213
 214         if (index < 0 || index > FEC_MAX_IDX)
 215                 return -EINVAL;
 216
 217         /* set this bit to open the OTP banks for reading */
 218         writel(OCOTP_CTRL_RD_BANK_OPEN,
 219                 &ocotp_regs->hw_ocotp_ctrl_set);
 220
 221         /* wait until OTP contents are readable */
 222         while (OCOTP_CTRL_BUSY & readl(&ocotp_regs->hw_ocotp_ctrl)) {
 223                 if (timeout-- < 0)
 224                         return -ETIMEDOUT;
 225                 udelay(100);
 226         }
 227
 228         for (i = 0; i < sizeof(mac); i++) {
 229                 int shift = 24 - i % 4 * 8;
 230
 231                 if (i % 4 == 0)
 232                         val = readl(&cust[index * 8 + i]);
 233                 mac[i] = val >> shift;
 234         }
 235         if (!is_valid_ether_addr(mac))
 236                 return 0;
 237
 238         if (index == 0) {
 239                 printf("MAC addr from fuse: %pM\n", mac);
 240                 snprintf(env_name, sizeof(env_name), "ethaddr");
 241         } else {
 242                 snprintf(env_name, sizeof(env_name), "eth%daddr", index);
 243         }
 244         eth_setenv_enetaddr(env_name, mac);
 245         return 0;
 246 }
 247 #endif /* CONFIG_GET_FEC_MAC_ADDR_FROM_IIM */
 248
 249 static const iomux_cfg_t tx28_fec_pads[] = {
 250         MX28_PAD_ENET0_RX_EN__ENET0_RX_EN,
 251         MX28_PAD_ENET0_RXD0__ENET0_RXD0,
 252         MX28_PAD_ENET0_RXD1__ENET0_RXD1,
 253 };
 254
 255 int board_eth_init(bd_t *bis)
 256 {
 257         int ret;
 258
 259         /* Reset the external phy */
 260         gpio_direction_output(MX28_PAD_ENET0_RX_CLK__GPIO_4_13, 0);
 261
 262         /* Power on the external phy */
 263         gpio_direction_output(MX28_PAD_PWM4__GPIO_3_29, 1);
 264
 265         /* Pull strap pins to high */
 266         gpio_direction_output(MX28_PAD_ENET0_RX_EN__GPIO_4_2, 1);
 267         gpio_direction_output(MX28_PAD_ENET0_RXD0__GPIO_4_3, 1);
 268         gpio_direction_output(MX28_PAD_ENET0_RXD1__GPIO_4_4, 1);
 269         gpio_direction_input(MX28_PAD_ENET0_TX_CLK__GPIO_4_5);
 270
 271         udelay(25000);
 272         gpio_set_value(MX28_PAD_ENET0_RX_CLK__GPIO_4_13, 1);
 273         udelay(100);
 274
 275         mxs_iomux_setup_multiple_pads(tx28_fec_pads, ARRAY_SIZE(tx28_fec_pads));
 276
 277         ret = cpu_eth_init(bis);
 278         if (ret) {
 279                 printf("cpu_eth_init() failed: %d\n", ret);
 280                 return ret;
 281         }
 282
 283         ret = fec_get_mac_addr(0);
 284         if (ret < 0) {
 285                 printf("Failed to read FEC0 MAC address from OCOTP\n");
 286                 return ret;
 287         }
 288 #ifdef CONFIG_FEC_MXC_MULTI
 289         if (getenv("ethaddr")) {
 290                 ret = fecmxc_initialize_multi(bis, 0, 0, MXS_ENET0_BASE);
 291                 if (ret) {
 292                         printf("FEC MXS: Unable to init FEC0\n");
 293                         return ret;
 294                 }
 295         }
 296
 297         ret = fec_get_mac_addr(1);
 298         if (ret < 0) {
 299                 printf("Failed to read FEC1 MAC address from OCOTP\n");
 300                 return ret;
 301         }
 302         if (getenv("eth1addr")) {
 303                 ret = fecmxc_initialize_multi(bis, 1, 1, MXS_ENET1_BASE);
 304                 if (ret) {
 305                         printf("FEC MXS: Unable to init FEC1\n");
 306                         return ret;
 307                 }
 308         }
 309         return 0;
 310 #else
 311         if (getenv("ethaddr")) {
 312                 ret = fecmxc_initialize(bis);
 313         }
 314         return ret;
 315 #endif
 316 }
 317 #endif /* CONFIG_FEC_MXC */
 318
 319 enum {
 320         LED_STATE_INIT = -1,
 321         LED_STATE_OFF,
 322         LED_STATE_ON,
 323 };
 324
 325 void show_activity(int arg)
 326 {
 327         static int led_state = LED_STATE_INIT;
 328         static ulong last;
 329
 330         if (led_state == LED_STATE_INIT) {
 331                 last = get_timer(0);
 332                 gpio_set_value(TX28_LED_GPIO, 1);
 333                 led_state = LED_STATE_ON;
 334         } else {
 335                 if (get_timer(last) > CONFIG_SYS_HZ) {
 336                         last = get_timer(0);
 337                         if (led_state == LED_STATE_ON) {
 338                                 gpio_set_value(TX28_LED_GPIO, 0);
 339                         } else {
 340                                 gpio_set_value(TX28_LED_GPIO, 1);
 341                         }
 342                         led_state = 1 - led_state;
 343                 }
 344         }
 345 }
 346
 347 static const iomux_cfg_t stk5_pads[] = {
 348         /* SW controlled LED on STK5 baseboard */
 349         MX28_PAD_ENET0_RXD3__GPIO_4_10,
 350 };
 351
 352 static const struct gpio stk5_gpios[] = {
 353 };
 354
 355 #ifdef CONFIG_LCD
 356 static ushort tx28_cmap[256];
 357 vidinfo_t panel_info = {
 358         /* set to max. size supported by SoC */
 359         .vl_col = 1600,
 360         .vl_row = 1200,
 361
 362         .vl_bpix = LCD_COLOR24,    /* Bits per pixel, 0: 1bpp, 1: 2bpp, 2: 4bpp, 3: 8bpp ... */
 363         .cmap = tx28_cmap,
 364 };
 365
 366 static struct fb_videomode tx28_fb_modes[] = {
 367         {
 368                 /* Standard VGA timing */
 369                 .name           = "VGA",
 370                 .refresh        = 60,
 371                 .xres           = 640,
 372                 .yres           = 480,
 373                 .pixclock       = KHZ2PICOS(25175),
 374                 .left_margin    = 48,
 375                 .hsync_len      = 96,
 376                 .right_margin   = 16,
 377                 .upper_margin   = 31,
 378                 .vsync_len      = 2,
 379                 .lower_margin   = 12,
 380                 .vmode          = FB_VMODE_NONINTERLACED,
 381         },
 382         {
 383                 /* Emerging ETV570 640 x 480 display. Syncs low active,
 384                  * DE high active, 115.2 mm x 86.4 mm display area
 385                  * VGA compatible timing
 386                  */
 387                 .name           = "ETV570",
 388                 .refresh        = 60,
 389                 .xres           = 640,
 390                 .yres           = 480,
 391                 .pixclock       = KHZ2PICOS(25175),
 392                 .left_margin    = 114,
 393                 .hsync_len      = 30,
 394                 .right_margin   = 16,
 395                 .upper_margin   = 32,
 396                 .vsync_len      = 3,
 397                 .lower_margin   = 10,
 398                 .vmode          = FB_VMODE_NONINTERLACED,
 399         },
 400         {
 401                 /* Emerging ET0350G0DH6 320 x 240 display.
 402                  * 70.08 mm x 52.56 mm display area.
 403                  */
 404                 .name           = "ET0350",
 405                 .refresh        = 60,
 406                 .xres           = 320,
 407                 .yres           = 240,
 408                 .pixclock       = KHZ2PICOS(6500),
 409                 .left_margin    = 68 - 34,
 410                 .hsync_len      = 34,
 411                 .right_margin   = 20,
 412                 .upper_margin   = 18 - 3,
 413                 .vsync_len      = 3,
 414                 .lower_margin   = 4,
 415                 .vmode          = FB_VMODE_NONINTERLACED,
 416         },
 417         {
 418                 /* Emerging ET0430G0DH6 480 x 272 display.
 419                  * 95.04 mm x 53.856 mm display area.
 420                  */
 421                 .name           = "ET0430",
 422                 .refresh        = 60,
 423                 .xres           = 480,
 424                 .yres           = 272,
 425                 .pixclock       = KHZ2PICOS(9000),
 426                 .left_margin    = 2,
 427                 .hsync_len      = 41,
 428                 .right_margin   = 2,
 429                 .upper_margin   = 2,
 430                 .vsync_len      = 10,
 431                 .lower_margin   = 2,
 432                 .vmode          = FB_VMODE_NONINTERLACED,
 433         },
 434         {
 435                 /* Emerging ET0500G0DH6 800 x 480 display.
 436                  * 109.6 mm x 66.4 mm display area.
 437                  */
 438                 .name           = "ET0500",
 439                 .refresh        = 60,
 440                 .xres           = 800,
 441                 .yres           = 480,
 442                 .pixclock       = KHZ2PICOS(33260),
 443                 .left_margin    = 216 - 128,
 444                 .hsync_len      = 128,
 445                 .right_margin   = 1056 - 800 - 216,
 446                 .upper_margin   = 35 - 2,
 447                 .vsync_len      = 2,
 448                 .lower_margin   = 525 - 480 - 35,
 449                 .vmode          = FB_VMODE_NONINTERLACED,
 450         },
 451         {
 452                 /* Emerging ETQ570G0DH6 320 x 240 display.
 453                  * 115.2 mm x 86.4 mm display area.
 454                  */
 455                 .name           = "ETQ570",
 456                 .refresh        = 60,
 457                 .xres           = 320,
 458                 .yres           = 240,
 459                 .pixclock       = KHZ2PICOS(6400),
 460                 .left_margin    = 38,
 461                 .hsync_len      = 30,
 462                 .right_margin   = 30,
 463                 .upper_margin   = 16, /* 15 according to datasheet */
 464                 .vsync_len      = 3, /* TVP -> 1>x>5 */
 465                 .lower_margin   = 4, /* 4.5 according to datasheet */
 466                 .vmode          = FB_VMODE_NONINTERLACED,
 467         },
 468         {
 469                 /* Emerging ET0700G0DH6 800 x 480 display.
 470                  * 152.4 mm x 91.44 mm display area.
 471                  */
 472                 .name           = "ET0700",
 473                 .refresh        = 60,
 474                 .xres           = 800,
 475                 .yres           = 480,
 476                 .pixclock       = KHZ2PICOS(33260),
 477                 .left_margin    = 216 - 128,
 478                 .hsync_len      = 128,
 479                 .right_margin   = 1056 - 800 - 216,
 480                 .upper_margin   = 35 - 2,
 481                 .vsync_len      = 2,
 482                 .lower_margin   = 525 - 480 - 35,
 483                 .vmode          = FB_VMODE_NONINTERLACED,
 484         },
 485         {
 486                 /* unnamed entry for assigning parameters parsed from 'video_mode' string */
 487                 .vmode          = FB_VMODE_NONINTERLACED,
 488         },
 489 };
 490
 491 static int lcd_enabled = 1;
 492
 493 void lcd_enable(void)
 494 {
 495         /* HACK ALERT:
 496          * global variable from common/lcd.c
 497          * Set to 0 here to prevent messages from going to LCD
 498          * rather than serial console
 499          */
 500         lcd_is_enabled = 0;
 501
 502         karo_load_splashimage(1);
 503         if (lcd_enabled) {
 504                 debug("Switching LCD on\n");
 505                 gpio_set_value(TX28_LCD_PWR_GPIO, 1);
 506                 udelay(100);
 507                 gpio_set_value(TX28_LCD_RST_GPIO, 1);
 508                 udelay(300000);
 509                 gpio_set_value(TX28_LCD_BACKLIGHT_GPIO, 0);
 510         }
 511 }
 512
 513 void lcd_disable(void)
 514 {
 515 }
 516
 517 void lcd_panel_disable(void)
 518 {
 519         if (lcd_enabled) {
 520                 debug("Switching LCD off\n");
 521                 gpio_set_value(TX28_LCD_BACKLIGHT_GPIO, 1);
 522                 gpio_set_value(TX28_LCD_RST_GPIO, 0);
 523                 gpio_set_value(TX28_LCD_PWR_GPIO, 0);
 524         }
 525 }
 526
 527 static const iomux_cfg_t stk5_lcd_pads[] = {
 528         /* LCD RESET */
 529         MX28_PAD_LCD_RESET__GPIO_3_30 | MXS_PAD_CTRL,
 530         /* LCD POWER_ENABLE */
 531         MX28_PAD_LCD_ENABLE__GPIO_1_31 | MXS_PAD_CTRL,
 532         /* LCD Backlight (PWM) */
 533         MX28_PAD_PWM0__GPIO_3_16 | MXS_PAD_CTRL,
 534
 535         /* Display */
 536         MX28_PAD_LCD_D00__LCD_D0 | MXS_PAD_CTRL,
 537         MX28_PAD_LCD_D01__LCD_D1 | MXS_PAD_CTRL,
 538         MX28_PAD_LCD_D02__LCD_D2 | MXS_PAD_CTRL,
 539         MX28_PAD_LCD_D03__LCD_D3 | MXS_PAD_CTRL,
 540         MX28_PAD_LCD_D04__LCD_D4 | MXS_PAD_CTRL,
 541         MX28_PAD_LCD_D05__LCD_D5 | MXS_PAD_CTRL,
 542         MX28_PAD_LCD_D06__LCD_D6 | MXS_PAD_CTRL,
 543         MX28_PAD_LCD_D07__LCD_D7 | MXS_PAD_CTRL,
 544         MX28_PAD_LCD_D08__LCD_D8 | MXS_PAD_CTRL,
 545         MX28_PAD_LCD_D09__LCD_D9 | MXS_PAD_CTRL,
 546         MX28_PAD_LCD_D10__LCD_D10 | MXS_PAD_CTRL,
 547         MX28_PAD_LCD_D11__LCD_D11 | MXS_PAD_CTRL,
 548         MX28_PAD_LCD_D12__LCD_D12 | MXS_PAD_CTRL,
 549         MX28_PAD_LCD_D13__LCD_D13 | MXS_PAD_CTRL,
 550         MX28_PAD_LCD_D14__LCD_D14 | MXS_PAD_CTRL,
 551         MX28_PAD_LCD_D15__LCD_D15 | MXS_PAD_CTRL,
 552         MX28_PAD_LCD_D16__LCD_D16 | MXS_PAD_CTRL,
 553         MX28_PAD_LCD_D17__LCD_D17 | MXS_PAD_CTRL,
 554         MX28_PAD_LCD_D18__LCD_D18 | MXS_PAD_CTRL,
 555         MX28_PAD_LCD_D19__LCD_D19 | MXS_PAD_CTRL,
 556         MX28_PAD_LCD_D20__LCD_D20 | MXS_PAD_CTRL,
 557         MX28_PAD_LCD_D21__LCD_D21 | MXS_PAD_CTRL,
 558         MX28_PAD_LCD_D22__LCD_D22 | MXS_PAD_CTRL,
 559         MX28_PAD_LCD_D23__LCD_D23 | MXS_PAD_CTRL,
 560         MX28_PAD_LCD_RD_E__LCD_VSYNC | MXS_PAD_CTRL,
 561         MX28_PAD_LCD_WR_RWN__LCD_HSYNC | MXS_PAD_CTRL,
 562         MX28_PAD_LCD_RS__LCD_DOTCLK | MXS_PAD_CTRL,
 563         MX28_PAD_LCD_CS__LCD_CS | MXS_PAD_CTRL,
 564         MX28_PAD_LCD_VSYNC__LCD_VSYNC | MXS_PAD_CTRL,
 565         MX28_PAD_LCD_HSYNC__LCD_HSYNC | MXS_PAD_CTRL,
 566         MX28_PAD_LCD_DOTCLK__LCD_DOTCLK | MXS_PAD_CTRL,
 567 };
 568
 569 static const struct gpio stk5_lcd_gpios[] = {
 570         { TX28_LCD_RST_GPIO, GPIOF_OUTPUT_INIT_LOW, "LCD RESET", },
 571         { TX28_LCD_PWR_GPIO, GPIOF_OUTPUT_INIT_LOW, "LCD POWER", },
 572         { TX28_LCD_BACKLIGHT_GPIO, GPIOF_OUTPUT_INIT_HIGH, "LCD BACKLIGHT", },
 573 };
 574
 575 extern void video_hw_init(void *lcdbase);
 576
 577 void lcd_ctrl_init(void *lcdbase)
 578 {
 579         int color_depth = 24;
 580         char *vm;
 581         unsigned long val;
 582         int refresh = 60;
 583         struct fb_videomode *p = tx28_fb_modes;
 584         struct fb_videomode fb_mode;
 585         int xres_set = 0, yres_set = 0, bpp_set = 0, refresh_set = 0;
 586
 587         if (!lcd_enabled) {
 588                 debug("LCD disabled\n");
 589                 return;
 590         }
 591
 592         if (tstc()) {
 593                 debug("Disabling LCD\n");
 594                 lcd_enabled = 0;
 595                 return;
 596         }
 597
 598         karo_fdt_move_fdt();
 599
 600         vm = getenv("video_mode");
 601         if (vm == NULL) {
 602                 debug("Disabling LCD\n");
 603                 lcd_enabled = 0;
 604                 return;
 605         }
 606         if (karo_fdt_get_fb_mode(working_fdt, vm, &fb_mode) == 0) {
 607                 p = &fb_mode;
 608                 debug("Using video mode from FDT\n");
 609                 vm += strlen(vm);
 610         }
 611         if (p->name != NULL)
 612                 debug("Trying compiled-in video modes\n");
 613         while (p->name != NULL) {
 614                 if (strcmp(p->name, vm) == 0) {
 615                         debug("Using video mode: '%s'\n", p->name);
 616                         vm += strlen(vm);
 617                         break;
 618                 }
 619                 p++;
 620         }
 621         if (*vm != '\0')
 622                 debug("Trying to decode video_mode: '%s'\n", vm);
 623         while (*vm != '\0') {
 624                 if (*vm >= '0' && *vm <= '9') {
 625                         char *end;
 626
 627                         val = simple_strtoul(vm, &end, 0);
 628                         if (end > vm) {
 629                                 if (!xres_set) {
 630                                         if (val > panel_info.vl_col)
 631                                                 val = panel_info.vl_col;
 632                                         p->xres = val;
 633                                         xres_set = 1;
 634                                 } else if (!yres_set) {
 635                                         if (val > panel_info.vl_row)
 636                                                 val = panel_info.vl_row;
 637                                         p->yres = val;
 638                                         yres_set = 1;
 639                                 } else if (!bpp_set) {
 640                                         switch (val) {
 641                                         case 8:
 642                                         case 16:
 643                                         case 18:
 644                                         case 24:
 645                                                 color_depth = val;
 646                                                 break;
 647
 648                                         default:
 649                                                 printf("Invalid color depth: '%.*s' in video_mode; using default: '%u'\n",
 650                                                         end - vm, vm, color_depth);
 651                                         }
 652                                         bpp_set = 1;
 653                                 } else if (!refresh_set) {
 654                                         refresh = val;
 655                                         refresh_set = 1;
 656                                 }
 657                         }
 658                         vm = end;
 659                 }
 660                 switch (*vm) {
 661                 case '@':
 662                         bpp_set = 1;
 663                         /* fallthru */
 664                 case '-':
 665                         yres_set = 1;
 666                         /* fallthru */
 667                 case 'x':
 668                         xres_set = 1;
 669                         /* fallthru */
 670                 case 'M':
 671                 case 'R':
 672                         vm++;
 673                         break;
 674
 675                 default:
 676                         if (*vm != '\0')
 677                                 vm++;
 678                 }
 679         }
 680         if (p->xres == 0 || p->yres == 0) {
 681                 printf("Invalid video mode: %s\n", getenv("video_mode"));
 682                 lcd_enabled = 0;
 683                 printf("Supported video modes are:");
 684                 for (p = &tx28_fb_modes[0]; p->name != NULL; p++) {
 685                         printf(" %s", p->name);
 686                 }
 687                 printf("\n");
 688                 return;
 689         }
 690         panel_info.vl_col = p->xres;
 691         panel_info.vl_row = p->yres;
 692
 693         switch (color_depth) {
 694         case 8:
 695                 panel_info.vl_bpix = LCD_COLOR8;
 696                 break;
 697         case 16:
 698                 panel_info.vl_bpix = LCD_COLOR16;
 699                 break;
 700         default:
 701                 panel_info.vl_bpix = LCD_COLOR24;
 702         }
 703
 704         p->pixclock = KHZ2PICOS(refresh *
 705                 (p->xres + p->left_margin + p->right_margin + p->hsync_len) *
 706                 (p->yres + p->upper_margin + p->lower_margin + p->vsync_len) /
 707                                 1000);
 708         debug("Pixel clock set to %lu.%03lu MHz\n",
 709                 PICOS2KHZ(p->pixclock) / 1000, PICOS2KHZ(p->pixclock) % 1000);
 710
 711         gpio_request_array(stk5_lcd_gpios, ARRAY_SIZE(stk5_lcd_gpios));
 712         mxs_iomux_setup_multiple_pads(stk5_lcd_pads,
 713                                 ARRAY_SIZE(stk5_lcd_pads));
 714
 715         debug("video format: %ux%u-%u@%u\n", p->xres, p->yres,
 716                 color_depth, refresh);
 717
 718         if (karo_load_splashimage(0) == 0) {
 719                 char vmode[32];
 720
 721                 /* setup env variable for mxsfb display driver */
 722                 snprintf(vmode, sizeof(vmode), "%dx%dMR-%d@%d",
 723                         p->xres, p->yres, color_depth, refresh);
 724                 setenv("videomode", vmode);
 725
 726                 debug("Initializing LCD controller\n");
 727                 video_hw_init(lcdbase);
 728                 setenv("videomode", NULL);
 729         } else {
 730                 debug("Skipping initialization of LCD controller\n");
 731         }
 732 }
 733 #else
 734 #define lcd_enabled 0
 735 #endif /* CONFIG_LCD */
 736
 737 static void stk5_board_init(void)
 738 {
 739         gpio_request_array(stk5_gpios, ARRAY_SIZE(stk5_gpios));
 740         mxs_iomux_setup_multiple_pads(stk5_pads, ARRAY_SIZE(stk5_pads));
 741 }
 742
 743 static void stk5v3_board_init(void)
 744 {
 745         stk5_board_init();
 746 }
 747
 748 static void stk5v5_board_init(void)
 749 {
 750         stk5_board_init();
 751
 752         /* init flexcan transceiver enable GPIO */
 753         gpio_request_one(MXS_GPIO_NR(0, 1), GPIOF_OUTPUT_INIT_HIGH,
 754                         "Flexcan Transceiver");
 755         mxs_iomux_setup_pad(MX28_PAD_LCD_D00__GPIO_1_0);
 756 }
 757
 758 int board_late_init(void)
 759 {
 760         const char *baseboard;
 761
 762         karo_fdt_move_fdt();
 763
 764         baseboard = getenv("baseboard");
 765         if (!baseboard)
 766                 return 0;
 767
 768         if (strncmp(baseboard, "stk5", 4) == 0) {
 769                 printf("Baseboard: %s\n", baseboard);
 770                 if ((strlen(baseboard) == 4) ||
 771                         strcmp(baseboard, "stk5-v3") == 0) {
 772                         stk5v3_board_init();
 773                 } else if (strcmp(baseboard, "stk5-v5") == 0) {
 774                         const char *otg_mode = getenv("otg_mode");
 775
 776                         if (otg_mode && strcmp(otg_mode, "host") == 0) {
 777                                 printf("otg_mode='%s' is incompatible with baseboard %s; setting to 'none'\n",
 778                                         otg_mode, baseboard);
 779                                 setenv("otg_mode", "none");
 780                         }
 781                         stk5v5_board_init();
 782                 } else {
 783                         printf("WARNING: Unsupported STK5 board rev.: %s\n",
 784                                 baseboard + 4);
 785                 }
 786         } else {
 787                 printf("WARNING: Unsupported baseboard: '%s'\n",
 788                         baseboard);
 789                 return -EINVAL;
 790         }
 791
 792         return 0;
 793 }
 794
 795 #define BOOT_CAUSE_MASK         (RTC_PERSISTENT0_EXTERNAL_RESET |       \
 796                                 RTC_PERSISTENT0_ALARM_WAKE |            \
 797                                 RTC_PERSISTENT0_THERMAL_RESET)
 798
 799 static void thermal_init(void)
 800 {
 801         struct mxs_power_regs *power_regs = (void *)MXS_POWER_BASE;
 802         struct mxs_clkctrl_regs *clkctrl_regs = (void *)MXS_CLKCTRL_BASE;
 803
 804         writel(POWER_THERMAL_LOW_POWER | POWER_THERMAL_OFFSET_ADJ_ENABLE |
 805                 POWER_THERMAL_OFFSET_ADJ_OFFSET(3),
 806                 &power_regs->hw_power_thermal);
 807
 808         writel(CLKCTRL_RESET_EXTERNAL_RESET_ENABLE |
 809                 CLKCTRL_RESET_THERMAL_RESET_ENABLE,
 810                 &clkctrl_regs->hw_clkctrl_reset);
 811 }
 812
 813 int checkboard(void)
 814 {
 815         struct mxs_power_regs *power_regs = (void *)MXS_POWER_BASE;
 816         u32 pwr_sts = readl(&power_regs->hw_power_sts);
 817         u32 pwrup_src = (pwr_sts >> 24) & 0x3f;
 818         const char *dlm = "";
 819
 820         printf("Board: Ka-Ro TX28-4%sx%d\n", TX28_MOD_SUFFIX,
 821                 CONFIG_SDRAM_SIZE / SZ_128M);
 822
 823         printf("POWERUP Source: ");
 824         if (pwrup_src & (3 << 0)) {
 825                 printf("%sPSWITCH %s voltage", dlm,
 826                         pwrup_src & (1 << 1) ? "HIGH" : "MID");
 827                 dlm = " | ";
 828         }
 829         if (pwrup_src & (1 << 4)) {
 830                 printf("%sRTC", dlm);
 831                 dlm = " | ";
 832         }
 833         if (pwrup_src & (1 << 5)) {
 834                 printf("%s5V", dlm);
 835                 dlm = " | ";
 836         }
 837         printf("\n");
 838
 839         if (boot_cause & BOOT_CAUSE_MASK) {
 840                 dlm="";
 841                 printf("Last boot cause: ");
 842                 if (boot_cause & RTC_PERSISTENT0_EXTERNAL_RESET) {
 843                         printf("%sEXTERNAL", dlm);
 844                         dlm = " | ";
 845                 }
 846                 if (boot_cause & RTC_PERSISTENT0_THERMAL_RESET) {
 847                         printf("%sTHERMAL", dlm);
 848                         dlm = " | ";
 849                 }
 850                 if (*dlm != '\0')
 851                         printf(" RESET");
 852                 if (boot_cause & RTC_PERSISTENT0_ALARM_WAKE) {
 853                         printf("%sALARM WAKE", dlm);
 854                         dlm = " | ";
 855                 }
 856                 printf("\n");
 857         }
 858
 859         while (pwr_sts & POWER_STS_THERMAL_WARNING) {
 860                 static int first = 1;
 861
 862                 if (first) {
 863                         printf("CPU too hot to boot\n");
 864                         first = 0;
 865                 }
 866                 if (tstc())
 867                         break;
 868                 pwr_sts = readl(&power_regs->hw_power_sts);
 869         }
 870
 871         if (!(boot_cause & RTC_PERSISTENT0_THERMAL_RESET))
 872                 thermal_init();
 873
 874         return 0;
 875 }
 876
 877 #if defined(CONFIG_OF_BOARD_SETUP)
 878 #ifdef CONFIG_FDT_FIXUP_PARTITIONS
 879 #include <jffs2/jffs2.h>
 880 #include <mtd_node.h>
 881 struct node_info tx28_nand_nodes[] = {
 882         { "fsl,imx28-gpmi-nand", MTD_DEV_TYPE_NAND, },
 883 };
 884 #else
 885 #define fdt_fixup_mtdparts(b,n,c) do { } while (0)
 886 #endif
 887
 888 static int flexcan_enabled(void *blob)
 889 {
 890         const char *status;
 891         int off = fdt_path_offset(blob, "can0");
 892
 893         if (off < 0) {
 894                 printf("node 'can0' not found\n");
 895         } else {
 896                 status = fdt_getprop(blob, off, "status", NULL);
 897                 if (status && strcmp(status, "okay") == 0) {
 898                         printf("can0 is enabled\n");
 899                         return 1;
 900                 }
 901         }
 902         off = fdt_path_offset(blob, "can1");
 903         if (off < 0) {
 904                 printf("node 'can1' not found\n");
 905                 return 0;
 906         }
 907         status = fdt_getprop(blob, off, "status", NULL);
 908         if (status && strcmp(status, "okay") == 0) {
 909                 printf("can1 is enabled\n");
 910                 return 1;
 911         }
 912         printf("can driver disabled\n");
 913         return 0;
 914 }
 915
 916 static void tx28_set_lcd_pins(void *blob, const char *name)
 917 {
 918         int off = fdt_path_offset(blob, name);
 919         u32 ph;
 920         const struct fdt_property *pc;
 921         int len;
 922
 923         if (off < 0)
 924                 return;
 925
 926         ph = fdt32_to_cpu(fdt_create_phandle(blob, off));
 927         if (!ph)
 928                 return;
 929
 930         off = fdt_path_offset(blob, "lcdif");
 931         if (off < 0)
 932                 return;
 933
 934         pc = fdt_get_property(blob, off, "pinctrl-0", &len);
 935         if (!pc || len < sizeof(ph))
 936                 return;
 937
 938         memcpy((void *)pc->data, &ph, sizeof(ph));
 939         fdt_setprop(blob, off, "pinctrl-0", pc->data, len);
 940 }
 941
 942 static void tx28_fixup_flexcan(void *blob, int stk5_v5)
 943 {
 944         const char *can_xcvr = "disabled";
 945
 946         if (stk5_v5) {
 947                 if (flexcan_enabled(blob)) {
 948                         tx28_set_lcd_pins(blob, "lcdif_23bit_pins_a");
 949                         can_xcvr = "okay";
 950                 } else {
 951                         tx28_set_lcd_pins(blob, "lcdif_24bit_pins_a");
 952                 }
 953         } else {
 954                 const char *otg_mode = getenv("otg_mode");
 955
 956                 if (otg_mode && (strcmp(otg_mode, "host") == 0))
 957                         karo_fdt_enable_node(blob, "can1", 0);
 958         }
 959         fdt_find_and_setprop(blob, "/regulators/can-xcvr", "status",
 960                         can_xcvr, strlen(can_xcvr) + 1, 1);
 961 }
 962
 963 static void tx28_fixup_fec(void *blob)
 964 {
 965         karo_fdt_enable_node(blob, "ethernet1", 0);
 966 }
 967
 968 void ft_board_setup(void *blob, bd_t *bd)
 969 {
 970         const char *baseboard = getenv("baseboard");
 971         int stk5_v5 = baseboard != NULL && (strcmp(baseboard, "stk5-v5") == 0);
 972
 973 #ifdef CONFIG_TX28_S
 974         /* TX28-41xx (aka TX28S) has no external RTC
 975          * and no I2C GPIO extender
 976          */
 977         karo_fdt_remove_node(blob, "ds1339");
 978         karo_fdt_remove_node(blob, "gpio5");
 979 #endif
 980         if (stk5_v5) {
 981                 karo_fdt_remove_node(blob, "stk5led");
 982         } else {
 983                 tx28_fixup_fec(blob);
 984         }
 985         tx28_fixup_flexcan(blob, stk5_v5);
 986
 987         fdt_fixup_mtdparts(blob, tx28_nand_nodes, ARRAY_SIZE(tx28_nand_nodes));
 988         fdt_fixup_ethernet(blob);
 989
 990         karo_fdt_fixup_touchpanel(blob);
 991         karo_fdt_fixup_usb_otg(blob, "usbotg", "fsl,usbphy");
 992         karo_fdt_update_fb_mode(blob, getenv("video_mode"));
 993 }
 994 #endif