feat: Add Packet BLE

- Fail CRC
ElectronicCats · Oct 25, 2024 · 52da943 · 52da943
1 parent 6ed09db
commit 52da943
Show file tree

Hide file tree

Showing 4 changed files with 96 additions and 3 deletions.
diff --git a/firmware/components/ble_scann/ble_scann.c b/firmware/components/ble_scann/ble_scann.c
@@ -45,9 +45,7 @@ static void handle_bt_gapc_events(esp_gap_ble_cb_event_t event_type,
           if (!ble_scanner_active) {
             break;
           }
-          uart_sender_send_packet(UART_SENDER_PACKET_TYPE_BLE,
-                                  scan_result->scan_rst.ble_adv,
-                                  scan_result->scan_rst.adv_data_len);
+          uart_sender_send_packet_ble(UART_SENDER_PACKET_TYPE_BLE, scan_result);
           ESP_LOGI(TAG_BLE_CLIENT_MODULE, "New ADV found");
           break;
         case ESP_GAP_SEARCH_INQ_CMPL_EVT:

diff --git a/firmware/components/uart_sender/CMakeLists.txt b/firmware/components/uart_sender/CMakeLists.txt
@@ -1,2 +1,3 @@
 idf_component_register(SRCS "uart_sender.c"
+PRIV_REQUIRES bt bt_gattc 
 INCLUDE_DIRS ".")
diff --git a/firmware/components/uart_sender/uart_sender.c b/firmware/components/uart_sender/uart_sender.c
@@ -4,8 +4,24 @@
 #include <stdio.h>
 #include "esp_log.h"
 
+#define BLE_ADDRESS_SIZE    6
+#define BLE_PDU_INFO_OFFSET 19
+#define BLE_ADDRESS_OFFSET  21
+#define BLE_PAYLOAD_OFFSET  27
+
 static bool is_uart_sender_initialized = false;
 
+static unsigned char base_packet[] = {
+    0x40, 0x53,                          // Start - TI packet
+    0xc0,                                // Packet Info - TI Packet
+    0x36, 0x00,                          // Packet Length - TI Packet
+    0x8c, 0xc9, 0xaf, 0x01, 0x00, 0x00,  // Timestamp - TI Packet
+    0x25,                                // Channel - TI Packet
+    0x00, 0x00,                          // Connection Event - TI Packet
+    0x00,                                // Connection Info - TI Packet
+    0xd6, 0xbe, 0x89, 0x8e,              // Access Address - TI Packet
+};
+
 /**
  * @brief Initialize the UART sender
  *
@@ -55,3 +71,78 @@ void uart_sender_send_packet(uart_sender_packet_type type,
   printf("@E");    // End of packet
   printf("\n");
 }
+
+// unsigned char array[] = {
+
+//     // Header - BLE Packet
+//     0x42, // PDU Info - BLE Packet
+//     0x21, // AdvLen - BLE Packet
+//     0x15, 0xc7, 0xbf, 0x84, 0x50, 0x4b, // AdvA - BLE Packet
+//     // Payload - BLE Packet
+//     0x02, 0x01, 0x1a, 0x17, 0xff,
+//     0x4c, 0x00, 0x09, 0x08, 0x13, 0x03, 0xc0, 0xa8, 0x00, 0xb2, 0x1b, 0x58,
+//     0x16, 0x08, 0x00, 0xa6, 0x48, 0x4c, 0x4f, 0x71, 0xdf, 0xb7, 0xf1, 0x9b,
+//     0xee, 0xc7, // RSSI - TI Packet 0x80, // Status - TI Packet 0x40, 0x45 //
+//     END - TI packet
+// };
+
+uint32_t calculate_ble_crc24(const uint8_t* data, size_t len) {
+  uint32_t crc = 0x555555;  // Inicialización del CRC con 0x555555
+  uint32_t poly = 0x65B;    // Polinomio 0x65B
+
+  for (size_t i = 0; i < len; i++) {
+    crc ^= ((uint32_t) data[i] << 16);  // XOR el byte actual al CRC
+
+    for (int j = 0; j < 8; j++) {  // Procesar bit a bit
+      if (crc & 0x800000) {
+        crc = (crc << 1) ^ poly;
+      } else {
+        crc <<= 1;
+      }
+    }
+  }
+
+  return (crc & 0xFFFFFF);  // Retornar solo los 24 bits inferiores
+}
+
+void uart_sender_send_packet_ble(uart_sender_packet_type type,
+                                 esp_ble_gap_cb_param_t* packet) {
+  uart_sender_init();
+  uint8_t packet_length =
+      1 + 1 + BLE_ADDRESS_SIZE + packet->scan_rst.adv_data_len;
+  for (int i = 0; i < sizeof(base_packet); i++) {
+    printf("%c", base_packet[i]);
+  }
+  unsigned char temp_packet[packet_length];
+  uint8_t index = 0;
+  temp_packet[index] = packet->scan_rst.ble_evt_type;
+  index++;
+  temp_packet[index] = packet->scan_rst.adv_data_len;
+  index++;
+  for (int i = 0; i < BLE_ADDRESS_SIZE; i++) {
+    temp_packet[index] = packet->scan_rst.bda[i];
+    index++;
+  }
+  for (int i = 0; i < packet->scan_rst.adv_data_len; i++) {
+    temp_packet[index] = packet->scan_rst.ble_adv[i];
+    index++;
+  }
+  // printf("%c", packet->scan_rst.ble_evt_type);
+  // printf("%c", packet->scan_rst.adv_data_len);
+  // for (int i = 0; i < BLE_ADDRESS_SIZE; i++) {
+  //   printf("%c", packet->scan_rst.bda[i]);
+  // }
+  // for (int i = 0; i < packet->scan_rst.adv_data_len; i++) {
+  //   printf("%c", packet->scan_rst.ble_adv[i]);
+  // }
+  for (int i = 0; i < packet_length; i++) {
+    printf("%c", temp_packet[i]);
+  }
+
+  uint16_t crc = calculate_ble_crc24(temp_packet, packet_length);
+  printf("%02x%02x", (crc >> 8) & 0xFF, crc & 0xFF);
+  printf("%c", packet->scan_rst.rssi);
+  printf("\x80");  // Status
+  printf("@E");    // End of packet
+  printf("\n");
+}
diff --git a/firmware/components/uart_sender/uart_sender.h b/firmware/components/uart_sender/uart_sender.h
@@ -1,5 +1,6 @@
 #pragma once
 #include <stdint.h>
+#include "esp_gap_ble_api.h"
 #ifndef UART_SENDER
   #define UART_SENDER
 
@@ -21,6 +22,8 @@ void uart_sender_send_packet(uart_sender_packet_type type,
                              uint8_t* packet,
                              uint8_t len);
 
+void uart_sender_send_packet_ble(uart_sender_packet_type type,
+                                 esp_ble_gap_cb_param_t* packet);
 /**
  * @brief DeInitialize the UART sender
  *