blob: c828dacf9ee455136d04fc126e6519bf9c0c04a2 [file] [log] [blame]
Tom Rini10e47792018-05-06 17:58:06 -04001// SPDX-License-Identifier: GPL-2.0+
Wang Huanf0ce7d62014-09-05 13:52:44 +08002/*
3 * Copyright 2014 Freescale Semiconductor, Inc.
Wang Huanf0ce7d62014-09-05 13:52:44 +08004 */
5
6#include <common.h>
7#include <i2c.h>
8#include <asm/io.h>
9#include <asm/arch/immap_ls102xa.h>
10#include <asm/arch/clock.h>
11#include <asm/arch/fsl_serdes.h>
Yao Yuane0f8f542015-12-05 14:59:10 +080012#include <asm/arch/ls102xa_soc.h>
Zhuoyu Zhangfe4f2882015-08-17 18:55:12 +080013#include <asm/arch/ls102xa_devdis.h>
Yao Yuanfec6aa02014-11-26 14:54:33 +080014#include <hwconfig.h>
Wang Huanf0ce7d62014-09-05 13:52:44 +080015#include <mmc.h>
Mingkai Hu5b0df8a2015-10-26 19:47:41 +080016#include <fsl_csu.h>
Wang Huanf0ce7d62014-09-05 13:52:44 +080017#include <fsl_esdhc.h>
18#include <fsl_ifc.h>
Ruchika Gupta901ae762014-10-15 11:39:06 +053019#include <fsl_sec.h>
Alison Wang9da51782014-12-03 15:00:47 +080020#include <spl.h>
Zhuoyu Zhangfe4f2882015-08-17 18:55:12 +080021#include <fsl_devdis.h>
Aneesh Bansal39d5b3b2016-01-22 16:37:26 +053022#include <fsl_validate.h>
Shengzhou Liu15875a52016-11-21 11:36:48 +080023#include <fsl_ddr.h>
tang yuantian57296e72014-12-17 12:58:05 +080024#include "../common/sleep.h"
Wang Huanf0ce7d62014-09-05 13:52:44 +080025#include "../common/qixis.h"
26#include "ls1021aqds_qixis.h"
Zhao Qiang9fc2f302014-09-26 16:25:32 +080027#ifdef CONFIG_U_QE
Qianyu Gongae6a7582016-02-18 13:01:59 +080028#include <fsl_qe.h>
Zhao Qiang9fc2f302014-09-26 16:25:32 +080029#endif
Wang Huanf0ce7d62014-09-05 13:52:44 +080030
Yao Yuanfec6aa02014-11-26 14:54:33 +080031#define PIN_MUX_SEL_CAN 0x03
32#define PIN_MUX_SEL_IIC2 0xa0
33#define PIN_MUX_SEL_RGMII 0x00
34#define PIN_MUX_SEL_SAI 0x0c
35#define PIN_MUX_SEL_SDHC 0x00
36
37#define SET_SDHC_MUX_SEL(reg, value) ((reg & 0x0f) | value)
38#define SET_EC_MUX_SEL(reg, value) ((reg & 0xf0) | value)
Wang Huanf0ce7d62014-09-05 13:52:44 +080039enum {
Yao Yuanfec6aa02014-11-26 14:54:33 +080040 MUX_TYPE_CAN,
41 MUX_TYPE_IIC2,
42 MUX_TYPE_RGMII,
43 MUX_TYPE_SAI,
44 MUX_TYPE_SDHC,
Wang Huanf0ce7d62014-09-05 13:52:44 +080045 MUX_TYPE_SD_PCI4,
46 MUX_TYPE_SD_PC_SA_SG_SG,
47 MUX_TYPE_SD_PC_SA_PC_SG,
48 MUX_TYPE_SD_PC_SG_SG,
49};
50
Alison Wang29d75432014-12-09 17:38:23 +080051enum {
52 GE0_CLK125,
53 GE2_CLK125,
54 GE1_CLK125,
55};
56
Wang Huanf0ce7d62014-09-05 13:52:44 +080057int checkboard(void)
58{
Alison Wang34de5e42016-02-02 15:16:23 +080059#if !defined(CONFIG_QSPI_BOOT) && !defined(CONFIG_SD_BOOT_QSPI)
Wang Huanf0ce7d62014-09-05 13:52:44 +080060 char buf[64];
Alison Wang2145a372014-12-09 17:38:02 +080061#endif
Alison Wang9da51782014-12-03 15:00:47 +080062#if !defined(CONFIG_SD_BOOT) && !defined(CONFIG_QSPI_BOOT)
Wang Huanf0ce7d62014-09-05 13:52:44 +080063 u8 sw;
Alison Wang9da51782014-12-03 15:00:47 +080064#endif
Wang Huanf0ce7d62014-09-05 13:52:44 +080065
66 puts("Board: LS1021AQDS\n");
67
Alison Wang9da51782014-12-03 15:00:47 +080068#ifdef CONFIG_SD_BOOT
69 puts("SD\n");
70#elif CONFIG_QSPI_BOOT
71 puts("QSPI\n");
72#else
Wang Huanf0ce7d62014-09-05 13:52:44 +080073 sw = QIXIS_READ(brdcfg[0]);
74 sw = (sw & QIXIS_LBMAP_MASK) >> QIXIS_LBMAP_SHIFT;
75
76 if (sw < 0x8)
77 printf("vBank: %d\n", sw);
78 else if (sw == 0x8)
79 puts("PromJet\n");
80 else if (sw == 0x9)
81 puts("NAND\n");
82 else if (sw == 0x15)
83 printf("IFCCard\n");
84 else
85 printf("invalid setting of SW%u\n", QIXIS_LBMAP_SWITCH);
Alison Wang9da51782014-12-03 15:00:47 +080086#endif
Wang Huanf0ce7d62014-09-05 13:52:44 +080087
Alison Wang34de5e42016-02-02 15:16:23 +080088#if !defined(CONFIG_QSPI_BOOT) && !defined(CONFIG_SD_BOOT_QSPI)
Wang Huanf0ce7d62014-09-05 13:52:44 +080089 printf("Sys ID:0x%02x, Sys Ver: 0x%02x\n",
90 QIXIS_READ(id), QIXIS_READ(arch));
91
92 printf("FPGA: v%d (%s), build %d\n",
93 (int)QIXIS_READ(scver), qixis_read_tag(buf),
94 (int)qixis_read_minor());
Alison Wang2145a372014-12-09 17:38:02 +080095#endif
Wang Huanf0ce7d62014-09-05 13:52:44 +080096
97 return 0;
98}
99
100unsigned long get_board_sys_clk(void)
101{
102 u8 sysclk_conf = QIXIS_READ(brdcfg[1]);
103
104 switch (sysclk_conf & 0x0f) {
105 case QIXIS_SYSCLK_64:
106 return 64000000;
107 case QIXIS_SYSCLK_83:
108 return 83333333;
109 case QIXIS_SYSCLK_100:
110 return 100000000;
111 case QIXIS_SYSCLK_125:
112 return 125000000;
113 case QIXIS_SYSCLK_133:
114 return 133333333;
115 case QIXIS_SYSCLK_150:
116 return 150000000;
117 case QIXIS_SYSCLK_160:
118 return 160000000;
119 case QIXIS_SYSCLK_166:
120 return 166666666;
121 }
122 return 66666666;
123}
124
125unsigned long get_board_ddr_clk(void)
126{
127 u8 ddrclk_conf = QIXIS_READ(brdcfg[1]);
128
129 switch ((ddrclk_conf & 0x30) >> 4) {
130 case QIXIS_DDRCLK_100:
131 return 100000000;
132 case QIXIS_DDRCLK_125:
133 return 125000000;
134 case QIXIS_DDRCLK_133:
135 return 133333333;
136 }
137 return 66666666;
138}
139
Chenhui Zhao50966942014-11-06 10:51:59 +0800140int select_i2c_ch_pca9547(u8 ch)
141{
142 int ret;
143
144 ret = i2c_write(I2C_MUX_PCA_ADDR_PRI, 0, 1, &ch, 1);
145 if (ret) {
146 puts("PCA: failed to select proper channel\n");
147 return ret;
148 }
149
150 return 0;
151}
152
Wang Huanf0ce7d62014-09-05 13:52:44 +0800153int dram_init(void)
154{
Chenhui Zhao50966942014-11-06 10:51:59 +0800155 /*
156 * When resuming from deep sleep, the I2C channel may not be
157 * in the default channel. So, switch to the default channel
158 * before accessing DDR SPD.
159 */
160 select_i2c_ch_pca9547(I2C_MUX_CH_DEFAULT);
Simon Glass0e0ac202017-04-06 12:47:04 -0600161 return fsl_initdram();
Wang Huanf0ce7d62014-09-05 13:52:44 +0800162}
163
164#ifdef CONFIG_FSL_ESDHC
165struct fsl_esdhc_cfg esdhc_cfg[1] = {
166 {CONFIG_SYS_FSL_ESDHC_ADDR},
167};
168
169int board_mmc_init(bd_t *bis)
170{
171 esdhc_cfg[0].sdhc_clk = mxc_get_clock(MXC_ESDHC_CLK);
172
173 return fsl_esdhc_initialize(bis, &esdhc_cfg[0]);
174}
175#endif
176
Wang Huanf0ce7d62014-09-05 13:52:44 +0800177int board_early_init_f(void)
178{
179 struct ccsr_scfg *scfg = (struct ccsr_scfg *)CONFIG_SYS_FSL_SCFG_ADDR;
Wang Huanf0ce7d62014-09-05 13:52:44 +0800180
181#ifdef CONFIG_TSEC_ENET
Claudiu Manoil51b503e2015-08-12 13:29:14 +0300182 /* clear BD & FR bits for BE BD's and frame data */
183 clrbits_be32(&scfg->etsecdmamcr, SCFG_ETSECDMAMCR_LE_BD_FR);
Wang Huanf0ce7d62014-09-05 13:52:44 +0800184#endif
185
186#ifdef CONFIG_FSL_IFC
187 init_early_memctl_regs();
188#endif
189
Yao Yuane0f8f542015-12-05 14:59:10 +0800190 arch_soc_init();
Wang Huanf0ce7d62014-09-05 13:52:44 +0800191
tang yuantian57296e72014-12-17 12:58:05 +0800192#if defined(CONFIG_DEEP_SLEEP)
193 if (is_warm_boot())
194 fsl_dp_disable_console();
195#endif
196
Wang Huanf0ce7d62014-09-05 13:52:44 +0800197 return 0;
198}
Alison Wang9da51782014-12-03 15:00:47 +0800199
200#ifdef CONFIG_SPL_BUILD
201void board_init_f(ulong dummy)
202{
Ashish Kumar11234062017-08-11 11:09:14 +0530203 struct ccsr_cci400 *cci = (struct ccsr_cci400 *)(CONFIG_SYS_IMMR +
204 CONFIG_SYS_CCI400_OFFSET);
Alison Wang6027eb42015-03-12 11:31:44 +0800205 unsigned int major;
Alison Wang9da51782014-12-03 15:00:47 +0800206
Alison Wangab98bb52014-12-09 17:38:14 +0800207#ifdef CONFIG_NAND_BOOT
208 struct ccsr_gur __iomem *gur = (void *)CONFIG_SYS_FSL_GUTS_ADDR;
209 u32 porsr1, pinctl;
210
211 /*
212 * There is LS1 SoC issue where NOR, FPGA are inaccessible during
213 * NAND boot because IFC signals > IFC_AD7 are not enabled.
214 * This workaround changes RCW source to make all signals enabled.
215 */
216 porsr1 = in_be32(&gur->porsr1);
217 pinctl = ((porsr1 & ~(DCFG_CCSR_PORSR1_RCW_MASK)) |
218 DCFG_CCSR_PORSR1_RCW_SRC_I2C);
219 out_be32((unsigned int *)(CONFIG_SYS_DCSR_DCFG_ADDR + DCFG_DCSR_PORCR1),
220 pinctl);
221#endif
222
Alison Wang9da51782014-12-03 15:00:47 +0800223 /* Clear the BSS */
224 memset(__bss_start, 0, __bss_end - __bss_start);
225
226#ifdef CONFIG_FSL_IFC
227 init_early_memctl_regs();
228#endif
229
230 get_clocks();
231
tang yuantian57296e72014-12-17 12:58:05 +0800232#if defined(CONFIG_DEEP_SLEEP)
233 if (is_warm_boot())
234 fsl_dp_disable_console();
235#endif
236
Alison Wang9da51782014-12-03 15:00:47 +0800237 preloader_console_init();
238
239#ifdef CONFIG_SPL_I2C_SUPPORT
240 i2c_init_all();
241#endif
Alison Wang6027eb42015-03-12 11:31:44 +0800242
243 major = get_soc_major_rev();
244 if (major == SOC_MAJOR_VER_1_0)
245 out_le32(&cci->ctrl_ord, CCI400_CTRLORD_TERM_BARRIER);
Alison Wang9da51782014-12-03 15:00:47 +0800246
247 dram_init();
248
Alison Wang5dec9d72015-07-09 10:50:07 +0800249 /* Allow OCRAM access permission as R/W */
Mingkai Hu5b0df8a2015-10-26 19:47:41 +0800250#ifdef CONFIG_LAYERSCAPE_NS_ACCESS
251 enable_layerscape_ns_access();
Alison Wang5dec9d72015-07-09 10:50:07 +0800252#endif
253
Alison Wang9da51782014-12-03 15:00:47 +0800254 board_init_r(NULL, 0);
255}
256#endif
Wang Huanf0ce7d62014-09-05 13:52:44 +0800257
Alison Wang29d75432014-12-09 17:38:23 +0800258void config_etseccm_source(int etsec_gtx_125_mux)
259{
260 struct ccsr_scfg *scfg = (struct ccsr_scfg *)CONFIG_SYS_FSL_SCFG_ADDR;
261
262 switch (etsec_gtx_125_mux) {
263 case GE0_CLK125:
264 out_be32(&scfg->etsecmcr, SCFG_ETSECCMCR_GE0_CLK125);
265 debug("etseccm set to GE0_CLK125\n");
266 break;
267
268 case GE2_CLK125:
269 out_be32(&scfg->etsecmcr, SCFG_ETSECCMCR_GE2_CLK125);
270 debug("etseccm set to GE2_CLK125\n");
271 break;
272
273 case GE1_CLK125:
274 out_be32(&scfg->etsecmcr, SCFG_ETSECCMCR_GE1_CLK125);
275 debug("etseccm set to GE1_CLK125\n");
276 break;
277
278 default:
279 printf("Error! trying to set etseccm to invalid value\n");
280 break;
281 }
282}
283
Wang Huanf0ce7d62014-09-05 13:52:44 +0800284int config_board_mux(int ctrl_type)
285{
Yao Yuanfec6aa02014-11-26 14:54:33 +0800286 u8 reg12, reg14;
Wang Huanf0ce7d62014-09-05 13:52:44 +0800287
288 reg12 = QIXIS_READ(brdcfg[12]);
Yao Yuanfec6aa02014-11-26 14:54:33 +0800289 reg14 = QIXIS_READ(brdcfg[14]);
Wang Huanf0ce7d62014-09-05 13:52:44 +0800290
291 switch (ctrl_type) {
Yao Yuanfec6aa02014-11-26 14:54:33 +0800292 case MUX_TYPE_CAN:
Alison Wang29d75432014-12-09 17:38:23 +0800293 config_etseccm_source(GE2_CLK125);
Yao Yuanfec6aa02014-11-26 14:54:33 +0800294 reg14 = SET_EC_MUX_SEL(reg14, PIN_MUX_SEL_CAN);
295 break;
296 case MUX_TYPE_IIC2:
297 reg14 = SET_SDHC_MUX_SEL(reg14, PIN_MUX_SEL_IIC2);
298 break;
299 case MUX_TYPE_RGMII:
300 reg14 = SET_EC_MUX_SEL(reg14, PIN_MUX_SEL_RGMII);
301 break;
302 case MUX_TYPE_SAI:
Alison Wang29d75432014-12-09 17:38:23 +0800303 config_etseccm_source(GE2_CLK125);
Yao Yuanfec6aa02014-11-26 14:54:33 +0800304 reg14 = SET_EC_MUX_SEL(reg14, PIN_MUX_SEL_SAI);
305 break;
306 case MUX_TYPE_SDHC:
307 reg14 = SET_SDHC_MUX_SEL(reg14, PIN_MUX_SEL_SDHC);
308 break;
Wang Huanf0ce7d62014-09-05 13:52:44 +0800309 case MUX_TYPE_SD_PCI4:
310 reg12 = 0x38;
311 break;
312 case MUX_TYPE_SD_PC_SA_SG_SG:
313 reg12 = 0x01;
314 break;
315 case MUX_TYPE_SD_PC_SA_PC_SG:
316 reg12 = 0x01;
317 break;
318 case MUX_TYPE_SD_PC_SG_SG:
319 reg12 = 0x21;
320 break;
321 default:
322 printf("Wrong mux interface type\n");
323 return -1;
324 }
325
326 QIXIS_WRITE(brdcfg[12], reg12);
Yao Yuanfec6aa02014-11-26 14:54:33 +0800327 QIXIS_WRITE(brdcfg[14], reg14);
Wang Huanf0ce7d62014-09-05 13:52:44 +0800328
329 return 0;
330}
331
332int config_serdes_mux(void)
333{
334 struct ccsr_gur *gur = (struct ccsr_gur *)CONFIG_SYS_FSL_GUTS_ADDR;
335 u32 cfg;
336
337 cfg = in_be32(&gur->rcwsr[4]) & RCWSR4_SRDS1_PRTCL_MASK;
338 cfg >>= RCWSR4_SRDS1_PRTCL_SHIFT;
339
340 switch (cfg) {
341 case 0x0:
342 config_board_mux(MUX_TYPE_SD_PCI4);
343 break;
344 case 0x30:
345 config_board_mux(MUX_TYPE_SD_PC_SA_SG_SG);
346 break;
347 case 0x60:
348 config_board_mux(MUX_TYPE_SD_PC_SG_SG);
349 break;
350 case 0x70:
351 config_board_mux(MUX_TYPE_SD_PC_SA_PC_SG);
352 break;
353 default:
354 printf("SRDS1 prtcl:0x%x\n", cfg);
355 break;
356 }
357
358 return 0;
359}
360
tang yuantian9f51db22015-10-16 16:06:05 +0800361#ifdef CONFIG_BOARD_LATE_INIT
362int board_late_init(void)
363{
Aneesh Bansal39d5b3b2016-01-22 16:37:26 +0530364#ifdef CONFIG_CHAIN_OF_TRUST
365 fsl_setenv_chain_of_trust();
366#endif
tang yuantian9f51db22015-10-16 16:06:05 +0800367
368 return 0;
369}
370#endif
371
Ruchika Gupta901ae762014-10-15 11:39:06 +0530372int misc_init_r(void)
373{
Yao Yuanfec6aa02014-11-26 14:54:33 +0800374 int conflict_flag;
375
376 /* some signals can not enable simultaneous*/
377 conflict_flag = 0;
378 if (hwconfig("sdhc"))
379 conflict_flag++;
380 if (hwconfig("iic2"))
381 conflict_flag++;
382 if (conflict_flag > 1) {
383 printf("WARNING: pin conflict !\n");
384 return 0;
385 }
386
387 conflict_flag = 0;
388 if (hwconfig("rgmii"))
389 conflict_flag++;
390 if (hwconfig("can"))
391 conflict_flag++;
392 if (hwconfig("sai"))
393 conflict_flag++;
394 if (conflict_flag > 1) {
395 printf("WARNING: pin conflict !\n");
396 return 0;
397 }
398
399 if (hwconfig("can"))
400 config_board_mux(MUX_TYPE_CAN);
401 else if (hwconfig("rgmii"))
402 config_board_mux(MUX_TYPE_RGMII);
403 else if (hwconfig("sai"))
404 config_board_mux(MUX_TYPE_SAI);
405
406 if (hwconfig("iic2"))
407 config_board_mux(MUX_TYPE_IIC2);
408 else if (hwconfig("sdhc"))
409 config_board_mux(MUX_TYPE_SDHC);
410
Zhuoyu Zhangfe4f2882015-08-17 18:55:12 +0800411#ifdef CONFIG_FSL_DEVICE_DISABLE
412 device_disable(devdis_tbl, ARRAY_SIZE(devdis_tbl));
413#endif
Ruchika Gupta901ae762014-10-15 11:39:06 +0530414#ifdef CONFIG_FSL_CAAM
415 return sec_init();
416#endif
Yao Yuanfec6aa02014-11-26 14:54:33 +0800417 return 0;
Ruchika Gupta901ae762014-10-15 11:39:06 +0530418}
Ruchika Gupta901ae762014-10-15 11:39:06 +0530419
Wang Huanf0ce7d62014-09-05 13:52:44 +0800420int board_init(void)
421{
Ashish Kumar11234062017-08-11 11:09:14 +0530422 struct ccsr_cci400 *cci = (struct ccsr_cci400 *)(CONFIG_SYS_IMMR +
423 CONFIG_SYS_CCI400_OFFSET);
Alison Wang6027eb42015-03-12 11:31:44 +0800424 unsigned int major;
Wang Huanf0ce7d62014-09-05 13:52:44 +0800425
Hou Zhiqiang4b23ca82016-08-02 19:03:27 +0800426#ifdef CONFIG_SYS_FSL_ERRATUM_A010315
427 erratum_a010315();
428#endif
Shengzhou Liu15875a52016-11-21 11:36:48 +0800429#ifdef CONFIG_SYS_FSL_ERRATUM_A009942
430 erratum_a009942_check_cpo();
431#endif
Alison Wang6027eb42015-03-12 11:31:44 +0800432 major = get_soc_major_rev();
433 if (major == SOC_MAJOR_VER_1_0) {
434 /* Set CCI-400 control override register to
435 * enable barrier transaction */
436 out_le32(&cci->ctrl_ord, CCI400_CTRLORD_EN_BARRIER);
437 }
Wang Huanf0ce7d62014-09-05 13:52:44 +0800438
439 select_i2c_ch_pca9547(I2C_MUX_CH_DEFAULT);
440
441#ifndef CONFIG_SYS_FSL_NO_SERDES
442 fsl_serdes_init();
443 config_serdes_mux();
444#endif
Zhao Qiang9fc2f302014-09-26 16:25:32 +0800445
Alison Wang69364922016-02-05 12:48:17 +0800446 ls102xa_smmu_stream_id_init();
Xiubo Li03d40aa2014-11-21 17:40:59 +0800447
Zhao Qiang9fc2f302014-09-26 16:25:32 +0800448#ifdef CONFIG_U_QE
449 u_qe_init();
450#endif
451
Wang Huanf0ce7d62014-09-05 13:52:44 +0800452 return 0;
453}
tang yuantian57296e72014-12-17 12:58:05 +0800454
455#if defined(CONFIG_DEEP_SLEEP)
456void board_sleep_prepare(void)
457{
Ashish Kumar11234062017-08-11 11:09:14 +0530458 struct ccsr_cci400 __iomem *cci = (void *)(CONFIG_SYS_IMMR +
459 CONFIG_SYS_CCI400_OFFSET);
Alison Wang6027eb42015-03-12 11:31:44 +0800460 unsigned int major;
461
462 major = get_soc_major_rev();
463 if (major == SOC_MAJOR_VER_1_0) {
464 /* Set CCI-400 control override register to
465 * enable barrier transaction */
466 out_le32(&cci->ctrl_ord, CCI400_CTRLORD_EN_BARRIER);
467 }
tang yuantian57296e72014-12-17 12:58:05 +0800468
tang yuantian57296e72014-12-17 12:58:05 +0800469
Mingkai Hu5b0df8a2015-10-26 19:47:41 +0800470#ifdef CONFIG_LAYERSCAPE_NS_ACCESS
471 enable_layerscape_ns_access();
tang yuantian57296e72014-12-17 12:58:05 +0800472#endif
473}
474#endif
Wang Huanf0ce7d62014-09-05 13:52:44 +0800475
Simon Glass2aec3cc2014-10-23 18:58:47 -0600476int ft_board_setup(void *blob, bd_t *bd)
Wang Huanf0ce7d62014-09-05 13:52:44 +0800477{
478 ft_cpu_setup(blob, bd);
Simon Glass2aec3cc2014-10-23 18:58:47 -0600479
Minghuan Lian0c535242015-03-12 10:58:48 +0800480#ifdef CONFIG_PCI
481 ft_pci_setup(blob, bd);
Minghuan Liana4d6b612014-10-31 13:43:44 +0800482#endif
483
Simon Glass2aec3cc2014-10-23 18:58:47 -0600484 return 0;
Wang Huanf0ce7d62014-09-05 13:52:44 +0800485}
486
487u8 flash_read8(void *addr)
488{
489 return __raw_readb(addr + 1);
490}
491
492void flash_write16(u16 val, void *addr)
493{
494 u16 shftval = (((val >> 8) & 0xff) | ((val << 8) & 0xff00));
495
496 __raw_writew(shftval, addr);
497}
498
499u16 flash_read16(void *addr)
500{
501 u16 val = __raw_readw(addr);
502
503 return (((val) >> 8) & 0x00ff) | (((val) << 8) & 0xff00);
504}