1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
|
/*
* Licensed to the Apache Software Foundation (ASF) under one
* or more contributor license agreements. See the NOTICE file
* distributed with this work for additional information
* regarding copyright ownership. The ASF licenses this file
* to you under the Apache License, Version 2.0 (the
* "License"); you may not use this file except in compliance
* with the License. You may obtain a copy of the License at
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing,
* software distributed under the License is distributed on an
* "AS IS" BASIS, WITHOUT WARRANTIES OR CONDITIONS OF ANY
* KIND, either express or implied. See the License for the
* specific language governing permissions and limitations
* under the License.
*/
#include <stdint.h>
#include <assert.h>
#include <string.h>
#include <errno.h>
#include <stdio.h>
#include "os/os.h"
#include "nimble/hci_common.h"
#include "nimble/ble_hci_trans.h"
#include "host/ble_monitor.h"
#include "ble_hs_priv.h"
#include "ble_monitor_priv.h"
static int
ble_hs_hci_cmd_transport(struct ble_hci_cmd *cmd)
{
int rc;
#if BLE_MONITOR
ble_monitor_send(BLE_MONITOR_OPCODE_COMMAND_PKT, cmd,
cmd->length + sizeof(*cmd));
#endif
rc = ble_hci_trans_hs_cmd_tx((uint8_t *) cmd);
switch (rc) {
case 0:
return 0;
case BLE_ERR_MEM_CAPACITY:
return BLE_HS_ENOMEM_EVT;
default:
return BLE_HS_EUNKNOWN;
}
}
static int
ble_hs_hci_cmd_send(uint16_t opcode, uint8_t len, const void *cmddata)
{
struct ble_hci_cmd *cmd;
int rc;
cmd = (void *) ble_hci_trans_buf_alloc(BLE_HCI_TRANS_BUF_CMD);
BLE_HS_DBG_ASSERT(cmd != NULL);
cmd->opcode = htole16(opcode);
cmd->length = len;
if (len != 0) {
memcpy(cmd->data, cmddata, len);
}
rc = ble_hs_hci_cmd_transport(cmd);
if (rc == 0) {
STATS_INC(ble_hs_stats, hci_cmd);
} else {
BLE_HS_LOG(DEBUG, "ble_hs_hci_cmd_send failure; rc=%d\n", rc);
}
return rc;
}
int
ble_hs_hci_cmd_send_buf(uint16_t opcode, const void *buf, uint8_t buf_len)
{
switch (ble_hs_sync_state) {
case BLE_HS_SYNC_STATE_BAD:
return BLE_HS_ENOTSYNCED;
case BLE_HS_SYNC_STATE_BRINGUP:
if (!ble_hs_is_parent_task()) {
return BLE_HS_ENOTSYNCED;
}
break;
case BLE_HS_SYNC_STATE_GOOD:
break;
default:
BLE_HS_DBG_ASSERT(0);
return BLE_HS_EUNKNOWN;
}
return ble_hs_hci_cmd_send(opcode, buf_len, buf);
}
|
