blob: 6722cad27af0bae69e21a3eb0ba182aec7391b97 [file] [log] [blame]
Tom Rini83d290c2018-05-06 17:58:06 -04001// SPDX-License-Identifier: GPL-2.0+
Wang Huan550e3dc2014-09-05 13:52:44 +08002/*
3 * Copyright 2014 Freescale Semiconductor, Inc.
Wang Huan550e3dc2014-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 Yuan7ba02612015-12-05 14:59:10 +080012#include <asm/arch/ls102xa_soc.h>
Zhuoyu Zhang03c22442015-08-17 18:55:12 +080013#include <asm/arch/ls102xa_devdis.h>
tang yuantian4632ad72015-10-16 16:06:05 +080014#include <asm/arch/ls102xa_sata.h>
Yao Yuanbca11bd2014-11-26 14:54:33 +080015#include <hwconfig.h>
Wang Huan550e3dc2014-09-05 13:52:44 +080016#include <mmc.h>
Mingkai Hu435acd82015-10-26 19:47:41 +080017#include <fsl_csu.h>
Wang Huan550e3dc2014-09-05 13:52:44 +080018#include <fsl_esdhc.h>
19#include <fsl_ifc.h>
Ruchika Gupta4ba4a092014-10-15 11:39:06 +053020#include <fsl_sec.h>
Alison Wang86949c22014-12-03 15:00:47 +080021#include <spl.h>
Zhuoyu Zhang03c22442015-08-17 18:55:12 +080022#include <fsl_devdis.h>
Aneesh Bansald0412882016-01-22 16:37:26 +053023#include <fsl_validate.h>
Shengzhou Liu02fb2762016-11-21 11:36:48 +080024#include <fsl_ddr.h>
tang yuantian41ba57d2014-12-17 12:58:05 +080025#include "../common/sleep.h"
Wang Huan550e3dc2014-09-05 13:52:44 +080026#include "../common/qixis.h"
27#include "ls1021aqds_qixis.h"
Zhao Qiang63e75fd2014-09-26 16:25:32 +080028#ifdef CONFIG_U_QE
Qianyu Gong2459afb2016-02-18 13:01:59 +080029#include <fsl_qe.h>
Zhao Qiang63e75fd2014-09-26 16:25:32 +080030#endif
Wang Huan550e3dc2014-09-05 13:52:44 +080031
Yao Yuanbca11bd2014-11-26 14:54:33 +080032#define PIN_MUX_SEL_CAN 0x03
33#define PIN_MUX_SEL_IIC2 0xa0
34#define PIN_MUX_SEL_RGMII 0x00
35#define PIN_MUX_SEL_SAI 0x0c
36#define PIN_MUX_SEL_SDHC 0x00
37
38#define SET_SDHC_MUX_SEL(reg, value) ((reg & 0x0f) | value)
39#define SET_EC_MUX_SEL(reg, value) ((reg & 0xf0) | value)
Wang Huan550e3dc2014-09-05 13:52:44 +080040enum {
Yao Yuanbca11bd2014-11-26 14:54:33 +080041 MUX_TYPE_CAN,
42 MUX_TYPE_IIC2,
43 MUX_TYPE_RGMII,
44 MUX_TYPE_SAI,
45 MUX_TYPE_SDHC,
Wang Huan550e3dc2014-09-05 13:52:44 +080046 MUX_TYPE_SD_PCI4,
47 MUX_TYPE_SD_PC_SA_SG_SG,
48 MUX_TYPE_SD_PC_SA_PC_SG,
49 MUX_TYPE_SD_PC_SG_SG,
50};
51
Alison Wang0f5e5572014-12-09 17:38:23 +080052enum {
53 GE0_CLK125,
54 GE2_CLK125,
55 GE1_CLK125,
56};
57
Wang Huan550e3dc2014-09-05 13:52:44 +080058int checkboard(void)
59{
Alison Wang70097022016-02-02 15:16:23 +080060#if !defined(CONFIG_QSPI_BOOT) && !defined(CONFIG_SD_BOOT_QSPI)
Wang Huan550e3dc2014-09-05 13:52:44 +080061 char buf[64];
Alison Wangd612f0a2014-12-09 17:38:02 +080062#endif
Alison Wang86949c22014-12-03 15:00:47 +080063#if !defined(CONFIG_SD_BOOT) && !defined(CONFIG_QSPI_BOOT)
Wang Huan550e3dc2014-09-05 13:52:44 +080064 u8 sw;
Alison Wang86949c22014-12-03 15:00:47 +080065#endif
Wang Huan550e3dc2014-09-05 13:52:44 +080066
67 puts("Board: LS1021AQDS\n");
68
Alison Wang86949c22014-12-03 15:00:47 +080069#ifdef CONFIG_SD_BOOT
70 puts("SD\n");
71#elif CONFIG_QSPI_BOOT
72 puts("QSPI\n");
73#else
Wang Huan550e3dc2014-09-05 13:52:44 +080074 sw = QIXIS_READ(brdcfg[0]);
75 sw = (sw & QIXIS_LBMAP_MASK) >> QIXIS_LBMAP_SHIFT;
76
77 if (sw < 0x8)
78 printf("vBank: %d\n", sw);
79 else if (sw == 0x8)
80 puts("PromJet\n");
81 else if (sw == 0x9)
82 puts("NAND\n");
83 else if (sw == 0x15)
84 printf("IFCCard\n");
85 else
86 printf("invalid setting of SW%u\n", QIXIS_LBMAP_SWITCH);
Alison Wang86949c22014-12-03 15:00:47 +080087#endif
Wang Huan550e3dc2014-09-05 13:52:44 +080088
Alison Wang70097022016-02-02 15:16:23 +080089#if !defined(CONFIG_QSPI_BOOT) && !defined(CONFIG_SD_BOOT_QSPI)
Wang Huan550e3dc2014-09-05 13:52:44 +080090 printf("Sys ID:0x%02x, Sys Ver: 0x%02x\n",
91 QIXIS_READ(id), QIXIS_READ(arch));
92
93 printf("FPGA: v%d (%s), build %d\n",
94 (int)QIXIS_READ(scver), qixis_read_tag(buf),
95 (int)qixis_read_minor());
Alison Wangd612f0a2014-12-09 17:38:02 +080096#endif
Wang Huan550e3dc2014-09-05 13:52:44 +080097
98 return 0;
99}
100
101unsigned long get_board_sys_clk(void)
102{
103 u8 sysclk_conf = QIXIS_READ(brdcfg[1]);
104
105 switch (sysclk_conf & 0x0f) {
106 case QIXIS_SYSCLK_64:
107 return 64000000;
108 case QIXIS_SYSCLK_83:
109 return 83333333;
110 case QIXIS_SYSCLK_100:
111 return 100000000;
112 case QIXIS_SYSCLK_125:
113 return 125000000;
114 case QIXIS_SYSCLK_133:
115 return 133333333;
116 case QIXIS_SYSCLK_150:
117 return 150000000;
118 case QIXIS_SYSCLK_160:
119 return 160000000;
120 case QIXIS_SYSCLK_166:
121 return 166666666;
122 }
123 return 66666666;
124}
125
126unsigned long get_board_ddr_clk(void)
127{
128 u8 ddrclk_conf = QIXIS_READ(brdcfg[1]);
129
130 switch ((ddrclk_conf & 0x30) >> 4) {
131 case QIXIS_DDRCLK_100:
132 return 100000000;
133 case QIXIS_DDRCLK_125:
134 return 125000000;
135 case QIXIS_DDRCLK_133:
136 return 133333333;
137 }
138 return 66666666;
139}
140
Chenhui Zhaoafff1372014-11-06 10:51:59 +0800141int select_i2c_ch_pca9547(u8 ch)
142{
143 int ret;
144
145 ret = i2c_write(I2C_MUX_PCA_ADDR_PRI, 0, 1, &ch, 1);
146 if (ret) {
147 puts("PCA: failed to select proper channel\n");
148 return ret;
149 }
150
151 return 0;
152}
153
Wang Huan550e3dc2014-09-05 13:52:44 +0800154int dram_init(void)
155{
Chenhui Zhaoafff1372014-11-06 10:51:59 +0800156 /*
157 * When resuming from deep sleep, the I2C channel may not be
158 * in the default channel. So, switch to the default channel
159 * before accessing DDR SPD.
160 */
161 select_i2c_ch_pca9547(I2C_MUX_CH_DEFAULT);
Simon Glass3eace372017-04-06 12:47:04 -0600162 return fsl_initdram();
Wang Huan550e3dc2014-09-05 13:52:44 +0800163}
164
165#ifdef CONFIG_FSL_ESDHC
166struct fsl_esdhc_cfg esdhc_cfg[1] = {
167 {CONFIG_SYS_FSL_ESDHC_ADDR},
168};
169
170int board_mmc_init(bd_t *bis)
171{
172 esdhc_cfg[0].sdhc_clk = mxc_get_clock(MXC_ESDHC_CLK);
173
174 return fsl_esdhc_initialize(bis, &esdhc_cfg[0]);
175}
176#endif
177
Wang Huan550e3dc2014-09-05 13:52:44 +0800178int board_early_init_f(void)
179{
180 struct ccsr_scfg *scfg = (struct ccsr_scfg *)CONFIG_SYS_FSL_SCFG_ADDR;
Wang Huan550e3dc2014-09-05 13:52:44 +0800181
182#ifdef CONFIG_TSEC_ENET
Claudiu Manoilebe4c1e2015-08-12 13:29:14 +0300183 /* clear BD & FR bits for BE BD's and frame data */
184 clrbits_be32(&scfg->etsecdmamcr, SCFG_ETSECDMAMCR_LE_BD_FR);
Wang Huan550e3dc2014-09-05 13:52:44 +0800185#endif
186
187#ifdef CONFIG_FSL_IFC
188 init_early_memctl_regs();
189#endif
190
Yao Yuan7ba02612015-12-05 14:59:10 +0800191 arch_soc_init();
Wang Huan550e3dc2014-09-05 13:52:44 +0800192
tang yuantian41ba57d2014-12-17 12:58:05 +0800193#if defined(CONFIG_DEEP_SLEEP)
194 if (is_warm_boot())
195 fsl_dp_disable_console();
196#endif
197
Wang Huan550e3dc2014-09-05 13:52:44 +0800198 return 0;
199}
200
Alison Wang86949c22014-12-03 15:00:47 +0800201#ifdef CONFIG_SPL_BUILD
202void board_init_f(ulong dummy)
203{
Ashish Kumar63b23162017-08-11 11:09:14 +0530204 struct ccsr_cci400 *cci = (struct ccsr_cci400 *)(CONFIG_SYS_IMMR +
205 CONFIG_SYS_CCI400_OFFSET);
Alison Wang036f3f32015-03-12 11:31:44 +0800206 unsigned int major;
Alison Wang86949c22014-12-03 15:00:47 +0800207
Alison Wang8ab967b2014-12-09 17:38:14 +0800208#ifdef CONFIG_NAND_BOOT
209 struct ccsr_gur __iomem *gur = (void *)CONFIG_SYS_FSL_GUTS_ADDR;
210 u32 porsr1, pinctl;
211
212 /*
213 * There is LS1 SoC issue where NOR, FPGA are inaccessible during
214 * NAND boot because IFC signals > IFC_AD7 are not enabled.
215 * This workaround changes RCW source to make all signals enabled.
216 */
217 porsr1 = in_be32(&gur->porsr1);
218 pinctl = ((porsr1 & ~(DCFG_CCSR_PORSR1_RCW_MASK)) |
219 DCFG_CCSR_PORSR1_RCW_SRC_I2C);
220 out_be32((unsigned int *)(CONFIG_SYS_DCSR_DCFG_ADDR + DCFG_DCSR_PORCR1),
221 pinctl);
222#endif
223
Alison Wang86949c22014-12-03 15:00:47 +0800224 /* Clear the BSS */
225 memset(__bss_start, 0, __bss_end - __bss_start);
226
227#ifdef CONFIG_FSL_IFC
228 init_early_memctl_regs();
229#endif
230
231 get_clocks();
232
tang yuantian41ba57d2014-12-17 12:58:05 +0800233#if defined(CONFIG_DEEP_SLEEP)
234 if (is_warm_boot())
235 fsl_dp_disable_console();
236#endif
237
Alison Wang86949c22014-12-03 15:00:47 +0800238 preloader_console_init();
239
240#ifdef CONFIG_SPL_I2C_SUPPORT
241 i2c_init_all();
242#endif
Alison Wang036f3f32015-03-12 11:31:44 +0800243
244 major = get_soc_major_rev();
245 if (major == SOC_MAJOR_VER_1_0)
246 out_le32(&cci->ctrl_ord, CCI400_CTRLORD_TERM_BARRIER);
Alison Wang86949c22014-12-03 15:00:47 +0800247
248 dram_init();
249
Alison Wang8f0c7cb2015-07-09 10:50:07 +0800250 /* Allow OCRAM access permission as R/W */
Mingkai Hu435acd82015-10-26 19:47:41 +0800251#ifdef CONFIG_LAYERSCAPE_NS_ACCESS
252 enable_layerscape_ns_access();
Alison Wang8f0c7cb2015-07-09 10:50:07 +0800253#endif
254
Alison Wang86949c22014-12-03 15:00:47 +0800255 board_init_r(NULL, 0);
256}
257#endif
258
Alison Wang0f5e5572014-12-09 17:38:23 +0800259void config_etseccm_source(int etsec_gtx_125_mux)
260{
261 struct ccsr_scfg *scfg = (struct ccsr_scfg *)CONFIG_SYS_FSL_SCFG_ADDR;
262
263 switch (etsec_gtx_125_mux) {
264 case GE0_CLK125:
265 out_be32(&scfg->etsecmcr, SCFG_ETSECCMCR_GE0_CLK125);
266 debug("etseccm set to GE0_CLK125\n");
267 break;
268
269 case GE2_CLK125:
270 out_be32(&scfg->etsecmcr, SCFG_ETSECCMCR_GE2_CLK125);
271 debug("etseccm set to GE2_CLK125\n");
272 break;
273
274 case GE1_CLK125:
275 out_be32(&scfg->etsecmcr, SCFG_ETSECCMCR_GE1_CLK125);
276 debug("etseccm set to GE1_CLK125\n");
277 break;
278
279 default:
280 printf("Error! trying to set etseccm to invalid value\n");
281 break;
282 }
283}
284
Wang Huan550e3dc2014-09-05 13:52:44 +0800285int config_board_mux(int ctrl_type)
286{
Yao Yuanbca11bd2014-11-26 14:54:33 +0800287 u8 reg12, reg14;
Wang Huan550e3dc2014-09-05 13:52:44 +0800288
289 reg12 = QIXIS_READ(brdcfg[12]);
Yao Yuanbca11bd2014-11-26 14:54:33 +0800290 reg14 = QIXIS_READ(brdcfg[14]);
Wang Huan550e3dc2014-09-05 13:52:44 +0800291
292 switch (ctrl_type) {
Yao Yuanbca11bd2014-11-26 14:54:33 +0800293 case MUX_TYPE_CAN:
Alison Wang0f5e5572014-12-09 17:38:23 +0800294 config_etseccm_source(GE2_CLK125);
Yao Yuanbca11bd2014-11-26 14:54:33 +0800295 reg14 = SET_EC_MUX_SEL(reg14, PIN_MUX_SEL_CAN);
296 break;
297 case MUX_TYPE_IIC2:
298 reg14 = SET_SDHC_MUX_SEL(reg14, PIN_MUX_SEL_IIC2);
299 break;
300 case MUX_TYPE_RGMII:
301 reg14 = SET_EC_MUX_SEL(reg14, PIN_MUX_SEL_RGMII);
302 break;
303 case MUX_TYPE_SAI:
Alison Wang0f5e5572014-12-09 17:38:23 +0800304 config_etseccm_source(GE2_CLK125);
Yao Yuanbca11bd2014-11-26 14:54:33 +0800305 reg14 = SET_EC_MUX_SEL(reg14, PIN_MUX_SEL_SAI);
306 break;
307 case MUX_TYPE_SDHC:
308 reg14 = SET_SDHC_MUX_SEL(reg14, PIN_MUX_SEL_SDHC);
309 break;
Wang Huan550e3dc2014-09-05 13:52:44 +0800310 case MUX_TYPE_SD_PCI4:
311 reg12 = 0x38;
312 break;
313 case MUX_TYPE_SD_PC_SA_SG_SG:
314 reg12 = 0x01;
315 break;
316 case MUX_TYPE_SD_PC_SA_PC_SG:
317 reg12 = 0x01;
318 break;
319 case MUX_TYPE_SD_PC_SG_SG:
320 reg12 = 0x21;
321 break;
322 default:
323 printf("Wrong mux interface type\n");
324 return -1;
325 }
326
327 QIXIS_WRITE(brdcfg[12], reg12);
Yao Yuanbca11bd2014-11-26 14:54:33 +0800328 QIXIS_WRITE(brdcfg[14], reg14);
Wang Huan550e3dc2014-09-05 13:52:44 +0800329
330 return 0;
331}
332
333int config_serdes_mux(void)
334{
335 struct ccsr_gur *gur = (struct ccsr_gur *)CONFIG_SYS_FSL_GUTS_ADDR;
336 u32 cfg;
337
338 cfg = in_be32(&gur->rcwsr[4]) & RCWSR4_SRDS1_PRTCL_MASK;
339 cfg >>= RCWSR4_SRDS1_PRTCL_SHIFT;
340
341 switch (cfg) {
342 case 0x0:
343 config_board_mux(MUX_TYPE_SD_PCI4);
344 break;
345 case 0x30:
346 config_board_mux(MUX_TYPE_SD_PC_SA_SG_SG);
347 break;
348 case 0x60:
349 config_board_mux(MUX_TYPE_SD_PC_SG_SG);
350 break;
351 case 0x70:
352 config_board_mux(MUX_TYPE_SD_PC_SA_PC_SG);
353 break;
354 default:
355 printf("SRDS1 prtcl:0x%x\n", cfg);
356 break;
357 }
358
359 return 0;
360}
361
tang yuantian4632ad72015-10-16 16:06:05 +0800362#ifdef CONFIG_BOARD_LATE_INIT
363int board_late_init(void)
364{
365#ifdef CONFIG_SCSI_AHCI_PLAT
366 ls1021a_sata_init();
367#endif
Aneesh Bansald0412882016-01-22 16:37:26 +0530368#ifdef CONFIG_CHAIN_OF_TRUST
369 fsl_setenv_chain_of_trust();
370#endif
tang yuantian4632ad72015-10-16 16:06:05 +0800371
372 return 0;
373}
374#endif
375
Ruchika Gupta4ba4a092014-10-15 11:39:06 +0530376int misc_init_r(void)
377{
Yao Yuanbca11bd2014-11-26 14:54:33 +0800378 int conflict_flag;
379
380 /* some signals can not enable simultaneous*/
381 conflict_flag = 0;
382 if (hwconfig("sdhc"))
383 conflict_flag++;
384 if (hwconfig("iic2"))
385 conflict_flag++;
386 if (conflict_flag > 1) {
387 printf("WARNING: pin conflict !\n");
388 return 0;
389 }
390
391 conflict_flag = 0;
392 if (hwconfig("rgmii"))
393 conflict_flag++;
394 if (hwconfig("can"))
395 conflict_flag++;
396 if (hwconfig("sai"))
397 conflict_flag++;
398 if (conflict_flag > 1) {
399 printf("WARNING: pin conflict !\n");
400 return 0;
401 }
402
403 if (hwconfig("can"))
404 config_board_mux(MUX_TYPE_CAN);
405 else if (hwconfig("rgmii"))
406 config_board_mux(MUX_TYPE_RGMII);
407 else if (hwconfig("sai"))
408 config_board_mux(MUX_TYPE_SAI);
409
410 if (hwconfig("iic2"))
411 config_board_mux(MUX_TYPE_IIC2);
412 else if (hwconfig("sdhc"))
413 config_board_mux(MUX_TYPE_SDHC);
414
Zhuoyu Zhang03c22442015-08-17 18:55:12 +0800415#ifdef CONFIG_FSL_DEVICE_DISABLE
416 device_disable(devdis_tbl, ARRAY_SIZE(devdis_tbl));
417#endif
Ruchika Gupta4ba4a092014-10-15 11:39:06 +0530418#ifdef CONFIG_FSL_CAAM
419 return sec_init();
420#endif
Yao Yuanbca11bd2014-11-26 14:54:33 +0800421 return 0;
Ruchika Gupta4ba4a092014-10-15 11:39:06 +0530422}
Ruchika Gupta4ba4a092014-10-15 11:39:06 +0530423
Wang Huan550e3dc2014-09-05 13:52:44 +0800424int board_init(void)
425{
Ashish Kumar63b23162017-08-11 11:09:14 +0530426 struct ccsr_cci400 *cci = (struct ccsr_cci400 *)(CONFIG_SYS_IMMR +
427 CONFIG_SYS_CCI400_OFFSET);
Alison Wang036f3f32015-03-12 11:31:44 +0800428 unsigned int major;
Wang Huan550e3dc2014-09-05 13:52:44 +0800429
Hou Zhiqiangb392a6d2016-08-02 19:03:27 +0800430#ifdef CONFIG_SYS_FSL_ERRATUM_A010315
431 erratum_a010315();
432#endif
Shengzhou Liu02fb2762016-11-21 11:36:48 +0800433#ifdef CONFIG_SYS_FSL_ERRATUM_A009942
434 erratum_a009942_check_cpo();
435#endif
Alison Wang036f3f32015-03-12 11:31:44 +0800436 major = get_soc_major_rev();
437 if (major == SOC_MAJOR_VER_1_0) {
438 /* Set CCI-400 control override register to
439 * enable barrier transaction */
440 out_le32(&cci->ctrl_ord, CCI400_CTRLORD_EN_BARRIER);
441 }
Wang Huan550e3dc2014-09-05 13:52:44 +0800442
443 select_i2c_ch_pca9547(I2C_MUX_CH_DEFAULT);
444
445#ifndef CONFIG_SYS_FSL_NO_SERDES
446 fsl_serdes_init();
447 config_serdes_mux();
448#endif
Zhao Qiang63e75fd2014-09-26 16:25:32 +0800449
Alison Wanga08b1922016-02-05 12:48:17 +0800450 ls102xa_smmu_stream_id_init();
Xiubo Li660673a2014-11-21 17:40:59 +0800451
Zhao Qiang63e75fd2014-09-26 16:25:32 +0800452#ifdef CONFIG_U_QE
453 u_qe_init();
454#endif
455
Wang Huan550e3dc2014-09-05 13:52:44 +0800456 return 0;
457}
458
tang yuantian41ba57d2014-12-17 12:58:05 +0800459#if defined(CONFIG_DEEP_SLEEP)
460void board_sleep_prepare(void)
461{
Ashish Kumar63b23162017-08-11 11:09:14 +0530462 struct ccsr_cci400 __iomem *cci = (void *)(CONFIG_SYS_IMMR +
463 CONFIG_SYS_CCI400_OFFSET);
Alison Wang036f3f32015-03-12 11:31:44 +0800464 unsigned int major;
tang yuantian41ba57d2014-12-17 12:58:05 +0800465
Alison Wang036f3f32015-03-12 11:31:44 +0800466 major = get_soc_major_rev();
467 if (major == SOC_MAJOR_VER_1_0) {
468 /* Set CCI-400 control override register to
469 * enable barrier transaction */
470 out_le32(&cci->ctrl_ord, CCI400_CTRLORD_EN_BARRIER);
471 }
472
tang yuantian41ba57d2014-12-17 12:58:05 +0800473
Mingkai Hu435acd82015-10-26 19:47:41 +0800474#ifdef CONFIG_LAYERSCAPE_NS_ACCESS
475 enable_layerscape_ns_access();
tang yuantian41ba57d2014-12-17 12:58:05 +0800476#endif
477}
478#endif
479
Simon Glasse895a4b2014-10-23 18:58:47 -0600480int ft_board_setup(void *blob, bd_t *bd)
Wang Huan550e3dc2014-09-05 13:52:44 +0800481{
482 ft_cpu_setup(blob, bd);
Simon Glasse895a4b2014-10-23 18:58:47 -0600483
Minghuan Liand42bd342015-03-12 10:58:48 +0800484#ifdef CONFIG_PCI
485 ft_pci_setup(blob, bd);
Minghuan Lianda419022014-10-31 13:43:44 +0800486#endif
487
Simon Glasse895a4b2014-10-23 18:58:47 -0600488 return 0;
Wang Huan550e3dc2014-09-05 13:52:44 +0800489}
490
491u8 flash_read8(void *addr)
492{
493 return __raw_readb(addr + 1);
494}
495
496void flash_write16(u16 val, void *addr)
497{
498 u16 shftval = (((val >> 8) & 0xff) | ((val << 8) & 0xff00));
499
500 __raw_writew(shftval, addr);
501}
502
503u16 flash_read16(void *addr)
504{
505 u16 val = __raw_readw(addr);
506
507 return (((val) >> 8) & 0x00ff) | (((val) << 8) & 0xff00);
508}