common/cmd_fpga.c

   1 /*
   2  * (C) Copyright 2000, 2001
   3  * Rich Ireland, Enterasys Networks, rireland@enterasys.com.
   4  *
   5  * See file CREDITS for list of people who contributed to this
   6  * project.
   7  *
   8  * This program is free software; you can redistribute it and/or
   9  * modify it under the terms of the GNU General Public License as
  10  * published by the Free Software Foundation; either version 2 of
  11  * the License, or (at your option) any later version.
  12  *
  13  * This program is distributed in the hope that it will be useful,
  14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16  * GNU General Public License for more details.
  17  *
  18  * You should have received a copy of the GNU General Public License
  19  * along with this program; if not, write to the Free Software
  20  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  21  * MA 02111-1307 USA
  22  *
  23  */
  24
  25 /*
  26  *  FPGA support
  27  */
  28 #include <common.h>
  29 #include <command.h>
  30 #if (CONFIG_COMMANDS & CFG_CMD_NET)
  31 #include <net.h>
  32 #endif
  33 #include <fpga.h>
  34 #include <malloc.h>
  35
  36 #if 0
  37 #define FPGA_DEBUG
  38 #endif
  39
  40 #ifdef  FPGA_DEBUG
  41 #define PRINTF(fmt,args...)     printf (fmt ,##args)
  42 #else
  43 #define PRINTF(fmt,args...)
  44 #endif
  45
  46 #if defined (CONFIG_FPGA) && ( CONFIG_COMMANDS & CFG_CMD_FPGA )
  47
  48 /* Local functions */
  49 static void fpga_usage (cmd_tbl_t * cmdtp);
  50 static int fpga_get_op (char *opstr);
  51
  52 /* Local defines */
  53 #define FPGA_NONE   -1
  54 #define FPGA_INFO   0
  55 #define FPGA_LOAD   1
  56 #define FPGA_LOADB  2
  57 #define FPGA_DUMP   3
  58
  59 /* Convert bitstream data and load into the fpga */
  60 int fpga_loadbitstream(unsigned long dev, char* fpgadata, size_t size)
  61 {
  62         unsigned int length;
  63         unsigned char* swapdata;
  64         unsigned int swapsize;
  65         char buffer[80];
  66         unsigned char *ptr;
  67         unsigned char *dataptr;
  68         unsigned char data;
  69         unsigned int i;
  70         int rc;
  71
  72         dataptr = (unsigned char *)fpgadata;
  73
  74 #if CFG_FPGA_XILINX
  75         /* skip the first bytes of the bitsteam, their meaning is unknown */
  76         length = (*dataptr << 8) + *(dataptr+1);
  77         dataptr+=2;
  78         dataptr+=length;
  79
  80         /* get design name (identifier, length, string) */
  81         length = (*dataptr << 8) + *(dataptr+1);
  82         dataptr+=2;
  83         if (*dataptr++ != 0x61) {
  84                 PRINTF ("%s: Design name identifier not recognized in bitstream\n",
  85                         __FUNCTION__ );
  86                 return FPGA_FAIL;
  87         }
  88
  89         length = (*dataptr << 8) + *(dataptr+1);
  90         dataptr+=2;
  91         for(i=0;i<length;i++)
  92                 buffer[i]=*dataptr++;
  93
  94         printf("  design filename = \"%s\"\n", buffer);
  95
  96         /* get part number (identifier, length, string) */
  97         if (*dataptr++ != 0x62) {
  98                 printf("%s: Part number identifier not recognized in bitstream\n",
  99                         __FUNCTION__ );
 100                 return FPGA_FAIL;
 101         }
 102
 103         length = (*dataptr << 8) + *(dataptr+1);
 104         dataptr+=2;
 105         for(i=0;i<length;i++)
 106                 buffer[i]=*dataptr++;
 107         printf("  part number = \"%s\"\n", buffer);
 108
 109         /* get date (identifier, length, string) */
 110         if (*dataptr++ != 0x63) {
 111                 printf("%s: Date identifier not recognized in bitstream\n",
 112                        __FUNCTION__);
 113                 return FPGA_FAIL;
 114         }
 115
 116         length = (*dataptr << 8) + *(dataptr+1);
 117         dataptr+=2;
 118         for(i=0;i<length;i++)
 119                 buffer[i]=*dataptr++;
 120         printf("  date = \"%s\"\n", buffer);
 121
 122         /* get time (identifier, length, string) */
 123         if (*dataptr++ != 0x64) {
 124                 printf("%s: Time identifier not recognized in bitstream\n",__FUNCTION__);
 125                 return FPGA_FAIL;
 126         }
 127
 128         length = (*dataptr << 8) + *(dataptr+1);
 129         dataptr+=2;
 130         for(i=0;i<length;i++)
 131                 buffer[i]=*dataptr++;
 132         printf("  time = \"%s\"\n", buffer);
 133
 134         /* get fpga data length (identifier, length) */
 135         if (*dataptr++ != 0x65) {
 136                 printf("%s: Data length identifier not recognized in bitstream\n",
 137                         __FUNCTION__);
 138                 return FPGA_FAIL;
 139         }
 140         swapsize = ((unsigned int) *dataptr     <<24) +
 141                    ((unsigned int) *(dataptr+1) <<16) +
 142                    ((unsigned int) *(dataptr+2) <<8 ) +
 143                    ((unsigned int) *(dataptr+3)     ) ;
 144         dataptr+=4;
 145         printf("  bytes in bitstream = %d\n", swapsize);
 146
 147         /* check consistency of length obtained */
 148         if (swapsize >= size) {
 149                 printf("%s: Could not find right length of data in bitstream\n",
 150                         __FUNCTION__);
 151                 return FPGA_FAIL;
 152         }
 153
 154         /* allocate memory */
 155         swapdata = (unsigned char *)malloc(swapsize);
 156         if (swapdata == NULL) {
 157                 printf("%s: Could not allocate %d bytes memory !\n",
 158                         __FUNCTION__, swapsize);
 159                 return FPGA_FAIL;
 160         }
 161
 162         /* read data into memory and swap bits */
 163         ptr = swapdata;
 164         for (i = 0; i < swapsize; i++) {
 165                 data = 0x00;
 166                 data |= (*dataptr & 0x01) << 7;
 167                 data |= (*dataptr & 0x02) << 5;
 168                 data |= (*dataptr & 0x04) << 3;
 169                 data |= (*dataptr & 0x08) << 1;
 170                 data |= (*dataptr & 0x10) >> 1;
 171                 data |= (*dataptr & 0x20) >> 3;
 172                 data |= (*dataptr & 0x40) >> 5;
 173                 data |= (*dataptr & 0x80) >> 7;
 174                 *ptr++ = data;
 175                 dataptr++;
 176         }
 177
 178         rc = fpga_load(dev, swapdata, swapsize);
 179         free(swapdata);
 180         return rc;
 181 #else
 182         printf("Bitstream support only for Xilinx devices\n");
 183         return FPGA_FAIL;
 184 #endif
 185 }
 186
 187 /* ------------------------------------------------------------------------- */
 188 /* command form:
 189  *   fpga <op> <device number> <data addr> <datasize>
 190  * where op is 'load', 'dump', or 'info'
 191  * If there is no device number field, the fpga environment variable is used.
 192  * If there is no data addr field, the fpgadata environment variable is used.
 193  * The info command requires no data address field.
 194  */
 195 int do_fpga (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
 196 {
 197         int op, dev = FPGA_INVALID_DEVICE;
 198         size_t data_size = 0;
 199         void *fpga_data = NULL;
 200         char *devstr = getenv ("fpga");
 201         char *datastr = getenv ("fpgadata");
 202         int rc = FPGA_FAIL;
 203
 204         if (devstr)
 205                 dev = (int) simple_strtoul (devstr, NULL, 16);
 206         if (datastr)
 207                 fpga_data = (void *) simple_strtoul (datastr, NULL, 16);
 208
 209         switch (argc) {
 210         case 5:         /* fpga <op> <dev> <data> <datasize> */
 211                 data_size = simple_strtoul (argv[4], NULL, 16);
 212         case 4:         /* fpga <op> <dev> <data> */
 213                 fpga_data = (void *) simple_strtoul (argv[3], NULL, 16);
 214                 PRINTF ("%s: fpga_data = 0x%x\n", __FUNCTION__, (uint) fpga_data);
 215         case 3:         /* fpga <op> <dev | data addr> */
 216                 dev = (int) simple_strtoul (argv[2], NULL, 16);
 217                 PRINTF ("%s: device = %d\n", __FUNCTION__, dev);
 218                 /* FIXME - this is a really weak test */
 219                 if ((argc == 3) && (dev > fpga_count ())) {     /* must be buffer ptr */
 220                         PRINTF ("%s: Assuming buffer pointer in arg 3\n",
 221                                 __FUNCTION__);
 222                         fpga_data = (void *) dev;
 223                         PRINTF ("%s: fpga_data = 0x%x\n",
 224                                 __FUNCTION__, (uint) fpga_data);
 225                         dev = FPGA_INVALID_DEVICE;      /* reset device num */
 226                 }
 227         case 2:         /* fpga <op> */
 228                 op = (int) fpga_get_op (argv[1]);
 229                 break;
 230         default:
 231                 PRINTF ("%s: Too many or too few args (%d)\n",
 232                         __FUNCTION__, argc);
 233                 op = FPGA_NONE; /* force usage display */
 234                 break;
 235         }
 236
 237         switch (op) {
 238         case FPGA_NONE:
 239                 fpga_usage (cmdtp);
 240                 break;
 241
 242         case FPGA_INFO:
 243                 rc = fpga_info (dev);
 244                 break;
 245
 246         case FPGA_LOAD:
 247                 rc = fpga_load (dev, fpga_data, data_size);
 248                 break;
 249
 250         case FPGA_LOADB:
 251                 rc = fpga_loadbitstream(dev, fpga_data, data_size);
 252                 break;
 253
 254         case FPGA_DUMP:
 255                 rc = fpga_dump (dev, fpga_data, data_size);
 256                 break;
 257
 258         default:
 259                 printf ("Unknown operation\n");
 260                 fpga_usage (cmdtp);
 261                 break;
 262         }
 263         return (rc);
 264 }
 265
 266 static void fpga_usage (cmd_tbl_t * cmdtp)
 267 {
 268         printf ("Usage:\n%s\n", cmdtp->usage);
 269 }
 270
 271 /*
 272  * Map op to supported operations.  We don't use a table since we
 273  * would just have to relocate it from flash anyway.
 274  */
 275 static int fpga_get_op (char *opstr)
 276 {
 277         int op = FPGA_NONE;
 278
 279         if (!strcmp ("info", opstr)) {
 280                 op = FPGA_INFO;
 281         } else if (!strcmp ("loadb", opstr)) {
 282                 op = FPGA_LOADB;
 283         } else if (!strcmp ("load", opstr)) {
 284                 op = FPGA_LOAD;
 285         } else if (!strcmp ("dump", opstr)) {
 286                 op = FPGA_DUMP;
 287         }
 288
 289         if (op == FPGA_NONE) {
 290                 printf ("Unknown fpga operation \"%s\"\n", opstr);
 291         }
 292         return op;
 293 }
 294
 295 U_BOOT_CMD (fpga, 6, 1, do_fpga,
 296             "fpga    - loadable FPGA image support\n",
 297             "fpga [operation type] [device number] [image address] [image size]\n"
 298             "fpga operations:\n"
 299             "\tinfo\tlist known device information\n"
 300             "\tload\tLoad device from memory buffer\n"
 301             "\tloadb\tLoad device from bitstream buffer (Xilinx devices only)\n"
 302             "\tdump\tLoad device to memory buffer\n");
 303 #endif /* CONFIG_FPGA && CONFIG_COMMANDS & CFG_CMD_FPGA */