dscr_hantek_6022be.inc: Change vendor string to "sigrok".

[sigrok-firmware-fx2lafw.git] / gpif-acquisition.c

diff --git a/gpif-acquisition.c b/gpif-acquisition.c
index b44fbc078cbcc6e9659a841aa6f7a76201f381eb..17a87b9e968a0bd91324f4073da0fed95e44ddf2 100644 (file)
--- a/gpif-acquisition.c
+++ b/gpif-acquisition.c
@@ -1,5 +1,5 @@
 /*
- * This file is part of the fx2lafw project.
+ * This file is part of the sigrok-firmware-fx2lafw project.
  *
  * Copyright (C) 2011-2012 Uwe Hermann <uwe@hermann-uwe.de>
  * Copyright (C) 2012 Joel Holdsworth <joel@airwebreathe.org.uk>
@@ -27,7 +27,7 @@
 #include <fx2lafw.h>
 #include <gpif-acquisition.h>
 
-bit gpif_acquiring;
+__bit gpif_acquiring;
 
 static void gpif_reset_waveforms(void)
 {
@@ -54,7 +54,7 @@ static void gpif_setup_registers(void)
 
        /* When GPIF is idle, tri-state the data bus. */
        /* Bit 7: DONE, bit 0: IDLEDRV. TODO: Set/clear DONE bit? */
-       GPIFIDLECS = (1 << 0);
+       GPIFIDLECS = (0 << 0);
 
        /* When GPIF is idle, set CTL0-CTL5 to 0. */
        GPIFIDLECTL = 0;
@@ -71,7 +71,7 @@ static void gpif_setup_registers(void)
        /* Contains RDY* pin values. Read-only according to TRM. */
        GPIFREADYSTAT = 0;
 
-       /* Make GPIF stop on transcation count not flag */
+       /* Make GPIF stop on transaction count not flag. */
        EP2GPIFPFSTOP = (0 << 0);
 }
 
@@ -128,11 +128,11 @@ void gpif_init_la(void)
        /* Initialize flowstate registers (not used by us). */
        gpif_init_flowstates();
 
-       /* Reset the status */
+       /* Reset the status. */
        gpif_acquiring = FALSE;
 }
 
-static void gpif_make_delay_state(volatile BYTE *pSTATE, uint8_t delay)
+static void gpif_make_delay_state(volatile BYTE *pSTATE, uint8_t delay, uint8_t opcode, uint8_t output)
 {
        /*
         * DELAY
@@ -145,13 +145,13 @@ static void gpif_make_delay_state(volatile BYTE *pSTATE, uint8_t delay)
         * SGL=0, GIN=0, INCAD=0, NEXT=0, DATA=0, DP=0
         * Collect data in this state.
         */
-       pSTATE[8] = 0x00;
+       pSTATE[8] = opcode;
 
        /*
         * OUTPUT
         * OE[0:3]=0, CTL[0:3]=0
         */
-       pSTATE[16] = 0x00;
+       pSTATE[16] = output;
 
        /*
         * LOGIC FUNCTION
@@ -188,13 +188,22 @@ static void gpid_make_data_dp_state(volatile BYTE *pSTATE)
        pSTATE[24] = (6 << 3) | (6 << 0);
 }
 
-void gpif_acquisition_start(const struct cmd_start_acquisition *cmd)
+bool gpif_acquisition_start(const struct cmd_start_acquisition *cmd)
 {
-       xdata volatile BYTE *pSTATE;
+       int i;
+       volatile BYTE *pSTATE = &GPIF_WAVE_DATA;
 
        /* Ensure GPIF is idle before reconfiguration. */
        while (!(GPIFTRIG & 0x80));
 
+       /* Configure the EP2 FIFO. */
+       if (cmd->flags & CMD_START_FLAGS_SAMPLE_16BIT) {
+               EP2FIFOCFG = bmAUTOIN | bmWORDWIDE;
+       } else {
+               EP2FIFOCFG = bmAUTOIN;
+       }
+       SYNCDELAY();
+
        /* Set IFCONFIG to the correct clock source. */
        if (cmd->flags & CMD_START_FLAGS_CLK_48MHZ) {
                IFCONFIG = bmIFCLKSRC | bm3048MHZ | bmIFCLKOE | bmASYNC |
@@ -204,29 +213,35 @@ void gpif_acquisition_start(const struct cmd_start_acquisition *cmd)
                           bmGSTATE | bmIFGPIF;
        }
 
-       /* GPIF terminology: DP = decision point, NDP = non-decision-point */
+       if (cmd->flags & CMD_START_FLAGS_CLK_CTL2) {
+               uint8_t delay_1, delay_2;
 
-       /*
-        * Populate WAVEDATA.
-        *
-        * This is the basic algorithm implemented in our GPIF state machine:
-        *
-        * State 0: NDP: Delay for a period of time.
-        * State 1: DP: If EP2 is full, go to state 7 (the IDLE state), i.e.,
-        *          end the current waveform. Otherwise, sample data and go to
-        *          state 0 again, i.e., sample data until EP2 is full.
-        * State 2: Unused.
-        * State 3: Unused.
-        * State 4: Unused.
-        * State 5: Unused.
-        * State 6: Unused.
-        */
+               /* We need a pulse where the CTL2 pin alternates states. */
+
+               /* Make the low pulse shorter then the high pulse. */
+               delay_2 = cmd->sample_delay_l >> 2;
+               /* Work around >12MHz case resulting in a 0 delay low pulse. */
+               if (delay_2 == 0)
+                       delay_2 = 1;
+               delay_1 = cmd->sample_delay_l - delay_2;
+
+               gpif_make_delay_state(pSTATE++, delay_2, 0x00, 0x40);
+               gpif_make_delay_state(pSTATE++, delay_1, 0x00, 0x46);
+       } else {
+               /* Populate delay states. */
+               if ((cmd->sample_delay_h == 0 && cmd->sample_delay_l == 0) ||
+                       cmd->sample_delay_h >= 6)
+                       return false;
+
+               for (i = 0; i < cmd->sample_delay_h; i++)
+                       gpif_make_delay_state(pSTATE++, 0, 0x00, 0x00);
 
-       /* Populate S0 */
-       gpif_make_delay_state(&GPIF_WAVE_DATA, cmd->sample_delay);
+               if (cmd->sample_delay_l != 0)
+                       gpif_make_delay_state(pSTATE++, cmd->sample_delay_l, 0x00, 0x00);
+       }
 
        /* Populate S1 - the decision point. */
-       gpid_make_data_dp_state(&GPIF_WAVE_DATA + 1);
+       gpid_make_data_dp_state(pSTATE++);
 
        /* Execute the whole GPIF waveform once. */
        gpif_set_tc16(1);
@@ -236,6 +251,8 @@ void gpif_acquisition_start(const struct cmd_start_acquisition *cmd)
 
        /* Update the status. */
        gpif_acquiring = TRUE;
+
+       return true;
 }
 
 void gpif_poll(void)