1 /******************************************************************************
2  *
3  *  Copyright 2014  Broadcom Corporation
4  *
5  *  Licensed under the Apache License, Version 2.0 (the "License");
6  *  you may not use this file except in compliance with the License.
7  *  You may obtain a copy of the License at:
8  *
9  *  http://www.apache.org/licenses/LICENSE-2.0
10  *
11  *  Unless required by applicable law or agreed to in writing, software
12  *  distributed under the License is distributed on an "AS IS" BASIS,
13  *  WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
14  *  See the License for the specific language governing permissions and
15  *  limitations under the License.
16  *
17  ******************************************************************************/
18 
19 #define LOG_TAG "btm_ble_cont_energy"
20 
21 #include <bluetooth/log.h>
22 #include <inttypes.h>
23 #include <string.h>
24 
25 #include "btm_ble_api.h"
26 #include "internal_include/bt_target.h"
27 #include "os/log.h"
28 #include "stack/btm/btm_int_types.h"
29 #include "stack/include/bt_types.h"
30 
31 using namespace bluetooth;
32 
33 extern tBTM_CB btm_cb;
34 
35 tBTM_BLE_ENERGY_INFO_CB ble_energy_info_cb;
36 
37 /*******************************************************************************
38  *
39  * Function         btm_ble_cont_energy_cmpl_cback
40  *
41  * Description      Controller VSC complete callback
42  *
43  * Parameters
44  *
45  * Returns          void
46  *
47  ******************************************************************************/
btm_ble_cont_energy_cmpl_cback(tBTM_VSC_CMPL * p_params)48 static void btm_ble_cont_energy_cmpl_cback(tBTM_VSC_CMPL* p_params) {
49   uint8_t* p = p_params->p_param_buf;
50   uint16_t len = p_params->param_len;
51   uint32_t total_tx_time = 0, total_rx_time = 0, total_idle_time = 0,
52            total_energy_used = 0;
53 
54   if (len < 17) {
55     log::error("wrong length for btm_ble_cont_energy_cmpl_cback");
56     return;
57   }
58 
59   uint8_t raw_status;
60   STREAM_TO_UINT8(raw_status, p);
61   tHCI_STATUS status = to_hci_status_code(raw_status);
62   STREAM_TO_UINT32(total_tx_time, p);
63   STREAM_TO_UINT32(total_rx_time, p);
64   STREAM_TO_UINT32(total_idle_time, p);
65   STREAM_TO_UINT32(total_energy_used, p);
66 
67   log::verbose(
68       "energy_info status={},tx_t={}, rx_t={}, ener_used={}, idle_t={}", status,
69       total_tx_time, total_rx_time, total_energy_used, total_idle_time);
70 
71   if (NULL != ble_energy_info_cb.p_ener_cback)
72     ble_energy_info_cb.p_ener_cback(total_tx_time, total_rx_time,
73                                     total_idle_time, total_energy_used,
74                                     static_cast<tHCI_STATUS>(status));
75 
76   return;
77 }
78 
79 /*******************************************************************************
80  *
81  * Function         BTM_BleGetEnergyInfo
82  *
83  * Description      This function obtains the energy info
84  *
85  * Parameters      p_ener_cback - Callback pointer
86  *
87  * Returns          status
88  *
89  ******************************************************************************/
BTM_BleGetEnergyInfo(tBTM_BLE_ENERGY_INFO_CBACK * p_ener_cback)90 tBTM_STATUS BTM_BleGetEnergyInfo(tBTM_BLE_ENERGY_INFO_CBACK* p_ener_cback) {
91   tBTM_BLE_VSC_CB cmn_ble_vsc_cb;
92 
93   BTM_BleGetVendorCapabilities(&cmn_ble_vsc_cb);
94 
95   log::verbose("BTM_BleGetEnergyInfo");
96 
97   if (0 == cmn_ble_vsc_cb.energy_support) {
98     log::error("Controller does not support get energy info");
99     return BTM_ERR_PROCESSING;
100   }
101 
102   ble_energy_info_cb.p_ener_cback = p_ener_cback;
103   BTM_VendorSpecificCommand(HCI_BLE_ENERGY_INFO, 0, NULL,
104                             btm_ble_cont_energy_cmpl_cback);
105   return BTM_CMD_STARTED;
106 }
107