subghz_protocol_came.c 4.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131
  1. #include "subghz_protocol_came.h"
  2. #include "subghz_protocol_common.h"
  3. /*
  4. * Help
  5. * https://phreakerclub.com/447
  6. *
  7. */
  8. struct SubGhzProtocolCame {
  9. SubGhzProtocolCommon common;
  10. };
  11. SubGhzProtocolCame* subghz_protocol_came_alloc() {
  12. SubGhzProtocolCame* instance = furi_alloc(sizeof(SubGhzProtocolCame));
  13. instance->common.name = "Came";
  14. instance->common.code_min_count_bit_for_found = 12;
  15. instance->common.te_shot = 320;
  16. instance->common.te_long = 640;
  17. instance->common.te_delta = 150;
  18. return instance;
  19. }
  20. void subghz_protocol_came_free(SubGhzProtocolCame* instance) {
  21. furi_assert(instance);
  22. free(instance);
  23. }
  24. /** Send bit
  25. *
  26. * @param instance - SubGhzProtocolCame instance
  27. * @param bit - bit
  28. */
  29. void subghz_protocol_came_send_bit(SubGhzProtocolCame* instance, uint8_t bit) {
  30. if (bit) {
  31. //send bit 1
  32. SUBGHZ_TX_PIN_LOW();
  33. delay_us(instance->common.te_long);
  34. SUBGHZ_TX_PIN_HIGTH();
  35. delay_us(instance->common.te_shot);
  36. } else {
  37. //send bit 0
  38. SUBGHZ_TX_PIN_LOW();
  39. delay_us(instance->common.te_shot);
  40. SUBGHZ_TX_PIN_HIGTH();
  41. delay_us(instance->common.te_long);
  42. }
  43. }
  44. void subghz_protocol_came_send_key(SubGhzProtocolCame* instance, uint64_t key, uint8_t bit, uint8_t repeat) {
  45. while (repeat--) {
  46. //Send header
  47. SUBGHZ_TX_PIN_LOW();
  48. delay_us(instance->common.te_shot * 34); //+2 interval v bit 1
  49. //Send start bit
  50. subghz_protocol_came_send_bit(instance, 1);
  51. //Send key data
  52. for (uint8_t i = bit; i > 0; i--) {
  53. subghz_protocol_came_send_bit(instance, bit_read(key, i - 1));
  54. }
  55. }
  56. }
  57. void subghz_protocol_came_reset(SubGhzProtocolCame* instance) {
  58. instance->common.parser_step = 0;
  59. }
  60. void subghz_protocol_came_parse(SubGhzProtocolCame* instance, bool level, uint32_t duration) {
  61. switch (instance->common.parser_step) {
  62. case 0:
  63. if ((!level)
  64. && (DURATION_DIFF(duration, instance->common.te_shot * 51)< instance->common.te_delta * 51)) { //Need protocol 36 te_shot
  65. //Found header CAME
  66. instance->common.parser_step = 1;
  67. } else {
  68. instance->common.parser_step = 0;
  69. }
  70. break;
  71. case 1:
  72. if (!level) {
  73. break;
  74. } else if (DURATION_DIFF(duration, instance->common.te_shot)< instance->common.te_delta) {
  75. //Found start bit CAME
  76. instance->common.parser_step = 2;
  77. instance->common.code_found = 0;
  78. instance->common.code_count_bit = 0;
  79. } else {
  80. instance->common.parser_step = 0;
  81. }
  82. break;
  83. case 2:
  84. if (!level) { //save interval
  85. if (duration >= (instance->common.te_shot * 4)) {
  86. instance->common.parser_step = 1;
  87. if (instance->common.code_count_bit>= instance->common.code_min_count_bit_for_found) {
  88. instance->common.serial = 0x0;
  89. instance->common.btn = 0x0;
  90. if (instance->common.callback)
  91. instance->common.callback((SubGhzProtocolCommon*)instance, instance->common.context);
  92. }
  93. break;
  94. }
  95. instance->common.te_last = duration;
  96. instance->common.parser_step = 3;
  97. } else {
  98. instance->common.parser_step = 0;
  99. }
  100. break;
  101. case 3:
  102. if (level) {
  103. if ((DURATION_DIFF(instance->common.te_last,instance->common.te_shot) < instance->common.te_delta)
  104. && (DURATION_DIFF(duration, instance->common.te_long)< instance->common.te_delta)) {
  105. subghz_protocol_common_add_bit(&instance->common, 0);
  106. instance->common.parser_step = 2;
  107. } else if ((DURATION_DIFF(instance->common.te_last,instance->common.te_long)< instance->common.te_delta)
  108. && (DURATION_DIFF(duration, instance->common.te_shot)< instance->common.te_delta)) {
  109. subghz_protocol_common_add_bit(&instance->common, 1);
  110. instance->common.parser_step = 2;
  111. } else
  112. instance->common.parser_step = 0;
  113. } else {
  114. instance->common.parser_step = 0;
  115. }
  116. break;
  117. }
  118. }