flipperzero-firmware/lib/subghz/receiver.c

122 lines
3.5 KiB
C
Raw Normal View History

#include "receiver.h"
#include "protocols/registry.h"
#include <m-array.h>
typedef struct {
SubGhzProtocolEncoderBase* base;
} SubGhzReceiverSlot;
ARRAY_DEF(SubGhzReceiverSlotArray, SubGhzReceiverSlot, M_POD_OPLIST);
#define M_OPL_SubGhzReceiverSlotArray_t() ARRAY_OPLIST(SubGhzReceiverSlotArray, M_POD_OPLIST)
struct SubGhzReceiver {
SubGhzReceiverSlotArray_t slots;
SubGhzProtocolFlag filter;
SubGhzReceiverCallback callback;
void* context;
};
SubGhzReceiver* subghz_receiver_alloc_init(SubGhzEnvironment* environment) {
SubGhzReceiver* instance = malloc(sizeof(SubGhzReceiver));
SubGhzReceiverSlotArray_init(instance->slots);
for(size_t i = 0; i < subghz_protocol_registry_count(); ++i) {
const SubGhzProtocol* protocol = subghz_protocol_registry_get_by_index(i);
if(protocol->decoder && protocol->decoder->alloc) {
SubGhzReceiverSlot* slot = SubGhzReceiverSlotArray_push_new(instance->slots);
slot->base = protocol->decoder->alloc(environment);
}
}
instance->callback = NULL;
instance->context = NULL;
return instance;
}
void subghz_receiver_free(SubGhzReceiver* instance) {
furi_assert(instance);
instance->callback = NULL;
instance->context = NULL;
// Release allocated slots
for
M_EACH(slot, instance->slots, SubGhzReceiverSlotArray_t) {
slot->base->protocol->decoder->free(slot->base);
slot->base = NULL;
}
SubGhzReceiverSlotArray_clear(instance->slots);
free(instance);
}
void subghz_receiver_decode(SubGhzReceiver* instance, bool level, uint32_t duration) {
furi_assert(instance);
furi_assert(instance->slots);
for
M_EACH(slot, instance->slots, SubGhzReceiverSlotArray_t) {
if((slot->base->protocol->flag & instance->filter) == instance->filter) {
slot->base->protocol->decoder->feed(slot->base, level, duration);
}
}
}
void subghz_receiver_reset(SubGhzReceiver* instance) {
furi_assert(instance);
furi_assert(instance->slots);
for
M_EACH(slot, instance->slots, SubGhzReceiverSlotArray_t) {
slot->base->protocol->decoder->reset(slot->base);
}
}
static void subghz_receiver_rx_callback(SubGhzProtocolDecoderBase* decoder_base, void* context) {
SubGhzReceiver* instance = context;
if(instance->callback) {
instance->callback(instance, decoder_base, instance->context);
}
}
void subghz_receiver_set_rx_callback(
SubGhzReceiver* instance,
SubGhzReceiverCallback callback,
void* context) {
furi_assert(instance);
for
M_EACH(slot, instance->slots, SubGhzReceiverSlotArray_t) {
subghz_protocol_decoder_base_set_decoder_callback(
(SubGhzProtocolDecoderBase*)slot->base, subghz_receiver_rx_callback, instance);
}
instance->callback = callback;
instance->context = context;
}
void subghz_receiver_set_filter(SubGhzReceiver* instance, SubGhzProtocolFlag filter) {
furi_assert(instance);
instance->filter = filter;
}
SubGhzProtocolDecoderBase* subghz_receiver_search_decoder_base_by_name(
SubGhzReceiver* instance,
const char* decoder_name) {
SubGhzProtocolDecoderBase* result = NULL;
for
M_EACH(slot, instance->slots, SubGhzReceiverSlotArray_t) {
if(strcmp(slot->base->protocol->name, decoder_name) == 0) {
result = (SubGhzProtocolDecoderBase*)slot->base;
break;
}
}
return result;
}