1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun * (C) Copyright 2013 ADVANSEE
3*4882a593Smuzhiyun * Benoît Thébaudeau <benoit.thebaudeau@advansee.com>
4*4882a593Smuzhiyun *
5*4882a593Smuzhiyun * Based on Dirk Behme's
6*4882a593Smuzhiyun * https://github.com/dirkbehme/u-boot-imx6/blob/28b17e9/drivers/misc/imx_otp.c,
7*4882a593Smuzhiyun * which is based on Freescale's
8*4882a593Smuzhiyun * http://git.freescale.com/git/cgit.cgi/imx/uboot-imx.git/tree/drivers/misc/imx_otp.c?h=imx_v2009.08_1.1.0&id=9aa74e6,
9*4882a593Smuzhiyun * which is:
10*4882a593Smuzhiyun * Copyright (C) 2011 Freescale Semiconductor, Inc.
11*4882a593Smuzhiyun *
12*4882a593Smuzhiyun * SPDX-License-Identifier: GPL-2.0+
13*4882a593Smuzhiyun */
14*4882a593Smuzhiyun
15*4882a593Smuzhiyun #include <common.h>
16*4882a593Smuzhiyun #include <fuse.h>
17*4882a593Smuzhiyun #include <linux/errno.h>
18*4882a593Smuzhiyun #include <asm/io.h>
19*4882a593Smuzhiyun #include <asm/arch/clock.h>
20*4882a593Smuzhiyun #include <asm/arch/imx-regs.h>
21*4882a593Smuzhiyun #include <asm/mach-imx/sys_proto.h>
22*4882a593Smuzhiyun
23*4882a593Smuzhiyun #define BO_CTRL_WR_UNLOCK 16
24*4882a593Smuzhiyun #define BM_CTRL_WR_UNLOCK 0xffff0000
25*4882a593Smuzhiyun #define BV_CTRL_WR_UNLOCK_KEY 0x3e77
26*4882a593Smuzhiyun #define BM_CTRL_ERROR 0x00000200
27*4882a593Smuzhiyun #define BM_CTRL_BUSY 0x00000100
28*4882a593Smuzhiyun #define BO_CTRL_ADDR 0
29*4882a593Smuzhiyun #ifdef CONFIG_MX7
30*4882a593Smuzhiyun #define BM_CTRL_ADDR 0x0000000f
31*4882a593Smuzhiyun #define BM_CTRL_RELOAD 0x00000400
32*4882a593Smuzhiyun #elif defined(CONFIG_MX7ULP)
33*4882a593Smuzhiyun #define BM_CTRL_ADDR 0x000000FF
34*4882a593Smuzhiyun #define BM_CTRL_RELOAD 0x00000400
35*4882a593Smuzhiyun #define BM_OUT_STATUS_DED 0x00000400
36*4882a593Smuzhiyun #define BM_OUT_STATUS_LOCKED 0x00000800
37*4882a593Smuzhiyun #define BM_OUT_STATUS_PROGFAIL 0x00001000
38*4882a593Smuzhiyun #else
39*4882a593Smuzhiyun #define BM_CTRL_ADDR 0x0000007f
40*4882a593Smuzhiyun #endif
41*4882a593Smuzhiyun
42*4882a593Smuzhiyun #ifdef CONFIG_MX7
43*4882a593Smuzhiyun #define BO_TIMING_FSOURCE 12
44*4882a593Smuzhiyun #define BM_TIMING_FSOURCE 0x0007f000
45*4882a593Smuzhiyun #define BV_TIMING_FSOURCE_NS 1001
46*4882a593Smuzhiyun #define BO_TIMING_PROG 0
47*4882a593Smuzhiyun #define BM_TIMING_PROG 0x00000fff
48*4882a593Smuzhiyun #define BV_TIMING_PROG_US 10
49*4882a593Smuzhiyun #else
50*4882a593Smuzhiyun #define BO_TIMING_STROBE_READ 16
51*4882a593Smuzhiyun #define BM_TIMING_STROBE_READ 0x003f0000
52*4882a593Smuzhiyun #define BV_TIMING_STROBE_READ_NS 37
53*4882a593Smuzhiyun #define BO_TIMING_RELAX 12
54*4882a593Smuzhiyun #define BM_TIMING_RELAX 0x0000f000
55*4882a593Smuzhiyun #define BV_TIMING_RELAX_NS 17
56*4882a593Smuzhiyun #define BO_TIMING_STROBE_PROG 0
57*4882a593Smuzhiyun #define BM_TIMING_STROBE_PROG 0x00000fff
58*4882a593Smuzhiyun #define BV_TIMING_STROBE_PROG_US 10
59*4882a593Smuzhiyun #endif
60*4882a593Smuzhiyun
61*4882a593Smuzhiyun #define BM_READ_CTRL_READ_FUSE 0x00000001
62*4882a593Smuzhiyun
63*4882a593Smuzhiyun #define BF(value, field) (((value) << BO_##field) & BM_##field)
64*4882a593Smuzhiyun
65*4882a593Smuzhiyun #define WRITE_POSTAMBLE_US 2
66*4882a593Smuzhiyun
67*4882a593Smuzhiyun #if defined(CONFIG_MX6) || defined(CONFIG_VF610)
68*4882a593Smuzhiyun #define FUSE_BANK_SIZE 0x80
69*4882a593Smuzhiyun #ifdef CONFIG_MX6SL
70*4882a593Smuzhiyun #define FUSE_BANKS 8
71*4882a593Smuzhiyun #elif defined(CONFIG_MX6ULL) || defined(CONFIG_MX6SLL)
72*4882a593Smuzhiyun #define FUSE_BANKS 9
73*4882a593Smuzhiyun #else
74*4882a593Smuzhiyun #define FUSE_BANKS 16
75*4882a593Smuzhiyun #endif
76*4882a593Smuzhiyun #elif defined CONFIG_MX7
77*4882a593Smuzhiyun #define FUSE_BANK_SIZE 0x40
78*4882a593Smuzhiyun #define FUSE_BANKS 16
79*4882a593Smuzhiyun #elif defined(CONFIG_MX7ULP)
80*4882a593Smuzhiyun #define FUSE_BANK_SIZE 0x80
81*4882a593Smuzhiyun #define FUSE_BANKS 31
82*4882a593Smuzhiyun #else
83*4882a593Smuzhiyun #error "Unsupported architecture\n"
84*4882a593Smuzhiyun #endif
85*4882a593Smuzhiyun
86*4882a593Smuzhiyun #if defined(CONFIG_MX6)
87*4882a593Smuzhiyun
88*4882a593Smuzhiyun /*
89*4882a593Smuzhiyun * There is a hole in shadow registers address map of size 0x100
90*4882a593Smuzhiyun * between bank 5 and bank 6 on iMX6QP, iMX6DQ, iMX6SDL, iMX6SX,
91*4882a593Smuzhiyun * iMX6UL, i.MX6ULL and i.MX6SLL.
92*4882a593Smuzhiyun * Bank 5 ends at 0x6F0 and Bank 6 starts at 0x800. When reading the fuses,
93*4882a593Smuzhiyun * we should account for this hole in address space.
94*4882a593Smuzhiyun *
95*4882a593Smuzhiyun * Similar hole exists between bank 14 and bank 15 of size
96*4882a593Smuzhiyun * 0x80 on iMX6QP, iMX6DQ, iMX6SDL and iMX6SX.
97*4882a593Smuzhiyun * Note: iMX6SL has only 0-7 banks and there is no hole.
98*4882a593Smuzhiyun * Note: iMX6UL doesn't have this one.
99*4882a593Smuzhiyun *
100*4882a593Smuzhiyun * This function is to covert user input to physical bank index.
101*4882a593Smuzhiyun * Only needed when read fuse, because we use register offset, so
102*4882a593Smuzhiyun * need to calculate real register offset.
103*4882a593Smuzhiyun * When write, no need to consider hole, always use the bank/word
104*4882a593Smuzhiyun * index from fuse map.
105*4882a593Smuzhiyun */
fuse_bank_physical(int index)106*4882a593Smuzhiyun u32 fuse_bank_physical(int index)
107*4882a593Smuzhiyun {
108*4882a593Smuzhiyun u32 phy_index;
109*4882a593Smuzhiyun
110*4882a593Smuzhiyun if (is_mx6sl() || is_mx7ulp()) {
111*4882a593Smuzhiyun phy_index = index;
112*4882a593Smuzhiyun } else if (is_mx6ul() || is_mx6ull() || is_mx6sll()) {
113*4882a593Smuzhiyun if ((is_mx6ull() || is_mx6sll()) && index == 8)
114*4882a593Smuzhiyun index = 7;
115*4882a593Smuzhiyun
116*4882a593Smuzhiyun if (index >= 6)
117*4882a593Smuzhiyun phy_index = fuse_bank_physical(5) + (index - 6) + 3;
118*4882a593Smuzhiyun else
119*4882a593Smuzhiyun phy_index = index;
120*4882a593Smuzhiyun } else {
121*4882a593Smuzhiyun if (index >= 15)
122*4882a593Smuzhiyun phy_index = fuse_bank_physical(14) + (index - 15) + 2;
123*4882a593Smuzhiyun else if (index >= 6)
124*4882a593Smuzhiyun phy_index = fuse_bank_physical(5) + (index - 6) + 3;
125*4882a593Smuzhiyun else
126*4882a593Smuzhiyun phy_index = index;
127*4882a593Smuzhiyun }
128*4882a593Smuzhiyun return phy_index;
129*4882a593Smuzhiyun }
130*4882a593Smuzhiyun
fuse_word_physical(u32 bank,u32 word_index)131*4882a593Smuzhiyun u32 fuse_word_physical(u32 bank, u32 word_index)
132*4882a593Smuzhiyun {
133*4882a593Smuzhiyun if (is_mx6ull() || is_mx6sll()) {
134*4882a593Smuzhiyun if (bank == 8)
135*4882a593Smuzhiyun word_index = word_index + 4;
136*4882a593Smuzhiyun }
137*4882a593Smuzhiyun
138*4882a593Smuzhiyun return word_index;
139*4882a593Smuzhiyun }
140*4882a593Smuzhiyun #else
fuse_bank_physical(int index)141*4882a593Smuzhiyun u32 fuse_bank_physical(int index)
142*4882a593Smuzhiyun {
143*4882a593Smuzhiyun return index;
144*4882a593Smuzhiyun }
145*4882a593Smuzhiyun
fuse_word_physical(u32 bank,u32 word_index)146*4882a593Smuzhiyun u32 fuse_word_physical(u32 bank, u32 word_index)
147*4882a593Smuzhiyun {
148*4882a593Smuzhiyun return word_index;
149*4882a593Smuzhiyun }
150*4882a593Smuzhiyun
151*4882a593Smuzhiyun #endif
152*4882a593Smuzhiyun
wait_busy(struct ocotp_regs * regs,unsigned int delay_us)153*4882a593Smuzhiyun static void wait_busy(struct ocotp_regs *regs, unsigned int delay_us)
154*4882a593Smuzhiyun {
155*4882a593Smuzhiyun while (readl(®s->ctrl) & BM_CTRL_BUSY)
156*4882a593Smuzhiyun udelay(delay_us);
157*4882a593Smuzhiyun }
158*4882a593Smuzhiyun
clear_error(struct ocotp_regs * regs)159*4882a593Smuzhiyun static void clear_error(struct ocotp_regs *regs)
160*4882a593Smuzhiyun {
161*4882a593Smuzhiyun writel(BM_CTRL_ERROR, ®s->ctrl_clr);
162*4882a593Smuzhiyun }
163*4882a593Smuzhiyun
prepare_access(struct ocotp_regs ** regs,u32 bank,u32 word,int assert,const char * caller)164*4882a593Smuzhiyun static int prepare_access(struct ocotp_regs **regs, u32 bank, u32 word,
165*4882a593Smuzhiyun int assert, const char *caller)
166*4882a593Smuzhiyun {
167*4882a593Smuzhiyun *regs = (struct ocotp_regs *)OCOTP_BASE_ADDR;
168*4882a593Smuzhiyun
169*4882a593Smuzhiyun if (bank >= FUSE_BANKS ||
170*4882a593Smuzhiyun word >= ARRAY_SIZE((*regs)->bank[0].fuse_regs) >> 2 ||
171*4882a593Smuzhiyun !assert) {
172*4882a593Smuzhiyun printf("mxc_ocotp %s(): Invalid argument\n", caller);
173*4882a593Smuzhiyun return -EINVAL;
174*4882a593Smuzhiyun }
175*4882a593Smuzhiyun
176*4882a593Smuzhiyun if (is_mx6ull() || is_mx6sll()) {
177*4882a593Smuzhiyun if ((bank == 7 || bank == 8) &&
178*4882a593Smuzhiyun word >= ARRAY_SIZE((*regs)->bank[0].fuse_regs) >> 3) {
179*4882a593Smuzhiyun printf("mxc_ocotp %s(): Invalid argument\n", caller);
180*4882a593Smuzhiyun return -EINVAL;
181*4882a593Smuzhiyun }
182*4882a593Smuzhiyun }
183*4882a593Smuzhiyun
184*4882a593Smuzhiyun enable_ocotp_clk(1);
185*4882a593Smuzhiyun
186*4882a593Smuzhiyun wait_busy(*regs, 1);
187*4882a593Smuzhiyun clear_error(*regs);
188*4882a593Smuzhiyun
189*4882a593Smuzhiyun return 0;
190*4882a593Smuzhiyun }
191*4882a593Smuzhiyun
finish_access(struct ocotp_regs * regs,const char * caller)192*4882a593Smuzhiyun static int finish_access(struct ocotp_regs *regs, const char *caller)
193*4882a593Smuzhiyun {
194*4882a593Smuzhiyun u32 err;
195*4882a593Smuzhiyun
196*4882a593Smuzhiyun err = !!(readl(®s->ctrl) & BM_CTRL_ERROR);
197*4882a593Smuzhiyun clear_error(regs);
198*4882a593Smuzhiyun
199*4882a593Smuzhiyun #ifdef CONFIG_MX7ULP
200*4882a593Smuzhiyun /* Need to power down the OTP memory */
201*4882a593Smuzhiyun writel(1, ®s->pdn);
202*4882a593Smuzhiyun #endif
203*4882a593Smuzhiyun if (err) {
204*4882a593Smuzhiyun printf("mxc_ocotp %s(): Access protect error\n", caller);
205*4882a593Smuzhiyun return -EIO;
206*4882a593Smuzhiyun }
207*4882a593Smuzhiyun
208*4882a593Smuzhiyun return 0;
209*4882a593Smuzhiyun }
210*4882a593Smuzhiyun
prepare_read(struct ocotp_regs ** regs,u32 bank,u32 word,u32 * val,const char * caller)211*4882a593Smuzhiyun static int prepare_read(struct ocotp_regs **regs, u32 bank, u32 word, u32 *val,
212*4882a593Smuzhiyun const char *caller)
213*4882a593Smuzhiyun {
214*4882a593Smuzhiyun return prepare_access(regs, bank, word, val != NULL, caller);
215*4882a593Smuzhiyun }
216*4882a593Smuzhiyun
fuse_read(u32 bank,u32 word,u32 * val)217*4882a593Smuzhiyun int fuse_read(u32 bank, u32 word, u32 *val)
218*4882a593Smuzhiyun {
219*4882a593Smuzhiyun struct ocotp_regs *regs;
220*4882a593Smuzhiyun int ret;
221*4882a593Smuzhiyun u32 phy_bank;
222*4882a593Smuzhiyun u32 phy_word;
223*4882a593Smuzhiyun
224*4882a593Smuzhiyun ret = prepare_read(®s, bank, word, val, __func__);
225*4882a593Smuzhiyun if (ret)
226*4882a593Smuzhiyun return ret;
227*4882a593Smuzhiyun
228*4882a593Smuzhiyun phy_bank = fuse_bank_physical(bank);
229*4882a593Smuzhiyun phy_word = fuse_word_physical(bank, word);
230*4882a593Smuzhiyun
231*4882a593Smuzhiyun *val = readl(®s->bank[phy_bank].fuse_regs[phy_word << 2]);
232*4882a593Smuzhiyun
233*4882a593Smuzhiyun #ifdef CONFIG_MX7ULP
234*4882a593Smuzhiyun if (readl(®s->out_status) & BM_OUT_STATUS_DED) {
235*4882a593Smuzhiyun writel(BM_OUT_STATUS_DED, ®s->out_status_clr);
236*4882a593Smuzhiyun printf("mxc_ocotp %s(): fuse read wrong\n", __func__);
237*4882a593Smuzhiyun return -EIO;
238*4882a593Smuzhiyun }
239*4882a593Smuzhiyun #endif
240*4882a593Smuzhiyun return finish_access(regs, __func__);
241*4882a593Smuzhiyun }
242*4882a593Smuzhiyun
243*4882a593Smuzhiyun #ifdef CONFIG_MX7
set_timing(struct ocotp_regs * regs)244*4882a593Smuzhiyun static void set_timing(struct ocotp_regs *regs)
245*4882a593Smuzhiyun {
246*4882a593Smuzhiyun u32 ipg_clk;
247*4882a593Smuzhiyun u32 fsource, prog;
248*4882a593Smuzhiyun u32 timing;
249*4882a593Smuzhiyun
250*4882a593Smuzhiyun ipg_clk = mxc_get_clock(MXC_IPG_CLK);
251*4882a593Smuzhiyun
252*4882a593Smuzhiyun fsource = DIV_ROUND_UP((ipg_clk / 1000) * BV_TIMING_FSOURCE_NS,
253*4882a593Smuzhiyun + 1000000) + 1;
254*4882a593Smuzhiyun prog = DIV_ROUND_CLOSEST(ipg_clk * BV_TIMING_PROG_US, 1000000) + 1;
255*4882a593Smuzhiyun
256*4882a593Smuzhiyun timing = BF(fsource, TIMING_FSOURCE) | BF(prog, TIMING_PROG);
257*4882a593Smuzhiyun
258*4882a593Smuzhiyun clrsetbits_le32(®s->timing, BM_TIMING_FSOURCE | BM_TIMING_PROG,
259*4882a593Smuzhiyun timing);
260*4882a593Smuzhiyun }
261*4882a593Smuzhiyun #elif defined(CONFIG_MX7ULP)
set_timing(struct ocotp_regs * regs)262*4882a593Smuzhiyun static void set_timing(struct ocotp_regs *regs)
263*4882a593Smuzhiyun {
264*4882a593Smuzhiyun /* No timing set for MX7ULP */
265*4882a593Smuzhiyun }
266*4882a593Smuzhiyun
267*4882a593Smuzhiyun #else
set_timing(struct ocotp_regs * regs)268*4882a593Smuzhiyun static void set_timing(struct ocotp_regs *regs)
269*4882a593Smuzhiyun {
270*4882a593Smuzhiyun u32 ipg_clk;
271*4882a593Smuzhiyun u32 relax, strobe_read, strobe_prog;
272*4882a593Smuzhiyun u32 timing;
273*4882a593Smuzhiyun
274*4882a593Smuzhiyun ipg_clk = mxc_get_clock(MXC_IPG_CLK);
275*4882a593Smuzhiyun
276*4882a593Smuzhiyun relax = DIV_ROUND_UP(ipg_clk * BV_TIMING_RELAX_NS, 1000000000) - 1;
277*4882a593Smuzhiyun strobe_read = DIV_ROUND_UP(ipg_clk * BV_TIMING_STROBE_READ_NS,
278*4882a593Smuzhiyun 1000000000) + 2 * (relax + 1) - 1;
279*4882a593Smuzhiyun strobe_prog = DIV_ROUND_CLOSEST(ipg_clk * BV_TIMING_STROBE_PROG_US,
280*4882a593Smuzhiyun 1000000) + 2 * (relax + 1) - 1;
281*4882a593Smuzhiyun
282*4882a593Smuzhiyun timing = BF(strobe_read, TIMING_STROBE_READ) |
283*4882a593Smuzhiyun BF(relax, TIMING_RELAX) |
284*4882a593Smuzhiyun BF(strobe_prog, TIMING_STROBE_PROG);
285*4882a593Smuzhiyun
286*4882a593Smuzhiyun clrsetbits_le32(®s->timing, BM_TIMING_STROBE_READ | BM_TIMING_RELAX |
287*4882a593Smuzhiyun BM_TIMING_STROBE_PROG, timing);
288*4882a593Smuzhiyun }
289*4882a593Smuzhiyun #endif
290*4882a593Smuzhiyun
setup_direct_access(struct ocotp_regs * regs,u32 bank,u32 word,int write)291*4882a593Smuzhiyun static void setup_direct_access(struct ocotp_regs *regs, u32 bank, u32 word,
292*4882a593Smuzhiyun int write)
293*4882a593Smuzhiyun {
294*4882a593Smuzhiyun u32 wr_unlock = write ? BV_CTRL_WR_UNLOCK_KEY : 0;
295*4882a593Smuzhiyun #ifdef CONFIG_MX7
296*4882a593Smuzhiyun u32 addr = bank;
297*4882a593Smuzhiyun #else
298*4882a593Smuzhiyun u32 addr;
299*4882a593Smuzhiyun /* Bank 7 and Bank 8 only supports 4 words each for i.MX6ULL */
300*4882a593Smuzhiyun if ((is_mx6ull() || is_mx6sll()) && (bank > 7)) {
301*4882a593Smuzhiyun bank = bank - 1;
302*4882a593Smuzhiyun word += 4;
303*4882a593Smuzhiyun }
304*4882a593Smuzhiyun addr = bank << 3 | word;
305*4882a593Smuzhiyun #endif
306*4882a593Smuzhiyun
307*4882a593Smuzhiyun set_timing(regs);
308*4882a593Smuzhiyun clrsetbits_le32(®s->ctrl, BM_CTRL_WR_UNLOCK | BM_CTRL_ADDR,
309*4882a593Smuzhiyun BF(wr_unlock, CTRL_WR_UNLOCK) |
310*4882a593Smuzhiyun BF(addr, CTRL_ADDR));
311*4882a593Smuzhiyun }
312*4882a593Smuzhiyun
fuse_sense(u32 bank,u32 word,u32 * val)313*4882a593Smuzhiyun int fuse_sense(u32 bank, u32 word, u32 *val)
314*4882a593Smuzhiyun {
315*4882a593Smuzhiyun struct ocotp_regs *regs;
316*4882a593Smuzhiyun int ret;
317*4882a593Smuzhiyun
318*4882a593Smuzhiyun ret = prepare_read(®s, bank, word, val, __func__);
319*4882a593Smuzhiyun if (ret)
320*4882a593Smuzhiyun return ret;
321*4882a593Smuzhiyun
322*4882a593Smuzhiyun setup_direct_access(regs, bank, word, false);
323*4882a593Smuzhiyun writel(BM_READ_CTRL_READ_FUSE, ®s->read_ctrl);
324*4882a593Smuzhiyun wait_busy(regs, 1);
325*4882a593Smuzhiyun #ifdef CONFIG_MX7
326*4882a593Smuzhiyun *val = readl((®s->read_fuse_data0) + (word << 2));
327*4882a593Smuzhiyun #else
328*4882a593Smuzhiyun *val = readl(®s->read_fuse_data);
329*4882a593Smuzhiyun #endif
330*4882a593Smuzhiyun
331*4882a593Smuzhiyun #ifdef CONFIG_MX7ULP
332*4882a593Smuzhiyun if (readl(®s->out_status) & BM_OUT_STATUS_DED) {
333*4882a593Smuzhiyun writel(BM_OUT_STATUS_DED, ®s->out_status_clr);
334*4882a593Smuzhiyun printf("mxc_ocotp %s(): fuse read wrong\n", __func__);
335*4882a593Smuzhiyun return -EIO;
336*4882a593Smuzhiyun }
337*4882a593Smuzhiyun #endif
338*4882a593Smuzhiyun
339*4882a593Smuzhiyun return finish_access(regs, __func__);
340*4882a593Smuzhiyun }
341*4882a593Smuzhiyun
prepare_write(struct ocotp_regs ** regs,u32 bank,u32 word,const char * caller)342*4882a593Smuzhiyun static int prepare_write(struct ocotp_regs **regs, u32 bank, u32 word,
343*4882a593Smuzhiyun const char *caller)
344*4882a593Smuzhiyun {
345*4882a593Smuzhiyun return prepare_access(regs, bank, word, true, caller);
346*4882a593Smuzhiyun }
347*4882a593Smuzhiyun
fuse_prog(u32 bank,u32 word,u32 val)348*4882a593Smuzhiyun int fuse_prog(u32 bank, u32 word, u32 val)
349*4882a593Smuzhiyun {
350*4882a593Smuzhiyun struct ocotp_regs *regs;
351*4882a593Smuzhiyun int ret;
352*4882a593Smuzhiyun
353*4882a593Smuzhiyun ret = prepare_write(®s, bank, word, __func__);
354*4882a593Smuzhiyun if (ret)
355*4882a593Smuzhiyun return ret;
356*4882a593Smuzhiyun
357*4882a593Smuzhiyun setup_direct_access(regs, bank, word, true);
358*4882a593Smuzhiyun #ifdef CONFIG_MX7
359*4882a593Smuzhiyun switch (word) {
360*4882a593Smuzhiyun case 0:
361*4882a593Smuzhiyun writel(0, ®s->data1);
362*4882a593Smuzhiyun writel(0, ®s->data2);
363*4882a593Smuzhiyun writel(0, ®s->data3);
364*4882a593Smuzhiyun writel(val, ®s->data0);
365*4882a593Smuzhiyun break;
366*4882a593Smuzhiyun case 1:
367*4882a593Smuzhiyun writel(val, ®s->data1);
368*4882a593Smuzhiyun writel(0, ®s->data2);
369*4882a593Smuzhiyun writel(0, ®s->data3);
370*4882a593Smuzhiyun writel(0, ®s->data0);
371*4882a593Smuzhiyun break;
372*4882a593Smuzhiyun case 2:
373*4882a593Smuzhiyun writel(0, ®s->data1);
374*4882a593Smuzhiyun writel(val, ®s->data2);
375*4882a593Smuzhiyun writel(0, ®s->data3);
376*4882a593Smuzhiyun writel(0, ®s->data0);
377*4882a593Smuzhiyun break;
378*4882a593Smuzhiyun case 3:
379*4882a593Smuzhiyun writel(0, ®s->data1);
380*4882a593Smuzhiyun writel(0, ®s->data2);
381*4882a593Smuzhiyun writel(val, ®s->data3);
382*4882a593Smuzhiyun writel(0, ®s->data0);
383*4882a593Smuzhiyun break;
384*4882a593Smuzhiyun }
385*4882a593Smuzhiyun wait_busy(regs, BV_TIMING_PROG_US);
386*4882a593Smuzhiyun #else
387*4882a593Smuzhiyun writel(val, ®s->data);
388*4882a593Smuzhiyun wait_busy(regs, BV_TIMING_STROBE_PROG_US);
389*4882a593Smuzhiyun #endif
390*4882a593Smuzhiyun udelay(WRITE_POSTAMBLE_US);
391*4882a593Smuzhiyun
392*4882a593Smuzhiyun #ifdef CONFIG_MX7ULP
393*4882a593Smuzhiyun if (readl(®s->out_status) & (BM_OUT_STATUS_PROGFAIL | BM_OUT_STATUS_LOCKED)) {
394*4882a593Smuzhiyun writel((BM_OUT_STATUS_PROGFAIL | BM_OUT_STATUS_LOCKED), ®s->out_status_clr);
395*4882a593Smuzhiyun printf("mxc_ocotp %s(): fuse write is failed\n", __func__);
396*4882a593Smuzhiyun return -EIO;
397*4882a593Smuzhiyun }
398*4882a593Smuzhiyun #endif
399*4882a593Smuzhiyun
400*4882a593Smuzhiyun return finish_access(regs, __func__);
401*4882a593Smuzhiyun }
402*4882a593Smuzhiyun
fuse_override(u32 bank,u32 word,u32 val)403*4882a593Smuzhiyun int fuse_override(u32 bank, u32 word, u32 val)
404*4882a593Smuzhiyun {
405*4882a593Smuzhiyun struct ocotp_regs *regs;
406*4882a593Smuzhiyun int ret;
407*4882a593Smuzhiyun u32 phy_bank;
408*4882a593Smuzhiyun u32 phy_word;
409*4882a593Smuzhiyun
410*4882a593Smuzhiyun ret = prepare_write(®s, bank, word, __func__);
411*4882a593Smuzhiyun if (ret)
412*4882a593Smuzhiyun return ret;
413*4882a593Smuzhiyun
414*4882a593Smuzhiyun phy_bank = fuse_bank_physical(bank);
415*4882a593Smuzhiyun phy_word = fuse_word_physical(bank, word);
416*4882a593Smuzhiyun
417*4882a593Smuzhiyun writel(val, ®s->bank[phy_bank].fuse_regs[phy_word << 2]);
418*4882a593Smuzhiyun
419*4882a593Smuzhiyun #ifdef CONFIG_MX7ULP
420*4882a593Smuzhiyun if (readl(®s->out_status) & (BM_OUT_STATUS_PROGFAIL | BM_OUT_STATUS_LOCKED)) {
421*4882a593Smuzhiyun writel((BM_OUT_STATUS_PROGFAIL | BM_OUT_STATUS_LOCKED), ®s->out_status_clr);
422*4882a593Smuzhiyun printf("mxc_ocotp %s(): fuse write is failed\n", __func__);
423*4882a593Smuzhiyun return -EIO;
424*4882a593Smuzhiyun }
425*4882a593Smuzhiyun #endif
426*4882a593Smuzhiyun
427*4882a593Smuzhiyun return finish_access(regs, __func__);
428*4882a593Smuzhiyun }
429