- uint8_t DataPayload[*PacketLength];\r
-\r
- Pipe_Read_Stream_LE(&DataPayload, *PacketLength);\r
- *PacketLength = 0;\r
-\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 < sizeof(DataPayload); Byte++)\r
- printf_P(PSTR("0x%02X "), DataPayload[Byte]);\r
- puts_P(PSTR("\r\n"));\r
+ switch (Channel->PSM)\r
+ {\r
+ case CHANNEL_PSM_SDP:\r
+ /* Service Discovery Protocol packet */\r
+ ServiceDiscovery_ProcessPacket(Data, DataLen, 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