+ devc->empty_transfer_count = 0;
+ }
+
+ trigger_offset = 0;
+ if (devc->trigger_stage >= 0) {
+ for (i = 0; i < cur_sample_count; i++) {
+
+ const uint16_t cur_sample = devc->sample_wide ?
+ *((const uint16_t*)cur_buf + i) :
+ *((const 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->session_dev_id, &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->session_dev_id, &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;
+ }
+ }