]> git.kernelconcepts.de Git - karo-tx-uboot.git/blob - board/gateworks/gw_ventana/gw_ventana.c
imx: ventana: add mem_mb dynamic env var
[karo-tx-uboot.git] / board / gateworks / gw_ventana / gw_ventana.c
1 /*
2  * Copyright (C) 2013 Gateworks Corporation
3  *
4  * Author: Tim Harvey <tharvey@gateworks.com>
5  *
6  * SPDX-License-Identifier: GPL-2.0+
7  */
8
9 #include <common.h>
10 #include <asm/io.h>
11 #include <asm/arch/clock.h>
12 #include <asm/arch/imx-regs.h>
13 #include <asm/arch/iomux.h>
14 #include <asm/arch/mx6-pins.h>
15 #include <asm/arch/mxc_hdmi.h>
16 #include <asm/arch/crm_regs.h>
17 #include <asm/arch/sys_proto.h>
18 #include <asm/gpio.h>
19 #include <asm/imx-common/iomux-v3.h>
20 #include <asm/imx-common/mxc_i2c.h>
21 #include <asm/imx-common/boot_mode.h>
22 #include <asm/imx-common/sata.h>
23 #include <asm/imx-common/spi.h>
24 #include <asm/imx-common/video.h>
25 #include <jffs2/load_kernel.h>
26 #include <hwconfig.h>
27 #include <i2c.h>
28 #include <linux/ctype.h>
29 #include <fdt_support.h>
30 #include <fsl_esdhc.h>
31 #include <miiphy.h>
32 #include <mmc.h>
33 #include <mtd_node.h>
34 #include <netdev.h>
35 #include <pci.h>
36 #include <power/pmic.h>
37 #include <power/ltc3676_pmic.h>
38 #include <power/pfuze100_pmic.h>
39 #include <fdt_support.h>
40 #include <jffs2/load_kernel.h>
41 #include <spi_flash.h>
42
43 #include "gsc.h"
44 #include "ventana_eeprom.h"
45
46 DECLARE_GLOBAL_DATA_PTR;
47
48 /* GPIO's common to all baseboards */
49 #define GP_PHY_RST      IMX_GPIO_NR(1, 30)
50 #define GP_USB_OTG_PWR  IMX_GPIO_NR(3, 22)
51 #define GP_SD3_CD       IMX_GPIO_NR(7, 0)
52 #define GP_RS232_EN     IMX_GPIO_NR(2, 11)
53 #define GP_MSATA_SEL    IMX_GPIO_NR(2, 8)
54
55 #define UART_PAD_CTRL  (PAD_CTL_PKE | PAD_CTL_PUE |             \
56         PAD_CTL_PUS_100K_UP | PAD_CTL_SPEED_MED |               \
57         PAD_CTL_DSE_40ohm   | PAD_CTL_SRE_FAST  | PAD_CTL_HYS)
58
59 #define USDHC_PAD_CTRL (PAD_CTL_PKE | PAD_CTL_PUE |             \
60         PAD_CTL_PUS_47K_UP  | PAD_CTL_SPEED_LOW |               \
61         PAD_CTL_DSE_80ohm   | PAD_CTL_SRE_FAST  | PAD_CTL_HYS)
62
63 #define ENET_PAD_CTRL  (PAD_CTL_PKE | PAD_CTL_PUE |             \
64         PAD_CTL_PUS_100K_UP | PAD_CTL_SPEED_MED   |             \
65         PAD_CTL_DSE_40ohm   | PAD_CTL_HYS)
66
67 #define SPI_PAD_CTRL (PAD_CTL_HYS |                             \
68         PAD_CTL_PUS_100K_DOWN | PAD_CTL_SPEED_MED |             \
69         PAD_CTL_DSE_40ohm     | PAD_CTL_SRE_FAST)
70
71 #define DIO_PAD_CTRL  (PAD_CTL_PKE | PAD_CTL_PUE |              \
72         PAD_CTL_PUS_100K_UP | PAD_CTL_SPEED_MED |               \
73         PAD_CTL_DSE_34ohm | PAD_CTL_HYS | PAD_CTL_SRE_FAST)
74
75 #define I2C_PAD_CTRL  (PAD_CTL_PUS_100K_UP |                    \
76         PAD_CTL_SPEED_MED | PAD_CTL_DSE_40ohm | PAD_CTL_HYS |   \
77         PAD_CTL_ODE | PAD_CTL_SRE_FAST)
78
79 #define IRQ_PAD_CTRL  (PAD_CTL_PKE | PAD_CTL_PUE |              \
80         PAD_CTL_PUS_100K_UP | PAD_CTL_SPEED_MED |               \
81         PAD_CTL_DSE_34ohm | PAD_CTL_HYS | PAD_CTL_SRE_FAST)
82
83 #define DIO_PAD_CFG   (MUX_PAD_CTRL(DIO_PAD_CTRL) | MUX_MODE_SION)
84
85
86 /*
87  * EEPROM board info struct populated by read_eeprom so that we only have to
88  * read it once.
89  */
90 struct ventana_board_info ventana_info;
91
92 static int board_type;
93
94 /* UART1: Function varies per baseboard */
95 static iomux_v3_cfg_t const uart1_pads[] = {
96         IOMUX_PADS(PAD_SD3_DAT6__UART1_RX_DATA | MUX_PAD_CTRL(UART_PAD_CTRL)),
97         IOMUX_PADS(PAD_SD3_DAT7__UART1_TX_DATA | MUX_PAD_CTRL(UART_PAD_CTRL)),
98 };
99
100 /* UART2: Serial Console */
101 static iomux_v3_cfg_t const uart2_pads[] = {
102         IOMUX_PADS(PAD_SD4_DAT7__UART2_TX_DATA | MUX_PAD_CTRL(UART_PAD_CTRL)),
103         IOMUX_PADS(PAD_SD4_DAT4__UART2_RX_DATA | MUX_PAD_CTRL(UART_PAD_CTRL)),
104 };
105
106 #define PC MUX_PAD_CTRL(I2C_PAD_CTRL)
107
108 /* I2C1: GSC */
109 static struct i2c_pads_info mx6q_i2c_pad_info0 = {
110         .scl = {
111                 .i2c_mode = MX6Q_PAD_EIM_D21__I2C1_SCL | PC,
112                 .gpio_mode = MX6Q_PAD_EIM_D21__GPIO3_IO21 | PC,
113                 .gp = IMX_GPIO_NR(3, 21)
114         },
115         .sda = {
116                 .i2c_mode = MX6Q_PAD_EIM_D28__I2C1_SDA | PC,
117                 .gpio_mode = MX6Q_PAD_EIM_D28__GPIO3_IO28 | PC,
118                 .gp = IMX_GPIO_NR(3, 28)
119         }
120 };
121 static struct i2c_pads_info mx6dl_i2c_pad_info0 = {
122         .scl = {
123                 .i2c_mode = MX6DL_PAD_EIM_D21__I2C1_SCL | PC,
124                 .gpio_mode = MX6DL_PAD_EIM_D21__GPIO3_IO21 | PC,
125                 .gp = IMX_GPIO_NR(3, 21)
126         },
127         .sda = {
128                 .i2c_mode = MX6DL_PAD_EIM_D28__I2C1_SDA | PC,
129                 .gpio_mode = MX6DL_PAD_EIM_D28__GPIO3_IO28 | PC,
130                 .gp = IMX_GPIO_NR(3, 28)
131         }
132 };
133
134 /* I2C2: PMIC/PCIe Switch/PCIe Clock/Mezz */
135 static struct i2c_pads_info mx6q_i2c_pad_info1 = {
136         .scl = {
137                 .i2c_mode = MX6Q_PAD_KEY_COL3__I2C2_SCL | PC,
138                 .gpio_mode = MX6Q_PAD_KEY_COL3__GPIO4_IO12 | PC,
139                 .gp = IMX_GPIO_NR(4, 12)
140         },
141         .sda = {
142                 .i2c_mode = MX6Q_PAD_KEY_ROW3__I2C2_SDA | PC,
143                 .gpio_mode = MX6Q_PAD_KEY_ROW3__GPIO4_IO13 | PC,
144                 .gp = IMX_GPIO_NR(4, 13)
145         }
146 };
147 static struct i2c_pads_info mx6dl_i2c_pad_info1 = {
148         .scl = {
149                 .i2c_mode = MX6DL_PAD_KEY_COL3__I2C2_SCL | PC,
150                 .gpio_mode = MX6DL_PAD_KEY_COL3__GPIO4_IO12 | PC,
151                 .gp = IMX_GPIO_NR(4, 12)
152         },
153         .sda = {
154                 .i2c_mode = MX6DL_PAD_KEY_ROW3__I2C2_SDA | PC,
155                 .gpio_mode = MX6DL_PAD_KEY_ROW3__GPIO4_IO13 | PC,
156                 .gp = IMX_GPIO_NR(4, 13)
157         }
158 };
159
160 /* I2C3: Misc/Expansion */
161 static struct i2c_pads_info mx6q_i2c_pad_info2 = {
162         .scl = {
163                 .i2c_mode = MX6Q_PAD_GPIO_3__I2C3_SCL | PC,
164                 .gpio_mode = MX6Q_PAD_GPIO_3__GPIO1_IO03 | PC,
165                 .gp = IMX_GPIO_NR(1, 3)
166         },
167         .sda = {
168                 .i2c_mode = MX6Q_PAD_GPIO_6__I2C3_SDA | PC,
169                 .gpio_mode = MX6Q_PAD_GPIO_6__GPIO1_IO06 | PC,
170                 .gp = IMX_GPIO_NR(1, 6)
171         }
172 };
173 static struct i2c_pads_info mx6dl_i2c_pad_info2 = {
174         .scl = {
175                 .i2c_mode = MX6DL_PAD_GPIO_3__I2C3_SCL | PC,
176                 .gpio_mode = MX6DL_PAD_GPIO_3__GPIO1_IO03 | PC,
177                 .gp = IMX_GPIO_NR(1, 3)
178         },
179         .sda = {
180                 .i2c_mode = MX6DL_PAD_GPIO_6__I2C3_SDA | PC,
181                 .gpio_mode = MX6DL_PAD_GPIO_6__GPIO1_IO06 | PC,
182                 .gp = IMX_GPIO_NR(1, 6)
183         }
184 };
185
186 /* MMC */
187 static iomux_v3_cfg_t const usdhc3_pads[] = {
188         IOMUX_PADS(PAD_SD3_CLK__SD3_CLK    | MUX_PAD_CTRL(USDHC_PAD_CTRL)),
189         IOMUX_PADS(PAD_SD3_CMD__SD3_CMD    | MUX_PAD_CTRL(USDHC_PAD_CTRL)),
190         IOMUX_PADS(PAD_SD3_DAT0__SD3_DATA0 | MUX_PAD_CTRL(USDHC_PAD_CTRL)),
191         IOMUX_PADS(PAD_SD3_DAT1__SD3_DATA1 | MUX_PAD_CTRL(USDHC_PAD_CTRL)),
192         IOMUX_PADS(PAD_SD3_DAT2__SD3_DATA2 | MUX_PAD_CTRL(USDHC_PAD_CTRL)),
193         IOMUX_PADS(PAD_SD3_DAT3__SD3_DATA3 | MUX_PAD_CTRL(USDHC_PAD_CTRL)),
194         /* CD */
195         IOMUX_PADS(PAD_SD3_DAT5__GPIO7_IO00  | MUX_PAD_CTRL(IRQ_PAD_CTRL)),
196 };
197
198 /* ENET */
199 static iomux_v3_cfg_t const enet_pads[] = {
200         IOMUX_PADS(PAD_ENET_MDIO__ENET_MDIO  | MUX_PAD_CTRL(ENET_PAD_CTRL)),
201         IOMUX_PADS(PAD_ENET_MDC__ENET_MDC    | MUX_PAD_CTRL(ENET_PAD_CTRL)),
202         IOMUX_PADS(PAD_RGMII_TXC__RGMII_TXC  | MUX_PAD_CTRL(ENET_PAD_CTRL)),
203         IOMUX_PADS(PAD_RGMII_TD0__RGMII_TD0  | MUX_PAD_CTRL(ENET_PAD_CTRL)),
204         IOMUX_PADS(PAD_RGMII_TD1__RGMII_TD1  | MUX_PAD_CTRL(ENET_PAD_CTRL)),
205         IOMUX_PADS(PAD_RGMII_TD2__RGMII_TD2  | MUX_PAD_CTRL(ENET_PAD_CTRL)),
206         IOMUX_PADS(PAD_RGMII_TD3__RGMII_TD3  | MUX_PAD_CTRL(ENET_PAD_CTRL)),
207         IOMUX_PADS(PAD_RGMII_TX_CTL__RGMII_TX_CTL |
208                    MUX_PAD_CTRL(ENET_PAD_CTRL)),
209         IOMUX_PADS(PAD_ENET_REF_CLK__ENET_TX_CLK |
210                    MUX_PAD_CTRL(ENET_PAD_CTRL)),
211         IOMUX_PADS(PAD_RGMII_RXC__RGMII_RXC  | MUX_PAD_CTRL(ENET_PAD_CTRL)),
212         IOMUX_PADS(PAD_RGMII_RD0__RGMII_RD0  | MUX_PAD_CTRL(ENET_PAD_CTRL)),
213         IOMUX_PADS(PAD_RGMII_RD1__RGMII_RD1  | MUX_PAD_CTRL(ENET_PAD_CTRL)),
214         IOMUX_PADS(PAD_RGMII_RD2__RGMII_RD2  | MUX_PAD_CTRL(ENET_PAD_CTRL)),
215         IOMUX_PADS(PAD_RGMII_RD3__RGMII_RD3  | MUX_PAD_CTRL(ENET_PAD_CTRL)),
216         IOMUX_PADS(PAD_RGMII_RX_CTL__RGMII_RX_CTL |
217                    MUX_PAD_CTRL(ENET_PAD_CTRL)),
218         /* PHY nRST */
219         IOMUX_PADS(PAD_ENET_TXD0__GPIO1_IO30 | DIO_PAD_CFG),
220 };
221
222 /* NAND */
223 static iomux_v3_cfg_t const nfc_pads[] = {
224         IOMUX_PADS(PAD_NANDF_CLE__NAND_CLE     | MUX_PAD_CTRL(NO_PAD_CTRL)),
225         IOMUX_PADS(PAD_NANDF_ALE__NAND_ALE     | MUX_PAD_CTRL(NO_PAD_CTRL)),
226         IOMUX_PADS(PAD_NANDF_WP_B__NAND_WP_B   | MUX_PAD_CTRL(NO_PAD_CTRL)),
227         IOMUX_PADS(PAD_NANDF_RB0__NAND_READY_B | MUX_PAD_CTRL(NO_PAD_CTRL)),
228         IOMUX_PADS(PAD_NANDF_CS0__NAND_CE0_B   | MUX_PAD_CTRL(NO_PAD_CTRL)),
229         IOMUX_PADS(PAD_SD4_CMD__NAND_RE_B      | MUX_PAD_CTRL(NO_PAD_CTRL)),
230         IOMUX_PADS(PAD_SD4_CLK__NAND_WE_B      | MUX_PAD_CTRL(NO_PAD_CTRL)),
231         IOMUX_PADS(PAD_NANDF_D0__NAND_DATA00   | MUX_PAD_CTRL(NO_PAD_CTRL)),
232         IOMUX_PADS(PAD_NANDF_D1__NAND_DATA01   | MUX_PAD_CTRL(NO_PAD_CTRL)),
233         IOMUX_PADS(PAD_NANDF_D2__NAND_DATA02   | MUX_PAD_CTRL(NO_PAD_CTRL)),
234         IOMUX_PADS(PAD_NANDF_D3__NAND_DATA03   | MUX_PAD_CTRL(NO_PAD_CTRL)),
235         IOMUX_PADS(PAD_NANDF_D4__NAND_DATA04   | MUX_PAD_CTRL(NO_PAD_CTRL)),
236         IOMUX_PADS(PAD_NANDF_D5__NAND_DATA05   | MUX_PAD_CTRL(NO_PAD_CTRL)),
237         IOMUX_PADS(PAD_NANDF_D6__NAND_DATA06   | MUX_PAD_CTRL(NO_PAD_CTRL)),
238         IOMUX_PADS(PAD_NANDF_D7__NAND_DATA07   | MUX_PAD_CTRL(NO_PAD_CTRL)),
239 };
240
241 #ifdef CONFIG_CMD_NAND
242 static void setup_gpmi_nand(void)
243 {
244         struct mxc_ccm_reg *mxc_ccm = (struct mxc_ccm_reg *)CCM_BASE_ADDR;
245
246         /* config gpmi nand iomux */
247         SETUP_IOMUX_PADS(nfc_pads);
248
249         /* config gpmi and bch clock to 100 MHz */
250         clrsetbits_le32(&mxc_ccm->cs2cdr,
251                         MXC_CCM_CS2CDR_ENFC_CLK_PODF_MASK |
252                         MXC_CCM_CS2CDR_ENFC_CLK_PRED_MASK |
253                         MXC_CCM_CS2CDR_ENFC_CLK_SEL_MASK,
254                         MXC_CCM_CS2CDR_ENFC_CLK_PODF(0) |
255                         MXC_CCM_CS2CDR_ENFC_CLK_PRED(3) |
256                         MXC_CCM_CS2CDR_ENFC_CLK_SEL(3));
257
258         /* enable gpmi and bch clock gating */
259         setbits_le32(&mxc_ccm->CCGR4,
260                      MXC_CCM_CCGR4_RAWNAND_U_BCH_INPUT_APB_MASK |
261                      MXC_CCM_CCGR4_RAWNAND_U_GPMI_BCH_INPUT_BCH_MASK |
262                      MXC_CCM_CCGR4_RAWNAND_U_GPMI_BCH_INPUT_GPMI_IO_MASK |
263                      MXC_CCM_CCGR4_RAWNAND_U_GPMI_INPUT_APB_MASK |
264                      MXC_CCM_CCGR4_PL301_MX6QPER1_BCH_OFFSET);
265
266         /* enable apbh clock gating */
267         setbits_le32(&mxc_ccm->CCGR0, MXC_CCM_CCGR0_APBHDMA_MASK);
268 }
269 #endif
270
271 static void setup_iomux_enet(void)
272 {
273         SETUP_IOMUX_PADS(enet_pads);
274
275         /* toggle PHY_RST# */
276         gpio_direction_output(GP_PHY_RST, 0);
277         mdelay(2);
278         gpio_set_value(GP_PHY_RST, 1);
279 }
280
281 static void setup_iomux_uart(void)
282 {
283         SETUP_IOMUX_PADS(uart1_pads);
284         SETUP_IOMUX_PADS(uart2_pads);
285 }
286
287 #ifdef CONFIG_USB_EHCI_MX6
288 static iomux_v3_cfg_t const usb_pads[] = {
289         IOMUX_PADS(PAD_GPIO_1__USB_OTG_ID   | DIO_PAD_CFG),
290         IOMUX_PADS(PAD_KEY_COL4__USB_OTG_OC | DIO_PAD_CFG),
291         /* OTG PWR */
292         IOMUX_PADS(PAD_EIM_D22__GPIO3_IO22  | DIO_PAD_CFG),
293 };
294
295 int board_ehci_hcd_init(int port)
296 {
297         struct ventana_board_info *info = &ventana_info;
298
299         SETUP_IOMUX_PADS(usb_pads);
300
301         /* Reset USB HUB (present on GW54xx/GW53xx) */
302         switch (info->model[3]) {
303         case '3': /* GW53xx */
304         case '5': /* GW552x */
305                 SETUP_IOMUX_PAD(PAD_GPIO_9__GPIO1_IO09 | DIO_PAD_CFG);
306                 gpio_direction_output(IMX_GPIO_NR(1, 9), 0);
307                 mdelay(2);
308                 gpio_set_value(IMX_GPIO_NR(1, 9), 1);
309                 break;
310         case '4': /* GW54xx */
311                 SETUP_IOMUX_PAD(PAD_SD1_DAT0__GPIO1_IO16 | DIO_PAD_CFG);
312                 gpio_direction_output(IMX_GPIO_NR(1, 16), 0);
313                 mdelay(2);
314                 gpio_set_value(IMX_GPIO_NR(1, 16), 1);
315                 break;
316         }
317
318         return 0;
319 }
320
321 int board_ehci_power(int port, int on)
322 {
323         if (port)
324                 return 0;
325         gpio_set_value(GP_USB_OTG_PWR, on);
326         return 0;
327 }
328 #endif /* CONFIG_USB_EHCI_MX6 */
329
330 #ifdef CONFIG_FSL_ESDHC
331 static struct fsl_esdhc_cfg usdhc_cfg = { USDHC3_BASE_ADDR };
332
333 int board_mmc_getcd(struct mmc *mmc)
334 {
335         /* Card Detect */
336         gpio_direction_input(GP_SD3_CD);
337         return !gpio_get_value(GP_SD3_CD);
338 }
339
340 int board_mmc_init(bd_t *bis)
341 {
342         /* Only one USDHC controller on Ventana */
343         SETUP_IOMUX_PADS(usdhc3_pads);
344         usdhc_cfg.sdhc_clk = mxc_get_clock(MXC_ESDHC3_CLK);
345         usdhc_cfg.max_bus_width = 4;
346
347         return fsl_esdhc_initialize(bis, &usdhc_cfg);
348 }
349 #endif /* CONFIG_FSL_ESDHC */
350
351 #ifdef CONFIG_MXC_SPI
352 iomux_v3_cfg_t const ecspi1_pads[] = {
353         /* SS1 */
354         IOMUX_PADS(PAD_EIM_D19__GPIO3_IO19  | MUX_PAD_CTRL(SPI_PAD_CTRL)),
355         IOMUX_PADS(PAD_EIM_D17__ECSPI1_MISO | MUX_PAD_CTRL(SPI_PAD_CTRL)),
356         IOMUX_PADS(PAD_EIM_D18__ECSPI1_MOSI | MUX_PAD_CTRL(SPI_PAD_CTRL)),
357         IOMUX_PADS(PAD_EIM_D16__ECSPI1_SCLK | MUX_PAD_CTRL(SPI_PAD_CTRL)),
358 };
359
360 int board_spi_cs_gpio(unsigned bus, unsigned cs)
361 {
362         return (bus == 0 && cs == 0) ? (IMX_GPIO_NR(3, 19)) : -1;
363 }
364
365 static void setup_spi(void)
366 {
367         gpio_direction_output(IMX_GPIO_NR(3, 19), 1);
368         SETUP_IOMUX_PADS(ecspi1_pads);
369 }
370 #endif
371
372 /* configure eth0 PHY board-specific LED behavior */
373 int board_phy_config(struct phy_device *phydev)
374 {
375         unsigned short val;
376
377         /* Marvel 88E1510 */
378         if (phydev->phy_id == 0x1410dd1) {
379                 /*
380                  * Page 3, Register 16: LED[2:0] Function Control Register
381                  * LED[0] (SPD:Amber) R16_3.3:0 to 0111: on-GbE link
382                  * LED[1] (LNK:Green) R16_3.7:4 to 0001: on-link, blink-activity
383                  */
384                 phy_write(phydev, MDIO_DEVAD_NONE, 22, 3);
385                 val = phy_read(phydev, MDIO_DEVAD_NONE, 16);
386                 val &= 0xff00;
387                 val |= 0x0017;
388                 phy_write(phydev, MDIO_DEVAD_NONE, 16, val);
389                 phy_write(phydev, MDIO_DEVAD_NONE, 22, 0);
390         }
391
392         if (phydev->drv->config)
393                 phydev->drv->config(phydev);
394
395         return 0;
396 }
397
398 int board_eth_init(bd_t *bis)
399 {
400 #ifdef CONFIG_FEC_MXC
401         if (board_type != GW551x && board_type != GW552x) {
402                 setup_iomux_enet();
403                 cpu_eth_init(bis);
404         }
405 #endif
406
407 #ifdef CONFIG_E1000
408         e1000_initialize(bis);
409 #endif
410
411 #ifdef CONFIG_CI_UDC
412         /* For otg ethernet*/
413         usb_eth_initialize(bis);
414 #endif
415
416         /* default to the first detected enet dev */
417         if (!getenv("ethprime")) {
418                 struct eth_device *dev = eth_get_dev_by_index(0);
419                 if (dev) {
420                         setenv("ethprime", dev->name);
421                         printf("set ethprime to %s\n", getenv("ethprime"));
422                 }
423         }
424
425         return 0;
426 }
427
428 #if defined(CONFIG_VIDEO_IPUV3)
429
430 static void enable_hdmi(struct display_info_t const *dev)
431 {
432         imx_enable_hdmi_phy();
433 }
434
435 static int detect_i2c(struct display_info_t const *dev)
436 {
437         return i2c_set_bus_num(dev->bus) == 0 &&
438                 i2c_probe(dev->addr) == 0;
439 }
440
441 static void enable_lvds(struct display_info_t const *dev)
442 {
443         struct iomuxc *iomux = (struct iomuxc *)
444                                 IOMUXC_BASE_ADDR;
445
446         /* set CH0 data width to 24bit (IOMUXC_GPR2:5 0=18bit, 1=24bit) */
447         u32 reg = readl(&iomux->gpr[2]);
448         reg |= IOMUXC_GPR2_DATA_WIDTH_CH0_24BIT;
449         writel(reg, &iomux->gpr[2]);
450
451         /* Enable Backlight */
452         SETUP_IOMUX_PAD(PAD_SD1_CMD__GPIO1_IO18 | DIO_PAD_CFG);
453         gpio_direction_output(IMX_GPIO_NR(1, 18), 1);
454 }
455
456 struct display_info_t const displays[] = {{
457         /* HDMI Output */
458         .bus    = -1,
459         .addr   = 0,
460         .pixfmt = IPU_PIX_FMT_RGB24,
461         .detect = detect_hdmi,
462         .enable = enable_hdmi,
463         .mode   = {
464                 .name           = "HDMI",
465                 .refresh        = 60,
466                 .xres           = 1024,
467                 .yres           = 768,
468                 .pixclock       = 15385,
469                 .left_margin    = 220,
470                 .right_margin   = 40,
471                 .upper_margin   = 21,
472                 .lower_margin   = 7,
473                 .hsync_len      = 60,
474                 .vsync_len      = 10,
475                 .sync           = FB_SYNC_EXT,
476                 .vmode          = FB_VMODE_NONINTERLACED
477 } }, {
478         /* Freescale MXC-LVDS1: HannStar HSD100PXN1-A00 w/ egalx_ts cont */
479         .bus    = 2,
480         .addr   = 0x4,
481         .pixfmt = IPU_PIX_FMT_LVDS666,
482         .detect = detect_i2c,
483         .enable = enable_lvds,
484         .mode   = {
485                 .name           = "Hannstar-XGA",
486                 .refresh        = 60,
487                 .xres           = 1024,
488                 .yres           = 768,
489                 .pixclock       = 15385,
490                 .left_margin    = 220,
491                 .right_margin   = 40,
492                 .upper_margin   = 21,
493                 .lower_margin   = 7,
494                 .hsync_len      = 60,
495                 .vsync_len      = 10,
496                 .sync           = FB_SYNC_EXT,
497                 .vmode          = FB_VMODE_NONINTERLACED
498 } } };
499 size_t display_count = ARRAY_SIZE(displays);
500
501 static void setup_display(void)
502 {
503         struct mxc_ccm_reg *mxc_ccm = (struct mxc_ccm_reg *)CCM_BASE_ADDR;
504         struct iomuxc *iomux = (struct iomuxc *)IOMUXC_BASE_ADDR;
505         int reg;
506
507         enable_ipu_clock();
508         imx_setup_hdmi();
509         /* Turn on LDB0,IPU,IPU DI0 clocks */
510         reg = __raw_readl(&mxc_ccm->CCGR3);
511         reg |= MXC_CCM_CCGR3_LDB_DI0_MASK;
512         writel(reg, &mxc_ccm->CCGR3);
513
514         /* set LDB0, LDB1 clk select to 011/011 */
515         reg = readl(&mxc_ccm->cs2cdr);
516         reg &= ~(MXC_CCM_CS2CDR_LDB_DI0_CLK_SEL_MASK
517                  |MXC_CCM_CS2CDR_LDB_DI1_CLK_SEL_MASK);
518         reg |= (3<<MXC_CCM_CS2CDR_LDB_DI0_CLK_SEL_OFFSET)
519               |(3<<MXC_CCM_CS2CDR_LDB_DI1_CLK_SEL_OFFSET);
520         writel(reg, &mxc_ccm->cs2cdr);
521
522         reg = readl(&mxc_ccm->cscmr2);
523         reg |= MXC_CCM_CSCMR2_LDB_DI0_IPU_DIV;
524         writel(reg, &mxc_ccm->cscmr2);
525
526         reg = readl(&mxc_ccm->chsccdr);
527         reg |= (CHSCCDR_CLK_SEL_LDB_DI0
528                 <<MXC_CCM_CHSCCDR_IPU1_DI0_CLK_SEL_OFFSET);
529         writel(reg, &mxc_ccm->chsccdr);
530
531         reg = IOMUXC_GPR2_BGREF_RRMODE_EXTERNAL_RES
532              |IOMUXC_GPR2_DI1_VS_POLARITY_ACTIVE_HIGH
533              |IOMUXC_GPR2_DI0_VS_POLARITY_ACTIVE_LOW
534              |IOMUXC_GPR2_BIT_MAPPING_CH1_SPWG
535              |IOMUXC_GPR2_DATA_WIDTH_CH1_18BIT
536              |IOMUXC_GPR2_BIT_MAPPING_CH0_SPWG
537              |IOMUXC_GPR2_DATA_WIDTH_CH0_18BIT
538              |IOMUXC_GPR2_LVDS_CH1_MODE_DISABLED
539              |IOMUXC_GPR2_LVDS_CH0_MODE_ENABLED_DI0;
540         writel(reg, &iomux->gpr[2]);
541
542         reg = readl(&iomux->gpr[3]);
543         reg = (reg & ~IOMUXC_GPR3_LVDS0_MUX_CTL_MASK)
544             | (IOMUXC_GPR3_MUX_SRC_IPU1_DI0
545                <<IOMUXC_GPR3_LVDS0_MUX_CTL_OFFSET);
546         writel(reg, &iomux->gpr[3]);
547
548         /* Backlight CABEN on LVDS connector */
549         SETUP_IOMUX_PAD(PAD_SD2_CLK__GPIO1_IO10 | DIO_PAD_CFG);
550         gpio_direction_output(IMX_GPIO_NR(1, 10), 0);
551 }
552 #endif /* CONFIG_VIDEO_IPUV3 */
553
554 /*
555  * Baseboard specific GPIO
556  */
557
558 /* common to add baseboards */
559 static iomux_v3_cfg_t const gw_gpio_pads[] = {
560         /* MSATA_EN */
561         IOMUX_PADS(PAD_SD4_DAT0__GPIO2_IO08 | DIO_PAD_CFG),
562         /* RS232_EN# */
563         IOMUX_PADS(PAD_SD4_DAT3__GPIO2_IO11 | DIO_PAD_CFG),
564 };
565
566 /* prototype */
567 static iomux_v3_cfg_t const gwproto_gpio_pads[] = {
568         /* PANLEDG# */
569         IOMUX_PADS(PAD_KEY_COL0__GPIO4_IO06 | DIO_PAD_CFG),
570         /* PANLEDR# */
571         IOMUX_PADS(PAD_KEY_ROW0__GPIO4_IO07 | DIO_PAD_CFG),
572         /* LOCLED# */
573         IOMUX_PADS(PAD_KEY_ROW4__GPIO4_IO15 | DIO_PAD_CFG),
574         /* RS485_EN */
575         IOMUX_PADS(PAD_SD3_DAT4__GPIO7_IO01 | DIO_PAD_CFG),
576         /* IOEXP_PWREN# */
577         IOMUX_PADS(PAD_EIM_A19__GPIO2_IO19 | DIO_PAD_CFG),
578         /* IOEXP_IRQ# */
579         IOMUX_PADS(PAD_EIM_A20__GPIO2_IO18 | MUX_PAD_CTRL(IRQ_PAD_CTRL)),
580         /* VID_EN */
581         IOMUX_PADS(PAD_EIM_D31__GPIO3_IO31 | DIO_PAD_CFG),
582         /* DIOI2C_DIS# */
583         IOMUX_PADS(PAD_GPIO_19__GPIO4_IO05 | DIO_PAD_CFG),
584         /* PCICK_SSON */
585         IOMUX_PADS(PAD_SD1_CLK__GPIO1_IO20 | DIO_PAD_CFG),
586         /* PCI_RST# */
587         IOMUX_PADS(PAD_ENET_TXD1__GPIO1_IO29 | DIO_PAD_CFG),
588 };
589
590 static iomux_v3_cfg_t const gw51xx_gpio_pads[] = {
591         /* PANLEDG# */
592         IOMUX_PADS(PAD_KEY_COL0__GPIO4_IO06 | DIO_PAD_CFG),
593         /* PANLEDR# */
594         IOMUX_PADS(PAD_KEY_ROW0__GPIO4_IO07 | DIO_PAD_CFG),
595         /* IOEXP_PWREN# */
596         IOMUX_PADS(PAD_EIM_A19__GPIO2_IO19 | DIO_PAD_CFG),
597         /* IOEXP_IRQ# */
598         IOMUX_PADS(PAD_EIM_A20__GPIO2_IO18 | MUX_PAD_CTRL(IRQ_PAD_CTRL)),
599
600         /* GPS_SHDN */
601         IOMUX_PADS(PAD_GPIO_2__GPIO1_IO02 | DIO_PAD_CFG),
602         /* VID_PWR */
603         IOMUX_PADS(PAD_CSI0_DATA_EN__GPIO5_IO20 | DIO_PAD_CFG),
604         /* PCI_RST# */
605         IOMUX_PADS(PAD_GPIO_0__GPIO1_IO00 | DIO_PAD_CFG),
606         /* PCIESKT_WDIS# */
607         IOMUX_PADS(PAD_GPIO_17__GPIO7_IO12 | DIO_PAD_CFG),
608 };
609
610 static iomux_v3_cfg_t const gw52xx_gpio_pads[] = {
611         /* PANLEDG# */
612         IOMUX_PADS(PAD_KEY_COL0__GPIO4_IO06 | DIO_PAD_CFG),
613         /* PANLEDR# */
614         IOMUX_PADS(PAD_KEY_ROW0__GPIO4_IO07 | DIO_PAD_CFG),
615         /* IOEXP_PWREN# */
616         IOMUX_PADS(PAD_EIM_A19__GPIO2_IO19 | DIO_PAD_CFG),
617         /* IOEXP_IRQ# */
618         IOMUX_PADS(PAD_EIM_A20__GPIO2_IO18 | MUX_PAD_CTRL(IRQ_PAD_CTRL)),
619
620         /* MX6_LOCLED# */
621         IOMUX_PADS(PAD_KEY_ROW4__GPIO4_IO15 | DIO_PAD_CFG),
622         /* GPS_SHDN */
623         IOMUX_PADS(PAD_ENET_RXD0__GPIO1_IO27 | DIO_PAD_CFG),
624         /* USBOTG_SEL */
625         IOMUX_PADS(PAD_GPIO_2__GPIO1_IO02 | DIO_PAD_CFG),
626         /* VID_PWR */
627         IOMUX_PADS(PAD_EIM_D31__GPIO3_IO31 | DIO_PAD_CFG),
628         /* PCI_RST# */
629         IOMUX_PADS(PAD_ENET_TXD1__GPIO1_IO29 | DIO_PAD_CFG),
630         /* PCIESKT_WDIS# */
631         IOMUX_PADS(PAD_GPIO_17__GPIO7_IO12 | DIO_PAD_CFG),
632 };
633
634 static iomux_v3_cfg_t const gw53xx_gpio_pads[] = {
635         /* PANLEDG# */
636         IOMUX_PADS(PAD_KEY_COL0__GPIO4_IO06 | DIO_PAD_CFG),
637         /* PANLEDR# */
638         IOMUX_PADS(PAD_KEY_ROW0__GPIO4_IO07 | DIO_PAD_CFG),
639         /* MX6_LOCLED# */
640         IOMUX_PADS(PAD_KEY_ROW4__GPIO4_IO15 | DIO_PAD_CFG),
641         /* IOEXP_PWREN# */
642         IOMUX_PADS(PAD_EIM_A19__GPIO2_IO19 | DIO_PAD_CFG),
643         /* IOEXP_IRQ# */
644         IOMUX_PADS(PAD_EIM_A20__GPIO2_IO18 | MUX_PAD_CTRL(IRQ_PAD_CTRL)),
645         /* DIOI2C_DIS# */
646         IOMUX_PADS(PAD_GPIO_19__GPIO4_IO05 | DIO_PAD_CFG),
647         /* GPS_SHDN */
648         IOMUX_PADS(PAD_ENET_RXD0__GPIO1_IO27 | DIO_PAD_CFG),
649         /* VID_EN */
650         IOMUX_PADS(PAD_EIM_D31__GPIO3_IO31 | DIO_PAD_CFG),
651         /* PCI_RST# */
652         IOMUX_PADS(PAD_ENET_TXD1__GPIO1_IO29 | DIO_PAD_CFG),
653         /* PCIESKT_WDIS# */
654         IOMUX_PADS(PAD_GPIO_17__GPIO7_IO12 | DIO_PAD_CFG),
655 };
656
657 static iomux_v3_cfg_t const gw54xx_gpio_pads[] = {
658         /* PANLEDG# */
659         IOMUX_PADS(PAD_KEY_COL0__GPIO4_IO06 | DIO_PAD_CFG),
660         /* PANLEDR# */
661         IOMUX_PADS(PAD_KEY_COL2__GPIO4_IO10 | DIO_PAD_CFG),
662         /* MX6_LOCLED# */
663         IOMUX_PADS(PAD_KEY_ROW4__GPIO4_IO15 | DIO_PAD_CFG),
664         /* MIPI_DIO */
665         IOMUX_PADS(PAD_SD1_DAT3__GPIO1_IO21 | DIO_PAD_CFG),
666         /* RS485_EN */
667         IOMUX_PADS(PAD_EIM_D24__GPIO3_IO24 | DIO_PAD_CFG),
668         /* IOEXP_PWREN# */
669         IOMUX_PADS(PAD_KEY_ROW0__GPIO4_IO07 | DIO_PAD_CFG),
670         /* IOEXP_IRQ# */
671         IOMUX_PADS(PAD_KEY_ROW1__GPIO4_IO09 | MUX_PAD_CTRL(IRQ_PAD_CTRL)),
672         /* DIOI2C_DIS# */
673         IOMUX_PADS(PAD_GPIO_19__GPIO4_IO05 | DIO_PAD_CFG),
674         /* PCI_RST# */
675         IOMUX_PADS(PAD_ENET_TXD1__GPIO1_IO29 | DIO_PAD_CFG),
676         /* VID_EN */
677         IOMUX_PADS(PAD_EIM_D31__GPIO3_IO31 | DIO_PAD_CFG),
678         /* PCIESKT_WDIS# */
679         IOMUX_PADS(PAD_DISP0_DAT23__GPIO5_IO17 | DIO_PAD_CFG),
680 };
681
682 static iomux_v3_cfg_t const gw551x_gpio_pads[] = {
683         /* PANLED# */
684         IOMUX_PADS(PAD_KEY_ROW0__GPIO4_IO07 | DIO_PAD_CFG),
685         /* PCI_RST# */
686         IOMUX_PADS(PAD_GPIO_0__GPIO1_IO00 | DIO_PAD_CFG),
687         /* PCIESKT_WDIS# */
688         IOMUX_PADS(PAD_GPIO_17__GPIO7_IO12 | DIO_PAD_CFG),
689 };
690
691 static iomux_v3_cfg_t const gw552x_gpio_pads[] = {
692         /* PANLEDG# */
693         IOMUX_PADS(PAD_KEY_COL0__GPIO4_IO06 | DIO_PAD_CFG),
694         /* PANLEDR# */
695         IOMUX_PADS(PAD_KEY_ROW0__GPIO4_IO07 | DIO_PAD_CFG),
696         /* MX6_LOCLED# */
697         IOMUX_PADS(PAD_KEY_ROW4__GPIO4_IO15 | DIO_PAD_CFG),
698         /* PCI_RST# */
699         IOMUX_PADS(PAD_ENET_TXD1__GPIO1_IO29 | DIO_PAD_CFG),
700         /* MX6_DIO[4:9] */
701         IOMUX_PADS(PAD_CSI0_PIXCLK__GPIO5_IO18 | DIO_PAD_CFG),
702         IOMUX_PADS(PAD_CSI0_DATA_EN__GPIO5_IO20 | DIO_PAD_CFG),
703         IOMUX_PADS(PAD_CSI0_VSYNC__GPIO5_IO21 | DIO_PAD_CFG),
704         IOMUX_PADS(PAD_CSI0_DAT4__GPIO5_IO22 | DIO_PAD_CFG),
705         IOMUX_PADS(PAD_CSI0_DAT5__GPIO5_IO23 | DIO_PAD_CFG),
706         IOMUX_PADS(PAD_CSI0_DAT7__GPIO5_IO25 | DIO_PAD_CFG),
707         /* PCIEGBE1_OFF# */
708         IOMUX_PADS(PAD_GPIO_1__GPIO1_IO01 | DIO_PAD_CFG),
709         /* PCIEGBE2_OFF# */
710         IOMUX_PADS(PAD_GPIO_2__GPIO1_IO02 | DIO_PAD_CFG),
711         /* PCIESKT_WDIS# */
712         IOMUX_PADS(PAD_GPIO_17__GPIO7_IO12 | DIO_PAD_CFG),
713 };
714
715 /*
716  * each baseboard has 4 user configurable Digital IO lines which can
717  * be pinmuxed as a GPIO or in some cases a PWM
718  */
719 struct dio_cfg {
720         iomux_v3_cfg_t gpio_padmux[2];
721         unsigned gpio_param;
722         iomux_v3_cfg_t pwm_padmux[2];
723         unsigned pwm_param;
724 };
725
726 struct ventana {
727         /* pinmux */
728         iomux_v3_cfg_t const *gpio_pads;
729         int num_pads;
730         /* DIO pinmux/val */
731         struct dio_cfg dio_cfg[4];
732         int num_gpios;
733         /* various gpios (0 if non-existent) */
734         int leds[3];
735         int pcie_rst;
736         int mezz_pwren;
737         int mezz_irq;
738         int rs485en;
739         int gps_shdn;
740         int vidin_en;
741         int dioi2c_en;
742         int pcie_sson;
743         int usb_sel;
744         int wdis;
745 };
746
747 static struct ventana gpio_cfg[] = {
748         /* GW5400proto */
749         {
750                 .gpio_pads = gw54xx_gpio_pads,
751                 .num_pads = ARRAY_SIZE(gw54xx_gpio_pads)/2,
752                 .dio_cfg = {
753                         {
754                                 { IOMUX_PADS(PAD_GPIO_9__GPIO1_IO09) },
755                                 IMX_GPIO_NR(1, 9),
756                                 { IOMUX_PADS(PAD_GPIO_9__PWM1_OUT) },
757                                 1
758                         },
759                         {
760                                 { IOMUX_PADS(PAD_SD1_DAT2__GPIO1_IO19) },
761                                 IMX_GPIO_NR(1, 19),
762                                 { IOMUX_PADS(PAD_SD1_DAT2__PWM2_OUT) },
763                                 2
764                         },
765                         {
766                                 { IOMUX_PADS(PAD_SD4_DAT1__GPIO2_IO09) },
767                                 IMX_GPIO_NR(2, 9),
768                                 { IOMUX_PADS(PAD_SD4_DAT1__PWM3_OUT) },
769                                 3
770                         },
771                         {
772                                 { IOMUX_PADS(PAD_SD4_DAT2__GPIO2_IO10) },
773                                 IMX_GPIO_NR(2, 10),
774                                 { IOMUX_PADS(PAD_SD4_DAT2__PWM4_OUT) },
775                                 4
776                         },
777                 },
778                 .num_gpios = 4,
779                 .leds = {
780                         IMX_GPIO_NR(4, 6),
781                         IMX_GPIO_NR(4, 10),
782                         IMX_GPIO_NR(4, 15),
783                 },
784                 .pcie_rst = IMX_GPIO_NR(1, 29),
785                 .mezz_pwren = IMX_GPIO_NR(4, 7),
786                 .mezz_irq = IMX_GPIO_NR(4, 9),
787                 .rs485en = IMX_GPIO_NR(3, 24),
788                 .dioi2c_en = IMX_GPIO_NR(4,  5),
789                 .pcie_sson = IMX_GPIO_NR(1, 20),
790         },
791
792         /* GW51xx */
793         {
794                 .gpio_pads = gw51xx_gpio_pads,
795                 .num_pads = ARRAY_SIZE(gw51xx_gpio_pads)/2,
796                 .dio_cfg = {
797                         {
798                                 { IOMUX_PADS(PAD_SD1_DAT0__GPIO1_IO16) },
799                                 IMX_GPIO_NR(1, 16),
800                                 { 0, 0 },
801                                 0
802                         },
803                         {
804                                 { IOMUX_PADS(PAD_SD1_DAT2__GPIO1_IO19) },
805                                 IMX_GPIO_NR(1, 19),
806                                 { IOMUX_PADS(PAD_SD1_DAT2__PWM2_OUT) },
807                                 2
808                         },
809                         {
810                                 { IOMUX_PADS(PAD_SD1_DAT1__GPIO1_IO17) },
811                                 IMX_GPIO_NR(1, 17),
812                                 { IOMUX_PADS(PAD_SD1_DAT1__PWM3_OUT) },
813                                 3
814                         },
815                         {
816                                 { IOMUX_PADS(PAD_SD1_CMD__GPIO1_IO18) },
817                                 IMX_GPIO_NR(1, 18),
818                                 { IOMUX_PADS(PAD_SD1_CMD__PWM4_OUT) },
819                                 4
820                         },
821                 },
822                 .num_gpios = 4,
823                 .leds = {
824                         IMX_GPIO_NR(4, 6),
825                         IMX_GPIO_NR(4, 10),
826                 },
827                 .pcie_rst = IMX_GPIO_NR(1, 0),
828                 .mezz_pwren = IMX_GPIO_NR(2, 19),
829                 .mezz_irq = IMX_GPIO_NR(2, 18),
830                 .gps_shdn = IMX_GPIO_NR(1, 2),
831                 .vidin_en = IMX_GPIO_NR(5, 20),
832                 .wdis = IMX_GPIO_NR(7, 12),
833         },
834
835         /* GW52xx */
836         {
837                 .gpio_pads = gw52xx_gpio_pads,
838                 .num_pads = ARRAY_SIZE(gw52xx_gpio_pads)/2,
839                 .dio_cfg = {
840                         {
841                                 { IOMUX_PADS(PAD_SD1_DAT0__GPIO1_IO16) },
842                                 IMX_GPIO_NR(1, 16),
843                                 { 0, 0 },
844                                 0
845                         },
846                         {
847                                 { IOMUX_PADS(PAD_SD1_DAT2__GPIO1_IO19) },
848                                 IMX_GPIO_NR(1, 19),
849                                 { IOMUX_PADS(PAD_SD1_DAT2__PWM2_OUT) },
850                                 2
851                         },
852                         {
853                                 { IOMUX_PADS(PAD_SD1_DAT1__GPIO1_IO17) },
854                                 IMX_GPIO_NR(1, 17),
855                                 { IOMUX_PADS(PAD_SD1_DAT1__PWM3_OUT) },
856                                 3
857                         },
858                         {
859                                 { IOMUX_PADS(PAD_SD1_CLK__GPIO1_IO20) },
860                                 IMX_GPIO_NR(1, 20),
861                                 { 0, 0 },
862                                 0
863                         },
864                 },
865                 .num_gpios = 4,
866                 .leds = {
867                         IMX_GPIO_NR(4, 6),
868                         IMX_GPIO_NR(4, 7),
869                         IMX_GPIO_NR(4, 15),
870                 },
871                 .pcie_rst = IMX_GPIO_NR(1, 29),
872                 .mezz_pwren = IMX_GPIO_NR(2, 19),
873                 .mezz_irq = IMX_GPIO_NR(2, 18),
874                 .gps_shdn = IMX_GPIO_NR(1, 27),
875                 .vidin_en = IMX_GPIO_NR(3, 31),
876                 .usb_sel = IMX_GPIO_NR(1, 2),
877                 .wdis = IMX_GPIO_NR(7, 12),
878         },
879
880         /* GW53xx */
881         {
882                 .gpio_pads = gw53xx_gpio_pads,
883                 .num_pads = ARRAY_SIZE(gw53xx_gpio_pads)/2,
884                 .dio_cfg = {
885                         {
886                                 { IOMUX_PADS(PAD_SD1_DAT0__GPIO1_IO16) },
887                                 IMX_GPIO_NR(1, 16),
888                                 { 0, 0 },
889                                 0
890                         },
891                         {
892                                 { IOMUX_PADS(PAD_SD1_DAT2__GPIO1_IO19) },
893                                 IMX_GPIO_NR(1, 19),
894                                 { IOMUX_PADS(PAD_SD1_DAT2__PWM2_OUT) },
895                                 2
896                         },
897                         {
898                                 { IOMUX_PADS(PAD_SD1_DAT1__GPIO1_IO17) },
899                                 IMX_GPIO_NR(1, 17),
900                                 { IOMUX_PADS(PAD_SD1_DAT1__PWM3_OUT) },
901                                 3
902                         },
903                         {
904                                 {IOMUX_PADS(PAD_SD1_CLK__GPIO1_IO20) },
905                                 IMX_GPIO_NR(1, 20),
906                                 { 0, 0 },
907                                 0
908                         },
909                 },
910                 .num_gpios = 4,
911                 .leds = {
912                         IMX_GPIO_NR(4, 6),
913                         IMX_GPIO_NR(4, 7),
914                         IMX_GPIO_NR(4, 15),
915                 },
916                 .pcie_rst = IMX_GPIO_NR(1, 29),
917                 .mezz_pwren = IMX_GPIO_NR(2, 19),
918                 .mezz_irq = IMX_GPIO_NR(2, 18),
919                 .gps_shdn = IMX_GPIO_NR(1, 27),
920                 .vidin_en = IMX_GPIO_NR(3, 31),
921                 .wdis = IMX_GPIO_NR(7, 12),
922         },
923
924         /* GW54xx */
925         {
926                 .gpio_pads = gw54xx_gpio_pads,
927                 .num_pads = ARRAY_SIZE(gw54xx_gpio_pads)/2,
928                 .dio_cfg = {
929                         {
930                                 { IOMUX_PADS(PAD_GPIO_9__GPIO1_IO09) },
931                                 IMX_GPIO_NR(1, 9),
932                                 { IOMUX_PADS(PAD_GPIO_9__PWM1_OUT) },
933                                 1
934                         },
935                         {
936                                 { IOMUX_PADS(PAD_SD1_DAT2__GPIO1_IO19) },
937                                 IMX_GPIO_NR(1, 19),
938                                 { IOMUX_PADS(PAD_SD1_DAT2__PWM2_OUT) },
939                                 2
940                         },
941                         {
942                                 { IOMUX_PADS(PAD_SD4_DAT1__GPIO2_IO09) },
943                                 IMX_GPIO_NR(2, 9),
944                                 { IOMUX_PADS(PAD_SD4_DAT1__PWM3_OUT) },
945                                 3
946                         },
947                         {
948                                 { IOMUX_PADS(PAD_SD4_DAT2__GPIO2_IO10) },
949                                 IMX_GPIO_NR(2, 10),
950                                 { IOMUX_PADS(PAD_SD4_DAT2__PWM4_OUT) },
951                                 4
952                         },
953                 },
954                 .num_gpios = 4,
955                 .leds = {
956                         IMX_GPIO_NR(4, 6),
957                         IMX_GPIO_NR(4, 7),
958                         IMX_GPIO_NR(4, 15),
959                 },
960                 .pcie_rst = IMX_GPIO_NR(1, 29),
961                 .mezz_pwren = IMX_GPIO_NR(2, 19),
962                 .mezz_irq = IMX_GPIO_NR(2, 18),
963                 .rs485en = IMX_GPIO_NR(7, 1),
964                 .vidin_en = IMX_GPIO_NR(3, 31),
965                 .dioi2c_en = IMX_GPIO_NR(4,  5),
966                 .pcie_sson = IMX_GPIO_NR(1, 20),
967                 .wdis = IMX_GPIO_NR(5, 17),
968         },
969
970         /* GW551x */
971         {
972                 .gpio_pads = gw551x_gpio_pads,
973                 .num_pads = ARRAY_SIZE(gw551x_gpio_pads)/2,
974                 .dio_cfg = {
975                         {
976                                 { IOMUX_PADS(PAD_SD1_DAT0__GPIO1_IO16) },
977                                 IMX_GPIO_NR(1, 16),
978                                 { 0, 0 },
979                                 0
980                         },
981                         {
982                                 { IOMUX_PADS(PAD_SD1_DAT2__GPIO1_IO19) },
983                                 IMX_GPIO_NR(1, 19),
984                                 { IOMUX_PADS(PAD_SD1_DAT2__PWM2_OUT) },
985                                 2
986                         },
987                         {
988                                 { IOMUX_PADS(PAD_SD1_DAT1__GPIO1_IO17) },
989                                 IMX_GPIO_NR(1, 17),
990                                 { IOMUX_PADS(PAD_SD1_DAT1__PWM3_OUT) },
991                                 3
992                         },
993                         {
994                                 { IOMUX_PADS(PAD_SD1_CMD__GPIO1_IO18) },
995                                 IMX_GPIO_NR(1, 18),
996                                 { IOMUX_PADS(PAD_SD1_CMD__PWM4_OUT) },
997                                 4
998                         },
999                 },
1000                 .num_gpios = 2,
1001                 .leds = {
1002                         IMX_GPIO_NR(4, 7),
1003                 },
1004                 .pcie_rst = IMX_GPIO_NR(1, 0),
1005                 .wdis = IMX_GPIO_NR(7, 12),
1006         },
1007
1008         /* GW552x */
1009         {
1010                 .gpio_pads = gw552x_gpio_pads,
1011                 .num_pads = ARRAY_SIZE(gw552x_gpio_pads)/2,
1012                 .dio_cfg = {
1013                         {
1014                                 { IOMUX_PADS(PAD_SD1_DAT2__GPIO1_IO19) },
1015                                 IMX_GPIO_NR(1, 19),
1016                                 { IOMUX_PADS(PAD_SD1_DAT2__PWM2_OUT) },
1017                                 2
1018                         },
1019                         {
1020                                 { IOMUX_PADS(PAD_SD1_DAT1__GPIO1_IO17) },
1021                                 IMX_GPIO_NR(1, 17),
1022                                 { IOMUX_PADS(PAD_SD1_DAT1__PWM3_OUT) },
1023                                 3
1024                         },
1025                 },
1026                 .num_gpios = 4,
1027                 .leds = {
1028                         IMX_GPIO_NR(4, 6),
1029                         IMX_GPIO_NR(4, 7),
1030                         IMX_GPIO_NR(4, 15),
1031                 },
1032                 .pcie_rst = IMX_GPIO_NR(1, 29),
1033                 .wdis = IMX_GPIO_NR(7, 12),
1034         },
1035 };
1036
1037 /* setup board specific PMIC */
1038 int power_init_board(void)
1039 {
1040         struct pmic *p;
1041         u32 reg;
1042
1043         /* configure PFUZE100 PMIC */
1044         if (board_type == GW54xx || board_type == GW54proto) {
1045                 power_pfuze100_init(CONFIG_I2C_PMIC);
1046                 p = pmic_get("PFUZE100");
1047                 if (p && !pmic_probe(p)) {
1048                         pmic_reg_read(p, PFUZE100_DEVICEID, &reg);
1049                         printf("PMIC:  PFUZE100 ID=0x%02x\n", reg);
1050
1051                         /* Set VGEN1 to 1.5V and enable */
1052                         pmic_reg_read(p, PFUZE100_VGEN1VOL, &reg);
1053                         reg &= ~(LDO_VOL_MASK);
1054                         reg |= (LDOA_1_50V | LDO_EN);
1055                         pmic_reg_write(p, PFUZE100_VGEN1VOL, reg);
1056
1057                         /* Set SWBST to 5.0V and enable */
1058                         pmic_reg_read(p, PFUZE100_SWBSTCON1, &reg);
1059                         reg &= ~(SWBST_MODE_MASK | SWBST_VOL_MASK);
1060                         reg |= (SWBST_5_00V | SWBST_MODE_AUTO);
1061                         pmic_reg_write(p, PFUZE100_SWBSTCON1, reg);
1062                 }
1063         }
1064
1065         /* configure LTC3676 PMIC */
1066         else {
1067                 power_ltc3676_init(CONFIG_I2C_PMIC);
1068                 p = pmic_get("LTC3676_PMIC");
1069                 if (p && !pmic_probe(p)) {
1070                         puts("PMIC:  LTC3676\n");
1071                         /*
1072                          * set board-specific scalar for max CPU frequency
1073                          * per CPU based on the LDO enabled Operating Ranges
1074                          * defined in the respective IMX6DQ and IMX6SDL
1075                          * datasheets. The voltage resulting from the R1/R2
1076                          * feedback inputs on Ventana is 1308mV. Note that this
1077                          * is a bit shy of the Vmin of 1350mV in the datasheet
1078                          * for LDO enabled mode but is as high as we can go.
1079                          *
1080                          * We will rely on an OS kernel driver to properly
1081                          * regulate these per CPU operating point and use LDO
1082                          * bypass mode when using the higher frequency
1083                          * operating points to compensate as LDO bypass mode
1084                          * allows the rails be 125mV lower.
1085                          */
1086                         /* mask PGOOD during SW1 transition */
1087                         pmic_reg_write(p, LTC3676_DVB1B,
1088                                        0x1f | LTC3676_PGOOD_MASK);
1089                         /* set SW1 (VDD_SOC) */
1090                         pmic_reg_write(p, LTC3676_DVB1A, 0x1f);
1091
1092                         /* mask PGOOD during SW3 transition */
1093                         pmic_reg_write(p, LTC3676_DVB3B,
1094                                        0x1f | LTC3676_PGOOD_MASK);
1095                         /* set SW3 (VDD_ARM) */
1096                         pmic_reg_write(p, LTC3676_DVB3A, 0x1f);
1097                 }
1098         }
1099
1100         return 0;
1101 }
1102
1103 /* setup GPIO pinmux and default configuration per baseboard */
1104 static void setup_board_gpio(int board)
1105 {
1106         struct ventana_board_info *info = &ventana_info;
1107         const char *s;
1108         char arg[10];
1109         size_t len;
1110         int i;
1111         int quiet = simple_strtol(getenv("quiet"), NULL, 10);
1112
1113         if (board >= GW_UNKNOWN)
1114                 return;
1115
1116         /* RS232_EN# */
1117         gpio_direction_output(GP_RS232_EN, (hwconfig("rs232")) ? 0 : 1);
1118
1119         /* MSATA Enable */
1120         if (is_cpu_type(MXC_CPU_MX6Q) &&
1121             test_bit(EECONFIG_SATA, info->config)) {
1122                 gpio_direction_output(GP_MSATA_SEL,
1123                                       (hwconfig("msata")) ?  1 : 0);
1124         } else {
1125                 gpio_direction_output(GP_MSATA_SEL, 0);
1126         }
1127
1128 #if !defined(CONFIG_CMD_PCI)
1129         /* assert PCI_RST# (released by OS when clock is valid) */
1130         gpio_direction_output(gpio_cfg[board].pcie_rst, 0);
1131 #endif
1132
1133         /* turn off (active-high) user LED's */
1134         for (i = 0; i < ARRAY_SIZE(gpio_cfg[board].leds); i++) {
1135                 if (gpio_cfg[board].leds[i])
1136                         gpio_direction_output(gpio_cfg[board].leds[i], 1);
1137         }
1138
1139         /* Expansion Mezzanine IO */
1140         if (gpio_cfg[board].mezz_pwren)
1141                 gpio_direction_output(gpio_cfg[board].mezz_pwren, 0);
1142         if (gpio_cfg[board].mezz_irq)
1143                 gpio_direction_input(gpio_cfg[board].mezz_irq);
1144
1145         /* RS485 Transmit Enable */
1146         if (gpio_cfg[board].rs485en)
1147                 gpio_direction_output(gpio_cfg[board].rs485en, 0);
1148
1149         /* GPS_SHDN */
1150         if (gpio_cfg[board].gps_shdn)
1151                 gpio_direction_output(gpio_cfg[board].gps_shdn, 1);
1152
1153         /* Analog video codec power enable */
1154         if (gpio_cfg[board].vidin_en)
1155                 gpio_direction_output(gpio_cfg[board].vidin_en, 1);
1156
1157         /* DIOI2C_DIS# */
1158         if (gpio_cfg[board].dioi2c_en)
1159                 gpio_direction_output(gpio_cfg[board].dioi2c_en, 0);
1160
1161         /* PCICK_SSON: disable spread-spectrum clock */
1162         if (gpio_cfg[board].pcie_sson)
1163                 gpio_direction_output(gpio_cfg[board].pcie_sson, 0);
1164
1165         /* USBOTG Select (PCISKT or FrontPanel) */
1166         if (gpio_cfg[board].usb_sel)
1167                 gpio_direction_output(gpio_cfg[board].usb_sel,
1168                                       (hwconfig("usb_pcisel")) ? 1 : 0);
1169
1170
1171         /* PCISKT_WDIS# (Wireless disable GPIO to miniPCIe sockets) */
1172         if (gpio_cfg[board].wdis)
1173                 gpio_direction_output(gpio_cfg[board].wdis, 1);
1174
1175         /*
1176          * Configure DIO pinmux/padctl registers
1177          * see IMX6DQRM/IMX6SDLRM IOMUXC_SW_PAD_CTL_PAD_* register definitions
1178          */
1179         for (i = 0; i < 4; i++) {
1180                 struct dio_cfg *cfg = &gpio_cfg[board].dio_cfg[i];
1181                 iomux_v3_cfg_t ctrl = DIO_PAD_CFG;
1182                 unsigned cputype = is_cpu_type(MXC_CPU_MX6Q) ? 0 : 1;
1183
1184                 if (!cfg->gpio_padmux[0] && !cfg->gpio_padmux[1])
1185                         continue;
1186                 sprintf(arg, "dio%d", i);
1187                 if (!hwconfig(arg))
1188                         continue;
1189                 s = hwconfig_subarg(arg, "padctrl", &len);
1190                 if (s) {
1191                         ctrl = MUX_PAD_CTRL(simple_strtoul(s, NULL, 16)
1192                                             & 0x1ffff) | MUX_MODE_SION;
1193                 }
1194                 if (hwconfig_subarg_cmp(arg, "mode", "gpio")) {
1195                         if (!quiet) {
1196                                 printf("DIO%d:  GPIO%d_IO%02d (gpio-%d)\n", i,
1197                                        (cfg->gpio_param/32)+1,
1198                                        cfg->gpio_param%32,
1199                                        cfg->gpio_param);
1200                         }
1201                         imx_iomux_v3_setup_pad(cfg->gpio_padmux[cputype] |
1202                                                ctrl);
1203                         gpio_direction_input(cfg->gpio_param);
1204                 } else if (hwconfig_subarg_cmp("dio2", "mode", "pwm") &&
1205                            cfg->pwm_padmux) {
1206                         if (!quiet)
1207                                 printf("DIO%d:  pwm%d\n", i, cfg->pwm_param);
1208                         imx_iomux_v3_setup_pad(cfg->pwm_padmux[cputype] |
1209                                                MUX_PAD_CTRL(ctrl));
1210                 }
1211         }
1212
1213         if (!quiet) {
1214                 if (is_cpu_type(MXC_CPU_MX6Q) &&
1215                     (test_bit(EECONFIG_SATA, info->config))) {
1216                         printf("MSATA: %s\n", (hwconfig("msata") ?
1217                                "enabled" : "disabled"));
1218                 }
1219                 printf("RS232: %s\n", (hwconfig("rs232")) ?
1220                        "enabled" : "disabled");
1221         }
1222 }
1223
1224 #if defined(CONFIG_CMD_PCI)
1225 int imx6_pcie_toggle_reset(void)
1226 {
1227         if (board_type < GW_UNKNOWN) {
1228                 uint pin = gpio_cfg[board_type].pcie_rst;
1229                 gpio_direction_output(pin, 0);
1230                 mdelay(50);
1231                 gpio_direction_output(pin, 1);
1232         }
1233         return 0;
1234 }
1235
1236 /*
1237  * Most Ventana boards have a PLX PEX860x PCIe switch onboard and use its
1238  * GPIO's as PERST# signals for its downstream ports - configure the GPIO's
1239  * properly and assert reset for 100ms.
1240  */
1241 void board_pci_fixup_dev(struct pci_controller *hose, pci_dev_t dev,
1242                          unsigned short vendor, unsigned short device,
1243                          unsigned short class)
1244 {
1245         u32 dw;
1246
1247         debug("%s: %02d:%02d.%02d: %04x:%04x\n", __func__,
1248               PCI_BUS(dev), PCI_DEV(dev), PCI_FUNC(dev), vendor, device);
1249         if (vendor == PCI_VENDOR_ID_PLX &&
1250             (device & 0xfff0) == 0x8600 &&
1251             PCI_DEV(dev) == 0 && PCI_FUNC(dev) == 0) {
1252                 debug("configuring PLX 860X downstream PERST#\n");
1253                 pci_hose_read_config_dword(hose, dev, 0x62c, &dw);
1254                 dw |= 0xaaa8; /* GPIO1-7 outputs */
1255                 pci_hose_write_config_dword(hose, dev, 0x62c, dw);
1256
1257                 pci_hose_read_config_dword(hose, dev, 0x644, &dw);
1258                 dw |= 0xfe;   /* GPIO1-7 output high */
1259                 pci_hose_write_config_dword(hose, dev, 0x644, dw);
1260
1261                 mdelay(100);
1262         }
1263 }
1264 #endif /* CONFIG_CMD_PCI */
1265
1266 #ifdef CONFIG_SERIAL_TAG
1267 /*
1268  * called when setting up ATAGS before booting kernel
1269  * populate serialnum from the following (in order of priority):
1270  *   serial# env var
1271  *   eeprom
1272  */
1273 void get_board_serial(struct tag_serialnr *serialnr)
1274 {
1275         char *serial = getenv("serial#");
1276
1277         if (serial) {
1278                 serialnr->high = 0;
1279                 serialnr->low = simple_strtoul(serial, NULL, 10);
1280         } else if (ventana_info.model[0]) {
1281                 serialnr->high = 0;
1282                 serialnr->low = ventana_info.serial;
1283         } else {
1284                 serialnr->high = 0;
1285                 serialnr->low = 0;
1286         }
1287 }
1288 #endif
1289
1290 /*
1291  * Board Support
1292  */
1293
1294 /* called from SPL board_init_f() */
1295 int board_early_init_f(void)
1296 {
1297         setup_iomux_uart();
1298         gpio_direction_output(GP_USB_OTG_PWR, 0); /* OTG power off */
1299
1300 #if defined(CONFIG_VIDEO_IPUV3)
1301         setup_display();
1302 #endif
1303         return 0;
1304 }
1305
1306 int dram_init(void)
1307 {
1308         gd->ram_size = imx_ddr_size();
1309         return 0;
1310 }
1311
1312 int board_init(void)
1313 {
1314         struct iomuxc *const iomuxc_regs = (struct iomuxc *)IOMUXC_BASE_ADDR;
1315
1316         clrsetbits_le32(&iomuxc_regs->gpr[1],
1317                         IOMUXC_GPR1_OTG_ID_MASK,
1318                         IOMUXC_GPR1_OTG_ID_GPIO1);
1319
1320         /* address of linux boot parameters */
1321         gd->bd->bi_boot_params = PHYS_SDRAM + 0x100;
1322
1323 #ifdef CONFIG_CMD_NAND
1324         setup_gpmi_nand();
1325 #endif
1326 #ifdef CONFIG_MXC_SPI
1327         setup_spi();
1328 #endif
1329         if (is_cpu_type(MXC_CPU_MX6Q)) {
1330                 setup_i2c(0, CONFIG_SYS_I2C_SPEED, 0x7f, &mx6q_i2c_pad_info0);
1331                 setup_i2c(1, CONFIG_SYS_I2C_SPEED, 0x7f, &mx6q_i2c_pad_info1);
1332                 setup_i2c(2, CONFIG_SYS_I2C_SPEED, 0x7f, &mx6q_i2c_pad_info2);
1333         } else {
1334                 setup_i2c(0, CONFIG_SYS_I2C_SPEED, 0x7f, &mx6dl_i2c_pad_info0);
1335                 setup_i2c(1, CONFIG_SYS_I2C_SPEED, 0x7f, &mx6dl_i2c_pad_info1);
1336                 setup_i2c(2, CONFIG_SYS_I2C_SPEED, 0x7f, &mx6dl_i2c_pad_info2);
1337         }
1338
1339 #ifdef CONFIG_CMD_SATA
1340         setup_sata();
1341 #endif
1342         /* read Gateworks EEPROM into global struct (used later) */
1343         board_type = read_eeprom(CONFIG_I2C_GSC, &ventana_info);
1344
1345         /* board-specifc GPIO iomux */
1346         SETUP_IOMUX_PADS(gw_gpio_pads);
1347         if (board_type < GW_UNKNOWN) {
1348                 iomux_v3_cfg_t const *p = gpio_cfg[board_type].gpio_pads;
1349                 int count = gpio_cfg[board_type].num_pads;
1350
1351                 imx_iomux_v3_setup_multiple_pads(p, count);
1352         }
1353
1354         return 0;
1355 }
1356
1357 #if defined(CONFIG_DISPLAY_BOARDINFO_LATE)
1358 /*
1359  * called during late init (after relocation and after board_init())
1360  * by virtue of CONFIG_DISPLAY_BOARDINFO_LATE as we needed i2c initialized and
1361  * EEPROM read.
1362  */
1363 int checkboard(void)
1364 {
1365         struct ventana_board_info *info = &ventana_info;
1366         unsigned char buf[4];
1367         const char *p;
1368         int quiet; /* Quiet or minimal output mode */
1369
1370         quiet = 0;
1371         p = getenv("quiet");
1372         if (p)
1373                 quiet = simple_strtol(p, NULL, 10);
1374         else
1375                 setenv("quiet", "0");
1376
1377         puts("\nGateworks Corporation Copyright 2014\n");
1378         if (info->model[0]) {
1379                 printf("Model: %s\n", info->model);
1380                 printf("MFGDate: %02x-%02x-%02x%02x\n",
1381                        info->mfgdate[0], info->mfgdate[1],
1382                        info->mfgdate[2], info->mfgdate[3]);
1383                 printf("Serial:%d\n", info->serial);
1384         } else {
1385                 puts("Invalid EEPROM - board will not function fully\n");
1386         }
1387         if (quiet)
1388                 return 0;
1389
1390         /* Display GSC firmware revision/CRC/status */
1391         i2c_set_bus_num(CONFIG_I2C_GSC);
1392         if (!gsc_i2c_read(GSC_SC_ADDR, GSC_SC_FWVER, 1, buf, 1)) {
1393                 printf("GSC:   v%d", buf[0]);
1394                 if (!gsc_i2c_read(GSC_SC_ADDR, GSC_SC_STATUS, 1, buf, 4)) {
1395                         printf(" 0x%04x", buf[2] | buf[3]<<8); /* CRC */
1396                         printf(" 0x%02x", buf[0]); /* irq status */
1397                 }
1398                 puts("\n");
1399         }
1400         /* Display RTC */
1401         if (!gsc_i2c_read(GSC_RTC_ADDR, 0x00, 1, buf, 4)) {
1402                 printf("RTC:   %d\n",
1403                        buf[0] | buf[1]<<8 | buf[2]<<16 | buf[3]<<24);
1404         }
1405
1406         return 0;
1407 }
1408 #endif
1409
1410 #ifdef CONFIG_CMD_BMODE
1411 /*
1412  * BOOT_CFG1, BOOT_CFG2, BOOT_CFG3, BOOT_CFG4
1413  * see Table 8-11 and Table 5-9
1414  *  BOOT_CFG1[7] = 1 (boot from NAND)
1415  *  BOOT_CFG1[5] = 0 - raw NAND
1416  *  BOOT_CFG1[4] = 0 - default pad settings
1417  *  BOOT_CFG1[3:2] = 00 - devices = 1
1418  *  BOOT_CFG1[1:0] = 00 - Row Address Cycles = 3
1419  *  BOOT_CFG2[4:3] = 00 - Boot Search Count = 2
1420  *  BOOT_CFG2[2:1] = 01 - Pages In Block = 64
1421  *  BOOT_CFG2[0] = 0 - Reset time 12ms
1422  */
1423 static const struct boot_mode board_boot_modes[] = {
1424         /* NAND: 64pages per block, 3 row addr cycles, 2 copies of FCB/DBBT */
1425         { "nand", MAKE_CFGVAL(0x80, 0x02, 0x00, 0x00) },
1426         { NULL, 0 },
1427 };
1428 #endif
1429
1430 /* late init */
1431 int misc_init_r(void)
1432 {
1433         struct ventana_board_info *info = &ventana_info;
1434         unsigned char reg;
1435
1436         /* set env vars based on EEPROM data */
1437         if (ventana_info.model[0]) {
1438                 char str[16], fdt[36];
1439                 char *p;
1440                 const char *cputype = "";
1441                 int i;
1442
1443                 /*
1444                  * FDT name will be prefixed with CPU type.  Three versions
1445                  * will be created each increasingly generic and bootloader
1446                  * env scripts will try loading each from most specific to
1447                  * least.
1448                  */
1449                 if (is_cpu_type(MXC_CPU_MX6Q) ||
1450                     is_cpu_type(MXC_CPU_MX6D))
1451                         cputype = "imx6q";
1452                 else if (is_cpu_type(MXC_CPU_MX6DL) ||
1453                          is_cpu_type(MXC_CPU_MX6SOLO))
1454                         cputype = "imx6dl";
1455                 setenv("soctype", cputype);
1456                 if (8 << (ventana_info.nand_flash_size-1) >= 2048)
1457                         setenv("flash_layout", "large");
1458                 else
1459                         setenv("flash_layout", "normal");
1460                 memset(str, 0, sizeof(str));
1461                 for (i = 0; i < (sizeof(str)-1) && info->model[i]; i++)
1462                         str[i] = tolower(info->model[i]);
1463                 if (!getenv("model"))
1464                         setenv("model", str);
1465                 if (!getenv("fdt_file")) {
1466                         sprintf(fdt, "%s-%s.dtb", cputype, str);
1467                         setenv("fdt_file", fdt);
1468                 }
1469                 p = strchr(str, '-');
1470                 if (p) {
1471                         *p++ = 0;
1472
1473                         setenv("model_base", str);
1474                         if (!getenv("fdt_file1")) {
1475                                 sprintf(fdt, "%s-%s.dtb", cputype, str);
1476                                 setenv("fdt_file1", fdt);
1477                         }
1478                         if (board_type != GW551x && board_type != GW552x)
1479                                 str[4] = 'x';
1480                         str[5] = 'x';
1481                         str[6] = 0;
1482                         if (!getenv("fdt_file2")) {
1483                                 sprintf(fdt, "%s-%s.dtb", cputype, str);
1484                                 setenv("fdt_file2", fdt);
1485                         }
1486                 }
1487
1488                 /* initialize env from EEPROM */
1489                 if (test_bit(EECONFIG_ETH0, info->config) &&
1490                     !getenv("ethaddr")) {
1491                         eth_setenv_enetaddr("ethaddr", info->mac0);
1492                 }
1493                 if (test_bit(EECONFIG_ETH1, info->config) &&
1494                     !getenv("eth1addr")) {
1495                         eth_setenv_enetaddr("eth1addr", info->mac1);
1496                 }
1497
1498                 /* board serial-number */
1499                 sprintf(str, "%6d", info->serial);
1500                 setenv("serial#", str);
1501
1502                 /* memory MB */
1503                 sprintf(str, "%d", (int) (gd->ram_size >> 20));
1504                 setenv("mem_mb", str);
1505         }
1506
1507
1508         /* setup baseboard specific GPIO pinmux and config */
1509         setup_board_gpio(board_type);
1510
1511 #ifdef CONFIG_CMD_BMODE
1512         add_board_boot_modes(board_boot_modes);
1513 #endif
1514
1515         /*
1516          *  The Gateworks System Controller implements a boot
1517          *  watchdog (always enabled) as a workaround for IMX6 boot related
1518          *  errata such as:
1519          *    ERR005768 - no fix scheduled
1520          *    ERR006282 - fixed in silicon r1.2
1521          *    ERR007117 - fixed in silicon r1.3
1522          *    ERR007220 - fixed in silicon r1.3
1523          *    ERR007926 - no fix scheduled
1524          *  see http://cache.freescale.com/files/32bit/doc/errata/IMX6DQCE.pdf
1525          *
1526          * Disable the boot watchdog and display/clear the timeout flag if set
1527          */
1528         i2c_set_bus_num(CONFIG_I2C_GSC);
1529         if (!gsc_i2c_read(GSC_SC_ADDR, GSC_SC_CTRL1, 1, &reg, 1)) {
1530                 reg |= (1 << GSC_SC_CTRL1_WDDIS);
1531                 if (gsc_i2c_write(GSC_SC_ADDR, GSC_SC_CTRL1, 1, &reg, 1))
1532                         puts("Error: could not disable GSC Watchdog\n");
1533         } else {
1534                 puts("Error: could not disable GSC Watchdog\n");
1535         }
1536         if (!gsc_i2c_read(GSC_SC_ADDR, GSC_SC_STATUS, 1, &reg, 1)) {
1537                 if (reg & (1 << GSC_SC_IRQ_WATCHDOG)) { /* watchdog timeout */
1538                         puts("GSC boot watchdog timeout detected\n");
1539                         reg &= ~(1 << GSC_SC_IRQ_WATCHDOG); /* clear flag */
1540                         gsc_i2c_write(GSC_SC_ADDR, GSC_SC_STATUS, 1, &reg, 1);
1541                 }
1542         }
1543
1544         return 0;
1545 }
1546
1547 #if defined(CONFIG_OF_LIBFDT) && defined(CONFIG_OF_BOARD_SETUP)
1548
1549 /*
1550  * called prior to booting kernel or by 'fdt boardsetup' command
1551  *
1552  * unless 'fdt_noauto' env var is set we will update the following in the DTB:
1553  *  - mtd partitions based on mtdparts/mtdids env
1554  *  - system-serial (board serial num from EEPROM)
1555  *  - board (full model from EEPROM)
1556  *  - peripherals removed from DTB if not loaded on board (per EEPROM config)
1557  */
1558 int ft_board_setup(void *blob, bd_t *bd)
1559 {
1560         struct ventana_board_info *info = &ventana_info;
1561         struct ventana_eeprom_config *cfg;
1562         struct node_info nodes[] = {
1563                 { "sst,w25q256",          MTD_DEV_TYPE_NOR, },  /* SPI flash */
1564                 { "fsl,imx6q-gpmi-nand",  MTD_DEV_TYPE_NAND, }, /* NAND flash */
1565         };
1566         const char *model = getenv("model");
1567         int i;
1568         char rev = 0;
1569
1570         /* determine board revision */
1571         for (i = sizeof(ventana_info.model) - 1; i > 0; i--) {
1572                 if (ventana_info.model[i] >= 'A') {
1573                         rev = ventana_info.model[i];
1574                         break;
1575                 }
1576         }
1577
1578         if (getenv("fdt_noauto")) {
1579                 puts("   Skiping ft_board_setup (fdt_noauto defined)\n");
1580                 return 0;
1581         }
1582
1583         /* Update partition nodes using info from mtdparts env var */
1584         puts("   Updating MTD partitions...\n");
1585         fdt_fixup_mtdparts(blob, nodes, ARRAY_SIZE(nodes));
1586
1587         if (!model) {
1588                 puts("invalid board info: Leaving FDT fully enabled\n");
1589                 return 0;
1590         }
1591         printf("   Adjusting FDT per EEPROM for %s...\n", model);
1592
1593         /* board serial number */
1594         fdt_setprop(blob, 0, "system-serial", getenv("serial#"),
1595                     strlen(getenv("serial#")) + 1);
1596
1597         /* board (model contains model from device-tree) */
1598         fdt_setprop(blob, 0, "board", info->model,
1599                     strlen((const char *)info->model) + 1);
1600
1601         /*
1602          * disable wdog1/wdog2 nodes for GW51xx below revC to work around
1603          * errata causing wdog timer to be unreliable.
1604          */
1605         if (board_type == GW51xx && rev >= 'A' && rev < 'C') {
1606                 i = fdt_path_offset(blob,
1607                                     "/soc/aips-bus@02000000/wdog@020bc000");
1608                 if (i)
1609                         fdt_status_disabled(blob, i);
1610         }
1611
1612         /*
1613          * Peripheral Config:
1614          *  remove nodes by alias path if EEPROM config tells us the
1615          *  peripheral is not loaded on the board.
1616          */
1617         if (getenv("fdt_noconfig")) {
1618                 puts("   Skiping periperhal config (fdt_noconfig defined)\n");
1619                 return 0;
1620         }
1621         cfg = econfig;
1622         while (cfg->name) {
1623                 if (!test_bit(cfg->bit, info->config)) {
1624                         fdt_del_node_and_alias(blob, cfg->dtalias ?
1625                                                cfg->dtalias : cfg->name);
1626                 }
1627                 cfg++;
1628         }
1629
1630         return 0;
1631 }
1632 #endif /* defined(CONFIG_OF_FLAT_TREE) && defined(CONFIG_OF_BOARD_SETUP) */
1633