OSDN Git Service

monitor: Add the missing LL opcodes for Bluetooth 4.1 and 4.2 features
authorMarcel Holtmann <marcel@holtmann.org>
Sat, 17 Oct 2015 15:37:21 +0000 (08:37 -0700)
committerMarcel Holtmann <marcel@holtmann.org>
Sat, 17 Oct 2015 15:37:21 +0000 (08:37 -0700)
monitor/bt.h
monitor/ll.c

index b869b02..1a21592 100644 (file)
@@ -99,6 +99,29 @@ struct bt_ll_reject_ind {
        uint8_t  error;
 } __attribute__ ((packed));
 
+#define BT_LL_SLAVE_FEATURE_REQ        0x0e
+struct bt_ll_slave_feature_req {
+       uint8_t  features[8];
+} __attribute__ ((packed));
+
+#define BT_LL_CONN_PARAM_REQ   0x0f
+
+#define BT_LL_CONN_PARAM_RSP   0x10
+
+#define BT_LL_REJECT_IND_EXT   0x11
+struct bt_ll_reject_ind_ext {
+       uint8_t  opcode;
+       uint8_t  error;
+} __attribute__ ((packed));
+
+#define BT_LL_PING_REQ         0x12
+
+#define BT_LL_PING_RSP         0x13
+
+#define BT_LL_LENGTH_REQ       0x14
+
+#define BT_LL_LENGTH_RSP       0x15
+
 #define LMP_ESC4(x) ((127 << 8) | (x))
 
 #define BT_LMP_NAME_REQ                        1
index 8addbc6..6212f79 100644 (file)
@@ -460,6 +460,21 @@ static void reject_ind(const void *data, uint8_t size)
        packet_print_error("Error code", pdu->error);
 }
 
+static void slave_feature_req(const void *data, uint8_t size)
+{
+       const struct bt_ll_slave_feature_req *pdu = data;
+
+       packet_print_features_ll(pdu->features);
+}
+
+static void reject_ind_ext(const void *data, uint8_t size)
+{
+       const struct bt_ll_reject_ind_ext *pdu = data;
+
+       print_field("Reject opcode: %u (0x%2.2x)", pdu->opcode, pdu->opcode);
+       packet_print_error("Error code", pdu->error);
+}
+
 struct llcp_data {
        uint8_t opcode;
        const char *str;
@@ -469,22 +484,28 @@ struct llcp_data {
 };
 
 static const struct llcp_data llcp_table[] = {
-       { 0x00, "LL_CONNECTION_UPDATE_REQ", conn_update_req, 11, true },
-       { 0x01, "LL_CHANNEL_MAP_REQ",       channel_map_req,  7, true },
-       { 0x02, "LL_TERMINATE_IND",         terminate_ind,    1, true },
-       { 0x03, "LL_ENC_REQ",               enc_req,         22, true },
-       { 0x04, "LL_ENC_RSP",               enc_rsp,         12, true },
-       { 0x05, "LL_START_ENC_REQ",         null_pdu,         0, true },
-       { 0x06, "LL_START_ENC_RSP",         null_pdu,         0, true },
-       { 0x07, "LL_UNKNOWN_RSP",           unknown_rsp,      1, true },
-       { 0x08, "LL_FEATURE_REQ",           feature_req,      8, true },
-       { 0x09, "LL_FEATURE_RSP",           feature_rsp,      8, true },
-       { 0x0a, "LL_PAUSE_ENC_REQ",         null_pdu,         0, true },
-       { 0x0b, "LL_PAUSE_ENC_RSP",         null_pdu,         0, true },
-       { 0x0c, "LL_VERSION_IND",           version_ind,      5, true },
-       { 0x0d, "LL_REJECT_IND",            reject_ind,       1, true },
-       { 0x12, "LL_PING_REQ",              null_pdu,         0, true },
-       { 0x13, "LL_PING_RSP",              null_pdu,         0, true },
+       { 0x00, "LL_CONNECTION_UPDATE_REQ", conn_update_req,   11, true },
+       { 0x01, "LL_CHANNEL_MAP_REQ",       channel_map_req,    7, true },
+       { 0x02, "LL_TERMINATE_IND",         terminate_ind,      1, true },
+       { 0x03, "LL_ENC_REQ",               enc_req,           22, true },
+       { 0x04, "LL_ENC_RSP",               enc_rsp,           12, true },
+       { 0x05, "LL_START_ENC_REQ",         null_pdu,           0, true },
+       { 0x06, "LL_START_ENC_RSP",         null_pdu,           0, true },
+       { 0x07, "LL_UNKNOWN_RSP",           unknown_rsp,        1, true },
+       { 0x08, "LL_FEATURE_REQ",           feature_req,        8, true },
+       { 0x09, "LL_FEATURE_RSP",           feature_rsp,        8, true },
+       { 0x0a, "LL_PAUSE_ENC_REQ",         null_pdu,           0, true },
+       { 0x0b, "LL_PAUSE_ENC_RSP",         null_pdu,           0, true },
+       { 0x0c, "LL_VERSION_IND",           version_ind,        5, true },
+       { 0x0d, "LL_REJECT_IND",            reject_ind,         1, true },
+       { 0x0e, "LL_SLAVE_FEATURE_REQ",     slave_feature_req,  8, true },
+       { 0x0f, "LL_CONNECTION_PARAM_REQ",  NULL,              23, true },
+       { 0x10, "LL_CONNECTION_PARAM_RSP",  NULL,              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 },
+       { 0x14, "LL_LENGTH_REQ",            NULL,               8, true },
+       { 0x15, "LL_LENGTH_RSP",            NULL,               8, true },
        { }
 };