Try out the fsk

app/fskmodem.c

@@ -3,7 +3,9 @@
 //
 
 #include "fskmodem.h"
-#include "eeprom.h"
+//#include "messages.h"
+#include "driver/uart.h"
+#include "../ui/messages.h"
 
 uint16_t TONE2_FREQ;
 
@@ -15,6 +17,13 @@ uint8_t *dataPTR = dataPacket.data;
 
 SMSEnteringState gEnteringSMS = SMS_NOT_ENTERING;
 
+typedef enum {
+    Receiving,
+    Ready
+} RXState;
+
+RXState rxState = Ready;
+
 void MSG_ConfigureFSK(bool rx) {
     BK4819_WriteRegister(BK4819_REG_70, TONE2_ENABLE_BIT | (96U << 0));
 
@@ -115,25 +124,25 @@ uint16_t calculateCRC(uint8_t *data, size_t length) {
 
 
 void processReceivedPacket(DataPacket *packet) {
-    char String[31 + DataPacketDataSize];
+    char String[18];
     char numBuf[11];  // Enough for any 64-bit unsigned integer
     const unsigned int vfo = (gEeprom.CROSS_BAND_RX_TX == CROSS_BAND_OFF) ? gEeprom.RX_VFO
                                                                           : gEeprom.TX_VFO;
-    if (dataPacket.dest == gEeprom.FSKSRCAddress) {
+
+    if (packet->dest == gEeprom.FSKSRCAddress) {
+        AUDIO_PlayBeep(BEEP_500HZ_60MS_DOUBLE_BEEP);
         BK4819_PlaySingleTone(1000, 250, 127, true);
         strcpy(String, "SMS by ");
         itoa(packet->src, numBuf);  // Convert number to string
         strcat(String, numBuf);
-        strcat(String, ": ");
-        strcat(String, (char *)packet->data);
-
+        MESSAGES_SAVE();
         UI_DisplayPopup(String);
 #ifdef ENABLE_FEAT_F4HWN
         if (isMainOnly()) {
-                    UI_PrintStringSmallNormal(String, 2, 0, 5);
-                } else {
-                    UI_PrintStringSmallNormal(String, 2, 0, 3);
-                }
+            UI_PrintStringSmallNormal(String, 2, 0, 5);
+        } else {
+            UI_PrintStringSmallNormal(String, 2, 0, 3);
+        }
 #else
         UI_PrintStringSmallNormal(String, 2, 0, 3);
 
@@ -147,7 +156,7 @@ void processReceivedPacket(DataPacket *packet) {
         }
     }
 
-    memset(packet, 0, DataPacketDataSize); // Clear data after processing (example action)
+    memset(packet, 0, sizeof(DataPacket)); // Clear data after processing (example action)
 }
 
 
@@ -315,4 +324,65 @@ void prepareDataPacket() {
     Data[0]++;
     EEPROM_WriteBuffer(SEQParameterEEPROM, Data);
     dataPacket.ttl = 20;
+}
+
+void FSK_HANDLE_IRQ(unsigned short irq) {
+    //const uint16_t rx_sync_flags   = BK4819_ReadRegister(BK4819_REG_0B);
+
+    const bool rx_sync = (irq & BK4819_REG_02_FSK_RX_SYNC) != 0;
+    const bool rx_fifo_almost_full = (irq & BK4819_REG_02_FSK_FIFO_ALMOST_FULL) != 0;
+    const bool rx_finished = (irq & BK4819_REG_02_FSK_RX_FINISHED) != 0;
+
+    //UART_printf("\nMSG : S%i, F%i, E%i | %i", rx_sync, rx_fifo_almost_full, rx_finished, irq);
+
+    if (rx_sync) {
+        // prevent listening to fsk data and squelch (kamilsss655)
+        // CTCSS codes seem to false trigger the rx_sync
+        if (gCurrentCodeType == CODE_TYPE_OFF)
+            AUDIO_AudioPathOff();
+        gFSKWriteIndex = 0;
+        memset(&inBoundPacket, 0, sizeof(DataPacket));
+        rxState = Receiving;
+        UART_String("Sync\n");
+    }
+
+    if (rx_fifo_almost_full && rxState == Receiving) {
+        const uint16_t count = BK4819_ReadRegister(BK4819_REG_5E) & (7u << 0);  // Almost full threshold
+        uint16_t *ptr = (uint16_t *) &inBoundPacket;
+        size_t wordCount = sizeof(inBoundPacket) / sizeof(uint16_t);
+
+        for (uint16_t i = 0; i < count && gFSKWriteIndex < wordCount; i++) {
+            ptr[gFSKWriteIndex++] = BK4819_ReadRegister(BK4819_REG_5F);
+            UART_Send((const void *) &ptr[gFSKWriteIndex - 1], 2);
+        }
+
+        SYSTEM_DelayMs(10);
+    }
+
+    if (rx_finished) {
+        // Turn off green LED
+        BK4819_FskClearFifo();
+
+        rxState = Ready;
+        UART_String("FSK end\n");
+
+        if (gFSKWriteIndex > 2) {
+            // Validate checksum (assuming last 2 bytes are CRC-16)
+            //size_t dataLength = sizeof(inBoundPacket.data) - 2;
+            //uint16_t receivedCRC = (inBoundPacket.data[dataLength] << 8) | inBoundPacket.data[dataLength + 1];
+            //uint16_t calculatedCRC = calculateCRC(inBoundPacket.data, dataLength);
+
+            //if (receivedCRC == calculatedCRC) {
+            processReceivedPacket(&inBoundPacket);
+            //}
+        }
+
+        APP_EndTransmission();
+        FUNCTION_Select(FUNCTION_FOREGROUND);
+        gUpdateStatus = true;
+        gUpdateDisplay = true;
+        gFlagEndTransmission = false;
+
+        gFSKWriteIndex = 0;
+    }
 }