1 /*
2 * Copyright (C) 2017 The Android Open Source Project
3 *
4 * Portions copyright (C) 2017 Broadcom Limited
5 *
6 * Licensed under the Apache License, Version 2.0 (the "License");
7 * you may not use this file except in compliance with the License.
8 * You may obtain a copy of the License at
9 *
10 * http://www.apache.org/licenses/LICENSE-2.0
11 *
12 * Unless required by applicable law or agreed to in writing, software
13 * distributed under the License is distributed on an "AS IS" BASIS,
14 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
15 * See the License for the specific language governing permissions and
16 * limitations under the License.
17 */
18
19 #include <stdint.h>
20 #include <fcntl.h>
21 #include <sys/socket.h>
22 #include <netlink/genl/genl.h>
23 #include <netlink/genl/family.h>
24 #include <netlink/genl/ctrl.h>
25 #include <linux/rtnetlink.h>
26 #include <netpacket/packet.h>
27 #include <linux/filter.h>
28 #include <linux/errqueue.h>
29
30 #include <linux/pkt_sched.h>
31 #include <netlink/object-api.h>
32 #include <netlink/netlink.h>
33 #include <netlink/socket.h>
34 #include <netlink/handlers.h>
35
36 #include "sync.h"
37
38 #define LOG_TAG "WifiHAL"
39
40 #include <log/log.h>
41
42 #include "wifi_hal.h"
43 #include "common.h"
44 #include "cpp_bindings.h"
45
46 /* Internal radio statistics structure in the driver */
47 typedef struct {
48 wifi_radio radio;
49 uint32_t on_time;
50 uint32_t tx_time;
51 uint32_t rx_time;
52 uint32_t on_time_scan;
53 uint32_t on_time_nbd;
54 uint32_t on_time_gscan;
55 uint32_t on_time_roam_scan;
56 uint32_t on_time_pno_scan;
57 uint32_t on_time_hs20;
58 uint32_t num_channels;
59 wifi_channel_stat channels[];
60 } wifi_radio_stat_internal;
61
62 enum {
63 LSTATS_SUBCMD_GET_INFO = ANDROID_NL80211_SUBCMD_LSTATS_RANGE_START,
64 };
65
66 class GetLinkStatsCommand : public WifiCommand
67 {
68 wifi_stats_result_handler mHandler;
69 public:
GetLinkStatsCommand(wifi_interface_handle iface,wifi_stats_result_handler handler)70 GetLinkStatsCommand(wifi_interface_handle iface, wifi_stats_result_handler handler)
71 : WifiCommand("GetLinkStatsCommand", iface, 0), mHandler(handler)
72 { }
73
create()74 virtual int create() {
75 // ALOGI("Creating message to get link statistics; iface = %d", mIfaceInfo->id);
76
77 int ret = mMsg.create(GOOGLE_OUI, LSTATS_SUBCMD_GET_INFO);
78 if (ret < 0) {
79 ALOGE("Failed to create %x - %d", LSTATS_SUBCMD_GET_INFO, ret);
80 return ret;
81 }
82
83 return ret;
84 }
85
86 protected:
handleResponse(WifiEvent & reply)87 virtual int handleResponse(WifiEvent& reply) {
88
89 // ALOGI("In GetLinkStatsCommand::handleResponse");
90
91 if (reply.get_cmd() != NL80211_CMD_VENDOR) {
92 ALOGD("Ignoring reply with cmd = %d", reply.get_cmd());
93 return NL_SKIP;
94 }
95
96 int id = reply.get_vendor_id();
97 int subcmd = reply.get_vendor_subcmd();
98
99 // ALOGI("Id = %0x, subcmd = %d", id, subcmd);
100
101 void *data = reply.get_vendor_data();
102 int len = reply.get_vendor_data_len();
103 wifi_radio_stat *radio_stat =
104 convertToExternalRadioStatStructure((wifi_radio_stat_internal *)data);
105 if (!radio_stat) {
106 ALOGE("Invalid stats pointer received");
107 return NL_SKIP;
108 }
109 if (radio_stat->num_channels > 11) {
110 ALOGE("Incorrect number of channels = %d", radio_stat->num_channels);
111 // dump data before num_channels
112 ALOGE("radio: = %d", radio_stat->radio);
113 ALOGE("on_time: = %d", radio_stat->on_time);
114 ALOGE("tx_time: = %d", radio_stat->tx_time);
115 ALOGE("rx_time: = %d", radio_stat->rx_time);
116 ALOGE("on_time_scan: = %d", radio_stat->on_time_scan);
117 ALOGE("on_time_nbd: = %d", radio_stat->on_time_nbd);
118 ALOGE("on_time_gscan: = %d", radio_stat->on_time_gscan);
119 ALOGE("on_time_pno_scan: = %d", radio_stat->on_time_pno_scan);
120 ALOGE("on_time_hs20: = %d", radio_stat->on_time_hs20);
121 free(radio_stat);
122 return NL_SKIP;
123 }
124 wifi_iface_stat *iface_stat =
125 (wifi_iface_stat *)((char *)&((wifi_radio_stat_internal *)data)->channels
126 + radio_stat->num_channels * sizeof(wifi_channel_stat));
127 (*mHandler.on_link_stats_results)(id, iface_stat, 1, radio_stat);
128 free(radio_stat);
129 return NL_OK;
130 }
131
132 private:
convertToExternalRadioStatStructure(wifi_radio_stat_internal * internal_stat_ptr)133 wifi_radio_stat *convertToExternalRadioStatStructure(wifi_radio_stat_internal *internal_stat_ptr) {
134 wifi_radio_stat *external_stat_ptr = NULL;
135 if (internal_stat_ptr) {
136 uint32_t channel_size = internal_stat_ptr->num_channels * sizeof(wifi_channel_stat);
137 uint32_t total_size = sizeof(wifi_radio_stat) + channel_size;
138 external_stat_ptr = (wifi_radio_stat *)malloc(total_size);
139 if (external_stat_ptr) {
140 external_stat_ptr->radio = internal_stat_ptr->radio;
141 external_stat_ptr->on_time = internal_stat_ptr->on_time;
142 external_stat_ptr->tx_time = internal_stat_ptr->tx_time;
143 external_stat_ptr->rx_time = internal_stat_ptr->rx_time;
144 external_stat_ptr->tx_time_per_levels = NULL;
145 external_stat_ptr->num_tx_levels = 0;
146 external_stat_ptr->on_time_scan = internal_stat_ptr->on_time_scan;
147 external_stat_ptr->on_time_nbd = internal_stat_ptr->on_time_nbd;
148 external_stat_ptr->on_time_gscan = internal_stat_ptr->on_time_gscan;
149 external_stat_ptr->on_time_roam_scan = internal_stat_ptr->on_time_roam_scan;
150 external_stat_ptr->on_time_pno_scan = internal_stat_ptr->on_time_pno_scan;
151 external_stat_ptr->on_time_hs20 = internal_stat_ptr->on_time_hs20;
152 external_stat_ptr->num_channels = internal_stat_ptr->num_channels;
153 if (internal_stat_ptr->num_channels) {
154 memcpy(&(external_stat_ptr->channels), &(internal_stat_ptr->channels),
155 channel_size);
156 }
157 }
158 }
159 return external_stat_ptr;
160 }
161 };
162
wifi_get_link_stats(wifi_request_id id,wifi_interface_handle iface,wifi_stats_result_handler handler)163 wifi_error wifi_get_link_stats(wifi_request_id id,
164 wifi_interface_handle iface, wifi_stats_result_handler handler)
165 {
166 GetLinkStatsCommand command(iface, handler);
167 return (wifi_error) command.requestResponse();
168 }
169
wifi_set_link_stats(wifi_interface_handle,wifi_link_layer_params)170 wifi_error wifi_set_link_stats(
171 wifi_interface_handle /* iface */, wifi_link_layer_params /* params */)
172 {
173 /* Return success here since bcom HAL does not need set link stats. */
174 return WIFI_SUCCESS;
175 }
176
wifi_clear_link_stats(wifi_interface_handle,u32,u32 *,u8,u8 *)177 wifi_error wifi_clear_link_stats(
178 wifi_interface_handle /* iface */, u32 /* stats_clear_req_mask */,
179 u32 * /* stats_clear_rsp_mask */, u8 /* stop_req */, u8 * /* stop_rsp */)
180 {
181 /* Return success here since bcom HAL does not support clear link stats. */
182 return WIFI_SUCCESS;
183 }
184