X-Git-Url: http://sigrok.org/gitweb/?a=blobdiff_plain;f=hardware%2Fzeroplus-logic-cube%2Fapi.c;h=177c18416bfc3f77826deed17e659732ed4ecfd4;hb=a68bf88e3a6ba0184f1d6aea4ce26b9a2950a513;hp=ab062ea277ce530c3e5b4e18a34cc36b074ad49b;hpb=6078d2c99619233173d4536b74258c15e6be73ba;p=libsigrok.git diff --git a/hardware/zeroplus-logic-cube/api.c b/hardware/zeroplus-logic-cube/api.c index ab062ea2..177c1841 100644 --- a/hardware/zeroplus-logic-cube/api.c +++ b/hardware/zeroplus-logic-cube/api.c @@ -45,11 +45,9 @@ static const struct zp_model zeroplus_models[] = { {0x0c12, 0x7002, "LAP-16128U", 16, 128, 200}, {0x0c12, 0x7009, "LAP-C(16064)", 16, 64, 100}, {0x0c12, 0x700a, "LAP-C(16128)", 16, 128, 200}, - /* TODO: We don't know anything about these. {0x0c12, 0x700b, "LAP-C(32128)", 32, 128, 200}, {0x0c12, 0x700c, "LAP-C(321000)", 32, 1024, 200}, {0x0c12, 0x700d, "LAP-C(322000)", 32, 2048, 200}, - */ {0x0c12, 0x700e, "LAP-C(16032)", 16, 32, 100}, {0x0c12, 0x7016, "LAP-C(162000)", 16, 2048, 200}, { 0, 0, 0, 0, 0, 0 } @@ -59,6 +57,7 @@ static const int32_t hwcaps[] = { SR_CONF_LOGIC_ANALYZER, SR_CONF_SAMPLERATE, SR_CONF_CAPTURE_RATIO, + SR_CONF_VOLTAGE_THRESHOLD, SR_CONF_LIMIT_SAMPLES, }; @@ -69,6 +68,8 @@ static const int32_t hwcaps[] = { static const char *probe_names[] = { "A0", "A1", "A2", "A3", "A4", "A5", "A6", "A7", "B0", "B1", "B2", "B3", "B4", "B5", "B6", "B7", + "C0", "C1", "C2", "C3", "C4", "C5", "C6", "C7", + "D0", "D1", "D2", "D3", "D4", "D5", "D6", "D7", NULL, }; @@ -238,14 +239,9 @@ SR_PRIV int zp_set_samplerate(struct dev_context *devc, uint64_t samplerate) return SR_OK; } -static int clear_instances(void) -{ - return std_dev_clear(di, NULL); -} - static int init(struct sr_context *sr_ctx) { - return std_hw_init(sr_ctx, di, "zeroplus: "); + return std_init(sr_ctx, di, LOG_PREFIX); } static GSList *scan(GSList *options) @@ -308,10 +304,10 @@ static GSList *scan(GSList *options) devc->prof = prof; devc->num_channels = prof->channels; #ifdef ZP_EXPERIMENTAL - devc->max_memory_size = 128 * 1024; + devc->max_sample_depth = 128 * 1024; devc->max_samplerate = 200; #else - devc->max_memory_size = prof->sample_depth * 1024; + devc->max_sample_depth = prof->sample_depth * 1024; devc->max_samplerate = prof->max_sampling_freq; #endif devc->max_samplerate *= SR_MHZ(1); @@ -439,6 +435,9 @@ static int dev_open(struct sr_dev_inst *sdi) devc->cur_samplerate = SR_MHZ(1); } + if (devc->cur_threshold == 0) + set_voltage_threshold(devc, 1.5); + return SR_OK; } @@ -464,13 +463,16 @@ static int dev_close(struct sr_dev_inst *sdi) static int cleanup(void) { - return clear_instances(); + return std_dev_clear(di, NULL); } -static int config_get(int id, GVariant **data, const struct sr_dev_inst *sdi) +static int config_get(int id, GVariant **data, const struct sr_dev_inst *sdi, + const struct sr_channel_group *channel_group) { struct dev_context *devc; + (void)channel_group; + switch (id) { case SR_CONF_SAMPLERATE: if (sdi) { @@ -479,7 +481,24 @@ static int config_get(int id, GVariant **data, const struct sr_dev_inst *sdi) sr_spew("Returning samplerate: %" PRIu64 "Hz.", devc->cur_samplerate); } else - return SR_ERR; + return SR_ERR_ARG; + break; + case SR_CONF_CAPTURE_RATIO: + if (sdi) { + devc = sdi->priv; + *data = g_variant_new_uint64(devc->capture_ratio); + } else + return SR_ERR_ARG; + break; + case SR_CONF_VOLTAGE_THRESHOLD: + if (sdi) { + GVariant *range[2]; + devc = sdi->priv; + range[0] = g_variant_new_double(devc->cur_threshold); + range[1] = g_variant_new_double(devc->cur_threshold); + *data = g_variant_new_tuple(range, 2); + } else + return SR_ERR_ARG; break; default: return SR_ERR_NA; @@ -488,9 +507,13 @@ static int config_get(int id, GVariant **data, const struct sr_dev_inst *sdi) return SR_OK; } -static int config_set(int id, GVariant *data, const struct sr_dev_inst *sdi) +static int config_set(int id, GVariant *data, const struct sr_dev_inst *sdi, + const struct sr_channel_group *channel_group) { struct dev_context *devc; + gdouble low, high; + + (void)channel_group; if (sdi->status != SR_ST_ACTIVE) return SR_ERR_DEV_CLOSED; @@ -507,6 +530,9 @@ static int config_set(int id, GVariant *data, const struct sr_dev_inst *sdi) return set_limit_samples(devc, g_variant_get_uint64(data)); case SR_CONF_CAPTURE_RATIO: return set_capture_ratio(devc, g_variant_get_uint64(data)); + case SR_CONF_VOLTAGE_THRESHOLD: + g_variant_get(data, "(dd)", &low, &high); + return set_voltage_threshold(devc, (low + high) / 2.0); default: return SR_ERR_NA; } @@ -514,11 +540,16 @@ static int config_set(int id, GVariant *data, const struct sr_dev_inst *sdi) return SR_OK; } -static int config_list(int key, GVariant **data, const struct sr_dev_inst *sdi) +static int config_list(int key, GVariant **data, const struct sr_dev_inst *sdi, + const struct sr_channel_group *channel_group) { struct dev_context *devc; - GVariant *gvar; + GVariant *gvar, *grange[2]; GVariantBuilder gvb; + double v; + GVariant *range[2]; + + (void)channel_group; switch (key) { case SR_CONF_DEVICE_OPTIONS: @@ -547,6 +578,24 @@ static int config_list(int key, GVariant **data, const struct sr_dev_inst *sdi) case SR_CONF_TRIGGER_TYPE: *data = g_variant_new_string(TRIGGER_TYPE); break; + case SR_CONF_VOLTAGE_THRESHOLD: + g_variant_builder_init(&gvb, G_VARIANT_TYPE_ARRAY); + for (v = -6.0; v <= 6.0; v += 0.1) { + range[0] = g_variant_new_double(v); + range[1] = g_variant_new_double(v); + gvar = g_variant_new_tuple(range, 2); + g_variant_builder_add_value(&gvb, gvar); + } + *data = g_variant_builder_end(&gvb); + break; + case SR_CONF_LIMIT_SAMPLES: + if (!sdi) + return SR_ERR_ARG; + devc = sdi->priv; + grange[0] = g_variant_new_uint64(0); + grange[1] = g_variant_new_uint64(devc->max_sample_depth); + *data = g_variant_new_tuple(grange, 2); + break; default: return SR_ERR_NA; } @@ -561,10 +610,21 @@ static int dev_acquisition_start(const struct sr_dev_inst *sdi, struct sr_usb_dev_inst *usb; struct sr_datafeed_packet packet; struct sr_datafeed_logic logic; - //uint64_t samples_read; + unsigned int samples_read; int res; unsigned int packet_num, n; unsigned char *buf; + unsigned int status; + unsigned int stop_address; + unsigned int now_address; + unsigned int trigger_address; + unsigned int trigger_offset; + unsigned int triggerbar; + unsigned int ramsize_trigger; + unsigned int memory_size; + unsigned int valid_samples; + unsigned int discard; + int trigger_now; if (sdi->status != SR_ST_ACTIVE) return SR_ERR_DEV_CLOSED; @@ -590,39 +650,138 @@ static int dev_acquisition_start(const struct sr_dev_inst *sdi, sr_info("Waiting for data."); analyzer_wait_data(usb->devhdl); - sr_info("Stop address = 0x%x.", - analyzer_get_stop_address(usb->devhdl)); - sr_info("Now address = 0x%x.", - analyzer_get_now_address(usb->devhdl)); - sr_info("Trigger address = 0x%x.", - analyzer_get_trigger_address(usb->devhdl)); + status = analyzer_read_status(usb->devhdl); + stop_address = analyzer_get_stop_address(usb->devhdl); + now_address = analyzer_get_now_address(usb->devhdl); + trigger_address = analyzer_get_trigger_address(usb->devhdl); + + triggerbar = analyzer_get_triggerbar_address(); + ramsize_trigger = analyzer_get_ramsize_trigger_address(); + + n = get_memory_size(devc->memory_size); + memory_size = n / 4; + + sr_info("Status = 0x%x.", status); + sr_info("Stop address = 0x%x.", stop_address); + sr_info("Now address = 0x%x.", now_address); + sr_info("Trigger address = 0x%x.", trigger_address); + sr_info("Triggerbar address = 0x%x.", triggerbar); + sr_info("Ramsize trigger = 0x%x.", ramsize_trigger); + sr_info("Memory size = 0x%x.", memory_size); /* Send header packet to the session bus. */ std_session_send_df_header(cb_data, LOG_PREFIX); + /* Check for empty capture */ + if ((status & STATUS_READY) && !stop_address) { + packet.type = SR_DF_END; + sr_session_send(cb_data, &packet); + return SR_OK; + } + if (!(buf = g_try_malloc(PACKET_SIZE))) { sr_err("Packet buffer malloc failed."); return SR_ERR_MALLOC; } - //samples_read = 0; + /* Check if the trigger is in the samples we are throwing away */ + trigger_now = now_address == trigger_address || + ((now_address + 1) % memory_size) == trigger_address; + + /* + * STATUS_READY doesn't clear until now_address advances past + * addr 0, but for our logic, clear it in that case + */ + if (!now_address) + status &= ~STATUS_READY; + analyzer_read_start(usb->devhdl); + + /* Calculate how much data to discard */ + discard = 0; + if (status & STATUS_READY) { + /* + * We haven't wrapped around, we need to throw away data from + * our current position to the end of the buffer. + * Additionally, the first two samples captured are always + * bogus. + */ + discard += memory_size - now_address + 2; + now_address = 2; + } + + /* If we have more samples than we need, discard them */ + valid_samples = (stop_address - now_address) % memory_size; + if (valid_samples > ramsize_trigger + triggerbar) { + discard += valid_samples - (ramsize_trigger + triggerbar); + now_address += valid_samples - (ramsize_trigger + triggerbar); + } + + sr_info("Need to discard %d samples.", discard); + + /* Calculate how far in the trigger is */ + if (trigger_now) + trigger_offset = 0; + else + trigger_offset = (trigger_address - now_address) % memory_size; + + /* Recalculate the number of samples available */ + valid_samples = (stop_address - now_address) % memory_size; + /* Send the incoming transfer to the session bus. */ - n = get_memory_size(devc->memory_size); - if (devc->max_memory_size * 4 < n) - n = devc->max_memory_size * 4; + samples_read = 0; for (packet_num = 0; packet_num < n / PACKET_SIZE; packet_num++) { + unsigned int len; + unsigned int buf_offset; + res = analyzer_read_data(usb->devhdl, buf, PACKET_SIZE); sr_info("Tried to read %d bytes, actually read %d bytes.", PACKET_SIZE, res); + if (discard >= PACKET_SIZE / 4) { + discard -= PACKET_SIZE / 4; + continue; + } + + len = PACKET_SIZE - discard * 4; + buf_offset = discard * 4; + discard = 0; + + /* Check if we've read all the samples */ + if (samples_read + len / 4 >= valid_samples) + len = (valid_samples - samples_read) * 4; + if (!len) + break; + + if (samples_read < trigger_offset && + samples_read + len / 4 > trigger_offset) { + /* Send out samples remaining before trigger */ + packet.type = SR_DF_LOGIC; + packet.payload = &logic; + logic.length = (trigger_offset - samples_read) * 4; + logic.unitsize = 4; + logic.data = buf + buf_offset; + sr_session_send(cb_data, &packet); + len -= logic.length; + samples_read += logic.length / 4; + buf_offset += logic.length; + } + + if (samples_read == trigger_offset) { + /* Send out trigger */ + packet.type = SR_DF_TRIGGER; + packet.payload = NULL; + sr_session_send(cb_data, &packet); + } + + /* Send out data (or data after trigger) */ packet.type = SR_DF_LOGIC; packet.payload = &logic; - logic.length = PACKET_SIZE; + logic.length = len; logic.unitsize = 4; - logic.data = buf; + logic.data = buf + buf_offset; sr_session_send(cb_data, &packet); - //samples_read += res / 4; + samples_read += len / 4; } analyzer_read_stop(usb->devhdl); g_free(buf); @@ -663,7 +822,7 @@ SR_PRIV struct sr_dev_driver zeroplus_logic_cube_driver_info = { .cleanup = cleanup, .scan = scan, .dev_list = dev_list, - .dev_clear = cleanup, + .dev_clear = NULL, .config_get = config_get, .config_set = config_set, .config_list = config_list,