From: Sudha Bheemanna <b.sudha@samsung.com>
Date: Thu, 8 Sep 2016 05:26:15 +0000 (+0530)
Subject: Bluetooth: Add LE vendor specific event handler
X-Git-Url: http://review.tizen.org/git/?a=commitdiff_plain;h=37fc1c9c79f03ae7c81ea7640d64db9895a405b8;p=platform%2Fkernel%2Flinux-starfive.git

Bluetooth: Add LE vendor specific event handler

This patch adds the vendor specific LE meta event handler.
It handles the vendor specific handles like,
LE_MULTI_ADV_STATE_CHANGE_SUB_EVENT, LE_RSSI_LINK_ALERT.

Change-Id: I1f344a31e36f9c7442fe0bd8b598e67d9f5fb9bf
Signed-off-by: Sudha Bheemanna <b.sudha@samsung.com>
[divide hci vendor speicif group event function]
Signed-off-by: Seung-Woo Kim <sw0312.kim@samsung.com>
Signed-off-by: Amit Purwar <amit.purwar@samsung.com>
---

diff --git a/include/net/bluetooth/hci.h b/include/net/bluetooth/hci.h
index 74b653ce7e8b..7c06599cb9a1 100644
--- a/include/net/bluetooth/hci.h
+++ b/include/net/bluetooth/hci.h
@@ -2320,6 +2320,25 @@ struct hci_ev_sync_train_complete {
 
 #define HCI_EV_PERIPHERAL_PAGE_RESP_TIMEOUT	0x54
 
+#ifdef TIZEN_BT
+/*
+ * Vendor Specific HCI Event
+ * Vendor: Broadcom
+ * Purpose: This HCI Event gives RSSI Alerts for monitored LE Link
+ */
+#define HCI_EV_VENDOR_SPECIFIC		0xFF
+struct hci_ev_vendor_specific {
+	__u8	event_sub_code;
+} __packed;
+
+#define LE_META_VENDOR_SPECIFIC_GROUP_EVENT 0xE9
+struct hci_ev_ext_vendor_specific {
+	__u8	event_le_ext_sub_code;
+} __packed;
+
+#define LE_RSSI_LINK_ALERT 0x02
+#endif
+
 #define HCI_EV_LE_CONN_COMPLETE		0x01
 struct hci_ev_le_conn_complete {
 	__u8     status;
diff --git a/net/bluetooth/hci_event.c b/net/bluetooth/hci_event.c
index c99b07189ed6..43b1b8ee0b01 100644
--- a/net/bluetooth/hci_event.c
+++ b/net/bluetooth/hci_event.c
@@ -1859,6 +1859,50 @@ static void hci_cc_get_raw_rssi(struct hci_dev *hdev,
 
 	mgmt_raw_rssi_response(hdev, rp, rp->status);
 }
+
+static void hci_vendor_specific_group_ext_evt(struct hci_dev *hdev,
+					      struct sk_buff *skb)
+{
+	struct hci_ev_ext_vendor_specific *ev = (void *)skb->data;
+	__u8 event_le_ext_sub_code;
+
+	BT_DBG("RSSI event LE_META_VENDOR_SPECIFIC_GROUP_EVENT: %X",
+	       LE_META_VENDOR_SPECIFIC_GROUP_EVENT);
+
+	skb_pull(skb, sizeof(*ev));
+	event_le_ext_sub_code = ev->event_le_ext_sub_code;
+
+	switch (event_le_ext_sub_code) {
+	case LE_RSSI_LINK_ALERT:
+		BT_DBG("RSSI event LE_RSSI_LINK_ALERT %X",
+		       LE_RSSI_LINK_ALERT);
+		mgmt_rssi_alert_evt(hdev, skb);
+		break;
+
+	default:
+		break;
+	}
+}
+
+static void hci_vendor_specific_evt(struct hci_dev *hdev, struct sk_buff *skb)
+{
+	struct hci_ev_vendor_specific *ev = (void *)skb->data;
+	__u8 event_sub_code;
+
+	BT_DBG("hci_vendor_specific_evt");
+
+	skb_pull(skb, sizeof(*ev));
+	event_sub_code = ev->event_sub_code;
+
+	switch (event_sub_code) {
+	case LE_META_VENDOR_SPECIFIC_GROUP_EVENT:
+		hci_vendor_specific_group_ext_evt(hdev, skb);
+		break;
+
+	default:
+		break;
+	}
+}
 #endif
 
 static void hci_cc_read_rssi(struct hci_dev *hdev, struct sk_buff *skb)
@@ -6535,9 +6579,15 @@ void hci_event_packet(struct hci_dev *hdev, struct sk_buff *skb)
 		hci_num_comp_blocks_evt(hdev, skb);
 		break;
 
+#ifdef TIZEN_BT
+	case HCI_EV_VENDOR_SPECIFIC:
+		hci_vendor_specific_evt(hdev, skb);
+		break;
+#else
 	case HCI_EV_VENDOR:
 		msft_vendor_evt(hdev, skb);
 		break;
+#endif
 
 	default:
 		BT_DBG("%s event 0x%2.2x", hdev->name, event);