- memcpy(&sample,
- logic->inbuf + logic->itercnt * logic->di->data_unitsize,
- logic->di->data_unitsize);
- for (i = 0; i < logic->di->dec_num_probes; i++)
- probe_samples[i] =
- sample & (1 << logic->di->dec_probemap[i]) ? 1 : 0;
+ sample_pos = logic->inbuf + logic->itercnt * logic->di->data_unitsize;
+ for (i = 0; i < logic->di->dec_num_probes; i++) {
+ /* A probemap value of -1 means "unused optional probe". */
+ if (logic->di->dec_probemap[i] == -1) {
+ /* Value of unused probe is 0xff, instead of 0 or 1. */
+ logic->di->probe_samples[i] = 0xff;
+ } else {
+ byte_offset = logic->di->dec_probemap[i] / 8;
+ bit_offset = logic->di->dec_probemap[i] % 8;
+ sample = *(sample_pos + byte_offset) & (1 << bit_offset) ? 1 : 0;
+ logic->di->probe_samples[i] = sample;
+ }
+ }