Diff between 0b548ec4cdf8d9fbe6257a726423c70719b4b71c and 373abffd14d2e3228c23cd6363ea731eff4ba8eb

Changed Files

File Additions Deletions Status
emulator/btdev.c +26 -0 modified

Full Patch

diff --git a/emulator/btdev.c b/emulator/btdev.c
index 6a7b97d..8d4b239 100644
--- a/emulator/btdev.c
+++ b/emulator/btdev.c
@@ -74,6 +74,8 @@ struct btdev {
 	uint16_t conn_accept_timeout;
 	uint16_t page_timeout;
 	uint8_t  scan_enable;
+	uint16_t page_scan_interval;
+	uint16_t page_scan_window;
 	uint8_t  auth_enable;
 	uint8_t  inquiry_mode;
 	uint8_t  afh_assess_mode;
@@ -278,6 +280,9 @@ struct btdev *btdev_create(enum btdev_type type, uint16_t id)
 		break;
 	}
 
+	btdev->page_scan_interval = 0x0800;
+	btdev->page_scan_window = 0x0012;
+
 	btdev->acl_mtu = 192;
 	btdev->acl_max_pkt = 1;
 
@@ -686,6 +691,7 @@ static void default_cmd(struct btdev *btdev, uint16_t opcode,
 	const struct bt_hci_cmd_write_conn_accept_timeout *wcat;
 	const struct bt_hci_cmd_write_page_timeout *wpt;
 	const struct bt_hci_cmd_write_scan_enable *wse;
+	const struct bt_hci_cmd_write_page_scan_activity *wpsa;
 	const struct bt_hci_cmd_write_auth_enable *wae;
 	const struct bt_hci_cmd_write_class_of_dev *wcod;
 	const struct bt_hci_cmd_write_voice_setting *wvs;
@@ -704,6 +710,7 @@ static void default_cmd(struct btdev *btdev, uint16_t opcode,
 	struct bt_hci_rsp_read_conn_accept_timeout rcat;
 	struct bt_hci_rsp_read_page_timeout rpt;
 	struct bt_hci_rsp_read_scan_enable rse;
+	struct bt_hci_rsp_read_page_scan_activity rpsa;
 	struct bt_hci_rsp_read_auth_enable rae;
 	struct bt_hci_rsp_read_class_of_dev rcod;
 	struct bt_hci_rsp_read_voice_setting rvs;
@@ -954,6 +961,25 @@ static void default_cmd(struct btdev *btdev, uint16_t opcode,
 		cmd_complete(btdev, opcode, &status, sizeof(status));
 		break;
 
+	case BT_HCI_CMD_READ_PAGE_SCAN_ACTIVITY:
+		if (btdev->type == BTDEV_TYPE_LE)
+			goto unsupported;
+		rpsa.status = BT_HCI_ERR_SUCCESS;
+		rpsa.interval = cpu_to_le16(btdev->page_scan_interval);
+		rpsa.window = cpu_to_le16(btdev->page_scan_window);
+		cmd_complete(btdev, opcode, &rpsa, sizeof(rpsa));
+		break;
+
+	case BT_HCI_CMD_WRITE_PAGE_SCAN_ACTIVITY:
+		if (btdev->type == BTDEV_TYPE_LE)
+			goto unsupported;
+		wpsa = data;
+		btdev->page_scan_interval = le16_to_cpu(wpsa->interval);
+		btdev->page_scan_window = le16_to_cpu(wpsa->window);
+		status = BT_HCI_ERR_SUCCESS;
+		cmd_complete(btdev, opcode, &status, sizeof(status));
+		break;
+
 	case BT_HCI_CMD_READ_AUTH_ENABLE:
 		if (btdev->type == BTDEV_TYPE_LE)
 			goto unsupported;