Commit | Line | Data |
---|---|---|
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 |
27 | using namespace std; |
28 | ||
29 | typedef 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 | ||
56 | enum 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 | ||
90 | struct dot11_rm_ie { | |
91 | u8 id; | |
92 | u8 len; | |
93 | u8 token; | |
94 | u8 mode; | |
95 | u8 type; | |
96 | } __attribute__ ((packed)); | |
97 | typedef struct dot11_rm_ie dot11_rm_ie_t; | |
98 | typedef struct strmap_entry { | |
99 | int id; | |
100 | string text; | |
101 | } strmap_entry_t; | |
102 | ||
103 | static 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 | }*/ | |
133 | class RttCommand : public WifiCommand | |
134 | { | |
135 | int rtt_id; | |
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; | |
144 | public: | |
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) { | |
419 | rtt_result->number_per_burst_peer = (byte)nl_nested_itr.get_u8(); | |
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) { | |
423 | rtt_result->retry_after_duration = (byte)nl_nested_itr.get_u8(); | |
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 | }; | |
496 | class GetRttCapabilitiesCommand : public WifiCommand | |
497 | { | |
498 | wifi_rtt_capabilities *mCapabilities; | |
499 | public: | |
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 | } | |
515 | protected: | |
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; | |
533 | public: | |
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 | ||
552 | protected: | |
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 |
578 | wifi_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 */ | |
601 | wifi_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 */ | |
614 | wifi_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 */ | |
625 | wifi_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 | } |