From 5f49b321cb71170225e28633c30f065997bd8e2e Mon Sep 17 00:00:00 2001
From: Kristian Lauszus <lauszus@gmail.com>
Date: Mon, 25 Nov 2013 02:58:33 +0100
Subject: [PATCH] Print data receiving on the L2CAP control channel for
 debugging

---
 BTHID.cpp | 14 ++++++++++----
 1 file changed, 10 insertions(+), 4 deletions(-)

diff --git a/BTHID.cpp b/BTHID.cpp
index 7820d2d5..5cd8701d 100644
--- a/BTHID.cpp
+++ b/BTHID.cpp
@@ -182,9 +182,8 @@ void BTHID::ACLData(uint8_t* l2capinbuf) {
                         }
 #endif
                 } else if (l2capinbuf[6] == interrupt_dcid[0] && l2capinbuf[7] == interrupt_dcid[1]) { // l2cap_interrupt
-                        //Notify(PSTR("\r\n\r\nL2CAP Interrupt: "), 0x80);
 #ifdef PRINTREPORT
-                        Notify(PSTR("\r\n"), 0x80);
+                        Notify(PSTR("\r\nL2CAP Interrupt: "), 0x80);
                         for (uint16_t i = 0; i  < ((uint16_t)l2capinbuf[5] << 8 | l2capinbuf[4]); i++) {
                                 D_PrintHex<uint8_t > (l2capinbuf[i + 8], 0x80);
                                 Notifyc(' ', 0x80);
@@ -200,14 +199,13 @@ void BTHID::ACLData(uint8_t* l2capinbuf) {
                                                 break;
 
                                         case 0x02: // Mouse events
-                                        case 0x1A:
                                                 if (pRptParser[MOUSE_PARSER_ID]) {
                                                         uint16_t length =  ((uint16_t)l2capinbuf[5] << 8 | l2capinbuf[4]);
                                                         pRptParser[MOUSE_PARSER_ID]->Parse((HID*)this, 0, (uint8_t) length, &l2capinbuf[10]);
                                                 }
                                                 break;
                                         case 0x03:
-#ifdef EXTRADEBUG
+#ifdef DEBUG_USB_HOST
                                                 Notify(PSTR("\r\nChange mode event: "), 0x80);
                                                 D_PrintHex<uint8_t > (l2capinbuf[11], 0x80);
 #endif
@@ -220,6 +218,14 @@ void BTHID::ACLData(uint8_t* l2capinbuf) {
 #endif
                                 }
                         }
+                } else if (l2capinbuf[6] == control_dcid[0] && l2capinbuf[7] == control_dcid[1]) { // l2cap_control
+#ifdef PRINTREPORT
+                        Notify(PSTR("\r\nL2CAP Control: "), 0x80);
+                        for (uint16_t i = 0; i  < ((uint16_t)l2capinbuf[5] << 8 | l2capinbuf[4]); i++) {
+                                D_PrintHex<uint8_t > (l2capinbuf[i + 8], 0x80);
+                                Notifyc(' ', 0x80);
+                        }
+#endif
                 }
 #ifdef EXTRADEBUG
                 else {