325 lines
8.3 KiB
C
325 lines
8.3 KiB
C
/*
|
|
* (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 defined(CONFIG_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) && defined(CONFIG_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
|
|
#define FPGA_LOADMK 4
|
|
|
|
/* 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_LOADMK:
|
|
{
|
|
image_header_t header;
|
|
image_header_t *hdr = &header;
|
|
ulong data;
|
|
|
|
memmove (&header, (char *)fpga_data, sizeof(image_header_t));
|
|
if (ntohl(hdr->ih_magic) != IH_MAGIC) {
|
|
puts ("Bad Magic Number\n");
|
|
return 1;
|
|
}
|
|
data = ((ulong)fpga_data + sizeof(image_header_t));
|
|
data_size = ntohl(hdr->ih_size);
|
|
rc = fpga_load (dev, (void *)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 ("loadmk", opstr)) {
|
|
op = FPGA_LOADMK;
|
|
} 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"
|
|
"\tloadmk\tLoad device generated with mkimage\n"
|
|
"\tdump\tLoad device to memory buffer\n");
|
|
#endif
|