mpsse.c

   1 /*
   2  *  iceprog -- simple programming tool for FTDI-based Lattice iCE programmers
   3  *
   4  *  Copyright (C) 2015  Clifford Wolf <clifford@clifford.at>
   5  *  Copyright (C) 2018  Piotr Esden-Tempski <piotr@esden.net>
   6  *
   7  *  Permission to use, copy, modify, and/or distribute this software for any
   8  *  purpose with or without fee is hereby granted, provided that the above
   9  *  copyright notice and this permission notice appear in all copies.
  10  *
  11  *  THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
  12  *  WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  13  *  MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  14  *  ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  15  *  WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  16  *  ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  17  *  OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  18  *
  19  *  Relevant Documents:
  20  *  -------------------
  21  *  http://www.ftdichip.com/Support/Documents/AppNotes/AN_108_Command_Processor_for_MPSSE_and_MCU_Host_Bus_Emulation_Modes.pdf
  22  */
  23
  24 #define _GNU_SOURCE
  25
  26 #include <ftdi.h>
  27 #include <stdio.h>
  28 #include <stdint.h>
  29 #include <stdbool.h>
  30 #include <stdlib.h>
  31 #include <unistd.h>
  32
  33 #include "mpsse.h"
  34
  35 // ---------------------------------------------------------
  36 // MPSSE / FTDI definitions
  37 // ---------------------------------------------------------
  38
  39 /* FTDI bank pinout typically used for iCE dev boards
  40  * BUS IO | Signal | Control
  41  * -------+--------+--------------
  42  * xDBUS0 |    SCK | MPSSE
  43  * xDBUS1 |   MOSI | MPSSE
  44  * xDBUS2 |   MISO | MPSSE
  45  * xDBUS3 |     nc |
  46  * xDBUS4 |     CS | GPIO
  47  * xDBUS5 |     nc |
  48  * xDBUS6 |  CDONE | GPIO
  49  * xDBUS7 | CRESET | GPIO
  50  */
  51
  52 struct ftdi_context mpsse_ftdic;
  53 bool mpsse_ftdic_open = false;
  54 bool mpsse_ftdic_latency_set = false;
  55 unsigned char mpsse_ftdi_latency;
  56
  57
  58 // ---------------------------------------------------------
  59 // MPSSE / FTDI function implementations
  60 // ---------------------------------------------------------
  61
  62 void mpsse_check_rx()
  63 {
  64         uint8_t cnt = 0;
  65         while (1) {
  66                 uint8_t data;
  67                 int rc = ftdi_read_data(&mpsse_ftdic, &data, 1);
  68                 if (rc <= 0)
  69                         break;
  70                 fprintf(stderr, "unexpected rx byte: %02X\n", data);
  71                 cnt++;
  72
  73                 if(cnt > 32)
  74                         break;
  75         }
  76 }
  77
  78 void mpsse_error(int status)
  79 {
  80         mpsse_check_rx();
  81         fprintf(stderr, "ABORT.\n");
  82         if (mpsse_ftdic_open) {
  83                 if (mpsse_ftdic_latency_set)
  84                         ftdi_set_latency_timer(&mpsse_ftdic, mpsse_ftdi_latency);
  85                 ftdi_usb_close(&mpsse_ftdic);
  86         }
  87         ftdi_deinit(&mpsse_ftdic);
  88         exit(status);
  89 }
  90
  91 uint8_t mpsse_recv_byte()
  92 {
  93         uint8_t data;
  94         while (1) {
  95                 int rc = ftdi_read_data(&mpsse_ftdic, &data, 1);
  96                 if (rc < 0) {
  97                         fprintf(stderr, "Read error.\n");
  98                         mpsse_error(2);
  99                 }
 100                 if (rc == 1)
 101                         break;
 102                 usleep(100);
 103         }
 104         return data;
 105 }
 106
 107 void mpsse_send_byte(uint8_t data)
 108 {
 109         int rc = ftdi_write_data(&mpsse_ftdic, &data, 1);
 110         if (rc != 1) {
 111                 fprintf(stderr, "Write error (single byte, rc=%d, expected %d)(%s).\n", rc, 1, ftdi_get_error_string(&mpsse_ftdic));
 112                 mpsse_error(2);
 113         }
 114 }
 115
 116 void mpsse_purge(void){
 117         int rc = ftdi_usb_purge_buffers(&mpsse_ftdic);
 118         if (rc != 0) {
 119                 fprintf(stderr, "Purge error.\n");
 120                 mpsse_error(2);
 121         }
 122 }
 123
 124 void mpsse_xfer(uint8_t* data_buffer, uint16_t send_length, uint16_t receive_length)
 125 {
 126         if(send_length){
 127                 int rc = ftdi_write_data(&mpsse_ftdic, data_buffer, send_length);
 128                 if (rc != send_length) {
 129                         fprintf(stderr, "Write error (rc=%d, expected %d)[%s]\n", rc, 1, ftdi_get_error_string(&mpsse_ftdic));
 130                         mpsse_error(2);
 131                 }
 132         }
 133
 134         if(receive_length){
 135                 /* Calls to ftdi_read_data may return with less data than requested if it wasn't ready.
 136                  * We stay in this while loop to collect all the data that we expect. */
 137                 uint16_t rx_len = 0;
 138                 while(rx_len != receive_length){
 139                         int rc = ftdi_read_data(&mpsse_ftdic, data_buffer + rx_len, receive_length - rx_len);
 140                         if (rc < 0) {
 141                                 fprintf(stderr, "Read error (rc=%d)[%s]\n", rc, ftdi_get_error_string(&mpsse_ftdic));
 142                                 mpsse_error(2);
 143                         }else{
 144                                 rx_len += rc;
 145                         }
 146                 }
 147         }
 148 }
 149
 150 void mpsse_jtag_init(){
 151         mpsse_send_byte(MC_SETB_LOW);
 152         mpsse_send_byte(0x08); /* Value */
 153         mpsse_send_byte(0x0B); /* Direction */
 154
 155         /* Reset JTAG State machine */
 156         jtag_init();
 157 }
 158
 159 void mpsse_jtag_tms(uint8_t bits, uint8_t pattern){
 160         mpsse_send_byte(MC_DATA_TMS | MC_DATA_LSB | MC_DATA_BITS);
 161         mpsse_send_byte(bits-1);
 162         mpsse_send_byte(pattern);
 163 }
 164
 165 void mpsse_init(int ifnum, const char *devstr, bool slow_clock)
 166 {
 167         enum ftdi_interface ftdi_ifnum = INTERFACE_A;
 168
 169         switch (ifnum) {
 170                 case 0:
 171                         ftdi_ifnum = INTERFACE_A;
 172                         break;
 173                 case 1:
 174                         ftdi_ifnum = INTERFACE_B;
 175                         break;
 176                 case 2:
 177                         ftdi_ifnum = INTERFACE_C;
 178                         break;
 179                 case 3:
 180                         ftdi_ifnum = INTERFACE_D;
 181                         break;
 182                 default:
 183                         ftdi_ifnum = INTERFACE_A;
 184                         break;
 185         }
 186
 187         ftdi_init(&mpsse_ftdic);
 188         ftdi_set_interface(&mpsse_ftdic, ftdi_ifnum);
 189
 190         if (devstr != NULL) {
 191                 if (ftdi_usb_open_string(&mpsse_ftdic, devstr)) {
 192                         fprintf(stderr, "Can't find iCE FTDI USB device (device string %s).\n", devstr);
 193                         mpsse_error(2);
 194                 }
 195         } else {
 196                 if (ftdi_usb_open(&mpsse_ftdic, 0x0403, 0x6010) && ftdi_usb_open(&mpsse_ftdic, 0x0403, 0x6014)) {
 197                         fprintf(stderr, "Can't find iCE FTDI USB device (vendor_id 0x0403, device_id 0x6010 or 0x6014).\n");
 198                         mpsse_error(2);
 199                 }
 200         }
 201
 202         mpsse_ftdic_open = true;
 203
 204         if (ftdi_usb_reset(&mpsse_ftdic)) {
 205                 fprintf(stderr, "Failed to reset iCE FTDI USB device.\n");
 206                 mpsse_error(2);
 207         }
 208
 209         if (ftdi_usb_purge_buffers(&mpsse_ftdic)) {
 210                 fprintf(stderr, "Failed to purge buffers on iCE FTDI USB device.\n");
 211                 mpsse_error(2);
 212         }
 213
 214         if (ftdi_get_latency_timer(&mpsse_ftdic, &mpsse_ftdi_latency) < 0) {
 215                 fprintf(stderr, "Failed to get latency timer (%s).\n", ftdi_get_error_string(&mpsse_ftdic));
 216                 mpsse_error(2);
 217         }
 218
 219         /* 1 is the fastest polling, it means 1 kHz polling */
 220         if (ftdi_set_latency_timer(&mpsse_ftdic, 1) < 0) {
 221                 fprintf(stderr, "Failed to set latency timer (%s).\n", ftdi_get_error_string(&mpsse_ftdic));
 222                 mpsse_error(2);
 223         }
 224
 225         mpsse_ftdic_latency_set = true;
 226
 227         /* Enter MPSSE (Multi-Protocol Synchronous Serial Engine) mode. Set all pins to output. */
 228         if (ftdi_set_bitmode(&mpsse_ftdic, 0xff, BITMODE_MPSSE) < 0) {
 229                 fprintf(stderr, "Failed to set BITMODE_MPSSE on FTDI USB device.\n");
 230                 mpsse_error(2);
 231         }
 232
 233         int rc = ftdi_usb_purge_buffers(&mpsse_ftdic);
 234         if (rc != 0) {
 235                 fprintf(stderr, "Purge error.\n");
 236                 mpsse_error(2);
 237         }
 238
 239         if (slow_clock) {
 240                 // set 50 kHz clock
 241                 mpsse_send_byte(MC_SET_CLK_DIV);
 242                 mpsse_send_byte(119);
 243                 mpsse_send_byte(0x00);
 244         } else {
 245                 // set 6 MHz clock
 246                 mpsse_send_byte(MC_SET_CLK_DIV);
 247                 mpsse_send_byte(5);
 248                 mpsse_send_byte(0x00);
 249         }
 250 }
 251
 252 void mpsse_close(void)
 253 {
 254         ftdi_set_latency_timer(&mpsse_ftdic, mpsse_ftdi_latency);
 255         ftdi_disable_bitbang(&mpsse_ftdic);
 256         ftdi_usb_close(&mpsse_ftdic);
 257         ftdi_deinit(&mpsse_ftdic);
 258 }