]> sigrok.org Git - libsigrok.git/blobdiff - src/hardware/sysclk-lwla/lwla1016.c
sysclk-lwla: Work around short transfer quirk
[libsigrok.git] / src / hardware / sysclk-lwla / lwla1016.c
index b8031941cb736728036e06468c9fe4c5218e3e73..33fd7e28988fda27f3eff7cd22e48e23d45faa27 100644 (file)
 
 /* Capture memory read start address.
  */
-#define READ_START_ADDR                2
+#define READ_START_ADDR        2
 
 /* Number of device memory units (32 bit) to read at a time.
  */
-#define READ_CHUNK_LEN32       250
+#define READ_CHUNK_LEN 250
 
 /** LWLA1016 register addresses.
  */
@@ -102,9 +102,9 @@ static const char bitstream_map[][32] = {
 static void read_response(struct acquisition_state *acq)
 {
        uint32_t *in_p, *out_p;
-       size_t words_left, num_words;
-       size_t max_samples, run_samples;
-       size_t i;
+       unsigned int words_left, num_words;
+       unsigned int max_samples, run_samples;
+       unsigned int i;
 
        words_left = MIN(acq->mem_addr_next, acq->mem_addr_stop)
                        - acq->mem_addr_done;
@@ -142,9 +142,9 @@ static void read_response_rle(struct acquisition_state *acq)
 {
        uint32_t *in_p;
        uint16_t *out_p;
-       size_t words_left;
-       size_t max_samples, run_samples;
-       size_t wi, ri;
+       unsigned int words_left;
+       unsigned int max_samples, run_samples;
+       unsigned int wi, ri;
        uint32_t word;
        uint16_t sample;
 
@@ -159,11 +159,11 @@ static void read_response_rle(struct acquisition_state *acq)
                run_samples = MIN(max_samples, acq->run_len);
 
                /* Expand run-length samples into session packet. */
-               sample = acq->sample;
+               sample = GUINT16_TO_LE(acq->sample);
                out_p = &((uint16_t *)acq->out_packet)[acq->out_index];
 
                for (ri = 0; ri < run_samples; ri++)
-                       out_p[ri] = GUINT16_TO_LE(sample);
+                       out_p[ri] = sample;
 
                acq->run_len -= run_samples;
                acq->out_index += run_samples;
@@ -182,6 +182,58 @@ static void read_response_rle(struct acquisition_state *acq)
        acq->mem_addr_done += wi;
 }
 
+/* Check whether we can receive responses of more than 64 bytes.
+ * The FX2 firmware of the LWLA1016 has a bug in the reset logic which
+ * sometimes causes the response endpoint to be limited to transfers of
+ * 64 bytes at a time, instead of the expected 2*512 bytes. The problem
+ * can be worked around by never requesting more than 64 bytes.
+ * This quirk manifests itself only under certain conditions, and some
+ * users seem to see it more frequently than others. Detect it here in
+ * order to avoid paying the penalty unnecessarily.
+ */
+static int test_read_memory(const struct sr_dev_inst *sdi,
+                           unsigned int start, unsigned int count)
+{
+       struct dev_context *devc;
+       struct sr_usb_dev_inst *usb;
+       unsigned int i;
+       int xfer_len;
+       int ret;
+       uint16_t command[5];
+       unsigned char reply[512];
+
+       devc = sdi->priv;
+       usb  = sdi->conn;
+
+       command[0] = LWLA_WORD(CMD_READ_MEM32);
+       command[1] = LWLA_WORD_0(start);
+       command[2] = LWLA_WORD_1(start);
+       command[3] = LWLA_WORD_0(count);
+       command[4] = LWLA_WORD_1(count);
+
+       ret = lwla_send_command(usb, command, ARRAY_SIZE(command));
+       if (ret != SR_OK)
+               return ret;
+
+       ret = lwla_receive_reply(usb, reply, sizeof(reply), &xfer_len);
+       if (ret != SR_OK)
+               return ret;
+
+       devc->short_transfer_quirk = (xfer_len == 64);
+
+       for (i = xfer_len; i < 4 * count && xfer_len == 64; i += xfer_len) {
+               ret = lwla_receive_reply(usb, reply, sizeof(reply), &xfer_len);
+               if (ret != SR_OK)
+                       return ret;
+       }
+       if (i != 4 * count) {
+               sr_err("Invalid read response of unexpected length %d.",
+                      xfer_len);
+               return SR_ERR;
+       }
+       return SR_OK;
+}
+
 /* Select and transfer FPGA bitstream for the current configuration.
  */
 static int apply_fpga_config(const struct sr_dev_inst *sdi)
@@ -213,9 +265,15 @@ static int apply_fpga_config(const struct sr_dev_inst *sdi)
  */
 static int device_init_check(const struct sr_dev_inst *sdi)
 {
+       static const struct regval mem_reset[] = {
+               {REG_MEM_CTRL, MEM_CTRL_RESET},
+               {REG_MEM_CTRL, 0},
+       };
        uint32_t value;
        int ret;
 
+       const unsigned int test_count = 24;
+
        ret = lwla_read_reg(sdi->conn, REG_TEST_ID, &value);
        if (ret != SR_OK)
                return ret;
@@ -229,7 +287,19 @@ static int device_init_check(const struct sr_dev_inst *sdi)
                sr_err("Received invalid test word 0x%08X.", value);
                return SR_ERR;
        }
-       return SR_OK;
+
+       ret = lwla_write_regs(sdi->conn, mem_reset, ARRAY_SIZE(mem_reset));
+       if (ret != SR_OK)
+               return ret;
+
+       ret = test_read_memory(sdi, 0, test_count);
+       if (ret != SR_OK)
+               return ret;
+       /*
+        * Issue another read request or the device will stall, for whatever
+        * reason. This happens both with and without the short transfer quirk.
+        */
+       return test_read_memory(sdi, test_count, test_count);
 }
 
 static int setup_acquisition(const struct sr_dev_inst *sdi)
@@ -285,7 +355,7 @@ static int prepare_request(const struct sr_dev_inst *sdi)
 {
        struct dev_context *devc;
        struct acquisition_state *acq;
-       size_t count;
+       unsigned int chunk_len, count;
 
        devc = sdi->priv;
        acq  = devc->acquisition;
@@ -319,9 +389,10 @@ static int prepare_request(const struct sr_dev_inst *sdi)
                lwla_queue_regval(acq, REG_CAP_COUNT, 0);
                break;
        case STATE_READ_REQUEST:
-               /* Always read a multiple of 8 device words. */
-               count = MIN(READ_CHUNK_LEN32,
-                           acq->mem_addr_stop - acq->mem_addr_next);
+               /* Limit reads to 16 device words (64 bytes) at a time if the
+                * device firmware has the short transfer quirk. */
+               chunk_len = (devc->short_transfer_quirk) ? 16 : READ_CHUNK_LEN;
+               count = MIN(chunk_len, acq->mem_addr_stop - acq->mem_addr_next);
 
                acq->xfer_buf_out[0] = LWLA_WORD(CMD_READ_MEM32);
                acq->xfer_buf_out[1] = LWLA_WORD_0(acq->mem_addr_next);