fx2lafw.c

   1 /*
   2  * This file is part of the sigrok-firmware-fx2lafw project.
   3  *
   4  * Copyright (C) 2011-2012 Uwe Hermann <uwe@hermann-uwe.de>
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License as published by
   8  * the Free Software Foundation; either version 2 of the License, or
   9  * (at your option) any later version.
  10  *
  11  * This program is distributed in the hope that it will be useful,
  12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14  * GNU General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU General Public License
  17  * along with this program; if not, see <http://www.gnu.org/licenses/>.
  18  */
  19
  20 /*
  21  * fx2lafw is an open-source firmware for Cypress FX2 based logic analyzers.
  22  *
  23  * It is written in C, using fx2lib as helper library, and sdcc as compiler.
  24  * The code is licensed under the terms of the GNU GPL, version 2 or later.
  25  *
  26  * Technical notes:
  27  *
  28  *  - We use the FX2 in GPIF mode to sample the data (asynchronously).
  29  *  - We use the internal 48MHz clock for GPIF.
  30  *  - The 8 channels/pins we sample (the GPIF data bus) are PB0-PB7,
  31  *    or PB0-PB7 + PD0-PD7 for 16-channel sampling.
  32  *  - Endpoint 2 (quad-buffered) is used for data transfers from FX2 to host.
  33  *
  34  * Documentation:
  35  *
  36  *  - See http://sigrok.org/wiki/Fx2lafw
  37  */
  38
  39 #include <fx2regs.h>
  40 #include <fx2macros.h>
  41 #include <fx2ints.h>
  42 #include <delay.h>
  43 #include <setupdat.h>
  44 #include <eputils.h>
  45 #include <gpif.h>
  46 #include <command.h>
  47 #include <fx2lafw.h>
  48 #include <gpif-acquisition.h>
  49
  50 /* ... */
  51 volatile __bit got_sud;
  52 BYTE vendor_command;
  53
  54 volatile WORD ledcounter = 1000;
  55
  56 extern __bit gpif_acquiring;
  57
  58 static void setup_endpoints(void)
  59 {
  60         /* Setup EP2 (IN). */
  61         EP2CFG = (1 << 7) |               /* EP is valid/activated */
  62                  (1 << 6) |               /* EP direction: IN */
  63                  (1 << 5) | (0 << 4) |    /* EP Type: bulk */
  64                  (1 << 3) |               /* EP buffer size: 1024 */
  65                  (0 << 2) |               /* Reserved. */
  66                  (0 << 1) | (0 << 0);     /* EP buffering: quad buffering */
  67         SYNCDELAY();
  68
  69         /* Disable all other EPs (EP1, EP4, EP6, and EP8). */
  70         EP1INCFG &= ~bmVALID;
  71         SYNCDELAY();
  72         EP1OUTCFG &= ~bmVALID;
  73         SYNCDELAY();
  74         EP4CFG &= ~bmVALID;
  75         SYNCDELAY();
  76         EP6CFG &= ~bmVALID;
  77         SYNCDELAY();
  78         EP8CFG &= ~bmVALID;
  79         SYNCDELAY();
  80
  81         /* EP2: Reset the FIFOs. */
  82         /* Note: RESETFIFO() gets the EP number WITHOUT bit 7 set/cleared. */
  83         RESETFIFO(0x02)
  84
  85         /* EP2: Enable AUTOIN mode. Set FIFO width to 8bits. */
  86         EP2FIFOCFG = bmAUTOIN;
  87         SYNCDELAY();
  88
  89         /* EP2: Auto-commit 512 (0x200) byte packets (due to AUTOIN = 1). */
  90         EP2AUTOINLENH = 0x02;
  91         SYNCDELAY();
  92         EP2AUTOINLENL = 0x00;
  93         SYNCDELAY();
  94
  95         /* EP2: Set the GPIF flag to 'full'. */
  96         EP2GPIFFLGSEL = (1 << 1) | (0 << 1);
  97         SYNCDELAY();
  98 }
  99
 100 static void send_fw_version(void)
 101 {
 102         /* Populate the buffer. */
 103         struct version_info *const vi = (struct version_info *)EP0BUF;
 104         vi->major = FX2LAFW_VERSION_MAJOR;
 105         vi->minor = FX2LAFW_VERSION_MINOR;
 106
 107         /* Send the message. */
 108         EP0BCH = 0;
 109         EP0BCL = sizeof(struct version_info);
 110 }
 111
 112 static void send_revid_version(void)
 113 {
 114         uint8_t *p;
 115
 116         /* Populate the buffer. */
 117         p = (uint8_t *)EP0BUF;
 118         *p = REVID;
 119
 120         /* Send the message. */
 121         EP0BCH = 0;
 122         EP0BCL = 1;
 123 }
 124
 125 BOOL handle_vendorcommand(BYTE cmd)
 126 {
 127         /* Protocol implementation */
 128         switch (cmd) {
 129         case CMD_START:
 130                 vendor_command = cmd;
 131                 EP0BCL = 0;
 132                 return TRUE;
 133                 break;
 134         case CMD_GET_FW_VERSION:
 135                 send_fw_version();
 136                 return TRUE;
 137                 break;
 138         case CMD_GET_REVID_VERSION:
 139                 send_revid_version();
 140                 return TRUE;
 141                 break;
 142         }
 143
 144         return FALSE;
 145 }
 146
 147 BOOL handle_get_interface(BYTE ifc, BYTE *alt_ifc)
 148 {
 149         /* We only support interface 0, alternate interface 0. */
 150         if (ifc != 0)
 151                 return FALSE;
 152
 153         *alt_ifc = 0;
 154         return TRUE;
 155 }
 156
 157 BOOL handle_set_interface(BYTE ifc, BYTE alt_ifc)
 158 {
 159         /* We only support interface 0, alternate interface 0. */
 160         if (ifc != 0 || alt_ifc != 0)
 161                 return FALSE;
 162
 163         /* Perform procedure from TRM, section 2.3.7: */
 164
 165         /* (1) TODO. */
 166
 167         /* (2) Reset data toggles of the EPs in the interface. */
 168         /* Note: RESETTOGGLE() gets the EP number WITH bit 7 set/cleared. */
 169         RESETTOGGLE(0x82);
 170
 171         /* (3) Restore EPs to their default conditions. */
 172         /* Note: RESETFIFO() gets the EP number WITHOUT bit 7 set/cleared. */
 173         RESETFIFO(0x02);
 174         /* TODO */
 175
 176         /* (4) Clear the HSNAK bit. Not needed, fx2lib does this. */
 177
 178         return TRUE;
 179 }
 180
 181 BYTE handle_get_configuration(void)
 182 {
 183         /* We only support configuration 1. */
 184         return 1;
 185 }
 186
 187 BOOL handle_set_configuration(BYTE cfg)
 188 {
 189         /* We only support configuration 1. */
 190         return (cfg == 1) ? TRUE : FALSE;
 191 }
 192
 193 void sudav_isr(void) __interrupt SUDAV_ISR
 194 {
 195         got_sud = TRUE;
 196         CLEAR_SUDAV();
 197 }
 198
 199 void usbreset_isr(void) __interrupt USBRESET_ISR
 200 {
 201         handle_hispeed(FALSE);
 202         CLEAR_USBRESET();
 203 }
 204
 205 void hispeed_isr(void) __interrupt HISPEED_ISR
 206 {
 207         handle_hispeed(TRUE);
 208         CLEAR_HISPEED();
 209 }
 210
 211 void timer2_isr(void) __interrupt TF2_ISR
 212 {
 213         /* Blink LED during acquisition, keep it on otherwise. */
 214         if (gpif_acquiring) {
 215                 if (--ledcounter == 0) {
 216                         PA1 = !PA1;
 217                         ledcounter = 1000;
 218                 }
 219         } else {
 220                 PA1 = 1; /* LED on. */
 221         }
 222         TF2 = 0;
 223 }
 224
 225 void fx2lafw_init(void)
 226 {
 227         /* Set DYN_OUT and ENH_PKT bits, as recommended by the TRM. */
 228         REVCTL = bmNOAUTOARM | bmSKIPCOMMIT;
 229
 230         got_sud = FALSE;
 231         vendor_command = 0;
 232
 233         /* Renumerate. */
 234         RENUMERATE_UNCOND();
 235
 236         SETCPUFREQ(CLK_48M);
 237
 238         USE_USB_INTS();
 239
 240         /* TODO: Does the order of the following lines matter? */
 241         ENABLE_SUDAV();
 242         ENABLE_HISPEED();
 243         ENABLE_USBRESET();
 244
 245         /* PA1 (LED) is an output. */
 246         PORTACFG = 0;
 247         OEA = (1 << 1);
 248         PA1 = 1; /* LED on. */
 249
 250         /* Init timer2. */
 251         RCAP2L = -500 & 0xff;
 252         RCAP2H = (-500 & 0xff00) >> 8;
 253         T2CON = 0;
 254         ET2 = 1;
 255         TR2 = 1;
 256
 257         /* Global (8051) interrupt enable. */
 258         EA = 1;
 259
 260         /* Setup the endpoints. */
 261         setup_endpoints();
 262
 263         /* Put the FX2 into GPIF master mode and setup the GPIF. */
 264         gpif_init_la();
 265 }
 266
 267 void fx2lafw_poll(void)
 268 {
 269         if (got_sud) {
 270                 handle_setupdata();
 271                 got_sud = FALSE;
 272         }
 273
 274         if (vendor_command) {
 275                 switch (vendor_command) {
 276                 case CMD_START:
 277                         if ((EP0CS & bmEPBUSY) != 0)
 278                                 break;
 279
 280                         if (EP0BCL == sizeof(struct cmd_start_acquisition)) {
 281                                 gpif_acquisition_start(
 282                                  (const struct cmd_start_acquisition *)EP0BUF);
 283                         }
 284
 285                         /* Acknowledge the vendor command. */
 286                         vendor_command = 0;
 287                         break;
 288                 default:
 289                         /* Unimplemented command. */
 290                         vendor_command = 0;
 291                         break;
 292                 }
 293         }
 294
 295         gpif_poll();
 296 }
 297
 298 void main(void)
 299 {
 300         fx2lafw_init();
 301         while (1)
 302                 fx2lafw_poll();
 303 }