subghz_txrx_create_potocol_key.c 4.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164
  1. #include "subghz_txrx_i.h"
  2. #include "subghz_txrx_create_potocol_key.h"
  3. #include <lib/subghz/transmitter.h>
  4. #include <lib/subghz/protocols/protocol_items.h>
  5. #include <lib/subghz/protocols/protocol_items.h>
  6. #include <lib/subghz/protocols/keeloq.h>
  7. #include <lib/subghz/protocols/secplus_v1.h>
  8. #include <lib/subghz/protocols/secplus_v2.h>
  9. #include <flipper_format/flipper_format_i.h>
  10. #include <lib/toolbox/stream/stream.h>
  11. #include <lib/subghz/protocols/raw.h>
  12. #define TAG "SubGhzCreateProtocolKey"
  13. bool subghz_txrx_gen_data_protocol(
  14. void* context,
  15. const char* preset_name,
  16. uint32_t frequency,
  17. const char* protocol_name,
  18. uint64_t key,
  19. uint32_t bit) {
  20. furi_assert(context);
  21. SubGhzTxRx* instance = context;
  22. bool res = false;
  23. subghz_txrx_set_preset(instance, preset_name, frequency, NULL, 0);
  24. instance->decoder_result =
  25. subghz_receiver_search_decoder_base_by_name(instance->receiver, protocol_name);
  26. if(instance->decoder_result == NULL) {
  27. //TODO: Error
  28. // furi_string_set(error_str, "Protocol not\nfound!");
  29. // scene_manager_next_scene(scene_manager, SubGhzSceneShowErrorSub);
  30. FURI_LOG_E(TAG, "Protocol not found!");
  31. return false;
  32. }
  33. do {
  34. Stream* fff_data_stream = flipper_format_get_raw_stream(instance->fff_data);
  35. stream_clean(fff_data_stream);
  36. if(subghz_protocol_decoder_base_serialize(
  37. instance->decoder_result, instance->fff_data, instance->preset) !=
  38. SubGhzProtocolStatusOk) {
  39. FURI_LOG_E(TAG, "Unable to serialize");
  40. break;
  41. }
  42. if(!flipper_format_update_uint32(instance->fff_data, "Bit", &bit, 1)) {
  43. FURI_LOG_E(TAG, "Unable to update Bit");
  44. break;
  45. }
  46. uint8_t key_data[sizeof(uint64_t)] = {0};
  47. for(size_t i = 0; i < sizeof(uint64_t); i++) {
  48. key_data[sizeof(uint64_t) - i - 1] = (key >> (i * 8)) & 0xFF;
  49. }
  50. if(!flipper_format_update_hex(instance->fff_data, "Key", key_data, sizeof(uint64_t))) {
  51. FURI_LOG_E(TAG, "Unable to update Key");
  52. break;
  53. }
  54. res = true;
  55. } while(false);
  56. return res;
  57. }
  58. bool subghz_txrx_gen_data_protocol_and_te(
  59. SubGhzTxRx* instance,
  60. const char* preset_name,
  61. uint32_t frequency,
  62. const char* protocol_name,
  63. uint64_t key,
  64. uint32_t bit,
  65. uint32_t te) {
  66. furi_assert(instance);
  67. bool ret = false;
  68. if(subghz_txrx_gen_data_protocol(instance, preset_name, frequency, protocol_name, key, bit)) {
  69. if(!flipper_format_update_uint32(instance->fff_data, "TE", (uint32_t*)&te, 1)) {
  70. FURI_LOG_E(TAG, "Unable to update Te");
  71. } else {
  72. ret = true;
  73. }
  74. }
  75. return ret;
  76. }
  77. bool subghz_txrx_gen_keelog_protocol(
  78. SubGhzTxRx* instance,
  79. const char* name_preset,
  80. uint32_t frequency,
  81. const char* name_sysmem,
  82. uint32_t serial,
  83. uint8_t btn,
  84. uint16_t cnt) {
  85. furi_assert(instance);
  86. bool ret = false;
  87. serial &= 0x0FFFFFFF;
  88. instance->transmitter =
  89. subghz_transmitter_alloc_init(instance->environment, SUBGHZ_PROTOCOL_KEELOQ_NAME);
  90. subghz_txrx_set_preset(instance, name_preset, frequency, NULL, 0);
  91. if(instance->transmitter) {
  92. subghz_protocol_keeloq_create_data(
  93. subghz_transmitter_get_protocol_instance(instance->transmitter),
  94. instance->fff_data,
  95. serial,
  96. btn,
  97. cnt,
  98. name_sysmem,
  99. instance->preset);
  100. ret = true;
  101. }
  102. subghz_transmitter_free(instance->transmitter);
  103. return ret;
  104. }
  105. bool subghz_txrx_gen_secplus_v2_protocol(
  106. SubGhzTxRx* instance,
  107. const char* name_preset,
  108. uint32_t frequency,
  109. uint32_t serial,
  110. uint8_t btn,
  111. uint32_t cnt) {
  112. furi_assert(instance);
  113. bool ret = false;
  114. instance->transmitter =
  115. subghz_transmitter_alloc_init(instance->environment, SUBGHZ_PROTOCOL_SECPLUS_V2_NAME);
  116. subghz_txrx_set_preset(instance, name_preset, frequency, NULL, 0);
  117. if(instance->transmitter) {
  118. subghz_protocol_secplus_v2_create_data(
  119. subghz_transmitter_get_protocol_instance(instance->transmitter),
  120. instance->fff_data,
  121. serial,
  122. btn,
  123. cnt,
  124. instance->preset);
  125. ret = true;
  126. }
  127. return ret;
  128. }
  129. bool subghz_txrx_gen_secplus_v1_protocol(
  130. SubGhzTxRx* instance,
  131. const char* name_preset,
  132. uint32_t frequency) {
  133. furi_assert(instance);
  134. bool ret = false;
  135. uint32_t serial = (uint32_t)rand();
  136. while(!subghz_protocol_secplus_v1_check_fixed(serial)) {
  137. serial = (uint32_t)rand();
  138. }
  139. if(subghz_txrx_gen_data_protocol(
  140. instance,
  141. name_preset,
  142. frequency,
  143. SUBGHZ_PROTOCOL_SECPLUS_V1_NAME,
  144. (uint64_t)serial << 32 | 0xE6000000,
  145. 42)) {
  146. ret = true;
  147. }
  148. return ret;
  149. }