- trigger_offset = 0;
- if (devc->trigger_stage >= 0) {
- for (i = 0; i < cur_sample_count; i++) {
-
- cur_sample = devc->sample_wide ?
- *((uint16_t *)cur_buf + i) :
- *((uint8_t *)cur_buf + i);
-
- if ((cur_sample & devc->trigger_mask[devc->trigger_stage]) ==
- devc->trigger_value[devc->trigger_stage]) {
- /* Match on this trigger stage. */
- devc->trigger_buffer[devc->trigger_stage] = cur_sample;
- devc->trigger_stage++;
-
- if (devc->trigger_stage == NUM_TRIGGER_STAGES ||
- devc->trigger_mask[devc->trigger_stage] == 0) {
- /* Match on all trigger stages, we're done. */
- trigger_offset = i + 1;
-
- /*
- * TODO: Send pre-trigger buffer to session bus.
- * Tell the frontend we hit the trigger here.
- */
- packet.type = SR_DF_TRIGGER;
- packet.payload = NULL;
- sr_session_send(devc->cb_data, &packet);
-
- /*
- * Send the samples that triggered it,
- * since we're skipping past them.
- */
- packet.type = SR_DF_LOGIC;
- packet.payload = &logic;
- logic.unitsize = sizeof(*devc->trigger_buffer);
- logic.length = devc->trigger_stage * logic.unitsize;
- logic.data = devc->trigger_buffer;
- sr_session_send(devc->cb_data, &packet);
-
- devc->trigger_stage = TRIGGER_FIRED;
- break;
- }
- } else if (devc->trigger_stage > 0) {
- /*
- * We had a match before, but not in the next sample. However, we may
- * have a match on this stage in the next bit -- trigger on 0001 will
- * fail on seeing 00001, so we need to go back to stage 0 -- but at
- * the next sample from the one that matched originally, which the
- * counter increment at the end of the loop takes care of.
- */
- i -= devc->trigger_stage;
- if (i < -1)
- i = -1; /* Oops, went back past this buffer. */
- /* Reset trigger stage. */
- devc->trigger_stage = 0;
- }
- }
- }
-
- if (devc->trigger_stage == TRIGGER_FIRED) {
- /* Send the incoming transfer to the session bus. */
- trigger_offset_bytes = trigger_offset * sample_width;
- packet.type = SR_DF_LOGIC;
- packet.payload = &logic;
- logic.length = transfer->actual_length - trigger_offset_bytes;
- logic.unitsize = sample_width;
- logic.data = cur_buf + trigger_offset_bytes;
- sr_session_send(devc->cb_data, &packet);
-
- devc->num_samples += cur_sample_count;
- if (devc->limit_samples &&
- (unsigned int)devc->num_samples > devc->limit_samples) {
- fx2lafw_abort_acquisition(devc);
- free_transfer(transfer);
- return;
+ if (devc->trigger_fired) {
+ if (devc->sent_samples < devc->limit_samples) {
+ /* Send the incoming transfer to the session bus. */
+ packet.type = SR_DF_LOGIC;
+ packet.payload = &logic;
+ if (devc->sent_samples + cur_sample_count > devc->limit_samples)
+ num_samples = devc->limit_samples - devc->sent_samples;
+ else
+ num_samples = cur_sample_count;
+ logic.length = num_samples * unitsize;
+ logic.unitsize = unitsize;
+ logic.data = transfer->buffer;
+ sr_session_send(devc->cb_data, &packet);
+ devc->sent_samples += num_samples;