infrared_decoder_nec.c 3.7 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697
  1. #include "infrared_protocol_nec_i.h"
  2. #include <core/check.h>
  3. InfraredMessage* infrared_decoder_nec_check_ready(void* ctx) {
  4. return infrared_common_decoder_check_ready(ctx);
  5. }
  6. bool infrared_decoder_nec_interpret(InfraredCommonDecoder* decoder) {
  7. furi_assert(decoder);
  8. bool result = false;
  9. if(decoder->databit_cnt == 32) {
  10. uint8_t address = decoder->data[0];
  11. uint8_t address_inverse = decoder->data[1];
  12. uint8_t command = decoder->data[2];
  13. uint8_t command_inverse = decoder->data[3];
  14. uint8_t inverse_command_inverse = (uint8_t)~command_inverse;
  15. uint8_t inverse_address_inverse = (uint8_t)~address_inverse;
  16. if((command == inverse_command_inverse) && (address == inverse_address_inverse)) {
  17. decoder->message.protocol = InfraredProtocolNEC;
  18. decoder->message.address = address;
  19. decoder->message.command = command;
  20. decoder->message.repeat = false;
  21. result = true;
  22. } else {
  23. decoder->message.protocol = InfraredProtocolNECext;
  24. decoder->message.address = decoder->data[0] | (decoder->data[1] << 8);
  25. decoder->message.command = decoder->data[2] | (decoder->data[3] << 8);
  26. decoder->message.repeat = false;
  27. result = true;
  28. }
  29. } else if(decoder->databit_cnt == 42) {
  30. uint32_t* data1 = (void*)decoder->data;
  31. uint16_t* data2 = (void*)(data1 + 1);
  32. uint16_t address = *data1 & 0x1FFF;
  33. uint16_t address_inverse = (*data1 >> 13) & 0x1FFF;
  34. uint16_t command = ((*data1 >> 26) & 0x3F) | ((*data2 & 0x3) << 6);
  35. uint16_t command_inverse = (*data2 >> 2) & 0xFF;
  36. if((address == (~address_inverse & 0x1FFF)) && (command == (~command_inverse & 0xFF))) {
  37. decoder->message.protocol = InfraredProtocolNEC42;
  38. decoder->message.address = address;
  39. decoder->message.command = command;
  40. decoder->message.repeat = false;
  41. result = true;
  42. } else {
  43. decoder->message.protocol = InfraredProtocolNEC42ext;
  44. decoder->message.address = address | (address_inverse << 13);
  45. decoder->message.command = command | (command_inverse << 8);
  46. decoder->message.repeat = false;
  47. result = true;
  48. }
  49. }
  50. return result;
  51. }
  52. // timings start from Space (delay between message and repeat)
  53. InfraredStatus infrared_decoder_nec_decode_repeat(InfraredCommonDecoder* decoder) {
  54. furi_assert(decoder);
  55. float preamble_tolerance = decoder->protocol->timings.preamble_tolerance;
  56. uint32_t bit_tolerance = decoder->protocol->timings.bit_tolerance;
  57. InfraredStatus status = InfraredStatusError;
  58. if(decoder->timings_cnt < 4) return InfraredStatusOk;
  59. if((decoder->timings[0] > INFRARED_NEC_REPEAT_PAUSE_MIN) &&
  60. (decoder->timings[0] < INFRARED_NEC_REPEAT_PAUSE_MAX) &&
  61. MATCH_TIMING(decoder->timings[1], INFRARED_NEC_REPEAT_MARK, preamble_tolerance) &&
  62. MATCH_TIMING(decoder->timings[2], INFRARED_NEC_REPEAT_SPACE, preamble_tolerance) &&
  63. MATCH_TIMING(decoder->timings[3], decoder->protocol->timings.bit1_mark, bit_tolerance)) {
  64. status = InfraredStatusReady;
  65. decoder->timings_cnt = 0;
  66. } else {
  67. status = InfraredStatusError;
  68. }
  69. return status;
  70. }
  71. void* infrared_decoder_nec_alloc(void) {
  72. return infrared_common_decoder_alloc(&infrared_protocol_nec);
  73. }
  74. InfraredMessage* infrared_decoder_nec_decode(void* decoder, bool level, uint32_t duration) {
  75. return infrared_common_decode(decoder, level, duration);
  76. }
  77. void infrared_decoder_nec_free(void* decoder) {
  78. infrared_common_decoder_free(decoder);
  79. }
  80. void infrared_decoder_nec_reset(void* decoder) {
  81. infrared_common_decoder_reset(decoder);
  82. }