2 * (C) Copyright 2012-2013, Xilinx, Michal Simek
5 * Joe Hershberger <joe.hershberger@ni.com>
7 * SPDX-License-Identifier: GPL-2.0+
13 #include <linux/sizes.h>
14 #include <asm/arch/hardware.h>
15 #include <asm/arch/sys_proto.h>
17 #define DEVCFG_CTRL_PCFG_PROG_B 0x40000000
18 #define DEVCFG_ISR_FATAL_ERROR_MASK 0x00740040
19 #define DEVCFG_ISR_ERROR_FLAGS_MASK 0x00340840
20 #define DEVCFG_ISR_RX_FIFO_OV 0x00040000
21 #define DEVCFG_ISR_DMA_DONE 0x00002000
22 #define DEVCFG_ISR_PCFG_DONE 0x00000004
23 #define DEVCFG_STATUS_DMA_CMD_Q_F 0x80000000
24 #define DEVCFG_STATUS_DMA_CMD_Q_E 0x40000000
25 #define DEVCFG_STATUS_DMA_DONE_CNT_MASK 0x30000000
26 #define DEVCFG_STATUS_PCFG_INIT 0x00000010
27 #define DEVCFG_MCTRL_PCAP_LPBK 0x00000010
28 #define DEVCFG_MCTRL_RFIFO_FLUSH 0x00000002
29 #define DEVCFG_MCTRL_WFIFO_FLUSH 0x00000001
31 #ifndef CONFIG_SYS_FPGA_WAIT
32 #define CONFIG_SYS_FPGA_WAIT CONFIG_SYS_HZ/100 /* 10 ms */
35 #ifndef CONFIG_SYS_FPGA_PROG_TIME
36 #define CONFIG_SYS_FPGA_PROG_TIME (CONFIG_SYS_HZ * 4) /* 4 s */
39 int zynq_info(Xilinx_desc
*desc
)
44 #define DUMMY_WORD 0xffffffff
46 /* Xilinx binary format header */
47 static const u32 bin_format
[] = {
48 DUMMY_WORD
, /* Dummy words */
56 0x000000bb, /* Sync word */
57 0x11220044, /* Sync word */
60 0xaa995566, /* Sync word */
67 * Load the whole word from unaligned buffer
68 * Keep in your mind that it is byte loading on little-endian system
70 static u32
load_word(const void *buf
, u32 swap
)
76 if (swap
== SWAP_NO
) {
77 for (p
= 0; p
< 4; p
++) {
82 for (p
= 3; p
>= 0; p
--) {
91 static u32
check_header(const void *buf
)
95 u32
*test
= (u32
*)buf
;
97 debug("%s: Let's check bitstream header\n", __func__
);
99 /* Checking that passing bin is not a bitstream */
100 for (i
= 0; i
< ARRAY_SIZE(bin_format
); i
++) {
101 pattern
= load_word(&test
[i
], swap
);
104 * Bitstreams in binary format are swapped
105 * compare to regular bistream.
106 * Do not swap dummy word but if swap is done assume
107 * that parsing buffer is binary format
109 if ((__swab32(pattern
) != DUMMY_WORD
) &&
110 (__swab32(pattern
) == bin_format
[i
])) {
111 pattern
= __swab32(pattern
);
113 debug("%s: data swapped - let's swap\n", __func__
);
116 debug("%s: %d/%x: pattern %x/%x bin_format\n", __func__
, i
,
117 (u32
)&test
[i
], pattern
, bin_format
[i
]);
118 if (pattern
!= bin_format
[i
]) {
119 debug("%s: Bitstream is not recognized\n", __func__
);
123 debug("%s: Found bitstream header at %x %s swapinng\n", __func__
,
124 (u32
)buf
, swap
== SWAP_NO
? "without" : "with");
129 static void *check_data(u8
*buf
, size_t bsize
, u32
*swap
)
131 u32 word
, p
= 0; /* possition */
133 /* Because buf doesn't need to be aligned let's read it by chars */
134 for (p
= 0; p
< bsize
; p
++) {
135 word
= load_word(&buf
[p
], SWAP_NO
);
136 debug("%s: word %x %x/%x\n", __func__
, word
, p
, (u32
)&buf
[p
]);
138 /* Find the first bitstream dummy word */
139 if (word
== DUMMY_WORD
) {
140 debug("%s: Found dummy word at position %x/%x\n",
141 __func__
, p
, (u32
)&buf
[p
]);
142 *swap
= check_header(&buf
[p
]);
144 /* FIXME add full bitstream checking here */
148 /* Loop can be huge - support CTRL + C */
156 int zynq_load(Xilinx_desc
*desc
, const void *buf
, size_t bsize
)
158 unsigned long ts
; /* Timestamp */
160 u32 i
, control
, isr_status
, status
, swap
, diff
;
163 /* Detect if we are going working with partial or full bitstream */
164 if (bsize
!= desc
->size
) {
165 printf("%s: Working with partial bitstream\n", __func__
);
169 buf_start
= check_data((u8
*)buf
, bsize
, &swap
);
173 /* Check if data is postpone from start */
174 diff
= (u32
)buf_start
- (u32
)buf
;
176 printf("%s: Bitstream is not validated yet (diff %x)\n",
181 if ((u32
)buf
< SZ_1M
) {
182 printf("%s: Bitstream has to be placed up to 1MB (%x)\n",
187 if ((u32
)buf
!= ALIGN((u32
)buf
, ARCH_DMA_MINALIGN
)) {
188 u32
*new_buf
= (u32
*)ALIGN((u32
)buf
, ARCH_DMA_MINALIGN
);
191 * This might be dangerous but permits to flash if
192 * ARCH_DMA_MINALIGN is greater than header size
194 if (new_buf
> buf_start
) {
195 debug("%s: Aligned buffer is after buffer start\n",
197 new_buf
-= ARCH_DMA_MINALIGN
;
200 printf("%s: Align buffer at %x to %x(swap %d)\n", __func__
,
201 (u32
)buf_start
, (u32
)new_buf
, swap
);
203 for (i
= 0; i
< (bsize
/4); i
++)
204 new_buf
[i
] = load_word(&buf_start
[i
], swap
);
208 } else if (swap
!= SWAP_DONE
) {
209 /* For bitstream which are aligned */
210 u32
*new_buf
= (u32
*)buf
;
212 printf("%s: Bitstream is not swapped(%d) - swap it\n", __func__
,
215 for (i
= 0; i
< (bsize
/4); i
++)
216 new_buf
[i
] = load_word(&buf_start
[i
], swap
);
221 /* Clear loopback bit */
222 clrbits_le32(&devcfg_base
->mctrl
, DEVCFG_MCTRL_PCAP_LPBK
);
225 zynq_slcr_devcfg_disable();
227 /* Setting PCFG_PROG_B signal to high */
228 control
= readl(&devcfg_base
->ctrl
);
229 writel(control
| DEVCFG_CTRL_PCFG_PROG_B
, &devcfg_base
->ctrl
);
230 /* Setting PCFG_PROG_B signal to low */
231 writel(control
& ~DEVCFG_CTRL_PCFG_PROG_B
, &devcfg_base
->ctrl
);
233 /* Polling the PCAP_INIT status for Reset */
235 while (readl(&devcfg_base
->status
) & DEVCFG_STATUS_PCFG_INIT
) {
236 if (get_timer(ts
) > CONFIG_SYS_FPGA_WAIT
) {
237 printf("%s: Timeout wait for INIT to clear\n",
243 /* Setting PCFG_PROG_B signal to high */
244 writel(control
| DEVCFG_CTRL_PCFG_PROG_B
, &devcfg_base
->ctrl
);
246 /* Polling the PCAP_INIT status for Set */
248 while (!(readl(&devcfg_base
->status
) &
249 DEVCFG_STATUS_PCFG_INIT
)) {
250 if (get_timer(ts
) > CONFIG_SYS_FPGA_WAIT
) {
251 printf("%s: Timeout wait for INIT to set\n",
258 isr_status
= readl(&devcfg_base
->int_sts
);
260 /* Clear it all, so if Boot ROM comes back, it can proceed */
261 writel(0xFFFFFFFF, &devcfg_base
->int_sts
);
263 if (isr_status
& DEVCFG_ISR_FATAL_ERROR_MASK
) {
264 debug("%s: Fatal errors in PCAP 0x%X\n", __func__
, isr_status
);
266 /* If RX FIFO overflow, need to flush RX FIFO first */
267 if (isr_status
& DEVCFG_ISR_RX_FIFO_OV
) {
268 writel(DEVCFG_MCTRL_RFIFO_FLUSH
, &devcfg_base
->mctrl
);
269 writel(0xFFFFFFFF, &devcfg_base
->int_sts
);
274 status
= readl(&devcfg_base
->status
);
276 debug("%s: Status = 0x%08X\n", __func__
, status
);
278 if (status
& DEVCFG_STATUS_DMA_CMD_Q_F
) {
279 debug("%s: Error: device busy\n", __func__
);
283 debug("%s: Device ready\n", __func__
);
285 if (!(status
& DEVCFG_STATUS_DMA_CMD_Q_E
)) {
286 if (!(readl(&devcfg_base
->int_sts
) & DEVCFG_ISR_DMA_DONE
)) {
287 /* Error state, transfer cannot occur */
288 debug("%s: ISR indicates error\n", __func__
);
291 /* Clear out the status */
292 writel(DEVCFG_ISR_DMA_DONE
, &devcfg_base
->int_sts
);
296 if (status
& DEVCFG_STATUS_DMA_DONE_CNT_MASK
) {
297 /* Clear the count of completed DMA transfers */
298 writel(DEVCFG_STATUS_DMA_DONE_CNT_MASK
, &devcfg_base
->status
);
301 debug("%s: Source = 0x%08X\n", __func__
, (u32
)buf
);
302 debug("%s: Size = %zu\n", __func__
, bsize
);
304 /* flush(clean & invalidate) d-cache range buf */
305 flush_dcache_range((u32
)buf
, (u32
)buf
+
306 roundup(bsize
, ARCH_DMA_MINALIGN
));
308 /* Set up the transfer */
309 writel((u32
)buf
| 1, &devcfg_base
->dma_src_addr
);
310 writel(0xFFFFFFFF, &devcfg_base
->dma_dst_addr
);
311 writel(bsize
>> 2, &devcfg_base
->dma_src_len
);
312 writel(0, &devcfg_base
->dma_dst_len
);
314 isr_status
= readl(&devcfg_base
->int_sts
);
316 /* Polling the PCAP_INIT status for Set */
318 while (!(isr_status
& DEVCFG_ISR_DMA_DONE
)) {
319 if (isr_status
& DEVCFG_ISR_ERROR_FLAGS_MASK
) {
320 debug("%s: Error: isr = 0x%08X\n", __func__
,
322 debug("%s: Write count = 0x%08X\n", __func__
,
323 readl(&devcfg_base
->write_count
));
324 debug("%s: Read count = 0x%08X\n", __func__
,
325 readl(&devcfg_base
->read_count
));
329 if (get_timer(ts
) > CONFIG_SYS_FPGA_PROG_TIME
) {
330 printf("%s: Timeout wait for DMA to complete\n",
334 isr_status
= readl(&devcfg_base
->int_sts
);
337 debug("%s: DMA transfer is done\n", __func__
);
339 /* Check FPGA configuration completion */
341 while (!(isr_status
& DEVCFG_ISR_PCFG_DONE
)) {
342 if (get_timer(ts
) > CONFIG_SYS_FPGA_WAIT
) {
343 printf("%s: Timeout wait for FPGA to config\n",
347 isr_status
= readl(&devcfg_base
->int_sts
);
350 debug("%s: FPGA config done\n", __func__
);
352 /* Clear out the DMA status */
353 writel(DEVCFG_ISR_DMA_DONE
, &devcfg_base
->int_sts
);
356 zynq_slcr_devcfg_enable();
361 int zynq_dump(Xilinx_desc
*desc
, const void *buf
, size_t bsize
)