projects / GitHub / MotorolaMobilityLLC / hardware-samsung_slsi-scsc_wifibt-wifi_hal.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
[9610] wlbt: Fix compilation erros for Android Q
[GitHub/MotorolaMobilityLLC/hardware-samsung_slsi-scsc_wifibt-wifi_hal.git] / rtt.cpp
CommitLineData
7753f181
DD		 1#include <stdint.h>
2#include <fcntl.h>
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>
11
12#include <linux/pkt_sched.h>
13#include <netlink/object-api.h>
14#include <netlink/netlink.h>
15#include <netlink/socket.h>
7753f181 16
47e18f37 17#include <string>
7753f181
DD		 18#include "nl80211_copy.h"
19
20#include "sync.h"
21
7753f181
DD		 22#include <utils/Log.h>
23
24#include "wifi_hal.h"
25#include "common.h"
26#include "cpp_bindings.h"
47e18f37
JPS		 27using namespace std;
28
29typedef enum {
30 SLSI_RTT_ATTRIBUTE_TARGET_CNT = 0,
31 SLSI_RTT_ATTRIBUTE_TARGET_INFO,
32 SLSI_RTT_ATTRIBUTE_TARGET_MAC,
33 SLSI_RTT_ATTRIBUTE_TARGET_TYPE,
34 SLSI_RTT_ATTRIBUTE_TARGET_PEER,
35 SLSI_RTT_ATTRIBUTE_TARGET_CHAN_WIDTH,
36 SLSI_RTT_ATTRIBUTE_TARGET_CHAN_FREQ,
37 SLSI_RTT_ATTRIBUTE_TARGET_CHAN_FREQ0,
38 SLSI_RTT_ATTRIBUTE_TARGET_CHAN_FREQ1,
39 SLSI_RTT_ATTRIBUTE_TARGET_PERIOD,
40 SLSI_RTT_ATTRIBUTE_TARGET_NUM_BURST,
41 SLSI_RTT_ATTRIBUTE_TARGET_NUM_FTM_BURST,
42 SLSI_RTT_ATTRIBUTE_TARGET_NUM_RETRY_FTM,
43 SLSI_RTT_ATTRIBUTE_TARGET_NUM_RETRY_FTMR,
44 SLSI_RTT_ATTRIBUTE_TARGET_LCI,
45 SLSI_RTT_ATTRIBUTE_TARGET_LCR,
46 SLSI_RTT_ATTRIBUTE_TARGET_BURST_DURATION,
47 SLSI_RTT_ATTRIBUTE_TARGET_PREAMBLE,
48 SLSI_RTT_ATTRIBUTE_TARGET_BW,
49 SLSI_RTT_ATTRIBUTE_RESULTS_COMPLETE = 30,
50 SLSI_RTT_ATTRIBUTE_RESULTS_PER_TARGET,
51 SLSI_RTT_ATTRIBUTE_RESULT_CNT,
52 SLSI_RTT_ATTRIBUTE_RESULT,
53 SLSI_RTT_ATTRIBUTE_TARGET_ID
54} SLSI_RTT_ATTRIBUTE;
55
56enum slsi_rtt_event_attributes {
57 SLSI_RTT_EVENT_ATTR_ADDR = 0,
58 SLSI_RTT_EVENT_ATTR_BURST_NUM,
59 SLSI_RTT_EVENT_ATTR_MEASUREMENT_NUM,
60 SLSI_RTT_EVENT_ATTR_SUCCESS_NUM,
61 SLSI_RTT_EVENT_ATTR_NUM_PER_BURST_PEER,
62 SLSI_RTT_EVENT_ATTR_STATUS,
63 SLSI_RTT_EVENT_ATTR_RETRY_AFTER_DURATION,
64 SLSI_RTT_EVENT_ATTR_TYPE,
65 SLSI_RTT_EVENT_ATTR_RSSI,
66 SLSI_RTT_EVENT_ATTR_RSSI_SPREAD,
67 SLSI_RTT_EVENT_ATTR_TX_PREAMBLE,
68 SLSI_RTT_EVENT_ATTR_TX_NSS,
69 SLSI_RTT_EVENT_ATTR_TX_BW,
70 SLSI_RTT_EVENT_ATTR_TX_MCS,
71 SLSI_RTT_EVENT_ATTR_TX_RATE,
72 SLSI_RTT_EVENT_ATTR_RX_PREAMBLE,
73 SLSI_RTT_EVENT_ATTR_RX_NSS,
74 SLSI_RTT_EVENT_ATTR_RX_BW,
75 SLSI_RTT_EVENT_ATTR_RX_MCS,
76 SLSI_RTT_EVENT_ATTR_RX_RATE,
77 SLSI_RTT_EVENT_ATTR_RTT,
78 SLSI_RTT_EVENT_ATTR_RTT_SD,
79 SLSI_RTT_EVENT_ATTR_RTT_SPREAD,
80 SLSI_RTT_EVENT_ATTR_DISTANCE_MM,
81 SLSI_RTT_EVENT_ATTR_DISTANCE_SD_MM,
82 SLSI_RTT_EVENT_ATTR_DISTANCE_SPREAD_MM,
83 SLSI_RTT_EVENT_ATTR_TIMESTAMP_US,
84 SLSI_RTT_EVENT_ATTR_BURST_DURATION_MSN,
85 SLSI_RTT_EVENT_ATTR_NEGOTIATED_BURST_NUM,
86 SLSI_RTT_EVENT_ATTR_LCI,
87 SLSI_RTT_EVENT_ATTR_LCR
88};
89
90struct dot11_rm_ie {
91 u8 id;
92 u8 len;
93 u8 token;
94 u8 mode;
95 u8 type;
96} __attribute__ ((packed));
97typedef struct dot11_rm_ie dot11_rm_ie_t;
98typedef struct strmap_entry {
99 int id;
100 string text;
101} strmap_entry_t;
102
103static const strmap_entry_t err_info[] = {
104 {RTT_STATUS_SUCCESS, string("Success")},
105 {RTT_STATUS_FAILURE, string("Failure")},
106 {RTT_STATUS_FAIL_NO_RSP, string("No reponse")},
107 {RTT_STATUS_FAIL_INVALID_TS, string("Invalid Timestamp")},
108 {RTT_STATUS_FAIL_PROTOCOL, string("Protocol error")},
109 {RTT_STATUS_FAIL_REJECTED, string("Rejected")},
110 {RTT_STATUS_FAIL_NOT_SCHEDULED_YET, string("not scheduled")},
111 {RTT_STATUS_FAIL_SCHEDULE, string("schedule failed")},
112 {RTT_STATUS_FAIL_TM_TIMEOUT, string("timeout")},
113 {RTT_STATUS_FAIL_AP_ON_DIFF_CHANNEL, string("AP is on difference channel")},
114 {RTT_STATUS_FAIL_NO_CAPABILITY, string("no capability")},
115 {RTT_STATUS_FAIL_BUSY_TRY_LATER, string("busy and try later")},
116 {RTT_STATUS_ABORTED, string("aborted")}
117};
118/*static const string get_err_info(int status)
119{
120 int i;
121 const strmap_entry_t *p_entry;
122 int num_entries = sizeof(err_info)/ sizeof(err_info[0]);
123 * scan thru the table till end
124 p_entry = err_info;
125 for (i = 0; i < (int) num_entries; i++)
126 {
127 if (p_entry->id == status)
128 return p_entry->text;
129 p_entry++; * next entry
130 }
131 return "unknown error"; * not found
132}*/
133class RttCommand : public WifiCommand
134{
ea44a0c5 135 int rtt_id;
47e18f37
JPS		 136 unsigned numTargetDevice;
137 int mCompleted;
138 int currentIdx;
139 int totalCnt;
140 static const int MAX_RESULTS = 1024;
141 wifi_rtt_result *rttResults[MAX_RESULTS];
142 wifi_rtt_config *rttParams;
143 wifi_rtt_event_handler rttHandler;
144public:
145 RttCommand(wifi_interface_handle iface, int id, unsigned num_rtt_config,
146 wifi_rtt_config rtt_config[], wifi_rtt_event_handler handler)
147 : WifiCommand(iface, id), rtt_id(id), numTargetDevice(num_rtt_config), rttParams(rtt_config),
148 rttHandler(handler)
149 {
150 memset(rttResults, 0, sizeof(rttResults));
151 currentIdx = 0;
152 mCompleted = 0;
153 totalCnt = 0;
154 }
155
156 RttCommand(wifi_interface_handle iface, int id)
c9af5606 157 : WifiCommand(iface, id), rtt_id(id), rttParams(NULL)
47e18f37 158 {
c9af5606
SP		 159 rttHandler.on_rtt_results = NULL;
160 memset(rttResults, 0, sizeof(rttResults));
47e18f37
JPS		 161 currentIdx = 0;
162 mCompleted = 0;
163 totalCnt = 0;
164 numTargetDevice = 0;
165 }
166 int createSetupRequest(WifiRequest& request) {
167 int result = request.create(GOOGLE_OUI, SLSI_NL80211_VENDOR_SUBCMD_RTT_RANGE_START);
168 if (result < 0) {
169 return result;
170 }
171 nlattr *data = request.attr_start(NL80211_ATTR_VENDOR_DATA);
172 result = request.put_u16(SLSI_RTT_ATTRIBUTE_TARGET_ID, rtt_id);
173 if (result < 0) {
174 return result;
175 }
176 result = request.put_u8(SLSI_RTT_ATTRIBUTE_TARGET_CNT, numTargetDevice);
177 ALOGI("numTargetDevice %d\n",numTargetDevice);
178 if (result < 0) {
179 return result;
180 }
181 nlattr *rtt_config = request.attr_start(SLSI_RTT_ATTRIBUTE_TARGET_INFO);
182 for (unsigned i = 0; i < numTargetDevice; i++) {
183 nlattr *attr2 = request.attr_start(i);
184
185 result = request.put_addr(SLSI_RTT_ATTRIBUTE_TARGET_MAC, rttParams[i].addr);
186 ALOGI("mac_addr %p\n",rttParams[i].addr);
187 if (result < 0) {
188 return result;
189 }
190
191 result = request.put_u16(SLSI_RTT_ATTRIBUTE_TARGET_TYPE, rttParams[i].type);
192 ALOGI("\trtt_type %d\n",rttParams[i].type);
193 if (result < 0) {
194 return result;
195 }
196
197 result = request.put_u16(SLSI_RTT_ATTRIBUTE_TARGET_PEER, rttParams[i].peer);
198 ALOGI("\trtt_peer %d\n",rttParams[i].peer);
199 if (result < 0) {
200 return result;
201 }
202 result = request.put_u16(SLSI_RTT_ATTRIBUTE_TARGET_CHAN_FREQ, rttParams[i].channel.center_freq);
203 ALOGI("\trtt_ primary channel_freq %d\n",rttParams[i].channel.center_freq);
204 if (result < 0) {
205 return result;
206 }
207 result = request.put_u16(SLSI_RTT_ATTRIBUTE_TARGET_CHAN_WIDTH, rttParams[i].channel.width);
208 ALOGI("\trtt_channel width:%d\n",rttParams[i].channel.width);
209 if (result < 0) {
210 return result;
211 }
212 result = request.put_u16(SLSI_RTT_ATTRIBUTE_TARGET_CHAN_FREQ0, rttParams[i].channel.center_freq0);
213 ALOGI("\trtt_channel_freq 0:%d\n",rttParams[i].channel.center_freq0);
214 if (result < 0) {
215 return result;
216 }
217 result = request.put_u16(SLSI_RTT_ATTRIBUTE_TARGET_CHAN_FREQ1, rttParams[i].channel.center_freq1);
218 ALOGI("\trtt_channel_freq 1: %d\n",rttParams[i].channel.center_freq1);
219 if (result < 0) {
220 return result;
221 }
222 result = request.put_u8(SLSI_RTT_ATTRIBUTE_TARGET_NUM_BURST, rttParams[i].num_burst);
223 ALOGI("\tnum_burst %d\n",rttParams[i].num_burst);
224 if (result < 0) {
225 return result;
226 }
227
228 result = request.put_u8(SLSI_RTT_ATTRIBUTE_TARGET_NUM_FTM_BURST,
229 rttParams[i].num_frames_per_burst);
230 ALOGI("\tnum_frames_per_burst %d\n",rttParams[i].num_frames_per_burst);
231 if (result < 0) {
232 return result;
233 }
234
235 result = request.put_u8(SLSI_RTT_ATTRIBUTE_TARGET_NUM_RETRY_FTM,
236 rttParams[i].num_retries_per_rtt_frame);
237 ALOGI("\tnum_retries_per_rtt_frame %d\n",rttParams[i].num_retries_per_rtt_frame);
238 if (result < 0) {
239 return result;
240 }
241
242 result = request.put_u8(SLSI_RTT_ATTRIBUTE_TARGET_NUM_RETRY_FTMR,
243 rttParams[i].num_retries_per_ftmr);
244 ALOGI("\tnum_retries_per_ftmr %d\n",rttParams[i].num_retries_per_ftmr);
245 if (result < 0) {
246 return result;
247 }
248
249 result = request.put_u8(SLSI_RTT_ATTRIBUTE_TARGET_PERIOD,
250 rttParams[i].burst_period);
251 ALOGI("\tburst_period %d\n",rttParams[i].burst_period);
252 if (result < 0) {
253 return result;
254 }
255
256 result = request.put_u8(SLSI_RTT_ATTRIBUTE_TARGET_BURST_DURATION,
257 rttParams[i].burst_duration);
258 ALOGI("\tburst_duration %d\n",rttParams[i].burst_duration);
259 if (result < 0) {
260 return result;
261 }
262
263 result = request.put_u16(SLSI_RTT_ATTRIBUTE_TARGET_LCI,
264 rttParams[i].LCI_request);
265 ALOGI("\tLCI_request %d\n",rttParams[i].LCI_request);
266 if (result < 0) {
267 return result;
268 }
269
270 result = request.put_u16(SLSI_RTT_ATTRIBUTE_TARGET_LCR,
271 rttParams[i].LCR_request);
272 ALOGI("\tLCR_ request%d\n",rttParams[i].LCR_request);
273 if (result < 0) {
274 return result;
275 }
276
277 result = request.put_u16(SLSI_RTT_ATTRIBUTE_TARGET_BW,
278 rttParams[i].bw);
279 ALOGI("\tBW%d\n",rttParams[i].bw);
280 if (result < 0) {
281 return result;
282 }
283
284 result = request.put_u16(SLSI_RTT_ATTRIBUTE_TARGET_PREAMBLE,
285 rttParams[i].preamble);
286 ALOGI("\tpreamble%d\n",rttParams[i].preamble);
287 if (result < 0) {
288 return result;
289 }
290 request.attr_end(attr2);
291 }
292 ALOGE("setup request created");
293 request.attr_end(rtt_config);
294 request.attr_end(data);
295 return WIFI_SUCCESS;
296 }
297
298 int createTeardownRequest(WifiRequest& request, unsigned num_devices, mac_addr addr[]) {
299 int result = request.create(GOOGLE_OUI, SLSI_NL80211_VENDOR_SUBCMD_RTT_RANGE_CANCEL);
300 if (result < 0) {
301 return result;
302 }
303 nlattr *data = request.attr_start(NL80211_ATTR_VENDOR_DATA);
304 request.put_u16(SLSI_RTT_ATTRIBUTE_TARGET_ID, rtt_id);
305 request.put_u16(SLSI_RTT_ATTRIBUTE_TARGET_CNT, num_devices);
306 for(unsigned i = 0; i < num_devices; i++) {
307 result = request.put_addr(SLSI_RTT_ATTRIBUTE_TARGET_MAC, addr[i]);
308 if (result < 0) {
309 return result;
310 }
311 }
312 request.attr_end(data);
313 return result;
314 }
315 int start() {
316 WifiRequest request(familyId(), ifaceId());
317 int result = createSetupRequest(request);
318 if (result != WIFI_SUCCESS) {
319 ALOGE("failed to create setup request; result = %d", result);
320 return result;
321 }
322
323 result = requestResponse(request);
324 if (result != WIFI_SUCCESS) {
325 ALOGE("failed to configure RTT setup; result = %d", result);
326 return result;
327 }
328 registerVendorHandler(GOOGLE_OUI, SLSI_RTT_RESULT_EVENT);
329 registerVendorHandler(GOOGLE_OUI, SLSI_RTT_EVENT_COMPLETE);
330 return result;
331 }
332
333 virtual int cancel() {
334 ALOGD("Stopping RTT");
335
336 WifiRequest request(familyId(), ifaceId());
337 int result = createTeardownRequest(request, 0, NULL);
338 if (result != WIFI_SUCCESS) {
339 ALOGE("failed to create stop request; result = %d", result);
340 } else {
341 result = requestResponse(request);
342 if (result != WIFI_SUCCESS) {
343 ALOGE("failed to stop scan; result = %d", result);
344 }
345 }
346 ALOGE("RTT stopped");
347 /*This needs to be check */
348 unregisterVendorHandler(GOOGLE_OUI, SLSI_RTT_RESULT_EVENT);
349 unregisterVendorHandler(GOOGLE_OUI, SLSI_RTT_EVENT_COMPLETE);
350 return WIFI_SUCCESS;
351 }
352
353 int cancel_specific(unsigned num_devices, mac_addr addr[]) {
354 ALOGE("Stopping RTT specific");
355
356 WifiRequest request(familyId(), ifaceId());
357 int result = createTeardownRequest(request, num_devices, addr);
358 if (result != WIFI_SUCCESS) {
359 ALOGE("failed to create stop request; result = %d", result);
360 } else {
361 result = requestResponse(request);
362 if (result != WIFI_SUCCESS) {
363 ALOGE("failed to stop RTT; result = %d", result);
364 }
365 }
366 ALOGE("Specific RTT stopped");
367 /*This needs to be check */
368 unregisterVendorHandler(GOOGLE_OUI, SLSI_RTT_RESULT_EVENT);
369 unregisterVendorHandler(GOOGLE_OUI, SLSI_RTT_EVENT_COMPLETE);
370 return WIFI_SUCCESS;
371 }
372
373 virtual int handleResponse(WifiEvent& reply) {
374 /* Nothing to do on response! */
375 return NL_SKIP;
376 }
377
378 virtual int handleEvent(WifiEvent& event) {
379 currentIdx=0;
380 nlattr *vendor_data = event.get_attribute(NL80211_ATTR_VENDOR_DATA);
381 int event_id = event.get_vendor_subcmd();
382 ALOGD("Got an RTT event with id:%d\n",event_id);
383 if(event_id == SLSI_RTT_EVENT_COMPLETE) {
384 ALOGD("RTT event complete\n");
385 unregisterVendorHandler(GOOGLE_OUI, SLSI_RTT_RESULT_EVENT);
386 WifiCommand *cmd = wifi_unregister_cmd(wifiHandle(), id());
387 if (cmd)
388 cmd->releaseRef();
389 } else if (event_id == SLSI_RTT_RESULT_EVENT) {
390 int result_cnt = 0;
391 int rtt_id = 0;
392 ALOGD("RTT result event\n");
393 for (nl_iterator it(vendor_data); it.has_next(); it.next()) {
394 if (it.get_type() == SLSI_RTT_ATTRIBUTE_RESULT_CNT) {
395 result_cnt = it.get_u16();
396 ALOGD("RTT results count : %d\n", result_cnt);
397 } else if (it.get_type() == SLSI_RTT_ATTRIBUTE_TARGET_ID) {
398 rtt_id = it.get_u16();
399 ALOGD("RTT target id : %d\n", rtt_id);
400 } else if (it.get_type() == SLSI_RTT_ATTRIBUTE_RESULT) {
401 ALOGD("RTT result attribute : %d\n", SLSI_RTT_ATTRIBUTE_RESULT);
402 rttResults[currentIdx] = (wifi_rtt_result *)malloc(sizeof(wifi_rtt_result));
403 wifi_rtt_result *rtt_result = rttResults[currentIdx];
404 if (rtt_result == NULL) {
405 ALOGE("failed to allocate the wifi_rtt_result\n");
406 unregisterVendorHandler(GOOGLE_OUI, SLSI_RTT_RESULT_EVENT);
407 break;
408 }
409 for(nl_iterator nl_nested_itr((struct nlattr *)it.get()); nl_nested_itr.has_next(); nl_nested_itr.next()) {
410 if (nl_nested_itr.get_type() == SLSI_RTT_EVENT_ATTR_ADDR) {
411 memcpy(rtt_result->addr, nl_nested_itr.get_data(), nl_nested_itr.get_len());
412 } else if (nl_nested_itr.get_type() == SLSI_RTT_EVENT_ATTR_BURST_NUM) {
413 rtt_result->burst_num = (unsigned)nl_nested_itr.get_u8();
414 } else if (nl_nested_itr.get_type() == SLSI_RTT_EVENT_ATTR_MEASUREMENT_NUM) {
415 rtt_result->measurement_number = (unsigned)nl_nested_itr.get_u8();
416 } else if (nl_nested_itr.get_type() == SLSI_RTT_EVENT_ATTR_SUCCESS_NUM) {
417 rtt_result->success_number = (unsigned)nl_nested_itr.get_u8();
418 } else if (nl_nested_itr.get_type() == SLSI_RTT_EVENT_ATTR_NUM_PER_BURST_PEER) {
ea44a0c5 419 rtt_result->number_per_burst_peer = (unsigned char)nl_nested_itr.get_u8();
47e18f37
JPS		 420 } else if (nl_nested_itr.get_type() == SLSI_RTT_EVENT_ATTR_STATUS) {
421 rtt_result->status = (wifi_rtt_status)nl_nested_itr.get_u16();
422 } else if (nl_nested_itr.get_type() == SLSI_RTT_EVENT_ATTR_RETRY_AFTER_DURATION) {
ea44a0c5 423 rtt_result->retry_after_duration = (unsigned char)nl_nested_itr.get_u8();
47e18f37
JPS		 424 } else if (nl_nested_itr.get_type() == SLSI_RTT_EVENT_ATTR_TYPE) {
425 rtt_result->type = (wifi_rtt_type)nl_nested_itr.get_u16();
426 } else if (nl_nested_itr.get_type() == SLSI_RTT_EVENT_ATTR_RSSI) {
427 rtt_result->rssi = (wifi_rssi)nl_nested_itr.get_u16();
428 } else if (nl_nested_itr.get_type() == SLSI_RTT_EVENT_ATTR_RSSI_SPREAD) {
429 rtt_result->rssi_spread= (wifi_rssi)nl_nested_itr.get_u16();
430 } else if (nl_nested_itr.get_type() == SLSI_RTT_EVENT_ATTR_TX_PREAMBLE) {
431 rtt_result->tx_rate.preamble = nl_nested_itr.get_u32();
432 } else if (nl_nested_itr.get_type() == SLSI_RTT_EVENT_ATTR_TX_NSS) {
433 rtt_result->tx_rate.nss = nl_nested_itr.get_u32();
434 } else if (nl_nested_itr.get_type() == SLSI_RTT_EVENT_ATTR_TX_BW) {
435 rtt_result->tx_rate.bw = nl_nested_itr.get_u32();
436 } else if (nl_nested_itr.get_type() == SLSI_RTT_EVENT_ATTR_TX_MCS) {
437 rtt_result->tx_rate.rateMcsIdx = nl_nested_itr.get_u32();
438 } else if (nl_nested_itr.get_type() == SLSI_RTT_EVENT_ATTR_TX_RATE) {
439 rtt_result->tx_rate.bitrate = nl_nested_itr.get_u32();
440 }else if (nl_nested_itr.get_type() == SLSI_RTT_EVENT_ATTR_RX_PREAMBLE) {
441 rtt_result->rx_rate.preamble = nl_nested_itr.get_u32();
442 } else if (nl_nested_itr.get_type() == SLSI_RTT_EVENT_ATTR_RX_NSS) {
443 rtt_result->rx_rate.nss = nl_nested_itr.get_u32();
444 } else if (nl_nested_itr.get_type() == SLSI_RTT_EVENT_ATTR_RX_BW) {
445 rtt_result->rx_rate.bw = nl_nested_itr.get_u32();
446 } else if (nl_nested_itr.get_type() == SLSI_RTT_EVENT_ATTR_RX_MCS) {
447 rtt_result->rx_rate.rateMcsIdx = nl_nested_itr.get_u32();
448 } else if (nl_nested_itr.get_type() == SLSI_RTT_EVENT_ATTR_RX_RATE) {
449 rtt_result->rx_rate.bitrate = nl_nested_itr.get_u32();
450 } else if (nl_nested_itr.get_type() == SLSI_RTT_EVENT_ATTR_RTT) {
451 rtt_result->rtt = (wifi_timespan)nl_nested_itr.get_u32();
452 } else if (nl_nested_itr.get_type() == SLSI_RTT_EVENT_ATTR_RTT_SD) {
453 rtt_result->rtt_sd = (wifi_timespan)nl_nested_itr.get_u16();
454 } else if (nl_nested_itr.get_type() == SLSI_RTT_EVENT_ATTR_RTT_SPREAD) {
455 rtt_result->rtt_spread = (wifi_timespan)nl_nested_itr.get_u16();
456 } else if (nl_nested_itr.get_type() == SLSI_RTT_EVENT_ATTR_DISTANCE_MM) {
457 rtt_result->distance_mm = nl_nested_itr.get_u32();
458 } else if (nl_nested_itr.get_type() == SLSI_RTT_EVENT_ATTR_DISTANCE_SD_MM) {
459 rtt_result->distance_sd_mm = nl_nested_itr.get_u32();
460 } else if (nl_nested_itr.get_type() == SLSI_RTT_EVENT_ATTR_DISTANCE_SPREAD_MM) {
461 rtt_result->distance_spread_mm = nl_nested_itr.get_u32();
462 } else if (nl_nested_itr.get_type() == SLSI_RTT_EVENT_ATTR_TIMESTAMP_US) {
463 rtt_result->ts = (wifi_timestamp)nl_nested_itr.get_u32();
464 } else if (nl_nested_itr.get_type() == SLSI_RTT_EVENT_ATTR_BURST_DURATION_MSN) {
465 rtt_result->burst_duration = nl_nested_itr.get_u16();
466 } else if (nl_nested_itr.get_type() == SLSI_RTT_EVENT_ATTR_NEGOTIATED_BURST_NUM) {
467 rtt_result->negotiated_burst_num = nl_nested_itr.get_u8();
468 } else if (nl_nested_itr.get_type() == SLSI_RTT_EVENT_ATTR_LCI) {
469 u8 *lci_ie = (u8 *)nl_nested_itr.get_data();
470 rtt_result->LCI = (wifi_information_element *)malloc(sizeof(wifi_information_element) + nl_nested_itr.get_len() - 2);
471 rtt_result->LCI->id = lci_ie[0];
472 rtt_result->LCI->len =lci_ie[1];
473 memcpy(rtt_result->LCI->data, &lci_ie[2], nl_nested_itr.get_len() - 2);
474 } else if (nl_nested_itr.get_type() == SLSI_RTT_EVENT_ATTR_LCR) {
475 u8 *lcr_ie = (u8 *)nl_nested_itr.get_data();
476 rtt_result->LCR = (wifi_information_element *)malloc(sizeof(wifi_information_element) + nl_nested_itr.get_len() - 2);
477 rtt_result->LCR->id = lcr_ie[0];
478 rtt_result->LCR->len =lcr_ie[1];
479 memcpy(rtt_result->LCR->data, &lcr_ie[2], nl_nested_itr.get_len() - 2);
480 }
481 }
482 currentIdx++;
483 }
484 }
485 (*rttHandler.on_rtt_results)(id() ,currentIdx, rttResults);
486 for (int i = 0; i < currentIdx; i++) {
487 free(rttResults[i]);
488 rttResults[i] = NULL;
489 }
490 currentIdx = 0;
491 }
492 ALOGE("Handled response for rtt config");
493 return NL_SKIP;
494 }
495};
496class GetRttCapabilitiesCommand : public WifiCommand
497 {
498 wifi_rtt_capabilities *mCapabilities;
499public:
500 GetRttCapabilitiesCommand(wifi_interface_handle iface, wifi_rtt_capabilities *capabitlites)
501 : WifiCommand(iface, 0), mCapabilities(capabitlites)
502 {
503 memset(mCapabilities, 0, sizeof(*mCapabilities));
504 }
505
506 virtual int create() {
507 int ret = mMsg.create(GOOGLE_OUI, SLSI_NL80211_VENDOR_SUBCMD_RTT_GET_CAPABILITIES);
508 if (ret < 0) {
509 ALOGE("NL message creation failed");
510 return ret;
511 }
512
513 return ret;
514 }
515protected:
516 virtual int handleResponse(WifiEvent& reply) {
517
518 if (reply.get_cmd() != NL80211_CMD_VENDOR) {
519 ALOGE("Ignoring reply with cmd = %d", reply.get_cmd());
520 return NL_SKIP;
521 }
522 void *data = reply.get_vendor_data();
523 int len = reply.get_vendor_data_len();
524
525 memcpy(mCapabilities, data, min(len, (int) sizeof(*mCapabilities)));
526 ALOGE("RTT capa response");
527 return NL_OK;
528 }
529};
530/*class GetRttResponderInfoCommand : public WifiCommand
531{
532 wifi_rtt_responder* mResponderInfo;
533public:
534 GetRttResponderInfoCommand(wifi_interface_handle iface, wifi_rtt_responder *responderInfo)
535 : WifiCommand(iface, 0), mResponderInfo(responderInfo)
536 {
537 memset(mResponderInfo, 0 , sizeof(*mResponderInfo));
538
539 }
540
541 virtual int create() {
542 ALOGD("Creating message to get responder info ; iface = %d", mIfaceInfo->id);
543
544 int ret = mMsg.create(GOOGLE_OUI, SLSI_NL80211_VENDOR_SUBCMD_RTT_GETAVAILCHANNEL);
545 if (ret < 0) {
546 return ret;
547 }
548
549 // return ret;
550 }
551
552protected:
553 virtual int handleResponse(WifiEvent& reply) {
554
555 ALOGD("In GetRttResponderInfoCommand::handleResponse");
556
557 if (reply.get_cmd() != NL80211_CMD_VENDOR) {
558 ALOGD("Ignoring reply with cmd = %d", reply.get_cmd());
559 return NL_SKIP;
560 }
561
562 int id = reply.get_vendor_id();
563 int subcmd = reply.get_vendor_subcmd();
564
565 void *data = reply.get_vendor_data();
566 int len = reply.get_vendor_data_len();
567
568 ALOGD("Id = %0x, subcmd = %d, len = %d, expected len = %d", id, subcmd, len,
569 sizeof(*mResponderInfo));
570
571 memcpy(mResponderInfo, data, min(len, (int) sizeof(*mResponderInfo)));
572
573 return NL_OK;
574 }
575};*/
576
577 /* API to request RTT measurement */
7753f181
DD		 578wifi_error wifi_rtt_range_request(wifi_request_id id, wifi_interface_handle iface,
579 unsigned num_rtt_config, wifi_rtt_config rtt_config[], wifi_rtt_event_handler handler)
580{
47e18f37
JPS		 581 ALOGE("Inside RTT RANGE range request");
582 wifi_handle handle = getWifiHandle(iface);
583 RttCommand *cmd = new RttCommand(iface, id, num_rtt_config, rtt_config, handler);
584 NULL_CHECK_RETURN(cmd, "memory allocation failure", WIFI_ERROR_OUT_OF_MEMORY);
585 wifi_error result = wifi_register_cmd(handle, id, cmd);
586 if (result != WIFI_SUCCESS) {
587 cmd->releaseRef();
588 return result;
589 }
590 result = (wifi_error)cmd->start();
591 if (result != WIFI_SUCCESS) {
592 wifi_unregister_cmd(handle, id);
593 cmd->releaseRef();
594 return result;
595 }
596 ALOGE("wifi range request successfully executed");
597 return result;
7753f181
DD		 598}
599
600/* API to cancel RTT measurements */
601wifi_error wifi_rtt_range_cancel(wifi_request_id id, wifi_interface_handle iface,
602 unsigned num_devices, mac_addr addr[])
603{
47e18f37
JPS		 604 if (!iface)
605 return WIFI_ERROR_UNINITIALIZED;
606 RttCommand *cmd = new RttCommand(iface, id);
607 NULL_CHECK_RETURN(cmd, "memory allocation failure", WIFI_ERROR_OUT_OF_MEMORY);
608 cmd->cancel_specific(num_devices, addr);
609 cmd->releaseRef();
610 return WIFI_SUCCESS;
7753f181
DD		 611}
612
613/* API to get RTT capability */
614wifi_error wifi_get_rtt_capabilities(wifi_interface_handle iface,
615 wifi_rtt_capabilities *capabilities)
616{
47e18f37
JPS		 617 ALOGE("Inside get rtt capabilities cap:%p iface:%p", capabilities, iface);
618 if (!iface)
619 return WIFI_ERROR_UNINITIALIZED;
620 GetRttCapabilitiesCommand command(iface, capabilities);
621 return (wifi_error) command.requestResponse();
7753f181 622
47e18f37
JPS		 623}
624/* API to get the responder information */
625wifi_error wifi_rtt_get_responder_info(wifi_interface_handle iface,
626 wifi_rtt_responder* responderInfo)
627{
628 /*GetRttResponderInfoCommand command(iface, responderInfo);
629 return (wifi_error) command.requestResponse();*/
7753f181 630 return WIFI_ERROR_NOT_SUPPORTED;
47e18f37 631
7753f181 632}