emulator: sync with upstream

[platform/upstream/bluez.git] / emulator / btdev.c

diff --git a/emulator/btdev.c b/emulator/btdev.c
index a9b225a..69d84a5 100755 (executable)
--- 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)