Co-Simulation/Примеры кода

Литература

Литература

Пример win

FT_HANDLE ftHandle;    // Handle of the FTDI device
 FT_STATUS ftStatus;    // Result of each D2XX call
 
 DWORD dwNumDevs;    // The number of devices
 unsigned int uiDevIndex = 0xF; // The device in the list that we'll use
 
 BYTE byOutputBuffer[1024];  // Buffer to hold MPSSE commands and data to be sent to the FT2232H
 BYTE byInputBuffer[1024];  // Buffer to hold data read from the FT2232H
 
 DWORD dwCount = 0;    // General loop index
 DWORD dwNumBytesToSend = 0;  // Index to the output buffer
 DWORD dwNumBytesSent = 0;  // Count of actual bytes sent - used with FT_Write
 DWORD dwNumBytesToRead = 0;  // Number of bytes available to read in the driver's input buffer
 DWORD dwNumBytesRead = 0;  // Count of actual bytes read - used with FT_Read
 
 DWORD dwClockDivisor = 0x0001; // Value of clock divisor, SCL Frequency = 60/((1+0x05DB)*2) (MHz) = 20khz
 
 DWORD RxBytes = 0;
 DWORD TxBytes = 0;
 DWORD EventDWord = 0;
 
printf("Checking for FTDI devices...\n");
 
 ftStatus = FT_CreateDeviceInfoList(&dwNumDevs);
         // Get the number of FTDI devices
 if (ftStatus != FT_OK)   // Did the command execute OK?
 {
  printf("Error in getting the number of devices\n");
  return 1;     // Exit with error
 }
 
 if (dwNumDevs < 1)    // Exit if we don't see any
 {
  printf("There are no FTDI devices installed\n");
  return 1;     // Exist with error
 }
 // Open the port - For this application note, we'll assume the first device is a FT2232H or FT4232H
 // Further checks can be made against the device descriptions, locations, serial numbers, etc. 
 //  before opening the port.
 
 printf("\nAssume first device has the FIFO and open it...\n");
 
 ftStatus = FT_Open(0, &ftHandle);
 if (ftStatus != FT_OK)
 {
  printf("Open Failed with error %d\n", ftStatus);
  return 1;     // Exit with error
 }

Листинг файла baud_test.c

/* baud_test.c
 *
 * test setting the baudrate and compare it with the expected runtime
 *
 * options:
 *  -p <devicestring> defaults to "i:0x0403:0x6001" (this is the first FT232R with default id)
 *       d:<devicenode> path of bus and device-node (e.g. "003/001") within usb device tree (usually at /proc/bus/usb/)
 *       i:<vendor>:<product> first device with given vendor and product id,
 *                            ids can be decimal, octal (preceded by "0") or hex (preceded by "0x")
 *       i:<vendor>:<product>:<index> as above with index being the number of the device (starting with 0)
 *                            if there are more than one
 *       s:<vendor>:<product>:<serial> first device with given vendor id, product id and serial string
 *  -d <datasize to send in bytes>
 *  -b <baudrate> (divides by 16 if bitbang as taken from the ftdi datasheets)
 *  -m <mode to use> r: serial a: async bitbang s:sync bitbang h:sync FIFO
 *  -c <chunksize>
 *
 * (C) 2009 by Gerd v. Egidy <gerd.von.egidy@intra2net.com>
 *
 * 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 <sys/time.h>
#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <ftdi.h>
 
double get_prec_time()
{
    struct timeval tv;
    double res;
 
    gettimeofday(&tv,NULL);
 
    res=tv.tv_sec;
    res+=((double)tv.tv_usec/1000000);
 
    return res;
}
 
int main(int argc, char **argv)
{
    struct ftdi_context *ftdi;
    int i, t;
    unsigned char *txbuf;
    unsigned char *rxbuf;
    double start, duration, plan;
    int retval= 0;
 
    // default values
    int baud=9600;
    int set_baud;
    int datasize=100000;
 
    char default_devicedesc[] = "i:0x0403:0x6014";
    char *devicedesc=default_devicedesc;
    int txchunksize=256;
    enum ftdi_mpsse_mode test_mode=BITMODE_BITBANG;
 
    while ((t = getopt (argc, argv, "b:d:p:m:c:")) != -1)
    {
        switch (t)
        {
            case 'd':
                datasize = atoi (optarg);
                break;
            case 'm':
                switch (*optarg)
                {
                    case 'r':
                        // serial
                        test_mode=BITMODE_RESET;
                        break;
                    case 'a':
                        // async
                        test_mode=BITMODE_BITBANG;
                        break;
                    case 's':
                        // sync
                        test_mode=BITMODE_SYNCBB;
                        break;
                    case 'h':
                        // sync
                        test_mode=BITMODE_SYNCFF;
                        break;
                }
                break;
            case 'b':
                baud = atoi (optarg);
                break;
            case 'p':
                devicedesc=optarg;
                break;
            case 'c':
                txchunksize = atoi (optarg);
                break;
        }
    }
 
    txbuf=malloc(txchunksize);
    rxbuf=malloc(txchunksize);
    if (txbuf == NULL || rxbuf == NULL)
    {
        fprintf(stderr, "can't malloc\n");
        return EXIT_FAILURE;
    }
 
    if ((ftdi = ftdi_new()) == 0)
    {
        fprintf(stderr, "ftdi_new failed\n");
        retval = EXIT_FAILURE;
        goto done;
    }
 
    if (ftdi_usb_open_string(ftdi, devicedesc) < 0)
    {
        fprintf(stderr,"Can't open ftdi device: %s\n",ftdi_get_error_string(ftdi));
        retval = EXIT_FAILURE;
        goto do_deinit;
    }
 
    set_baud=baud;
    if (test_mode!=BITMODE_RESET)
    {
        // we do bitbang, so real baudrate / 16
        set_baud=baud/16;
    }
 
    ftdi_set_baudrate(ftdi,set_baud);
    printf("real baudrate used: %d\n",(test_mode==BITMODE_RESET) ? ftdi->baudrate : ftdi->baudrate*16);
 
    if (ftdi_set_bitmode(ftdi, 0xFF,test_mode) < 0)
    {
        fprintf(stderr,"Can't set mode: %s\n",ftdi_get_error_string(ftdi));
        retval = EXIT_FAILURE;
        goto do_close;
    }
 
    if (test_mode==BITMODE_RESET)
    {
        // serial 8N1: 8 data bits, 1 startbit, 1 stopbit
        plan=((double)(datasize*10))/baud;
    }
    else
    {
        // bitbang means 8 bits at once
        plan=((double)datasize)/baud;
    }
 
    printf("this test should take %.2f seconds\n",plan);
 
    // prepare data to send: 0 and 1 bits alternating (except for serial start/stopbit):
    // maybe someone wants to look at this with a scope or logic analyzer
    for (i=0; i<txchunksize; i++)
    {
        if (test_mode==BITMODE_RESET)
            txbuf[i]=0xAA;
        else
            txbuf[i]=(i%2) ? 0xff : 0;
    }
 
    if (ftdi_write_data_set_chunksize(ftdi, txchunksize) < 0 ||
            ftdi_read_data_set_chunksize(ftdi, txchunksize) < 0)
    {
        fprintf(stderr,"Can't set chunksize: %s\n",ftdi_get_error_string(ftdi));
        retval = EXIT_FAILURE;
        goto do_close;
    }
 
    if (test_mode==BITMODE_SYNCBB)
    {
        // completely clear the receive buffer before beginning
        while (ftdi_read_data(ftdi, rxbuf, txchunksize)>0);
    }
 
    if (test_mode==BITMODE_SYNCFF)
    {
        // completely clear the receive buffer before beginning
        while (ftdi_read_data(ftdi, rxbuf, txchunksize)>0);
    }
 
    start=get_prec_time();
 
    // don't wait for more data to arrive, take what we get and keep on sending
    // yes, we really would like to have libusb 1.0+ with async read/write...
    ftdi->usb_read_timeout=1;
 
    i=0;
    while (i < datasize)
    {
        int sendsize=txchunksize;
        if (i+sendsize > datasize)
            sendsize=datasize-i;
 
        if ((sendsize=ftdi_write_data(ftdi, txbuf, sendsize)) < 0)
        {
            fprintf(stderr,"write failed at %d: %s\n",
                    i, ftdi_get_error_string(ftdi));
            retval = EXIT_FAILURE;
            goto do_close;
        }
 
        i+=sendsize;
 
        if (test_mode==BITMODE_SYNCBB)
        {
            // read the same amount of data as sent
            ftdi_read_data(ftdi, rxbuf, sendsize);
        }
        if (test_mode==BITMODE_SYNCFF)
        {
            // read the same amount of data as sent
            ftdi_read_data(ftdi, rxbuf, sendsize);
        }
 
    }
 
    duration=get_prec_time()-start;
    printf("and took %.4f seconds, this is %.0f baud or factor %.3f\n",duration,(plan*baud)/duration,plan/duration);
do_close:
    ftdi_usb_close(ftdi);
do_deinit:
    ftdi_free(ftdi);
done:
    if(rxbuf)
        free(rxbuf);
    if(txbuf)
        free(txbuf);
    exit (retval);
}

Листинг файла stream_test.c

/* stream_test.c
 *
 * Test reading  from FT2232H in synchronous FIFO mode.
 *
 * The FT2232H must supply data due to an appropriate circuit
 *
 * To check for skipped block with appended code, 
 *     a structure as follows is assumed
 * 1* uint32_t num (incremented in 0x4000 steps)
 * 3* uint32_t dont_care
 *
 * After start, data will be read in streaming until the program is aborted
 * Progess information wil be printed out
 * If a filename is given on the command line, the data read will be
 * written to that file
 *
 */
#include <stdio.h>
#include <stdlib.h>
#include <stdint.h>
#include <string.h>
#include <unistd.h>
#include <getopt.h>
#include <signal.h>
#include <errno.h>
#include <ftdi.h>
void check_outfile(char *);
 
static FILE *outputFile;
 
static int check = 1;
static int exitRequested = 0;
/*
 * sigintHandler --
 *
 *    SIGINT handler, so we can gracefully exit when the user hits ctrl-C.
 */
 
static void
sigintHandler(int signum)
{
   exitRequested = 1;
}
 
static void
usage(const char *argv0)
{
   fprintf(stderr,
           "Usage: %s [options...] \n"
           "Test streaming read from FT2232H\n"
           "[-P string] only look for product with given string\n"
           "[-n] don't check for special block structure\n"
           "\n"
           "If some filename is given, write data read to that file\n"
           "Progess information is printed each second\n"
           "Abort with ^C\n"
           "\n"
           "Options:\n"
           "\n"
           "Copyright (C) 2009 Micah Dowty <micah@navi.cx>\n"
           "Adapted for use with libftdi (C) 2010 Uwe Bonnes <bon@elektron.ikp.physik.tu-darmstadt.de>\n",
           argv0);
   exit(1);
}
 
static uint32_t start = 0;
static uint32_t offset = 0;
static uint64_t blocks = 0;
static uint32_t skips = 0;
static uint32_t n_err = 0;
static int
readCallback(uint8_t *buffer, int length, FTDIProgressInfo *progress, void *userdata)
{
   if (length)
   {
       if (check)
       {
           int i,rem;
           uint32_t num;
           for (i= offset; i<length-16; i+=16)
           {
               num = *(uint32_t*) (buffer+i);
               if (start && (num != start +0x4000))
               {
                   uint32_t delta = ((num-start)/0x4000)-1;
                   fprintf(stderr, "Skip %7d blocks from 0x%08x to 0x%08x at blocks %10llu\n",
                           delta, start -0x4000, num, (unsigned long long)blocks);
                   n_err++;
                   skips += delta;
               }
               blocks ++;
               start = num;
           }
           rem = length -i;
           if (rem >3)
           {
               num = *(uint32_t*) (buffer+i);
               if (start && (num != start +0x4000))
               {
                   uint32_t delta = ((num-start)/0x4000)-1;
                   fprintf(stderr, "Skip %7d blocks from 0x%08x to 0x%08x at blocks %10llu\n",
                           delta, start -0x4000, num, (unsigned long long) blocks);
                   n_err++;
                   skips += delta;
               }
               start = num;
           }
           else if (rem)
               start += 0x4000;
           if (rem != 0)
           {
               blocks ++;
               offset = 16-rem;
           }
       }
       if (outputFile)
       {
           if (fwrite(buffer, length, 1, outputFile) != 1)
           {
               perror("Write error");
               return 1;
           }
       }
   }
   if (progress)
   {
       fprintf(stderr, "%10.02fs total time %9.3f MiB captured %7.1f kB/s curr rate %7.1f kB/s totalrate %d dropouts\n",
               progress->totalTime,
               progress->current.totalBytes / (1024.0 * 1024.0),
               progress->currentRate / 1024.0,
               progress->totalRate / 1024.0,
               n_err);
   }
   return exitRequested ? 1 : 0;
}
 
int main(int argc, char **argv)
{
   struct ftdi_context *ftdi;
   int err, c;
   FILE *of = NULL;
   char const *outfile  = 0;
   outputFile =0;
   exitRequested = 0;
   char *descstring = NULL;
   int option_index;
   static struct option long_options[] = {{NULL},};
 
   while ((c = getopt_long(argc, argv, "P:n", long_options, &option_index)) !=- 1)
       switch (c) 
       {
       case -1:
           break;
       case 'P':
           descstring = optarg;
           break;
       case 'n':
           check = 0;
           break;
       default:
           usage(argv[0]);
       }
 
   if (optind == argc - 1)
   {
       // Exactly one extra argument- a dump file
       outfile = argv[optind];
   }
   else if (optind < argc)
   {
       // Too many extra args
       usage(argv[0]);
   }
 
   if ((ftdi = ftdi_new()) == 0)
   {
       fprintf(stderr, "ftdi_new failed\n");
       return EXIT_FAILURE;
   }
 
   if (ftdi_set_interface(ftdi, INTERFACE_A) < 0)
   {
       fprintf(stderr, "ftdi_set_interface failed\n");
       ftdi_free(ftdi);
       return EXIT_FAILURE;
   }
 
   if (ftdi_usb_open_desc(ftdi, 0x0403, 0x6014, descstring, NULL) < 0)
   {
       fprintf(stderr,"Can't open ftdi device: %s\n",ftdi_get_error_string(ftdi));
       ftdi_free(ftdi);
       return EXIT_FAILURE;
   }
 
   /* A timeout value of 1 results in may skipped blocks */
   if(ftdi_set_latency_timer(ftdi, 2))
   {
       fprintf(stderr,"Can't set latency, Error %s\n",ftdi_get_error_string(ftdi));
       ftdi_usb_close(ftdi);
       ftdi_free(ftdi);
       return EXIT_FAILURE;
   }
 
/*   if(ftdi_usb_purge_rx_buffer(ftdi) < 0)
   {
       fprintf(stderr,"Can't rx purge\n",ftdi_get_error_string(ftdi));
       return EXIT_FAILURE;
       }*/
   if (outfile)
       if ((of = fopen(outfile,"w+")) == 0)
           fprintf(stderr,"Can't open logfile %s, Error %s\n", outfile, strerror(errno));
   if (of)
       if (setvbuf(of, NULL, _IOFBF , 1<<16) == 0)
           outputFile = of;
   signal(SIGINT, sigintHandler);
 
   err = ftdi_readstream(ftdi, readCallback, NULL, 8, 256);
   if (err < 0 && !exitRequested)
       exit(1);
 
   if (outputFile) {
       fclose(outputFile);
       outputFile = NULL;
   }
   fprintf(stderr, "Capture ended.\n");
 
//   if (ftdi_set_bitmode(ftdi,  0xff, BITMODE_RESET) < 0)
   if (ftdi_set_bitmode(ftdi,  0xff, BITMODE_SYNCFF) < 0)
   {
       fprintf(stderr,"Can't set synchronous fifo mode, Error %s\n",ftdi_get_error_string(ftdi));
       ftdi_usb_close(ftdi);
       ftdi_free(ftdi);
       return EXIT_FAILURE;
   }
   ftdi_usb_close(ftdi);
   ftdi_free(ftdi);
   signal(SIGINT, SIG_DFL);
   if (check && outfile)
   {
       if ((outputFile = fopen(outfile,"r")) == 0)
       {
           fprintf(stderr,"Can't open logfile %s, Error %s\n", outfile, strerror(errno));
           ftdi_usb_close(ftdi);
           ftdi_free(ftdi);
           return EXIT_FAILURE;
       }
       check_outfile(descstring);
       fclose(outputFile);
   }
   else if (check)
       fprintf(stderr,"%d errors of %llu blocks (%Le), %d (%Le) blocks skipped\n",
               n_err, (unsigned long long) blocks, (long double)n_err/(long double) blocks,
               skips, (long double)skips/(long double) blocks);
   exit (0);
}
 
void check_outfile(char *descstring)
{
    if(strcmp(descstring,"FT2232HTEST") == 0)
    {
       char buf0[1024];
       char buf1[1024];
       char bufr[1024];
       char *pa, *pb, *pc;
       unsigned int num_lines = 0, line_num = 1;
       int err_count = 0;
       unsigned int num_start, num_end;
 
       pa = buf0;
       pb = buf1;
       pc = buf0;
       if(fgets(pa, 1023, outputFile) == NULL)
       {
           fprintf(stderr,"Empty output file\n");
           return;
       }
       while(fgets(pb, 1023, outputFile) != NULL)
       {
           num_lines++;
           unsigned int num_save = num_start;
           if( sscanf(pa,"%6u%94s%6u",&num_start, bufr,&num_end) !=3)
           {
               fprintf(stdout,"Format doesn't match at line %8d \"%s",
                       num_lines, pa);
               err_count++;
               line_num = num_save +2;
           }
           else
           {
               if ((num_start+1)%100000 != num_end)
               {
                   if (err_count < 20)
                       fprintf(stdout,"Malformed line %d \"%s\"\n", 
                               num_lines, pa);
                   err_count++;
               }
               else if(num_start != line_num)
               {
                   if (err_count < 20)
                       fprintf(stdout,"Skipping from %d to %d\n", 
                               line_num, num_start);
                   err_count++;
 
               }
               line_num = num_end;
           }
           pa = pb;
           pb = pc;
           pc = pa;
       }
       if(err_count)
           fprintf(stdout,"\n%d errors of %d data sets %f\n", err_count, num_lines, (double) err_count/(double)num_lines);
       else
           fprintf(stdout,"No errors for %d lines\n",num_lines);
   }
    else if(strcmp(descstring,"LLBBC10") == 0)
    { 
        uint32_t block0[4];
        uint32_t block1[4];
        uint32_t *pa = block0;
        uint32_t *pb = block1;
        uint32_t *pc = block0;
        uint32_t start= 0;
        uint32_t nread = 0;
        int n_shown = 0;
        int n_errors = 0;
        if (fread(pa, sizeof(uint32_t), 4,outputFile) < 4)
        {
            fprintf(stderr,"Empty result file\n");
            return;
        }
        while(fread(pb, sizeof(uint32_t), 4,outputFile) != 0)
        {
            blocks++;
            nread =  pa[0];
            if(start>0 && (nread != start))
            {
                if(n_shown < 30)
                {
                    fprintf(stderr, "Skip %7d blocks from 0x%08x to 0x%08x at blocks %10llu \n",
                            (nread-start)/0x4000, start -0x4000, nread, (unsigned long long) blocks);
                    n_shown ++;
                }
                n_errors++;
            }
            else if (n_shown >0) 
                n_shown--; 
            start = nread + 0x4000;
            pa = pb;
            pb = pc;
            pc = pa;
        }
        if(n_errors)
            fprintf(stderr, "%d blocks wrong from %llu blocks read\n",
                    n_errors, (unsigned long long) blocks);
        else
            fprintf(stderr, "%llu blocks all fine\n", (unsigned long long) blocks);
    }
}

Co-Simulation/Примеры кода

Материал из Wiki