2 * This program is free software; you can redistribute it and/or modify
3 * it under the terms of the GNU General Public License as published by
4 * the Free Software Foundation; either version 2 of the License, or
5 * (at your option) any later version.
7 * This program is distributed in the hope that it will be useful,
8 * but WITHOUT ANY WARRANTY; without even the implied warranty of
9 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
10 * GNU General Public License for more details.
13 #include <linux/kernel.h>
14 #include <linux/init.h>
15 #include <linux/module.h>
16 #include <linux/types.h>
17 #include <linux/device.h>
18 #include <linux/string.h>
19 #include <linux/slab.h>
21 #include <linux/platform_device.h>
23 #include <linux/delay.h>
25 #include <linux/firmware.h>
27 #include "gs_fpgaboot.h"
30 #define DEVICE_NAME "device"
31 #define CLASS_NAME "fpgaboot"
33 static u8 bits_magic[] = {
34 0x0, 0x9, 0xf, 0xf0, 0xf, 0xf0,
35 0xf, 0xf0, 0xf, 0xf0, 0x0, 0x0, 0x1};
37 /* fake device for request_firmware */
38 static struct platform_device *firmware_pdev;
40 static char *file = "xlinx_fpga_firmware.bit";
41 module_param(file, charp, S_IRUGO);
42 MODULE_PARM_DESC(file, "Xilinx FPGA firmware file.");
44 static void read_bitstream(char *bitdata, char *buf, int *offset, int rdsize)
46 memcpy(buf, bitdata + *offset, rdsize);
50 static void readinfo_bitstream(char *bitdata, char *buf, int *offset)
55 /* read section char */
56 read_bitstream(bitdata, tbuf, offset, 1);
59 read_bitstream(bitdata, tbuf, offset, 2);
61 len = tbuf[0] << 8 | tbuf[1];
63 read_bitstream(bitdata, buf, offset, len);
70 static int readlength_bitstream(char *bitdata, int *lendata, int *offset)
74 /* read section char */
75 read_bitstream(bitdata, tbuf, offset, 1);
77 /* make sure it is section 'e' */
79 pr_err("error: length section is not 'e', but %c\n", tbuf[0]);
83 /* read 4bytes length */
84 read_bitstream(bitdata, tbuf, offset, 4);
86 *lendata = tbuf[0] << 24 | tbuf[1] << 16 |
87 tbuf[2] << 8 | tbuf[3];
93 * read first 13 bytes to check bitstream magic number
95 static int readmagic_bitstream(char *bitdata, int *offset)
100 read_bitstream(bitdata, buf, offset, 13);
101 r = memcmp(buf, bits_magic, 13);
103 pr_err("error: corrupted header");
106 pr_info("bitstream file magic number Ok\n");
108 *offset = 13; /* magic length */
114 * NOTE: supports only bitstream format
116 static enum fmt_image get_imageformat(struct fpgaimage *fimage)
121 static void gs_print_header(struct fpgaimage *fimage)
123 pr_info("file: %s\n", fimage->filename);
124 pr_info("part: %s\n", fimage->part);
125 pr_info("date: %s\n", fimage->date);
126 pr_info("time: %s\n", fimage->time);
127 pr_info("lendata: %d\n", fimage->lendata);
130 static void gs_read_bitstream(struct fpgaimage *fimage)
136 bitdata = (char *)fimage->fw_entry->data;
138 readmagic_bitstream(bitdata, &offset);
139 readinfo_bitstream(bitdata, fimage->filename, &offset);
140 readinfo_bitstream(bitdata, fimage->part, &offset);
141 readinfo_bitstream(bitdata, fimage->date, &offset);
142 readinfo_bitstream(bitdata, fimage->time, &offset);
143 readlength_bitstream(bitdata, &fimage->lendata, &offset);
145 fimage->fpgadata = bitdata + offset;
148 static int gs_read_image(struct fpgaimage *fimage)
152 img_fmt = get_imageformat(fimage);
156 pr_info("image is bitstream format\n");
157 gs_read_bitstream(fimage);
160 pr_err("unsupported fpga image format\n");
164 gs_print_header(fimage);
169 static int gs_load_image(struct fpgaimage *fimage, char *fw_file)
173 pr_info("load fpgaimage %s\n", fw_file);
175 err = request_firmware(&fimage->fw_entry, fw_file, &firmware_pdev->dev);
177 pr_err("firmware %s is missing, cannot continue.\n", fw_file);
184 static int gs_download_image(struct fpgaimage *fimage, enum wbus bus_bytes)
190 bitdata = (char *)fimage->fpgadata;
191 size = fimage->lendata;
194 print_hex_dump_bytes("bitfile sample: ", DUMP_PREFIX_OFFSET,
196 #endif /* DEBUG_FPGA */
197 if (!xl_supported_prog_bus_width(bus_bytes)) {
198 pr_err("unsupported program bus width %d\n",
203 /* Bring csi_b, rdwr_b Low and program_b High */
208 /* Configuration reset */
213 /* Wait for Device Initialization */
214 while (xl_get_init_b() == 0)
217 pr_info("device init done\n");
219 for (i = 0; i < size; i += bus_bytes)
220 xl_shift_bytes_out(bus_bytes, bitdata + i);
222 pr_info("program done\n");
225 if (xl_get_init_b() == 0) {
226 pr_err("init_b 0\n");
230 while (xl_get_done_b() == 0) {
231 if (cnt++ > MAX_WAIT_DONE) {
232 pr_err("init_B %d\n", xl_get_init_b());
237 if (cnt > MAX_WAIT_DONE) {
238 pr_err("fpga download fail\n");
242 pr_info("download fpgaimage\n");
244 /* Compensate for Special Startup Conditions */
250 static int gs_release_image(struct fpgaimage *fimage)
252 release_firmware(fimage->fw_entry);
253 pr_info("release fpgaimage\n");
259 * NOTE: supports systemmap parallel programming
261 static int gs_set_download_method(struct fpgaimage *fimage)
263 pr_info("set program method\n");
265 fimage->dmethod = m_systemmap;
267 pr_info("systemmap program method\n");
272 static int init_driver(void)
274 firmware_pdev = platform_device_register_simple("fpgaboot", -1,
276 return PTR_ERR_OR_ZERO(firmware_pdev);
279 static int gs_fpgaboot(void)
282 struct fpgaimage *fimage;
284 fimage = kmalloc(sizeof(*fimage), GFP_KERNEL);
288 err = gs_load_image(fimage, file);
290 pr_err("gs_load_image error\n");
294 err = gs_read_image(fimage);
296 pr_err("gs_read_image error\n");
300 err = gs_set_download_method(fimage);
302 pr_err("gs_set_download_method error\n");
306 err = gs_download_image(fimage, bus_2byte);
308 pr_err("gs_download_image error\n");
312 err = gs_release_image(fimage);
314 pr_err("gs_release_image error\n");
322 err = gs_release_image(fimage);
324 pr_err("gs_release_image error\n");
331 static int __init gs_fpgaboot_init(void)
335 pr_info("FPGA DOWNLOAD --->\n");
337 pr_info("FPGA image file name: %s\n", file);
341 pr_err("FPGA DRIVER INIT FAIL!!\n");
347 pr_err("GPIO INIT FAIL!!\n");
353 pr_err("FPGA DOWNLOAD FAIL!!\n");
357 pr_info("FPGA DOWNLOAD DONE <---\n");
362 platform_device_unregister(firmware_pdev);
367 static void __exit gs_fpgaboot_exit(void)
369 platform_device_unregister(firmware_pdev);
370 pr_info("FPGA image download module removed\n");
373 module_init(gs_fpgaboot_init);
374 module_exit(gs_fpgaboot_exit);
376 MODULE_AUTHOR("Insop Song");
377 MODULE_DESCRIPTION("Xlinix FPGA firmware download");
378 MODULE_LICENSE("GPL");