Bluetooth: Add support to enable/disable IPSP 11/90611/1
authorSudha Bheemanna <b.sudha@samsung.com>
Mon, 3 Oct 2016 06:06:17 +0000 (11:36 +0530)
committerSudha Bheemanna <b.sudha@samsung.com>
Mon, 3 Oct 2016 06:06:17 +0000 (11:36 +0530)
This patch supports MGMT commands and code to enable or disable
IPSP 6LowPan features.

Change-Id: I4fa404d01493562251b821a68a400a5e05d48078
Signed-off-by: Sudha Bheemanna <b.sudha@samsung.com>
include/net/bluetooth/l2cap.h
include/net/bluetooth/mgmt_tizen.h
net/bluetooth/6lowpan.c
net/bluetooth/mgmt.c

index d032509..7663026 100644 (file)
@@ -973,5 +973,14 @@ void l2cap_unregister_user(struct l2cap_conn *conn, struct l2cap_user *user);
 #ifdef CONFIG_TIZEN_WIP
 int l2cap_update_connection_param(struct l2cap_conn *conn, u16 min, u16 max,
                                  u16 latency, u16 to_multiplier);
+#ifdef CONFIG_BT_6LOWPAN
+/* IPSP : initialize/deinitialize 6lowpan */
+void bt_6lowpan_enable(void);
+void bt_6lowpan_disable(void);
+#else
+static inline void bt_6lowpan_enable(void) { }
+static inline void bt_6lowpan_disable(void) { }
 #endif
+#endif
+
 #endif /* __L2CAP_H */
index 54e753b..809d416 100644 (file)
@@ -165,6 +165,11 @@ struct mgmt_rp_get_adv_tx_power {
        __s8 adv_tx_power;
 } __packed;
 
+#define MGMT_OP_ENABLE_6LOWPAN                 (TIZEN_OP_CODE_BASE + 0x12)
+struct mgmt_cp_enable_6lowpan {
+       __u8    enable_6lowpan;
+} __packed;
+#define MGMT_ENABLE_BT_6LOWPAN_SIZE            1
 
 /* BEGIN TIZEN_Bluetooth :: name update changes */
 #define MGMT_EV_DEVICE_NAME_UPDATE             (TIZEN_EV_BASE + 0x01)
index 4a9f37b..b52b0f3 100644 (file)
@@ -1448,6 +1448,40 @@ static int __init bt_6lowpan_init(void)
        return register_netdevice_notifier(&bt_6lowpan_dev_notifier);
 }
 
+#ifdef CONFIG_TIZEN_WIP
+void bt_6lowpan_enable(void)
+{
+       if (!enable_6lowpan) {
+               disconnect_all_peers();
+
+               enable_6lowpan = true;
+
+               if (listen_chan) {
+                       l2cap_chan_close(listen_chan, 0);
+                       l2cap_chan_put(listen_chan);
+               }
+
+               listen_chan = bt_6lowpan_listen();
+
+               register_netdevice_notifier(&bt_6lowpan_dev_notifier);
+       }
+}
+
+void bt_6lowpan_disable(void)
+{
+       if (enable_6lowpan) {
+               if (listen_chan) {
+                       l2cap_chan_close(listen_chan, 0);
+                       l2cap_chan_put(listen_chan);
+                       listen_chan = NULL;
+               }
+               disconnect_devices();
+               unregister_netdevice_notifier(&bt_6lowpan_dev_notifier);
+               enable_6lowpan = false;
+       }
+}
+#endif
+
 static void __exit bt_6lowpan_exit(void)
 {
        debugfs_remove(lowpan_enable_debugfs);
index fa22e9b..6de7555 100644 (file)
@@ -6805,6 +6805,41 @@ void mgmt_multi_adv_state_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
        mgmt_event(MGMT_EV_MULTI_ADV_STATE_CHANGED, hdev, &mgmt_ev,
                        sizeof(struct mgmt_ev_vendor_specific_multi_adv_state_changed), NULL);
 }
+
+static int enable_bt_6lowpan(struct sock *sk, struct hci_dev *hdev,
+               void *data, u16 len)
+{
+       int err;
+       struct mgmt_cp_enable_6lowpan *cp = data;
+
+       BT_DBG("%s", hdev->name);
+
+       hci_dev_lock(hdev);
+
+       if (!hdev_is_powered(hdev)) {
+               err = cmd_status(sk, hdev->id, MGMT_OP_ENABLE_6LOWPAN,
+                                     MGMT_STATUS_NOT_POWERED);
+               goto unlocked;
+       }
+
+       if (!lmp_le_capable(hdev)) {
+               err = cmd_status(sk, hdev->id, MGMT_OP_ENABLE_6LOWPAN,
+                                     MGMT_STATUS_NOT_SUPPORTED);
+               goto unlocked;
+       }
+
+       if (cp->enable_6lowpan)
+               bt_6lowpan_enable();
+       else
+               bt_6lowpan_disable();
+
+       err = cmd_complete(sk, hdev->id, MGMT_OP_ENABLE_6LOWPAN,
+                               MGMT_STATUS_SUCCESS, NULL, 0);
+unlocked:
+       hci_dev_unlock(hdev);
+       return err;
+}
+
 /* END TIZEN_Bluetooth */
 #endif
 
@@ -7906,7 +7941,8 @@ static const struct mgmt_handler tizen_mgmt_handlers[] = {
        { set_manufacturer_data,   false, MGMT_SET_MANUFACTURER_DATA_SIZE},
        { le_set_scan_params,      false, MGMT_LE_SET_SCAN_PARAMS_SIZE },
        { set_voice_setting,       false, MGMT_SET_VOICE_SETTING_SIZE},
-       { get_adv_tx_power,       false, MGMT_GET_ADV_TX_POWER_SIZE}
+       { get_adv_tx_power,       false, MGMT_GET_ADV_TX_POWER_SIZE},
+       { enable_bt_6lowpan,       false, MGMT_ENABLE_BT_6LOWPAN_SIZE },
 };
 #endif