249 lines
		
	
	
		
			7.2 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			249 lines
		
	
	
		
			7.2 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
#include "irda.h"
 | 
						|
#include "furi/check.h"
 | 
						|
#include "irda_common_i.h"
 | 
						|
#include "irda_protocol_defs_i.h"
 | 
						|
#include <stdbool.h>
 | 
						|
#include <stdint.h>
 | 
						|
#include <stdlib.h>
 | 
						|
#include <furi.h>
 | 
						|
#include "irda_i.h"
 | 
						|
#include <api-hal-irda.h>
 | 
						|
 | 
						|
struct IrdaDecoderHandler {
 | 
						|
    void** ctx;
 | 
						|
};
 | 
						|
 | 
						|
typedef struct {
 | 
						|
    IrdaAlloc alloc;
 | 
						|
    IrdaDecode decode;
 | 
						|
    IrdaReset reset;
 | 
						|
    IrdaFree free;
 | 
						|
} IrdaDecoders;
 | 
						|
 | 
						|
typedef struct {
 | 
						|
    IrdaEncoderReset reset;
 | 
						|
    IrdaAlloc alloc;
 | 
						|
    IrdaEncode encode;
 | 
						|
    IrdaFree free;
 | 
						|
} IrdaEncoders;
 | 
						|
 | 
						|
typedef struct {
 | 
						|
    IrdaProtocol protocol;
 | 
						|
    const char* name;
 | 
						|
    IrdaDecoders decoder;
 | 
						|
    IrdaEncoders encoder;
 | 
						|
    uint8_t address_length;
 | 
						|
    uint8_t command_length;
 | 
						|
} IrdaProtocolImplementation;
 | 
						|
 | 
						|
struct IrdaEncoderHandler {
 | 
						|
    void* encoder;
 | 
						|
    IrdaProtocol protocol;
 | 
						|
};
 | 
						|
 | 
						|
// TODO: replace with key-value, Now we refer by enum index, which is dangerous.
 | 
						|
static const IrdaProtocolImplementation irda_protocols[] = {
 | 
						|
    // #0
 | 
						|
    { .protocol = IrdaProtocolNEC,
 | 
						|
      .name = "NEC",
 | 
						|
      .decoder = {
 | 
						|
          .alloc = irda_decoder_nec_alloc,
 | 
						|
          .decode = irda_decoder_nec_decode,
 | 
						|
          .reset = irda_decoder_nec_reset,
 | 
						|
          .free = irda_decoder_nec_free},
 | 
						|
      .encoder = {
 | 
						|
          .alloc = irda_encoder_nec_alloc,
 | 
						|
          .encode = irda_encoder_nec_encode,
 | 
						|
          .reset = irda_encoder_nec_reset,
 | 
						|
          .free = irda_encoder_nec_free},
 | 
						|
      .address_length = 2,
 | 
						|
      .command_length = 2,
 | 
						|
    },
 | 
						|
    // #1 - have to be after NEC
 | 
						|
    { .protocol = IrdaProtocolNECext,
 | 
						|
      .name = "NECext",
 | 
						|
      .decoder = {
 | 
						|
          .alloc = irda_decoder_necext_alloc,
 | 
						|
          .decode = irda_decoder_nec_decode,
 | 
						|
          .reset = irda_decoder_nec_reset,
 | 
						|
          .free = irda_decoder_nec_free},
 | 
						|
      .encoder = {
 | 
						|
          .alloc = irda_encoder_necext_alloc,
 | 
						|
          .encode = irda_encoder_nec_encode,
 | 
						|
          .reset = irda_encoder_necext_reset,
 | 
						|
          .free = irda_encoder_nec_free},
 | 
						|
      .address_length = 4,
 | 
						|
      .command_length = 2,
 | 
						|
    },
 | 
						|
    // #2
 | 
						|
    { .protocol = IrdaProtocolSamsung32,
 | 
						|
      .name ="Samsung32",
 | 
						|
      .decoder = {
 | 
						|
          .alloc = irda_decoder_samsung32_alloc,
 | 
						|
          .decode = irda_decoder_samsung32_decode,
 | 
						|
          .reset = irda_decoder_samsung32_reset,
 | 
						|
          .free = irda_decoder_samsung32_free},
 | 
						|
      .encoder = {
 | 
						|
          .alloc = irda_encoder_samsung32_alloc,
 | 
						|
          .encode = irda_encoder_samsung32_encode,
 | 
						|
          .reset = irda_encoder_samsung32_reset,
 | 
						|
          .free = irda_encoder_samsung32_free},
 | 
						|
      .address_length = 2,
 | 
						|
      .command_length = 2,
 | 
						|
    },
 | 
						|
    // #3
 | 
						|
    { .protocol = IrdaProtocolRC6,
 | 
						|
      .name = "RC6",
 | 
						|
      .decoder = {
 | 
						|
          .alloc = irda_decoder_rc6_alloc,
 | 
						|
          .decode = irda_decoder_rc6_decode,
 | 
						|
          .reset = irda_decoder_rc6_reset,
 | 
						|
          .free = irda_decoder_rc6_free},
 | 
						|
      .encoder = {
 | 
						|
          .alloc = irda_encoder_rc6_alloc,
 | 
						|
          .encode = irda_encoder_rc6_encode,
 | 
						|
          .reset = irda_encoder_rc6_reset,
 | 
						|
          .free = irda_encoder_rc6_free},
 | 
						|
      .address_length = 2,
 | 
						|
      .command_length = 2,
 | 
						|
    },
 | 
						|
};
 | 
						|
 | 
						|
const IrdaMessage* irda_decode(IrdaDecoderHandler* handler, bool level, uint32_t duration) {
 | 
						|
    furi_assert(handler);
 | 
						|
 | 
						|
    IrdaMessage* message = NULL;
 | 
						|
    IrdaMessage* result = NULL;
 | 
						|
 | 
						|
    for (int i = 0; i < COUNT_OF(irda_protocols); ++i) {
 | 
						|
        if (irda_protocols[i].decoder.decode) {
 | 
						|
            message = irda_protocols[i].decoder.decode(handler->ctx[i], level, duration);
 | 
						|
            if (!result && message) {
 | 
						|
                message->protocol = irda_protocols[i].protocol;
 | 
						|
                result = message;
 | 
						|
            }
 | 
						|
        }
 | 
						|
    }
 | 
						|
 | 
						|
    return result;
 | 
						|
}
 | 
						|
 | 
						|
IrdaDecoderHandler* irda_alloc_decoder(void) {
 | 
						|
    IrdaDecoderHandler* handler = furi_alloc(sizeof(IrdaDecoderHandler));
 | 
						|
    handler->ctx = furi_alloc(sizeof(void*) * COUNT_OF(irda_protocols));
 | 
						|
 | 
						|
    for (int i = 0; i < COUNT_OF(irda_protocols); ++i) {
 | 
						|
        handler->ctx[i] = 0;
 | 
						|
        if (irda_protocols[i].decoder.alloc)
 | 
						|
            handler->ctx[i] = irda_protocols[i].decoder.alloc();
 | 
						|
    }
 | 
						|
 | 
						|
    return handler;
 | 
						|
}
 | 
						|
 | 
						|
void irda_free_decoder(IrdaDecoderHandler* handler) {
 | 
						|
    furi_assert(handler);
 | 
						|
    furi_assert(handler->ctx);
 | 
						|
 | 
						|
    for (int i = 0; i < COUNT_OF(irda_protocols); ++i) {
 | 
						|
        if (irda_protocols[i].decoder.free)
 | 
						|
            irda_protocols[i].decoder.free(handler->ctx[i]);
 | 
						|
    }
 | 
						|
 | 
						|
    free(handler->ctx);
 | 
						|
    free(handler);
 | 
						|
}
 | 
						|
 | 
						|
void irda_reset_decoder(IrdaDecoderHandler* handler) {
 | 
						|
    for (int i = 0; i < COUNT_OF(irda_protocols); ++i) {
 | 
						|
        if (irda_protocols[i].decoder.reset)
 | 
						|
            irda_protocols[i].decoder.reset(handler->ctx[i]);
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
IrdaEncoderHandler* irda_alloc_encoder(void) {
 | 
						|
    IrdaEncoderHandler* handler = furi_alloc(sizeof(IrdaEncoderHandler));
 | 
						|
    handler->encoder = NULL;
 | 
						|
    handler->protocol = IrdaProtocolUnknown;
 | 
						|
    return handler;
 | 
						|
}
 | 
						|
 | 
						|
void irda_free_encoder(IrdaEncoderHandler* handler) {
 | 
						|
    furi_assert(handler);
 | 
						|
 | 
						|
    if (handler->encoder) {
 | 
						|
        furi_assert(irda_is_protocol_valid(handler->protocol));
 | 
						|
        furi_assert(irda_protocols[handler->protocol].encoder.free);
 | 
						|
        irda_protocols[handler->protocol].encoder.free(handler->encoder);
 | 
						|
    }
 | 
						|
 | 
						|
    free(handler);
 | 
						|
}
 | 
						|
 | 
						|
void irda_reset_encoder(IrdaEncoderHandler* handler, const IrdaMessage* message) {
 | 
						|
    furi_assert(handler);
 | 
						|
    furi_assert(message);
 | 
						|
    furi_assert(irda_is_protocol_valid(message->protocol));
 | 
						|
    furi_assert(irda_protocols[message->protocol].encoder.reset);
 | 
						|
    furi_assert(irda_protocols[message->protocol].encoder.alloc);
 | 
						|
 | 
						|
    /* Realloc encoder if different protocol set */
 | 
						|
    if (message->protocol != handler->protocol) {
 | 
						|
        if (handler->encoder != NULL) {
 | 
						|
            furi_assert(handler->protocol != IrdaProtocolUnknown);
 | 
						|
            irda_protocols[handler->protocol].encoder.free(handler->encoder);
 | 
						|
        }
 | 
						|
        handler->encoder = irda_protocols[message->protocol].encoder.alloc();
 | 
						|
        handler->protocol = message->protocol;
 | 
						|
    }
 | 
						|
 | 
						|
    irda_protocols[handler->protocol].encoder.reset(handler->encoder, message);
 | 
						|
}
 | 
						|
 | 
						|
 | 
						|
IrdaStatus irda_encode(IrdaEncoderHandler* handler, uint32_t* duration, bool* level) {
 | 
						|
    furi_assert(handler);
 | 
						|
    furi_assert(irda_is_protocol_valid(handler->protocol));
 | 
						|
    furi_assert(irda_protocols[handler->protocol].encoder.encode);
 | 
						|
 | 
						|
    IrdaStatus status = irda_protocols[handler->protocol].encoder.encode(handler->encoder, duration, level);
 | 
						|
    furi_assert(status != IrdaStatusError);
 | 
						|
 | 
						|
    return status;
 | 
						|
}
 | 
						|
 | 
						|
 | 
						|
bool irda_is_protocol_valid(IrdaProtocol protocol) {
 | 
						|
    return (protocol >= 0) && (protocol < COUNT_OF(irda_protocols));
 | 
						|
}
 | 
						|
 | 
						|
IrdaProtocol irda_get_protocol_by_name(const char* protocol_name) {
 | 
						|
    for (int i = 0; i < COUNT_OF(irda_protocols); ++i) {
 | 
						|
        if (!strcmp(irda_protocols[i].name, protocol_name))
 | 
						|
            return i;
 | 
						|
    }
 | 
						|
    return IrdaProtocolUnknown;
 | 
						|
}
 | 
						|
 | 
						|
const char* irda_get_protocol_name(IrdaProtocol protocol) {
 | 
						|
    if (irda_is_protocol_valid(protocol))
 | 
						|
        return irda_protocols[protocol].name;
 | 
						|
    else
 | 
						|
        return "Invalid";
 | 
						|
}
 | 
						|
 | 
						|
uint8_t irda_get_protocol_address_length(IrdaProtocol protocol) {
 | 
						|
    if (irda_is_protocol_valid(protocol))
 | 
						|
        return irda_protocols[protocol].address_length;
 | 
						|
    else
 | 
						|
        return 0;
 | 
						|
}
 | 
						|
 | 
						|
uint8_t irda_get_protocol_command_length(IrdaProtocol protocol) {
 | 
						|
    if (irda_is_protocol_valid(protocol))
 | 
						|
        return irda_protocols[protocol].command_length;
 | 
						|
    else
 | 
						|
        return 0;
 | 
						|
}
 | 
						|
 |