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> 1402b5d2edSShaohui Xie #include <asm/arch/soc.h> 1502b5d2edSShaohui Xie #include <ahci.h> 1602b5d2edSShaohui Xie #include <hwconfig.h> 1702b5d2edSShaohui Xie #include <mmc.h> 1802b5d2edSShaohui Xie #include <scsi.h> 1902b5d2edSShaohui Xie #include <fm_eth.h> 2002b5d2edSShaohui Xie #include <fsl_esdhc.h> 2102b5d2edSShaohui Xie #include <fsl_ifc.h> 2202b5d2edSShaohui Xie #include <spl.h> 2302b5d2edSShaohui Xie 2402b5d2edSShaohui Xie #include "../common/qixis.h" 2502b5d2edSShaohui Xie #include "ls1043aqds_qixis.h" 2602b5d2edSShaohui Xie 2702b5d2edSShaohui Xie DECLARE_GLOBAL_DATA_PTR; 2802b5d2edSShaohui Xie 2902b5d2edSShaohui Xie enum { 3002b5d2edSShaohui Xie MUX_TYPE_GPIO, 3102b5d2edSShaohui Xie }; 3202b5d2edSShaohui Xie 3302b5d2edSShaohui Xie /* LS1043AQDS serdes mux */ 3402b5d2edSShaohui Xie #define CFG_SD_MUX1_SLOT2 0x0 /* SLOT2 TX/RX0 */ 3502b5d2edSShaohui Xie #define CFG_SD_MUX1_SLOT1 0x1 /* SLOT1 TX/RX1 */ 3602b5d2edSShaohui Xie #define CFG_SD_MUX2_SLOT3 0x0 /* SLOT3 TX/RX0 */ 3702b5d2edSShaohui Xie #define CFG_SD_MUX2_SLOT1 0x1 /* SLOT1 TX/RX2 */ 3802b5d2edSShaohui Xie #define CFG_SD_MUX3_SLOT4 0x0 /* SLOT4 TX/RX0 */ 3902b5d2edSShaohui Xie #define CFG_SD_MUX3_MUX4 0x1 /* MUX4 */ 4002b5d2edSShaohui Xie #define CFG_SD_MUX4_SLOT3 0x0 /* SLOT3 TX/RX1 */ 4102b5d2edSShaohui Xie #define CFG_SD_MUX4_SLOT1 0x1 /* SLOT1 TX/RX3 */ 428c35cc3bSShaohui Xie #define CFG_UART_MUX_MASK 0x6 438c35cc3bSShaohui Xie #define CFG_UART_MUX_SHIFT 1 448c35cc3bSShaohui Xie #define CFG_LPUART_EN 0x1 4502b5d2edSShaohui Xie 4602b5d2edSShaohui Xie int checkboard(void) 4702b5d2edSShaohui Xie { 4802b5d2edSShaohui Xie char buf[64]; 49a2fd238eSQianyu Gong #ifndef CONFIG_SD_BOOT 5002b5d2edSShaohui Xie u8 sw; 5102b5d2edSShaohui Xie #endif 5202b5d2edSShaohui Xie 5302b5d2edSShaohui Xie puts("Board: LS1043AQDS, boot from "); 5402b5d2edSShaohui Xie 5502b5d2edSShaohui Xie #ifdef CONFIG_SD_BOOT 5602b5d2edSShaohui Xie puts("SD\n"); 5702b5d2edSShaohui Xie #else 5802b5d2edSShaohui Xie sw = QIXIS_READ(brdcfg[0]); 5902b5d2edSShaohui Xie sw = (sw & QIXIS_LBMAP_MASK) >> QIXIS_LBMAP_SHIFT; 6002b5d2edSShaohui Xie 6102b5d2edSShaohui Xie if (sw < 0x8) 6202b5d2edSShaohui Xie printf("vBank: %d\n", sw); 6302b5d2edSShaohui Xie else if (sw == 0x8) 6402b5d2edSShaohui Xie puts("PromJet\n"); 6502b5d2edSShaohui Xie else if (sw == 0x9) 6602b5d2edSShaohui Xie puts("NAND\n"); 67a2fd238eSQianyu Gong else if (sw == 0xF) 68a2fd238eSQianyu Gong printf("QSPI\n"); 6902b5d2edSShaohui Xie else 7002b5d2edSShaohui Xie printf("invalid setting of SW%u\n", QIXIS_LBMAP_SWITCH); 7102b5d2edSShaohui Xie #endif 7202b5d2edSShaohui Xie 7302b5d2edSShaohui Xie printf("Sys ID: 0x%02x, Sys Ver: 0x%02x\n", 7402b5d2edSShaohui Xie QIXIS_READ(id), QIXIS_READ(arch)); 7502b5d2edSShaohui Xie 7602b5d2edSShaohui Xie printf("FPGA: v%d (%s), build %d\n", 7702b5d2edSShaohui Xie (int)QIXIS_READ(scver), qixis_read_tag(buf), 7802b5d2edSShaohui Xie (int)qixis_read_minor()); 7902b5d2edSShaohui Xie 8002b5d2edSShaohui Xie return 0; 8102b5d2edSShaohui Xie } 8202b5d2edSShaohui Xie 8302b5d2edSShaohui Xie bool if_board_diff_clk(void) 8402b5d2edSShaohui Xie { 8502b5d2edSShaohui Xie u8 diff_conf = QIXIS_READ(brdcfg[11]); 8602b5d2edSShaohui Xie 8702b5d2edSShaohui Xie return diff_conf & 0x40; 8802b5d2edSShaohui Xie } 8902b5d2edSShaohui Xie 9002b5d2edSShaohui Xie unsigned long get_board_sys_clk(void) 9102b5d2edSShaohui Xie { 9202b5d2edSShaohui Xie u8 sysclk_conf = QIXIS_READ(brdcfg[1]); 9302b5d2edSShaohui Xie 9402b5d2edSShaohui Xie switch (sysclk_conf & 0x0f) { 9502b5d2edSShaohui Xie case QIXIS_SYSCLK_64: 9602b5d2edSShaohui Xie return 64000000; 9702b5d2edSShaohui Xie case QIXIS_SYSCLK_83: 9802b5d2edSShaohui Xie return 83333333; 9902b5d2edSShaohui Xie case QIXIS_SYSCLK_100: 10002b5d2edSShaohui Xie return 100000000; 10102b5d2edSShaohui Xie case QIXIS_SYSCLK_125: 10202b5d2edSShaohui Xie return 125000000; 10302b5d2edSShaohui Xie case QIXIS_SYSCLK_133: 10402b5d2edSShaohui Xie return 133333333; 10502b5d2edSShaohui Xie case QIXIS_SYSCLK_150: 10602b5d2edSShaohui Xie return 150000000; 10702b5d2edSShaohui Xie case QIXIS_SYSCLK_160: 10802b5d2edSShaohui Xie return 160000000; 10902b5d2edSShaohui Xie case QIXIS_SYSCLK_166: 11002b5d2edSShaohui Xie return 166666666; 11102b5d2edSShaohui Xie } 11202b5d2edSShaohui Xie 11302b5d2edSShaohui Xie return 66666666; 11402b5d2edSShaohui Xie } 11502b5d2edSShaohui Xie 11602b5d2edSShaohui Xie unsigned long get_board_ddr_clk(void) 11702b5d2edSShaohui Xie { 11802b5d2edSShaohui Xie u8 ddrclk_conf = QIXIS_READ(brdcfg[1]); 11902b5d2edSShaohui Xie 12002b5d2edSShaohui Xie if (if_board_diff_clk()) 12102b5d2edSShaohui Xie return get_board_sys_clk(); 12202b5d2edSShaohui Xie switch ((ddrclk_conf & 0x30) >> 4) { 12302b5d2edSShaohui Xie case QIXIS_DDRCLK_100: 12402b5d2edSShaohui Xie return 100000000; 12502b5d2edSShaohui Xie case QIXIS_DDRCLK_125: 12602b5d2edSShaohui Xie return 125000000; 12702b5d2edSShaohui Xie case QIXIS_DDRCLK_133: 12802b5d2edSShaohui Xie return 133333333; 12902b5d2edSShaohui Xie } 13002b5d2edSShaohui Xie 13102b5d2edSShaohui Xie return 66666666; 13202b5d2edSShaohui Xie } 13302b5d2edSShaohui Xie 13402b5d2edSShaohui Xie int select_i2c_ch_pca9547(u8 ch) 13502b5d2edSShaohui Xie { 13602b5d2edSShaohui Xie int ret; 13702b5d2edSShaohui Xie 13802b5d2edSShaohui Xie ret = i2c_write(I2C_MUX_PCA_ADDR_PRI, 0, 1, &ch, 1); 13902b5d2edSShaohui Xie if (ret) { 14002b5d2edSShaohui Xie puts("PCA: failed to select proper channel\n"); 14102b5d2edSShaohui Xie return ret; 14202b5d2edSShaohui Xie } 14302b5d2edSShaohui Xie 14402b5d2edSShaohui Xie return 0; 14502b5d2edSShaohui Xie } 14602b5d2edSShaohui Xie 14702b5d2edSShaohui Xie int dram_init(void) 14802b5d2edSShaohui Xie { 14902b5d2edSShaohui Xie /* 15002b5d2edSShaohui Xie * When resuming from deep sleep, the I2C channel may not be 15102b5d2edSShaohui Xie * in the default channel. So, switch to the default channel 15202b5d2edSShaohui Xie * before accessing DDR SPD. 15302b5d2edSShaohui Xie */ 15402b5d2edSShaohui Xie select_i2c_ch_pca9547(I2C_MUX_CH_DEFAULT); 15502b5d2edSShaohui Xie gd->ram_size = initdram(0); 15602b5d2edSShaohui Xie 15702b5d2edSShaohui Xie return 0; 15802b5d2edSShaohui Xie } 15902b5d2edSShaohui Xie 16002b5d2edSShaohui Xie int i2c_multiplexer_select_vid_channel(u8 channel) 16102b5d2edSShaohui Xie { 16202b5d2edSShaohui Xie return select_i2c_ch_pca9547(channel); 16302b5d2edSShaohui Xie } 16402b5d2edSShaohui Xie 16502b5d2edSShaohui Xie void board_retimer_init(void) 16602b5d2edSShaohui Xie { 16702b5d2edSShaohui Xie u8 reg; 16802b5d2edSShaohui Xie 16902b5d2edSShaohui Xie /* Retimer is connected to I2C1_CH7_CH5 */ 170ec44289dSWenbin Song select_i2c_ch_pca9547(I2C_MUX_CH7); 17102b5d2edSShaohui Xie reg = I2C_MUX_CH5; 17202b5d2edSShaohui Xie i2c_write(I2C_MUX_PCA_ADDR_SEC, 0, 1, ®, 1); 17302b5d2edSShaohui Xie 17402b5d2edSShaohui Xie /* Access to Control/Shared register */ 17502b5d2edSShaohui Xie reg = 0x0; 17602b5d2edSShaohui Xie i2c_write(I2C_RETIMER_ADDR, 0xff, 1, ®, 1); 17702b5d2edSShaohui Xie 17802b5d2edSShaohui Xie /* Read device revision and ID */ 17902b5d2edSShaohui Xie i2c_read(I2C_RETIMER_ADDR, 1, 1, ®, 1); 18002b5d2edSShaohui Xie debug("Retimer version id = 0x%x\n", reg); 18102b5d2edSShaohui Xie 18202b5d2edSShaohui Xie /* Enable Broadcast. All writes target all channel register sets */ 18302b5d2edSShaohui Xie reg = 0x0c; 18402b5d2edSShaohui Xie i2c_write(I2C_RETIMER_ADDR, 0xff, 1, ®, 1); 18502b5d2edSShaohui Xie 18602b5d2edSShaohui Xie /* Reset Channel Registers */ 18702b5d2edSShaohui Xie i2c_read(I2C_RETIMER_ADDR, 0, 1, ®, 1); 18802b5d2edSShaohui Xie reg |= 0x4; 18902b5d2edSShaohui Xie i2c_write(I2C_RETIMER_ADDR, 0, 1, ®, 1); 19002b5d2edSShaohui Xie 19102b5d2edSShaohui Xie /* Enable override divider select and Enable Override Output Mux */ 19202b5d2edSShaohui Xie i2c_read(I2C_RETIMER_ADDR, 9, 1, ®, 1); 19302b5d2edSShaohui Xie reg |= 0x24; 19402b5d2edSShaohui Xie i2c_write(I2C_RETIMER_ADDR, 9, 1, ®, 1); 19502b5d2edSShaohui Xie 19602b5d2edSShaohui Xie /* Select VCO Divider to full rate (000) */ 19702b5d2edSShaohui Xie i2c_read(I2C_RETIMER_ADDR, 0x18, 1, ®, 1); 19802b5d2edSShaohui Xie reg &= 0x8f; 19902b5d2edSShaohui Xie i2c_write(I2C_RETIMER_ADDR, 0x18, 1, ®, 1); 20002b5d2edSShaohui Xie 20102b5d2edSShaohui Xie /* Selects active PFD MUX Input as Re-timed Data (001) */ 20202b5d2edSShaohui Xie i2c_read(I2C_RETIMER_ADDR, 0x1e, 1, ®, 1); 20302b5d2edSShaohui Xie reg &= 0x3f; 20402b5d2edSShaohui Xie reg |= 0x20; 20502b5d2edSShaohui Xie i2c_write(I2C_RETIMER_ADDR, 0x1e, 1, ®, 1); 20602b5d2edSShaohui Xie 20702b5d2edSShaohui Xie /* Set data rate as 10.3125 Gbps */ 20802b5d2edSShaohui Xie reg = 0x0; 20902b5d2edSShaohui Xie i2c_write(I2C_RETIMER_ADDR, 0x60, 1, ®, 1); 21002b5d2edSShaohui Xie reg = 0xb2; 21102b5d2edSShaohui Xie i2c_write(I2C_RETIMER_ADDR, 0x61, 1, ®, 1); 21202b5d2edSShaohui Xie reg = 0x90; 21302b5d2edSShaohui Xie i2c_write(I2C_RETIMER_ADDR, 0x62, 1, ®, 1); 21402b5d2edSShaohui Xie reg = 0xb3; 21502b5d2edSShaohui Xie i2c_write(I2C_RETIMER_ADDR, 0x63, 1, ®, 1); 21602b5d2edSShaohui Xie reg = 0xcd; 21702b5d2edSShaohui Xie i2c_write(I2C_RETIMER_ADDR, 0x64, 1, ®, 1); 218ec44289dSWenbin Song 219ec44289dSWenbin Song /* Return the default channel */ 220ec44289dSWenbin Song select_i2c_ch_pca9547(I2C_MUX_CH_DEFAULT); 22102b5d2edSShaohui Xie } 22202b5d2edSShaohui Xie 22302b5d2edSShaohui Xie int board_early_init_f(void) 22402b5d2edSShaohui Xie { 2255a7c40beSQianyu Gong #ifdef CONFIG_HAS_FSL_XHCI_USB 2265a7c40beSQianyu Gong struct ccsr_scfg *scfg = (struct ccsr_scfg *)CONFIG_SYS_FSL_SCFG_ADDR; 2275a7c40beSQianyu Gong u32 usb_pwrfault; 2285a7c40beSQianyu Gong #endif 2298c35cc3bSShaohui Xie #ifdef CONFIG_LPUART 2308c35cc3bSShaohui Xie u8 uart; 2318c35cc3bSShaohui Xie #endif 232581ff00bSQianyu Gong 233581ff00bSQianyu Gong #ifdef CONFIG_SYS_I2C_EARLY_INIT 234581ff00bSQianyu Gong i2c_early_init_f(); 235581ff00bSQianyu Gong #endif 23602b5d2edSShaohui Xie fsl_lsch2_early_init_f(); 2375a7c40beSQianyu Gong 2385a7c40beSQianyu Gong #ifdef CONFIG_HAS_FSL_XHCI_USB 2395a7c40beSQianyu Gong out_be32(&scfg->rcwpmuxcr0, 0x3333); 2405a7c40beSQianyu Gong out_be32(&scfg->usbdrvvbus_selcr, SCFG_USBDRVVBUS_SELCR_USB1); 2415a7c40beSQianyu Gong usb_pwrfault = 2423e06ba8fSShaohui Xie (SCFG_USBPWRFAULT_DEDICATED << SCFG_USBPWRFAULT_USB3_SHIFT) | 2433e06ba8fSShaohui Xie (SCFG_USBPWRFAULT_DEDICATED << SCFG_USBPWRFAULT_USB2_SHIFT) | 2445a7c40beSQianyu Gong (SCFG_USBPWRFAULT_SHARED << SCFG_USBPWRFAULT_USB1_SHIFT); 2455a7c40beSQianyu Gong out_be32(&scfg->usbpwrfault_selcr, usb_pwrfault); 2465a7c40beSQianyu Gong #endif 2475a7c40beSQianyu Gong 2488c35cc3bSShaohui Xie #ifdef CONFIG_LPUART 2498c35cc3bSShaohui Xie /* We use lpuart0 as system console */ 2508c35cc3bSShaohui Xie uart = QIXIS_READ(brdcfg[14]); 2518c35cc3bSShaohui Xie uart &= ~CFG_UART_MUX_MASK; 2528c35cc3bSShaohui Xie uart |= CFG_LPUART_EN << CFG_UART_MUX_SHIFT; 2538c35cc3bSShaohui Xie QIXIS_WRITE(brdcfg[14], uart); 2548c35cc3bSShaohui Xie #endif 25502b5d2edSShaohui Xie 25602b5d2edSShaohui Xie return 0; 25702b5d2edSShaohui Xie } 25802b5d2edSShaohui Xie 25902b5d2edSShaohui Xie #ifdef CONFIG_FSL_DEEP_SLEEP 26002b5d2edSShaohui Xie /* determine if it is a warm boot */ 26102b5d2edSShaohui Xie bool is_warm_boot(void) 26202b5d2edSShaohui Xie { 26302b5d2edSShaohui Xie #define DCFG_CCSR_CRSTSR_WDRFR (1 << 3) 26402b5d2edSShaohui Xie struct ccsr_gur __iomem *gur = (void *)CONFIG_SYS_FSL_GUTS_ADDR; 26502b5d2edSShaohui Xie 26602b5d2edSShaohui Xie if (in_be32(&gur->crstsr) & DCFG_CCSR_CRSTSR_WDRFR) 26702b5d2edSShaohui Xie return 1; 26802b5d2edSShaohui Xie 26902b5d2edSShaohui Xie return 0; 27002b5d2edSShaohui Xie } 27102b5d2edSShaohui Xie #endif 27202b5d2edSShaohui Xie 27302b5d2edSShaohui Xie int config_board_mux(int ctrl_type) 27402b5d2edSShaohui Xie { 27502b5d2edSShaohui Xie u8 reg14; 27602b5d2edSShaohui Xie 27702b5d2edSShaohui Xie reg14 = QIXIS_READ(brdcfg[14]); 27802b5d2edSShaohui Xie 27902b5d2edSShaohui Xie switch (ctrl_type) { 28002b5d2edSShaohui Xie case MUX_TYPE_GPIO: 28102b5d2edSShaohui Xie reg14 = (reg14 & (~0x30)) | 0x20; 28202b5d2edSShaohui Xie break; 28302b5d2edSShaohui Xie default: 28402b5d2edSShaohui Xie puts("Unsupported mux interface type\n"); 28502b5d2edSShaohui Xie return -1; 28602b5d2edSShaohui Xie } 28702b5d2edSShaohui Xie 28802b5d2edSShaohui Xie QIXIS_WRITE(brdcfg[14], reg14); 28902b5d2edSShaohui Xie 29002b5d2edSShaohui Xie return 0; 29102b5d2edSShaohui Xie } 29202b5d2edSShaohui Xie 29302b5d2edSShaohui Xie int config_serdes_mux(void) 29402b5d2edSShaohui Xie { 29502b5d2edSShaohui Xie return 0; 29602b5d2edSShaohui Xie } 29702b5d2edSShaohui Xie 29802b5d2edSShaohui Xie 29902b5d2edSShaohui Xie #ifdef CONFIG_MISC_INIT_R 30002b5d2edSShaohui Xie int misc_init_r(void) 30102b5d2edSShaohui Xie { 30202b5d2edSShaohui Xie if (hwconfig("gpio")) 30302b5d2edSShaohui Xie config_board_mux(MUX_TYPE_GPIO); 30402b5d2edSShaohui Xie 30502b5d2edSShaohui Xie return 0; 30602b5d2edSShaohui Xie } 30702b5d2edSShaohui Xie #endif 30802b5d2edSShaohui Xie 30902b5d2edSShaohui Xie int board_init(void) 31002b5d2edSShaohui Xie { 311*b392a6d4SHou Zhiqiang #ifdef CONFIG_SYS_FSL_ERRATUM_A010315 312*b392a6d4SHou Zhiqiang erratum_a010315(); 313*b392a6d4SHou Zhiqiang #endif 314*b392a6d4SHou Zhiqiang 31502b5d2edSShaohui Xie select_i2c_ch_pca9547(I2C_MUX_CH_DEFAULT); 31602b5d2edSShaohui Xie board_retimer_init(); 31702b5d2edSShaohui Xie 31802b5d2edSShaohui Xie #ifdef CONFIG_SYS_FSL_SERDES 31902b5d2edSShaohui Xie config_serdes_mux(); 32002b5d2edSShaohui Xie #endif 32102b5d2edSShaohui Xie 32202b5d2edSShaohui Xie return 0; 32302b5d2edSShaohui Xie } 32402b5d2edSShaohui Xie 32502b5d2edSShaohui Xie #ifdef CONFIG_OF_BOARD_SETUP 32602b5d2edSShaohui Xie int ft_board_setup(void *blob, bd_t *bd) 32702b5d2edSShaohui Xie { 32858e4ad1dSShaohui Xie u64 base[CONFIG_NR_DRAM_BANKS]; 32958e4ad1dSShaohui Xie u64 size[CONFIG_NR_DRAM_BANKS]; 3308401c710SQianyu Gong u8 reg; 33158e4ad1dSShaohui Xie 33258e4ad1dSShaohui Xie /* fixup DT for the two DDR banks */ 33358e4ad1dSShaohui Xie base[0] = gd->bd->bi_dram[0].start; 33458e4ad1dSShaohui Xie size[0] = gd->bd->bi_dram[0].size; 33558e4ad1dSShaohui Xie base[1] = gd->bd->bi_dram[1].start; 33658e4ad1dSShaohui Xie size[1] = gd->bd->bi_dram[1].size; 33758e4ad1dSShaohui Xie 33858e4ad1dSShaohui Xie fdt_fixup_memory_banks(blob, base, size, 2); 33902b5d2edSShaohui Xie ft_cpu_setup(blob, bd); 34002b5d2edSShaohui Xie 34102b5d2edSShaohui Xie #ifdef CONFIG_SYS_DPAA_FMAN 34202b5d2edSShaohui Xie fdt_fixup_fman_ethernet(blob); 34302b5d2edSShaohui Xie fdt_fixup_board_enet(blob); 34402b5d2edSShaohui Xie #endif 3458401c710SQianyu Gong 3468401c710SQianyu Gong reg = QIXIS_READ(brdcfg[0]); 3478401c710SQianyu Gong reg = (reg & QIXIS_LBMAP_MASK) >> QIXIS_LBMAP_SHIFT; 3488401c710SQianyu Gong 3498401c710SQianyu Gong /* Disable IFC if QSPI is enabled */ 3508401c710SQianyu Gong if (reg == 0xF) 3518401c710SQianyu Gong do_fixup_by_compat(blob, "fsl,ifc", 3528401c710SQianyu Gong "status", "disabled", 8 + 1, 1); 3538401c710SQianyu Gong 35402b5d2edSShaohui Xie return 0; 35502b5d2edSShaohui Xie } 35602b5d2edSShaohui Xie #endif 35702b5d2edSShaohui Xie 35802b5d2edSShaohui Xie u8 flash_read8(void *addr) 35902b5d2edSShaohui Xie { 36002b5d2edSShaohui Xie return __raw_readb(addr + 1); 36102b5d2edSShaohui Xie } 36202b5d2edSShaohui Xie 36302b5d2edSShaohui Xie void flash_write16(u16 val, void *addr) 36402b5d2edSShaohui Xie { 36502b5d2edSShaohui Xie u16 shftval = (((val >> 8) & 0xff) | ((val << 8) & 0xff00)); 36602b5d2edSShaohui Xie 36702b5d2edSShaohui Xie __raw_writew(shftval, addr); 36802b5d2edSShaohui Xie } 36902b5d2edSShaohui Xie 37002b5d2edSShaohui Xie u16 flash_read16(void *addr) 37102b5d2edSShaohui Xie { 37202b5d2edSShaohui Xie u16 val = __raw_readw(addr); 37302b5d2edSShaohui Xie 37402b5d2edSShaohui Xie return (((val) >> 8) & 0x00ff) | (((val) << 8) & 0xff00); 37502b5d2edSShaohui Xie } 376