monitor/ll: Add support for connection parameter command.

LL_CONNECTION_PARAM_REQ (0x0f)
  Interval min: 7.50 msec (0x0006)
  Interval max: 7.50 msec (0x0006)
  Latency: 0 (0x0000)
  Timeout: 5000 msec (0x01f4)
  Preffered periodicity: 0.00 (0x00)
  Reference connection event count: 4 (0x04)
  Offset 0: 0.00 msec (0x00)
  Offset 1: 0.00 msec (0x00)
  Offset 2: 1.25 msec (0x01)
  Offset 3: 0.00 msec (0x00)
  Offset 4: 2.50 msec (0x02)
  Offset 5: 0.00 msec (0x00)

LL_CONNECTION_PARAM_RSP (0x10)
  Interval min: 7.50 msec (0x0006)
  Interval max: 7.50 msec (0x0006)
  Latency: 0 (0x0000)
  Timeout: 5000 msec (0x01f4)
  Preffered periodicity: 0.00 (0x00)
  Reference connection event count: 4 (0x04)
  Offset 0: 318.75 msec (0xff)
  Offset 1: 318.75 msec (0xff)
  Offset 2: 318.75 msec (0xff)
  Offset 3: 318.75 msec (0xff)
  Offset 4: 318.75 msec (0xff)
  Offset 5: 318.75 msec (0xff)

diff --git a/monitor/bt.h b/monitor/bt.h
index 9c5dfd4..78be053 100755 (executable)
--- a/monitor/bt.h
+++ b/monitor/bt.h
@@ -95,8 +95,36 @@ struct bt_ll_peripheral_feature_req {
 } __attribute__ ((packed));
 
 #define BT_LL_CONN_PARAM_REQ   0x0f
+struct bt_ll_conn_param_req {
+       uint16_t interval_min;
+       uint16_t interval_max;
+       uint16_t latency;
+       uint16_t timeout;
+       uint8_t pref_period;
+       uint16_t pref_conn_evt_count;
+       uint8_t offset_0;
+       uint8_t offset_1;
+       uint8_t offset_2;
+       uint8_t offset_3;
+       uint8_t offset_4;
+       uint8_t offset_5;
+} __attribute__ ((packed));
 
 #define BT_LL_CONN_PARAM_RSP   0x10
+struct bt_ll_conn_param_rsp {
+       uint16_t interval_min;
+       uint16_t interval_max;
+       uint16_t latency;
+       uint16_t timeout;
+       uint8_t pref_period;
+       uint16_t pref_conn_evt_count;
+       uint8_t offset_0;
+       uint8_t offset_1;
+       uint8_t offset_2;
+       uint8_t offset_3;
+       uint8_t offset_4;
+       uint8_t offset_5;
+} __attribute__ ((packed));
 
 #define BT_LL_REJECT_IND_EXT   0x11
 struct bt_ll_reject_ind_ext {

diff --git a/monitor/ll.c b/monitor/ll.c
index 8ee253c..a228307 100755 (executable)
--- a/monitor/ll.c
+++ b/monitor/ll.c
@@ -457,6 +457,64 @@ static void peripheral_feature_req(const void *data, uint8_t size)
        packet_print_features_ll(pdu->features);
 }
 
+static void conn_param_req(const void *data, uint8_t size)
+{
+       const struct bt_ll_conn_param_req *pdu = data;
+
+       print_field("Interval min: %.2f msec (0x%4.4x)",
+                               pdu->interval_min * 1.25, pdu->interval_min);
+       print_field("Interval max: %.2f msec (0x%4.4x)",
+                               pdu->interval_max * 1.25, pdu->interval_max);
+       print_field("Latency: %d (0x%4.4x)", pdu->latency, pdu->latency);
+       print_field("Timeout: %d msec (0x%4.4x)", pdu->timeout * 10,
+                                                               pdu->timeout);
+       print_field("Preffered periodicity: %.2f (0x%2.2x)",
+                               pdu->pref_period * 1.25, pdu->pref_period);
+       print_field("Reference connection event count: %d (0x%2.2x)",
+                       pdu->pref_conn_evt_count, pdu->pref_conn_evt_count);
+       print_field("Offset 0: %.2f msec (0x%2.2x)", pdu->offset_0 * 1.25,
+                                                               pdu->offset_0);
+       print_field("Offset 1: %.2f msec (0x%2.2x)", pdu->offset_1 * 1.25,
+                                                               pdu->offset_1);
+       print_field("Offset 2: %.2f msec (0x%2.2x)", pdu->offset_2 * 1.25,
+                                                               pdu->offset_2);
+       print_field("Offset 3: %.2f msec (0x%2.2x)", pdu->offset_3 * 1.25,
+                                                               pdu->offset_3);
+       print_field("Offset 4: %.2f msec (0x%2.2x)", pdu->offset_4 * 1.25,
+                                                               pdu->offset_4);
+       print_field("Offset 5: %.2f msec (0x%2.2x)", pdu->offset_5 * 1.25,
+                                                               pdu->offset_5);
+}
+
+static void conn_param_rsp(const void *data, uint8_t size)
+{
+       const struct bt_ll_conn_param_rsp *pdu = data;
+
+       print_field("Interval min: %.2f msec (0x%4.4x)",
+                               pdu->interval_min * 1.25, pdu->interval_min);
+       print_field("Interval max: %.2f msec (0x%4.4x)",
+                               pdu->interval_max * 1.25, pdu->interval_max);
+       print_field("Latency: %d (0x%4.4x)", pdu->latency, pdu->latency);
+       print_field("Timeout: %d msec (0x%4.4x)", pdu->timeout * 10,
+                                                               pdu->timeout);
+       print_field("Preffered periodicity: %.2f (0x%2.2x)",
+                               pdu->pref_period * 1.25, pdu->pref_period);
+       print_field("Reference connection event count: %d (0x%2.2x)",
+                       pdu->pref_conn_evt_count, pdu->pref_conn_evt_count);
+       print_field("Offset 0: %.2f msec (0x%2.2x)", pdu->offset_0 * 1.25,
+                                                               pdu->offset_0);
+       print_field("Offset 1: %.2f msec (0x%2.2x)", pdu->offset_1 * 1.25,
+                                                               pdu->offset_1);
+       print_field("Offset 2: %.2f msec (0x%2.2x)", pdu->offset_2 * 1.25,
+                                                               pdu->offset_2);
+       print_field("Offset 3: %.2f msec (0x%2.2x)", pdu->offset_3 * 1.25,
+                                                               pdu->offset_3);
+       print_field("Offset 4: %.2f msec (0x%2.2x)", pdu->offset_4 * 1.25,
+                                                               pdu->offset_4);
+       print_field("Offset 5: %.2f msec (0x%2.2x)", pdu->offset_5 * 1.25,
+                                                               pdu->offset_5);
+}
+
 static void reject_ind_ext(const void *data, uint8_t size)
 {
        const struct bt_ll_reject_ind_ext *pdu = data;
@@ -706,8 +764,8 @@ static const struct llcp_data llcp_table[] = {
        { 0x0c, "LL_VERSION_IND",           version_ind,        5, true },
        { 0x0d, "LL_REJECT_IND",            reject_ind,         1, true },
        { 0x0e, "LL_PERIPHERAL_FEATURE_REQ", peripheral_feature_req, 8, true },
-       { 0x0f, "LL_CONNECTION_PARAM_REQ",  NULL,              23, true },
-       { 0x10, "LL_CONNECTION_PARAM_RSP",  NULL,              23, true },
+       { 0x0f, "LL_CONNECTION_PARAM_REQ",  conn_param_req,    23, true },
+       { 0x10, "LL_CONNECTION_PARAM_RSP",  conn_param_rsp,    23, true },
        { 0x11, "LL_REJECT_IND_EXT",        reject_ind_ext,     2, true },
        { 0x12, "LL_PING_REQ",              null_pdu,           0, true },
        { 0x13, "LL_PING_RSP",              null_pdu,           0, true },