Bluetooth: Send LE Connection Update Command
authorClaudio Takahasi <claudio.takahasi@openbossa.org>
Wed, 16 Feb 2011 22:44:53 +0000 (20:44 -0200)
committerGustavo F. Padovan <padovan@profusion.mobi>
Wed, 16 Feb 2011 23:13:21 +0000 (20:13 -0300)
If the new connection update parameter are accepted, the LE master
host sends the LE Connection Update Command to its controller informing
the new requested parameters.

Signed-off-by: Claudio Takahasi <claudio.takahasi@openbossa.org>
Signed-off-by: Gustavo F. Padovan <padovan@profusion.mobi>
include/net/bluetooth/hci.h
include/net/bluetooth/hci_core.h
net/bluetooth/hci_conn.c
net/bluetooth/l2cap_core.c

index 6d4e11624fef5d9e8e6dfe9672a9d74b7236e728..a5f8c4684a3279b70d75449a92b5110393e5a2b3 100644 (file)
@@ -677,6 +677,17 @@ struct hci_cp_le_create_conn {
 
 #define HCI_OP_LE_CREATE_CONN_CANCEL   0x200e
 
+#define HCI_OP_LE_CONN_UPDATE          0x2013
+struct hci_cp_le_conn_update {
+       __le16   handle;
+       __le16   conn_interval_min;
+       __le16   conn_interval_max;
+       __le16   conn_latency;
+       __le16   supervision_timeout;
+       __le16   min_ce_len;
+       __le16   max_ce_len;
+} __packed;
+
 /* ---- HCI Events ---- */
 #define HCI_EV_INQUIRY_COMPLETE                0x01
 
index ecd2acf2442043afbe284a64b7455fe959103f59..7ee921d78a9442098da85102d6e7def16a7a75ea 100644 (file)
@@ -777,4 +777,6 @@ struct hci_sec_filter {
 
 void hci_req_complete(struct hci_dev *hdev, __u16 cmd, int result);
 
+void hci_le_conn_update(struct hci_conn *conn, u16 min, u16 max,
+                                       u16 latency, u16 to_multiplier);
 #endif /* __HCI_CORE_H */
index efcd2b508f5d996764b87e81cb7c133b1364171b..a050a69849012d9870bdb71cb9b120df11b18f3b 100644 (file)
@@ -183,6 +183,26 @@ void hci_setup_sync(struct hci_conn *conn, __u16 handle)
        hci_send_cmd(hdev, HCI_OP_SETUP_SYNC_CONN, sizeof(cp), &cp);
 }
 
+void hci_le_conn_update(struct hci_conn *conn, u16 min, u16 max,
+                                       u16 latency, u16 to_multiplier)
+{
+       struct hci_cp_le_conn_update cp;
+       struct hci_dev *hdev = conn->hdev;
+
+       memset(&cp, 0, sizeof(cp));
+
+       cp.handle               = cpu_to_le16(conn->handle);
+       cp.conn_interval_min    = cpu_to_le16(min);
+       cp.conn_interval_max    = cpu_to_le16(max);
+       cp.conn_latency         = cpu_to_le16(latency);
+       cp.supervision_timeout  = cpu_to_le16(to_multiplier);
+       cp.min_ce_len           = cpu_to_le16(0x0001);
+       cp.max_ce_len           = cpu_to_le16(0x0001);
+
+       hci_send_cmd(hdev, HCI_OP_LE_CONN_UPDATE, sizeof(cp), &cp);
+}
+EXPORT_SYMBOL(hci_le_conn_update);
+
 /* Device _must_ be locked */
 void hci_sco_setup(struct hci_conn *conn, __u8 status)
 {
index e0e7b82cff023595c0cc4fa70cadd17c46354987..bd313671036039793d1564b73f993390abecbe94 100644 (file)
@@ -2529,6 +2529,7 @@ static inline int l2cap_conn_param_update_req(struct l2cap_conn *conn,
        struct l2cap_conn_param_update_req *req;
        struct l2cap_conn_param_update_rsp rsp;
        u16 min, max, latency, to_multiplier, cmd_len;
+       int err;
 
        if (!(hcon->link_mode & HCI_LM_MASTER))
                return -EINVAL;
@@ -2547,7 +2548,9 @@ static inline int l2cap_conn_param_update_req(struct l2cap_conn *conn,
                                                min, max, latency, to_multiplier);
 
        memset(&rsp, 0, sizeof(rsp));
-       if (l2cap_check_conn_param(min, max, latency, to_multiplier))
+
+       err = l2cap_check_conn_param(min, max, latency, to_multiplier);
+       if (err)
                rsp.result = cpu_to_le16(L2CAP_CONN_PARAM_REJECTED);
        else
                rsp.result = cpu_to_le16(L2CAP_CONN_PARAM_ACCEPTED);
@@ -2555,6 +2558,9 @@ static inline int l2cap_conn_param_update_req(struct l2cap_conn *conn,
        l2cap_send_cmd(conn, cmd->ident, L2CAP_CONN_PARAM_UPDATE_RSP,
                                                        sizeof(rsp), &rsp);
 
+       if (!err)
+               hci_le_conn_update(hcon, min, max, latency, to_multiplier);
+
        return 0;
 }