Release 4.18 drivers/staging/gs_fpgaboot/gs_fpgaboot.c

/*
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 */

#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/module.h>
#include <linux/types.h>
#include <linux/device.h>
#include <linux/string.h>
#include <linux/slab.h>
#include <linux/fs.h>
#include <linux/platform_device.h>
#include <linux/of.h>
#include <linux/delay.h>
#include <linux/io.h>
#include <linux/firmware.h>
#include <asm/unaligned.h>

#include "gs_fpgaboot.h"
#include "io.h"


#define DEVICE_NAME "device"

#define CLASS_NAME  "fpgaboot"


static u8 bits_magic[] = {
	0x0, 0x9, 0xf, 0xf0, 0xf, 0xf0,
	0xf, 0xf0, 0xf, 0xf0, 0x0, 0x0, 0x1};

/* fake device for request_firmware */

static struct platform_device	*firmware_pdev;


static char	*file = "xlinx_fpga_firmware.bit";
module_param(file, charp, 0444);
MODULE_PARM_DESC(file, "Xilinx FPGA firmware file.");



static void read_bitstream(u8 *bitdata, u8 *buf, int *offset, int rdsize)
{
	memcpy(buf, bitdata + *offset, rdsize);
	*offset += rdsize;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Insop Song
36
94.74%
1
50.00%
Jacob von Chorus
2
5.26%
1
50.00%
Total
38
100.00%
2
100.00%



static int readinfo_bitstream(u8 *bitdata, u8 *buf, int size, int *offset)
{
	u8 tbuf[2];
	u16 len;

	/* read section char */
	read_bitstream(bitdata, tbuf, offset, 1);

	/* read length */
	read_bitstream(bitdata, tbuf, offset, 2);

	len = get_unaligned_be16(tbuf);
	if (len >= size) {
		pr_err("error: readinfo buffer too small\n");
		return -EINVAL;
	}

	read_bitstream(bitdata, buf, offset, len);
	buf[len] = '\0';

	return 0;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Insop Song
67
67.68%
1
33.33%
Jacob von Chorus
32
32.32%
2
66.67%
Total
99
100.00%
3
100.00%

/*
 * read bitdata length
 */


static int readlength_bitstream(u8 *bitdata, int *lendata, int *offset)
{
	u8 tbuf[4];

	/* read section char */
	read_bitstream(bitdata, tbuf, offset, 1);

	/* make sure it is section 'e' */
	if (tbuf[0] != 'e') {
		pr_err("error: length section is not 'e', but %c\n", tbuf[0]);
		return -EINVAL;
	}

	/* read 4bytes length */
	read_bitstream(bitdata, tbuf, offset, 4);

	*lendata = get_unaligned_be32(tbuf);

	return 0;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Insop Song
78
91.76%
1
25.00%
Jacob von Chorus
7
8.24%
3
75.00%
Total
85
100.00%
4
100.00%

/*
 * read first 13 bytes to check bitstream magic number
 */


static int readmagic_bitstream(u8 *bitdata, int *offset)
{
	u8 buf[13];
	int r;

	read_bitstream(bitdata, buf, offset, 13);
	r = memcmp(buf, bits_magic, 13);
	if (r) {
		pr_err("error: corrupted header\n");
		return -EINVAL;
	}
	pr_info("bitstream file magic number Ok\n");

	*offset = 13;	/* magic length */

	return 0;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Insop Song
70
94.59%
1
25.00%
Jacob von Chorus
3
4.05%
2
50.00%
Arvind Yadav
1
1.35%
1
25.00%
Total
74
100.00%
4
100.00%

/*
 * NOTE: supports only bitstream format
 */


static enum fmt_image get_imageformat(void)
{
	return f_bit;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Insop Song
11
91.67%
1
50.00%
Jacob von Chorus
1
8.33%
1
50.00%
Total
12
100.00%
2
100.00%



static void gs_print_header(struct fpgaimage *fimage)
{
	pr_info("file: %s\n", fimage->filename);
	pr_info("part: %s\n", fimage->part);
	pr_info("date: %s\n", fimage->date);
	pr_info("time: %s\n", fimage->time);
	pr_info("lendata: %d\n", fimage->lendata);
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Insop Song
56
100.00%
1
100.00%
Total
56
100.00%
1
100.00%



static int gs_read_bitstream(struct fpgaimage *fimage)
{
	u8 *bitdata;
	int offset;
	int err;

	offset = 0;
	bitdata = (u8 *)fimage->fw_entry->data;

	err = readmagic_bitstream(bitdata, &offset);
	if (err)
		return err;

	err = readinfo_bitstream(bitdata, fimage->filename, MAX_STR, &offset);
	if (err)
		return err;
	err = readinfo_bitstream(bitdata, fimage->part, MAX_STR, &offset);
	if (err)
		return err;
	err = readinfo_bitstream(bitdata, fimage->date, MAX_STR, &offset);
	if (err)
		return err;
	err = readinfo_bitstream(bitdata, fimage->time, MAX_STR, &offset);
	if (err)
		return err;

	err = readlength_bitstream(bitdata, &fimage->lendata, &offset);
	if (err)
		return err;

	fimage->fpgadata = bitdata + offset;

	return 0;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Insop Song
108
60.34%
1
33.33%
Jacob von Chorus
71
39.66%
2
66.67%
Total
179
100.00%
3
100.00%



static int gs_read_image(struct fpgaimage *fimage)
{
	int img_fmt;
	int err;

	img_fmt = get_imageformat();

	switch (img_fmt) {
	case f_bit:
		pr_info("image is bitstream format\n");
		err = gs_read_bitstream(fimage);
		if (err)
			return err;
		break;
	default:
		pr_err("unsupported fpga image format\n");
		return -EINVAL;
	}

	gs_print_header(fimage);

	return 0;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Insop Song
55
79.71%
1
33.33%
Jacob von Chorus
14
20.29%
2
66.67%
Total
69
100.00%
3
100.00%



static int gs_load_image(struct fpgaimage *fimage, char *fw_file)
{
	int err;

	pr_info("load fpgaimage %s\n", fw_file);

	err = request_firmware(&fimage->fw_entry, fw_file, &firmware_pdev->dev);
	if (err != 0) {
		pr_err("firmware %s is missing, cannot continue.\n", fw_file);
		return err;
	}

	return 0;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Insop Song
59
93.65%
1
50.00%
Devendra Naga
4
6.35%
1
50.00%
Total
63
100.00%
2
100.00%



static int gs_download_image(struct fpgaimage *fimage, enum wbus bus_bytes)
{
	u8 *bitdata;
	int size, i, cnt;

	cnt = 0;
	bitdata = (u8 *)fimage->fpgadata;
	size = fimage->lendata;

#ifdef DEBUG_FPGA
	print_hex_dump_bytes("bitfile sample: ", DUMP_PREFIX_OFFSET,
			     bitdata, 0x100);
#endif /* DEBUG_FPGA */
	if (!xl_supported_prog_bus_width(bus_bytes)) {
		pr_err("unsupported program bus width %d\n",
		       bus_bytes);
		return -EINVAL;
	}

	/* Bring csi_b, rdwr_b Low and program_b High */
	xl_program_b(1);
	xl_rdwr_b(0);
	xl_csi_b(0);

	/* Configuration reset */
	xl_program_b(0);
	msleep(20);
	xl_program_b(1);

	/* Wait for Device Initialization */
	while (xl_get_init_b() == 0)
		;

	pr_info("device init done\n");

	for (i = 0; i < size; i += bus_bytes)
		xl_shift_bytes_out(bus_bytes, bitdata + i);

	pr_info("program done\n");

	/* Check INIT_B */
	if (xl_get_init_b() == 0) {
		pr_err("init_b 0\n");
		return -EIO;
	}

	while (xl_get_done_b() == 0) {
		if (cnt++ > MAX_WAIT_DONE) {
			pr_err("init_B %d\n", xl_get_init_b());
			break;
		}
	}

	if (cnt > MAX_WAIT_DONE) {
		pr_err("fpga download fail\n");
		return -EIO;
	}

	pr_info("download fpgaimage\n");

	/* Compensate for Special Startup Conditions */
	xl_shift_cclk(8);

	return 0;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Insop Song
226
96.17%
1
25.00%
Jacob von Chorus
5
2.13%
2
50.00%
Joe Perches
4
1.70%
1
25.00%
Total
235
100.00%
4
100.00%



static int gs_release_image(struct fpgaimage *fimage)
{
	release_firmware(fimage->fw_entry);
	pr_info("release fpgaimage\n");

	return 0;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Insop Song
26
100.00%
1
100.00%
Total
26
100.00%
1
100.00%

/*
 * NOTE: supports systemmap parallel programming
 */


static int gs_set_download_method(struct fpgaimage *fimage)
{
	pr_info("set program method\n");

	fimage->dmethod = m_systemmap;

	pr_info("systemmap program method\n");

	return 0;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Insop Song
30
100.00%
1
100.00%
Total
30
100.00%
1
100.00%



static int init_driver(void)
{
	firmware_pdev = platform_device_register_simple("fpgaboot", -1,
							NULL, 0);
	return PTR_ERR_OR_ZERO(firmware_pdev);
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Insop Song
27
96.43%
1
50.00%
Fengguang Wu
1
3.57%
1
50.00%
Total
28
100.00%
2
100.00%



static int gs_fpgaboot(void)
{
	int err;
	struct fpgaimage	*fimage;

	fimage = kmalloc(sizeof(*fimage), GFP_KERNEL);
	if (!fimage)
		return -ENOMEM;

	err = gs_load_image(fimage, file);
	if (err) {
		pr_err("gs_load_image error\n");
		goto err_out1;
	}

	err = gs_read_image(fimage);
	if (err) {
		pr_err("gs_read_image error\n");
		goto err_out2;
	}

	err = gs_set_download_method(fimage);
	if (err) {
		pr_err("gs_set_download_method error\n");
		goto err_out2;
	}

	err = gs_download_image(fimage, bus_2byte);
	if (err) {
		pr_err("gs_download_image error\n");
		goto err_out2;
	}

	err = gs_release_image(fimage);
	if (err) {
		pr_err("gs_release_image error\n");
		goto err_out1;
	}

	kfree(fimage);
	return 0;

err_out2:
	err = gs_release_image(fimage);
	if (err)
		pr_err("gs_release_image error\n");
err_out1:
	kfree(fimage);

	return err;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Insop Song
175
95.63%
1
25.00%
Dzmitry Sledneu
5
2.73%
1
25.00%
Ben Marsh
2
1.09%
1
25.00%
Jacob von Chorus
1
0.55%
1
25.00%
Total
183
100.00%
4
100.00%



static int __init gs_fpgaboot_init(void)
{
	int err;

	pr_info("FPGA DOWNLOAD --->\n");

	pr_info("FPGA image file name: %s\n", file);

	err = init_driver();
	if (err) {
		pr_err("FPGA DRIVER INIT FAIL!!\n");
		return err;
	}

	err = xl_init_io();
	if (err) {
		pr_err("GPIO INIT FAIL!!\n");
		goto errout;
	}

	err = gs_fpgaboot();
	if (err) {
		pr_err("FPGA DOWNLOAD FAIL!!\n");
		goto errout;
	}

	pr_info("FPGA DOWNLOAD DONE <---\n");

	return 0;

errout:
	platform_device_unregister(firmware_pdev);

	return err;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Insop Song
92
92.93%
1
33.33%
Eva Rachel Retuya
4
4.04%
1
33.33%
Devendra Naga
3
3.03%
1
33.33%
Total
99
100.00%
3
100.00%



static void __exit gs_fpgaboot_exit(void)
{
	platform_device_unregister(firmware_pdev);
	pr_info("FPGA image download module removed\n");
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Insop Song
15
78.95%
1
50.00%
Eva Rachel Retuya
4
21.05%
1
50.00%
Total
19
100.00%
2
100.00%

module_init(gs_fpgaboot_init);
module_exit(gs_fpgaboot_exit);

MODULE_AUTHOR("Insop Song");
MODULE_DESCRIPTION("Xlinix FPGA firmware download");
MODULE_LICENSE("GPL");
Overall Contributors
Person
Tokens
Prop
Commits
CommitProp
Insop Song
1274
88.23%
1
6.67%
Jacob von Chorus
139
9.63%
3
20.00%
Eva Rachel Retuya
8
0.55%
1
6.67%
Devendra Naga
7
0.48%
2
13.33%
Dzmitry Sledneu
5
0.35%
1
6.67%
Joe Perches
4
0.28%
1
6.67%
Ben Marsh
3
0.21%
2
13.33%
Rehas Sachdeva
1
0.07%
1
6.67%
Arvind Yadav
1
0.07%
1
6.67%
Shyam Saini
1
0.07%
1
6.67%
Fengguang Wu
1
0.07%
1
6.67%
Total
1444
100.00%
15
100.00%
Directory: drivers/staging/gs_fpgaboot

Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.