1 // SPDX-License-Identifier: GPL-2.0
3 * (C) Copyright 2015 - 2016, Xilinx, Inc,
4 * Michal Simek <michal.simek@xilinx.com>
5 * Siva Durga Prasad <siva.durga.paladugu@xilinx.com>
12 #include <zynqmp_firmware.h>
13 #include <linux/sizes.h>
14 #include <asm/arch/sys_proto.h>
17 #define DUMMY_WORD 0xffffffff
19 /* Xilinx binary format header */
20 static const u32 bin_format
[] = {
21 DUMMY_WORD
, /* Dummy words */
37 0x000000bb, /* Sync word */
38 0x11220044, /* Sync word */
41 0xaa995566, /* Sync word */
48 * Load the whole word from unaligned buffer
49 * Keep in your mind that it is byte loading on little-endian system
51 static u32
load_word(const void *buf
, u32 swap
)
57 if (swap
== SWAP_NO
) {
58 for (p
= 0; p
< 4; p
++) {
63 for (p
= 3; p
>= 0; p
--) {
72 static u32
check_header(const void *buf
)
76 u32
*test
= (u32
*)buf
;
78 debug("%s: Let's check bitstream header\n", __func__
);
80 /* Checking that passing bin is not a bitstream */
81 for (i
= 0; i
< ARRAY_SIZE(bin_format
); i
++) {
82 pattern
= load_word(&test
[i
], swap
);
85 * Bitstreams in binary format are swapped
86 * compare to regular bistream.
87 * Do not swap dummy word but if swap is done assume
88 * that parsing buffer is binary format
90 if ((__swab32(pattern
) != DUMMY_WORD
) &&
91 (__swab32(pattern
) == bin_format
[i
])) {
93 debug("%s: data swapped - let's swap\n", __func__
);
96 debug("%s: %d/%px: pattern %x/%x bin_format\n", __func__
, i
,
97 &test
[i
], pattern
, bin_format
[i
]);
99 debug("%s: Found bitstream header at %px %s swapinng\n", __func__
,
100 buf
, swap
== SWAP_NO
? "without" : "with");
105 static void *check_data(u8
*buf
, size_t bsize
, u32
*swap
)
107 u32 word
, p
= 0; /* possition */
109 /* Because buf doesn't need to be aligned let's read it by chars */
110 for (p
= 0; p
< bsize
; p
++) {
111 word
= load_word(&buf
[p
], SWAP_NO
);
112 debug("%s: word %x %x/%px\n", __func__
, word
, p
, &buf
[p
]);
114 /* Find the first bitstream dummy word */
115 if (word
== DUMMY_WORD
) {
116 debug("%s: Found dummy word at position %x/%px\n",
117 __func__
, p
, &buf
[p
]);
118 *swap
= check_header(&buf
[p
]);
120 /* FIXME add full bitstream checking here */
124 /* Loop can be huge - support CTRL + C */
131 static ulong
zynqmp_align_dma_buffer(u32
*buf
, u32 len
, u32 swap
)
136 if ((ulong
)buf
!= ALIGN((ulong
)buf
, ARCH_DMA_MINALIGN
)) {
137 new_buf
= (u32
*)ALIGN((ulong
)buf
, ARCH_DMA_MINALIGN
);
140 * This might be dangerous but permits to flash if
141 * ARCH_DMA_MINALIGN is greater than header size
143 if (new_buf
> (u32
*)buf
) {
144 debug("%s: Aligned buffer is after buffer start\n",
146 new_buf
-= ARCH_DMA_MINALIGN
;
148 printf("%s: Align buffer at %px to %px(swap %d)\n", __func__
,
151 for (i
= 0; i
< (len
/4); i
++)
152 new_buf
[i
] = load_word(&buf
[i
], swap
);
155 } else if ((swap
!= SWAP_DONE
) &&
156 (zynqmp_firmware_version() <= PMUFW_V1_0
)) {
157 /* For bitstream which are aligned */
160 printf("%s: Bitstream is not swapped(%d) - swap it\n", __func__
,
163 for (i
= 0; i
< (len
/4); i
++)
164 new_buf
[i
] = load_word(&buf
[i
], swap
);
170 static int zynqmp_validate_bitstream(xilinx_desc
*desc
, const void *buf
,
171 size_t bsize
, u32 blocksize
, u32
*swap
)
176 buf_start
= check_data((u8
*)buf
, blocksize
, swap
);
181 /* Check if data is postpone from start */
182 diff
= (ulong
)buf_start
- (ulong
)buf
;
184 printf("%s: Bitstream is not validated yet (diff %lx)\n",
189 if ((ulong
)buf
< SZ_1M
) {
190 printf("%s: Bitstream has to be placed up to 1MB (%px)\n",
198 static int zynqmp_load(xilinx_desc
*desc
, const void *buf
, size_t bsize
,
199 bitstream_type bstype
)
201 ALLOC_CACHE_ALIGN_BUFFER(u32
, bsizeptr
, 1);
206 u32 ret_payload
[PAYLOAD_ARG_CNT
];
207 bool xilfpga_old
= false;
209 if (zynqmp_firmware_version() <= PMUFW_V1_0
) {
210 puts("WARN: PMUFW v1.0 or less is detected\n");
211 puts("WARN: Not all bitstream formats are supported\n");
212 puts("WARN: Please upgrade PMUFW\n");
214 if (zynqmp_validate_bitstream(desc
, buf
, bsize
, bsize
, &swap
))
216 bsizeptr
= (u32
*)&bsize
;
217 flush_dcache_range((ulong
)bsizeptr
,
218 (ulong
)bsizeptr
+ sizeof(size_t));
219 bstype
|= BIT(ZYNQMP_FPGA_BIT_NS
);
222 bin_buf
= zynqmp_align_dma_buffer((u32
*)buf
, bsize
, swap
);
224 debug("%s called!\n", __func__
);
225 flush_dcache_range(bin_buf
, bin_buf
+ bsize
);
227 buf_lo
= (u32
)bin_buf
;
228 buf_hi
= upper_32_bits(bin_buf
);
231 ret
= xilinx_pm_request(ZYNQMP_SIP_SVC_PM_FPGA_LOAD
, buf_lo
,
232 buf_hi
, (u32
)(uintptr_t)bsizeptr
,
233 bstype
, ret_payload
);
235 ret
= xilinx_pm_request(ZYNQMP_SIP_SVC_PM_FPGA_LOAD
, buf_lo
,
236 buf_hi
, (u32
)bsize
, 0, ret_payload
);
239 puts("PL FPGA LOAD fail\n");
244 #if defined(CONFIG_CMD_FPGA_LOAD_SECURE) && !defined(CONFIG_SPL_BUILD)
245 static int zynqmp_loads(xilinx_desc
*desc
, const void *buf
, size_t bsize
,
246 struct fpga_secure_info
*fpga_sec_info
)
250 u32 ret_payload
[PAYLOAD_ARG_CNT
];
253 flush_dcache_range((ulong
)buf
, (ulong
)buf
+
254 ALIGN(bsize
, CONFIG_SYS_CACHELINE_SIZE
));
256 if (!fpga_sec_info
->encflag
)
257 flag
|= BIT(ZYNQMP_FPGA_BIT_ENC_DEV_KEY
);
259 if (fpga_sec_info
->userkey_addr
&&
260 fpga_sec_info
->encflag
== FPGA_ENC_USR_KEY
) {
261 flush_dcache_range((ulong
)fpga_sec_info
->userkey_addr
,
262 (ulong
)fpga_sec_info
->userkey_addr
+
264 CONFIG_SYS_CACHELINE_SIZE
));
265 flag
|= BIT(ZYNQMP_FPGA_BIT_ENC_USR_KEY
);
268 if (!fpga_sec_info
->authflag
)
269 flag
|= BIT(ZYNQMP_FPGA_BIT_AUTH_OCM
);
271 if (fpga_sec_info
->authflag
== ZYNQMP_FPGA_AUTH_DDR
)
272 flag
|= BIT(ZYNQMP_FPGA_BIT_AUTH_DDR
);
274 buf_lo
= lower_32_bits((ulong
)buf
);
275 buf_hi
= upper_32_bits((ulong
)buf
);
277 ret
= xilinx_pm_request(ZYNQMP_SIP_SVC_PM_FPGA_LOAD
, buf_lo
,
279 (u32
)(uintptr_t)fpga_sec_info
->userkey_addr
,
282 puts("PL FPGA LOAD fail\n");
284 puts("Bitstream successfully loaded\n");
290 static int zynqmp_pcap_info(xilinx_desc
*desc
)
293 u32 ret_payload
[PAYLOAD_ARG_CNT
];
295 ret
= xilinx_pm_request(ZYNQMP_SIP_SVC_PM_FPGA_STATUS
, 0, 0, 0,
298 printf("PCAP status\t0x%x\n", ret_payload
[1]);
303 struct xilinx_fpga_op zynqmp_op
= {
305 #if defined CONFIG_CMD_FPGA_LOAD_SECURE
306 .loads
= zynqmp_loads
,
308 .info
= zynqmp_pcap_info
,