]> sigrok.org Git - libsigrok.git/blobdiff - hardware/link-mso19/protocol.c
More cleanup. Communication with mso19 is working, but its not triggering. Need to...
[libsigrok.git] / hardware / link-mso19 / protocol.c
index 5c879dd19ee76e36288aa76d605a2dda040d79c0..1b20ac9b0124ebdf21b493e696071fb8988fc9b5 100644 (file)
  */
 
 #include "protocol.h"
+#include <arpa/inet.h>
 
 extern SR_PRIV struct sr_dev_driver link_mso19_driver_info;
 static struct sr_dev_driver *di = &link_mso19_driver_info;
 
-SR_PRIV int mso_parse_serial(const char *iSerial, const char *iProduct,
-    struct dev_context *devc)
-{
-       unsigned int u1, u2, u3, u4, u5, u6;
-
-  iProduct = iProduct;
-  /* FIXME: This code is in the original app, but I think its
-   * used only for the GUI */
-  /*   if (strstr(iProduct, "REV_02") || strstr(iProduct, "REV_03"))
-      devc->num_sample_rates = 0x16;
-      else
-      devc->num_sample_rates = 0x10; */
-  
-
-       /* parse iSerial */
-       if (iSerial[0] != '4' || sscanf(iSerial, "%5u%3u%3u%1u%1u%6u",
-                               &u1, &u2, &u3, &u4, &u5, &u6) != 6)
-               return SR_ERR;
-       devc->hwmodel = u4;
-       devc->hwrev = u5;
-       devc->serial = u6;
-       devc->vbit = u1 / 10000;
-       if (devc->vbit == 0)
-               devc->vbit = 4.19195;
-       devc->dac_offset = u2;
-       if (devc->dac_offset == 0)
-               devc->dac_offset = 0x1ff;
-       devc->offset_range = u3;
-       if (devc->offset_range == 0)
-               devc->offset_range = 0x17d;
-
-       /*
-        * FIXME: There is more code on the original software to handle
-        * bigger iSerial strings, but as I can't test on my device
-        * I will not implement it yet
-        */
-
-       return SR_OK;
-}
-
 SR_PRIV int mso_send_control_message(struct sr_serial_dev_inst *serial,
     uint16_t payload[], int n)
 {
@@ -105,6 +66,180 @@ ret:
        return ret;
 }
 
+
+SR_PRIV int mso_configure_trigger(struct sr_dev_inst *sdi)
+{
+       struct dev_context *devc = sdi->priv;
+       uint16_t ops[16];
+       uint16_t dso_trigger = mso_calc_raw_from_mv(devc);
+
+       dso_trigger &= 0x3ff;
+       if ((!devc->trigger_slope && devc->trigger_chan == 1) ||
+                       (devc->trigger_slope &&
+                        (devc->trigger_chan == 0 ||
+                         devc->trigger_chan == 2 ||
+                         devc->trigger_chan == 3)))
+               dso_trigger |= 0x400;
+
+       switch (devc->trigger_chan) {
+       case 1:
+               dso_trigger |= 0xe000;
+       case 2:
+               dso_trigger |= 0x4000;
+               break;
+       case 3:
+               dso_trigger |= 0x2000;
+               break;
+       case 4:
+               dso_trigger |= 0xa000;
+               break;
+       case 5:
+               dso_trigger |= 0x8000;
+               break;
+       default:
+       case 0:
+               break;
+       }
+
+       switch (devc->trigger_outsrc) {
+       case 1:
+               dso_trigger |= 0x800;
+               break;
+       case 2:
+               dso_trigger |= 0x1000;
+               break;
+       case 3:
+               dso_trigger |= 0x1800;
+               break;
+
+       }
+
+       ops[0] = mso_trans(5, devc->la_trigger);
+       ops[1] = mso_trans(6, devc->la_trigger_mask);
+       ops[2] = mso_trans(3, dso_trigger & 0xff);
+       ops[3] = mso_trans(4, (dso_trigger >> 8) & 0xff);
+       ops[4] = mso_trans(11,
+                       devc->dso_trigger_width / SR_HZ_TO_NS(devc->cur_rate));
+
+       /* Select the SPI/I2C trigger config bank */
+       ops[5] = mso_trans(REG_CTL2, (devc->ctlbase2 | BITS_CTL2_BANK(2)));
+       /* Configure the SPI/I2C protocol trigger */
+       ops[6] = mso_trans(REG_PT_WORD(0), devc->protocol_trigger.word[0]);
+       ops[7] = mso_trans(REG_PT_WORD(1), devc->protocol_trigger.word[1]);
+       ops[8] = mso_trans(REG_PT_WORD(2), devc->protocol_trigger.word[2]);
+       ops[9] = mso_trans(REG_PT_WORD(3), devc->protocol_trigger.word[3]);
+       ops[10] = mso_trans(REG_PT_MASK(0), devc->protocol_trigger.mask[0]);
+       ops[11] = mso_trans(REG_PT_MASK(1), devc->protocol_trigger.mask[1]);
+       ops[12] = mso_trans(REG_PT_MASK(2), devc->protocol_trigger.mask[2]);
+       ops[13] = mso_trans(REG_PT_MASK(3), devc->protocol_trigger.mask[3]);
+       ops[14] = mso_trans(REG_PT_SPIMODE, devc->protocol_trigger.spimode);
+       /* Select the default config bank */
+       ops[15] = mso_trans(REG_CTL2, devc->ctlbase2);
+
+       return mso_send_control_message(devc->serial, ARRAY_AND_SIZE(ops));
+}
+
+SR_PRIV int mso_configure_threshold_level(struct sr_dev_inst *sdi)
+{
+       struct dev_context *devc = sdi->priv;
+
+       return mso_dac_out(sdi, la_threshold_map[devc->la_threshold]);
+}
+
+SR_PRIV int mso_read_buffer(struct sr_dev_inst *sdi)
+{
+       uint16_t ops[] = { mso_trans(REG_BUFFER, 0) };
+       struct dev_context *devc = sdi->priv;
+
+       sr_dbg("Requesting buffer dump.");
+       return mso_send_control_message(devc->serial, ARRAY_AND_SIZE(ops));
+}
+
+SR_PRIV int mso_arm(struct sr_dev_inst *sdi)
+{
+       struct dev_context *devc = sdi->priv;
+       uint16_t ops[] = {
+               mso_trans(REG_CTL1, devc->ctlbase1 | BIT_CTL1_RESETFSM),
+               mso_trans(REG_CTL1, devc->ctlbase1 | BIT_CTL1_ARM),
+               mso_trans(REG_CTL1, devc->ctlbase1),
+       };
+
+       sr_dbg("Requesting trigger arm.");
+       return mso_send_control_message(devc->serial, ARRAY_AND_SIZE(ops));
+}
+
+SR_PRIV int mso_force_capture(struct sr_dev_inst *sdi)
+{
+       struct dev_context *devc = sdi->priv;
+       uint16_t ops[] = {
+               mso_trans(REG_CTL1, devc->ctlbase1 | 8),
+               mso_trans(REG_CTL1, devc->ctlbase1),
+       };
+
+       sr_dbg("Requesting forced capture.");
+       return mso_send_control_message(devc->serial, ARRAY_AND_SIZE(ops));
+}
+
+SR_PRIV int mso_dac_out(struct sr_dev_inst *sdi, uint16_t val)
+{
+       struct dev_context *devc = sdi->priv;
+       uint16_t ops[] = {
+               mso_trans(REG_DAC1, (val >> 8) & 0xff),
+               mso_trans(REG_DAC2, val & 0xff),
+               mso_trans(REG_CTL1, devc->ctlbase1 | BIT_CTL1_RESETADC),
+       };
+
+       sr_dbg("Setting dac word to 0x%x.", val);
+       return mso_send_control_message(devc->serial, ARRAY_AND_SIZE(ops));
+}
+
+SR_PRIV inline uint16_t mso_calc_raw_from_mv(struct dev_context *devc)
+{
+       return (uint16_t) (0x200 -
+                       ((devc->dso_trigger_voltage / devc->dso_probe_attn) /
+                        devc->vbit));
+}
+
+
+SR_PRIV int mso_parse_serial(const char *iSerial, const char *iProduct,
+    struct dev_context *devc)
+{
+       unsigned int u1, u2, u3, u4, u5, u6;
+
+  iProduct = iProduct;
+  /* FIXME: This code is in the original app, but I think its
+   * used only for the GUI */
+  /*   if (strstr(iProduct, "REV_02") || strstr(iProduct, "REV_03"))
+      devc->num_sample_rates = 0x16;
+      else
+      devc->num_sample_rates = 0x10; */
+  
+
+       /* parse iSerial */
+       if (iSerial[0] != '4' || sscanf(iSerial, "%5u%3u%3u%1u%1u%6u",
+                               &u1, &u2, &u3, &u4, &u5, &u6) != 6)
+               return SR_ERR;
+       devc->hwmodel = u4;
+       devc->hwrev = u5;
+       devc->vbit = u1 / 10000;
+       if (devc->vbit == 0)
+               devc->vbit = 4.19195;
+       devc->dac_offset = u2;
+       if (devc->dac_offset == 0)
+               devc->dac_offset = 0x1ff;
+       devc->offset_range = u3;
+       if (devc->offset_range == 0)
+               devc->offset_range = 0x17d;
+
+       /*
+        * FIXME: There is more code on the original software to handle
+        * bigger iSerial strings, but as I can't test on my device
+        * I will not implement it yet
+        */
+
+       return SR_OK;
+}
+
 SR_PRIV int mso_reset_adc(struct sr_dev_inst *sdi)
 {
        struct dev_context *devc = sdi->priv;
@@ -118,6 +253,32 @@ SR_PRIV int mso_reset_adc(struct sr_dev_inst *sdi)
        return mso_send_control_message(devc->serial, ARRAY_AND_SIZE(ops));
 }
 
+SR_PRIV int mso_reset_fsm(struct sr_dev_inst *sdi)
+{
+       struct dev_context *devc = sdi->priv;
+       uint16_t ops[1];
+
+       devc->ctlbase1 |= BIT_CTL1_RESETFSM;
+       ops[0] = mso_trans(REG_CTL1, devc->ctlbase1);
+
+       sr_dbg("Requesting ADC reset.");
+       return mso_send_control_message(devc->serial, ARRAY_AND_SIZE(ops));
+}
+
+SR_PRIV int mso_toggle_led(struct sr_dev_inst *sdi, int state)
+{
+       struct dev_context *devc = sdi->priv;
+       uint16_t ops[1];
+
+       devc->ctlbase1 &= ~BIT_CTL1_LED;
+       if (state)
+               devc->ctlbase1 |= BIT_CTL1_LED;
+       ops[0] = mso_trans(REG_CTL1, devc->ctlbase1);
+
+       sr_dbg("Requesting LED toggle.");
+       return mso_send_control_message(devc->serial, ARRAY_AND_SIZE(ops));
+}
+
 SR_PRIV void stop_acquisition(const struct sr_dev_inst *sdi)
 {
        struct sr_datafeed_packet packet;
@@ -151,12 +312,16 @@ SR_PRIV int mso_configure_rate(struct sr_dev_inst *sdi, uint32_t rate)
        for (i = 0; i < ARRAY_SIZE(rate_map); i++) {
                if (rate_map[i].rate == rate) {
                        devc->ctlbase2 = rate_map[i].slowmode;
-                       ret = mso_clkrate_out(sdi, rate_map[i].val);
+                       ret = mso_clkrate_out(devc->serial, rate_map[i].val);
                        if (ret == SR_OK)
                                devc->cur_rate = rate;
                        return ret;
                }
        }
+
+  if (ret != SR_OK)
+               sr_err("Unsupported rate.");
+
        return ret;
 }
 
@@ -190,16 +355,13 @@ SR_PRIV int mso_receive_data(int fd, int revents, void *cb_data)
        struct sr_datafeed_packet packet;
        struct sr_datafeed_logic logic;
        struct sr_dev_inst *sdi;
-       struct drv_context *drvc;
-       struct dev_context *devc;
        GSList *l;
-       int num_channels, offset, i, j;
-       unsigned char byte;
+       int i;
 
-       drvc = di->priv;
+       struct drv_context *drvc = di->priv;
 
        /* Find this device's devc struct by its fd. */
-       devc = NULL;
+       struct dev_context *devc = NULL;
        for (l = drvc->instances; l; l = l->next) {
                sdi = l->data;
                devc = sdi->priv;
@@ -268,4 +430,5 @@ SR_PRIV int mso_receive_data(int fd, int revents, void *cb_data)
        packet.type = SR_DF_END;
        sr_session_send(devc->session_dev_id, &packet);
 
+  return TRUE;
 }