From ed2254b20c13996a0d0a9bb2a3b4c0ad2453739c Mon Sep 17 00:00:00 2001 From: Johan Hedberg Date: Wed, 8 Jan 2014 14:04:58 +0200 Subject: [PATCH] emulator: Add initial support for PIN Code Request Negative Reply --- emulator/btdev.c | 36 ++++++++++++++++++++++++++++++++++++ 1 file changed, 36 insertions(+) diff --git a/emulator/btdev.c b/emulator/btdev.c index 00ea14e53..e34be7148 100644 --- a/emulator/btdev.c +++ b/emulator/btdev.c @@ -270,6 +270,7 @@ static void set_bredr_commands(struct btdev *btdev) btdev->commands[1] |= 0x01; /* Accept Connection Request */ btdev->commands[1] |= 0x02; /* Reject Connection Request */ btdev->commands[1] |= 0x08; /* Link Key Request Negative Reply */ + btdev->commands[1] |= 0x20; /* PIN Code Request Negative Reply */ btdev->commands[1] |= 0x80; /* Authentication Requested */ btdev->commands[2] |= 0x08; /* Remote Name Request */ btdev->commands[2] |= 0x10; /* Cancel Remote Name Request */ @@ -902,6 +903,24 @@ static void link_key_req_neg_reply_complete(struct btdev *btdev, sizeof(pin_req)); } +static void pin_code_req_neg_reply_complete(struct btdev *btdev, + const uint8_t *bdaddr) +{ + struct bt_hci_evt_auth_complete ev; + struct btdev *remote = btdev->conn; + + if (!remote) + return; + + ev.status = BT_HCI_ERR_PIN_OR_KEY_MISSING; + + ev.handle = cpu_to_le16(42); + send_event(btdev, BT_HCI_EVT_AUTH_COMPLETE, &ev, sizeof(ev)); + + ev.handle = cpu_to_le16(42); + send_event(remote, BT_HCI_EVT_AUTH_COMPLETE, &ev, sizeof(ev)); +} + static void auth_request_complete(struct btdev *btdev, uint16_t handle) { struct btdev *remote = btdev->conn; @@ -1198,6 +1217,7 @@ static void default_cmd(struct btdev *btdev, uint16_t opcode, struct bt_hci_rsp_le_test_end lte; struct bt_hci_rsp_remote_name_request_cancel rnrc_rsp; struct bt_hci_rsp_link_key_request_neg_reply lkrnr_rsp; + struct bt_hci_rsp_pin_code_request_neg_reply pcrnr_rsp; uint8_t status, page; switch (opcode) { @@ -1250,6 +1270,14 @@ static void default_cmd(struct btdev *btdev, uint16_t opcode, cmd_complete(btdev, opcode, &lkrnr_rsp, sizeof(lkrnr_rsp)); break; + case BT_HCI_CMD_PIN_CODE_REQUEST_NEG_REPLY: + if (btdev->type == BTDEV_TYPE_LE) + goto unsupported; + pcrnr_rsp.status = BT_HCI_ERR_SUCCESS; + memcpy(pcrnr_rsp.bdaddr, data, 6); + cmd_complete(btdev, opcode, &pcrnr_rsp, sizeof(pcrnr_rsp)); + break; + case BT_HCI_CMD_AUTH_REQUESTED: if (btdev->type == BTDEV_TYPE_LE) goto unsupported; @@ -2044,6 +2072,7 @@ static void default_cmd_completion(struct btdev *btdev, uint16_t opcode, const struct bt_hci_cmd_reject_conn_request *rcr; const struct bt_hci_cmd_auth_requested *ar; const struct bt_hci_cmd_link_key_request_neg_reply *lkrnr; + const struct bt_hci_cmd_pin_code_request_neg_reply *pcrnr; const struct bt_hci_cmd_remote_name_request *rnr; const struct bt_hci_cmd_remote_name_request_cancel *rnrc; const struct bt_hci_cmd_read_remote_features *rrf; @@ -2098,6 +2127,13 @@ static void default_cmd_completion(struct btdev *btdev, uint16_t opcode, link_key_req_neg_reply_complete(btdev, lkrnr->bdaddr); break; + case BT_HCI_CMD_PIN_CODE_REQUEST_NEG_REPLY: + if (btdev->type == BTDEV_TYPE_LE) + return; + pcrnr = data; + pin_code_req_neg_reply_complete(btdev, pcrnr->bdaddr); + break; + case BT_HCI_CMD_AUTH_REQUESTED: if (btdev->type == BTDEV_TYPE_LE) return; -- 2.47.3