Fixed filter setting bug in ISOBUS module.
Added filtering test/example to `sc_mod_test.c`.
Filtering works now, threading was changed.

Also changes thread stuff:
* Shouldn't lose commands anymore
* Should prevent only 1 of in/out thread dying