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;
 | |
| }
 | 
