]> sigrok.org Git - libsigrokdecode.git/blame_incremental - type_decoder.c
Add initial OUTPUT_LOGIC support.
[libsigrokdecode.git] / type_decoder.c
... / ...
CommitLineData
1/*
2 * This file is part of the libsigrokdecode project.
3 *
4 * Copyright (C) 2012 Bert Vermeulen <bert@biot.com>
5 *
6 * This program is free software: you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation, either version 3 of the License, or
9 * (at your option) any later version.
10 *
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
15 *
16 * You should have received a copy of the GNU General Public License
17 * along with this program. If not, see <http://www.gnu.org/licenses/>.
18 */
19
20#include <config.h>
21#include "libsigrokdecode-internal.h" /* First, so we avoid a _POSIX_C_SOURCE warning. */
22#include "libsigrokdecode.h"
23#include <inttypes.h>
24
25/** @cond PRIVATE */
26extern SRD_PRIV GSList *sessions;
27/** @endcond */
28
29typedef struct {
30 PyObject_HEAD
31} srd_Decoder;
32
33/* This is only used for nicer srd_dbg() output. */
34SRD_PRIV const char *output_type_name(unsigned int idx)
35{
36 static const char names[][16] = {
37 "OUTPUT_ANN",
38 "OUTPUT_PYTHON",
39 "OUTPUT_BINARY",
40 "OUTPUT_LOGIC",
41 "OUTPUT_META",
42 "(invalid)"
43 };
44
45 return names[MIN(idx, G_N_ELEMENTS(names) - 1)];
46}
47
48static void release_annotation(struct srd_proto_data_annotation *pda)
49{
50 if (!pda)
51 return;
52 if (pda->ann_text)
53 g_strfreev(pda->ann_text);
54}
55
56static int convert_annotation(struct srd_decoder_inst *di, PyObject *obj,
57 struct srd_proto_data *pdata)
58{
59 PyObject *py_tmp;
60 struct srd_pd_output *pdo;
61 struct srd_proto_data_annotation *pda;
62 int ann_class;
63 char **ann_text;
64 PyGILState_STATE gstate;
65
66 gstate = PyGILState_Ensure();
67
68 /* Should be a list of [annotation class, [string, ...]]. */
69 if (!PyList_Check(obj)) {
70 srd_err("Protocol decoder %s submitted an annotation that"
71 " is not a list", di->decoder->name);
72 goto err;
73 }
74
75 /* Should have 2 elements. */
76 if (PyList_Size(obj) != 2) {
77 srd_err("Protocol decoder %s submitted annotation list with "
78 "%zd elements instead of 2", di->decoder->name,
79 PyList_Size(obj));
80 goto err;
81 }
82
83 /*
84 * The first element should be an integer matching a previously
85 * registered annotation class.
86 */
87 py_tmp = PyList_GetItem(obj, 0);
88 if (!PyLong_Check(py_tmp)) {
89 srd_err("Protocol decoder %s submitted annotation list, but "
90 "first element was not an integer.", di->decoder->name);
91 goto err;
92 }
93 ann_class = PyLong_AsLong(py_tmp);
94 if (!(pdo = g_slist_nth_data(di->decoder->annotations, ann_class))) {
95 srd_err("Protocol decoder %s submitted data to unregistered "
96 "annotation class %d.", di->decoder->name, ann_class);
97 goto err;
98 }
99
100 /* Second element must be a list. */
101 py_tmp = PyList_GetItem(obj, 1);
102 if (!PyList_Check(py_tmp)) {
103 srd_err("Protocol decoder %s submitted annotation list, but "
104 "second element was not a list.", di->decoder->name);
105 goto err;
106 }
107 if (py_strseq_to_char(py_tmp, &ann_text) != SRD_OK) {
108 srd_err("Protocol decoder %s submitted annotation list, but "
109 "second element was malformed.", di->decoder->name);
110 goto err;
111 }
112
113 pda = pdata->data;
114 pda->ann_class = ann_class;
115 pda->ann_text = ann_text;
116
117 PyGILState_Release(gstate);
118
119 return SRD_OK;
120
121err:
122 PyGILState_Release(gstate);
123
124 return SRD_ERR_PYTHON;
125}
126
127static void release_logic(struct srd_proto_data_logic *pdl)
128{
129 if (!pdl)
130 return;
131 g_free((void *)pdl->data);
132}
133
134static int convert_logic(struct srd_decoder_inst *di, PyObject *obj,
135 struct srd_proto_data *pdata)
136{
137 struct srd_proto_data_logic *pdl;
138 PyObject *py_tmp;
139 Py_ssize_t size;
140 int logic_class;
141 char *class_name, *buf;
142 PyGILState_STATE gstate;
143
144 gstate = PyGILState_Ensure();
145
146 /* Should be a list of [logic class, bytes]. */
147 if (!PyList_Check(obj)) {
148 srd_err("Protocol decoder %s submitted non-list for SRD_OUTPUT_LOGIC.",
149 di->decoder->name);
150 goto err;
151 }
152
153 /* Should have 2 elements. */
154 if (PyList_Size(obj) != 2) {
155 srd_err("Protocol decoder %s submitted SRD_OUTPUT_LOGIC list "
156 "with %zd elements instead of 2", di->decoder->name,
157 PyList_Size(obj));
158 goto err;
159 }
160
161 /* The first element should be an integer. */
162 py_tmp = PyList_GetItem(obj, 0);
163 if (!PyLong_Check(py_tmp)) {
164 srd_err("Protocol decoder %s submitted SRD_OUTPUT_LOGIC list, "
165 "but first element was not an integer.", di->decoder->name);
166 goto err;
167 }
168 logic_class = PyLong_AsLong(py_tmp);
169 if (!(class_name = g_slist_nth_data(di->decoder->logic_output_channels, logic_class))) {
170 srd_err("Protocol decoder %s submitted SRD_OUTPUT_LOGIC with "
171 "unregistered logic class %d.", di->decoder->name, logic_class);
172 goto err;
173 }
174
175 /* Second element should be bytes. */
176 py_tmp = PyList_GetItem(obj, 1);
177 if (!PyBytes_Check(py_tmp)) {
178 srd_err("Protocol decoder %s submitted SRD_OUTPUT_LOGIC list, "
179 "but second element was not bytes.", di->decoder->name);
180 goto err;
181 }
182
183 /* Consider an empty set of bytes a bug. */
184 if (PyBytes_Size(py_tmp) == 0) {
185 srd_err("Protocol decoder %s submitted SRD_OUTPUT_LOGIC "
186 "with empty data set.", di->decoder->name);
187 goto err;
188 }
189
190 if (PyBytes_AsStringAndSize(py_tmp, &buf, &size) == -1)
191 goto err;
192
193 PyGILState_Release(gstate);
194
195 pdl = pdata->data;
196 pdl->logic_class = logic_class;
197 pdl->size = size;
198 if (!(pdl->data = g_try_malloc(pdl->size)))
199 return SRD_ERR_MALLOC;
200 memcpy((void *)pdl->data, (const void *)buf, pdl->size);
201
202 return SRD_OK;
203
204err:
205 PyGILState_Release(gstate);
206
207 return SRD_ERR_PYTHON;
208}
209
210static void release_binary(struct srd_proto_data_binary *pdb)
211{
212 if (!pdb)
213 return;
214 g_free((void *)pdb->data);
215}
216
217static int convert_binary(struct srd_decoder_inst *di, PyObject *obj,
218 struct srd_proto_data *pdata)
219{
220 struct srd_proto_data_binary *pdb;
221 PyObject *py_tmp;
222 Py_ssize_t size;
223 int bin_class;
224 char *class_name, *buf;
225 PyGILState_STATE gstate;
226
227 gstate = PyGILState_Ensure();
228
229 /* Should be a list of [binary class, bytes]. */
230 if (!PyList_Check(obj)) {
231 srd_err("Protocol decoder %s submitted non-list for SRD_OUTPUT_BINARY.",
232 di->decoder->name);
233 goto err;
234 }
235
236 /* Should have 2 elements. */
237 if (PyList_Size(obj) != 2) {
238 srd_err("Protocol decoder %s submitted SRD_OUTPUT_BINARY list "
239 "with %zd elements instead of 2", di->decoder->name,
240 PyList_Size(obj));
241 goto err;
242 }
243
244 /* The first element should be an integer. */
245 py_tmp = PyList_GetItem(obj, 0);
246 if (!PyLong_Check(py_tmp)) {
247 srd_err("Protocol decoder %s submitted SRD_OUTPUT_BINARY list, "
248 "but first element was not an integer.", di->decoder->name);
249 goto err;
250 }
251 bin_class = PyLong_AsLong(py_tmp);
252 if (!(class_name = g_slist_nth_data(di->decoder->binary, bin_class))) {
253 srd_err("Protocol decoder %s submitted SRD_OUTPUT_BINARY with "
254 "unregistered binary class %d.", di->decoder->name, bin_class);
255 goto err;
256 }
257
258 /* Second element should be bytes. */
259 py_tmp = PyList_GetItem(obj, 1);
260 if (!PyBytes_Check(py_tmp)) {
261 srd_err("Protocol decoder %s submitted SRD_OUTPUT_BINARY list, "
262 "but second element was not bytes.", di->decoder->name);
263 goto err;
264 }
265
266 /* Consider an empty set of bytes a bug. */
267 if (PyBytes_Size(py_tmp) == 0) {
268 srd_err("Protocol decoder %s submitted SRD_OUTPUT_BINARY "
269 "with empty data set.", di->decoder->name);
270 goto err;
271 }
272
273 if (PyBytes_AsStringAndSize(py_tmp, &buf, &size) == -1)
274 goto err;
275
276 PyGILState_Release(gstate);
277
278 pdb = pdata->data;
279 pdb->bin_class = bin_class;
280 pdb->size = size;
281 if (!(pdb->data = g_try_malloc(pdb->size)))
282 return SRD_ERR_MALLOC;
283 memcpy((void *)pdb->data, (const void *)buf, pdb->size);
284
285 return SRD_OK;
286
287err:
288 PyGILState_Release(gstate);
289
290 return SRD_ERR_PYTHON;
291}
292
293static inline struct srd_decoder_inst *srd_sess_inst_find_by_obj(
294 struct srd_session *sess, const GSList *stack, const PyObject *obj)
295{
296 const GSList *l;
297 struct srd_decoder_inst *tmp, *di;
298
299 if (!sess)
300 return NULL;
301
302 di = NULL;
303 for (l = stack ? stack : sess->di_list; di == NULL && l != NULL; l = l->next) {
304 tmp = l->data;
305 if (tmp->py_inst == obj)
306 di = tmp;
307 else if (tmp->next_di)
308 di = srd_sess_inst_find_by_obj(sess, tmp->next_di, obj);
309 }
310
311 return di;
312}
313
314/**
315 * Find a decoder instance by its Python object.
316 *
317 * I.e. find that instance's instantiation of the sigrokdecode.Decoder class.
318 * This will recurse to find the instance anywhere in the stack tree of all
319 * sessions.
320 *
321 * @param stack Pointer to a GSList of struct srd_decoder_inst, indicating the
322 * stack to search. To start searching at the bottom level of
323 * decoder instances, pass NULL.
324 * @param obj The Python class instantiation.
325 *
326 * @return Pointer to struct srd_decoder_inst, or NULL if not found.
327 *
328 * @since 0.1.0
329 */
330static inline struct srd_decoder_inst *srd_inst_find_by_obj(
331 const GSList *stack, const PyObject *obj)
332{
333 struct srd_decoder_inst *di;
334 struct srd_session *sess;
335 GSList *l;
336
337 /* Performance shortcut: Handle the most common case first. */
338 sess = sessions->data;
339 di = sess->di_list->data;
340 if (di->py_inst == obj)
341 return di;
342
343 di = NULL;
344 for (l = sessions; di == NULL && l != NULL; l = l->next) {
345 sess = l->data;
346 di = srd_sess_inst_find_by_obj(sess, stack, obj);
347 }
348
349 return di;
350}
351
352static int convert_meta(struct srd_proto_data *pdata, PyObject *obj)
353{
354 long long intvalue;
355 double dvalue;
356 PyGILState_STATE gstate;
357
358 gstate = PyGILState_Ensure();
359
360 if (g_variant_type_equal(pdata->pdo->meta_type, G_VARIANT_TYPE_INT64)) {
361 if (!PyLong_Check(obj)) {
362 PyErr_Format(PyExc_TypeError, "This output was registered "
363 "as 'int', but something else was passed.");
364 goto err;
365 }
366 intvalue = PyLong_AsLongLong(obj);
367 if (PyErr_Occurred())
368 goto err;
369 pdata->data = g_variant_new_int64(intvalue);
370 } else if (g_variant_type_equal(pdata->pdo->meta_type, G_VARIANT_TYPE_DOUBLE)) {
371 if (!PyFloat_Check(obj)) {
372 PyErr_Format(PyExc_TypeError, "This output was registered "
373 "as 'float', but something else was passed.");
374 goto err;
375 }
376 dvalue = PyFloat_AsDouble(obj);
377 if (PyErr_Occurred())
378 goto err;
379 pdata->data = g_variant_new_double(dvalue);
380 }
381
382 PyGILState_Release(gstate);
383
384 return SRD_OK;
385
386err:
387 PyGILState_Release(gstate);
388
389 return SRD_ERR_PYTHON;
390}
391
392static void release_meta(GVariant *gvar)
393{
394 if (!gvar)
395 return;
396 g_variant_unref(gvar);
397}
398
399static PyObject *Decoder_put(PyObject *self, PyObject *args)
400{
401 GSList *l;
402 PyObject *py_data, *py_res;
403 struct srd_decoder_inst *di, *next_di;
404 struct srd_pd_output *pdo;
405 struct srd_proto_data pdata;
406 struct srd_proto_data_annotation pda;
407 struct srd_proto_data_binary pdb;
408 uint64_t start_sample, end_sample;
409 int output_id;
410 struct srd_pd_callback *cb;
411 PyGILState_STATE gstate;
412
413 py_data = NULL;
414
415 gstate = PyGILState_Ensure();
416
417 if (!(di = srd_inst_find_by_obj(NULL, self))) {
418 /* Shouldn't happen. */
419 srd_dbg("put(): self instance not found.");
420 goto err;
421 }
422
423 if (!PyArg_ParseTuple(args, "KKiO", &start_sample, &end_sample,
424 &output_id, &py_data)) {
425 /*
426 * This throws an exception, but by returning NULL here we let
427 * Python raise it. This results in a much better trace in
428 * controller.c on the decode() method call.
429 */
430 goto err;
431 }
432
433 if (!(l = g_slist_nth(di->pd_output, output_id))) {
434 srd_err("Protocol decoder %s submitted invalid output ID %d.",
435 di->decoder->name, output_id);
436 goto err;
437 }
438 pdo = l->data;
439
440 /* Upon SRD_OUTPUT_PYTHON for stacked PDs, we have a nicer log message later. */
441 if (pdo->output_type != SRD_OUTPUT_PYTHON && di->next_di != NULL) {
442 srd_spew("Instance %s put %" PRIu64 "-%" PRIu64 " %s on "
443 "oid %d (%s).", di->inst_id, start_sample, end_sample,
444 output_type_name(pdo->output_type), output_id,
445 pdo->proto_id);
446 }
447
448 pdata.start_sample = start_sample;
449 pdata.end_sample = end_sample;
450 pdata.pdo = pdo;
451 pdata.data = NULL;
452
453 switch (pdo->output_type) {
454 case SRD_OUTPUT_ANN:
455 /* Annotations are only fed to callbacks. */
456 if ((cb = srd_pd_output_callback_find(di->sess, pdo->output_type))) {
457 pdata.data = &pda;
458 /* Convert from PyDict to srd_proto_data_annotation. */
459 if (convert_annotation(di, py_data, &pdata) != SRD_OK) {
460 /* An error was already logged. */
461 break;
462 }
463 Py_BEGIN_ALLOW_THREADS
464 cb->cb(&pdata, cb->cb_data);
465 Py_END_ALLOW_THREADS
466 release_annotation(pdata.data);
467 }
468 break;
469 case SRD_OUTPUT_PYTHON:
470 for (l = di->next_di; l; l = l->next) {
471 next_di = l->data;
472 srd_spew("Instance %s put %" PRIu64 "-%" PRIu64 " %s "
473 "on oid %d (%s) to instance %s.", di->inst_id,
474 start_sample,
475 end_sample, output_type_name(pdo->output_type),
476 output_id, pdo->proto_id, next_di->inst_id);
477 if (!(py_res = PyObject_CallMethod(
478 next_di->py_inst, "decode", "KKO", start_sample,
479 end_sample, py_data))) {
480 srd_exception_catch("Calling %s decode() failed",
481 next_di->inst_id);
482 }
483 Py_XDECREF(py_res);
484 }
485 if ((cb = srd_pd_output_callback_find(di->sess, pdo->output_type))) {
486 /*
487 * Frontends aren't really supposed to get Python
488 * callbacks, but it's useful for testing.
489 */
490 pdata.data = py_data;
491 cb->cb(&pdata, cb->cb_data);
492 }
493 break;
494 case SRD_OUTPUT_BINARY:
495 if ((cb = srd_pd_output_callback_find(di->sess, pdo->output_type))) {
496 pdata.data = &pdb;
497 /* Convert from PyDict to srd_proto_data_binary. */
498 if (convert_binary(di, py_data, &pdata) != SRD_OK) {
499 /* An error was already logged. */
500 break;
501 }
502 Py_BEGIN_ALLOW_THREADS
503 cb->cb(&pdata, cb->cb_data);
504 Py_END_ALLOW_THREADS
505 release_binary(pdata.data);
506 }
507 break;
508 case SRD_OUTPUT_LOGIC:
509 if ((cb = srd_pd_output_callback_find(di->sess, pdo->output_type))) {
510 pdata.data = &pdb;
511 /* Convert from PyDict to srd_proto_data_logic. */
512 if (convert_logic(di, py_data, &pdata) != SRD_OK) {
513 /* An error was already logged. */
514 break;
515 }
516 Py_BEGIN_ALLOW_THREADS
517 cb->cb(&pdata, cb->cb_data);
518 Py_END_ALLOW_THREADS
519 release_logic(pdata.data);
520 }
521 break;
522 case SRD_OUTPUT_META:
523 if ((cb = srd_pd_output_callback_find(di->sess, pdo->output_type))) {
524 /* Annotations need converting from PyObject. */
525 if (convert_meta(&pdata, py_data) != SRD_OK) {
526 /* An exception was already set up. */
527 break;
528 }
529 Py_BEGIN_ALLOW_THREADS
530 cb->cb(&pdata, cb->cb_data);
531 Py_END_ALLOW_THREADS
532 release_meta(pdata.data);
533 }
534 break;
535 default:
536 srd_err("Protocol decoder %s submitted invalid output type %d.",
537 di->decoder->name, pdo->output_type);
538 break;
539 }
540
541 PyGILState_Release(gstate);
542
543 Py_RETURN_NONE;
544
545err:
546 PyGILState_Release(gstate);
547
548 return NULL;
549}
550
551static PyObject *Decoder_register(PyObject *self, PyObject *args,
552 PyObject *kwargs)
553{
554 struct srd_decoder_inst *di;
555 struct srd_pd_output *pdo;
556 PyObject *py_new_output_id;
557 PyTypeObject *meta_type_py;
558 const GVariantType *meta_type_gv;
559 int output_type;
560 char *proto_id, *meta_name, *meta_descr;
561 char *keywords[] = { "output_type", "proto_id", "meta", NULL };
562 PyGILState_STATE gstate;
563 gboolean is_meta;
564 GSList *l;
565 struct srd_pd_output *cmp;
566
567 gstate = PyGILState_Ensure();
568
569 meta_type_py = NULL;
570 meta_type_gv = NULL;
571 meta_name = meta_descr = NULL;
572
573 if (!(di = srd_inst_find_by_obj(NULL, self))) {
574 PyErr_SetString(PyExc_Exception, "decoder instance not found");
575 goto err;
576 }
577
578 /* Default to instance ID, which defaults to class ID. */
579 proto_id = di->inst_id;
580 if (!PyArg_ParseTupleAndKeywords(args, kwargs, "i|s(Oss)", keywords,
581 &output_type, &proto_id,
582 &meta_type_py, &meta_name, &meta_descr)) {
583 /* Let Python raise this exception. */
584 goto err;
585 }
586
587 /* Check if the meta value's type is supported. */
588 is_meta = output_type == SRD_OUTPUT_META;
589 if (is_meta) {
590 if (meta_type_py == &PyLong_Type)
591 meta_type_gv = G_VARIANT_TYPE_INT64;
592 else if (meta_type_py == &PyFloat_Type)
593 meta_type_gv = G_VARIANT_TYPE_DOUBLE;
594 else {
595 PyErr_Format(PyExc_TypeError, "Unsupported type.");
596 goto err;
597 }
598 }
599
600 pdo = NULL;
601 for (l = di->pd_output; l; l = l->next) {
602 cmp = l->data;
603 if (cmp->output_type != output_type)
604 continue;
605 if (strcmp(cmp->proto_id, proto_id) != 0)
606 continue;
607 if (is_meta && cmp->meta_type != meta_type_gv)
608 continue;
609 if (is_meta && strcmp(cmp->meta_name, meta_name) != 0)
610 continue;
611 if (is_meta && strcmp(cmp->meta_descr, meta_descr) != 0)
612 continue;
613 pdo = cmp;
614 break;
615 }
616 if (pdo) {
617 py_new_output_id = Py_BuildValue("i", pdo->pdo_id);
618 PyGILState_Release(gstate);
619 return py_new_output_id;
620 }
621
622 pdo = g_malloc(sizeof(struct srd_pd_output));
623
624 /* pdo_id is just a simple index, nothing is deleted from this list anyway. */
625 pdo->pdo_id = g_slist_length(di->pd_output);
626 pdo->output_type = output_type;
627 pdo->di = di;
628 pdo->proto_id = g_strdup(proto_id);
629
630 if (output_type == SRD_OUTPUT_META) {
631 pdo->meta_type = meta_type_gv;
632 pdo->meta_name = g_strdup(meta_name);
633 pdo->meta_descr = g_strdup(meta_descr);
634 }
635
636 di->pd_output = g_slist_append(di->pd_output, pdo);
637 py_new_output_id = Py_BuildValue("i", pdo->pdo_id);
638
639 PyGILState_Release(gstate);
640
641 srd_dbg("Instance %s creating new output type %s as oid %d (%s).",
642 di->inst_id, output_type_name(output_type), pdo->pdo_id,
643 proto_id);
644
645 return py_new_output_id;
646
647err:
648 PyGILState_Release(gstate);
649
650 return NULL;
651}
652
653static int get_term_type(const char *v)
654{
655 switch (v[0]) {
656 case 'h':
657 return SRD_TERM_HIGH;
658 case 'l':
659 return SRD_TERM_LOW;
660 case 'r':
661 return SRD_TERM_RISING_EDGE;
662 case 'f':
663 return SRD_TERM_FALLING_EDGE;
664 case 'e':
665 return SRD_TERM_EITHER_EDGE;
666 case 'n':
667 return SRD_TERM_NO_EDGE;
668 default:
669 return -1;
670 }
671
672 return -1;
673}
674
675/**
676 * Get the pin values at the current sample number.
677 *
678 * @param di The decoder instance to use. Must not be NULL.
679 * The number of channels must be >= 1.
680 *
681 * @return A newly allocated PyTuple containing the pin values at the
682 * current sample number.
683 */
684static PyObject *get_current_pinvalues(const struct srd_decoder_inst *di)
685{
686 int i;
687 uint8_t sample;
688 const uint8_t *sample_pos;
689 int byte_offset, bit_offset;
690 PyObject *py_pinvalues;
691 PyGILState_STATE gstate;
692
693 if (!di) {
694 srd_err("Invalid decoder instance.");
695 return NULL;
696 }
697
698 gstate = PyGILState_Ensure();
699
700 py_pinvalues = PyTuple_New(di->dec_num_channels);
701
702 for (i = 0; i < di->dec_num_channels; i++) {
703 /* A channelmap value of -1 means "unused optional channel". */
704 if (di->dec_channelmap[i] == -1) {
705 /* Value of unused channel is 0xff, instead of 0 or 1. */
706 PyTuple_SetItem(py_pinvalues, i, PyLong_FromUnsignedLong(0xff));
707 } else {
708 sample_pos = di->inbuf + ((di->abs_cur_samplenum - di->abs_start_samplenum) * di->data_unitsize);
709 byte_offset = di->dec_channelmap[i] / 8;
710 bit_offset = di->dec_channelmap[i] % 8;
711 sample = *(sample_pos + byte_offset) & (1 << bit_offset) ? 1 : 0;
712 PyTuple_SetItem(py_pinvalues, i, PyLong_FromUnsignedLong(sample));
713 }
714 }
715
716 PyGILState_Release(gstate);
717
718 return py_pinvalues;
719}
720
721/**
722 * Create a list of terms in the specified condition.
723 *
724 * If there are no terms in the condition, 'term_list' will be NULL.
725 *
726 * @param di The decoder instance to use. Must not be NULL.
727 * @param py_dict A Python dict containing terms. Must not be NULL.
728 * @param term_list Pointer to a GSList which will be set to the newly
729 * created list of terms. Must not be NULL.
730 *
731 * @return SRD_OK upon success, a negative error code otherwise.
732 */
733static int create_term_list(struct srd_decoder_inst *di,
734 PyObject *py_dict, GSList **term_list)
735{
736 Py_ssize_t pos = 0;
737 PyObject *py_key, *py_value;
738 struct srd_term *term;
739 int64_t num_samples_to_skip;
740 char *term_str;
741 PyGILState_STATE gstate;
742
743 if (!py_dict || !term_list)
744 return SRD_ERR_ARG;
745
746 /* "Create" an empty GSList of terms. */
747 *term_list = NULL;
748
749 gstate = PyGILState_Ensure();
750
751 /* Iterate over all items in the current dict. */
752 while (PyDict_Next(py_dict, &pos, &py_key, &py_value)) {
753 /* Check whether the current key is a string or a number. */
754 if (PyLong_Check(py_key)) {
755 /* The key is a number. */
756 /* Get the value string. */
757 if ((py_pydictitem_as_str(py_dict, py_key, &term_str)) != SRD_OK) {
758 srd_err("Failed to get the value.");
759 goto err;
760 }
761 term = g_malloc(sizeof(struct srd_term));
762 term->type = get_term_type(term_str);
763 term->channel = PyLong_AsLong(py_key);
764 if (term->channel < 0 || term->channel >= di->dec_num_channels)
765 term->type = SRD_TERM_ALWAYS_FALSE;
766 g_free(term_str);
767 } else if (PyUnicode_Check(py_key)) {
768 /* The key is a string. */
769 /* TODO: Check if the key is "skip". */
770 if ((py_pydictitem_as_long(py_dict, py_key, &num_samples_to_skip)) != SRD_OK) {
771 srd_err("Failed to get number of samples to skip.");
772 goto err;
773 }
774 term = g_malloc(sizeof(struct srd_term));
775 term->type = SRD_TERM_SKIP;
776 term->num_samples_to_skip = num_samples_to_skip;
777 term->num_samples_already_skipped = 0;
778 if (num_samples_to_skip < 0)
779 term->type = SRD_TERM_ALWAYS_FALSE;
780 } else {
781 srd_err("Term key is neither a string nor a number.");
782 goto err;
783 }
784
785 /* Add the term to the list of terms. */
786 *term_list = g_slist_append(*term_list, term);
787 }
788
789 PyGILState_Release(gstate);
790
791 return SRD_OK;
792
793err:
794 PyGILState_Release(gstate);
795
796 return SRD_ERR;
797}
798
799/**
800 * Replace the current condition list with the new one.
801 *
802 * @param self TODO. Must not be NULL.
803 * @param args TODO. Must not be NULL.
804 *
805 * @retval SRD_OK The new condition list was set successfully.
806 * @retval SRD_ERR There was an error setting the new condition list.
807 * The contents of di->condition_list are undefined.
808 * @retval 9999 TODO.
809 */
810static int set_new_condition_list(PyObject *self, PyObject *args)
811{
812 struct srd_decoder_inst *di;
813 GSList *term_list;
814 PyObject *py_conditionlist, *py_conds, *py_dict;
815 int i, num_conditions, ret;
816 PyGILState_STATE gstate;
817
818 if (!self || !args)
819 return SRD_ERR_ARG;
820
821 gstate = PyGILState_Ensure();
822
823 /* Get the decoder instance. */
824 if (!(di = srd_inst_find_by_obj(NULL, self))) {
825 PyErr_SetString(PyExc_Exception, "decoder instance not found");
826 goto err;
827 }
828
829 /*
830 * Return an error condition from .wait() when termination is
831 * requested, such that decode() will terminate.
832 */
833 if (di->want_wait_terminate) {
834 srd_dbg("%s: %s: Skip (want_term).", di->inst_id, __func__);
835 goto err;
836 }
837
838 /*
839 * Parse the argument of self.wait() into 'py_conds', and check
840 * the data type. The argument is optional, None is assumed in
841 * its absence. None or an empty dict or an empty list mean that
842 * there is no condition, and the next available sample shall
843 * get returned to the caller.
844 */
845 py_conds = Py_None;
846 if (!PyArg_ParseTuple(args, "|O", &py_conds)) {
847 /* Let Python raise this exception. */
848 goto err;
849 }
850 if (py_conds == Py_None) {
851 /* 'py_conds' is None. */
852 goto ret_9999;
853 } else if (PyList_Check(py_conds)) {
854 /* 'py_conds' is a list. */
855 py_conditionlist = py_conds;
856 num_conditions = PyList_Size(py_conditionlist);
857 if (num_conditions == 0)
858 goto ret_9999; /* The PD invoked self.wait([]). */
859 Py_INCREF(py_conditionlist);
860 } else if (PyDict_Check(py_conds)) {
861 /* 'py_conds' is a dict. */
862 if (PyDict_Size(py_conds) == 0)
863 goto ret_9999; /* The PD invoked self.wait({}). */
864 /* Make a list and put the dict in there for convenience. */
865 py_conditionlist = PyList_New(1);
866 Py_INCREF(py_conds);
867 PyList_SetItem(py_conditionlist, 0, py_conds);
868 num_conditions = 1;
869 } else {
870 srd_err("Condition list is neither a list nor a dict.");
871 goto err;
872 }
873
874 /* Free the old condition list. */
875 condition_list_free(di);
876
877 ret = SRD_OK;
878
879 /* Iterate over the conditions, set di->condition_list accordingly. */
880 for (i = 0; i < num_conditions; i++) {
881 /* Get a condition (dict) from the condition list. */
882 py_dict = PyList_GetItem(py_conditionlist, i);
883 if (!PyDict_Check(py_dict)) {
884 srd_err("Condition is not a dict.");
885 ret = SRD_ERR;
886 break;
887 }
888
889 /* Create the list of terms in this condition. */
890 if ((ret = create_term_list(di, py_dict, &term_list)) < 0)
891 break;
892
893 /* Add the new condition to the PD instance's condition list. */
894 di->condition_list = g_slist_append(di->condition_list, term_list);
895 }
896
897 Py_DecRef(py_conditionlist);
898
899 PyGILState_Release(gstate);
900
901 return ret;
902
903err:
904 PyGILState_Release(gstate);
905
906 return SRD_ERR;
907
908ret_9999:
909 PyGILState_Release(gstate);
910
911 return 9999;
912}
913
914/**
915 * Create a SKIP condition list for condition-less .wait() calls.
916 *
917 * @param di Decoder instance.
918 * @param count Number of samples to skip.
919 *
920 * @retval SRD_OK The new condition list was set successfully.
921 * @retval SRD_ERR There was an error setting the new condition list.
922 * The contents of di->condition_list are undefined.
923 *
924 * This routine is a reduced and specialized version of the @ref
925 * set_new_condition_list() and @ref create_term_list() routines which
926 * gets invoked when .wait() was called without specifications for
927 * conditions. This minor duplication of the SKIP term list creation
928 * simplifies the logic and avoids the creation of expensive Python
929 * objects with "constant" values which the caller did not pass in the
930 * first place. It results in maximum sharing of match handling code
931 * paths.
932 */
933static int set_skip_condition(struct srd_decoder_inst *di, uint64_t count)
934{
935 struct srd_term *term;
936 GSList *term_list;
937
938 condition_list_free(di);
939 term = g_malloc(sizeof(*term));
940 term->type = SRD_TERM_SKIP;
941 term->num_samples_to_skip = count;
942 term->num_samples_already_skipped = 0;
943 term_list = g_slist_append(NULL, term);
944 di->condition_list = g_slist_append(di->condition_list, term_list);
945
946 return SRD_OK;
947}
948
949static PyObject *Decoder_wait(PyObject *self, PyObject *args)
950{
951 int ret;
952 uint64_t skip_count;
953 unsigned int i;
954 gboolean found_match;
955 struct srd_decoder_inst *di;
956 PyObject *py_pinvalues, *py_matched, *py_samplenum;
957 PyGILState_STATE gstate;
958
959 if (!self || !args)
960 return NULL;
961
962 gstate = PyGILState_Ensure();
963
964 if (!(di = srd_inst_find_by_obj(NULL, self))) {
965 PyErr_SetString(PyExc_Exception, "decoder instance not found");
966 PyGILState_Release(gstate);
967 Py_RETURN_NONE;
968 }
969
970 ret = set_new_condition_list(self, args);
971 if (ret < 0) {
972 srd_dbg("%s: %s: Aborting wait().", di->inst_id, __func__);
973 goto err;
974 }
975 if (ret == 9999) {
976 /*
977 * Empty condition list, automatic match. Arrange for the
978 * execution of regular match handling code paths such that
979 * the next available sample is returned to the caller.
980 * Make sure to skip one sample when "anywhere within the
981 * stream", yet make sure to not skip sample number 0.
982 */
983 if (di->abs_cur_samplenum)
984 skip_count = 1;
985 else if (!di->condition_list)
986 skip_count = 0;
987 else
988 skip_count = 1;
989 ret = set_skip_condition(di, skip_count);
990 if (ret < 0) {
991 srd_dbg("%s: %s: Cannot setup condition-less wait().",
992 di->inst_id, __func__);
993 goto err;
994 }
995 }
996
997 while (1) {
998
999 Py_BEGIN_ALLOW_THREADS
1000
1001 /* Wait for new samples to process, or termination request. */
1002 g_mutex_lock(&di->data_mutex);
1003 while (!di->got_new_samples && !di->want_wait_terminate)
1004 g_cond_wait(&di->got_new_samples_cond, &di->data_mutex);
1005
1006 /*
1007 * Check whether any of the current condition(s) match.
1008 * Arrange for termination requests to take a code path which
1009 * won't find new samples to process, pretends to have processed
1010 * previously stored samples, and returns to the main thread,
1011 * while the termination request still gets signalled.
1012 */
1013 found_match = FALSE;
1014
1015 /* Ignore return value for now, should never be negative. */
1016 (void)process_samples_until_condition_match(di, &found_match);
1017
1018 Py_END_ALLOW_THREADS
1019
1020 /* If there's a match, set self.samplenum etc. and return. */
1021 if (found_match) {
1022 /* Set self.samplenum to the (absolute) sample number that matched. */
1023 py_samplenum = PyLong_FromUnsignedLongLong(di->abs_cur_samplenum);
1024 PyObject_SetAttrString(di->py_inst, "samplenum", py_samplenum);
1025 Py_DECREF(py_samplenum);
1026
1027 if (di->match_array && di->match_array->len > 0) {
1028 py_matched = PyTuple_New(di->match_array->len);
1029 for (i = 0; i < di->match_array->len; i++)
1030 PyTuple_SetItem(py_matched, i, PyBool_FromLong(di->match_array->data[i]));
1031 PyObject_SetAttrString(di->py_inst, "matched", py_matched);
1032 Py_DECREF(py_matched);
1033 match_array_free(di);
1034 } else {
1035 PyObject_SetAttrString(di->py_inst, "matched", Py_None);
1036 }
1037
1038 py_pinvalues = get_current_pinvalues(di);
1039
1040 g_mutex_unlock(&di->data_mutex);
1041
1042 PyGILState_Release(gstate);
1043
1044 return py_pinvalues;
1045 }
1046
1047 /* No match, reset state for the next chunk. */
1048 di->got_new_samples = FALSE;
1049 di->handled_all_samples = TRUE;
1050 di->abs_start_samplenum = 0;
1051 di->abs_end_samplenum = 0;
1052 di->inbuf = NULL;
1053 di->inbuflen = 0;
1054
1055 /* Signal the main thread that we handled all samples. */
1056 g_cond_signal(&di->handled_all_samples_cond);
1057
1058 /*
1059 * When termination of wait() and decode() was requested,
1060 * then exit the loop after releasing the mutex.
1061 */
1062 if (di->want_wait_terminate) {
1063 srd_dbg("%s: %s: Will return from wait().",
1064 di->inst_id, __func__);
1065 g_mutex_unlock(&di->data_mutex);
1066 goto err;
1067 }
1068
1069 g_mutex_unlock(&di->data_mutex);
1070 }
1071
1072 PyGILState_Release(gstate);
1073
1074 Py_RETURN_NONE;
1075
1076err:
1077 PyGILState_Release(gstate);
1078
1079 return NULL;
1080}
1081
1082/**
1083 * Return whether the specified channel was supplied to the decoder.
1084 *
1085 * @param self TODO. Must not be NULL.
1086 * @param args TODO. Must not be NULL.
1087 *
1088 * @retval Py_True The channel has been supplied by the frontend.
1089 * @retval Py_False The channel has been supplied by the frontend.
1090 * @retval NULL An error occurred.
1091 */
1092static PyObject *Decoder_has_channel(PyObject *self, PyObject *args)
1093{
1094 int idx, count;
1095 struct srd_decoder_inst *di;
1096 PyGILState_STATE gstate;
1097
1098 if (!self || !args)
1099 return NULL;
1100
1101 gstate = PyGILState_Ensure();
1102
1103 if (!(di = srd_inst_find_by_obj(NULL, self))) {
1104 PyErr_SetString(PyExc_Exception, "decoder instance not found");
1105 goto err;
1106 }
1107
1108 /*
1109 * Get the integer argument of self.has_channel(). Check for
1110 * the range of supported PD input channel numbers.
1111 */
1112 if (!PyArg_ParseTuple(args, "i", &idx)) {
1113 /* Let Python raise this exception. */
1114 goto err;
1115 }
1116
1117 count = g_slist_length(di->decoder->channels) +
1118 g_slist_length(di->decoder->opt_channels);
1119 if (idx < 0 || idx >= count) {
1120 srd_err("Invalid index %d, PD channel count %d.", idx, count);
1121 PyErr_SetString(PyExc_IndexError, "invalid channel index");
1122 goto err;
1123 }
1124
1125 PyGILState_Release(gstate);
1126
1127 return (di->dec_channelmap[idx] == -1) ? Py_False : Py_True;
1128
1129err:
1130 PyGILState_Release(gstate);
1131
1132 return NULL;
1133}
1134
1135static PyMethodDef Decoder_methods[] = {
1136 { "put", Decoder_put, METH_VARARGS,
1137 "Accepts a dictionary with the following keys: startsample, endsample, data" },
1138 { "register", (PyCFunction)(void(*)(void))Decoder_register, METH_VARARGS|METH_KEYWORDS,
1139 "Register a new output stream" },
1140 { "wait", Decoder_wait, METH_VARARGS,
1141 "Wait for one or more conditions to occur" },
1142 { "has_channel", Decoder_has_channel, METH_VARARGS,
1143 "Report whether a channel was supplied" },
1144 {NULL, NULL, 0, NULL}
1145};
1146
1147/**
1148 * Create the sigrokdecode.Decoder type.
1149 *
1150 * @return The new type object.
1151 *
1152 * @private
1153 */
1154SRD_PRIV PyObject *srd_Decoder_type_new(void)
1155{
1156 PyType_Spec spec;
1157 PyType_Slot slots[] = {
1158 { Py_tp_doc, "sigrok Decoder base class" },
1159 { Py_tp_methods, Decoder_methods },
1160 { Py_tp_new, (void *)&PyType_GenericNew },
1161 { 0, NULL }
1162 };
1163 PyObject *py_obj;
1164 PyGILState_STATE gstate;
1165
1166 gstate = PyGILState_Ensure();
1167
1168 spec.name = "sigrokdecode.Decoder";
1169 spec.basicsize = sizeof(srd_Decoder);
1170 spec.itemsize = 0;
1171 spec.flags = Py_TPFLAGS_DEFAULT | Py_TPFLAGS_BASETYPE;
1172 spec.slots = slots;
1173
1174 py_obj = PyType_FromSpec(&spec);
1175
1176 PyGILState_Release(gstate);
1177
1178 return py_obj;
1179}