board/karo/tx51/tx51.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  * You should have received a copy of the GNU General Public License
  19  * along with this program; if not, write to the Free Software
  20  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  21  * MA 02111-1307 USA
  22  */
  23 #include <common.h>
  24 #include <errno.h>
  25 #include <libfdt.h>
  26 #include <fsl_esdhc.h>
  27 #include <mmc.h>
  28 #include <netdev.h>
  29 #include <fdt_support.h>
  30 #include <asm/string.h>
  31 #include <asm/io.h>
  32 #include <asm/gpio.h>
  33 #include <asm/arch/iomux-mx51.h>
  34 #include <asm/arch/clock.h>
  35 #include <asm/arch/imx-regs.h>
  36 #include <asm/arch/sys_proto.h>
  37
  38 #if !defined(CONFIG_TX51_80x0) && !defined(CONFIG_TX51_80x1) && !defined(CONFIG_TX51_80x2)
  39 #error TX51 model not selected
  40 #endif
  41
  42 //#define TIMER_TEST
  43
  44 #define IMX_GPIO_NR(p, o)       ((((p) - 1) << 5) | (o))
  45
  46 #define TX51_FEC_RESET_GPIO     IMX_GPIO_NR(2, 14)
  47 #define TX51_FEC_POWER_GPIO     IMX_GPIO_NR(1, 3)
  48 #define TX51_LED_GPIO           IMX_GPIO_NR(4, 10)
  49
  50 DECLARE_GLOBAL_DATA_PTR;
  51
  52 /*
  53  * Functions
  54  */
  55 static void print_reset_cause(void)
  56 {
  57         u32 srsr;
  58         struct src *src_regs = (struct src *)SRC_BASE_ADDR;
  59         void __iomem *wdt_base = (void __iomem *)WDOG1_BASE_ADDR;
  60         char *dlm = "";
  61
  62         printf("Reset cause: ");
  63
  64         srsr = readl(&src_regs->srsr);
  65         if (srsr & 0x00001) {
  66                 printf("%sPOR", dlm);
  67                 dlm = " | ";
  68         }
  69         if (srsr & 0x00004) {
  70                 printf("%sCSU", dlm);
  71                 dlm = " | ";
  72         }
  73         if (srsr & 0x00008) {
  74                 printf("%sIPP USER", dlm);
  75                 dlm = " | ";
  76         }
  77         if (srsr & 0x00010) {
  78                 u32 wrsr = readw(wdt_base + 4);
  79                 if (wrsr & (1 << 0)) {
  80                         printf("%sSOFT", dlm);
  81                         dlm = " | ";
  82                 }
  83                 if (wrsr & (1 << 1)) {
  84                         printf("%sWDOG", dlm);
  85                         dlm = " | ";
  86                 }
  87         }
  88         if (srsr & 0x00020) {
  89                 printf("%sJTAG HIGH-Z", dlm);
  90                 dlm = " | ";
  91         }
  92         if (srsr & 0x00040) {
  93                 printf("%sJTAG SW", dlm);
  94                 dlm = " | ";
  95         }
  96         if (srsr & 0x10000) {
  97                 printf("%sWARM BOOT", dlm);
  98                 dlm = " | ";
  99         }
 100         if (dlm[0] == '\0')
 101                 printf("unknown");
 102
 103         printf("\n");
 104 }
 105
 106 static void print_cpuinfo(void)
 107 {
 108         u32 cpurev;
 109
 110         cpurev = get_cpu_rev();
 111
 112         printf("CPU:   Freescale i.MX51 rev%d.%d at %d MHz\n",
 113                 (cpurev & 0x000F0) >> 4,
 114                 (cpurev & 0x0000F) >> 0,
 115                 mxc_get_clock(MXC_ARM_CLK) / 1000000);
 116
 117         print_reset_cause();
 118 }
 119
 120 int board_early_init_f(void)
 121 {
 122 #ifdef CONFIG_USB_EHCI_MX5
 123         setup_usb_h1();
 124 #endif
 125         writel(0xffffffff, 0x73fd4068);
 126         writel(0xffffffff, 0x73fd406c);
 127         writel(0xffffffff, 0x73fd4070);
 128         writel(0xffffffff, 0x73fd4074);
 129         writel(0xffffffff, 0x73fd4078);
 130         writel(0xffffffff, 0x73fd407c);
 131         writel(0xffffffff, 0x73fd4080);
 132         writel(0xffffffff, 0x73fd4084);
 133         return 0;
 134 }
 135
 136 void coloured_LED_init(void)
 137 {
 138         /* Switch LED off */
 139         gpio_set_value(TX51_LED_GPIO, 0);
 140 }
 141
 142 int board_init(void)
 143 {
 144         /* Address of boot parameters */
 145         gd->bd->bi_boot_params = PHYS_SDRAM_1 + 0x1000;
 146         return 0;
 147 }
 148
 149 int dram_init(void)
 150 {
 151         int ret;
 152
 153         /* dram_init must store complete ramsize in gd->ram_size */
 154         gd->ram_size = get_ram_size((void *)CONFIG_SYS_SDRAM_BASE,
 155                                 PHYS_SDRAM_1_SIZE);
 156
 157         ret = mxc_set_clock(CONFIG_SYS_MX5_HCLK,
 158                 CONFIG_SYS_SDRAM_CLOCK, MXC_DDR_CLK);
 159         if (ret)
 160                 printf("%s: Failed to set DDR clock to %uMHz: %d\n", __func__,
 161                         CONFIG_SYS_SDRAM_CLOCK, ret);
 162         else
 163                 debug("%s: DDR clock set to %u.%03uMHz (desig.: %u.000MHz)\n",
 164                         __func__, mxc_get_clock(MXC_DDR_CLK) / 1000000,
 165                         mxc_get_clock(MXC_DDR_CLK) / 1000 % 1000,
 166                         CONFIG_SYS_SDRAM_CLOCK);
 167         return ret;
 168 }
 169
 170 void dram_init_banksize(void)
 171 {
 172         gd->bd->bi_dram[0].start = PHYS_SDRAM_1;
 173         gd->bd->bi_dram[0].size = get_ram_size((void *)PHYS_SDRAM_1,
 174                         PHYS_SDRAM_1_SIZE);
 175 #if CONFIG_NR_DRAM_BANKS > 1
 176         gd->bd->bi_dram[1].start = PHYS_SDRAM_2;
 177         gd->bd->bi_dram[1].size = get_ram_size((void *)PHYS_SDRAM_2,
 178                         PHYS_SDRAM_2_SIZE);
 179 #endif
 180 }
 181
 182 #ifdef  CONFIG_CMD_MMC
 183 int board_mmc_getcd(struct mmc *mmc)
 184 {
 185         struct fsl_esdhc_cfg *cfg = mmc->priv;
 186
 187         if (cfg->cd_gpio < 0)
 188                 return cfg->cd_gpio;
 189
 190         return !gpio_get_value(cfg->cd_gpio);
 191 }
 192
 193 static struct fsl_esdhc_cfg esdhc_cfg[] = {
 194         {
 195                 .esdhc_base = (void __iomem *)MMC_SDHC1_BASE_ADDR,
 196                 .no_snoop = 1,
 197                 .cd_gpio = IMX_GPIO_NR(3, 8),
 198                 .wp_gpio = -EINVAL,
 199         },
 200         {
 201                 .esdhc_base = (void __iomem *)MMC_SDHC2_BASE_ADDR,
 202                 .no_snoop = 1,
 203                 .cd_gpio = IMX_GPIO_NR(3, 6),
 204                 .wp_gpio = -EINVAL,
 205         },
 206 };
 207
 208 static const iomux_v3_cfg_t mmc0_pads[] = {
 209         MX51_PAD_SD1_CMD__SD1_CMD,
 210         MX51_PAD_SD1_CLK__SD1_CLK,
 211         MX51_PAD_SD1_DATA0__SD1_DATA0,
 212         MX51_PAD_SD1_DATA1__SD1_DATA1,
 213         MX51_PAD_SD1_DATA2__SD1_DATA2,
 214         MX51_PAD_SD1_DATA3__SD1_DATA3,
 215         /* SD1 CD */
 216         MX51_PAD_DISPB2_SER_RS__GPIO3_8 |
 217         MUX_PAD_CTRL(PAD_CTL_PUE | PAD_CTL_PKE),
 218 };
 219
 220 static const iomux_v3_cfg_t mmc1_pads[] = {
 221         MX51_PAD_SD2_CMD__SD2_CMD,
 222         MX51_PAD_SD2_CLK__SD2_CLK,
 223         MX51_PAD_SD2_DATA0__SD2_DATA0,
 224         MX51_PAD_SD2_DATA1__SD2_DATA1,
 225         MX51_PAD_SD2_DATA2__SD2_DATA2,
 226         MX51_PAD_SD2_DATA3__SD2_DATA3,
 227         /* SD2 CD */
 228         MX51_PAD_DISPB2_SER_DIO__GPIO3_6 |
 229         MUX_PAD_CTRL(PAD_CTL_PUE | PAD_CTL_PKE),
 230 };
 231
 232 static struct {
 233         const iomux_v3_cfg_t *pads;
 234         int count;
 235 } mmc_pad_config[] = {
 236         { mmc0_pads, ARRAY_SIZE(mmc0_pads), },
 237         { mmc1_pads, ARRAY_SIZE(mmc1_pads), },
 238 };
 239
 240 int board_mmc_init(bd_t *bis)
 241 {
 242         int i;
 243
 244         for (i = 0; i < ARRAY_SIZE(esdhc_cfg); i++) {
 245                 struct mmc *mmc;
 246
 247                 if (i >= CONFIG_SYS_FSL_ESDHC_NUM)
 248                         break;
 249                 mxc_iomux_v3_setup_multiple_pads(mmc_pad_config[i].pads,
 250                                                 mmc_pad_config[i].count);
 251                 fsl_esdhc_initialize(bis, &esdhc_cfg[i]);
 252                 mmc = find_mmc_device(i);
 253                 if (mmc == NULL)
 254                         continue;
 255                 if (board_mmc_getcd(mmc) > 0)
 256                         mmc_init(mmc);
 257         }
 258         return 0;
 259 }
 260 #endif /* CONFIG_CMD_MMC */
 261
 262 #ifdef CONFIG_FEC_MXC
 263
 264 #ifndef ETH_ALEN
 265 #define ETH_ALEN 6
 266 #endif
 267
 268 #define IOMUX_SION              IOMUX_PAD(0, 0, IOMUX_CONFIG_SION, 0, 0, 0)
 269
 270 void imx_get_mac_from_fuse(int dev_id, unsigned char *mac)
 271 {
 272         int i;
 273         struct iim_regs *iim = (struct iim_regs *)IMX_IIM_BASE;
 274         struct fuse_bank *bank = &iim->bank[1];
 275         struct fuse_bank1_regs *fuse = (struct fuse_bank1_regs *)bank->fuse_regs;
 276
 277         if (dev_id > 0)
 278                 return;
 279
 280         for (i = 0; i < ETH_ALEN; i++)
 281                 mac[ETH_ALEN - i - 1] = readl(&fuse->mac_addr[i]);
 282 }
 283
 284 #define FEC_PAD_CTL     (PAD_CTL_DVS | PAD_CTL_PKE | PAD_CTL_DSE_HIGH | \
 285                         PAD_CTL_SRE_FAST)
 286 #define FEC_PAD_CTL2    (PAD_CTL_DVS | PAD_CTL_PKE | PAD_CTL_PUE |      \
 287                         PAD_CTL_PUS_100K_UP | PAD_CTL_SRE_FAST)
 288 #define GPIO_PAD_CTL    (PAD_CTL_DVS | PAD_CTL_DSE_HIGH)
 289
 290 static iomux_v3_cfg_t tx51_fec_gpio_pads[] = {
 291         NEW_PAD_CTRL(MX51_PAD_NANDF_CS3__GPIO3_19, GPIO_PAD_CTL) | IOMUX_SION,
 292         NEW_PAD_CTRL(MX51_PAD_EIM_EB2__GPIO2_22, GPIO_PAD_CTL) | IOMUX_SION,
 293         NEW_PAD_CTRL(MX51_PAD_NANDF_RB3__GPIO3_11, GPIO_PAD_CTL) | IOMUX_SION,
 294         NEW_PAD_CTRL(MX51_PAD_NANDF_D11__GPIO3_29, GPIO_PAD_CTL) | IOMUX_SION,
 295         NEW_PAD_CTRL(MX51_PAD_NANDF_D9__GPIO3_31, GPIO_PAD_CTL) | IOMUX_SION, /* RXD0/Mode0 */
 296         NEW_PAD_CTRL(MX51_PAD_EIM_EB3__GPIO2_23, GPIO_PAD_CTL) | IOMUX_SION, /* RXD1/Mode1 */
 297         NEW_PAD_CTRL(MX51_PAD_EIM_CS2__GPIO2_27, GPIO_PAD_CTL) | IOMUX_SION, /* RXD2/Mode2 */
 298         NEW_PAD_CTRL(MX51_PAD_EIM_CS3__GPIO2_28, GPIO_PAD_CTL) | IOMUX_SION, /* RXD3/nINTSEL */
 299         NEW_PAD_CTRL(MX51_PAD_EIM_CS4__GPIO2_29, GPIO_PAD_CTL) | IOMUX_SION,
 300         NEW_PAD_CTRL(MX51_PAD_NANDF_RDY_INT__GPIO3_24, GPIO_PAD_CTL) | IOMUX_SION,
 301         NEW_PAD_CTRL(MX51_PAD_NANDF_CS7__GPIO3_23, GPIO_PAD_CTL) | IOMUX_SION,
 302         NEW_PAD_CTRL(MX51_PAD_NANDF_D8__GPIO4_0, GPIO_PAD_CTL) | IOMUX_SION,
 303         NEW_PAD_CTRL(MX51_PAD_NANDF_CS4__GPIO3_20, GPIO_PAD_CTL) | IOMUX_SION,
 304         NEW_PAD_CTRL(MX51_PAD_NANDF_CS5__GPIO3_21, GPIO_PAD_CTL) | IOMUX_SION,
 305         NEW_PAD_CTRL(MX51_PAD_NANDF_CS6__GPIO3_22, GPIO_PAD_CTL) | IOMUX_SION,
 306         NEW_PAD_CTRL(MX51_PAD_NANDF_RB2__GPIO3_10, GPIO_PAD_CTL) | IOMUX_SION,
 307         NEW_PAD_CTRL(MX51_PAD_EIM_CS5__GPIO2_30, GPIO_PAD_CTL) | IOMUX_SION,
 308         NEW_PAD_CTRL(MX51_PAD_NANDF_CS2__GPIO3_18, GPIO_PAD_CTL) | IOMUX_SION, /* PHY INT */
 309         NEW_PAD_CTRL(MX51_PAD_EIM_A20__GPIO2_14, GPIO_PAD_CTL) | IOMUX_SION, /* PHY RESET */
 310         NEW_PAD_CTRL(MX51_PAD_GPIO1_3__GPIO1_3, GPIO_PAD_CTL) | IOMUX_SION,  /* PHY POWER */
 311 };
 312
 313 static iomux_v3_cfg_t tx51_fec_pads[] = {
 314         NEW_PAD_CTRL(MX51_PAD_NANDF_CS3__FEC_MDC, FEC_PAD_CTL),
 315         NEW_PAD_CTRL(MX51_PAD_EIM_EB2__FEC_MDIO, FEC_PAD_CTL),
 316         NEW_PAD_CTRL(MX51_PAD_NANDF_RB3__FEC_RX_CLK, FEC_PAD_CTL2),
 317         NEW_PAD_CTRL(MX51_PAD_NANDF_D11__FEC_RX_DV, FEC_PAD_CTL2),
 318         NEW_PAD_CTRL(MX51_PAD_NANDF_D9__FEC_RDATA0, FEC_PAD_CTL2),
 319         NEW_PAD_CTRL(MX51_PAD_EIM_EB3__FEC_RDATA1, FEC_PAD_CTL2),
 320         NEW_PAD_CTRL(MX51_PAD_EIM_CS2__FEC_RDATA2, FEC_PAD_CTL2),
 321         NEW_PAD_CTRL(MX51_PAD_EIM_CS3__FEC_RDATA3, FEC_PAD_CTL2),
 322         NEW_PAD_CTRL(MX51_PAD_EIM_CS4__FEC_RX_ER, FEC_PAD_CTL2),
 323         NEW_PAD_CTRL(MX51_PAD_NANDF_RDY_INT__FEC_TX_CLK, FEC_PAD_CTL2),
 324         NEW_PAD_CTRL(MX51_PAD_NANDF_CS7__FEC_TX_EN, FEC_PAD_CTL),
 325         NEW_PAD_CTRL(MX51_PAD_NANDF_D8__FEC_TDATA0, FEC_PAD_CTL),
 326         NEW_PAD_CTRL(MX51_PAD_NANDF_CS4__FEC_TDATA1, FEC_PAD_CTL),
 327         NEW_PAD_CTRL(MX51_PAD_NANDF_CS5__FEC_TDATA2, FEC_PAD_CTL),
 328         NEW_PAD_CTRL(MX51_PAD_NANDF_CS6__FEC_TDATA3, FEC_PAD_CTL),
 329         NEW_PAD_CTRL(MX51_PAD_NANDF_RB2__FEC_COL, FEC_PAD_CTL2),
 330         NEW_PAD_CTRL(MX51_PAD_EIM_CS5__FEC_CRS, FEC_PAD_CTL),
 331         NEW_PAD_CTRL(MX51_PAD_NANDF_CS2__GPIO3_18, GPIO_PAD_CTL),
 332         NEW_PAD_CTRL(MX51_PAD_EIM_A20__GPIO2_14, GPIO_PAD_CTL),
 333         NEW_PAD_CTRL(MX51_PAD_GPIO1_3__GPIO1_3, GPIO_PAD_CTL),
 334 };
 335
 336 static struct {
 337         unsigned gpio:8,
 338                 dir:1,
 339                 val:1;
 340 } tx51_fec_gpios[] = {
 341         { IMX_GPIO_NR(1, 3), 1, 0, },   /* PHY power */
 342         { IMX_GPIO_NR(2, 14), 1, 0, },  /* PHY reset */
 343         { IMX_GPIO_NR(3, 19), 1, 0, },  /* MDC */
 344         { IMX_GPIO_NR(2, 22), 1, 0, },  /* MDIO */
 345         { IMX_GPIO_NR(3, 11), 0, 1, },  /* RX_CLK */
 346         { IMX_GPIO_NR(3, 29), 0, 0, },  /* RX_DV */
 347         { IMX_GPIO_NR(3, 31), 1, 1, },  /* RXD0/Mode0 */
 348         { IMX_GPIO_NR(2, 23), 1, 1, },  /* RXD1/Mode1 */
 349         { IMX_GPIO_NR(2, 27), 1, 1, },  /* RXD2/Mode2 */
 350         { IMX_GPIO_NR(2, 28), 1, 1, },  /* RXD3/nINTSEL */
 351         { IMX_GPIO_NR(2, 29), 0, 0, },  /* RX_ER */
 352         { IMX_GPIO_NR(3, 24), 0, 0, },  /* TX_CLK */
 353         { IMX_GPIO_NR(3, 23), 1, 0, },  /* TX_EN */
 354         { IMX_GPIO_NR(4, 0), 1, 0, },   /* TXD0 */
 355         { IMX_GPIO_NR(3, 20), 1, 0, },  /* TXD1 */
 356         { IMX_GPIO_NR(3, 21), 1, 0, },  /* TXD2 */
 357         { IMX_GPIO_NR(3, 22), 1, 0, },  /* TXD3 */
 358         { IMX_GPIO_NR(3, 10), 1, 0, },  /* COL */
 359         { IMX_GPIO_NR(2, 30), 1, (CONFIG_FEC_MXC_PHYADDR >> 4) & 1, }, /* PHYAD4 */
 360         { IMX_GPIO_NR(3, 18), 0, 1, },  /* PHY INT (TX_ER) */
 361 };
 362
 363 int board_eth_init(bd_t *bis)
 364 {
 365         int ret;
 366         unsigned char mac[ETH_ALEN];
 367         char mac_str[ETH_ALEN * 3] = "";
 368         int i;
 369
 370         for (i = 0; i < ARRAY_SIZE(tx51_fec_gpios); i++) {
 371                 int gpio = tx51_fec_gpios[i].gpio;
 372
 373                 debug("Setting GPIO%d_%d as output LOW\n",
 374                         gpio / 32 + 1, gpio % 32);
 375                 gpio_direction_output(gpio, 0);
 376         }
 377         mxc_iomux_v3_setup_multiple_pads(tx51_fec_gpio_pads,
 378                                         ARRAY_SIZE(tx51_fec_gpio_pads));
 379
 380         /* Power on the external phy */
 381         gpio_direction_output(TX51_FEC_POWER_GPIO, 1);
 382
 383         udelay(1000);
 384
 385         for (i = 0; i < ARRAY_SIZE(tx51_fec_gpios); i++) {
 386                 int gpio = tx51_fec_gpios[i].gpio;
 387                 int dir = tx51_fec_gpios[i].dir;
 388                 int val = tx51_fec_gpios[i].val;
 389
 390                 if (dir && val) {
 391                         gpio_direction_output(gpio, val);
 392                 } else if (!dir) {
 393                         gpio_direction_input(gpio);
 394                 }
 395         }
 396
 397         udelay(25000);
 398
 399         /* Deassert RESET to the external phy */
 400         gpio_set_value(TX51_FEC_RESET_GPIO, 1);
 401
 402         udelay(400);
 403
 404         mxc_iomux_v3_setup_multiple_pads(tx51_fec_pads,
 405                                         ARRAY_SIZE(tx51_fec_pads));
 406
 407         ret = cpu_eth_init(bis);
 408         if (ret) {
 409                 printf("cpu_eth_init() failed: %d\n", ret);
 410         }
 411
 412         imx_get_mac_from_fuse(0, mac);
 413         snprintf(mac_str, sizeof(mac_str), "%02x:%02x:%02x:%02x:%02x:%02x",
 414                 mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]);
 415         setenv("ethaddr", mac_str);
 416
 417         return ret;
 418 }
 419 #endif /* CONFIG_FEC_MXC */
 420
 421 enum {
 422         LED_STATE_INIT = -1,
 423         LED_STATE_OFF,
 424         LED_STATE_ON,
 425 };
 426
 427 void show_activity(int arg)
 428 {
 429         static int led_state = LED_STATE_INIT;
 430         static ulong last;
 431
 432         if (led_state == LED_STATE_INIT) {
 433                 last = get_timer(0);
 434                 gpio_set_value(TX51_LED_GPIO, 1);
 435                 led_state = LED_STATE_ON;
 436         } else {
 437                 if (get_timer(last) > CONFIG_SYS_HZ) {
 438                         last = get_timer(0);
 439                         if (led_state == LED_STATE_ON) {
 440                                 gpio_set_value(TX51_LED_GPIO, 0);
 441                         } else {
 442                                 gpio_set_value(TX51_LED_GPIO, 1);
 443                         }
 444                         led_state = 1 - led_state;
 445                 }
 446         }
 447 }
 448
 449 static const iomux_v3_cfg_t stk5_pads[] = {
 450         /* heartbeat LED */
 451         MX51_PAD_CSI2_D13__GPIO4_10,
 452         /* LCD RESET */
 453         MX51_PAD_CSI2_VSYNC__GPIO4_13,
 454         /* LCD POWER_ENABLE */
 455         MX51_PAD_CSI2_HSYNC__GPIO4_14,
 456         /* LCD Backlight (PWM) */
 457         MX51_PAD_GPIO1_2__GPIO1_2,
 458 };
 459
 460 enum gpio_flags {
 461         GPIOF_INPUT,
 462         GPIOF_OUTPUT_INIT_LOW,
 463         GPIOF_OUTPUT_INIT_HIGH,
 464 };
 465
 466 struct gpio {
 467         unsigned int gpio;
 468         enum gpio_flags flags;
 469         const char *label;
 470 };
 471
 472 static const struct gpio stk5_gpios[] = {
 473         { IMX_GPIO_NR(4, 10), GPIOF_OUTPUT_INIT_LOW, "HEARTBEAT LED", },
 474         { IMX_GPIO_NR(4, 13), GPIOF_OUTPUT_INIT_LOW, "LCD RESET", },
 475         { IMX_GPIO_NR(4, 14), GPIOF_OUTPUT_INIT_LOW, "LCD POWER", },
 476         { IMX_GPIO_NR(1, 2), GPIOF_OUTPUT_INIT_HIGH, "LCD BACKLIGHT", },
 477 };
 478
 479 static int gpio_request_array(const struct gpio *gp, int count)
 480 {
 481         int ret;
 482         int i;
 483
 484         for (i = 0; i < count; i++) {
 485                 ret = gpio_request(gp[i].gpio, gp[i].label);
 486                 if (ret)
 487                         goto error;
 488
 489                 if (gp[i].flags == GPIOF_INPUT)
 490                         gpio_direction_input(gp[i].gpio);
 491                 else if (gp[i].flags == GPIOF_OUTPUT_INIT_LOW)
 492                         gpio_direction_output(gp[i].gpio, 0);
 493                 else if (gp[i].flags == GPIOF_OUTPUT_INIT_HIGH)
 494                         gpio_direction_output(gp[i].gpio, 1);
 495         }
 496         return 0;
 497
 498 error:
 499         while (--i >= 0)
 500                 gpio_free(gp[i].gpio);
 501
 502         return ret;
 503 }
 504
 505 static void stk5_board_init(void)
 506 {
 507         mxc_iomux_v3_setup_multiple_pads(stk5_pads, ARRAY_SIZE(stk5_pads));
 508         gpio_request_array(stk5_gpios, ARRAY_SIZE(stk5_gpios));
 509 }
 510
 511 static void stk5v3_board_init(void)
 512 {
 513         stk5_board_init();
 514 }
 515
 516 static void stk5v5_board_init(void)
 517 {
 518         stk5_board_init();
 519 }
 520
 521 static void tx51_move_fdt(void)
 522 {
 523         unsigned long fdt_addr = getenv_ulong("fdtcontroladdr", 16, 0);
 524         void *fdt = NULL;
 525
 526 #ifdef CONFIG_OF_EMBED
 527         fdt = _binary_dt_dtb_start;
 528 #elif defined CONFIG_OF_SEPARATE
 529         fdt = (void *)(_end_ofs + _TEXT_BASE);
 530 #endif
 531         if (fdt && fdt_addr != 0) {
 532                 if (fdt_check_header(fdt) == 0) {
 533                         size_t fdt_len = fdt_totalsize(fdt);
 534
 535                         memmove((void *)fdt_addr, fdt, fdt_len);
 536                 } else {
 537                         printf("ERROR: No valid FDT found at %p\n", fdt);
 538                 }
 539         }
 540 }
 541
 542 int board_late_init(void)
 543 {
 544         const char *baseboard;
 545
 546         baseboard = getenv("baseboard");
 547         if (!baseboard)
 548                 return 0;
 549
 550         if (strncmp(baseboard, "stk5", 4) == 0) {
 551                 printf("Baseboard: %s\n", baseboard);
 552                 if ((strlen(baseboard) == 4) ||
 553                         strcmp(baseboard, "stk5-v3") == 0) {
 554                         stk5v3_board_init();
 555                 } else if (strcmp(baseboard, "stk5-v5") == 0) {
 556                         stk5v5_board_init();
 557                 } else {
 558                         printf("WARNING: Unsupported STK5 board rev.: %s\n",
 559                                 baseboard + 4);
 560                 }
 561         } else {
 562                 printf("WARNING: Unsupported baseboard: '%s'\n",
 563                         baseboard);
 564                 return -EINVAL;
 565         }
 566         return 0;
 567 }
 568
 569 int checkboard(void)
 570 {
 571         print_cpuinfo();
 572
 573         printf("Board: Ka-Ro TX51\n");
 574
 575         tx51_move_fdt();
 576
 577 #ifdef TIMER_TEST
 578         {
 579                 unsigned long start = get_timer(0);
 580                 unsigned long last = gd->tbl;
 581                 unsigned long loop = 0;
 582                 unsigned long cnt = 0;
 583                 while (!tstc()) {
 584                         unsigned long elapsed = get_timer(start);
 585                         unsigned long diff = gd->tbl - last;
 586
 587                         loop++;
 588                         last = gd->tbl;
 589
 590                         printf("loop %4lu: t=%08lx diff=%08lx steps=%5lu elapsed time: %lu",
 591                                 loop, gd->tbl, diff, cnt, elapsed / CONFIG_SYS_HZ);
 592                         cnt = 0;
 593                         while (get_timer(start) < loop * CONFIG_SYS_HZ) {
 594                                 cnt++;
 595                                 udelay(100);
 596                         }
 597                         printf("\n");
 598                 }
 599         }
 600 #endif
 601         return 0;
 602 }
 603
 604 #if defined(CONFIG_OF_BOARD_SETUP)
 605 #ifdef CONFIG_FDT_FIXUP_PARTITIONS
 606 #include <jffs2/jffs2.h>
 607 #include <mtd_node.h>
 608 struct node_info nodes[] = {
 609         { "fsl,imx51-nand", MTD_DEV_TYPE_NAND, },
 610 };
 611
 612 #else
 613 #define fdt_fixup_mtdparts(b,n,c) do { } while (0)
 614 #endif
 615
 616 static const char *tx51_touchpanels[] = {
 617         "ti,tsc2007",
 618         "edt,edt-ft5x06",
 619 };
 620
 621 static void tx51_fixup_touchpanel(void *blob)
 622 {
 623         int i;
 624         const char *model = getenv("touchpanel");
 625
 626         for (i = 0; i < ARRAY_SIZE(tx51_touchpanels); i++) {
 627                 int offs;
 628                 const char *tp = tx51_touchpanels[i];
 629
 630                 if (model != NULL && strcmp(model, tp) == 0)
 631                         continue;
 632
 633                 tp = strchr(tp, ',');
 634                 if (tp != NULL && *tp != '\0' && strcmp(model, tp + 1) == 0)
 635                         continue;
 636
 637                 offs = fdt_node_offset_by_compatible(blob, -1,
 638                                                 tx51_touchpanels[i]);
 639                 if (offs < 0) {
 640                         printf("node '%s' not found: %d\n",
 641                                 tx51_touchpanels[i], offs);
 642                         continue;
 643                 }
 644                 printf("Removing node '%s' at offset %d\n",
 645                         tx51_touchpanels[i], offs);
 646                 fdt_del_node(blob, offs);
 647         }
 648 }
 649
 650 void ft_board_setup(void *blob, bd_t *bd)
 651 {
 652         fdt_fixup_mtdparts(blob, nodes, ARRAY_SIZE(nodes));
 653         fdt_fixup_ethernet(blob);
 654
 655         tx51_fixup_touchpanel(blob);
 656 }
 657 #endif