102b5d2edSShaohui Xie /*
202b5d2edSShaohui Xie  * Copyright 2015 Freescale Semiconductor, Inc.
302b5d2edSShaohui Xie  *
402b5d2edSShaohui Xie  * SPDX-License-Identifier:	GPL-2.0+
502b5d2edSShaohui Xie  */
602b5d2edSShaohui Xie 
702b5d2edSShaohui Xie #include <common.h>
802b5d2edSShaohui Xie #include <i2c.h>
902b5d2edSShaohui Xie #include <fdt_support.h>
1002b5d2edSShaohui Xie #include <asm/io.h>
1102b5d2edSShaohui Xie #include <asm/arch/clock.h>
1202b5d2edSShaohui Xie #include <asm/arch/fsl_serdes.h>
1302b5d2edSShaohui Xie #include <asm/arch/fdt.h>
14*4961eafcSYork Sun #include <asm/arch/mmu.h>
1502b5d2edSShaohui Xie #include <asm/arch/soc.h>
1602b5d2edSShaohui Xie #include <ahci.h>
1702b5d2edSShaohui Xie #include <hwconfig.h>
1802b5d2edSShaohui Xie #include <mmc.h>
1902b5d2edSShaohui Xie #include <scsi.h>
2002b5d2edSShaohui Xie #include <fm_eth.h>
2102b5d2edSShaohui Xie #include <fsl_esdhc.h>
2202b5d2edSShaohui Xie #include <fsl_ifc.h>
2302b5d2edSShaohui Xie #include <spl.h>
2402b5d2edSShaohui Xie 
2502b5d2edSShaohui Xie #include "../common/qixis.h"
2602b5d2edSShaohui Xie #include "ls1043aqds_qixis.h"
2702b5d2edSShaohui Xie 
2802b5d2edSShaohui Xie DECLARE_GLOBAL_DATA_PTR;
2902b5d2edSShaohui Xie 
3002b5d2edSShaohui Xie enum {
3102b5d2edSShaohui Xie 	MUX_TYPE_GPIO,
3202b5d2edSShaohui Xie };
3302b5d2edSShaohui Xie 
3402b5d2edSShaohui Xie /* LS1043AQDS serdes mux */
3502b5d2edSShaohui Xie #define CFG_SD_MUX1_SLOT2	0x0 /* SLOT2 TX/RX0 */
3602b5d2edSShaohui Xie #define CFG_SD_MUX1_SLOT1	0x1 /* SLOT1 TX/RX1 */
3702b5d2edSShaohui Xie #define CFG_SD_MUX2_SLOT3	0x0 /* SLOT3 TX/RX0 */
3802b5d2edSShaohui Xie #define CFG_SD_MUX2_SLOT1	0x1 /* SLOT1 TX/RX2 */
3902b5d2edSShaohui Xie #define CFG_SD_MUX3_SLOT4	0x0 /* SLOT4 TX/RX0 */
4002b5d2edSShaohui Xie #define CFG_SD_MUX3_MUX4	0x1 /* MUX4 */
4102b5d2edSShaohui Xie #define CFG_SD_MUX4_SLOT3	0x0 /* SLOT3 TX/RX1 */
4202b5d2edSShaohui Xie #define CFG_SD_MUX4_SLOT1	0x1 /* SLOT1 TX/RX3 */
438c35cc3bSShaohui Xie #define CFG_UART_MUX_MASK	0x6
448c35cc3bSShaohui Xie #define CFG_UART_MUX_SHIFT	1
458c35cc3bSShaohui Xie #define CFG_LPUART_EN		0x1
4602b5d2edSShaohui Xie 
4702b5d2edSShaohui Xie int checkboard(void)
4802b5d2edSShaohui Xie {
4902b5d2edSShaohui Xie 	char buf[64];
50a2fd238eSQianyu Gong #ifndef CONFIG_SD_BOOT
5102b5d2edSShaohui Xie 	u8 sw;
5202b5d2edSShaohui Xie #endif
5302b5d2edSShaohui Xie 
5402b5d2edSShaohui Xie 	puts("Board: LS1043AQDS, boot from ");
5502b5d2edSShaohui Xie 
5602b5d2edSShaohui Xie #ifdef CONFIG_SD_BOOT
5702b5d2edSShaohui Xie 	puts("SD\n");
5802b5d2edSShaohui Xie #else
5902b5d2edSShaohui Xie 	sw = QIXIS_READ(brdcfg[0]);
6002b5d2edSShaohui Xie 	sw = (sw & QIXIS_LBMAP_MASK) >> QIXIS_LBMAP_SHIFT;
6102b5d2edSShaohui Xie 
6202b5d2edSShaohui Xie 	if (sw < 0x8)
6302b5d2edSShaohui Xie 		printf("vBank: %d\n", sw);
6402b5d2edSShaohui Xie 	else if (sw == 0x8)
6502b5d2edSShaohui Xie 		puts("PromJet\n");
6602b5d2edSShaohui Xie 	else if (sw == 0x9)
6702b5d2edSShaohui Xie 		puts("NAND\n");
68a2fd238eSQianyu Gong 	else if (sw == 0xF)
69a2fd238eSQianyu Gong 		printf("QSPI\n");
7002b5d2edSShaohui Xie 	else
7102b5d2edSShaohui Xie 		printf("invalid setting of SW%u\n", QIXIS_LBMAP_SWITCH);
7202b5d2edSShaohui Xie #endif
7302b5d2edSShaohui Xie 
7402b5d2edSShaohui Xie 	printf("Sys ID: 0x%02x, Sys Ver: 0x%02x\n",
7502b5d2edSShaohui Xie 	       QIXIS_READ(id), QIXIS_READ(arch));
7602b5d2edSShaohui Xie 
7702b5d2edSShaohui Xie 	printf("FPGA:  v%d (%s), build %d\n",
7802b5d2edSShaohui Xie 	       (int)QIXIS_READ(scver), qixis_read_tag(buf),
7902b5d2edSShaohui Xie 	       (int)qixis_read_minor());
8002b5d2edSShaohui Xie 
8102b5d2edSShaohui Xie 	return 0;
8202b5d2edSShaohui Xie }
8302b5d2edSShaohui Xie 
8402b5d2edSShaohui Xie bool if_board_diff_clk(void)
8502b5d2edSShaohui Xie {
8602b5d2edSShaohui Xie 	u8 diff_conf = QIXIS_READ(brdcfg[11]);
8702b5d2edSShaohui Xie 
8802b5d2edSShaohui Xie 	return diff_conf & 0x40;
8902b5d2edSShaohui Xie }
9002b5d2edSShaohui Xie 
9102b5d2edSShaohui Xie unsigned long get_board_sys_clk(void)
9202b5d2edSShaohui Xie {
9302b5d2edSShaohui Xie 	u8 sysclk_conf = QIXIS_READ(brdcfg[1]);
9402b5d2edSShaohui Xie 
9502b5d2edSShaohui Xie 	switch (sysclk_conf & 0x0f) {
9602b5d2edSShaohui Xie 	case QIXIS_SYSCLK_64:
9702b5d2edSShaohui Xie 		return 64000000;
9802b5d2edSShaohui Xie 	case QIXIS_SYSCLK_83:
9902b5d2edSShaohui Xie 		return 83333333;
10002b5d2edSShaohui Xie 	case QIXIS_SYSCLK_100:
10102b5d2edSShaohui Xie 		return 100000000;
10202b5d2edSShaohui Xie 	case QIXIS_SYSCLK_125:
10302b5d2edSShaohui Xie 		return 125000000;
10402b5d2edSShaohui Xie 	case QIXIS_SYSCLK_133:
10502b5d2edSShaohui Xie 		return 133333333;
10602b5d2edSShaohui Xie 	case QIXIS_SYSCLK_150:
10702b5d2edSShaohui Xie 		return 150000000;
10802b5d2edSShaohui Xie 	case QIXIS_SYSCLK_160:
10902b5d2edSShaohui Xie 		return 160000000;
11002b5d2edSShaohui Xie 	case QIXIS_SYSCLK_166:
11102b5d2edSShaohui Xie 		return 166666666;
11202b5d2edSShaohui Xie 	}
11302b5d2edSShaohui Xie 
11402b5d2edSShaohui Xie 	return 66666666;
11502b5d2edSShaohui Xie }
11602b5d2edSShaohui Xie 
11702b5d2edSShaohui Xie unsigned long get_board_ddr_clk(void)
11802b5d2edSShaohui Xie {
11902b5d2edSShaohui Xie 	u8 ddrclk_conf = QIXIS_READ(brdcfg[1]);
12002b5d2edSShaohui Xie 
12102b5d2edSShaohui Xie 	if (if_board_diff_clk())
12202b5d2edSShaohui Xie 		return get_board_sys_clk();
12302b5d2edSShaohui Xie 	switch ((ddrclk_conf & 0x30) >> 4) {
12402b5d2edSShaohui Xie 	case QIXIS_DDRCLK_100:
12502b5d2edSShaohui Xie 		return 100000000;
12602b5d2edSShaohui Xie 	case QIXIS_DDRCLK_125:
12702b5d2edSShaohui Xie 		return 125000000;
12802b5d2edSShaohui Xie 	case QIXIS_DDRCLK_133:
12902b5d2edSShaohui Xie 		return 133333333;
13002b5d2edSShaohui Xie 	}
13102b5d2edSShaohui Xie 
13202b5d2edSShaohui Xie 	return 66666666;
13302b5d2edSShaohui Xie }
13402b5d2edSShaohui Xie 
13502b5d2edSShaohui Xie int select_i2c_ch_pca9547(u8 ch)
13602b5d2edSShaohui Xie {
13702b5d2edSShaohui Xie 	int ret;
13802b5d2edSShaohui Xie 
13902b5d2edSShaohui Xie 	ret = i2c_write(I2C_MUX_PCA_ADDR_PRI, 0, 1, &ch, 1);
14002b5d2edSShaohui Xie 	if (ret) {
14102b5d2edSShaohui Xie 		puts("PCA: failed to select proper channel\n");
14202b5d2edSShaohui Xie 		return ret;
14302b5d2edSShaohui Xie 	}
14402b5d2edSShaohui Xie 
14502b5d2edSShaohui Xie 	return 0;
14602b5d2edSShaohui Xie }
14702b5d2edSShaohui Xie 
14802b5d2edSShaohui Xie int dram_init(void)
14902b5d2edSShaohui Xie {
15002b5d2edSShaohui Xie 	/*
15102b5d2edSShaohui Xie 	 * When resuming from deep sleep, the I2C channel may not be
15202b5d2edSShaohui Xie 	 * in the default channel. So, switch to the default channel
15302b5d2edSShaohui Xie 	 * before accessing DDR SPD.
15402b5d2edSShaohui Xie 	 */
15502b5d2edSShaohui Xie 	select_i2c_ch_pca9547(I2C_MUX_CH_DEFAULT);
15602b5d2edSShaohui Xie 	gd->ram_size = initdram(0);
157*4961eafcSYork Sun #if !defined(CONFIG_SPL) || defined(CONFIG_SPL_BUILD)
158*4961eafcSYork Sun 	/* This will break-before-make MMU for DDR */
159*4961eafcSYork Sun 	update_early_mmu_table();
160*4961eafcSYork Sun #endif
16102b5d2edSShaohui Xie 
16202b5d2edSShaohui Xie 	return 0;
16302b5d2edSShaohui Xie }
16402b5d2edSShaohui Xie 
16502b5d2edSShaohui Xie int i2c_multiplexer_select_vid_channel(u8 channel)
16602b5d2edSShaohui Xie {
16702b5d2edSShaohui Xie 	return select_i2c_ch_pca9547(channel);
16802b5d2edSShaohui Xie }
16902b5d2edSShaohui Xie 
17002b5d2edSShaohui Xie void board_retimer_init(void)
17102b5d2edSShaohui Xie {
17202b5d2edSShaohui Xie 	u8 reg;
17302b5d2edSShaohui Xie 
17402b5d2edSShaohui Xie 	/* Retimer is connected to I2C1_CH7_CH5 */
175ec44289dSWenbin Song 	select_i2c_ch_pca9547(I2C_MUX_CH7);
17602b5d2edSShaohui Xie 	reg = I2C_MUX_CH5;
17702b5d2edSShaohui Xie 	i2c_write(I2C_MUX_PCA_ADDR_SEC, 0, 1, &reg, 1);
17802b5d2edSShaohui Xie 
17902b5d2edSShaohui Xie 	/* Access to Control/Shared register */
18002b5d2edSShaohui Xie 	reg = 0x0;
18102b5d2edSShaohui Xie 	i2c_write(I2C_RETIMER_ADDR, 0xff, 1, &reg, 1);
18202b5d2edSShaohui Xie 
18302b5d2edSShaohui Xie 	/* Read device revision and ID */
18402b5d2edSShaohui Xie 	i2c_read(I2C_RETIMER_ADDR, 1, 1, &reg, 1);
18502b5d2edSShaohui Xie 	debug("Retimer version id = 0x%x\n", reg);
18602b5d2edSShaohui Xie 
18702b5d2edSShaohui Xie 	/* Enable Broadcast. All writes target all channel register sets */
18802b5d2edSShaohui Xie 	reg = 0x0c;
18902b5d2edSShaohui Xie 	i2c_write(I2C_RETIMER_ADDR, 0xff, 1, &reg, 1);
19002b5d2edSShaohui Xie 
19102b5d2edSShaohui Xie 	/* Reset Channel Registers */
19202b5d2edSShaohui Xie 	i2c_read(I2C_RETIMER_ADDR, 0, 1, &reg, 1);
19302b5d2edSShaohui Xie 	reg |= 0x4;
19402b5d2edSShaohui Xie 	i2c_write(I2C_RETIMER_ADDR, 0, 1, &reg, 1);
19502b5d2edSShaohui Xie 
19602b5d2edSShaohui Xie 	/* Enable override divider select and Enable Override Output Mux */
19702b5d2edSShaohui Xie 	i2c_read(I2C_RETIMER_ADDR, 9, 1, &reg, 1);
19802b5d2edSShaohui Xie 	reg |= 0x24;
19902b5d2edSShaohui Xie 	i2c_write(I2C_RETIMER_ADDR, 9, 1, &reg, 1);
20002b5d2edSShaohui Xie 
20102b5d2edSShaohui Xie 	/* Select VCO Divider to full rate (000) */
20202b5d2edSShaohui Xie 	i2c_read(I2C_RETIMER_ADDR, 0x18, 1, &reg, 1);
20302b5d2edSShaohui Xie 	reg &= 0x8f;
20402b5d2edSShaohui Xie 	i2c_write(I2C_RETIMER_ADDR, 0x18, 1, &reg, 1);
20502b5d2edSShaohui Xie 
20602b5d2edSShaohui Xie 	/* Selects active PFD MUX Input as Re-timed Data (001) */
20702b5d2edSShaohui Xie 	i2c_read(I2C_RETIMER_ADDR, 0x1e, 1, &reg, 1);
20802b5d2edSShaohui Xie 	reg &= 0x3f;
20902b5d2edSShaohui Xie 	reg |= 0x20;
21002b5d2edSShaohui Xie 	i2c_write(I2C_RETIMER_ADDR, 0x1e, 1, &reg, 1);
21102b5d2edSShaohui Xie 
21202b5d2edSShaohui Xie 	/* Set data rate as 10.3125 Gbps */
21302b5d2edSShaohui Xie 	reg = 0x0;
21402b5d2edSShaohui Xie 	i2c_write(I2C_RETIMER_ADDR, 0x60, 1, &reg, 1);
21502b5d2edSShaohui Xie 	reg = 0xb2;
21602b5d2edSShaohui Xie 	i2c_write(I2C_RETIMER_ADDR, 0x61, 1, &reg, 1);
21702b5d2edSShaohui Xie 	reg = 0x90;
21802b5d2edSShaohui Xie 	i2c_write(I2C_RETIMER_ADDR, 0x62, 1, &reg, 1);
21902b5d2edSShaohui Xie 	reg = 0xb3;
22002b5d2edSShaohui Xie 	i2c_write(I2C_RETIMER_ADDR, 0x63, 1, &reg, 1);
22102b5d2edSShaohui Xie 	reg = 0xcd;
22202b5d2edSShaohui Xie 	i2c_write(I2C_RETIMER_ADDR, 0x64, 1, &reg, 1);
223ec44289dSWenbin Song 
224ec44289dSWenbin Song 	/* Return the default channel */
225ec44289dSWenbin Song 	select_i2c_ch_pca9547(I2C_MUX_CH_DEFAULT);
22602b5d2edSShaohui Xie }
22702b5d2edSShaohui Xie 
22802b5d2edSShaohui Xie int board_early_init_f(void)
22902b5d2edSShaohui Xie {
2305a7c40beSQianyu Gong #ifdef CONFIG_HAS_FSL_XHCI_USB
2315a7c40beSQianyu Gong 	struct ccsr_scfg *scfg = (struct ccsr_scfg *)CONFIG_SYS_FSL_SCFG_ADDR;
2325a7c40beSQianyu Gong 	u32 usb_pwrfault;
2335a7c40beSQianyu Gong #endif
2348c35cc3bSShaohui Xie #ifdef CONFIG_LPUART
2358c35cc3bSShaohui Xie 	u8 uart;
2368c35cc3bSShaohui Xie #endif
237581ff00bSQianyu Gong 
238581ff00bSQianyu Gong #ifdef CONFIG_SYS_I2C_EARLY_INIT
239581ff00bSQianyu Gong 	i2c_early_init_f();
240581ff00bSQianyu Gong #endif
24102b5d2edSShaohui Xie 	fsl_lsch2_early_init_f();
2425a7c40beSQianyu Gong 
2435a7c40beSQianyu Gong #ifdef CONFIG_HAS_FSL_XHCI_USB
2445a7c40beSQianyu Gong 	out_be32(&scfg->rcwpmuxcr0, 0x3333);
2455a7c40beSQianyu Gong 	out_be32(&scfg->usbdrvvbus_selcr, SCFG_USBDRVVBUS_SELCR_USB1);
2465a7c40beSQianyu Gong 	usb_pwrfault =
2473e06ba8fSShaohui Xie 		(SCFG_USBPWRFAULT_DEDICATED << SCFG_USBPWRFAULT_USB3_SHIFT) |
2483e06ba8fSShaohui Xie 		(SCFG_USBPWRFAULT_DEDICATED << SCFG_USBPWRFAULT_USB2_SHIFT) |
2495a7c40beSQianyu Gong 		(SCFG_USBPWRFAULT_SHARED << SCFG_USBPWRFAULT_USB1_SHIFT);
2505a7c40beSQianyu Gong 	out_be32(&scfg->usbpwrfault_selcr, usb_pwrfault);
2515a7c40beSQianyu Gong #endif
2525a7c40beSQianyu Gong 
2538c35cc3bSShaohui Xie #ifdef CONFIG_LPUART
2548c35cc3bSShaohui Xie 	/* We use lpuart0 as system console */
2558c35cc3bSShaohui Xie 	uart = QIXIS_READ(brdcfg[14]);
2568c35cc3bSShaohui Xie 	uart &= ~CFG_UART_MUX_MASK;
2578c35cc3bSShaohui Xie 	uart |= CFG_LPUART_EN << CFG_UART_MUX_SHIFT;
2588c35cc3bSShaohui Xie 	QIXIS_WRITE(brdcfg[14], uart);
2598c35cc3bSShaohui Xie #endif
26002b5d2edSShaohui Xie 
26102b5d2edSShaohui Xie 	return 0;
26202b5d2edSShaohui Xie }
26302b5d2edSShaohui Xie 
26402b5d2edSShaohui Xie #ifdef CONFIG_FSL_DEEP_SLEEP
26502b5d2edSShaohui Xie /* determine if it is a warm boot */
26602b5d2edSShaohui Xie bool is_warm_boot(void)
26702b5d2edSShaohui Xie {
26802b5d2edSShaohui Xie #define DCFG_CCSR_CRSTSR_WDRFR	(1 << 3)
26902b5d2edSShaohui Xie 	struct ccsr_gur __iomem *gur = (void *)CONFIG_SYS_FSL_GUTS_ADDR;
27002b5d2edSShaohui Xie 
27102b5d2edSShaohui Xie 	if (in_be32(&gur->crstsr) & DCFG_CCSR_CRSTSR_WDRFR)
27202b5d2edSShaohui Xie 		return 1;
27302b5d2edSShaohui Xie 
27402b5d2edSShaohui Xie 	return 0;
27502b5d2edSShaohui Xie }
27602b5d2edSShaohui Xie #endif
27702b5d2edSShaohui Xie 
27802b5d2edSShaohui Xie int config_board_mux(int ctrl_type)
27902b5d2edSShaohui Xie {
28002b5d2edSShaohui Xie 	u8 reg14;
28102b5d2edSShaohui Xie 
28202b5d2edSShaohui Xie 	reg14 = QIXIS_READ(brdcfg[14]);
28302b5d2edSShaohui Xie 
28402b5d2edSShaohui Xie 	switch (ctrl_type) {
28502b5d2edSShaohui Xie 	case MUX_TYPE_GPIO:
28602b5d2edSShaohui Xie 		reg14 = (reg14 & (~0x30)) | 0x20;
28702b5d2edSShaohui Xie 		break;
28802b5d2edSShaohui Xie 	default:
28902b5d2edSShaohui Xie 		puts("Unsupported mux interface type\n");
29002b5d2edSShaohui Xie 		return -1;
29102b5d2edSShaohui Xie 	}
29202b5d2edSShaohui Xie 
29302b5d2edSShaohui Xie 	QIXIS_WRITE(brdcfg[14], reg14);
29402b5d2edSShaohui Xie 
29502b5d2edSShaohui Xie 	return 0;
29602b5d2edSShaohui Xie }
29702b5d2edSShaohui Xie 
29802b5d2edSShaohui Xie int config_serdes_mux(void)
29902b5d2edSShaohui Xie {
30002b5d2edSShaohui Xie 	return 0;
30102b5d2edSShaohui Xie }
30202b5d2edSShaohui Xie 
30302b5d2edSShaohui Xie 
30402b5d2edSShaohui Xie #ifdef CONFIG_MISC_INIT_R
30502b5d2edSShaohui Xie int misc_init_r(void)
30602b5d2edSShaohui Xie {
30702b5d2edSShaohui Xie 	if (hwconfig("gpio"))
30802b5d2edSShaohui Xie 		config_board_mux(MUX_TYPE_GPIO);
30902b5d2edSShaohui Xie 
31002b5d2edSShaohui Xie 	return 0;
31102b5d2edSShaohui Xie }
31202b5d2edSShaohui Xie #endif
31302b5d2edSShaohui Xie 
31402b5d2edSShaohui Xie int board_init(void)
31502b5d2edSShaohui Xie {
316b392a6d4SHou Zhiqiang #ifdef CONFIG_SYS_FSL_ERRATUM_A010315
317b392a6d4SHou Zhiqiang 	erratum_a010315();
318b392a6d4SHou Zhiqiang #endif
319b392a6d4SHou Zhiqiang 
32002b5d2edSShaohui Xie 	select_i2c_ch_pca9547(I2C_MUX_CH_DEFAULT);
32102b5d2edSShaohui Xie 	board_retimer_init();
32202b5d2edSShaohui Xie 
32302b5d2edSShaohui Xie #ifdef CONFIG_SYS_FSL_SERDES
32402b5d2edSShaohui Xie 	config_serdes_mux();
32502b5d2edSShaohui Xie #endif
32602b5d2edSShaohui Xie 
32702b5d2edSShaohui Xie 	return 0;
32802b5d2edSShaohui Xie }
32902b5d2edSShaohui Xie 
33002b5d2edSShaohui Xie #ifdef CONFIG_OF_BOARD_SETUP
33102b5d2edSShaohui Xie int ft_board_setup(void *blob, bd_t *bd)
33202b5d2edSShaohui Xie {
33358e4ad1dSShaohui Xie 	u64 base[CONFIG_NR_DRAM_BANKS];
33458e4ad1dSShaohui Xie 	u64 size[CONFIG_NR_DRAM_BANKS];
3358401c710SQianyu Gong 	u8 reg;
33658e4ad1dSShaohui Xie 
33758e4ad1dSShaohui Xie 	/* fixup DT for the two DDR banks */
33858e4ad1dSShaohui Xie 	base[0] = gd->bd->bi_dram[0].start;
33958e4ad1dSShaohui Xie 	size[0] = gd->bd->bi_dram[0].size;
34058e4ad1dSShaohui Xie 	base[1] = gd->bd->bi_dram[1].start;
34158e4ad1dSShaohui Xie 	size[1] = gd->bd->bi_dram[1].size;
34258e4ad1dSShaohui Xie 
34358e4ad1dSShaohui Xie 	fdt_fixup_memory_banks(blob, base, size, 2);
34402b5d2edSShaohui Xie 	ft_cpu_setup(blob, bd);
34502b5d2edSShaohui Xie 
34602b5d2edSShaohui Xie #ifdef CONFIG_SYS_DPAA_FMAN
34702b5d2edSShaohui Xie 	fdt_fixup_fman_ethernet(blob);
34802b5d2edSShaohui Xie 	fdt_fixup_board_enet(blob);
34902b5d2edSShaohui Xie #endif
3508401c710SQianyu Gong 
3518401c710SQianyu Gong 	reg = QIXIS_READ(brdcfg[0]);
3528401c710SQianyu Gong 	reg = (reg & QIXIS_LBMAP_MASK) >> QIXIS_LBMAP_SHIFT;
3538401c710SQianyu Gong 
3548401c710SQianyu Gong 	/* Disable IFC if QSPI is enabled */
3558401c710SQianyu Gong 	if (reg == 0xF)
3568401c710SQianyu Gong 		do_fixup_by_compat(blob, "fsl,ifc",
3578401c710SQianyu Gong 				   "status", "disabled", 8 + 1, 1);
3588401c710SQianyu Gong 
35902b5d2edSShaohui Xie 	return 0;
36002b5d2edSShaohui Xie }
36102b5d2edSShaohui Xie #endif
36202b5d2edSShaohui Xie 
36302b5d2edSShaohui Xie u8 flash_read8(void *addr)
36402b5d2edSShaohui Xie {
36502b5d2edSShaohui Xie 	return __raw_readb(addr + 1);
36602b5d2edSShaohui Xie }
36702b5d2edSShaohui Xie 
36802b5d2edSShaohui Xie void flash_write16(u16 val, void *addr)
36902b5d2edSShaohui Xie {
37002b5d2edSShaohui Xie 	u16 shftval = (((val >> 8) & 0xff) | ((val << 8) & 0xff00));
37102b5d2edSShaohui Xie 
37202b5d2edSShaohui Xie 	__raw_writew(shftval, addr);
37302b5d2edSShaohui Xie }
37402b5d2edSShaohui Xie 
37502b5d2edSShaohui Xie u16 flash_read16(void *addr)
37602b5d2edSShaohui Xie {
37702b5d2edSShaohui Xie 	u16 val = __raw_readw(addr);
37802b5d2edSShaohui Xie 
37902b5d2edSShaohui Xie 	return (((val) >> 8) & 0x00ff) | (((val) << 8) & 0xff00);
38002b5d2edSShaohui Xie }
381