- uint8_t DataPayload[*PacketLength];\r
- Pipe_Read_Stream_LE(&DataPayload, *PacketLength);\r
- *PacketLength = 0;\r
-\r
- BT_ACL_DEBUG("-- Data Payload: ", NULL);\r
- for (uint16_t B = 0; B < sizeof(DataPayload); B++)\r
- printf("0x%02X ", DataPayload[B]);\r
- printf("\r\n"); \r
+ switch (Channel->PSM)\r
+ {\r
+ case CHANNEL_PSM_SDP:\r
+ /* Service Discovery Protocol packet */\r
+ ServiceDiscovery_ProcessPacket(Data, Channel);\r
+ break;\r
+ default:\r
+ /* Unknown Protocol packet */\r
+ printf_P(PSTR("Packet Received (Channel 0x%04X, PSM: 0x%02x):\r\n"), Channel->LocalNumber, Channel->PSM);\r
+ for (uint16_t Byte = 0; Byte < DataLen; Byte++)\r
+ printf_P(PSTR("0x%02X "), ((uint8_t*)Data)[Byte]);\r
+ puts_P(PSTR("\r\n"));\r
+ \r
+ break;\r
+ }\r