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