projects / pub / USBasp.git / blobdiff
? search:
summary | shortlog | log | commit | commitdiff | tree
raw | inline | side by side
Make AVRISP-MKII clone project's software PDI/TPI mode more robust by keeping track...
[pub/USBasp.git] / Demos / Host / Incomplete / BluetoothHost / Lib / ServiceDiscoveryProtocol.c
diff --git a/Demos/Host/Incomplete/BluetoothHost/Lib/ServiceDiscoveryProtocol.c b/Demos/Host/Incomplete/BluetoothHost/Lib/ServiceDiscoveryProtocol.c
index 1ee4c84..6dd3796 100644 (file)
--- a/Demos/Host/Incomplete/BluetoothHost/Lib/ServiceDiscoveryProtocol.c
+++ b/Demos/Host/Incomplete/BluetoothHost/Lib/ServiceDiscoveryProtocol.c
@@ -28,14 +28,168 @@
   this software.\r
 */\r
 \r
   this software.\r
 */\r
 \r
+#define  INCLUDE_FROM_SERVICEDISCOVERYPROTOCOL_C\r
 #include "ServiceDiscoveryProtocol.h"\r
 \r
 #include "ServiceDiscoveryProtocol.h"\r
 \r
-void ServiceDiscovery_ProcessPacket(void* Data, uint16_t Length, Bluetooth_Channel_t* Channel)\r
+SERVICE_ATTRIBUTE_TEXT(SDP_Attribute_Name,             "SDP");\r
+SERVICE_ATTRIBUTE_TEXT(SDP_Attribute_Description,      "BT Service Discovery");\r
+SERVICE_ATTRIBUTE_8BIT_LEN(SDP_Attribute_Availability, SDP_DATATYPE_UNSIGNED_INT, 1, {0xFF});\r
+const ServiceAttributeTable_t SDP_Attribute_Table[] PROGMEM =\r
+       {\r
+               {.AttributeID = SDP_ATTRIBUTE_NAME        , .AttributeData = &SDP_Attribute_Name},\r
+               {.AttributeID = SDP_ATTRIBUTE_DESCRIPTION , .AttributeData = &SDP_Attribute_Description},\r
+               {.AttributeID = SDP_ATTRIBUTE_AVAILABILITY, .AttributeData = &SDP_Attribute_Availability},\r
+               SERVICE_ATTRIBUTE_TABLE_TERMINATOR\r
+       };\r
+\r
+SERVICE_ATTRIBUTE_TEXT(RFCOMM_Attribute_Name,             "RFCOMM");\r
+SERVICE_ATTRIBUTE_TEXT(RFCOMM_Attribute_Description,      "Virtual Serial");\r
+SERVICE_ATTRIBUTE_8BIT_LEN(RFCOMM_Attribute_Availability, SDP_DATATYPE_UNSIGNED_INT, 1, {0xFF});\r
+const ServiceAttributeTable_t RFCOMM_Attribute_Table[] PROGMEM =\r
+       {\r
+               {.AttributeID = SDP_ATTRIBUTE_NAME        , .AttributeData = &RFCOMM_Attribute_Name},\r
+               {.AttributeID = SDP_ATTRIBUTE_DESCRIPTION , .AttributeData = &RFCOMM_Attribute_Description},\r
+               {.AttributeID = SDP_ATTRIBUTE_AVAILABILITY, .AttributeData = &RFCOMM_Attribute_Availability},\r
+               SERVICE_ATTRIBUTE_TABLE_TERMINATOR\r
+       };\r
+       \r
+const ServiceTable_t SDP_Services_Table[] =\r
+       {\r
+               {   // 128-bit UUID for the SDP service\r
+                       .UUID  = {BASE_96BIT_UUID, 0x01, 0x00, 0x00, 0x00},\r
+                       .AttributeTable = &SDP_Attribute_Table,\r
+               },\r
+               {   // 128-bit UUID for the RFCOMM service\r
+                       .UUID  = {BASE_96BIT_UUID, 0x03, 0x00, 0x00, 0x00},\r
+                       .AttributeTable = &RFCOMM_Attribute_Table,\r
+               },\r
+       };\r
+\r
+\r
+void ServiceDiscovery_ProcessPacket(void* Data, Bluetooth_Channel_t* Channel)\r
 {\r
        SDP_PDUHeader_t* SDPHeader = (SDP_PDUHeader_t*)Data;\r
        SDPHeader->ParameterLength = SwapEndian_16(SDPHeader->ParameterLength);\r
 \r
 {\r
        SDP_PDUHeader_t* SDPHeader = (SDP_PDUHeader_t*)Data;\r
        SDPHeader->ParameterLength = SwapEndian_16(SDPHeader->ParameterLength);\r
 \r
-       BT_SDP_DEBUG(1, "<< Service Discovery Packet", NULL);\r
+       BT_SDP_DEBUG(1, "SDP Packet Received");\r
        BT_SDP_DEBUG(2, "-- PDU ID: 0x%02X", SDPHeader->PDU);\r
        BT_SDP_DEBUG(2, "-- Param Length: 0x%04X", SDPHeader->ParameterLength);\r
        BT_SDP_DEBUG(2, "-- PDU ID: 0x%02X", SDPHeader->PDU);\r
        BT_SDP_DEBUG(2, "-- Param Length: 0x%04X", SDPHeader->ParameterLength);\r
+\r
+       switch (SDPHeader->PDU)\r
+       {\r
+               case SDP_PDU_SERVICESEARCHREQUEST:\r
+                       ServiceDiscovery_ProcessServiceSearch(SDPHeader);\r
+                       break;          \r
+               case SDP_PDU_SERVICEATTRIBUTEREQUEST:\r
+                       ServiceDiscovery_ProcessServiceAttribute(SDPHeader);\r
+                       break;\r
+               case SDP_PDU_SERVICESEARCHATTRIBUTEREQUEST:\r
+                       ServiceDiscovery_ProcessServiceSearchAttribute(SDPHeader);\r
+                       break;\r
+       }\r
+}\r
+\r
+static void ServiceDiscovery_ProcessServiceSearch(SDP_PDUHeader_t* SDPHeader)\r
+{\r
+       BT_SDP_DEBUG(1, "<< Service Search");\r
+}\r
+\r
+static void ServiceDiscovery_ProcessServiceAttribute(SDP_PDUHeader_t* SDPHeader)\r
+{\r
+       BT_SDP_DEBUG(1, "<< Service Attribute");\r
+}\r
+\r
+static void ServiceDiscovery_ProcessServiceSearchAttribute(SDP_PDUHeader_t* SDPHeader)\r
+{\r
+       void* CurrentParameter = ((void*)SDPHeader + sizeof(SDP_PDUHeader_t));\r
+       \r
+       BT_SDP_DEBUG(1, "<< Service Search Attribute");\r
+       \r
+       uint8_t ElementHeaderSize;\r
+\r
+       uint16_t ServicePatternLength = ServiceDiscovery_GetDataElementSize(&CurrentParameter, &ElementHeaderSize);\r
+       BT_SDP_DEBUG(2, "-- Total UUID Length: 0x%04X", ServicePatternLength);\r
+       while (ServicePatternLength)\r
+       {\r
+               uint8_t UUIDLength = ServiceDiscovery_GetDataElementSize(&CurrentParameter, &ElementHeaderSize);\r
+               uint8_t UUID[16] = {BASE_96BIT_UUID, 0x00, 0x00, 0x00, 0x00};\r
+\r
+               if (UUIDLength <= 32)\r
+                 memcpy(&UUID[sizeof(UUID) - sizeof(uint32_t)], CurrentParameter, UUIDLength);\r
+               else\r
+                 memcpy(UUID, CurrentParameter, UUIDLength);\r
+               \r
+               CurrentParameter += UUIDLength;\r
+               \r
+               BT_SDP_DEBUG(2, "-- UUID (%d): 0x%02X%02X%02X%02X-%02X%02X-%02X%02X-%02X%02X-%02X%02X%02X%02X%02X%02X",\r
+                                               UUIDLength,\r
+                               UUID[15], UUID[14], UUID[13], UUID[12], UUID[11], UUID[10], UUID[9], UUID[8],\r
+                                               UUID[7],  UUID[6],  UUID[5],  UUID[4],  UUID[3],  UUID[2],  UUID[1], UUID[0]);\r
+       \r
+               ServicePatternLength -= (UUIDLength + ElementHeaderSize);\r
+       }\r
+       \r
+       uint16_t MaxAttributeSize = ServiceDiscovery_Read16BitParameter(&CurrentParameter);\r
+       BT_SDP_DEBUG(2, "-- Max Return Attribute Bytes: 0x%04X", MaxAttributeSize);\r
+\r
+       uint16_t AttributeIDListLength = ServiceDiscovery_GetDataElementSize(&CurrentParameter, &ElementHeaderSize);\r
+       BT_SDP_DEBUG(2, "-- Total Attribute Length: 0x%04X", AttributeIDListLength);\r
+       while (AttributeIDListLength)\r
+       {\r
+               uint8_t  AttributeLength = ServiceDiscovery_GetDataElementSize(&CurrentParameter, &ElementHeaderSize);\r
+               uint32_t Attribute = 0;\r
+               \r
+               memcpy(&Attribute, CurrentParameter, AttributeLength);\r
+               CurrentParameter += AttributeLength;\r
+               \r
+               BT_SDP_DEBUG(2, "-- Attribute(%d): 0x%08lX", AttributeLength, Attribute);\r
+       \r
+               AttributeIDListLength -= (AttributeLength + ElementHeaderSize);\r
+       }\r
+}\r
+\r
+static uint32_t ServiceDiscovery_GetDataElementSize(void** DataElementHeader, uint8_t* ElementHeaderSize)\r
+{\r
+       uint8_t SizeIndex = (*((uint8_t*)*DataElementHeader) & 0x07);\r
+       *DataElementHeader += sizeof(uint8_t);\r
+       \r
+       *ElementHeaderSize = 1;\r
+       \r
+       uint32_t ElementValue;\r
+       \r
+       switch (SizeIndex)\r
+       {\r
+               case 0:\r
+                       ElementValue = 1;\r
+                       break;\r
+               case 1:\r
+                       ElementValue = 2;\r
+                       break;\r
+               case 2:\r
+                       ElementValue = 4;\r
+                       break;\r
+               case 3:\r
+                       ElementValue = 8;\r
+                       break;\r
+               case 4:\r
+                       ElementValue = 16;\r
+                       break;\r
+               case 5:\r
+                       ElementValue = *((uint8_t*)*DataElementHeader);\r
+                       *DataElementHeader += sizeof(uint8_t);\r
+                       *ElementHeaderSize  = (1 + sizeof(uint8_t));\r
+                       break;\r
+               case 6:\r
+                       ElementValue = *((uint16_t*)*DataElementHeader);\r
+                       *DataElementHeader += sizeof(uint16_t);\r
+                       *ElementHeaderSize  = (1 + sizeof(uint16_t));\r
+                       break;\r
+               default:\r
+                       ElementValue = *((uint32_t*)*DataElementHeader);\r
+                       *DataElementHeader += sizeof(uint32_t);\r
+                       *ElementHeaderSize  = (1 + sizeof(uint32_t));\r
+                       break;\r
+       }\r
+       \r
+       return ElementValue;\r
 }\r
 }\r
USB isp AVR programmer