From 847a1f6628e2f2f76a529ff7d860ae689138157f Mon Sep 17 00:00:00 2001
From: Arkadiusz Lichwa <arkadiusz.lichwa@tieto.com>
Date: Fri, 29 Jan 2016 13:29:54 +0100
Subject: [PATCH] Bluetooth: BR/EDR: Add initial SSP Complete

Adds HCI protocol type for Secure Simple Pair Complete event and enables the
event in controller.
Then implements the initial SSP Complete event handler with catching
the status of SSP process.

Change-Id: Ic7cc5b4cab8a1b4120285815c24eeb6483d748df
Signed-off-by: Arkadiusz Lichwa <arkadiusz.lichwa@tieto.com>
---
 include/bluetooth/hci.h  |  6 ++++++
 net/bluetooth/hci_core.c | 24 ++++++++++++++++++++++++
 2 files changed, 30 insertions(+)

diff --git a/include/bluetooth/hci.h b/include/bluetooth/hci.h
index 31680773b08..46af054b107 100644
--- a/include/bluetooth/hci.h
+++ b/include/bluetooth/hci.h
@@ -583,6 +583,12 @@ struct bt_hci_evt_io_capa_resp {
 	uint8_t   authentication;
 } __packed;
 
+#define BT_HCI_EVT_SSP_COMPLETE			0x36
+struct bt_hci_evt_ssp_complete {
+	uint8_t   status;
+	bt_addr_t bdaddr;
+} __packed;
+
 #define BT_HCI_EVT_LE_META_EVENT		0x3e
 struct bt_hci_evt_le_meta_event {
 	uint8_t  subevent;
diff --git a/net/bluetooth/hci_core.c b/net/bluetooth/hci_core.c
index c12cb7031a6..94f35e06ebd 100644
--- a/net/bluetooth/hci_core.c
+++ b/net/bluetooth/hci_core.c
@@ -1153,6 +1153,26 @@ static void io_capa_req(struct net_buf *buf)
 	cp->reason = BT_HCI_ERR_PAIRING_NOT_ALLOWED;
 	bt_hci_cmd_send_sync(BT_HCI_OP_IO_CAPABILITY_NEG_REPLY, resp_buf, NULL);
 }
+
+static void ssp_complete(struct net_buf *buf)
+{
+	struct bt_hci_evt_ssp_complete *evt = (void *)buf->data;
+	struct bt_conn *conn;
+
+	BT_DBG("status %u", evt->status);
+
+	conn = bt_conn_lookup_addr_br(&evt->bdaddr);
+	if (!conn) {
+		BT_ERR("Can't find conn for %s", bt_addr_str(&evt->bdaddr));
+		return;
+	}
+
+	if (evt->status) {
+		bt_conn_disconnect(conn, BT_HCI_ERR_AUTHENTICATION_FAIL);
+	}
+
+	bt_conn_unref(conn);
+}
 #endif
 
 #if defined(CONFIG_BLUETOOTH_SMP) || defined(CONFIG_BLUETOOTH_BREDR)
@@ -1839,6 +1859,9 @@ static void hci_event(struct net_buf *buf)
 	case BT_HCI_EVT_IO_CAPA_REQ:
 		io_capa_req(buf);
 		break;
+	case BT_HCI_EVT_SSP_COMPLETE:
+		ssp_complete(buf);
+		break;
 #endif
 #if defined(CONFIG_BLUETOOTH_CONN)
 	case BT_HCI_EVT_DISCONN_COMPLETE:
@@ -2300,6 +2323,7 @@ static int set_event_mask(void)
 	ev->events[2] |= 0x80; /* Link Key Notif */
 	ev->events[6] |= 0x01; /* IO Capability Request */
 	ev->events[6] |= 0x02; /* IO Capability Response */
+	ev->events[6] |= 0x20; /* Simple Pairing Complete */
 #endif
 	ev->events[1] |= 0x20; /* Command Complete */
 	ev->events[1] |= 0x40; /* Command Status */