common/cmd_fpga.c - uboot/windcharger - Git at Google

 /*
  * (C) Copyright 2000, 2001
  * Rich Ireland, Enterasys Networks, rireland@enterasys.com.
  *
  * See file CREDITS for list of people who contributed to this
  * project.
  *
  * 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.
  *
  * You should have received a copy of the GNU General Public License
  * along with this program; if not, write to the Free Software
  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  * MA 02111-1307 USA
  *
  */

 /*
  *  FPGA support
  */
 #include <common.h>
 #include <command.h>
 #if (CONFIG_COMMANDS & CFG_CMD_NET)
 #include <net.h>
 #endif
 #include <fpga.h>
 #include <malloc.h>

 #if 0
 #define	FPGA_DEBUG
 #endif

 #ifdef	FPGA_DEBUG
 #define	PRINTF(fmt,args...)	printf (fmt ,##args)
 #else
 #define PRINTF(fmt,args...)
 #endif

 #if defined (CONFIG_FPGA) && ( CONFIG_COMMANDS & CFG_CMD_FPGA )

 /* Local functions */
 static void fpga_usage (cmd_tbl_t * cmdtp);
 static int fpga_get_op (char *opstr);

 /* Local defines */
 #define FPGA_NONE   -1
 #define FPGA_INFO   0
 #define FPGA_LOAD   1
 #define FPGA_LOADB  2
 #define FPGA_DUMP   3

 /* Convert bitstream data and load into the fpga */
 int fpga_loadbitstream(unsigned long dev, char* fpgadata, size_t size)
 {
 	unsigned int length;
 	unsigned char* swapdata;
 	unsigned int swapsize;
 	char buffer[80];
 	unsigned char *ptr;
 	unsigned char *dataptr;
 	unsigned char data;
 	unsigned int i;
 	int rc;

 	dataptr = (unsigned char *)fpgadata;

 #if CFG_FPGA_XILINX
 	/* skip the first bytes of the bitsteam, their meaning is unknown */
 	length = (*dataptr << 8) + *(dataptr+1);
 	dataptr+=2;
 	dataptr+=length;

 	/* get design name (identifier, length, string) */
 	length = (*dataptr << 8) + *(dataptr+1);
 	dataptr+=2;
 	if (*dataptr++ != 0x61) {
 		PRINTF ("%s: Design name identifier not recognized in bitstream\n",
 			__FUNCTION__ );
 		return FPGA_FAIL;
 	}

 	length = (*dataptr << 8) + *(dataptr+1);
 	dataptr+=2;
 	for(i=0;i<length;i++)
 		buffer[i]=*dataptr++;

 	printf("  design filename = \"%s\"\n", buffer);

 	/* get part number (identifier, length, string) */
 	if (*dataptr++ != 0x62) {
 		printf("%s: Part number identifier not recognized in bitstream\n",
 			__FUNCTION__ );
 		return FPGA_FAIL;
 	}

 	length = (*dataptr << 8) + *(dataptr+1);
 	dataptr+=2;
 	for(i=0;i<length;i++)
 		buffer[i]=*dataptr++;
 	printf("  part number = \"%s\"\n", buffer);

 	/* get date (identifier, length, string) */
 	if (*dataptr++ != 0x63) {
 		printf("%s: Date identifier not recognized in bitstream\n",
 		       __FUNCTION__);
 		return FPGA_FAIL;
 	}

 	length = (*dataptr << 8) + *(dataptr+1);
 	dataptr+=2;
 	for(i=0;i<length;i++)
 		buffer[i]=*dataptr++;
 	printf("  date = \"%s\"\n", buffer);

 	/* get time (identifier, length, string) */
 	if (*dataptr++ != 0x64) {
 		printf("%s: Time identifier not recognized in bitstream\n",__FUNCTION__);
 		return FPGA_FAIL;
 	}

 	length = (*dataptr << 8) + *(dataptr+1);
 	dataptr+=2;
 	for(i=0;i<length;i++)
 		buffer[i]=*dataptr++;
 	printf("  time = \"%s\"\n", buffer);

 	/* get fpga data length (identifier, length) */
 	if (*dataptr++ != 0x65) {
 		printf("%s: Data length identifier not recognized in bitstream\n",
 			__FUNCTION__);
 		return FPGA_FAIL;
 	}
 	swapsize = ((unsigned int) *dataptr     <<24) +
 	           ((unsigned int) *(dataptr+1) <<16) +
 	           ((unsigned int) *(dataptr+2) <<8 ) +
 	           ((unsigned int) *(dataptr+3)     ) ;
 	dataptr+=4;
 	printf("  bytes in bitstream = %d\n", swapsize);

 	/* check consistency of length obtained */
 	if (swapsize >= size) {
 		printf("%s: Could not find right length of data in bitstream\n",
 			__FUNCTION__);
 		return FPGA_FAIL;
 	}

 	/* allocate memory */
 	swapdata = (unsigned char *)malloc(swapsize);
 	if (swapdata == NULL) {
 		printf("%s: Could not allocate %d bytes memory !\n",
 			__FUNCTION__, swapsize);
 		return FPGA_FAIL;
 	}

 	/* read data into memory and swap bits */
 	ptr = swapdata;
 	for (i = 0; i < swapsize; i++) {
 		data = 0x00;
 		data |= (*dataptr & 0x01) << 7;
 		data |= (*dataptr & 0x02) << 5;
 		data |= (*dataptr & 0x04) << 3;
 		data |= (*dataptr & 0x08) << 1;
 		data |= (*dataptr & 0x10) >> 1;
 		data |= (*dataptr & 0x20) >> 3;
 		data |= (*dataptr & 0x40) >> 5;
 		data |= (*dataptr & 0x80) >> 7;
 		*ptr++ = data;
 		dataptr++;
 	}

 	rc = fpga_load(dev, swapdata, swapsize);
 	free(swapdata);
 	return rc;
 #else
 	printf("Bitstream support only for Xilinx devices\n");
 	return FPGA_FAIL;
 #endif
 }

 /* ------------------------------------------------------------------------- */
 /* command form:
  *   fpga <op> <device number> <data addr> <datasize>
  * where op is 'load', 'dump', or 'info'
  * If there is no device number field, the fpga environment variable is used.
  * If there is no data addr field, the fpgadata environment variable is used.
  * The info command requires no data address field.
  */
 int do_fpga (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
 {
 	int op, dev = FPGA_INVALID_DEVICE;
 	size_t data_size = 0;
 	void *fpga_data = NULL;
 	char *devstr = getenv ("fpga");
 	char *datastr = getenv ("fpgadata");
 	int rc = FPGA_FAIL;

 	if (devstr)
 		dev = (int) simple_strtoul (devstr, NULL, 16);
 	if (datastr)
 		fpga_data = (void *) simple_strtoul (datastr, NULL, 16);

 	switch (argc) {
 	case 5:		/* fpga <op> <dev> <data> <datasize> */
 		data_size = simple_strtoul (argv[4], NULL, 16);
 	case 4:		/* fpga <op> <dev> <data> */
 		fpga_data = (void *) simple_strtoul (argv[3], NULL, 16);
 		PRINTF ("%s: fpga_data = 0x%x\n", __FUNCTION__, (uint) fpga_data);
 	case 3:		/* fpga <op> <dev | data addr> */
 		dev = (int) simple_strtoul (argv[2], NULL, 16);
 		PRINTF ("%s: device = %d\n", __FUNCTION__, dev);
 		/* FIXME - this is a really weak test */
 		if ((argc == 3) && (dev > fpga_count ())) {	/* must be buffer ptr */
 			PRINTF ("%s: Assuming buffer pointer in arg 3\n",
 				__FUNCTION__);
 			fpga_data = (void *) dev;
 			PRINTF ("%s: fpga_data = 0x%x\n",
 				__FUNCTION__, (uint) fpga_data);
 			dev = FPGA_INVALID_DEVICE;	/* reset device num */
 		}
 	case 2:		/* fpga <op> */
 		op = (int) fpga_get_op (argv[1]);
 		break;
 	default:
 		PRINTF ("%s: Too many or too few args (%d)\n",
 			__FUNCTION__, argc);
 		op = FPGA_NONE;	/* force usage display */
 		break;
 	}

 	switch (op) {
 	case FPGA_NONE:
 		fpga_usage (cmdtp);
 		break;

 	case FPGA_INFO:
 		rc = fpga_info (dev);
 		break;

 	case FPGA_LOAD:
 		rc = fpga_load (dev, fpga_data, data_size);
 		break;

 	case FPGA_LOADB:
 		rc = fpga_loadbitstream(dev, fpga_data, data_size);
 		break;

 	case FPGA_DUMP:
 		rc = fpga_dump (dev, fpga_data, data_size);
 		break;

 	default:
 		printf ("Unknown operation\n");
 		fpga_usage (cmdtp);
 		break;
 	}
 	return (rc);
 }

 static void fpga_usage (cmd_tbl_t * cmdtp)
 {
 	printf ("Usage:\n%s\n", cmdtp->usage);
 }

 /*
  * Map op to supported operations.  We don't use a table since we
  * would just have to relocate it from flash anyway.
  */
 static int fpga_get_op (char *opstr)
 {
 	int op = FPGA_NONE;

 	if (!strcmp ("info", opstr)) {
 		op = FPGA_INFO;
 	} else if (!strcmp ("loadb", opstr)) {
 		op = FPGA_LOADB;
 	} else if (!strcmp ("load", opstr)) {
 		op = FPGA_LOAD;
 	} else if (!strcmp ("dump", opstr)) {
 		op = FPGA_DUMP;
 	}

 	if (op == FPGA_NONE) {
 		printf ("Unknown fpga operation \"%s\"\n", opstr);
 	}
 	return op;
 }

 U_BOOT_CMD (fpga, 6, 1, do_fpga,
 	    "fpga    - loadable FPGA image support\n",
 	    "fpga [operation type] [device number] [image address] [image size]\n"
 	    "fpga operations:\n"
 	    "\tinfo\tlist known device information\n"
 	    "\tload\tLoad device from memory buffer\n"
 	    "\tloadb\tLoad device from bitstream buffer (Xilinx devices only)\n"
 	    "\tdump\tLoad device to memory buffer\n");
 #endif /* CONFIG_FPGA && CONFIG_COMMANDS & CFG_CMD_FPGA */
	/*
	* (C) Copyright 2000, 2001
	* Rich Ireland, Enterasys Networks, rireland@enterasys.com.
	*
	* See file CREDITS for list of people who contributed to this
	* project.
	*
	* 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.
	*
	* You should have received a copy of the GNU General Public License
	* along with this program; if not, write to the Free Software
	* Foundation, Inc., 59 Temple Place, Suite 330, Boston,
	* MA 02111-1307 USA
	*
	*/

	/*
	* FPGA support
	*/
	#include <common.h>
	#include <command.h>
	#if (CONFIG_COMMANDS & CFG_CMD_NET)
	#include <net.h>
	#endif
	#include <fpga.h>
	#include <malloc.h>

	#if 0
	#define FPGA_DEBUG
	#endif

	#ifdef FPGA_DEBUG
	#define PRINTF(fmt,args...) printf (fmt ,##args)
	#else
	#define PRINTF(fmt,args...)
	#endif

	#if defined (CONFIG_FPGA) && ( CONFIG_COMMANDS & CFG_CMD_FPGA )

	/* Local functions */
	static void fpga_usage (cmd_tbl_t * cmdtp);
	static int fpga_get_op (char *opstr);

	/* Local defines */
	#define FPGA_NONE -1
	#define FPGA_INFO 0
	#define FPGA_LOAD 1
	#define FPGA_LOADB 2
	#define FPGA_DUMP 3

	/* Convert bitstream data and load into the fpga */
	int fpga_loadbitstream(unsigned long dev, char* fpgadata, size_t size)
	{
	unsigned int length;
	unsigned char* swapdata;
	unsigned int swapsize;
	char buffer[80];
	unsigned char *ptr;
	unsigned char *dataptr;
	unsigned char data;
	unsigned int i;
	int rc;

	dataptr = (unsigned char *)fpgadata;

	#if CFG_FPGA_XILINX
	/* skip the first bytes of the bitsteam, their meaning is unknown */
	length = (dataptr << 8) + (dataptr+1);
	dataptr+=2;
	dataptr+=length;

	/* get design name (identifier, length, string) */
	length = (dataptr << 8) + (dataptr+1);
	dataptr+=2;
	if (*dataptr++ != 0x61) {
	PRINTF ("%s: Design name identifier not recognized in bitstream\n",
	__FUNCTION__ );
	return FPGA_FAIL;
	}

	length = (dataptr << 8) + (dataptr+1);
	dataptr+=2;
	for(i=0;i<length;i++)
	buffer[i]=*dataptr++;

	printf(" design filename = \"%s\"\n", buffer);

	/* get part number (identifier, length, string) */
	if (*dataptr++ != 0x62) {
	printf("%s: Part number identifier not recognized in bitstream\n",
	__FUNCTION__ );
	return FPGA_FAIL;
	}

	length = (dataptr << 8) + (dataptr+1);
	dataptr+=2;
	for(i=0;i<length;i++)
	buffer[i]=*dataptr++;
	printf(" part number = \"%s\"\n", buffer);

	/* get date (identifier, length, string) */
	if (*dataptr++ != 0x63) {
	printf("%s: Date identifier not recognized in bitstream\n",
	__FUNCTION__);
	return FPGA_FAIL;
	}

	length = (dataptr << 8) + (dataptr+1);
	dataptr+=2;
	for(i=0;i<length;i++)
	buffer[i]=*dataptr++;
	printf(" date = \"%s\"\n", buffer);

	/* get time (identifier, length, string) */
	if (*dataptr++ != 0x64) {
	printf("%s: Time identifier not recognized in bitstream\n",__FUNCTION__);
	return FPGA_FAIL;
	}

	length = (dataptr << 8) + (dataptr+1);
	dataptr+=2;
	for(i=0;i<length;i++)
	buffer[i]=*dataptr++;
	printf(" time = \"%s\"\n", buffer);

	/* get fpga data length (identifier, length) */
	if (*dataptr++ != 0x65) {
	printf("%s: Data length identifier not recognized in bitstream\n",
	__FUNCTION__);
	return FPGA_FAIL;
	}
	swapsize = ((unsigned int) *dataptr <<24) +
	((unsigned int) *(dataptr+1) <<16) +
	((unsigned int) *(dataptr+2) <<8 ) +
	((unsigned int) *(dataptr+3) ) ;
	dataptr+=4;
	printf(" bytes in bitstream = %d\n", swapsize);

	/* check consistency of length obtained */
	if (swapsize >= size) {
	printf("%s: Could not find right length of data in bitstream\n",
	__FUNCTION__);
	return FPGA_FAIL;
	}

	/* allocate memory */
	swapdata = (unsigned char *)malloc(swapsize);
	if (swapdata == NULL) {
	printf("%s: Could not allocate %d bytes memory !\n",
	__FUNCTION__, swapsize);
	return FPGA_FAIL;
	}

	/* read data into memory and swap bits */
	ptr = swapdata;
	for (i = 0; i < swapsize; i++) {
	data = 0x00;
	data \|= (*dataptr & 0x01) << 7;
	data \|= (*dataptr & 0x02) << 5;
	data \|= (*dataptr & 0x04) << 3;
	data \|= (*dataptr & 0x08) << 1;
	data \|= (*dataptr & 0x10) >> 1;
	data \|= (*dataptr & 0x20) >> 3;
	data \|= (*dataptr & 0x40) >> 5;
	data \|= (*dataptr & 0x80) >> 7;
	*ptr++ = data;
	dataptr++;
	}

	rc = fpga_load(dev, swapdata, swapsize);
	free(swapdata);
	return rc;
	#else
	printf("Bitstream support only for Xilinx devices\n");
	return FPGA_FAIL;
	#endif
	}

	/* ------------------------------------------------------------------------- */
	/* command form:
	* fpga <op> <device number> <data addr> <datasize>
	* where op is 'load', 'dump', or 'info'
	* If there is no device number field, the fpga environment variable is used.
	* If there is no data addr field, the fpgadata environment variable is used.
	* The info command requires no data address field.
	*/
	int do_fpga (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
	{
	int op, dev = FPGA_INVALID_DEVICE;
	size_t data_size = 0;
	void *fpga_data = NULL;
	char *devstr = getenv ("fpga");
	char *datastr = getenv ("fpgadata");
	int rc = FPGA_FAIL;

	if (devstr)
	dev = (int) simple_strtoul (devstr, NULL, 16);
	if (datastr)
	fpga_data = (void *) simple_strtoul (datastr, NULL, 16);

	switch (argc) {
	case 5: /* fpga <op> <dev> <data> <datasize> */
	data_size = simple_strtoul (argv[4], NULL, 16);
	case 4: /* fpga <op> <dev> <data> */
	fpga_data = (void *) simple_strtoul (argv[3], NULL, 16);
	PRINTF ("%s: fpga_data = 0x%x\n", __FUNCTION__, (uint) fpga_data);
	case 3: /* fpga <op> <dev \| data addr> */
	dev = (int) simple_strtoul (argv[2], NULL, 16);
	PRINTF ("%s: device = %d\n", __FUNCTION__, dev);
	/* FIXME - this is a really weak test */
	if ((argc == 3) && (dev > fpga_count ())) { /* must be buffer ptr */
	PRINTF ("%s: Assuming buffer pointer in arg 3\n",
	__FUNCTION__);
	fpga_data = (void *) dev;
	PRINTF ("%s: fpga_data = 0x%x\n",
	__FUNCTION__, (uint) fpga_data);
	dev = FPGA_INVALID_DEVICE; /* reset device num */
	}
	case 2: /* fpga <op> */
	op = (int) fpga_get_op (argv[1]);
	break;
	default:
	PRINTF ("%s: Too many or too few args (%d)\n",
	__FUNCTION__, argc);
	op = FPGA_NONE; /* force usage display */
	break;
	}

	switch (op) {
	case FPGA_NONE:
	fpga_usage (cmdtp);
	break;

	case FPGA_INFO:
	rc = fpga_info (dev);
	break;

	case FPGA_LOAD:
	rc = fpga_load (dev, fpga_data, data_size);
	break;

	case FPGA_LOADB:
	rc = fpga_loadbitstream(dev, fpga_data, data_size);
	break;

	case FPGA_DUMP:
	rc = fpga_dump (dev, fpga_data, data_size);
	break;

	default:
	printf ("Unknown operation\n");
	fpga_usage (cmdtp);
	break;
	}
	return (rc);
	}

	static void fpga_usage (cmd_tbl_t * cmdtp)
	{
	printf ("Usage:\n%s\n", cmdtp->usage);
	}

	/*
	* Map op to supported operations. We don't use a table since we
	* would just have to relocate it from flash anyway.
	*/
	static int fpga_get_op (char *opstr)
	{
	int op = FPGA_NONE;

	if (!strcmp ("info", opstr)) {
	op = FPGA_INFO;
	} else if (!strcmp ("loadb", opstr)) {
	op = FPGA_LOADB;
	} else if (!strcmp ("load", opstr)) {
	op = FPGA_LOAD;
	} else if (!strcmp ("dump", opstr)) {
	op = FPGA_DUMP;
	}

	if (op == FPGA_NONE) {
	printf ("Unknown fpga operation \"%s\"\n", opstr);
	}
	return op;
	}

	U_BOOT_CMD (fpga, 6, 1, do_fpga,
	"fpga - loadable FPGA image support\n",
	"fpga [operation type] [device number] [image address] [image size]\n"
	"fpga operations:\n"
	"\tinfo\tlist known device information\n"
	"\tload\tLoad device from memory buffer\n"
	"\tloadb\tLoad device from bitstream buffer (Xilinx devices only)\n"
	"\tdump\tLoad device to memory buffer\n");
	#endif /* CONFIG_FPGA && CONFIG_COMMANDS & CFG_CMD_FPGA */