Document Bluetooth files with overall file Doxygen comments. Add more initial RFCOMM...

[pub/USBasp.git] / Demos / Host / Incomplete / BluetoothHost / Lib / RFCOMM.c

diff --git a/Demos/Host/Incomplete/BluetoothHost/Lib/RFCOMM.c b/Demos/Host/Incomplete/BluetoothHost/Lib/RFCOMM.c
index a441ae1..5101606 100644 (file)
--- a/Demos/Host/Incomplete/BluetoothHost/Lib/RFCOMM.c
+++ b/Demos/Host/Incomplete/BluetoothHost/Lib/RFCOMM.c
@@ -28,6 +28,13 @@
   this software.\r
 */\r
 \r
+/** \file\r
+ *\r
+ *  RFCOMM layer module. This module manages the RFCOMM layer of the\r
+ *  stack, providing virtual serial port channels on top of the lower\r
+ *  L2CAP layer.\r
+ */\r
+\r
 #define  INCLUDE_FROM_RFCOMM_C\r
 #include "RFCOMM.h"\r
 \r
@@ -62,10 +69,10 @@ void RFCOMM_Initialize(void)
 \r
 void RFCOMM_ProcessPacket(void* Data, Bluetooth_Channel_t* const Channel)\r
 {\r
-       RFCOMM_Header_t* FrameHeader = (RFCOMM_Header_t*)Data;\r
+       const RFCOMM_Header_t* FrameHeader = (const RFCOMM_Header_t*)Data;\r
        \r
        /* Decode the RFCOMM frame type from the header */\r
-       switch (FrameHeader->FrameType & ~FRAME_POLL_FINAL)\r
+       switch (FrameHeader->Control & ~FRAME_POLL_FINAL)\r
        {\r
                case RFCOMM_Frame_SABM:\r
                        RFCOMM_ProcessSABM(FrameHeader, Channel);\r
@@ -82,54 +89,94 @@ void RFCOMM_ProcessPacket(void* Data, Bluetooth_Channel_t* const Channel)
                case RFCOMM_Frame_UIH:\r
                        RFCOMM_ProcessUIH(FrameHeader, Channel);\r
                        break;\r
+               default:\r
+                       BT_RFCOMM_DEBUG(1, "<< Unknown Frame Type");\r
+                       break;\r
        }\r
 }\r
 \r
 static void RFCOMM_ProcessSABM(const RFCOMM_Header_t* const FrameHeader, Bluetooth_Channel_t* const Channel)\r
 {\r
-       uint8_t* CurrBufferPos = ((uint8_t*)FrameHeader + sizeof(RFCOMM_Header_t));\r
-       uint16_t DataLen       = RFCOMM_GetFrameDataLength(&CurrBufferPos);\r
-\r
        BT_RFCOMM_DEBUG(1, "<< SABM Received");\r
-       BT_RFCOMM_DEBUG(2, "-- Data Length 0x%04X", DataLen);\r
+       BT_RFCOMM_DEBUG(2, "-- Address 0x%02X", FrameHeader->Address);\r
+       \r
+       // TODO: Reset channel send/receive state here\r
+       \r
+       struct\r
+       {\r
+               RFCOMM_Header_t FrameHeader;\r
+               uint8_t         FrameLength;\r
+               uint8_t         FCS;\r
+       } ResponsePacket;\r
+       \r
+       /* Copy over the same frame header as the sent packet to copy the logical RFCOMM channel address */\r
+       ResponsePacket.FrameHeader.Address              = FrameHeader->Address;\r
+       \r
+       /* Set the frame type to an Unnumbered Acknowledgement to acknowledge the SABM request */\r
+       ResponsePacket.FrameHeader.Control = RFCOMM_Frame_UA;\r
+       \r
+       /* Set the length to 0 (LSB indicates end of 8-bit length field) */\r
+       ResponsePacket.FrameLength = 0x01;\r
+       \r
+       /* Calculate the frame checksum from all fields except the FCS field itself */\r
+       ResponsePacket.FCS = RFCOMM_GetFCSValue(&ResponsePacket, sizeof(ResponsePacket) - sizeof(ResponsePacket.FCS));\r
+       \r
+       BT_RFCOMM_DEBUG(1, ">> UA Sent");\r
 \r
-       for (uint16_t i = 0; i < DataLen; i++)\r
-         printf("0x%02X ", CurrBufferPos[i]);\r
-       printf("\r\n");\r
+       /* Send the completed response packet to the sender */\r
+       Bluetooth_SendPacket(&ResponsePacket, sizeof(ResponsePacket), Channel);\r
 }\r
 \r
 static void RFCOMM_ProcessUA(const RFCOMM_Header_t* const FrameHeader, Bluetooth_Channel_t* const Channel)\r
 {\r
+       const uint8_t* CurrBufferPos = ((const uint8_t*)FrameHeader + sizeof(RFCOMM_Header_t));\r
+\r
        BT_RFCOMM_DEBUG(1, "<< UA Received");\r
+       BT_RFCOMM_DEBUG(2, "-- Address 0x%02X", FrameHeader->Address);\r
 }\r
 \r
 static void RFCOMM_ProcessDM(const RFCOMM_Header_t* const FrameHeader, Bluetooth_Channel_t* const Channel)\r
 {\r
+       const uint8_t* CurrBufferPos = ((const uint8_t*)FrameHeader + sizeof(RFCOMM_Header_t));\r
+\r
        BT_RFCOMM_DEBUG(1, "<< DM Received");\r
+       BT_RFCOMM_DEBUG(2, "-- Address 0x%02X", FrameHeader->Address);\r
 }\r
 \r
 static void RFCOMM_ProcessDISC(const RFCOMM_Header_t* const FrameHeader, Bluetooth_Channel_t* const Channel)\r
 {\r
+       const uint8_t* CurrBufferPos = ((const uint8_t*)FrameHeader + sizeof(RFCOMM_Header_t));\r
+\r
        BT_RFCOMM_DEBUG(1, "<< DISC Received");\r
+       BT_RFCOMM_DEBUG(2, "-- Address 0x%02X", FrameHeader->Address);\r
 }\r
 \r
 static void RFCOMM_ProcessUIH(const RFCOMM_Header_t* const FrameHeader, Bluetooth_Channel_t* const Channel)\r
 {\r
+       const uint8_t* CurrBufferPos = ((const uint8_t*)FrameHeader + sizeof(RFCOMM_Header_t));\r
+\r
        BT_RFCOMM_DEBUG(1, "<< UIH Received");\r
+       BT_RFCOMM_DEBUG(2, "-- Address 0x%02X", FrameHeader->Address);\r
 }\r
 \r
-static uint16_t RFCOMM_GetFrameDataLength(void** BufferPos)\r
+static uint8_t RFCOMM_GetFCSValue(const void* FrameStart, uint16_t Length)\r
 {\r
-       uint8_t FirstOctet = *((uint8_t*)*BufferPos);\r
-       (*BufferPos)++;\r
+       const uint8_t* CurrPos = FrameStart;\r
+       uint8_t        FCS     = 0xFF;\r
+       \r
+       while (Length--)\r
+         FCS = pgm_read_byte(CRC8_Table[FCS ^ *(CurrPos++)]);\r
 \r
+       return ~FCS;\r
+}\r
+\r
+static uint16_t RFCOMM_GetFrameDataLength(const uint8_t** BufferPos)\r
+{\r
+       uint8_t FirstOctet  = *((*BufferPos)++);\r
        uint8_t SecondOctet = 0;\r
        \r
        if (!(FirstOctet & 0x01))\r
-       {\r
-               SecondOctet = *((uint8_t*)*BufferPos);\r
-               (*BufferPos)++;\r
-       }\r
+         SecondOctet = *((*BufferPos)++);\r
        \r
        return (((uint16_t)SecondOctet << 7) | (FirstOctet >> 1));\r
 }\r