---
emulator/btdev.c | 18 ++++++++++++++++++
emulator/btdev.h | 3 ++-
emulator/hciemu.c | 8 ++++++++
emulator/hciemu.h | 3 +++
4 files changed, 31 insertions(+), 1 deletion(-)
diff --git a/emulator/btdev.c b/emulator/btdev.c
index a9b225a24..69d84a5fc 100644
--- a/emulator/btdev.c
+++ b/emulator/btdev.c
@@ -570,6 +570,17 @@ static void set_le_features(struct btdev *btdev)
btdev->le_features[0] |= 0x08; /* Slave-initiated Features Exchange */
}
+static void set_le_states(struct btdev *btdev)
+{
+ /* Set all 41 bits as per Bluetooth 5.0 specification */
+ btdev->le_states[0] = 0xff;
+ btdev->le_states[1] = 0xff;
+ btdev->le_states[2] = 0xff;
+ btdev->le_states[3] = 0xff;
+ btdev->le_states[4] = 0xff;
+ btdev->le_states[5] = 0x03;
+}
+
static void set_amp_features(struct btdev *btdev)
{
}
@@ -603,6 +614,7 @@ struct btdev *btdev_create(enum btdev_type type, uint16_t id)
btdev->version = 0x09;
set_bredrle_features(btdev);
set_bredrle_commands(btdev);
+ set_le_states(btdev);
break;
case BTDEV_TYPE_BREDR:
btdev->version = 0x05;
@@ -613,6 +625,7 @@ struct btdev *btdev_create(enum btdev_type type, uint16_t id)
btdev->version = 0x09;
set_le_features(btdev);
set_le_commands(btdev);
+ set_le_states(btdev);
break;
case BTDEV_TYPE_AMP:
btdev->version = 0x01;
@@ -685,6 +698,11 @@ uint8_t btdev_get_le_scan_enable(struct btdev *btdev)
return btdev->le_scan_enable;
}
+void btdev_set_le_states(struct btdev *btdev, const uint8_t *le_states)
+{
+ memcpy(btdev->le_states, le_states, sizeof(btdev->le_states));
+}
+
static bool use_ssp(struct btdev *btdev1, struct btdev *btdev2)
{
if (btdev1->auth_enable || btdev2->auth_enable)
diff --git a/emulator/btdev.h b/emulator/btdev.h
index 40c72199b..ba06a1015 100644
--- a/emulator/btdev.h
+++ b/emulator/btdev.h
@@ -84,12 +84,13 @@ uint8_t btdev_get_scan_enable(struct btdev *btdev);
uint8_t btdev_get_le_scan_enable(struct btdev *btdev);
+void btdev_set_le_states(struct btdev *btdev, const uint8_t *le_states);
+
void btdev_set_command_handler(struct btdev *btdev, btdev_command_func handler,
void *user_data);
void btdev_set_send_handler(struct btdev *btdev, btdev_send_func handler,
void *user_data);
-
void btdev_receive_h4(struct btdev *btdev, const void *data, uint16_t len);
int btdev_add_hook(struct btdev *btdev, enum btdev_hook_type type,
diff --git a/emulator/hciemu.c b/emulator/hciemu.c
index 7debb8f27..1787a6c0d 100644
--- a/emulator/hciemu.c
+++ b/emulator/hciemu.c
@@ -444,6 +444,14 @@ uint8_t hciemu_get_master_le_scan_enable(struct hciemu *hciemu)
return btdev_get_le_scan_enable(hciemu->master_dev);
}
+void hciemu_set_master_le_states(struct hciemu *hciemu, const uint8_t *le_states)
+{
+ if (!hciemu || !hciemu->master_dev)
+ return;
+
+ btdev_set_le_states(hciemu->master_dev, le_states);
+}
+
bool hciemu_add_master_post_command_hook(struct hciemu *hciemu,
hciemu_command_func_t function, void *user_data)
{
diff --git a/emulator/hciemu.h b/emulator/hciemu.h
index 783f99cf1..5c0c4c306 100644
--- a/emulator/hciemu.h
+++ b/emulator/hciemu.h
@@ -57,6 +57,9 @@ uint8_t hciemu_get_master_scan_enable(struct hciemu *hciemu);
uint8_t hciemu_get_master_le_scan_enable(struct hciemu *hciemu);
+void hciemu_set_master_le_states(struct hciemu *hciemu,
+ const uint8_t *le_states);
+
typedef void (*hciemu_command_func_t)(uint16_t opcode, const void *data,
uint8_t len, void *user_data);
--
2.14.1
--
To unsubscribe from this list: send the line "unsubscribe linux-bluetooth" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at http://vger.kernel.org/majordomo-info.html
