From b903344d92e57dba63654e347d200d27f4566837 Mon Sep 17 00:00:00 2001
From: Lukasz Rymanowski <lukasz.rymanowski@tieto.com>
Date: Fri, 4 Mar 2011 19:41:55 +0100
Subject: [PATCH] pand: Fix for TP_BNEP_CTRL_BV_01_C qualification test

With this fix pand will correctly respond on unknown BNEP control
command.
---
 compat/bnep.c | 16 ++++++++++++++++
 1 file changed, 16 insertions(+)

diff --git a/compat/bnep.c b/compat/bnep.c
index 24bf7e343..281350baf 100644
--- a/compat/bnep.c
+++ b/compat/bnep.c
@@ -231,6 +231,22 @@ int bnep_accept_connection(int sk, uint16_t role, char *dev)
 		return -1;
 
 	req = (void *) pkt;
+
+	/* Highest known Control command ID
+	 * is BNEP_FILTER_MULT_ADDR_RSP = 0x06 */
+	if (req->type == BNEP_CONTROL &&
+				req->ctrl > BNEP_FILTER_MULT_ADDR_RSP) {
+		uint8_t pkt[3];
+
+		pkt[0] = BNEP_CONTROL;
+		pkt[1] = BNEP_CMD_NOT_UNDERSTOOD;
+		pkt[2] = req->ctrl;
+
+		send(sk, pkt, sizeof(pkt), 0);
+
+		return -1;
+	}
+
 	if (req->type != BNEP_CONTROL || req->ctrl != BNEP_SETUP_CONN_REQ)
 		return -1;
 
-- 
2.47.3