122 lines
		
	
	
		
			3.5 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			122 lines
		
	
	
		
			3.5 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
#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;
 | 
						|
}
 |