3 #include <sys/socket.h>
4 #include <netlink/genl/genl.h>
5 #include <netlink/genl/family.h>
6 #include <netlink/genl/ctrl.h>
7 #include <linux/rtnetlink.h>
8 #include <netpacket/packet.h>
9 #include <linux/filter.h>
10 #include <linux/errqueue.h>
12 #include <linux/pkt_sched.h>
13 #include <netlink/object-api.h>
14 #include <netlink/netlink.h>
15 #include <netlink/socket.h>
16 #include <netlink/handlers.h>
20 #include <utils/Log.h>
24 #include "cpp_bindings.h"
28 LSTATS_ATTRIBUTE_SET_MPDU_SIZE_THRESHOLD
= 1,
29 LSTATS_ATTRIBUTE_SET_AGGR_STATISTICS_GATHERING
,
30 LSTATS_ATTRIBUTE_CLEAR_STOP_REQUEST_MASK
,
31 LSTATS_ATTRIBUTE_CLEAR_STOP_REQUEST
,
37 class LinkLayerStatsCommand
: public WifiCommand
39 wifi_link_layer_params mParams
;
40 u32 mStatsClearReqMask
;
41 u32
*mStatsClearRspMask
;
45 LinkLayerStatsCommand(wifi_interface_handle handle
, wifi_link_layer_params params
)
46 : WifiCommand(handle
, 0), mParams(params
)
48 mStatsClearReqMask
= 0;
49 mStatsClearRspMask
= 0;
55 LinkLayerStatsCommand(wifi_interface_handle handle
,
56 u32 stats_clear_req_mask
, u32
*stats_clear_rsp_mask
, u8 stop_req
, u8
*stop_rsp
)
57 : WifiCommand(handle
, 0), mStatsClearReqMask(stats_clear_req_mask
), mStatsClearRspMask(stats_clear_rsp_mask
),
58 mStopReq(stop_req
), mStopRsp(stop_rsp
)
60 memset(&mParams
,0,sizeof(wifi_link_layer_params
));
63 int createSetRequest(WifiRequest
& request
) {
64 int result
= request
.create(GOOGLE_OUI
, SLSI_NL80211_VENDOR_SUBCMD_LLS_SET_INFO
);
69 nlattr
*data
= request
.attr_start(NL80211_ATTR_VENDOR_DATA
);
71 result
= request
.put_u32(LSTATS_ATTRIBUTE_SET_MPDU_SIZE_THRESHOLD
, mParams
.mpdu_size_threshold
);
76 result
= request
.put_u32(LSTATS_ATTRIBUTE_SET_AGGR_STATISTICS_GATHERING
, mParams
.aggressive_statistics_gathering
);
80 request
.attr_end(data
);
84 int createClearRequest(WifiRequest
& request
) {
85 int result
= request
.create(GOOGLE_OUI
, SLSI_NL80211_VENDOR_SUBCMD_LLS_CLEAR_INFO
);
89 nlattr
*data
= request
.attr_start(NL80211_ATTR_VENDOR_DATA
);
91 result
= request
.put_u32(LSTATS_ATTRIBUTE_CLEAR_STOP_REQUEST_MASK
, mStatsClearReqMask
);
96 result
= request
.put_u32(LSTATS_ATTRIBUTE_CLEAR_STOP_REQUEST
, mStopReq
);
100 request
.attr_end(data
);
105 ALOGD("Starting Link Layer Statistics measurement (%d, %d)", mParams
.mpdu_size_threshold
, mParams
.aggressive_statistics_gathering
);
106 WifiRequest
request(familyId(), ifaceId());
107 int result
= createSetRequest(request
);
109 ALOGE("failed to set Link Layer Statistics (result:%d)", result
);
113 result
= requestResponse(request
);
115 ALOGE("failed to Set Link Layer Statistics (result:%d)", result
);
122 virtual int clear() {
123 ALOGD("Clearing Link Layer Statistics (%d, %d)", mStatsClearReqMask
, mStopReq
);
124 WifiRequest
request(familyId(), ifaceId());
125 int result
= createClearRequest(request
);
127 ALOGE("failed to clear Link Layer Statistics (result:%d)", result
);
131 result
= requestResponse(request
);
133 ALOGE("failed to clear Link Layer Statistics (result:%d)", result
);
140 virtual int handleResponse(WifiEvent
& reply
) {
141 /* Nothing to do on response! */
147 wifi_error
wifi_set_link_stats(wifi_interface_handle iface
, wifi_link_layer_params params
)
149 LinkLayerStatsCommand
*command
= new LinkLayerStatsCommand(iface
, params
);
150 wifi_error result
= (wifi_error
)command
->start();
151 if (result
!= WIFI_SUCCESS
) {
152 ALOGE("failed to Set link layer stats (result:%d)", result
);
157 wifi_error
wifi_clear_link_stats(wifi_interface_handle iface
,
158 u32 stats_clear_req_mask
, u32
*stats_clear_rsp_mask
, u8 stop_req
, u8
*stop_rsp
)
160 LinkLayerStatsCommand
*command
= new LinkLayerStatsCommand(iface
, stats_clear_req_mask
, stats_clear_rsp_mask
, stop_req
, stop_rsp
);
161 wifi_error result
= (wifi_error
)command
->clear();
162 if (result
!= WIFI_SUCCESS
) {
163 ALOGE("failed to Clear link layer stats (result:%d)", result
);
164 *stats_clear_rsp_mask
= 0;
167 *stats_clear_rsp_mask
= stats_clear_req_mask
;
168 *stop_rsp
= stop_req
;
174 class GetLinkStatsCommand
: public WifiCommand
176 wifi_stats_result_handler mHandler
;
177 wifi_interface_handle iface
;
179 GetLinkStatsCommand(wifi_interface_handle iface
, wifi_stats_result_handler handler
)
180 : WifiCommand(iface
, 0), mHandler(handler
)
185 virtual int create() {
186 int ret
= mMsg
.create(GOOGLE_OUI
, SLSI_NL80211_VENDOR_SUBCMD_LLS_GET_INFO
);
188 ALOGE("Failed to create %x - %d", SLSI_NL80211_VENDOR_SUBCMD_LLS_GET_INFO
, ret
);
196 virtual int handleResponse(WifiEvent
& reply
) {
197 if (reply
.get_cmd() != NL80211_CMD_VENDOR
) {
198 ALOGD("Ignoring reply with cmd = %d", reply
.get_cmd());
201 int id
= reply
.get_vendor_id();
202 u8
*data
= (u8
*)reply
.get_vendor_data();
203 int num_radios
= 0, i
= 0;
204 num_radios
= data
[0];
205 data
+= sizeof(data
[0]);
207 // assuming max peers is 16
208 wifi_iface_stat
*iface_stat
= (wifi_iface_stat
*) malloc(sizeof(wifi_iface_stat
) + sizeof(wifi_peer_info
) * 16);
210 ALOGE("Memory alloc failed for iface_stat in response handler!!!");
214 // max channel is 39 (14 2.4GHz and 25 5GHz)
215 wifi_radio_stat
*radio_stat
= (wifi_radio_stat
*) malloc((num_radios
* sizeof(wifi_radio_stat
)) + sizeof(wifi_channel_stat
) * 39);
216 wifi_radio_stat
*radio_stat2
;
217 radio_stat2
= radio_stat
;
219 ALOGE("Memory alloc failed for radio_stat in response handler!!!");
224 /* Data sent from driver does not contain num_tx_levels and tx_time per level. So copy
225 * radio data in two parts - 1st part until num_tx_levels and 2nd part from rx_time.
226 * channel data is copied separately
228 int radio_data_len1
,radio_data_len2
;
229 radio_data_len1
= (u8
*)&(radio_stat
->num_tx_levels
) - (u8
*)radio_stat
;
230 radio_data_len2
= (u8
*)(radio_stat
->channels
) - (u8
*)&(radio_stat
->rx_time
);
232 //kernel is 64 bit. if userspace is 64 bit, typecastting buffer works else, make corrections
233 if (sizeof(iface_stat
->iface
) == 8) {
234 memcpy(iface_stat
, data
, sizeof(wifi_iface_stat
) + sizeof(wifi_peer_info
) * ((wifi_iface_stat
*)data
)->num_peers
);
235 data
+= sizeof(wifi_iface_stat
) + sizeof(wifi_peer_info
) * ((wifi_iface_stat
*)data
)->num_peers
;
237 /* for 64 bit kernel ad 32 bit user space, there is 4 byte extra at the begining and another 4 byte pad after 80 bytes
238 * so remove first 4 and 81-84 bytes from NL buffer.*/
240 memcpy(iface_stat
, data
, 80);
241 data
+= 80 + 4; //for allignment skip 4 bytes
242 memcpy(((u8
*)iface_stat
) + 80, data
, sizeof(wifi_iface_stat
) - 80);
243 data
+= sizeof(wifi_iface_stat
) - 80;
244 memcpy(iface_stat
->peer_info
, data
, sizeof(wifi_peer_info
) * iface_stat
->num_peers
);
245 data
+= sizeof(wifi_peer_info
) * iface_stat
->num_peers
;
247 for (i
= 0; i
< num_radios
; i
++) {
248 memcpy(radio_stat2
, data
, radio_data_len1
);
249 data
+= radio_data_len1
;
250 memcpy(&radio_stat2
->rx_time
, data
, radio_data_len2
);
251 data
+= radio_data_len2
;
252 memcpy(radio_stat2
->channels
, data
, sizeof(wifi_channel_stat
)* radio_stat2
->num_channels
);
253 radio_stat2
->num_tx_levels
= 0;
254 radio_stat2
->tx_time_per_levels
= NULL
;
255 data
+= sizeof(wifi_channel_stat
)* radio_stat2
->num_channels
;
256 radio_stat2
=(wifi_radio_stat
*) ((u8
*)radio_stat2
+ sizeof(wifi_radio_stat
) +
257 (sizeof(wifi_channel_stat
) * radio_stat2
->num_channels
));
259 iface_stat
->iface
= iface
;
260 (*mHandler
.on_link_stats_results
)(id
, iface_stat
, num_radios
, radio_stat
);
267 wifi_error
wifi_get_link_stats(wifi_request_id id
,
268 wifi_interface_handle iface
, wifi_stats_result_handler handler
)
270 GetLinkStatsCommand
command(iface
, handler
);
271 return (wifi_error
) command
.requestResponse();