Branch data Line data Source code
1 : : /*
2 : : * Wi-Fi Direct - P2P module
3 : : * Copyright (c) 2009-2010, Atheros Communications
4 : : *
5 : : * This software may be distributed under the terms of the BSD license.
6 : : * See README for more details.
7 : : */
8 : :
9 : : #include "includes.h"
10 : :
11 : : #include "common.h"
12 : : #include "eloop.h"
13 : : #include "common/ieee802_11_defs.h"
14 : : #include "common/ieee802_11_common.h"
15 : : #include "wps/wps_i.h"
16 : : #include "p2p_i.h"
17 : : #include "p2p.h"
18 : :
19 : :
20 : : static void p2p_state_timeout(void *eloop_ctx, void *timeout_ctx);
21 : : static void p2p_device_free(struct p2p_data *p2p, struct p2p_device *dev);
22 : : static void p2p_process_presence_req(struct p2p_data *p2p, const u8 *da,
23 : : const u8 *sa, const u8 *data, size_t len,
24 : : int rx_freq);
25 : : static void p2p_process_presence_resp(struct p2p_data *p2p, const u8 *da,
26 : : const u8 *sa, const u8 *data,
27 : : size_t len);
28 : : static void p2p_ext_listen_timeout(void *eloop_ctx, void *timeout_ctx);
29 : : static void p2p_scan_timeout(void *eloop_ctx, void *timeout_ctx);
30 : :
31 : :
32 : : /*
33 : : * p2p_scan recovery timeout
34 : : *
35 : : * Many drivers are using 30 second timeout on scan results. Allow a bit larger
36 : : * timeout for this to avoid hitting P2P timeout unnecessarily.
37 : : */
38 : : #define P2P_SCAN_TIMEOUT 35
39 : :
40 : : /**
41 : : * P2P_PEER_EXPIRATION_AGE - Number of seconds after which inactive peer
42 : : * entries will be removed
43 : : */
44 : : #define P2P_PEER_EXPIRATION_AGE 300
45 : :
46 : : #define P2P_PEER_EXPIRATION_INTERVAL (P2P_PEER_EXPIRATION_AGE / 2)
47 : :
48 : 21 : static void p2p_expire_peers(struct p2p_data *p2p)
49 : : {
50 : : struct p2p_device *dev, *n;
51 : : struct os_reltime now;
52 : : size_t i;
53 : :
54 : 21 : os_get_reltime(&now);
55 [ + + ]: 25 : dl_list_for_each_safe(dev, n, &p2p->devices, struct p2p_device, list) {
56 [ + - ]: 4 : if (dev->last_seen.sec + P2P_PEER_EXPIRATION_AGE >= now.sec)
57 : 4 : continue;
58 : :
59 [ # # # # ]: 0 : if (p2p->cfg->go_connected &&
60 : 0 : p2p->cfg->go_connected(p2p->cfg->cb_ctx,
61 : 0 : dev->info.p2p_device_addr)) {
62 : : /*
63 : : * We are connected as a client to a group in which the
64 : : * peer is the GO, so do not expire the peer entry.
65 : : */
66 : 0 : os_get_reltime(&dev->last_seen);
67 : 0 : continue;
68 : : }
69 : :
70 [ # # ]: 0 : for (i = 0; i < p2p->num_groups; i++) {
71 [ # # ]: 0 : if (p2p_group_is_client_connected(
72 : 0 : p2p->groups[i], dev->info.p2p_device_addr))
73 : 0 : break;
74 : : }
75 [ # # ]: 0 : if (i < p2p->num_groups) {
76 : : /*
77 : : * The peer is connected as a client in a group where
78 : : * we are the GO, so do not expire the peer entry.
79 : : */
80 : 0 : os_get_reltime(&dev->last_seen);
81 : 0 : continue;
82 : : }
83 : :
84 : 0 : p2p_dbg(p2p, "Expiring old peer entry " MACSTR,
85 : 0 : MAC2STR(dev->info.p2p_device_addr));
86 : 0 : dl_list_del(&dev->list);
87 : 0 : p2p_device_free(p2p, dev);
88 : : }
89 : 21 : }
90 : :
91 : :
92 : 21 : static void p2p_expiration_timeout(void *eloop_ctx, void *timeout_ctx)
93 : : {
94 : 21 : struct p2p_data *p2p = eloop_ctx;
95 : 21 : p2p_expire_peers(p2p);
96 : 21 : eloop_register_timeout(P2P_PEER_EXPIRATION_INTERVAL, 0,
97 : : p2p_expiration_timeout, p2p, NULL);
98 : 21 : }
99 : :
100 : :
101 : 9205 : static const char * p2p_state_txt(int state)
102 : : {
103 [ + + + + : 9205 : switch (state) {
+ + + + +
+ + + - +
- - ]
104 : : case P2P_IDLE:
105 : 5281 : return "IDLE";
106 : : case P2P_SEARCH:
107 : 2363 : return "SEARCH";
108 : : case P2P_CONNECT:
109 : 474 : return "CONNECT";
110 : : case P2P_CONNECT_LISTEN:
111 : 62 : return "CONNECT_LISTEN";
112 : : case P2P_GO_NEG:
113 : 242 : return "GO_NEG";
114 : : case P2P_LISTEN_ONLY:
115 : 387 : return "LISTEN_ONLY";
116 : : case P2P_WAIT_PEER_CONNECT:
117 : 30 : return "WAIT_PEER_CONNECT";
118 : : case P2P_WAIT_PEER_IDLE:
119 : 24 : return "WAIT_PEER_IDLE";
120 : : case P2P_SD_DURING_FIND:
121 : 45 : return "SD_DURING_FIND";
122 : : case P2P_PROVISIONING:
123 : 204 : return "PROVISIONING";
124 : : case P2P_PD_DURING_FIND:
125 : 12 : return "PD_DURING_FIND";
126 : : case P2P_INVITE:
127 : 66 : return "INVITE";
128 : : case P2P_INVITE_LISTEN:
129 : 0 : return "INVITE_LISTEN";
130 : : case P2P_SEARCH_WHEN_READY:
131 : 15 : return "SEARCH_WHEN_READY";
132 : : case P2P_CONTINUE_SEARCH_WHEN_READY:
133 : 0 : return "CONTINUE_SEARCH_WHEN_READY";
134 : : default:
135 : 9205 : return "?";
136 : : }
137 : : }
138 : :
139 : :
140 : 0 : const char * p2p_get_state_txt(struct p2p_data *p2p)
141 : : {
142 : 0 : return p2p_state_txt(p2p->state);
143 : : }
144 : :
145 : :
146 : 18 : u16 p2p_get_provisioning_info(struct p2p_data *p2p, const u8 *addr)
147 : : {
148 : 18 : struct p2p_device *dev = NULL;
149 : :
150 [ + - ][ - + ]: 18 : if (!addr || !p2p)
151 : 0 : return 0;
152 : :
153 : 18 : dev = p2p_get_device(p2p, addr);
154 [ + - ]: 18 : if (dev)
155 : 18 : return dev->wps_prov_info;
156 : : else
157 : 18 : return 0;
158 : : }
159 : :
160 : :
161 : 65 : void p2p_clear_provisioning_info(struct p2p_data *p2p, const u8 *addr)
162 : : {
163 : 65 : struct p2p_device *dev = NULL;
164 : :
165 [ + - ][ - + ]: 65 : if (!addr || !p2p)
166 : 65 : return;
167 : :
168 : 65 : dev = p2p_get_device(p2p, addr);
169 [ + + ]: 65 : if (dev)
170 : 59 : dev->wps_prov_info = 0;
171 : : }
172 : :
173 : :
174 : 2775 : void p2p_set_state(struct p2p_data *p2p, int new_state)
175 : : {
176 : 2775 : p2p_dbg(p2p, "State %s -> %s",
177 : 2775 : p2p_state_txt(p2p->state), p2p_state_txt(new_state));
178 : 2775 : p2p->state = new_state;
179 : 2775 : }
180 : :
181 : :
182 : 678 : void p2p_set_timeout(struct p2p_data *p2p, unsigned int sec, unsigned int usec)
183 : : {
184 : 678 : p2p_dbg(p2p, "Set timeout (state=%s): %u.%06u sec",
185 : 678 : p2p_state_txt(p2p->state), sec, usec);
186 : 678 : eloop_cancel_timeout(p2p_state_timeout, p2p, NULL);
187 : 678 : eloop_register_timeout(sec, usec, p2p_state_timeout, p2p, NULL);
188 : 678 : }
189 : :
190 : :
191 : 2144 : void p2p_clear_timeout(struct p2p_data *p2p)
192 : : {
193 : 2144 : p2p_dbg(p2p, "Clear timeout (state=%s)", p2p_state_txt(p2p->state));
194 : 2144 : eloop_cancel_timeout(p2p_state_timeout, p2p, NULL);
195 : 2144 : }
196 : :
197 : :
198 : 5 : void p2p_go_neg_failed(struct p2p_data *p2p, struct p2p_device *peer,
199 : : int status)
200 : : {
201 : : struct p2p_go_neg_results res;
202 : 5 : p2p_clear_timeout(p2p);
203 : 5 : p2p_set_state(p2p, P2P_IDLE);
204 [ + - ]: 5 : if (p2p->go_neg_peer) {
205 : 5 : p2p->go_neg_peer->flags &= ~P2P_DEV_PEER_WAITING_RESPONSE;
206 : 5 : p2p->go_neg_peer->wps_method = WPS_NOT_READY;
207 : : }
208 : 5 : p2p->go_neg_peer = NULL;
209 : :
210 : 5 : os_memset(&res, 0, sizeof(res));
211 : 5 : res.status = status;
212 [ + - ]: 5 : if (peer) {
213 : 5 : os_memcpy(res.peer_device_addr, peer->info.p2p_device_addr,
214 : : ETH_ALEN);
215 : 5 : os_memcpy(res.peer_interface_addr, peer->intended_addr,
216 : : ETH_ALEN);
217 : : }
218 : 5 : p2p->cfg->go_neg_completed(p2p->cfg->cb_ctx, &res);
219 : 5 : }
220 : :
221 : :
222 : 432 : static void p2p_listen_in_find(struct p2p_data *p2p, int dev_disc)
223 : : {
224 : : unsigned int r, tu;
225 : : int freq;
226 : : struct wpabuf *ies;
227 : :
228 : 432 : p2p_dbg(p2p, "Starting short listen state (state=%s)",
229 : 432 : p2p_state_txt(p2p->state));
230 : :
231 : 432 : freq = p2p_channel_to_freq(p2p->cfg->reg_class, p2p->cfg->channel);
232 [ - + ]: 432 : if (freq < 0) {
233 : 0 : p2p_dbg(p2p, "Unknown regulatory class/channel");
234 : 0 : return;
235 : : }
236 : :
237 : 432 : os_get_random((u8 *) &r, sizeof(r));
238 : 864 : tu = (r % ((p2p->max_disc_int - p2p->min_disc_int) + 1) +
239 : 432 : p2p->min_disc_int) * 100;
240 [ - + ][ # # ]: 432 : if (p2p->max_disc_tu >= 0 && tu > (unsigned int) p2p->max_disc_tu)
241 : 0 : tu = p2p->max_disc_tu;
242 [ + + ][ - + ]: 432 : if (!dev_disc && tu < 100)
243 : 0 : tu = 100; /* Need to wait in non-device discovery use cases */
244 [ + - ][ - + ]: 432 : if (p2p->cfg->max_listen && 1024 * tu / 1000 > p2p->cfg->max_listen)
245 : 0 : tu = p2p->cfg->max_listen * 1000 / 1024;
246 : :
247 [ - + ]: 432 : if (tu == 0) {
248 : 0 : p2p_dbg(p2p, "Skip listen state since duration was 0 TU");
249 : 0 : p2p_set_timeout(p2p, 0, 0);
250 : 0 : return;
251 : : }
252 : :
253 : 432 : p2p->pending_listen_freq = freq;
254 : 432 : p2p->pending_listen_sec = 0;
255 : 432 : p2p->pending_listen_usec = 1024 * tu;
256 : :
257 : 432 : ies = p2p_build_probe_resp_ies(p2p);
258 [ - + ]: 432 : if (ies == NULL)
259 : 0 : return;
260 : :
261 [ - + ]: 432 : if (p2p->cfg->start_listen(p2p->cfg->cb_ctx, freq, 1024 * tu / 1000,
262 : : ies) < 0) {
263 : 0 : p2p_dbg(p2p, "Failed to start listen mode");
264 : 0 : p2p->pending_listen_freq = 0;
265 : : }
266 : 432 : wpabuf_free(ies);
267 : : }
268 : :
269 : :
270 : 99 : int p2p_listen(struct p2p_data *p2p, unsigned int timeout)
271 : : {
272 : : int freq;
273 : : struct wpabuf *ies;
274 : :
275 : 99 : p2p_dbg(p2p, "Going to listen(only) state");
276 : :
277 : 99 : freq = p2p_channel_to_freq(p2p->cfg->reg_class, p2p->cfg->channel);
278 [ - + ]: 99 : if (freq < 0) {
279 : 0 : p2p_dbg(p2p, "Unknown regulatory class/channel");
280 : 0 : return -1;
281 : : }
282 : :
283 : 99 : p2p->pending_listen_freq = freq;
284 : 99 : p2p->pending_listen_sec = timeout / 1000;
285 : 99 : p2p->pending_listen_usec = (timeout % 1000) * 1000;
286 : :
287 [ + + ]: 99 : if (p2p->p2p_scan_running) {
288 [ - + ]: 1 : if (p2p->start_after_scan == P2P_AFTER_SCAN_CONNECT) {
289 : 0 : p2p_dbg(p2p, "p2p_scan running - connect is already pending - skip listen");
290 : 0 : return 0;
291 : : }
292 : 1 : p2p_dbg(p2p, "p2p_scan running - delay start of listen state");
293 : 1 : p2p->start_after_scan = P2P_AFTER_SCAN_LISTEN;
294 : 1 : return 0;
295 : : }
296 : :
297 : 98 : ies = p2p_build_probe_resp_ies(p2p);
298 [ - + ]: 98 : if (ies == NULL)
299 : 0 : return -1;
300 : :
301 [ - + ]: 98 : if (p2p->cfg->start_listen(p2p->cfg->cb_ctx, freq, timeout, ies) < 0) {
302 : 0 : p2p_dbg(p2p, "Failed to start listen mode");
303 : 0 : p2p->pending_listen_freq = 0;
304 : 0 : wpabuf_free(ies);
305 : 0 : return -1;
306 : : }
307 : 98 : wpabuf_free(ies);
308 : :
309 : 98 : p2p_set_state(p2p, P2P_LISTEN_ONLY);
310 : :
311 : 99 : return 0;
312 : : }
313 : :
314 : :
315 : 112 : static void p2p_device_clear_reported(struct p2p_data *p2p)
316 : : {
317 : : struct p2p_device *dev;
318 [ + + ]: 147 : dl_list_for_each(dev, &p2p->devices, struct p2p_device, list)
319 : 35 : dev->flags &= ~P2P_DEV_REPORTED;
320 : 112 : }
321 : :
322 : :
323 : : /**
324 : : * p2p_get_device - Fetch a peer entry
325 : : * @p2p: P2P module context from p2p_init()
326 : : * @addr: P2P Device Address of the peer
327 : : * Returns: Pointer to the device entry or %NULL if not found
328 : : */
329 : 1788 : struct p2p_device * p2p_get_device(struct p2p_data *p2p, const u8 *addr)
330 : : {
331 : : struct p2p_device *dev;
332 [ + + ]: 1902 : dl_list_for_each(dev, &p2p->devices, struct p2p_device, list) {
333 [ + + ]: 1569 : if (os_memcmp(dev->info.p2p_device_addr, addr, ETH_ALEN) == 0)
334 : 1455 : return dev;
335 : : }
336 : 1788 : return NULL;
337 : : }
338 : :
339 : :
340 : : /**
341 : : * p2p_get_device_interface - Fetch a peer entry based on P2P Interface Address
342 : : * @p2p: P2P module context from p2p_init()
343 : : * @addr: P2P Interface Address of the peer
344 : : * Returns: Pointer to the device entry or %NULL if not found
345 : : */
346 : 35 : struct p2p_device * p2p_get_device_interface(struct p2p_data *p2p,
347 : : const u8 *addr)
348 : : {
349 : : struct p2p_device *dev;
350 [ + + ]: 72 : dl_list_for_each(dev, &p2p->devices, struct p2p_device, list) {
351 [ + + ]: 43 : if (os_memcmp(dev->interface_addr, addr, ETH_ALEN) == 0)
352 : 6 : return dev;
353 : : }
354 : 35 : return NULL;
355 : : }
356 : :
357 : :
358 : : /**
359 : : * p2p_create_device - Create a peer entry
360 : : * @p2p: P2P module context from p2p_init()
361 : : * @addr: P2P Device Address of the peer
362 : : * Returns: Pointer to the device entry or %NULL on failure
363 : : *
364 : : * If there is already an entry for the peer, it will be returned instead of
365 : : * creating a new one.
366 : : */
367 : 626 : static struct p2p_device * p2p_create_device(struct p2p_data *p2p,
368 : : const u8 *addr)
369 : : {
370 : 626 : struct p2p_device *dev, *oldest = NULL;
371 : 626 : size_t count = 0;
372 : :
373 : 626 : dev = p2p_get_device(p2p, addr);
374 [ + + ]: 626 : if (dev)
375 : 480 : return dev;
376 : :
377 [ + + ]: 161 : dl_list_for_each(dev, &p2p->devices, struct p2p_device, list) {
378 : 15 : count++;
379 [ - + # # ]: 15 : if (oldest == NULL ||
380 : 0 : os_reltime_before(&dev->last_seen, &oldest->last_seen))
381 : 15 : oldest = dev;
382 : : }
383 [ - + ][ # # ]: 146 : if (count + 1 > p2p->cfg->max_peers && oldest) {
384 : 0 : p2p_dbg(p2p, "Remove oldest peer entry to make room for a new peer");
385 : 0 : dl_list_del(&oldest->list);
386 : 0 : p2p_device_free(p2p, oldest);
387 : : }
388 : :
389 : 146 : dev = os_zalloc(sizeof(*dev));
390 [ - + ]: 146 : if (dev == NULL)
391 : 0 : return NULL;
392 : 146 : dl_list_add(&p2p->devices, &dev->list);
393 : 146 : os_memcpy(dev->info.p2p_device_addr, addr, ETH_ALEN);
394 : :
395 : 626 : return dev;
396 : : }
397 : :
398 : :
399 : 10 : static void p2p_copy_client_info(struct p2p_device *dev,
400 : : struct p2p_client_info *cli)
401 : : {
402 : 10 : os_memcpy(dev->info.device_name, cli->dev_name, cli->dev_name_len);
403 : 10 : dev->info.device_name[cli->dev_name_len] = '\0';
404 : 10 : dev->info.dev_capab = cli->dev_capab;
405 : 10 : dev->info.config_methods = cli->config_methods;
406 : 10 : os_memcpy(dev->info.pri_dev_type, cli->pri_dev_type, 8);
407 : 10 : dev->info.wps_sec_dev_type_list_len = 8 * cli->num_sec_dev_types;
408 : 10 : os_memcpy(dev->info.wps_sec_dev_type_list, cli->sec_dev_types,
409 : : dev->info.wps_sec_dev_type_list_len);
410 : 10 : }
411 : :
412 : :
413 : 322 : static int p2p_add_group_clients(struct p2p_data *p2p, const u8 *go_dev_addr,
414 : : const u8 *go_interface_addr, int freq,
415 : : const u8 *gi, size_t gi_len)
416 : : {
417 : : struct p2p_group_info info;
418 : : size_t c;
419 : : struct p2p_device *dev;
420 : :
421 [ + + ]: 322 : if (gi == NULL)
422 : 311 : return 0;
423 : :
424 [ - + ]: 11 : if (p2p_group_info_parse(gi, gi_len, &info) < 0)
425 : 0 : return -1;
426 : :
427 : : /*
428 : : * Clear old data for this group; if the devices are still in the
429 : : * group, the information will be restored in the loop following this.
430 : : */
431 [ + + ]: 26 : dl_list_for_each(dev, &p2p->devices, struct p2p_device, list) {
432 [ + + ]: 15 : if (os_memcmp(dev->member_in_go_iface, go_interface_addr,
433 : : ETH_ALEN) == 0) {
434 : 4 : os_memset(dev->member_in_go_iface, 0, ETH_ALEN);
435 : 4 : os_memset(dev->member_in_go_dev, 0, ETH_ALEN);
436 : : }
437 : : }
438 : :
439 [ + + ]: 22 : for (c = 0; c < info.num_clients; c++) {
440 : 11 : struct p2p_client_info *cli = &info.client[c];
441 [ + + ]: 11 : if (os_memcmp(cli->p2p_device_addr, p2p->cfg->dev_addr,
442 : : ETH_ALEN) == 0)
443 : 1 : continue; /* ignore our own entry */
444 : 10 : dev = p2p_get_device(p2p, cli->p2p_device_addr);
445 [ + + ]: 10 : if (dev) {
446 [ + - ]: 4 : if (dev->flags & (P2P_DEV_GROUP_CLIENT_ONLY |
447 : : P2P_DEV_PROBE_REQ_ONLY)) {
448 : : /*
449 : : * Update information since we have not
450 : : * received this directly from the client.
451 : : */
452 : 4 : p2p_copy_client_info(dev, cli);
453 : : } else {
454 : : /*
455 : : * Need to update P2P Client Discoverability
456 : : * flag since it is valid only in P2P Group
457 : : * Info attribute.
458 : : */
459 : 0 : dev->info.dev_capab &=
460 : : ~P2P_DEV_CAPAB_CLIENT_DISCOVERABILITY;
461 : 0 : dev->info.dev_capab |=
462 : 0 : cli->dev_capab &
463 : : P2P_DEV_CAPAB_CLIENT_DISCOVERABILITY;
464 : : }
465 [ - + ]: 4 : if (dev->flags & P2P_DEV_PROBE_REQ_ONLY) {
466 : 0 : dev->flags &= ~P2P_DEV_PROBE_REQ_ONLY;
467 : : }
468 : : } else {
469 : 6 : dev = p2p_create_device(p2p, cli->p2p_device_addr);
470 [ - + ]: 6 : if (dev == NULL)
471 : 0 : continue;
472 : 6 : dev->flags |= P2P_DEV_GROUP_CLIENT_ONLY;
473 : 6 : p2p_copy_client_info(dev, cli);
474 : 6 : dev->oper_freq = freq;
475 : 6 : p2p->cfg->dev_found(p2p->cfg->cb_ctx,
476 : 6 : dev->info.p2p_device_addr,
477 : 6 : &dev->info, 1);
478 : 6 : dev->flags |= P2P_DEV_REPORTED | P2P_DEV_REPORTED_ONCE;
479 : : }
480 : :
481 : 10 : os_memcpy(dev->interface_addr, cli->p2p_interface_addr,
482 : : ETH_ALEN);
483 : 10 : os_get_reltime(&dev->last_seen);
484 : 10 : os_memcpy(dev->member_in_go_dev, go_dev_addr, ETH_ALEN);
485 : 10 : os_memcpy(dev->member_in_go_iface, go_interface_addr,
486 : : ETH_ALEN);
487 : : }
488 : :
489 : 322 : return 0;
490 : : }
491 : :
492 : :
493 : 527 : static void p2p_copy_wps_info(struct p2p_data *p2p, struct p2p_device *dev,
494 : : int probe_req, const struct p2p_message *msg)
495 : : {
496 : 527 : os_memcpy(dev->info.device_name, msg->device_name,
497 : : sizeof(dev->info.device_name));
498 : :
499 [ + + ][ + - ]: 527 : if (msg->manufacturer &&
500 : 390 : msg->manufacturer_len < sizeof(dev->info.manufacturer)) {
501 : 390 : os_memset(dev->info.manufacturer, 0,
502 : : sizeof(dev->info.manufacturer));
503 : 390 : os_memcpy(dev->info.manufacturer, msg->manufacturer,
504 : : msg->manufacturer_len);
505 : : }
506 : :
507 [ + + ][ + - ]: 527 : if (msg->model_name &&
508 : 390 : msg->model_name_len < sizeof(dev->info.model_name)) {
509 : 390 : os_memset(dev->info.model_name, 0,
510 : : sizeof(dev->info.model_name));
511 : 390 : os_memcpy(dev->info.model_name, msg->model_name,
512 : : msg->model_name_len);
513 : : }
514 : :
515 [ + + ][ + - ]: 527 : if (msg->model_number &&
516 : 390 : msg->model_number_len < sizeof(dev->info.model_number)) {
517 : 390 : os_memset(dev->info.model_number, 0,
518 : : sizeof(dev->info.model_number));
519 : 390 : os_memcpy(dev->info.model_number, msg->model_number,
520 : : msg->model_number_len);
521 : : }
522 : :
523 [ + + ][ + - ]: 527 : if (msg->serial_number &&
524 : 322 : msg->serial_number_len < sizeof(dev->info.serial_number)) {
525 : 322 : os_memset(dev->info.serial_number, 0,
526 : : sizeof(dev->info.serial_number));
527 : 322 : os_memcpy(dev->info.serial_number, msg->serial_number,
528 : : msg->serial_number_len);
529 : : }
530 : :
531 [ + + ]: 527 : if (msg->pri_dev_type)
532 : 459 : os_memcpy(dev->info.pri_dev_type, msg->pri_dev_type,
533 : : sizeof(dev->info.pri_dev_type));
534 [ + - ]: 68 : else if (msg->wps_pri_dev_type)
535 : 68 : os_memcpy(dev->info.pri_dev_type, msg->wps_pri_dev_type,
536 : : sizeof(dev->info.pri_dev_type));
537 : :
538 [ - + ]: 527 : if (msg->wps_sec_dev_type_list) {
539 : 0 : os_memcpy(dev->info.wps_sec_dev_type_list,
540 : : msg->wps_sec_dev_type_list,
541 : : msg->wps_sec_dev_type_list_len);
542 : 0 : dev->info.wps_sec_dev_type_list_len =
543 : 0 : msg->wps_sec_dev_type_list_len;
544 : : }
545 : :
546 [ + + ]: 527 : if (msg->capability) {
547 : : /*
548 : : * P2P Client Discoverability bit is reserved in all frames
549 : : * that use this function, so do not change its value here.
550 : : */
551 : 526 : dev->info.dev_capab &= P2P_DEV_CAPAB_CLIENT_DISCOVERABILITY;
552 : 526 : dev->info.dev_capab |= msg->capability[0] &
553 : : ~P2P_DEV_CAPAB_CLIENT_DISCOVERABILITY;
554 : 526 : dev->info.group_capab = msg->capability[1];
555 : : }
556 : :
557 [ - + ]: 527 : if (msg->ext_listen_timing) {
558 : 0 : dev->ext_listen_period = WPA_GET_LE16(msg->ext_listen_timing);
559 : 0 : dev->ext_listen_interval =
560 : 0 : WPA_GET_LE16(msg->ext_listen_timing + 2);
561 : : }
562 : :
563 [ + + ]: 527 : if (!probe_req) {
564 : : u16 new_config_methods;
565 [ + - ]: 459 : new_config_methods = msg->config_methods ?
566 : : msg->config_methods : msg->wps_config_methods;
567 [ + - ][ + + ]: 459 : if (new_config_methods &&
568 : 459 : dev->info.config_methods != new_config_methods) {
569 : 129 : p2p_dbg(p2p, "Update peer " MACSTR
570 : : " config_methods 0x%x -> 0x%x",
571 : 774 : MAC2STR(dev->info.p2p_device_addr),
572 : 129 : dev->info.config_methods,
573 : : new_config_methods);
574 : 129 : dev->info.config_methods = new_config_methods;
575 : : }
576 : : }
577 : 527 : }
578 : :
579 : :
580 : : /**
581 : : * p2p_add_device - Add peer entries based on scan results or P2P frames
582 : : * @p2p: P2P module context from p2p_init()
583 : : * @addr: Source address of Beacon or Probe Response frame (may be either
584 : : * P2P Device Address or P2P Interface Address)
585 : : * @level: Signal level (signal strength of the received frame from the peer)
586 : : * @freq: Frequency on which the Beacon or Probe Response frame was received
587 : : * @rx_time: Time when the result was received
588 : : * @ies: IEs from the Beacon or Probe Response frame
589 : : * @ies_len: Length of ies buffer in octets
590 : : * @scan_res: Whether this was based on scan results
591 : : * Returns: 0 on success, -1 on failure
592 : : *
593 : : * If the scan result is for a GO, the clients in the group will also be added
594 : : * to the peer table. This function can also be used with some other frames
595 : : * like Provision Discovery Request that contains P2P Capability and P2P Device
596 : : * Info attributes.
597 : : */
598 : 613 : int p2p_add_device(struct p2p_data *p2p, const u8 *addr, int freq,
599 : : struct os_reltime *rx_time, int level, const u8 *ies,
600 : : size_t ies_len, int scan_res)
601 : : {
602 : : struct p2p_device *dev;
603 : : struct p2p_message msg;
604 : : const u8 *p2p_dev_addr;
605 : : int i;
606 : : struct os_reltime time_now;
607 : :
608 : 613 : os_memset(&msg, 0, sizeof(msg));
609 [ - + ]: 613 : if (p2p_parse_ies(ies, ies_len, &msg)) {
610 : 0 : p2p_dbg(p2p, "Failed to parse P2P IE for a device entry");
611 : 0 : p2p_parse_free(&msg);
612 : 0 : return -1;
613 : : }
614 : :
615 [ + + ]: 613 : if (msg.p2p_device_addr)
616 : 551 : p2p_dev_addr = msg.p2p_device_addr;
617 [ - + ]: 62 : else if (msg.device_id)
618 : 0 : p2p_dev_addr = msg.device_id;
619 : : else {
620 : 62 : p2p_dbg(p2p, "Ignore scan data without P2P Device Info or P2P Device Id");
621 : 62 : p2p_parse_free(&msg);
622 : 62 : return -1;
623 : : }
624 : :
625 [ - + ][ # # ]: 551 : if (!is_zero_ether_addr(p2p->peer_filter) &&
626 : 0 : os_memcmp(p2p_dev_addr, p2p->peer_filter, ETH_ALEN) != 0) {
627 : 0 : p2p_dbg(p2p, "Do not add peer filter for " MACSTR
628 : 0 : " due to peer filter", MAC2STR(p2p_dev_addr));
629 : 0 : p2p_parse_free(&msg);
630 : 0 : return 0;
631 : : }
632 : :
633 : 551 : dev = p2p_create_device(p2p, p2p_dev_addr);
634 [ - + ]: 551 : if (dev == NULL) {
635 : 0 : p2p_parse_free(&msg);
636 : 0 : return -1;
637 : : }
638 : :
639 [ + + ]: 551 : if (rx_time == NULL) {
640 : 133 : os_get_reltime(&time_now);
641 : 133 : rx_time = &time_now;
642 : : }
643 : :
644 : : /*
645 : : * Update the device entry only if the new peer
646 : : * entry is newer than the one previously stored.
647 : : */
648 [ + + + + ]: 1031 : if (dev->last_seen.sec > 0 &&
649 : 480 : os_reltime_before(rx_time, &dev->last_seen)) {
650 : 96 : p2p_dbg(p2p, "Do not update peer entry based on old frame (rx_time=%u.%06u last_seen=%u.%06u)",
651 : 96 : (unsigned int) rx_time->sec,
652 : 96 : (unsigned int) rx_time->usec,
653 : 96 : (unsigned int) dev->last_seen.sec,
654 : 96 : (unsigned int) dev->last_seen.usec);
655 : 96 : p2p_parse_free(&msg);
656 : 96 : return -1;
657 : : }
658 : :
659 : 455 : os_memcpy(&dev->last_seen, rx_time, sizeof(struct os_reltime));
660 : :
661 : 455 : dev->flags &= ~(P2P_DEV_PROBE_REQ_ONLY | P2P_DEV_GROUP_CLIENT_ONLY);
662 : :
663 [ + + ]: 455 : if (os_memcmp(addr, p2p_dev_addr, ETH_ALEN) != 0)
664 : 28 : os_memcpy(dev->interface_addr, addr, ETH_ALEN);
665 [ + + ][ + + ]: 455 : if (msg.ssid &&
666 [ - + ]: 285 : (msg.ssid[1] != P2P_WILDCARD_SSID_LEN ||
667 : 285 : os_memcmp(msg.ssid + 2, P2P_WILDCARD_SSID, P2P_WILDCARD_SSID_LEN)
668 : : != 0)) {
669 : 154 : os_memcpy(dev->oper_ssid, msg.ssid + 2, msg.ssid[1]);
670 : 154 : dev->oper_ssid_len = msg.ssid[1];
671 : : }
672 : :
673 [ + + ][ + - ]: 455 : if (freq >= 2412 && freq <= 2484 && msg.ds_params &&
[ + + ][ + - ]
674 [ + - ]: 322 : *msg.ds_params >= 1 && *msg.ds_params <= 14) {
675 : : int ds_freq;
676 [ - + ]: 322 : if (*msg.ds_params == 14)
677 : 0 : ds_freq = 2484;
678 : : else
679 : 322 : ds_freq = 2407 + *msg.ds_params * 5;
680 [ - + ]: 322 : if (freq != ds_freq) {
681 : 0 : p2p_dbg(p2p, "Update Listen frequency based on DS Parameter Set IE: %d -> %d MHz",
682 : : freq, ds_freq);
683 : 0 : freq = ds_freq;
684 : : }
685 : : }
686 : :
687 [ + + ][ + + ]: 455 : if (dev->listen_freq && dev->listen_freq != freq && scan_res) {
[ + + ]
688 [ + - ]: 4 : p2p_dbg(p2p, "Update Listen frequency based on scan results ("
689 : : MACSTR " %d -> %d MHz (DS param %d)",
690 : 24 : MAC2STR(dev->info.p2p_device_addr), dev->listen_freq,
691 : 8 : freq, msg.ds_params ? *msg.ds_params : -1);
692 : : }
693 [ + + ]: 455 : if (scan_res) {
694 : 322 : dev->listen_freq = freq;
695 [ + + ]: 322 : if (msg.group_info)
696 : 11 : dev->oper_freq = freq;
697 : : }
698 : 455 : dev->info.level = level;
699 : :
700 : 455 : p2p_copy_wps_info(p2p, dev, 0, &msg);
701 : :
702 [ + + ]: 5005 : for (i = 0; i < P2P_MAX_WPS_VENDOR_EXT; i++) {
703 : 4550 : wpabuf_free(dev->info.wps_vendor_ext[i]);
704 : 4550 : dev->info.wps_vendor_ext[i] = NULL;
705 : : }
706 : :
707 [ + - ]: 455 : for (i = 0; i < P2P_MAX_WPS_VENDOR_EXT; i++) {
708 [ + - ]: 455 : if (msg.wps_vendor_ext[i] == NULL)
709 : 455 : break;
710 : 0 : dev->info.wps_vendor_ext[i] = wpabuf_alloc_copy(
711 : 0 : msg.wps_vendor_ext[i], msg.wps_vendor_ext_len[i]);
712 [ # # ]: 0 : if (dev->info.wps_vendor_ext[i] == NULL)
713 : 0 : break;
714 : : }
715 : :
716 [ + + ]: 455 : if (msg.wfd_subelems) {
717 : 393 : wpabuf_free(dev->info.wfd_subelems);
718 : 393 : dev->info.wfd_subelems = wpabuf_dup(msg.wfd_subelems);
719 : : }
720 : :
721 [ + + ]: 455 : if (scan_res) {
722 : 322 : p2p_add_group_clients(p2p, p2p_dev_addr, addr, freq,
723 : : msg.group_info, msg.group_info_len);
724 : : }
725 : :
726 : 455 : p2p_parse_free(&msg);
727 : :
728 [ + + ]: 455 : if (p2p_pending_sd_req(p2p, dev))
729 : 8 : dev->flags |= P2P_DEV_SD_SCHEDULE;
730 : :
731 [ + + ]: 455 : if (dev->flags & P2P_DEV_REPORTED)
732 : 330 : return 0;
733 : :
734 : 125 : p2p_dbg(p2p, "Peer found with Listen frequency %d MHz (rx_time=%u.%06u)",
735 : 125 : freq, (unsigned int) rx_time->sec,
736 : 125 : (unsigned int) rx_time->usec);
737 [ - + ]: 125 : if (dev->flags & P2P_DEV_USER_REJECTED) {
738 : 0 : p2p_dbg(p2p, "Do not report rejected device");
739 : 0 : return 0;
740 : : }
741 : :
742 [ - + ][ # # ]: 125 : if (dev->info.config_methods == 0 &&
743 [ # # ][ # # ]: 0 : (freq == 2412 || freq == 2437 || freq == 2462)) {
744 : : /*
745 : : * If we have only seen a Beacon frame from a GO, we do not yet
746 : : * know what WPS config methods it supports. Since some
747 : : * applications use config_methods value from P2P-DEVICE-FOUND
748 : : * events, postpone reporting this peer until we've fully
749 : : * discovered its capabilities.
750 : : *
751 : : * At least for now, do this only if the peer was detected on
752 : : * one of the social channels since that peer can be easily be
753 : : * found again and there are no limitations of having to use
754 : : * passive scan on this channels, so this can be done through
755 : : * Probe Response frame that includes the config_methods
756 : : * information.
757 : : */
758 : 0 : p2p_dbg(p2p, "Do not report peer " MACSTR
759 : 0 : " with unknown config methods", MAC2STR(addr));
760 : 0 : return 0;
761 : : }
762 : :
763 : 125 : p2p->cfg->dev_found(p2p->cfg->cb_ctx, addr, &dev->info,
764 : 125 : !(dev->flags & P2P_DEV_REPORTED_ONCE));
765 : 125 : dev->flags |= P2P_DEV_REPORTED | P2P_DEV_REPORTED_ONCE;
766 : :
767 : 613 : return 0;
768 : : }
769 : :
770 : :
771 : 146 : static void p2p_device_free(struct p2p_data *p2p, struct p2p_device *dev)
772 : : {
773 : : int i;
774 : :
775 [ - + ]: 146 : if (p2p->go_neg_peer == dev) {
776 : : /*
777 : : * If GO Negotiation is in progress, report that it has failed.
778 : : */
779 : 0 : p2p_go_neg_failed(p2p, dev, -1);
780 : 0 : p2p->go_neg_peer = NULL;
781 : : }
782 [ - + ]: 146 : if (p2p->invite_peer == dev)
783 : 0 : p2p->invite_peer = NULL;
784 [ - + ]: 146 : if (p2p->sd_peer == dev)
785 : 0 : p2p->sd_peer = NULL;
786 [ + + ]: 146 : if (p2p->pending_client_disc_go == dev)
787 : 1 : p2p->pending_client_disc_go = NULL;
788 : :
789 : : /* dev_lost() device, but only if it was previously dev_found() */
790 [ + + ]: 146 : if (dev->flags & P2P_DEV_REPORTED_ONCE)
791 : 135 : p2p->cfg->dev_lost(p2p->cfg->cb_ctx,
792 : 135 : dev->info.p2p_device_addr);
793 : :
794 [ + + ]: 1606 : for (i = 0; i < P2P_MAX_WPS_VENDOR_EXT; i++) {
795 : 1460 : wpabuf_free(dev->info.wps_vendor_ext[i]);
796 : 1460 : dev->info.wps_vendor_ext[i] = NULL;
797 : : }
798 : :
799 : 146 : wpabuf_free(dev->info.wfd_subelems);
800 : :
801 : 146 : os_free(dev);
802 : 146 : }
803 : :
804 : :
805 : 0 : static int p2p_get_next_prog_freq(struct p2p_data *p2p)
806 : : {
807 : : struct p2p_channels *c;
808 : : struct p2p_reg_class *cla;
809 : : size_t cl, ch;
810 : 0 : int found = 0;
811 : : u8 reg_class;
812 : : u8 channel;
813 : : int freq;
814 : :
815 : 0 : c = &p2p->cfg->channels;
816 [ # # ]: 0 : for (cl = 0; cl < c->reg_classes; cl++) {
817 : 0 : cla = &c->reg_class[cl];
818 [ # # ]: 0 : if (cla->reg_class != p2p->last_prog_scan_class)
819 : 0 : continue;
820 [ # # ]: 0 : for (ch = 0; ch < cla->channels; ch++) {
821 [ # # ]: 0 : if (cla->channel[ch] == p2p->last_prog_scan_chan) {
822 : 0 : found = 1;
823 : 0 : break;
824 : : }
825 : : }
826 [ # # ]: 0 : if (found)
827 : 0 : break;
828 : : }
829 : :
830 [ # # ]: 0 : if (!found) {
831 : : /* Start from beginning */
832 : 0 : reg_class = c->reg_class[0].reg_class;
833 : 0 : channel = c->reg_class[0].channel[0];
834 : : } else {
835 : : /* Pick the next channel */
836 : 0 : ch++;
837 [ # # ]: 0 : if (ch == cla->channels) {
838 : 0 : cl++;
839 [ # # ]: 0 : if (cl == c->reg_classes)
840 : 0 : cl = 0;
841 : 0 : ch = 0;
842 : : }
843 : 0 : reg_class = c->reg_class[cl].reg_class;
844 : 0 : channel = c->reg_class[cl].channel[ch];
845 : : }
846 : :
847 : 0 : freq = p2p_channel_to_freq(reg_class, channel);
848 : 0 : p2p_dbg(p2p, "Next progressive search channel: reg_class %u channel %u -> %d MHz",
849 : : reg_class, channel, freq);
850 : 0 : p2p->last_prog_scan_class = reg_class;
851 : 0 : p2p->last_prog_scan_chan = channel;
852 : :
853 [ # # ][ # # ]: 0 : if (freq == 2412 || freq == 2437 || freq == 2462)
[ # # ]
854 : 0 : return 0; /* No need to add social channels */
855 : 0 : return freq;
856 : : }
857 : :
858 : :
859 : 354 : static void p2p_search(struct p2p_data *p2p)
860 : : {
861 : 354 : int freq = 0;
862 : : enum p2p_scan_type type;
863 : 354 : u16 pw_id = DEV_PW_DEFAULT;
864 : : int res;
865 : :
866 [ + + ]: 354 : if (p2p->drv_in_listen) {
867 : 4 : p2p_dbg(p2p, "Driver is still in Listen state - wait for it to end before continuing");
868 : 354 : return;
869 : : }
870 : 350 : p2p->cfg->stop_listen(p2p->cfg->cb_ctx);
871 : :
872 [ - + ][ # # ]: 350 : if (p2p->find_type == P2P_FIND_PROGRESSIVE &&
873 : : (freq = p2p_get_next_prog_freq(p2p)) > 0) {
874 : 0 : type = P2P_SCAN_SOCIAL_PLUS_ONE;
875 : 0 : p2p_dbg(p2p, "Starting search (+ freq %u)", freq);
876 : : } else {
877 : 350 : type = P2P_SCAN_SOCIAL;
878 : 350 : p2p_dbg(p2p, "Starting search");
879 : : }
880 : :
881 : 350 : res = p2p->cfg->p2p_scan(p2p->cfg->cb_ctx, type, freq,
882 : 350 : p2p->num_req_dev_types, p2p->req_dev_types,
883 : 350 : p2p->find_dev_id, pw_id);
884 [ - + ]: 350 : if (res < 0) {
885 : 0 : p2p_dbg(p2p, "Scan request failed");
886 : 0 : p2p_continue_find(p2p);
887 [ - + ]: 350 : } else if (res == 1) {
888 : 0 : p2p_dbg(p2p, "Could not start p2p_scan at this point - will try again after previous scan completes");
889 : 0 : p2p_set_state(p2p, P2P_CONTINUE_SEARCH_WHEN_READY);
890 : : } else {
891 : 350 : p2p_dbg(p2p, "Running p2p_scan");
892 : 350 : p2p->p2p_scan_running = 1;
893 : 350 : eloop_cancel_timeout(p2p_scan_timeout, p2p, NULL);
894 : 350 : eloop_register_timeout(P2P_SCAN_TIMEOUT, 0, p2p_scan_timeout,
895 : : p2p, NULL);
896 : : }
897 : : }
898 : :
899 : :
900 : 0 : static void p2p_find_timeout(void *eloop_ctx, void *timeout_ctx)
901 : : {
902 : 0 : struct p2p_data *p2p = eloop_ctx;
903 : 0 : p2p_dbg(p2p, "Find timeout -> stop");
904 : 0 : p2p_stop_find(p2p);
905 : 0 : }
906 : :
907 : :
908 : 475 : static int p2p_run_after_scan(struct p2p_data *p2p)
909 : : {
910 : : struct p2p_device *dev;
911 : : enum p2p_after_scan op;
912 : :
913 [ + + ]: 475 : if (p2p->after_scan_tx) {
914 : 16 : p2p->after_scan_tx_in_progress = 1;
915 : 16 : p2p_dbg(p2p, "Send pending Action frame at p2p_scan completion");
916 : 16 : p2p->cfg->send_action(p2p->cfg->cb_ctx,
917 : 16 : p2p->after_scan_tx->freq,
918 : 16 : p2p->after_scan_tx->dst,
919 : 16 : p2p->after_scan_tx->src,
920 : 16 : p2p->after_scan_tx->bssid,
921 : 16 : (u8 *) (p2p->after_scan_tx + 1),
922 : 16 : p2p->after_scan_tx->len,
923 : 16 : p2p->after_scan_tx->wait_time);
924 : 16 : os_free(p2p->after_scan_tx);
925 : 16 : p2p->after_scan_tx = NULL;
926 : 16 : return 1;
927 : : }
928 : :
929 : 459 : op = p2p->start_after_scan;
930 : 459 : p2p->start_after_scan = P2P_AFTER_SCAN_NOTHING;
931 [ + + + - ]: 459 : switch (op) {
932 : : case P2P_AFTER_SCAN_NOTHING:
933 : 437 : break;
934 : : case P2P_AFTER_SCAN_LISTEN:
935 : 1 : p2p_dbg(p2p, "Start previously requested Listen state");
936 : 1 : p2p_listen(p2p, p2p->pending_listen_sec * 1000 +
937 : 1 : p2p->pending_listen_usec / 1000);
938 : 1 : return 1;
939 : : case P2P_AFTER_SCAN_CONNECT:
940 : 21 : p2p_dbg(p2p, "Start previously requested connect with " MACSTR,
941 : 126 : MAC2STR(p2p->after_scan_peer));
942 : 21 : dev = p2p_get_device(p2p, p2p->after_scan_peer);
943 [ - + ]: 21 : if (dev == NULL) {
944 : 0 : p2p_dbg(p2p, "Peer not known anymore");
945 : 0 : break;
946 : : }
947 : 21 : p2p_connect_send(p2p, dev);
948 : 21 : return 1;
949 : : }
950 : :
951 : 475 : return 0;
952 : : }
953 : :
954 : :
955 : 0 : static void p2p_scan_timeout(void *eloop_ctx, void *timeout_ctx)
956 : : {
957 : 0 : struct p2p_data *p2p = eloop_ctx;
958 : : int running;
959 : 0 : p2p_dbg(p2p, "p2p_scan timeout (running=%d)", p2p->p2p_scan_running);
960 : 0 : running = p2p->p2p_scan_running;
961 : : /* Make sure we recover from missed scan results callback */
962 : 0 : p2p->p2p_scan_running = 0;
963 : :
964 [ # # ]: 0 : if (running)
965 : 0 : p2p_run_after_scan(p2p);
966 : 0 : }
967 : :
968 : :
969 : 1817 : static void p2p_free_req_dev_types(struct p2p_data *p2p)
970 : : {
971 : 1817 : p2p->num_req_dev_types = 0;
972 : 1817 : os_free(p2p->req_dev_types);
973 : 1817 : p2p->req_dev_types = NULL;
974 : 1817 : }
975 : :
976 : :
977 : 112 : int p2p_find(struct p2p_data *p2p, unsigned int timeout,
978 : : enum p2p_discovery_type type,
979 : : unsigned int num_req_dev_types, const u8 *req_dev_types,
980 : : const u8 *dev_id, unsigned int search_delay)
981 : : {
982 : : int res;
983 : :
984 : 112 : p2p_dbg(p2p, "Starting find (type=%d)", type);
985 : 112 : os_get_reltime(&p2p->find_start);
986 [ + + ]: 112 : if (p2p->p2p_scan_running) {
987 : 2 : p2p_dbg(p2p, "p2p_scan is already running");
988 : : }
989 : :
990 : 112 : p2p_free_req_dev_types(p2p);
991 [ - + ][ # # ]: 112 : if (req_dev_types && num_req_dev_types) {
992 : 0 : p2p->req_dev_types = os_malloc(num_req_dev_types *
993 : : WPS_DEV_TYPE_LEN);
994 [ # # ]: 0 : if (p2p->req_dev_types == NULL)
995 : 0 : return -1;
996 : 0 : os_memcpy(p2p->req_dev_types, req_dev_types,
997 : : num_req_dev_types * WPS_DEV_TYPE_LEN);
998 : 0 : p2p->num_req_dev_types = num_req_dev_types;
999 : : }
1000 : :
1001 [ - + ]: 112 : if (dev_id) {
1002 : 0 : os_memcpy(p2p->find_dev_id_buf, dev_id, ETH_ALEN);
1003 : 0 : p2p->find_dev_id = p2p->find_dev_id_buf;
1004 : : } else
1005 : 112 : p2p->find_dev_id = NULL;
1006 : :
1007 : 112 : p2p->start_after_scan = P2P_AFTER_SCAN_NOTHING;
1008 : 112 : p2p_clear_timeout(p2p);
1009 : 112 : p2p->cfg->stop_listen(p2p->cfg->cb_ctx);
1010 : 112 : p2p->find_type = type;
1011 : 112 : p2p_device_clear_reported(p2p);
1012 : 112 : p2p_set_state(p2p, P2P_SEARCH);
1013 : 112 : p2p->search_delay = search_delay;
1014 : 112 : p2p->in_search_delay = 0;
1015 : 112 : eloop_cancel_timeout(p2p_find_timeout, p2p, NULL);
1016 : 112 : p2p->last_p2p_find_timeout = timeout;
1017 [ - + ]: 112 : if (timeout)
1018 : 0 : eloop_register_timeout(timeout, 0, p2p_find_timeout,
1019 : : p2p, NULL);
1020 [ + + - ]: 112 : switch (type) {
1021 : : case P2P_FIND_START_WITH_FULL:
1022 : : case P2P_FIND_PROGRESSIVE:
1023 : 13 : res = p2p->cfg->p2p_scan(p2p->cfg->cb_ctx, P2P_SCAN_FULL, 0,
1024 : : p2p->num_req_dev_types,
1025 : 13 : p2p->req_dev_types, dev_id,
1026 : : DEV_PW_DEFAULT);
1027 : 13 : break;
1028 : : case P2P_FIND_ONLY_SOCIAL:
1029 : 99 : res = p2p->cfg->p2p_scan(p2p->cfg->cb_ctx, P2P_SCAN_SOCIAL, 0,
1030 : : p2p->num_req_dev_types,
1031 : 99 : p2p->req_dev_types, dev_id,
1032 : : DEV_PW_DEFAULT);
1033 : 99 : break;
1034 : : default:
1035 : 0 : return -1;
1036 : : }
1037 : :
1038 [ + + ]: 112 : if (res == 0) {
1039 : 107 : p2p_dbg(p2p, "Running p2p_scan");
1040 : 107 : p2p->p2p_scan_running = 1;
1041 : 107 : eloop_cancel_timeout(p2p_scan_timeout, p2p, NULL);
1042 : 107 : eloop_register_timeout(P2P_SCAN_TIMEOUT, 0, p2p_scan_timeout,
1043 : : p2p, NULL);
1044 [ + - ]: 5 : } else if (res == 1) {
1045 : 5 : p2p_dbg(p2p, "Could not start p2p_scan at this point - will try again after previous scan completes");
1046 : 5 : res = 0;
1047 : 5 : p2p_set_state(p2p, P2P_SEARCH_WHEN_READY);
1048 : 5 : eloop_cancel_timeout(p2p_find_timeout, p2p, NULL);
1049 : : } else {
1050 : 0 : p2p_dbg(p2p, "Failed to start p2p_scan");
1051 : 0 : p2p_set_state(p2p, P2P_IDLE);
1052 : 0 : eloop_cancel_timeout(p2p_find_timeout, p2p, NULL);
1053 : : }
1054 : :
1055 : 112 : return res;
1056 : : }
1057 : :
1058 : :
1059 : 4 : int p2p_other_scan_completed(struct p2p_data *p2p)
1060 : : {
1061 [ - + ]: 4 : if (p2p->state == P2P_CONTINUE_SEARCH_WHEN_READY) {
1062 : 0 : p2p_set_state(p2p, P2P_SEARCH);
1063 : 0 : p2p_search(p2p);
1064 : 0 : return 1;
1065 : : }
1066 [ - + ]: 4 : if (p2p->state != P2P_SEARCH_WHEN_READY)
1067 : 0 : return 0;
1068 : 4 : p2p_dbg(p2p, "Starting pending P2P find now that previous scan was completed");
1069 [ - + ]: 4 : if (p2p_find(p2p, p2p->last_p2p_find_timeout, p2p->find_type,
1070 : 4 : p2p->num_req_dev_types, p2p->req_dev_types,
1071 : 4 : p2p->find_dev_id, p2p->search_delay) < 0) {
1072 : 0 : p2p->cfg->find_stopped(p2p->cfg->cb_ctx);
1073 : 0 : return 0;
1074 : : }
1075 : 4 : return 1;
1076 : : }
1077 : :
1078 : :
1079 : 1695 : void p2p_stop_find_for_freq(struct p2p_data *p2p, int freq)
1080 : : {
1081 : 1695 : p2p_dbg(p2p, "Stopping find");
1082 : 1695 : eloop_cancel_timeout(p2p_find_timeout, p2p, NULL);
1083 : 1695 : p2p_clear_timeout(p2p);
1084 [ + + ][ + - ]: 1695 : if (p2p->state == P2P_SEARCH ||
1085 [ - + ]: 1590 : p2p->state == P2P_CONTINUE_SEARCH_WHEN_READY ||
1086 : 1590 : p2p->state == P2P_SEARCH_WHEN_READY)
1087 : 105 : p2p->cfg->find_stopped(p2p->cfg->cb_ctx);
1088 : 1695 : p2p_set_state(p2p, P2P_IDLE);
1089 : 1695 : p2p_free_req_dev_types(p2p);
1090 : 1695 : p2p->start_after_scan = P2P_AFTER_SCAN_NOTHING;
1091 [ + + ]: 1695 : if (p2p->go_neg_peer)
1092 : 7 : p2p->go_neg_peer->flags &= ~P2P_DEV_PEER_WAITING_RESPONSE;
1093 : 1695 : p2p->go_neg_peer = NULL;
1094 : 1695 : p2p->sd_peer = NULL;
1095 : 1695 : p2p->invite_peer = NULL;
1096 : 1695 : p2p_stop_listen_for_freq(p2p, freq);
1097 : 1695 : }
1098 : :
1099 : :
1100 : 1701 : void p2p_stop_listen_for_freq(struct p2p_data *p2p, int freq)
1101 : : {
1102 [ + + ][ + + ]: 1701 : if (freq > 0 && p2p->drv_in_listen == freq && p2p->in_listen) {
[ + - ]
1103 : 24 : p2p_dbg(p2p, "Skip stop_listen since we are on correct channel for response");
1104 : 1701 : return;
1105 : : }
1106 [ + + ]: 1677 : if (p2p->in_listen) {
1107 : 92 : p2p->in_listen = 0;
1108 : 92 : p2p_clear_timeout(p2p);
1109 : : }
1110 [ + + ]: 1677 : if (p2p->drv_in_listen) {
1111 : : /*
1112 : : * The driver may not deliver callback to p2p_listen_end()
1113 : : * when the operation gets canceled, so clear the internal
1114 : : * variable that is tracking driver state.
1115 : : */
1116 : 65 : p2p_dbg(p2p, "Clear drv_in_listen (%d)", p2p->drv_in_listen);
1117 : 65 : p2p->drv_in_listen = 0;
1118 : : }
1119 : 1677 : p2p->cfg->stop_listen(p2p->cfg->cb_ctx);
1120 : : }
1121 : :
1122 : :
1123 : 489 : void p2p_stop_listen(struct p2p_data *p2p)
1124 : : {
1125 [ + - ]: 489 : if (p2p->state != P2P_LISTEN_ONLY) {
1126 : 489 : p2p_dbg(p2p, "Skip stop_listen since not in listen_only state.");
1127 : 489 : return;
1128 : : }
1129 : :
1130 : 0 : p2p_stop_listen_for_freq(p2p, 0);
1131 : 0 : p2p_set_state(p2p, P2P_IDLE);
1132 : : }
1133 : :
1134 : :
1135 : 1660 : void p2p_stop_find(struct p2p_data *p2p)
1136 : : {
1137 : 1660 : p2p_stop_find_for_freq(p2p, 0);
1138 : 1660 : }
1139 : :
1140 : :
1141 : 21 : static int p2p_prepare_channel_pref(struct p2p_data *p2p,
1142 : : unsigned int force_freq,
1143 : : unsigned int pref_freq, int go)
1144 : : {
1145 : : u8 op_class, op_channel;
1146 [ + + ]: 21 : unsigned int freq = force_freq ? force_freq : pref_freq;
1147 : :
1148 : 21 : p2p_dbg(p2p, "Prepare channel pref - force_freq=%u pref_freq=%u go=%d",
1149 : : force_freq, pref_freq, go);
1150 [ - + ]: 21 : if (p2p_freq_to_channel(freq, &op_class, &op_channel) < 0) {
1151 : 0 : p2p_dbg(p2p, "Unsupported frequency %u MHz", freq);
1152 : 0 : return -1;
1153 : : }
1154 : :
1155 [ - + ][ # # ]: 21 : if (!p2p_channels_includes(&p2p->cfg->channels, op_class, op_channel) &&
1156 [ # # ]: 0 : (go || !p2p_channels_includes(&p2p->cfg->cli_channels, op_class,
1157 : : op_channel))) {
1158 : 0 : p2p_dbg(p2p, "Frequency %u MHz (oper_class %u channel %u) not allowed for P2P",
1159 : : freq, op_class, op_channel);
1160 : 0 : return -1;
1161 : : }
1162 : :
1163 : 21 : p2p->op_reg_class = op_class;
1164 : 21 : p2p->op_channel = op_channel;
1165 : :
1166 [ + + ]: 21 : if (force_freq) {
1167 : 20 : p2p->channels.reg_classes = 1;
1168 : 20 : p2p->channels.reg_class[0].channels = 1;
1169 : 20 : p2p->channels.reg_class[0].reg_class = p2p->op_reg_class;
1170 : 20 : p2p->channels.reg_class[0].channel[0] = p2p->op_channel;
1171 : : } else {
1172 : 1 : os_memcpy(&p2p->channels, &p2p->cfg->channels,
1173 : : sizeof(struct p2p_channels));
1174 : : }
1175 : :
1176 : 21 : return 0;
1177 : : }
1178 : :
1179 : :
1180 : 69 : static void p2p_prepare_channel_best(struct p2p_data *p2p)
1181 : : {
1182 : : u8 op_class, op_channel;
1183 : 69 : const int op_classes_5ghz[] = { 124, 115, 0 };
1184 : 69 : const int op_classes_ht40[] = { 126, 127, 116, 117, 0 };
1185 : 69 : const int op_classes_vht[] = { 128, 0 };
1186 : :
1187 : 69 : p2p_dbg(p2p, "Prepare channel best");
1188 : :
1189 [ + - ]: 69 : if (!p2p->cfg->cfg_op_channel && p2p->best_freq_overall > 0 &&
[ - + # # ]
1190 [ # # ]: 0 : p2p_supported_freq(p2p, p2p->best_freq_overall) &&
1191 : 0 : p2p_freq_to_channel(p2p->best_freq_overall, &op_class, &op_channel)
1192 : : == 0) {
1193 : 0 : p2p_dbg(p2p, "Select best overall channel as operating channel preference");
1194 : 0 : p2p->op_reg_class = op_class;
1195 : 0 : p2p->op_channel = op_channel;
1196 [ + - ]: 69 : } else if (!p2p->cfg->cfg_op_channel && p2p->best_freq_5 > 0 &&
[ - + # # ]
1197 [ # # ]: 0 : p2p_supported_freq(p2p, p2p->best_freq_5) &&
1198 : 0 : p2p_freq_to_channel(p2p->best_freq_5, &op_class, &op_channel)
1199 : : == 0) {
1200 : 0 : p2p_dbg(p2p, "Select best 5 GHz channel as operating channel preference");
1201 : 0 : p2p->op_reg_class = op_class;
1202 : 0 : p2p->op_channel = op_channel;
1203 [ + - ]: 69 : } else if (!p2p->cfg->cfg_op_channel && p2p->best_freq_24 > 0 &&
[ - + # # ]
1204 [ # # ]: 0 : p2p_supported_freq(p2p, p2p->best_freq_24) &&
1205 : 0 : p2p_freq_to_channel(p2p->best_freq_24, &op_class,
1206 : : &op_channel) == 0) {
1207 : 0 : p2p_dbg(p2p, "Select best 2.4 GHz channel as operating channel preference");
1208 : 0 : p2p->op_reg_class = op_class;
1209 : 0 : p2p->op_channel = op_channel;
1210 [ + + + - ]: 71 : } else if (p2p->cfg->num_pref_chan > 0 &&
1211 : 2 : p2p_channels_includes(&p2p->cfg->channels,
1212 : 2 : p2p->cfg->pref_chan[0].op_class,
1213 : 2 : p2p->cfg->pref_chan[0].chan)) {
1214 : 2 : p2p_dbg(p2p, "Select first pref_chan entry as operating channel preference");
1215 : 2 : p2p->op_reg_class = p2p->cfg->pref_chan[0].op_class;
1216 : 2 : p2p->op_channel = p2p->cfg->pref_chan[0].chan;
1217 [ - + ]: 67 : } else if (p2p_channel_select(&p2p->cfg->channels, op_classes_vht,
1218 : : &p2p->op_reg_class, &p2p->op_channel) ==
1219 : : 0) {
1220 : 0 : p2p_dbg(p2p, "Select possible VHT channel (op_class %u channel %u) as operating channel preference",
1221 : 0 : p2p->op_reg_class, p2p->op_channel);
1222 [ - + ]: 67 : } else if (p2p_channel_select(&p2p->cfg->channels, op_classes_ht40,
1223 : : &p2p->op_reg_class, &p2p->op_channel) ==
1224 : : 0) {
1225 : 0 : p2p_dbg(p2p, "Select possible HT40 channel (op_class %u channel %u) as operating channel preference",
1226 : 0 : p2p->op_reg_class, p2p->op_channel);
1227 [ - + ]: 67 : } else if (p2p_channel_select(&p2p->cfg->channels, op_classes_5ghz,
1228 : : &p2p->op_reg_class, &p2p->op_channel) ==
1229 : : 0) {
1230 : 0 : p2p_dbg(p2p, "Select possible 5 GHz channel (op_class %u channel %u) as operating channel preference",
1231 : 0 : p2p->op_reg_class, p2p->op_channel);
1232 : : } else {
1233 : 67 : p2p_dbg(p2p, "Select pre-configured channel as operating channel preference");
1234 : 67 : p2p->op_reg_class = p2p->cfg->op_reg_class;
1235 : 67 : p2p->op_channel = p2p->cfg->op_channel;
1236 : : }
1237 : :
1238 : 69 : os_memcpy(&p2p->channels, &p2p->cfg->channels,
1239 : : sizeof(struct p2p_channels));
1240 : 69 : }
1241 : :
1242 : :
1243 : : /**
1244 : : * p2p_prepare_channel - Select operating channel for GO Negotiation
1245 : : * @p2p: P2P module context from p2p_init()
1246 : : * @dev: Selected peer device
1247 : : * @force_freq: Forced frequency in MHz or 0 if not forced
1248 : : * @pref_freq: Preferred frequency in MHz or 0 if no preference
1249 : : * @go: Whether the local end will be forced to be GO
1250 : : * Returns: 0 on success, -1 on failure (channel not supported for P2P)
1251 : : *
1252 : : * This function is used to do initial operating channel selection for GO
1253 : : * Negotiation prior to having received peer information. The selected channel
1254 : : * may be further optimized in p2p_reselect_channel() once the peer information
1255 : : * is available.
1256 : : */
1257 : 90 : int p2p_prepare_channel(struct p2p_data *p2p, struct p2p_device *dev,
1258 : : unsigned int force_freq, unsigned int pref_freq, int go)
1259 : : {
1260 : 90 : p2p_dbg(p2p, "Prepare channel - force_freq=%u pref_freq=%u go=%d",
1261 : : force_freq, pref_freq, go);
1262 [ + + ][ + + ]: 90 : if (force_freq || pref_freq) {
1263 [ - + ]: 21 : if (p2p_prepare_channel_pref(p2p, force_freq, pref_freq, go) <
1264 : : 0)
1265 : 0 : return -1;
1266 : : } else {
1267 : 69 : p2p_prepare_channel_best(p2p);
1268 : : }
1269 : 90 : p2p_channels_dump(p2p, "prepared channels", &p2p->channels);
1270 [ + + ]: 90 : if (go)
1271 : 42 : p2p_channels_remove_freqs(&p2p->channels, &p2p->no_go_freq);
1272 [ + + ]: 48 : else if (!force_freq)
1273 : 38 : p2p_channels_union(&p2p->channels, &p2p->cfg->cli_channels,
1274 : : &p2p->channels);
1275 : 90 : p2p_channels_dump(p2p, "after go/cli filter/add", &p2p->channels);
1276 : :
1277 [ + + ]: 90 : p2p_dbg(p2p, "Own preference for operation channel: Operating Class %u Channel %u%s",
1278 : 180 : p2p->op_reg_class, p2p->op_channel,
1279 : : force_freq ? " (forced)" : "");
1280 : :
1281 [ + + ]: 90 : if (force_freq)
1282 : 20 : dev->flags |= P2P_DEV_FORCE_FREQ;
1283 : : else
1284 : 70 : dev->flags &= ~P2P_DEV_FORCE_FREQ;
1285 : :
1286 : 90 : return 0;
1287 : : }
1288 : :
1289 : :
1290 : 79 : static void p2p_set_dev_persistent(struct p2p_device *dev,
1291 : : int persistent_group)
1292 : : {
1293 [ + + + - ]: 79 : switch (persistent_group) {
1294 : : case 0:
1295 : 69 : dev->flags &= ~(P2P_DEV_PREFER_PERSISTENT_GROUP |
1296 : : P2P_DEV_PREFER_PERSISTENT_RECONN);
1297 : 69 : break;
1298 : : case 1:
1299 : 2 : dev->flags |= P2P_DEV_PREFER_PERSISTENT_GROUP;
1300 : 2 : dev->flags &= ~P2P_DEV_PREFER_PERSISTENT_RECONN;
1301 : 2 : break;
1302 : : case 2:
1303 : 8 : dev->flags |= P2P_DEV_PREFER_PERSISTENT_GROUP |
1304 : : P2P_DEV_PREFER_PERSISTENT_RECONN;
1305 : 8 : break;
1306 : : }
1307 : 79 : }
1308 : :
1309 : :
1310 : 45 : int p2p_connect(struct p2p_data *p2p, const u8 *peer_addr,
1311 : : enum p2p_wps_method wps_method,
1312 : : int go_intent, const u8 *own_interface_addr,
1313 : : unsigned int force_freq, int persistent_group,
1314 : : const u8 *force_ssid, size_t force_ssid_len,
1315 : : int pd_before_go_neg, unsigned int pref_freq)
1316 : : {
1317 : : struct p2p_device *dev;
1318 : :
1319 : 45 : p2p_dbg(p2p, "Request to start group negotiation - peer=" MACSTR
1320 : : " GO Intent=%d Intended Interface Address=" MACSTR
1321 : : " wps_method=%d persistent_group=%d pd_before_go_neg=%d",
1322 : 540 : MAC2STR(peer_addr), go_intent, MAC2STR(own_interface_addr),
1323 : : wps_method, persistent_group, pd_before_go_neg);
1324 : :
1325 : 45 : dev = p2p_get_device(p2p, peer_addr);
1326 [ + - ][ - + ]: 45 : if (dev == NULL || (dev->flags & P2P_DEV_PROBE_REQ_ONLY)) {
1327 : 0 : p2p_dbg(p2p, "Cannot connect to unknown P2P Device " MACSTR,
1328 : 0 : MAC2STR(peer_addr));
1329 : 0 : return -1;
1330 : : }
1331 : :
1332 [ - + ]: 45 : if (p2p_prepare_channel(p2p, dev, force_freq, pref_freq,
1333 : : go_intent == 15) < 0)
1334 : 0 : return -1;
1335 : :
1336 [ + + ]: 45 : if (dev->flags & P2P_DEV_GROUP_CLIENT_ONLY) {
1337 [ - + ]: 1 : if (!(dev->info.dev_capab &
1338 : : P2P_DEV_CAPAB_CLIENT_DISCOVERABILITY)) {
1339 : 0 : p2p_dbg(p2p, "Cannot connect to P2P Device " MACSTR
1340 : : " that is in a group and is not discoverable",
1341 : 0 : MAC2STR(peer_addr));
1342 : 0 : return -1;
1343 : : }
1344 [ - + ]: 1 : if (dev->oper_freq <= 0) {
1345 : 0 : p2p_dbg(p2p, "Cannot connect to P2P Device " MACSTR
1346 : : " with incomplete information",
1347 : 0 : MAC2STR(peer_addr));
1348 : 0 : return -1;
1349 : : }
1350 : :
1351 : : /*
1352 : : * First, try to connect directly. If the peer does not
1353 : : * acknowledge frames, assume it is sleeping and use device
1354 : : * discoverability via the GO at that point.
1355 : : */
1356 : : }
1357 : :
1358 : 45 : p2p->ssid_set = 0;
1359 [ - + ]: 45 : if (force_ssid) {
1360 : 0 : wpa_hexdump_ascii(MSG_DEBUG, "P2P: Forced SSID",
1361 : : force_ssid, force_ssid_len);
1362 : 0 : os_memcpy(p2p->ssid, force_ssid, force_ssid_len);
1363 : 0 : p2p->ssid_len = force_ssid_len;
1364 : 0 : p2p->ssid_set = 1;
1365 : : }
1366 : :
1367 : 45 : dev->flags &= ~P2P_DEV_NOT_YET_READY;
1368 : 45 : dev->flags &= ~P2P_DEV_USER_REJECTED;
1369 : 45 : dev->flags &= ~P2P_DEV_WAIT_GO_NEG_RESPONSE;
1370 : 45 : dev->flags &= ~P2P_DEV_WAIT_GO_NEG_CONFIRM;
1371 [ - + ]: 45 : if (pd_before_go_neg)
1372 : 0 : dev->flags |= P2P_DEV_PD_BEFORE_GO_NEG;
1373 : : else {
1374 : 45 : dev->flags &= ~P2P_DEV_PD_BEFORE_GO_NEG;
1375 : : /*
1376 : : * Assign dialog token and tie breaker here to use the same
1377 : : * values in each retry within the same GO Negotiation exchange.
1378 : : */
1379 : 45 : dev->dialog_token++;
1380 [ - + ]: 45 : if (dev->dialog_token == 0)
1381 : 0 : dev->dialog_token = 1;
1382 : 45 : dev->tie_breaker = p2p->next_tie_breaker;
1383 : 45 : p2p->next_tie_breaker = !p2p->next_tie_breaker;
1384 : : }
1385 : 45 : dev->connect_reqs = 0;
1386 : 45 : dev->go_neg_req_sent = 0;
1387 : 45 : dev->go_state = UNKNOWN_GO;
1388 : 45 : p2p_set_dev_persistent(dev, persistent_group);
1389 : 45 : p2p->go_intent = go_intent;
1390 : 45 : os_memcpy(p2p->intended_addr, own_interface_addr, ETH_ALEN);
1391 : :
1392 [ + - ]: 45 : if (p2p->state != P2P_IDLE)
1393 : 45 : p2p_stop_find(p2p);
1394 : :
1395 [ - + ]: 45 : if (p2p->after_scan_tx) {
1396 : : /*
1397 : : * We need to drop the pending frame to avoid issues with the
1398 : : * new GO Negotiation, e.g., when the pending frame was from a
1399 : : * previous attempt at starting a GO Negotiation.
1400 : : */
1401 : 0 : p2p_dbg(p2p, "Dropped previous pending Action frame TX that was waiting for p2p_scan completion");
1402 : 0 : os_free(p2p->after_scan_tx);
1403 : 0 : p2p->after_scan_tx = NULL;
1404 : : }
1405 : :
1406 : 45 : dev->wps_method = wps_method;
1407 : 45 : dev->status = P2P_SC_SUCCESS;
1408 : :
1409 [ + + ]: 45 : if (p2p->p2p_scan_running) {
1410 : 21 : p2p_dbg(p2p, "p2p_scan running - delay connect send");
1411 : 21 : p2p->start_after_scan = P2P_AFTER_SCAN_CONNECT;
1412 : 21 : os_memcpy(p2p->after_scan_peer, peer_addr, ETH_ALEN);
1413 : 21 : return 0;
1414 : : }
1415 : 24 : p2p->start_after_scan = P2P_AFTER_SCAN_NOTHING;
1416 : :
1417 : 45 : return p2p_connect_send(p2p, dev);
1418 : : }
1419 : :
1420 : :
1421 : 34 : int p2p_authorize(struct p2p_data *p2p, const u8 *peer_addr,
1422 : : enum p2p_wps_method wps_method,
1423 : : int go_intent, const u8 *own_interface_addr,
1424 : : unsigned int force_freq, int persistent_group,
1425 : : const u8 *force_ssid, size_t force_ssid_len,
1426 : : unsigned int pref_freq)
1427 : : {
1428 : : struct p2p_device *dev;
1429 : :
1430 : 34 : p2p_dbg(p2p, "Request to authorize group negotiation - peer=" MACSTR
1431 : : " GO Intent=%d Intended Interface Address=" MACSTR
1432 : : " wps_method=%d persistent_group=%d",
1433 : 408 : MAC2STR(peer_addr), go_intent, MAC2STR(own_interface_addr),
1434 : : wps_method, persistent_group);
1435 : :
1436 : 34 : dev = p2p_get_device(p2p, peer_addr);
1437 [ - + ]: 34 : if (dev == NULL) {
1438 : 0 : p2p_dbg(p2p, "Cannot authorize unknown P2P Device " MACSTR,
1439 : 0 : MAC2STR(peer_addr));
1440 : 0 : return -1;
1441 : : }
1442 : :
1443 [ - + ]: 34 : if (p2p_prepare_channel(p2p, dev, force_freq, pref_freq, go_intent ==
1444 : : 15) < 0)
1445 : 0 : return -1;
1446 : :
1447 : 34 : p2p->ssid_set = 0;
1448 [ - + ]: 34 : if (force_ssid) {
1449 : 0 : wpa_hexdump_ascii(MSG_DEBUG, "P2P: Forced SSID",
1450 : : force_ssid, force_ssid_len);
1451 : 0 : os_memcpy(p2p->ssid, force_ssid, force_ssid_len);
1452 : 0 : p2p->ssid_len = force_ssid_len;
1453 : 0 : p2p->ssid_set = 1;
1454 : : }
1455 : :
1456 : 34 : dev->flags &= ~P2P_DEV_NOT_YET_READY;
1457 : 34 : dev->flags &= ~P2P_DEV_USER_REJECTED;
1458 : 34 : dev->go_neg_req_sent = 0;
1459 : 34 : dev->go_state = UNKNOWN_GO;
1460 : 34 : p2p_set_dev_persistent(dev, persistent_group);
1461 : 34 : p2p->go_intent = go_intent;
1462 : 34 : os_memcpy(p2p->intended_addr, own_interface_addr, ETH_ALEN);
1463 : :
1464 : 34 : dev->wps_method = wps_method;
1465 : 34 : dev->status = P2P_SC_SUCCESS;
1466 : :
1467 : 34 : return 0;
1468 : : }
1469 : :
1470 : :
1471 : 4 : void p2p_add_dev_info(struct p2p_data *p2p, const u8 *addr,
1472 : : struct p2p_device *dev, struct p2p_message *msg)
1473 : : {
1474 : 4 : os_get_reltime(&dev->last_seen);
1475 : :
1476 : 4 : p2p_copy_wps_info(p2p, dev, 0, msg);
1477 : :
1478 [ + - ]: 4 : if (msg->listen_channel) {
1479 : : int freq;
1480 : 4 : freq = p2p_channel_to_freq(msg->listen_channel[3],
1481 : 4 : msg->listen_channel[4]);
1482 [ - + ]: 4 : if (freq < 0) {
1483 : 0 : p2p_dbg(p2p, "Unknown peer Listen channel: "
1484 : : "country=%c%c(0x%02x) reg_class=%u channel=%u",
1485 : 0 : msg->listen_channel[0],
1486 : 0 : msg->listen_channel[1],
1487 : 0 : msg->listen_channel[2],
1488 : 0 : msg->listen_channel[3],
1489 : 0 : msg->listen_channel[4]);
1490 : : } else {
1491 : 4 : p2p_dbg(p2p, "Update peer " MACSTR
1492 : : " Listen channel: %u -> %u MHz",
1493 : 24 : MAC2STR(dev->info.p2p_device_addr),
1494 : : dev->listen_freq, freq);
1495 : 4 : dev->listen_freq = freq;
1496 : : }
1497 : : }
1498 : :
1499 [ + - ]: 4 : if (msg->wfd_subelems) {
1500 : 4 : wpabuf_free(dev->info.wfd_subelems);
1501 : 4 : dev->info.wfd_subelems = wpabuf_dup(msg->wfd_subelems);
1502 : : }
1503 : :
1504 [ + + ]: 4 : if (dev->flags & P2P_DEV_PROBE_REQ_ONLY) {
1505 : 3 : dev->flags &= ~P2P_DEV_PROBE_REQ_ONLY;
1506 : 3 : p2p_dbg(p2p, "Completed device entry based on data from GO Negotiation Request");
1507 : : } else {
1508 : 1 : p2p_dbg(p2p, "Created device entry based on GO Neg Req: "
1509 : : MACSTR " dev_capab=0x%x group_capab=0x%x name='%s' "
1510 : : "listen_freq=%d",
1511 : 6 : MAC2STR(dev->info.p2p_device_addr),
1512 : 2 : dev->info.dev_capab, dev->info.group_capab,
1513 : 1 : dev->info.device_name, dev->listen_freq);
1514 : : }
1515 : :
1516 : 4 : dev->flags &= ~P2P_DEV_GROUP_CLIENT_ONLY;
1517 : :
1518 [ - + ]: 4 : if (dev->flags & P2P_DEV_USER_REJECTED) {
1519 : 0 : p2p_dbg(p2p, "Do not report rejected device");
1520 : 4 : return;
1521 : : }
1522 : :
1523 : 4 : p2p->cfg->dev_found(p2p->cfg->cb_ctx, addr, &dev->info,
1524 : 4 : !(dev->flags & P2P_DEV_REPORTED_ONCE));
1525 : 4 : dev->flags |= P2P_DEV_REPORTED | P2P_DEV_REPORTED_ONCE;
1526 : : }
1527 : :
1528 : :
1529 : 49 : void p2p_build_ssid(struct p2p_data *p2p, u8 *ssid, size_t *ssid_len)
1530 : : {
1531 : 49 : os_memcpy(ssid, P2P_WILDCARD_SSID, P2P_WILDCARD_SSID_LEN);
1532 : 49 : p2p_random((char *) &ssid[P2P_WILDCARD_SSID_LEN], 2);
1533 : 49 : os_memcpy(&ssid[P2P_WILDCARD_SSID_LEN + 2],
1534 : : p2p->cfg->ssid_postfix, p2p->cfg->ssid_postfix_len);
1535 : 49 : *ssid_len = P2P_WILDCARD_SSID_LEN + 2 + p2p->cfg->ssid_postfix_len;
1536 : 49 : }
1537 : :
1538 : :
1539 : 15 : int p2p_go_params(struct p2p_data *p2p, struct p2p_go_neg_results *params)
1540 : : {
1541 : 15 : p2p_build_ssid(p2p, params->ssid, ¶ms->ssid_len);
1542 : 15 : p2p_random(params->passphrase, 8);
1543 : 15 : return 0;
1544 : : }
1545 : :
1546 : :
1547 : 68 : void p2p_go_complete(struct p2p_data *p2p, struct p2p_device *peer)
1548 : : {
1549 : : struct p2p_go_neg_results res;
1550 : 68 : int go = peer->go_state == LOCAL_GO;
1551 : : struct p2p_channels intersection;
1552 : : int freqs;
1553 : : size_t i, j;
1554 : :
1555 [ + + ]: 68 : p2p_dbg(p2p, "GO Negotiation with " MACSTR " completed (%s will be GO)",
1556 : 408 : MAC2STR(peer->info.p2p_device_addr), go ? "local end" : "peer");
1557 : :
1558 : 68 : os_memset(&res, 0, sizeof(res));
1559 : 68 : res.role_go = go;
1560 : 68 : os_memcpy(res.peer_device_addr, peer->info.p2p_device_addr, ETH_ALEN);
1561 : 68 : os_memcpy(res.peer_interface_addr, peer->intended_addr, ETH_ALEN);
1562 : 68 : res.wps_method = peer->wps_method;
1563 [ + + ]: 68 : if (peer->flags & P2P_DEV_PREFER_PERSISTENT_GROUP) {
1564 [ + + ]: 10 : if (peer->flags & P2P_DEV_PREFER_PERSISTENT_RECONN)
1565 : 8 : res.persistent_group = 2;
1566 : : else
1567 : 2 : res.persistent_group = 1;
1568 : : }
1569 : :
1570 [ + + ]: 68 : if (go) {
1571 : : /* Setup AP mode for WPS provisioning */
1572 : 34 : res.freq = p2p_channel_to_freq(p2p->op_reg_class,
1573 : 34 : p2p->op_channel);
1574 : 34 : os_memcpy(res.ssid, p2p->ssid, p2p->ssid_len);
1575 : 34 : res.ssid_len = p2p->ssid_len;
1576 : 34 : p2p_random(res.passphrase, 8);
1577 : : } else {
1578 : 34 : res.freq = peer->oper_freq;
1579 [ + - ]: 34 : if (p2p->ssid_len) {
1580 : 34 : os_memcpy(res.ssid, p2p->ssid, p2p->ssid_len);
1581 : 34 : res.ssid_len = p2p->ssid_len;
1582 : : }
1583 : : }
1584 : :
1585 : 68 : p2p_channels_dump(p2p, "own channels", &p2p->channels);
1586 : 68 : p2p_channels_dump(p2p, "peer channels", &peer->channels);
1587 : 68 : p2p_channels_intersect(&p2p->channels, &peer->channels,
1588 : : &intersection);
1589 [ + + ]: 68 : if (go) {
1590 : 34 : p2p_channels_remove_freqs(&intersection, &p2p->no_go_freq);
1591 : 34 : p2p_channels_dump(p2p, "intersection after no-GO removal",
1592 : : &intersection);
1593 : : }
1594 : 68 : freqs = 0;
1595 [ + + ]: 136 : for (i = 0; i < intersection.reg_classes; i++) {
1596 : 68 : struct p2p_reg_class *c = &intersection.reg_class[i];
1597 [ - + ]: 68 : if (freqs + 1 == P2P_MAX_CHANNELS)
1598 : 0 : break;
1599 [ + + ]: 656 : for (j = 0; j < c->channels; j++) {
1600 : : int freq;
1601 [ - + ]: 588 : if (freqs + 1 == P2P_MAX_CHANNELS)
1602 : 0 : break;
1603 : 588 : freq = p2p_channel_to_freq(c->reg_class, c->channel[j]);
1604 [ - + ]: 588 : if (freq < 0)
1605 : 0 : continue;
1606 : 588 : res.freq_list[freqs++] = freq;
1607 : : }
1608 : : }
1609 : :
1610 [ + + ]: 68 : res.peer_config_timeout = go ? peer->client_timeout : peer->go_timeout;
1611 : :
1612 : 68 : p2p_clear_timeout(p2p);
1613 : 68 : p2p->ssid_set = 0;
1614 : 68 : peer->go_neg_req_sent = 0;
1615 : 68 : peer->wps_method = WPS_NOT_READY;
1616 : :
1617 : 68 : p2p_set_state(p2p, P2P_PROVISIONING);
1618 : 68 : p2p->cfg->go_neg_completed(p2p->cfg->cb_ctx, &res);
1619 : 68 : }
1620 : :
1621 : :
1622 : 195 : static void p2p_rx_p2p_action(struct p2p_data *p2p, const u8 *sa,
1623 : : const u8 *data, size_t len, int rx_freq)
1624 : : {
1625 : 195 : p2p_dbg(p2p, "RX P2P Public Action from " MACSTR, MAC2STR(sa));
1626 : 195 : wpa_hexdump(MSG_MSGDUMP, "P2P: P2P Public Action contents", data, len);
1627 : :
1628 [ - + ]: 195 : if (len < 1)
1629 : 195 : return;
1630 : :
1631 [ + + + + : 195 : switch (data[0]) {
+ + + + +
- ]
1632 : : case P2P_GO_NEG_REQ:
1633 : 46 : p2p_process_go_neg_req(p2p, sa, data + 1, len - 1, rx_freq);
1634 : 46 : break;
1635 : : case P2P_GO_NEG_RESP:
1636 : 45 : p2p_process_go_neg_resp(p2p, sa, data + 1, len - 1, rx_freq);
1637 : 45 : break;
1638 : : case P2P_GO_NEG_CONF:
1639 : 34 : p2p_process_go_neg_conf(p2p, sa, data + 1, len - 1);
1640 : 34 : break;
1641 : : case P2P_INVITATION_REQ:
1642 : 11 : p2p_process_invitation_req(p2p, sa, data + 1, len - 1,
1643 : : rx_freq);
1644 : 11 : break;
1645 : : case P2P_INVITATION_RESP:
1646 : 11 : p2p->cfg->send_action_done(p2p->cfg->cb_ctx);
1647 : 11 : p2p_process_invitation_resp(p2p, sa, data + 1, len - 1);
1648 : 11 : break;
1649 : : case P2P_PROV_DISC_REQ:
1650 : 21 : p2p_process_prov_disc_req(p2p, sa, data + 1, len - 1, rx_freq);
1651 : 21 : break;
1652 : : case P2P_PROV_DISC_RESP:
1653 : 21 : p2p_process_prov_disc_resp(p2p, sa, data + 1, len - 1);
1654 : 21 : break;
1655 : : case P2P_DEV_DISC_REQ:
1656 : 3 : p2p_process_dev_disc_req(p2p, sa, data + 1, len - 1, rx_freq);
1657 : 3 : break;
1658 : : case P2P_DEV_DISC_RESP:
1659 : 3 : p2p_process_dev_disc_resp(p2p, sa, data + 1, len - 1);
1660 : 3 : break;
1661 : : default:
1662 : 0 : p2p_dbg(p2p, "Unsupported P2P Public Action frame type %d",
1663 : 0 : data[0]);
1664 : 0 : break;
1665 : : }
1666 : : }
1667 : :
1668 : :
1669 : 237 : static void p2p_rx_action_public(struct p2p_data *p2p, const u8 *da,
1670 : : const u8 *sa, const u8 *bssid, const u8 *data,
1671 : : size_t len, int freq)
1672 : : {
1673 [ - + ]: 237 : if (len < 1)
1674 : 0 : return;
1675 : :
1676 [ + + + + : 237 : switch (data[0]) {
+ - ]
1677 : : case WLAN_PA_VENDOR_SPECIFIC:
1678 : 195 : data++;
1679 : 195 : len--;
1680 [ - + ]: 195 : if (len < 3)
1681 : 0 : return;
1682 [ - + ]: 195 : if (WPA_GET_BE24(data) != OUI_WFA)
1683 : 0 : return;
1684 : :
1685 : 195 : data += 3;
1686 : 195 : len -= 3;
1687 [ - + ]: 195 : if (len < 1)
1688 : 0 : return;
1689 : :
1690 [ - + ]: 195 : if (*data != P2P_OUI_TYPE)
1691 : 0 : return;
1692 : :
1693 : 195 : p2p_rx_p2p_action(p2p, sa, data + 1, len - 1, freq);
1694 : 195 : break;
1695 : : case WLAN_PA_GAS_INITIAL_REQ:
1696 : 8 : p2p_rx_gas_initial_req(p2p, sa, data + 1, len - 1, freq);
1697 : 8 : break;
1698 : : case WLAN_PA_GAS_INITIAL_RESP:
1699 : 8 : p2p_rx_gas_initial_resp(p2p, sa, data + 1, len - 1, freq);
1700 : 8 : break;
1701 : : case WLAN_PA_GAS_COMEBACK_REQ:
1702 : 13 : p2p_rx_gas_comeback_req(p2p, sa, data + 1, len - 1, freq);
1703 : 13 : break;
1704 : : case WLAN_PA_GAS_COMEBACK_RESP:
1705 : 13 : p2p_rx_gas_comeback_resp(p2p, sa, data + 1, len - 1, freq);
1706 : 237 : break;
1707 : : }
1708 : : }
1709 : :
1710 : :
1711 : 239 : void p2p_rx_action(struct p2p_data *p2p, const u8 *da, const u8 *sa,
1712 : : const u8 *bssid, u8 category,
1713 : : const u8 *data, size_t len, int freq)
1714 : : {
1715 [ + + ]: 239 : if (category == WLAN_ACTION_PUBLIC) {
1716 : 237 : p2p_rx_action_public(p2p, da, sa, bssid, data, len, freq);
1717 : 237 : return;
1718 : : }
1719 : :
1720 [ - + ]: 2 : if (category != WLAN_ACTION_VENDOR_SPECIFIC)
1721 : 0 : return;
1722 : :
1723 [ - + ]: 2 : if (len < 4)
1724 : 0 : return;
1725 : :
1726 [ - + ]: 2 : if (WPA_GET_BE24(data) != OUI_WFA)
1727 : 0 : return;
1728 : 2 : data += 3;
1729 : 2 : len -= 3;
1730 : :
1731 [ - + ]: 2 : if (*data != P2P_OUI_TYPE)
1732 : 0 : return;
1733 : 2 : data++;
1734 : 2 : len--;
1735 : :
1736 : : /* P2P action frame */
1737 : 2 : p2p_dbg(p2p, "RX P2P Action from " MACSTR, MAC2STR(sa));
1738 : 2 : wpa_hexdump(MSG_MSGDUMP, "P2P: P2P Action contents", data, len);
1739 : :
1740 [ - + ]: 2 : if (len < 1)
1741 : 0 : return;
1742 [ - + + - : 2 : switch (data[0]) {
- ]
1743 : : case P2P_NOA:
1744 : 0 : p2p_dbg(p2p, "Received P2P Action - Notice of Absence");
1745 : : /* TODO */
1746 : 0 : break;
1747 : : case P2P_PRESENCE_REQ:
1748 : 1 : p2p_process_presence_req(p2p, da, sa, data + 1, len - 1, freq);
1749 : 1 : break;
1750 : : case P2P_PRESENCE_RESP:
1751 : 1 : p2p_process_presence_resp(p2p, da, sa, data + 1, len - 1);
1752 : 1 : break;
1753 : : case P2P_GO_DISC_REQ:
1754 : 0 : p2p_process_go_disc_req(p2p, da, sa, data + 1, len - 1, freq);
1755 : 0 : break;
1756 : : default:
1757 : 0 : p2p_dbg(p2p, "Received P2P Action - unknown type %u", data[0]);
1758 : 239 : break;
1759 : : }
1760 : : }
1761 : :
1762 : :
1763 : 7 : static void p2p_go_neg_start(void *eloop_ctx, void *timeout_ctx)
1764 : : {
1765 : 7 : struct p2p_data *p2p = eloop_ctx;
1766 [ - + ]: 7 : if (p2p->go_neg_peer == NULL)
1767 : 7 : return;
1768 : 7 : p2p->cfg->stop_listen(p2p->cfg->cb_ctx);
1769 : 7 : p2p->go_neg_peer->status = P2P_SC_SUCCESS;
1770 : 7 : p2p_connect_send(p2p, p2p->go_neg_peer);
1771 : : }
1772 : :
1773 : :
1774 : 0 : static void p2p_invite_start(void *eloop_ctx, void *timeout_ctx)
1775 : : {
1776 : 0 : struct p2p_data *p2p = eloop_ctx;
1777 [ # # ]: 0 : if (p2p->invite_peer == NULL)
1778 : 0 : return;
1779 : 0 : p2p->cfg->stop_listen(p2p->cfg->cb_ctx);
1780 : 0 : p2p_invite_send(p2p, p2p->invite_peer, p2p->invite_go_dev_addr);
1781 : : }
1782 : :
1783 : :
1784 : 387 : static void p2p_add_dev_from_probe_req(struct p2p_data *p2p, const u8 *addr,
1785 : : const u8 *ie, size_t ie_len)
1786 : : {
1787 : : struct p2p_message msg;
1788 : : struct p2p_device *dev;
1789 : :
1790 : 387 : os_memset(&msg, 0, sizeof(msg));
1791 [ + - ][ + + ]: 387 : if (p2p_parse_ies(ie, ie_len, &msg) < 0 || msg.p2p_attributes == NULL)
1792 : : {
1793 : 2 : p2p_parse_free(&msg);
1794 : 2 : return; /* not a P2P probe */
1795 : : }
1796 : :
1797 [ + - ][ + + ]: 385 : if (msg.ssid == NULL || msg.ssid[1] != P2P_WILDCARD_SSID_LEN ||
[ - + ]
1798 : 315 : os_memcmp(msg.ssid + 2, P2P_WILDCARD_SSID, P2P_WILDCARD_SSID_LEN)
1799 : : != 0) {
1800 : : /* The Probe Request is not part of P2P Device Discovery. It is
1801 : : * not known whether the source address of the frame is the P2P
1802 : : * Device Address or P2P Interface Address. Do not add a new
1803 : : * peer entry based on this frames.
1804 : : */
1805 : 70 : p2p_parse_free(&msg);
1806 : 70 : return;
1807 : : }
1808 : :
1809 : 315 : dev = p2p_get_device(p2p, addr);
1810 [ + + ]: 315 : if (dev) {
1811 [ + + ][ + - ]: 247 : if (dev->country[0] == 0 && msg.listen_channel)
1812 : 39 : os_memcpy(dev->country, msg.listen_channel, 3);
1813 : 247 : os_get_reltime(&dev->last_seen);
1814 : 247 : p2p_parse_free(&msg);
1815 : 247 : return; /* already known */
1816 : : }
1817 : :
1818 : 68 : dev = p2p_create_device(p2p, addr);
1819 [ - + ]: 68 : if (dev == NULL) {
1820 : 0 : p2p_parse_free(&msg);
1821 : 0 : return;
1822 : : }
1823 : :
1824 : 68 : os_get_reltime(&dev->last_seen);
1825 : 68 : dev->flags |= P2P_DEV_PROBE_REQ_ONLY;
1826 : :
1827 [ + - ]: 68 : if (msg.listen_channel) {
1828 : 68 : os_memcpy(dev->country, msg.listen_channel, 3);
1829 : 68 : dev->listen_freq = p2p_channel_to_freq(msg.listen_channel[3],
1830 : 68 : msg.listen_channel[4]);
1831 : : }
1832 : :
1833 : 68 : p2p_copy_wps_info(p2p, dev, 1, &msg);
1834 : :
1835 [ + + ]: 68 : if (msg.wfd_subelems) {
1836 : 60 : wpabuf_free(dev->info.wfd_subelems);
1837 : 60 : dev->info.wfd_subelems = wpabuf_dup(msg.wfd_subelems);
1838 : : }
1839 : :
1840 : 68 : p2p_parse_free(&msg);
1841 : :
1842 : 387 : p2p_dbg(p2p, "Created device entry based on Probe Req: " MACSTR
1843 : : " dev_capab=0x%x group_capab=0x%x name='%s' listen_freq=%d",
1844 : 476 : MAC2STR(dev->info.p2p_device_addr), dev->info.dev_capab,
1845 : 68 : dev->info.group_capab, dev->info.device_name,
1846 : : dev->listen_freq);
1847 : : }
1848 : :
1849 : :
1850 : 1 : struct p2p_device * p2p_add_dev_from_go_neg_req(struct p2p_data *p2p,
1851 : : const u8 *addr,
1852 : : struct p2p_message *msg)
1853 : : {
1854 : : struct p2p_device *dev;
1855 : :
1856 : 1 : dev = p2p_get_device(p2p, addr);
1857 [ - + ]: 1 : if (dev) {
1858 : 0 : os_get_reltime(&dev->last_seen);
1859 : 0 : return dev; /* already known */
1860 : : }
1861 : :
1862 : 1 : dev = p2p_create_device(p2p, addr);
1863 [ - + ]: 1 : if (dev == NULL)
1864 : 0 : return NULL;
1865 : :
1866 : 1 : p2p_add_dev_info(p2p, addr, dev, msg);
1867 : :
1868 : 1 : return dev;
1869 : : }
1870 : :
1871 : :
1872 : 0 : static int dev_type_match(const u8 *dev_type, const u8 *req_dev_type)
1873 : : {
1874 [ # # ]: 0 : if (os_memcmp(dev_type, req_dev_type, WPS_DEV_TYPE_LEN) == 0)
1875 : 0 : return 1;
1876 [ # # # # ]: 0 : if (os_memcmp(dev_type, req_dev_type, 2) == 0 &&
1877 [ # # ]: 0 : WPA_GET_BE32(&req_dev_type[2]) == 0 &&
1878 : 0 : WPA_GET_BE16(&req_dev_type[6]) == 0)
1879 : 0 : return 1; /* Category match with wildcard OUI/sub-category */
1880 : 0 : return 0;
1881 : : }
1882 : :
1883 : :
1884 : 0 : int dev_type_list_match(const u8 *dev_type, const u8 *req_dev_type[],
1885 : : size_t num_req_dev_type)
1886 : : {
1887 : : size_t i;
1888 [ # # ]: 0 : for (i = 0; i < num_req_dev_type; i++) {
1889 [ # # ]: 0 : if (dev_type_match(dev_type, req_dev_type[i]))
1890 : 0 : return 1;
1891 : : }
1892 : 0 : return 0;
1893 : : }
1894 : :
1895 : :
1896 : : /**
1897 : : * p2p_match_dev_type - Match local device type with requested type
1898 : : * @p2p: P2P module context from p2p_init()
1899 : : * @wps: WPS TLVs from Probe Request frame (concatenated WPS IEs)
1900 : : * Returns: 1 on match, 0 on mismatch
1901 : : *
1902 : : * This function can be used to match the Requested Device Type attribute in
1903 : : * WPS IE with the local device types for deciding whether to reply to a Probe
1904 : : * Request frame.
1905 : : */
1906 : 366 : int p2p_match_dev_type(struct p2p_data *p2p, struct wpabuf *wps)
1907 : : {
1908 : : struct wps_parse_attr attr;
1909 : : size_t i;
1910 : :
1911 [ - + ]: 366 : if (wps_parse_msg(wps, &attr))
1912 : 0 : return 1; /* assume no Requested Device Type attributes */
1913 : :
1914 [ + - ]: 366 : if (attr.num_req_dev_type == 0)
1915 : 366 : return 1; /* no Requested Device Type attributes -> match */
1916 : :
1917 [ # # ]: 0 : if (dev_type_list_match(p2p->cfg->pri_dev_type, attr.req_dev_type,
1918 : : attr.num_req_dev_type))
1919 : 0 : return 1; /* Own Primary Device Type matches */
1920 : :
1921 [ # # ]: 0 : for (i = 0; i < p2p->cfg->num_sec_dev_types; i++)
1922 [ # # ]: 0 : if (dev_type_list_match(p2p->cfg->sec_dev_type[i],
1923 : : attr.req_dev_type,
1924 : : attr.num_req_dev_type))
1925 : 0 : return 1; /* Own Secondary Device Type matches */
1926 : :
1927 : : /* No matching device type found */
1928 : 366 : return 0;
1929 : : }
1930 : :
1931 : :
1932 : 792 : struct wpabuf * p2p_build_probe_resp_ies(struct p2p_data *p2p)
1933 : : {
1934 : : struct wpabuf *buf;
1935 : : u8 *len;
1936 : 792 : int pw_id = -1;
1937 : 792 : size_t extra = 0;
1938 : :
1939 : : #ifdef CONFIG_WIFI_DISPLAY
1940 [ + + ]: 792 : if (p2p->wfd_ie_probe_resp)
1941 : 675 : extra = wpabuf_len(p2p->wfd_ie_probe_resp);
1942 : : #endif /* CONFIG_WIFI_DISPLAY */
1943 : :
1944 : 792 : buf = wpabuf_alloc(1000 + extra);
1945 [ - + ]: 792 : if (buf == NULL)
1946 : 0 : return NULL;
1947 : :
1948 [ + + ]: 792 : if (p2p->go_neg_peer) {
1949 : : /* Advertise immediate availability of WPS credential */
1950 : 24 : pw_id = p2p_wps_method_pw_id(p2p->go_neg_peer->wps_method);
1951 : : }
1952 : :
1953 [ - + ]: 792 : if (p2p_build_wps_ie(p2p, buf, pw_id, 1) < 0) {
1954 : 0 : p2p_dbg(p2p, "Failed to build WPS IE for Probe Response");
1955 : 0 : wpabuf_free(buf);
1956 : 0 : return NULL;
1957 : : }
1958 : :
1959 : : #ifdef CONFIG_WIFI_DISPLAY
1960 [ + + ]: 792 : if (p2p->wfd_ie_probe_resp)
1961 : 675 : wpabuf_put_buf(buf, p2p->wfd_ie_probe_resp);
1962 : : #endif /* CONFIG_WIFI_DISPLAY */
1963 : :
1964 : : /* P2P IE */
1965 : 792 : len = p2p_buf_add_ie_hdr(buf);
1966 : 792 : p2p_buf_add_capability(buf, p2p->dev_capab &
1967 : : ~P2P_DEV_CAPAB_CLIENT_DISCOVERABILITY, 0);
1968 [ - + ]: 792 : if (p2p->ext_listen_interval)
1969 : 0 : p2p_buf_add_ext_listen_timing(buf, p2p->ext_listen_period,
1970 : 0 : p2p->ext_listen_interval);
1971 : 792 : p2p_buf_add_device_info(buf, p2p, NULL);
1972 : 792 : p2p_buf_update_ie_hdr(buf, len);
1973 : :
1974 : 792 : return buf;
1975 : : }
1976 : :
1977 : :
1978 : : static enum p2p_probe_req_status
1979 : 387 : p2p_reply_probe(struct p2p_data *p2p, const u8 *addr, const u8 *dst,
1980 : : const u8 *bssid, const u8 *ie, size_t ie_len)
1981 : : {
1982 : : struct ieee802_11_elems elems;
1983 : : struct wpabuf *buf;
1984 : : struct ieee80211_mgmt *resp;
1985 : : struct p2p_message msg;
1986 : : struct wpabuf *ies;
1987 : :
1988 [ + + ][ + + ]: 387 : if (!p2p->in_listen || !p2p->drv_in_listen) {
1989 : : /* not in Listen state - ignore Probe Request */
1990 : 124 : return P2P_PREQ_NOT_LISTEN;
1991 : : }
1992 : :
1993 [ - + ]: 263 : if (ieee802_11_parse_elems((u8 *) ie, ie_len, &elems, 0) ==
1994 : : ParseFailed) {
1995 : : /* Ignore invalid Probe Request frames */
1996 : 0 : return P2P_PREQ_MALFORMED;
1997 : : }
1998 : :
1999 [ - + ]: 263 : if (elems.p2p == NULL) {
2000 : : /* not a P2P probe - ignore it */
2001 : 0 : return P2P_PREQ_NOT_P2P;
2002 : : }
2003 : :
2004 [ + - ][ - + ]: 263 : if (dst && !is_broadcast_ether_addr(dst) &&
[ # # ]
2005 : 0 : os_memcmp(dst, p2p->cfg->dev_addr, ETH_ALEN) != 0) {
2006 : : /* Not sent to the broadcast address or our P2P Device Address
2007 : : */
2008 : 0 : return P2P_PREQ_NOT_PROCESSED;
2009 : : }
2010 : :
2011 [ + - ][ - + ]: 263 : if (bssid && !is_broadcast_ether_addr(bssid)) {
2012 : : /* Not sent to the Wildcard BSSID */
2013 : 0 : return P2P_PREQ_NOT_PROCESSED;
2014 : : }
2015 : :
2016 [ + - ][ + + ]: 263 : if (elems.ssid == NULL || elems.ssid_len != P2P_WILDCARD_SSID_LEN ||
[ - + ]
2017 : 262 : os_memcmp(elems.ssid, P2P_WILDCARD_SSID, P2P_WILDCARD_SSID_LEN) !=
2018 : : 0) {
2019 : : /* not using P2P Wildcard SSID - ignore */
2020 : 1 : return P2P_PREQ_NOT_PROCESSED;
2021 : : }
2022 : :
2023 [ - + ]: 262 : if (supp_rates_11b_only(&elems)) {
2024 : : /* Indicates support for 11b rates only */
2025 : 0 : return P2P_PREQ_NOT_P2P;
2026 : : }
2027 : :
2028 : 262 : os_memset(&msg, 0, sizeof(msg));
2029 [ - + ]: 262 : if (p2p_parse_ies(ie, ie_len, &msg) < 0) {
2030 : : /* Could not parse P2P attributes */
2031 : 0 : return P2P_PREQ_NOT_P2P;
2032 : : }
2033 : :
2034 [ - + ][ # # ]: 262 : if (msg.device_id &&
2035 : 0 : os_memcmp(msg.device_id, p2p->cfg->dev_addr, ETH_ALEN) != 0) {
2036 : : /* Device ID did not match */
2037 : 0 : p2p_parse_free(&msg);
2038 : 0 : return P2P_PREQ_NOT_PROCESSED;
2039 : : }
2040 : :
2041 : : /* Check Requested Device Type match */
2042 [ + - - + ]: 524 : if (msg.wps_attributes &&
2043 : 262 : !p2p_match_dev_type(p2p, msg.wps_attributes)) {
2044 : : /* No match with Requested Device Type */
2045 : 0 : p2p_parse_free(&msg);
2046 : 0 : return P2P_PREQ_NOT_PROCESSED;
2047 : : }
2048 : 262 : p2p_parse_free(&msg);
2049 : :
2050 [ - + ]: 262 : if (!p2p->cfg->send_probe_resp) {
2051 : : /* Response generated elsewhere */
2052 : 0 : return P2P_PREQ_NOT_PROCESSED;
2053 : : }
2054 : :
2055 : 262 : p2p_dbg(p2p, "Reply to P2P Probe Request in Listen state");
2056 : :
2057 : : /*
2058 : : * We do not really have a specific BSS that this frame is advertising,
2059 : : * so build a frame that has some information in valid format. This is
2060 : : * really only used for discovery purposes, not to learn exact BSS
2061 : : * parameters.
2062 : : */
2063 : 262 : ies = p2p_build_probe_resp_ies(p2p);
2064 [ - + ]: 262 : if (ies == NULL)
2065 : 0 : return P2P_PREQ_NOT_PROCESSED;
2066 : :
2067 : 262 : buf = wpabuf_alloc(200 + wpabuf_len(ies));
2068 [ - + ]: 262 : if (buf == NULL) {
2069 : 0 : wpabuf_free(ies);
2070 : 0 : return P2P_PREQ_NOT_PROCESSED;
2071 : : }
2072 : :
2073 : 262 : resp = NULL;
2074 : 262 : resp = wpabuf_put(buf, resp->u.probe_resp.variable - (u8 *) resp);
2075 : :
2076 : 262 : resp->frame_control = host_to_le16((WLAN_FC_TYPE_MGMT << 2) |
2077 : : (WLAN_FC_STYPE_PROBE_RESP << 4));
2078 : 262 : os_memcpy(resp->da, addr, ETH_ALEN);
2079 : 262 : os_memcpy(resp->sa, p2p->cfg->dev_addr, ETH_ALEN);
2080 : 262 : os_memcpy(resp->bssid, p2p->cfg->dev_addr, ETH_ALEN);
2081 : 262 : resp->u.probe_resp.beacon_int = host_to_le16(100);
2082 : : /* hardware or low-level driver will setup seq_ctrl and timestamp */
2083 : 262 : resp->u.probe_resp.capab_info =
2084 : : host_to_le16(WLAN_CAPABILITY_SHORT_PREAMBLE |
2085 : : WLAN_CAPABILITY_PRIVACY |
2086 : : WLAN_CAPABILITY_SHORT_SLOT_TIME);
2087 : :
2088 : 262 : wpabuf_put_u8(buf, WLAN_EID_SSID);
2089 : 262 : wpabuf_put_u8(buf, P2P_WILDCARD_SSID_LEN);
2090 : 262 : wpabuf_put_data(buf, P2P_WILDCARD_SSID, P2P_WILDCARD_SSID_LEN);
2091 : :
2092 : 262 : wpabuf_put_u8(buf, WLAN_EID_SUPP_RATES);
2093 : 262 : wpabuf_put_u8(buf, 8);
2094 : 262 : wpabuf_put_u8(buf, (60 / 5) | 0x80);
2095 : 262 : wpabuf_put_u8(buf, 90 / 5);
2096 : 262 : wpabuf_put_u8(buf, (120 / 5) | 0x80);
2097 : 262 : wpabuf_put_u8(buf, 180 / 5);
2098 : 262 : wpabuf_put_u8(buf, (240 / 5) | 0x80);
2099 : 262 : wpabuf_put_u8(buf, 360 / 5);
2100 : 262 : wpabuf_put_u8(buf, 480 / 5);
2101 : 262 : wpabuf_put_u8(buf, 540 / 5);
2102 : :
2103 : 262 : wpabuf_put_u8(buf, WLAN_EID_DS_PARAMS);
2104 : 262 : wpabuf_put_u8(buf, 1);
2105 : 262 : wpabuf_put_u8(buf, p2p->cfg->channel);
2106 : :
2107 : 262 : wpabuf_put_buf(buf, ies);
2108 : 262 : wpabuf_free(ies);
2109 : :
2110 : 262 : p2p->cfg->send_probe_resp(p2p->cfg->cb_ctx, buf);
2111 : :
2112 : 262 : wpabuf_free(buf);
2113 : :
2114 : 387 : return P2P_PREQ_NOT_PROCESSED;
2115 : : }
2116 : :
2117 : :
2118 : : enum p2p_probe_req_status
2119 : 387 : p2p_probe_req_rx(struct p2p_data *p2p, const u8 *addr, const u8 *dst,
2120 : : const u8 *bssid, const u8 *ie, size_t ie_len)
2121 : : {
2122 : : enum p2p_probe_req_status res;
2123 : :
2124 : 387 : p2p_add_dev_from_probe_req(p2p, addr, ie, ie_len);
2125 : :
2126 : 387 : res = p2p_reply_probe(p2p, addr, dst, bssid, ie, ie_len);
2127 : :
2128 [ + + ][ + + ]: 387 : if ((p2p->state == P2P_CONNECT || p2p->state == P2P_CONNECT_LISTEN) &&
[ + - ]
2129 [ + - ]: 7 : p2p->go_neg_peer &&
2130 : 7 : os_memcmp(addr, p2p->go_neg_peer->info.p2p_device_addr, ETH_ALEN)
2131 [ + - ]: 7 : == 0 &&
2132 : 7 : !(p2p->go_neg_peer->flags & P2P_DEV_WAIT_GO_NEG_CONFIRM)) {
2133 : : /* Received a Probe Request from GO Negotiation peer */
2134 : 7 : p2p_dbg(p2p, "Found GO Negotiation peer - try to start GO negotiation from timeout");
2135 : 7 : eloop_cancel_timeout(p2p_go_neg_start, p2p, NULL);
2136 : 7 : eloop_register_timeout(0, 0, p2p_go_neg_start, p2p, NULL);
2137 : 7 : return P2P_PREQ_PROCESSED;
2138 : : }
2139 : :
2140 [ + - ][ - + ]: 380 : if ((p2p->state == P2P_INVITE || p2p->state == P2P_INVITE_LISTEN) &&
[ # # ]
2141 [ # # ]: 0 : p2p->invite_peer &&
2142 : 0 : os_memcmp(addr, p2p->invite_peer->info.p2p_device_addr, ETH_ALEN)
2143 : : == 0) {
2144 : : /* Received a Probe Request from Invite peer */
2145 : 0 : p2p_dbg(p2p, "Found Invite peer - try to start Invite from timeout");
2146 : 0 : eloop_register_timeout(0, 0, p2p_invite_start, p2p, NULL);
2147 : 0 : return P2P_PREQ_PROCESSED;
2148 : : }
2149 : :
2150 : 387 : return res;
2151 : : }
2152 : :
2153 : :
2154 : 331 : static int p2p_assoc_req_ie_wlan_ap(struct p2p_data *p2p, const u8 *bssid,
2155 : : u8 *buf, size_t len, struct wpabuf *p2p_ie)
2156 : : {
2157 : : struct wpabuf *tmp;
2158 : : u8 *lpos;
2159 : : size_t tmplen;
2160 : : int res;
2161 : : u8 group_capab;
2162 : :
2163 [ + + ]: 331 : if (p2p_ie == NULL)
2164 : 329 : return 0; /* WLAN AP is not a P2P manager */
2165 : :
2166 : : /*
2167 : : * (Re)Association Request - P2P IE
2168 : : * P2P Capability attribute (shall be present)
2169 : : * P2P Interface attribute (present if concurrent device and
2170 : : * P2P Management is enabled)
2171 : : */
2172 : 2 : tmp = wpabuf_alloc(200);
2173 [ - + ]: 2 : if (tmp == NULL)
2174 : 0 : return -1;
2175 : :
2176 : 2 : lpos = p2p_buf_add_ie_hdr(tmp);
2177 : 2 : group_capab = 0;
2178 [ - + ]: 2 : if (p2p->num_groups > 0) {
2179 : 0 : group_capab |= P2P_GROUP_CAPAB_GROUP_OWNER;
2180 [ # # ][ # # ]: 0 : if ((p2p->dev_capab & P2P_DEV_CAPAB_CONCURRENT_OPER) &&
2181 [ # # ]: 0 : (p2p->dev_capab & P2P_DEV_CAPAB_INFRA_MANAGED) &&
2182 : 0 : p2p->cross_connect)
2183 : 0 : group_capab |= P2P_GROUP_CAPAB_CROSS_CONN;
2184 : : }
2185 : 2 : p2p_buf_add_capability(tmp, p2p->dev_capab, group_capab);
2186 [ + - ][ - + ]: 2 : if ((p2p->dev_capab & P2P_DEV_CAPAB_CONCURRENT_OPER) &&
2187 : 2 : (p2p->dev_capab & P2P_DEV_CAPAB_INFRA_MANAGED))
2188 : 0 : p2p_buf_add_p2p_interface(tmp, p2p);
2189 : 2 : p2p_buf_update_ie_hdr(tmp, lpos);
2190 : :
2191 : 2 : tmplen = wpabuf_len(tmp);
2192 [ - + ]: 2 : if (tmplen > len)
2193 : 0 : res = -1;
2194 : : else {
2195 : 2 : os_memcpy(buf, wpabuf_head(tmp), tmplen);
2196 : 2 : res = tmplen;
2197 : : }
2198 : 2 : wpabuf_free(tmp);
2199 : :
2200 : 331 : return res;
2201 : : }
2202 : :
2203 : :
2204 : 451 : int p2p_assoc_req_ie(struct p2p_data *p2p, const u8 *bssid, u8 *buf,
2205 : : size_t len, int p2p_group, struct wpabuf *p2p_ie)
2206 : : {
2207 : : struct wpabuf *tmp;
2208 : : u8 *lpos;
2209 : : struct p2p_device *peer;
2210 : : size_t tmplen;
2211 : : int res;
2212 : 451 : size_t extra = 0;
2213 : :
2214 [ + + ]: 451 : if (!p2p_group)
2215 : 331 : return p2p_assoc_req_ie_wlan_ap(p2p, bssid, buf, len, p2p_ie);
2216 : :
2217 : : #ifdef CONFIG_WIFI_DISPLAY
2218 [ + + ]: 120 : if (p2p->wfd_ie_assoc_req)
2219 : 104 : extra = wpabuf_len(p2p->wfd_ie_assoc_req);
2220 : : #endif /* CONFIG_WIFI_DISPLAY */
2221 : :
2222 : : /*
2223 : : * (Re)Association Request - P2P IE
2224 : : * P2P Capability attribute (shall be present)
2225 : : * Extended Listen Timing (may be present)
2226 : : * P2P Device Info attribute (shall be present)
2227 : : */
2228 : 120 : tmp = wpabuf_alloc(200 + extra);
2229 [ - + ]: 120 : if (tmp == NULL)
2230 : 0 : return -1;
2231 : :
2232 : : #ifdef CONFIG_WIFI_DISPLAY
2233 [ + + ]: 120 : if (p2p->wfd_ie_assoc_req)
2234 : 104 : wpabuf_put_buf(tmp, p2p->wfd_ie_assoc_req);
2235 : : #endif /* CONFIG_WIFI_DISPLAY */
2236 : :
2237 [ + - ]: 120 : peer = bssid ? p2p_get_device(p2p, bssid) : NULL;
2238 : :
2239 : 120 : lpos = p2p_buf_add_ie_hdr(tmp);
2240 : 120 : p2p_buf_add_capability(tmp, p2p->dev_capab, 0);
2241 [ - + ]: 120 : if (p2p->ext_listen_interval)
2242 : 0 : p2p_buf_add_ext_listen_timing(tmp, p2p->ext_listen_period,
2243 : 0 : p2p->ext_listen_interval);
2244 : 120 : p2p_buf_add_device_info(tmp, p2p, peer);
2245 : 120 : p2p_buf_update_ie_hdr(tmp, lpos);
2246 : :
2247 : 120 : tmplen = wpabuf_len(tmp);
2248 [ - + ]: 120 : if (tmplen > len)
2249 : 0 : res = -1;
2250 : : else {
2251 : 120 : os_memcpy(buf, wpabuf_head(tmp), tmplen);
2252 : 120 : res = tmplen;
2253 : : }
2254 : 120 : wpabuf_free(tmp);
2255 : :
2256 : 451 : return res;
2257 : : }
2258 : :
2259 : :
2260 : 31 : int p2p_scan_result_text(const u8 *ies, size_t ies_len, char *buf, char *end)
2261 : : {
2262 : : struct wpabuf *p2p_ie;
2263 : : int ret;
2264 : :
2265 : 31 : p2p_ie = ieee802_11_vendor_ie_concat(ies, ies_len, P2P_IE_VENDOR_TYPE);
2266 [ + + ]: 31 : if (p2p_ie == NULL)
2267 : 27 : return 0;
2268 : :
2269 : 4 : ret = p2p_attr_text(p2p_ie, buf, end);
2270 : 4 : wpabuf_free(p2p_ie);
2271 : 31 : return ret;
2272 : : }
2273 : :
2274 : :
2275 : 45 : int p2p_parse_dev_addr_in_p2p_ie(struct wpabuf *p2p_ie, u8 *dev_addr)
2276 : : {
2277 : : struct p2p_message msg;
2278 : :
2279 : 45 : os_memset(&msg, 0, sizeof(msg));
2280 [ - + ]: 45 : if (p2p_parse_p2p_ie(p2p_ie, &msg))
2281 : 0 : return -1;
2282 : :
2283 [ + + ]: 45 : if (msg.p2p_device_addr) {
2284 : 44 : os_memcpy(dev_addr, msg.p2p_device_addr, ETH_ALEN);
2285 : 44 : return 0;
2286 [ - + ]: 1 : } else if (msg.device_id) {
2287 : 0 : os_memcpy(dev_addr, msg.device_id, ETH_ALEN);
2288 : 0 : return 0;
2289 : : }
2290 : 45 : return -1;
2291 : : }
2292 : :
2293 : :
2294 : 13 : int p2p_parse_dev_addr(const u8 *ies, size_t ies_len, u8 *dev_addr)
2295 : : {
2296 : : struct wpabuf *p2p_ie;
2297 : : int ret;
2298 : :
2299 : 13 : p2p_ie = ieee802_11_vendor_ie_concat(ies, ies_len,
2300 : : P2P_IE_VENDOR_TYPE);
2301 [ + + ]: 13 : if (p2p_ie == NULL)
2302 : 10 : return -1;
2303 : 3 : ret = p2p_parse_dev_addr_in_p2p_ie(p2p_ie, dev_addr);
2304 : 3 : wpabuf_free(p2p_ie);
2305 : 13 : return ret;
2306 : : }
2307 : :
2308 : :
2309 : 68 : static void p2p_clear_go_neg(struct p2p_data *p2p)
2310 : : {
2311 : 68 : p2p->go_neg_peer = NULL;
2312 : 68 : p2p_clear_timeout(p2p);
2313 : 68 : p2p_set_state(p2p, P2P_IDLE);
2314 : 68 : }
2315 : :
2316 : :
2317 : 86 : void p2p_wps_success_cb(struct p2p_data *p2p, const u8 *mac_addr)
2318 : : {
2319 [ + + ]: 86 : if (p2p->go_neg_peer == NULL) {
2320 : 18 : p2p_dbg(p2p, "No pending Group Formation - ignore WPS registration success notification");
2321 : 18 : return; /* No pending Group Formation */
2322 : : }
2323 : :
2324 [ - + ]: 68 : if (os_memcmp(mac_addr, p2p->go_neg_peer->intended_addr, ETH_ALEN) !=
2325 : : 0) {
2326 : 0 : p2p_dbg(p2p, "Ignore WPS registration success notification for "
2327 : : MACSTR " (GO Negotiation peer " MACSTR ")",
2328 : 0 : MAC2STR(mac_addr),
2329 : 0 : MAC2STR(p2p->go_neg_peer->intended_addr));
2330 : 0 : return; /* Ignore unexpected peer address */
2331 : : }
2332 : :
2333 : 68 : p2p_dbg(p2p, "Group Formation completed successfully with " MACSTR,
2334 : 408 : MAC2STR(mac_addr));
2335 : :
2336 : 86 : p2p_clear_go_neg(p2p);
2337 : : }
2338 : :
2339 : :
2340 : 0 : void p2p_group_formation_failed(struct p2p_data *p2p)
2341 : : {
2342 [ # # ]: 0 : if (p2p->go_neg_peer == NULL) {
2343 : 0 : p2p_dbg(p2p, "No pending Group Formation - ignore group formation failure notification");
2344 : 0 : return; /* No pending Group Formation */
2345 : : }
2346 : :
2347 : 0 : p2p_dbg(p2p, "Group Formation failed with " MACSTR,
2348 : 0 : MAC2STR(p2p->go_neg_peer->intended_addr));
2349 : :
2350 : 0 : p2p_clear_go_neg(p2p);
2351 : : }
2352 : :
2353 : :
2354 : 10 : struct p2p_data * p2p_init(const struct p2p_config *cfg)
2355 : : {
2356 : : struct p2p_data *p2p;
2357 : :
2358 [ - + ]: 10 : if (cfg->max_peers < 1)
2359 : 0 : return NULL;
2360 : :
2361 : 10 : p2p = os_zalloc(sizeof(*p2p) + sizeof(*cfg));
2362 [ - + ]: 10 : if (p2p == NULL)
2363 : 0 : return NULL;
2364 : 10 : p2p->cfg = (struct p2p_config *) (p2p + 1);
2365 : 10 : os_memcpy(p2p->cfg, cfg, sizeof(*cfg));
2366 [ + + ]: 10 : if (cfg->dev_name)
2367 : 3 : p2p->cfg->dev_name = os_strdup(cfg->dev_name);
2368 [ - + ]: 10 : if (cfg->manufacturer)
2369 : 0 : p2p->cfg->manufacturer = os_strdup(cfg->manufacturer);
2370 [ - + ]: 10 : if (cfg->model_name)
2371 : 0 : p2p->cfg->model_name = os_strdup(cfg->model_name);
2372 [ - + ]: 10 : if (cfg->model_number)
2373 : 0 : p2p->cfg->model_number = os_strdup(cfg->model_number);
2374 [ - + ]: 10 : if (cfg->serial_number)
2375 : 0 : p2p->cfg->serial_number = os_strdup(cfg->serial_number);
2376 [ - + ]: 10 : if (cfg->pref_chan) {
2377 : 0 : p2p->cfg->pref_chan = os_malloc(cfg->num_pref_chan *
2378 : : sizeof(struct p2p_channel));
2379 [ # # ]: 0 : if (p2p->cfg->pref_chan) {
2380 : 0 : os_memcpy(p2p->cfg->pref_chan, cfg->pref_chan,
2381 : : cfg->num_pref_chan *
2382 : : sizeof(struct p2p_channel));
2383 : : } else
2384 : 0 : p2p->cfg->num_pref_chan = 0;
2385 : : }
2386 : :
2387 : 10 : p2p->min_disc_int = 1;
2388 : 10 : p2p->max_disc_int = 3;
2389 : 10 : p2p->max_disc_tu = -1;
2390 : :
2391 : 10 : os_get_random(&p2p->next_tie_breaker, 1);
2392 : 10 : p2p->next_tie_breaker &= 0x01;
2393 [ + - ]: 10 : if (cfg->sd_request)
2394 : 10 : p2p->dev_capab |= P2P_DEV_CAPAB_SERVICE_DISCOVERY;
2395 : 10 : p2p->dev_capab |= P2P_DEV_CAPAB_INVITATION_PROCEDURE;
2396 [ + - ]: 10 : if (cfg->concurrent_operations)
2397 : 10 : p2p->dev_capab |= P2P_DEV_CAPAB_CONCURRENT_OPER;
2398 : 10 : p2p->dev_capab |= P2P_DEV_CAPAB_CLIENT_DISCOVERABILITY;
2399 : :
2400 : 10 : dl_list_init(&p2p->devices);
2401 : :
2402 : 10 : eloop_register_timeout(P2P_PEER_EXPIRATION_INTERVAL, 0,
2403 : : p2p_expiration_timeout, p2p, NULL);
2404 : :
2405 : 10 : p2p->go_timeout = 100;
2406 : 10 : p2p->client_timeout = 20;
2407 : :
2408 : 10 : p2p_dbg(p2p, "initialized");
2409 : 10 : p2p_channels_dump(p2p, "channels", &p2p->cfg->channels);
2410 : 10 : p2p_channels_dump(p2p, "cli_channels", &p2p->cfg->cli_channels);
2411 : :
2412 : 10 : return p2p;
2413 : : }
2414 : :
2415 : :
2416 : 10 : void p2p_deinit(struct p2p_data *p2p)
2417 : : {
2418 : : #ifdef CONFIG_WIFI_DISPLAY
2419 : 10 : wpabuf_free(p2p->wfd_ie_beacon);
2420 : 10 : wpabuf_free(p2p->wfd_ie_probe_req);
2421 : 10 : wpabuf_free(p2p->wfd_ie_probe_resp);
2422 : 10 : wpabuf_free(p2p->wfd_ie_assoc_req);
2423 : 10 : wpabuf_free(p2p->wfd_ie_invitation);
2424 : 10 : wpabuf_free(p2p->wfd_ie_prov_disc_req);
2425 : 10 : wpabuf_free(p2p->wfd_ie_prov_disc_resp);
2426 : 10 : wpabuf_free(p2p->wfd_ie_go_neg);
2427 : 10 : wpabuf_free(p2p->wfd_dev_info);
2428 : 10 : wpabuf_free(p2p->wfd_assoc_bssid);
2429 : 10 : wpabuf_free(p2p->wfd_coupled_sink_info);
2430 : : #endif /* CONFIG_WIFI_DISPLAY */
2431 : :
2432 : 10 : eloop_cancel_timeout(p2p_expiration_timeout, p2p, NULL);
2433 : 10 : eloop_cancel_timeout(p2p_ext_listen_timeout, p2p, NULL);
2434 : 10 : eloop_cancel_timeout(p2p_scan_timeout, p2p, NULL);
2435 : 10 : eloop_cancel_timeout(p2p_go_neg_start, p2p, NULL);
2436 : 10 : p2p_flush(p2p);
2437 : 10 : p2p_free_req_dev_types(p2p);
2438 : 10 : os_free(p2p->cfg->dev_name);
2439 : 10 : os_free(p2p->cfg->manufacturer);
2440 : 10 : os_free(p2p->cfg->model_name);
2441 : 10 : os_free(p2p->cfg->model_number);
2442 : 10 : os_free(p2p->cfg->serial_number);
2443 : 10 : os_free(p2p->cfg->pref_chan);
2444 : 10 : os_free(p2p->groups);
2445 : 10 : wpabuf_free(p2p->sd_resp);
2446 : 10 : os_free(p2p->after_scan_tx);
2447 : 10 : p2p_remove_wps_vendor_extensions(p2p);
2448 : 10 : os_free(p2p->no_go_freq.range);
2449 : 10 : os_free(p2p);
2450 : 10 : }
2451 : :
2452 : :
2453 : 745 : void p2p_flush(struct p2p_data *p2p)
2454 : : {
2455 : : struct p2p_device *dev, *prev;
2456 : 745 : p2p_stop_find(p2p);
2457 [ + + ]: 891 : dl_list_for_each_safe(dev, prev, &p2p->devices, struct p2p_device,
2458 : : list) {
2459 : 146 : dl_list_del(&dev->list);
2460 : 146 : p2p_device_free(p2p, dev);
2461 : : }
2462 : 745 : p2p_free_sd_queries(p2p);
2463 : 745 : os_free(p2p->after_scan_tx);
2464 : 745 : p2p->after_scan_tx = NULL;
2465 : 745 : }
2466 : :
2467 : :
2468 : 0 : int p2p_unauthorize(struct p2p_data *p2p, const u8 *addr)
2469 : : {
2470 : : struct p2p_device *dev;
2471 : :
2472 : 0 : dev = p2p_get_device(p2p, addr);
2473 [ # # ]: 0 : if (dev == NULL)
2474 : 0 : return -1;
2475 : :
2476 : 0 : p2p_dbg(p2p, "Unauthorizing " MACSTR, MAC2STR(addr));
2477 : :
2478 [ # # ]: 0 : if (p2p->go_neg_peer == dev)
2479 : 0 : p2p->go_neg_peer = NULL;
2480 : :
2481 : 0 : dev->wps_method = WPS_NOT_READY;
2482 : 0 : dev->flags &= ~P2P_DEV_WAIT_GO_NEG_RESPONSE;
2483 : 0 : dev->flags &= ~P2P_DEV_WAIT_GO_NEG_CONFIRM;
2484 : :
2485 : : /* Check if after_scan_tx is for this peer. If so free it */
2486 [ # # ][ # # ]: 0 : if (p2p->after_scan_tx &&
2487 : 0 : os_memcmp(addr, p2p->after_scan_tx->dst, ETH_ALEN) == 0) {
2488 : 0 : os_free(p2p->after_scan_tx);
2489 : 0 : p2p->after_scan_tx = NULL;
2490 : : }
2491 : :
2492 : 0 : return 0;
2493 : : }
2494 : :
2495 : :
2496 : 3 : int p2p_set_dev_name(struct p2p_data *p2p, const char *dev_name)
2497 : : {
2498 : 3 : os_free(p2p->cfg->dev_name);
2499 [ + - ]: 3 : if (dev_name) {
2500 : 3 : p2p->cfg->dev_name = os_strdup(dev_name);
2501 [ - + ]: 3 : if (p2p->cfg->dev_name == NULL)
2502 : 0 : return -1;
2503 : : } else
2504 : 0 : p2p->cfg->dev_name = NULL;
2505 : 3 : return 0;
2506 : : }
2507 : :
2508 : :
2509 : 0 : int p2p_set_manufacturer(struct p2p_data *p2p, const char *manufacturer)
2510 : : {
2511 : 0 : os_free(p2p->cfg->manufacturer);
2512 : 0 : p2p->cfg->manufacturer = NULL;
2513 [ # # ]: 0 : if (manufacturer) {
2514 : 0 : p2p->cfg->manufacturer = os_strdup(manufacturer);
2515 [ # # ]: 0 : if (p2p->cfg->manufacturer == NULL)
2516 : 0 : return -1;
2517 : : }
2518 : :
2519 : 0 : return 0;
2520 : : }
2521 : :
2522 : :
2523 : 0 : int p2p_set_model_name(struct p2p_data *p2p, const char *model_name)
2524 : : {
2525 : 0 : os_free(p2p->cfg->model_name);
2526 : 0 : p2p->cfg->model_name = NULL;
2527 [ # # ]: 0 : if (model_name) {
2528 : 0 : p2p->cfg->model_name = os_strdup(model_name);
2529 [ # # ]: 0 : if (p2p->cfg->model_name == NULL)
2530 : 0 : return -1;
2531 : : }
2532 : :
2533 : 0 : return 0;
2534 : : }
2535 : :
2536 : :
2537 : 0 : int p2p_set_model_number(struct p2p_data *p2p, const char *model_number)
2538 : : {
2539 : 0 : os_free(p2p->cfg->model_number);
2540 : 0 : p2p->cfg->model_number = NULL;
2541 [ # # ]: 0 : if (model_number) {
2542 : 0 : p2p->cfg->model_number = os_strdup(model_number);
2543 [ # # ]: 0 : if (p2p->cfg->model_number == NULL)
2544 : 0 : return -1;
2545 : : }
2546 : :
2547 : 0 : return 0;
2548 : : }
2549 : :
2550 : :
2551 : 0 : int p2p_set_serial_number(struct p2p_data *p2p, const char *serial_number)
2552 : : {
2553 : 0 : os_free(p2p->cfg->serial_number);
2554 : 0 : p2p->cfg->serial_number = NULL;
2555 [ # # ]: 0 : if (serial_number) {
2556 : 0 : p2p->cfg->serial_number = os_strdup(serial_number);
2557 [ # # ]: 0 : if (p2p->cfg->serial_number == NULL)
2558 : 0 : return -1;
2559 : : }
2560 : :
2561 : 0 : return 0;
2562 : : }
2563 : :
2564 : :
2565 : 0 : void p2p_set_config_methods(struct p2p_data *p2p, u16 config_methods)
2566 : : {
2567 : 0 : p2p->cfg->config_methods = config_methods;
2568 : 0 : }
2569 : :
2570 : :
2571 : 0 : void p2p_set_uuid(struct p2p_data *p2p, const u8 *uuid)
2572 : : {
2573 : 0 : os_memcpy(p2p->cfg->uuid, uuid, 16);
2574 : 0 : }
2575 : :
2576 : :
2577 : 0 : int p2p_set_pri_dev_type(struct p2p_data *p2p, const u8 *pri_dev_type)
2578 : : {
2579 : 0 : os_memcpy(p2p->cfg->pri_dev_type, pri_dev_type, 8);
2580 : 0 : return 0;
2581 : : }
2582 : :
2583 : :
2584 : 0 : int p2p_set_sec_dev_types(struct p2p_data *p2p, const u8 dev_types[][8],
2585 : : size_t num_dev_types)
2586 : : {
2587 [ # # ]: 0 : if (num_dev_types > P2P_SEC_DEVICE_TYPES)
2588 : 0 : num_dev_types = P2P_SEC_DEVICE_TYPES;
2589 : 0 : p2p->cfg->num_sec_dev_types = num_dev_types;
2590 : 0 : os_memcpy(p2p->cfg->sec_dev_type, dev_types, num_dev_types * 8);
2591 : 0 : return 0;
2592 : : }
2593 : :
2594 : :
2595 : 10 : void p2p_remove_wps_vendor_extensions(struct p2p_data *p2p)
2596 : : {
2597 : : int i;
2598 : :
2599 [ + + ]: 110 : for (i = 0; i < P2P_MAX_WPS_VENDOR_EXT; i++) {
2600 : 100 : wpabuf_free(p2p->wps_vendor_ext[i]);
2601 : 100 : p2p->wps_vendor_ext[i] = NULL;
2602 : : }
2603 : 10 : }
2604 : :
2605 : :
2606 : 0 : int p2p_add_wps_vendor_extension(struct p2p_data *p2p,
2607 : : const struct wpabuf *vendor_ext)
2608 : : {
2609 : : int i;
2610 : :
2611 [ # # ]: 0 : if (vendor_ext == NULL)
2612 : 0 : return -1;
2613 : :
2614 [ # # ]: 0 : for (i = 0; i < P2P_MAX_WPS_VENDOR_EXT; i++) {
2615 [ # # ]: 0 : if (p2p->wps_vendor_ext[i] == NULL)
2616 : 0 : break;
2617 : : }
2618 [ # # ]: 0 : if (i >= P2P_MAX_WPS_VENDOR_EXT)
2619 : 0 : return -1;
2620 : :
2621 : 0 : p2p->wps_vendor_ext[i] = wpabuf_dup(vendor_ext);
2622 [ # # ]: 0 : if (p2p->wps_vendor_ext[i] == NULL)
2623 : 0 : return -1;
2624 : :
2625 : 0 : return 0;
2626 : : }
2627 : :
2628 : :
2629 : 0 : int p2p_set_country(struct p2p_data *p2p, const char *country)
2630 : : {
2631 : 0 : os_memcpy(p2p->cfg->country, country, 3);
2632 : 0 : return 0;
2633 : : }
2634 : :
2635 : :
2636 : 423 : void p2p_continue_find(struct p2p_data *p2p)
2637 : : {
2638 : : struct p2p_device *dev;
2639 : 423 : p2p_set_state(p2p, P2P_SEARCH);
2640 [ + + ]: 818 : dl_list_for_each(dev, &p2p->devices, struct p2p_device, list) {
2641 [ + + ]: 406 : if (dev->flags & P2P_DEV_SD_SCHEDULE) {
2642 [ + - ]: 8 : if (p2p_start_sd(p2p, dev) == 0)
2643 : 8 : return;
2644 : : else
2645 : 0 : break;
2646 [ + + ][ + - ]: 398 : } else if (dev->req_config_methods &&
2647 : 3 : !(dev->flags & P2P_DEV_PD_FOR_JOIN)) {
2648 : 3 : p2p_dbg(p2p, "Send pending Provision Discovery Request to "
2649 : : MACSTR " (config methods 0x%x)",
2650 : 18 : MAC2STR(dev->info.p2p_device_addr),
2651 : 3 : dev->req_config_methods);
2652 [ + - ]: 3 : if (p2p_send_prov_disc_req(p2p, dev, 0, 0) == 0)
2653 : 3 : return;
2654 : : }
2655 : : }
2656 : :
2657 : 423 : p2p_listen_in_find(p2p, 1);
2658 : : }
2659 : :
2660 : :
2661 : 8 : static void p2p_sd_cb(struct p2p_data *p2p, int success)
2662 : : {
2663 : 8 : p2p_dbg(p2p, "Service Discovery Query TX callback: success=%d",
2664 : : success);
2665 : 8 : p2p->pending_action_state = P2P_NO_PENDING_ACTION;
2666 : :
2667 [ - + ]: 8 : if (!success) {
2668 [ # # ]: 0 : if (p2p->sd_peer) {
2669 : 0 : p2p->sd_peer->flags &= ~P2P_DEV_SD_SCHEDULE;
2670 : 0 : p2p->sd_peer = NULL;
2671 : : }
2672 : 0 : p2p_continue_find(p2p);
2673 : 0 : return;
2674 : : }
2675 : :
2676 [ - + ]: 8 : if (p2p->sd_peer == NULL) {
2677 : 0 : p2p_dbg(p2p, "No SD peer entry known");
2678 : 0 : p2p_continue_find(p2p);
2679 : 0 : return;
2680 : : }
2681 : :
2682 : : /* Wait for response from the peer */
2683 : 8 : p2p_set_state(p2p, P2P_SD_DURING_FIND);
2684 : 8 : p2p_set_timeout(p2p, 0, 200000);
2685 : : }
2686 : :
2687 : :
2688 : : /**
2689 : : * p2p_retry_pd - Retry any pending provision disc requests in IDLE state
2690 : : * @p2p: P2P module context from p2p_init()
2691 : : */
2692 : 3 : static void p2p_retry_pd(struct p2p_data *p2p)
2693 : : {
2694 : : struct p2p_device *dev;
2695 : :
2696 [ + - ]: 3 : if (p2p->state != P2P_IDLE)
2697 : 3 : return;
2698 : :
2699 : : /*
2700 : : * Retry the prov disc req attempt only for the peer that the user had
2701 : : * requested.
2702 : : */
2703 : :
2704 [ # # ]: 3 : dl_list_for_each(dev, &p2p->devices, struct p2p_device, list) {
2705 [ # # ]: 0 : if (os_memcmp(p2p->pending_pd_devaddr,
2706 : : dev->info.p2p_device_addr, ETH_ALEN) != 0)
2707 : 0 : continue;
2708 [ # # ]: 0 : if (!dev->req_config_methods)
2709 : 0 : continue;
2710 : :
2711 : 0 : p2p_dbg(p2p, "Send pending Provision Discovery Request to "
2712 : : MACSTR " (config methods 0x%x)",
2713 : 0 : MAC2STR(dev->info.p2p_device_addr),
2714 : 0 : dev->req_config_methods);
2715 : 0 : p2p_send_prov_disc_req(p2p, dev,
2716 : 0 : dev->flags & P2P_DEV_PD_FOR_JOIN,
2717 : : p2p->pd_force_freq);
2718 : 0 : return;
2719 : : }
2720 : : }
2721 : :
2722 : :
2723 : 24 : static void p2p_prov_disc_cb(struct p2p_data *p2p, int success)
2724 : : {
2725 : 24 : p2p_dbg(p2p, "Provision Discovery Request TX callback: success=%d",
2726 : : success);
2727 : :
2728 : : /*
2729 : : * Postpone resetting the pending action state till after we actually
2730 : : * time out. This allows us to take some action like notifying any
2731 : : * interested parties about no response to the request.
2732 : : *
2733 : : * When the timer (below) goes off we check in IDLE, SEARCH, or
2734 : : * LISTEN_ONLY state, which are the only allowed states to issue a PD
2735 : : * requests in, if this was still pending and then raise notification.
2736 : : */
2737 : :
2738 [ + + ]: 24 : if (!success) {
2739 : 3 : p2p->pending_action_state = P2P_NO_PENDING_ACTION;
2740 : :
2741 [ + - ][ - + ]: 3 : if (p2p->user_initiated_pd &&
2742 [ # # ]: 0 : (p2p->state == P2P_SEARCH || p2p->state == P2P_LISTEN_ONLY))
2743 : : {
2744 : : /* Retry request from timeout to avoid busy loops */
2745 : 3 : p2p->pending_action_state = P2P_PENDING_PD;
2746 : 3 : p2p_set_timeout(p2p, 0, 50000);
2747 [ # # ]: 0 : } else if (p2p->state != P2P_IDLE)
2748 : 0 : p2p_continue_find(p2p);
2749 [ # # ]: 0 : else if (p2p->user_initiated_pd) {
2750 : 0 : p2p->pending_action_state = P2P_PENDING_PD;
2751 : 0 : p2p_set_timeout(p2p, 0, 300000);
2752 : : }
2753 : 24 : return;
2754 : : }
2755 : :
2756 : : /*
2757 : : * This postponing, of resetting pending_action_state, needs to be
2758 : : * done only for user initiated PD requests and not internal ones.
2759 : : */
2760 [ + + ]: 21 : if (p2p->user_initiated_pd)
2761 : 20 : p2p->pending_action_state = P2P_PENDING_PD;
2762 : : else
2763 : 1 : p2p->pending_action_state = P2P_NO_PENDING_ACTION;
2764 : :
2765 : : /* Wait for response from the peer */
2766 [ + + ]: 21 : if (p2p->state == P2P_SEARCH)
2767 : 3 : p2p_set_state(p2p, P2P_PD_DURING_FIND);
2768 : 21 : p2p_set_timeout(p2p, 0, 200000);
2769 : : }
2770 : :
2771 : :
2772 : 1683 : int p2p_scan_res_handler(struct p2p_data *p2p, const u8 *bssid, int freq,
2773 : : struct os_reltime *rx_time, int level, const u8 *ies,
2774 : : size_t ies_len)
2775 : : {
2776 [ + + ]: 1683 : if (os_reltime_before(rx_time, &p2p->find_start)) {
2777 : : /*
2778 : : * The driver may have cached (e.g., in cfg80211 BSS table) the
2779 : : * scan results for relatively long time. To avoid reporting
2780 : : * stale information, update P2P peers only based on results
2781 : : * that have based on frames received after the last p2p_find
2782 : : * operation was started.
2783 : : */
2784 : 1210 : p2p_dbg(p2p, "Ignore old scan result for " MACSTR
2785 : : " (rx_time=%u.%06u)",
2786 : 8470 : MAC2STR(bssid), (unsigned int) rx_time->sec,
2787 : 1210 : (unsigned int) rx_time->usec);
2788 : 1210 : return 0;
2789 : : }
2790 : :
2791 : 473 : p2p_add_device(p2p, bssid, freq, rx_time, level, ies, ies_len, 1);
2792 : :
2793 : 1683 : return 0;
2794 : : }
2795 : :
2796 : :
2797 : 475 : void p2p_scan_res_handled(struct p2p_data *p2p)
2798 : : {
2799 [ + + ]: 475 : if (!p2p->p2p_scan_running) {
2800 : 18 : p2p_dbg(p2p, "p2p_scan was not running, but scan results received");
2801 : : }
2802 : 475 : p2p->p2p_scan_running = 0;
2803 : 475 : eloop_cancel_timeout(p2p_scan_timeout, p2p, NULL);
2804 : :
2805 [ + + ]: 475 : if (p2p_run_after_scan(p2p))
2806 : 475 : return;
2807 [ + + ]: 437 : if (p2p->state == P2P_SEARCH)
2808 : 411 : p2p_continue_find(p2p);
2809 : : }
2810 : :
2811 : :
2812 : 938 : void p2p_scan_ie(struct p2p_data *p2p, struct wpabuf *ies, const u8 *dev_id)
2813 : : {
2814 : : u8 *len;
2815 : :
2816 : : #ifdef CONFIG_WIFI_DISPLAY
2817 [ + + ]: 938 : if (p2p->wfd_ie_probe_req)
2818 : 794 : wpabuf_put_buf(ies, p2p->wfd_ie_probe_req);
2819 : : #endif /* CONFIG_WIFI_DISPLAY */
2820 : :
2821 : 938 : len = p2p_buf_add_ie_hdr(ies);
2822 : 938 : p2p_buf_add_capability(ies, p2p->dev_capab &
2823 : : ~P2P_DEV_CAPAB_CLIENT_DISCOVERABILITY, 0);
2824 [ - + ]: 938 : if (dev_id)
2825 : 0 : p2p_buf_add_device_id(ies, dev_id);
2826 [ + - ][ + - ]: 938 : if (p2p->cfg->reg_class && p2p->cfg->channel)
2827 : 938 : p2p_buf_add_listen_channel(ies, p2p->cfg->country,
2828 : 938 : p2p->cfg->reg_class,
2829 : 938 : p2p->cfg->channel);
2830 [ - + ]: 938 : if (p2p->ext_listen_interval)
2831 : 0 : p2p_buf_add_ext_listen_timing(ies, p2p->ext_listen_period,
2832 : 0 : p2p->ext_listen_interval);
2833 : : /* TODO: p2p_buf_add_operating_channel() if GO */
2834 : 938 : p2p_buf_update_ie_hdr(ies, len);
2835 : 938 : }
2836 : :
2837 : :
2838 : 939 : size_t p2p_scan_ie_buf_len(struct p2p_data *p2p)
2839 : : {
2840 : 939 : size_t len = 100;
2841 : :
2842 : : #ifdef CONFIG_WIFI_DISPLAY
2843 [ + - ][ + + ]: 939 : if (p2p && p2p->wfd_ie_probe_req)
2844 : 795 : len += wpabuf_len(p2p->wfd_ie_probe_req);
2845 : : #endif /* CONFIG_WIFI_DISPLAY */
2846 : :
2847 : 939 : return len;
2848 : : }
2849 : :
2850 : :
2851 : 0 : int p2p_ie_text(struct wpabuf *p2p_ie, char *buf, char *end)
2852 : : {
2853 : 0 : return p2p_attr_text(p2p_ie, buf, end);
2854 : : }
2855 : :
2856 : :
2857 : 61 : static void p2p_go_neg_req_cb(struct p2p_data *p2p, int success)
2858 : : {
2859 : 61 : struct p2p_device *dev = p2p->go_neg_peer;
2860 : : int timeout;
2861 : :
2862 : 61 : p2p_dbg(p2p, "GO Negotiation Request TX callback: success=%d", success);
2863 : :
2864 [ - + ]: 61 : if (dev == NULL) {
2865 : 0 : p2p_dbg(p2p, "No pending GO Negotiation");
2866 : 0 : return;
2867 : : }
2868 : :
2869 [ + + ]: 61 : if (success) {
2870 [ - + ]: 45 : if (dev->flags & P2P_DEV_USER_REJECTED) {
2871 : 0 : p2p_set_state(p2p, P2P_IDLE);
2872 : 0 : return;
2873 : : }
2874 [ + - ]: 16 : } else if (dev->go_neg_req_sent) {
2875 : : /* Cancel the increment from p2p_connect_send() on failure */
2876 : 16 : dev->go_neg_req_sent--;
2877 : : }
2878 : :
2879 [ + + ][ + + ]: 61 : if (!success &&
2880 [ + - ]: 3 : (dev->info.dev_capab & P2P_DEV_CAPAB_CLIENT_DISCOVERABILITY) &&
2881 : 3 : !is_zero_ether_addr(dev->member_in_go_dev)) {
2882 : 3 : p2p_dbg(p2p, "Peer " MACSTR " did not acknowledge request - try to use device discoverability through its GO",
2883 : 18 : MAC2STR(dev->info.p2p_device_addr));
2884 : 3 : p2p->cfg->send_action_done(p2p->cfg->cb_ctx);
2885 : 3 : p2p_send_dev_disc_req(p2p, dev);
2886 : 3 : return;
2887 : : }
2888 : :
2889 : : /*
2890 : : * Use P2P find, if needed, to find the other device from its listen
2891 : : * channel.
2892 : : */
2893 : 58 : p2p_set_state(p2p, P2P_CONNECT);
2894 [ + + ]: 58 : timeout = success ? 500000 : 100000;
2895 [ + + ][ + - ]: 58 : if (!success && p2p->go_neg_peer &&
[ - + ]
2896 : 13 : (p2p->go_neg_peer->flags & P2P_DEV_PEER_WAITING_RESPONSE)) {
2897 : : unsigned int r;
2898 : : /*
2899 : : * Peer is expected to wait our response and we will skip the
2900 : : * listen phase. Add some randomness to the wait time here to
2901 : : * make it less likely to hit cases where we could end up in
2902 : : * sync with peer not listening.
2903 : : */
2904 : 0 : os_get_random((u8 *) &r, sizeof(r));
2905 : 0 : timeout += r % 100000;
2906 : : }
2907 : 61 : p2p_set_timeout(p2p, 0, timeout);
2908 : : }
2909 : :
2910 : :
2911 : 34 : static void p2p_go_neg_resp_cb(struct p2p_data *p2p, int success)
2912 : : {
2913 : 34 : p2p_dbg(p2p, "GO Negotiation Response TX callback: success=%d",
2914 : : success);
2915 [ - + ][ # # ]: 34 : if (!p2p->go_neg_peer && p2p->state == P2P_PROVISIONING) {
2916 : 0 : p2p_dbg(p2p, "Ignore TX callback event - GO Negotiation is not running anymore");
2917 : 34 : return;
2918 : : }
2919 : 34 : p2p_set_state(p2p, P2P_CONNECT);
2920 : 34 : p2p_set_timeout(p2p, 0, 500000);
2921 : : }
2922 : :
2923 : :
2924 : 11 : static void p2p_go_neg_resp_failure_cb(struct p2p_data *p2p, int success,
2925 : : const u8 *addr)
2926 : : {
2927 : 11 : p2p_dbg(p2p, "GO Negotiation Response (failure) TX callback: success=%d", success);
2928 [ - + ][ # # ]: 11 : if (p2p->go_neg_peer && p2p->go_neg_peer->status != P2P_SC_SUCCESS) {
2929 : 0 : p2p_go_neg_failed(p2p, p2p->go_neg_peer,
2930 : 0 : p2p->go_neg_peer->status);
2931 [ + - ]: 11 : } else if (success) {
2932 : : struct p2p_device *dev;
2933 : 11 : dev = p2p_get_device(p2p, addr);
2934 [ + - ][ + + ]: 11 : if (dev &&
2935 : 11 : dev->status == P2P_SC_FAIL_INFO_CURRENTLY_UNAVAILABLE)
2936 : 6 : dev->flags |= P2P_DEV_PEER_WAITING_RESPONSE;
2937 : : }
2938 : 11 : }
2939 : :
2940 : :
2941 : 34 : static void p2p_go_neg_conf_cb(struct p2p_data *p2p,
2942 : : enum p2p_send_action_result result)
2943 : : {
2944 : : struct p2p_device *dev;
2945 : :
2946 : 34 : p2p_dbg(p2p, "GO Negotiation Confirm TX callback: result=%d", result);
2947 : 34 : p2p->cfg->send_action_done(p2p->cfg->cb_ctx);
2948 [ - + ]: 34 : if (result == P2P_SEND_ACTION_FAILED) {
2949 : 0 : p2p_go_neg_failed(p2p, p2p->go_neg_peer, -1);
2950 : 0 : return;
2951 : : }
2952 [ - + ]: 34 : if (result == P2P_SEND_ACTION_NO_ACK) {
2953 : : /*
2954 : : * It looks like the TX status for GO Negotiation Confirm is
2955 : : * often showing failure even when the peer has actually
2956 : : * received the frame. Since the peer may change channels
2957 : : * immediately after having received the frame, we may not see
2958 : : * an Ack for retries, so just dropping a single frame may
2959 : : * trigger this. To allow the group formation to succeed if the
2960 : : * peer did indeed receive the frame, continue regardless of
2961 : : * the TX status.
2962 : : */
2963 : 0 : p2p_dbg(p2p, "Assume GO Negotiation Confirm TX was actually received by the peer even though Ack was not reported");
2964 : : }
2965 : :
2966 : 34 : dev = p2p->go_neg_peer;
2967 [ - + ]: 34 : if (dev == NULL)
2968 : 0 : return;
2969 : :
2970 : 34 : p2p_go_complete(p2p, dev);
2971 : : }
2972 : :
2973 : :
2974 : 257 : void p2p_send_action_cb(struct p2p_data *p2p, unsigned int freq, const u8 *dst,
2975 : : const u8 *src, const u8 *bssid,
2976 : : enum p2p_send_action_result result)
2977 : : {
2978 : : enum p2p_pending_action_state state;
2979 : : int success;
2980 : :
2981 : 257 : p2p_dbg(p2p, "Action frame TX callback (state=%d freq=%u dst=" MACSTR
2982 : : " src=" MACSTR " bssid=" MACSTR " result=%d",
2983 : 3341 : p2p->pending_action_state, freq, MAC2STR(dst), MAC2STR(src),
2984 : 1542 : MAC2STR(bssid), result);
2985 : 257 : success = result == P2P_SEND_ACTION_SUCCESS;
2986 : 257 : state = p2p->pending_action_state;
2987 : 257 : p2p->pending_action_state = P2P_NO_PENDING_ACTION;
2988 [ + + + + : 257 : switch (state) {
+ + + + +
+ + - - ]
2989 : : case P2P_NO_PENDING_ACTION:
2990 [ + + ]: 57 : if (p2p->after_scan_tx_in_progress) {
2991 : 1 : p2p->after_scan_tx_in_progress = 0;
2992 [ - + # # ]: 1 : if (p2p->start_after_scan != P2P_AFTER_SCAN_NOTHING &&
2993 : 0 : p2p_run_after_scan(p2p))
2994 : 0 : break;
2995 [ + - ]: 1 : if (p2p->state == P2P_SEARCH) {
2996 : 1 : p2p_dbg(p2p, "Continue find after after_scan_tx completion");
2997 : 1 : p2p_continue_find(p2p);
2998 : : }
2999 : : }
3000 : 57 : break;
3001 : : case P2P_PENDING_GO_NEG_REQUEST:
3002 : 61 : p2p_go_neg_req_cb(p2p, success);
3003 : 61 : break;
3004 : : case P2P_PENDING_GO_NEG_RESPONSE:
3005 : 34 : p2p_go_neg_resp_cb(p2p, success);
3006 : 34 : break;
3007 : : case P2P_PENDING_GO_NEG_RESPONSE_FAILURE:
3008 : 11 : p2p_go_neg_resp_failure_cb(p2p, success, dst);
3009 : 11 : break;
3010 : : case P2P_PENDING_GO_NEG_CONFIRM:
3011 : 34 : p2p_go_neg_conf_cb(p2p, result);
3012 : 34 : break;
3013 : : case P2P_PENDING_SD:
3014 : 8 : p2p_sd_cb(p2p, success);
3015 : 8 : break;
3016 : : case P2P_PENDING_PD:
3017 : 24 : p2p_prov_disc_cb(p2p, success);
3018 : 24 : break;
3019 : : case P2P_PENDING_INVITATION_REQUEST:
3020 : 11 : p2p_invitation_req_cb(p2p, success);
3021 : 11 : break;
3022 : : case P2P_PENDING_INVITATION_RESPONSE:
3023 : 11 : p2p_invitation_resp_cb(p2p, success);
3024 : 11 : break;
3025 : : case P2P_PENDING_DEV_DISC_REQUEST:
3026 : 3 : p2p_dev_disc_req_cb(p2p, success);
3027 : 3 : break;
3028 : : case P2P_PENDING_DEV_DISC_RESPONSE:
3029 : 3 : p2p_dev_disc_resp_cb(p2p, success);
3030 : 3 : break;
3031 : : case P2P_PENDING_GO_DISC_REQ:
3032 : 0 : p2p_go_disc_req_cb(p2p, success);
3033 : 0 : break;
3034 : : }
3035 : :
3036 : 257 : p2p->after_scan_tx_in_progress = 0;
3037 : 257 : }
3038 : :
3039 : :
3040 : 528 : void p2p_listen_cb(struct p2p_data *p2p, unsigned int freq,
3041 : : unsigned int duration)
3042 : : {
3043 [ - + ]: 528 : if (freq == p2p->pending_client_disc_freq) {
3044 : 0 : p2p_dbg(p2p, "Client discoverability remain-awake completed");
3045 : 0 : p2p->pending_client_disc_freq = 0;
3046 : 0 : return;
3047 : : }
3048 : :
3049 [ - + ]: 528 : if (freq != p2p->pending_listen_freq) {
3050 : 0 : p2p_dbg(p2p, "Unexpected listen callback for freq=%u duration=%u (pending_listen_freq=%u)",
3051 : : freq, duration, p2p->pending_listen_freq);
3052 : 0 : return;
3053 : : }
3054 : :
3055 : 528 : p2p_dbg(p2p, "Starting Listen timeout(%u,%u) on freq=%u based on callback",
3056 : : p2p->pending_listen_sec, p2p->pending_listen_usec,
3057 : : p2p->pending_listen_freq);
3058 : 528 : p2p->in_listen = 1;
3059 : 528 : p2p->drv_in_listen = freq;
3060 [ + + ][ + - ]: 528 : if (p2p->pending_listen_sec || p2p->pending_listen_usec) {
3061 : : /*
3062 : : * Add 20 msec extra wait to avoid race condition with driver
3063 : : * remain-on-channel end event, i.e., give driver more time to
3064 : : * complete the operation before our timeout expires.
3065 : : */
3066 : 528 : p2p_set_timeout(p2p, p2p->pending_listen_sec,
3067 : 528 : p2p->pending_listen_usec + 20000);
3068 : : }
3069 : :
3070 : 528 : p2p->pending_listen_freq = 0;
3071 : : }
3072 : :
3073 : :
3074 : 525 : int p2p_listen_end(struct p2p_data *p2p, unsigned int freq)
3075 : : {
3076 : 525 : p2p_dbg(p2p, "Driver ended Listen state (freq=%u)", freq);
3077 : 525 : p2p->drv_in_listen = 0;
3078 [ + + ]: 525 : if (p2p->in_listen)
3079 : 457 : return 0; /* Internal timeout will trigger the next step */
3080 : :
3081 [ + + ][ + - ]: 68 : if (p2p->state == P2P_CONNECT_LISTEN && p2p->go_neg_peer) {
3082 [ - + ]: 1 : if (p2p->go_neg_peer->connect_reqs >= 120) {
3083 : 0 : p2p_dbg(p2p, "Timeout on sending GO Negotiation Request without getting response");
3084 : 0 : p2p_go_neg_failed(p2p, p2p->go_neg_peer, -1);
3085 : 0 : return 0;
3086 : : }
3087 : :
3088 : 1 : p2p_set_state(p2p, P2P_CONNECT);
3089 : 1 : p2p_connect_send(p2p, p2p->go_neg_peer);
3090 : 1 : return 1;
3091 [ + + ]: 67 : } else if (p2p->state == P2P_SEARCH) {
3092 [ - + ]: 5 : if (p2p->p2p_scan_running) {
3093 : : /*
3094 : : * Search is already in progress. This can happen if
3095 : : * an Action frame RX is reported immediately after
3096 : : * the end of a remain-on-channel operation and the
3097 : : * response frame to that is sent using an offchannel
3098 : : * operation while in p2p_find. Avoid an attempt to
3099 : : * restart a scan here.
3100 : : */
3101 : 0 : p2p_dbg(p2p, "p2p_scan already in progress - do not try to start a new one");
3102 : 0 : return 1;
3103 : : }
3104 [ + + ]: 5 : if (p2p->pending_listen_freq) {
3105 : : /*
3106 : : * Better wait a bit if the driver is unable to start
3107 : : * offchannel operation for some reason. p2p_search()
3108 : : * will be started from internal timeout.
3109 : : */
3110 : 1 : p2p_dbg(p2p, "Listen operation did not seem to start - delay search phase to avoid busy loop");
3111 : 1 : p2p_set_timeout(p2p, 0, 100000);
3112 : 1 : return 1;
3113 : : }
3114 [ - + ]: 4 : if (p2p->search_delay) {
3115 : 0 : p2p_dbg(p2p, "Delay search operation by %u ms",
3116 : : p2p->search_delay);
3117 : 0 : p2p_set_timeout(p2p, p2p->search_delay / 1000,
3118 : 0 : (p2p->search_delay % 1000) * 1000);
3119 : 0 : return 1;
3120 : : }
3121 : 4 : p2p_search(p2p);
3122 : 4 : return 1;
3123 : : }
3124 : :
3125 : 525 : return 0;
3126 : : }
3127 : :
3128 : :
3129 : 14 : static void p2p_timeout_connect(struct p2p_data *p2p)
3130 : : {
3131 : 14 : p2p->cfg->send_action_done(p2p->cfg->cb_ctx);
3132 [ + - ][ - + ]: 14 : if (p2p->go_neg_peer &&
3133 : 14 : (p2p->go_neg_peer->flags & P2P_DEV_WAIT_GO_NEG_CONFIRM)) {
3134 : 0 : p2p_dbg(p2p, "Wait for GO Negotiation Confirm timed out - assume GO Negotiation failed");
3135 : 0 : p2p_go_neg_failed(p2p, p2p->go_neg_peer, -1);
3136 : 0 : return;
3137 : : }
3138 [ + - ][ - + ]: 14 : if (p2p->go_neg_peer &&
3139 [ # # ]: 0 : (p2p->go_neg_peer->flags & P2P_DEV_PEER_WAITING_RESPONSE) &&
3140 : 0 : p2p->go_neg_peer->connect_reqs < 120) {
3141 : 0 : p2p_dbg(p2p, "Peer expected to wait our response - skip listen");
3142 : 0 : p2p_connect_send(p2p, p2p->go_neg_peer);
3143 : 0 : return;
3144 : : }
3145 : :
3146 : 14 : p2p_set_state(p2p, P2P_CONNECT_LISTEN);
3147 : 14 : p2p_listen_in_find(p2p, 0);
3148 : : }
3149 : :
3150 : :
3151 : 8 : static void p2p_timeout_connect_listen(struct p2p_data *p2p)
3152 : : {
3153 [ + - ]: 8 : if (p2p->go_neg_peer) {
3154 [ - + ]: 8 : if (p2p->drv_in_listen) {
3155 : 0 : p2p_dbg(p2p, "Driver is still in Listen state; wait for it to complete");
3156 : 0 : return;
3157 : : }
3158 : :
3159 [ - + ]: 8 : if (p2p->go_neg_peer->connect_reqs >= 120) {
3160 : 0 : p2p_dbg(p2p, "Timeout on sending GO Negotiation Request without getting response");
3161 : 0 : p2p_go_neg_failed(p2p, p2p->go_neg_peer, -1);
3162 : 0 : return;
3163 : : }
3164 : :
3165 : 8 : p2p_set_state(p2p, P2P_CONNECT);
3166 : 8 : p2p_connect_send(p2p, p2p->go_neg_peer);
3167 : : } else
3168 : 8 : p2p_set_state(p2p, P2P_IDLE);
3169 : : }
3170 : :
3171 : :
3172 : 0 : static void p2p_timeout_wait_peer_connect(struct p2p_data *p2p)
3173 : : {
3174 : : /*
3175 : : * TODO: could remain constantly in Listen state for some time if there
3176 : : * are no other concurrent uses for the radio. For now, go to listen
3177 : : * state once per second to give other uses a chance to use the radio.
3178 : : */
3179 : 0 : p2p_set_state(p2p, P2P_WAIT_PEER_IDLE);
3180 : 0 : p2p_set_timeout(p2p, 0, 500000);
3181 : 0 : }
3182 : :
3183 : :
3184 : 6 : static void p2p_timeout_wait_peer_idle(struct p2p_data *p2p)
3185 : : {
3186 : 6 : struct p2p_device *dev = p2p->go_neg_peer;
3187 : :
3188 [ - + ]: 6 : if (dev == NULL) {
3189 : 0 : p2p_dbg(p2p, "Unknown GO Neg peer - stop GO Neg wait");
3190 : 0 : return;
3191 : : }
3192 : :
3193 : 6 : dev->wait_count++;
3194 [ - + ]: 6 : if (dev->wait_count >= 120) {
3195 : 0 : p2p_dbg(p2p, "Timeout on waiting peer to become ready for GO Negotiation");
3196 : 0 : p2p_go_neg_failed(p2p, dev, -1);
3197 : 0 : return;
3198 : : }
3199 : :
3200 : 6 : p2p_dbg(p2p, "Go to Listen state while waiting for the peer to become ready for GO Negotiation");
3201 : 6 : p2p_set_state(p2p, P2P_WAIT_PEER_CONNECT);
3202 : 6 : p2p_listen_in_find(p2p, 0);
3203 : : }
3204 : :
3205 : :
3206 : 0 : static void p2p_timeout_sd_during_find(struct p2p_data *p2p)
3207 : : {
3208 : 0 : p2p_dbg(p2p, "Service Discovery Query timeout");
3209 [ # # ]: 0 : if (p2p->sd_peer) {
3210 : 0 : p2p->cfg->send_action_done(p2p->cfg->cb_ctx);
3211 : 0 : p2p->sd_peer->flags &= ~P2P_DEV_SD_SCHEDULE;
3212 : 0 : p2p->sd_peer = NULL;
3213 : : }
3214 : 0 : p2p_continue_find(p2p);
3215 : 0 : }
3216 : :
3217 : :
3218 : 0 : static void p2p_timeout_prov_disc_during_find(struct p2p_data *p2p)
3219 : : {
3220 : 0 : p2p_dbg(p2p, "Provision Discovery Request timeout");
3221 : 0 : p2p->cfg->send_action_done(p2p->cfg->cb_ctx);
3222 : 0 : p2p_continue_find(p2p);
3223 : 0 : }
3224 : :
3225 : :
3226 : 3 : static void p2p_timeout_prov_disc_req(struct p2p_data *p2p)
3227 : : {
3228 : 3 : p2p->pending_action_state = P2P_NO_PENDING_ACTION;
3229 : :
3230 : : /*
3231 : : * For user initiated PD requests that we have not gotten any responses
3232 : : * for while in IDLE state, we retry them a couple of times before
3233 : : * giving up.
3234 : : */
3235 [ - + ]: 3 : if (!p2p->user_initiated_pd)
3236 : 3 : return;
3237 : :
3238 : 3 : p2p_dbg(p2p, "User initiated Provision Discovery Request timeout");
3239 : :
3240 [ + - ]: 3 : if (p2p->pd_retries) {
3241 : 3 : p2p->pd_retries--;
3242 : 3 : p2p_retry_pd(p2p);
3243 : : } else {
3244 : : struct p2p_device *dev;
3245 : 0 : int for_join = 0;
3246 : :
3247 [ # # ]: 0 : dl_list_for_each(dev, &p2p->devices, struct p2p_device, list) {
3248 [ # # ]: 0 : if (os_memcmp(p2p->pending_pd_devaddr,
3249 : : dev->info.p2p_device_addr, ETH_ALEN) != 0)
3250 : 0 : continue;
3251 [ # # ][ # # ]: 0 : if (dev->req_config_methods &&
3252 : 0 : (dev->flags & P2P_DEV_PD_FOR_JOIN))
3253 : 0 : for_join = 1;
3254 : : }
3255 : :
3256 [ # # ]: 0 : if (p2p->cfg->prov_disc_fail)
3257 [ # # ]: 0 : p2p->cfg->prov_disc_fail(p2p->cfg->cb_ctx,
3258 : 0 : p2p->pending_pd_devaddr,
3259 : : for_join ?
3260 : : P2P_PROV_DISC_TIMEOUT_JOIN :
3261 : : P2P_PROV_DISC_TIMEOUT);
3262 : 0 : p2p_reset_pending_pd(p2p);
3263 : : }
3264 : : }
3265 : :
3266 : :
3267 : 0 : static void p2p_timeout_invite(struct p2p_data *p2p)
3268 : : {
3269 : 0 : p2p->cfg->send_action_done(p2p->cfg->cb_ctx);
3270 : 0 : p2p_set_state(p2p, P2P_INVITE_LISTEN);
3271 [ # # ]: 0 : if (p2p->inv_role == P2P_INVITE_ROLE_ACTIVE_GO) {
3272 : : /*
3273 : : * Better remain on operating channel instead of listen channel
3274 : : * when running a group.
3275 : : */
3276 : 0 : p2p_dbg(p2p, "Inviting in active GO role - wait on operating channel");
3277 : 0 : p2p_set_timeout(p2p, 0, 100000);
3278 : 0 : return;
3279 : : }
3280 : 0 : p2p_listen_in_find(p2p, 0);
3281 : : }
3282 : :
3283 : :
3284 : 0 : static void p2p_timeout_invite_listen(struct p2p_data *p2p)
3285 : : {
3286 [ # # ][ # # ]: 0 : if (p2p->invite_peer && p2p->invite_peer->invitation_reqs < 100) {
3287 : 0 : p2p_set_state(p2p, P2P_INVITE);
3288 : 0 : p2p_invite_send(p2p, p2p->invite_peer,
3289 : : p2p->invite_go_dev_addr);
3290 : : } else {
3291 [ # # ]: 0 : if (p2p->invite_peer) {
3292 : 0 : p2p_dbg(p2p, "Invitation Request retry limit reached");
3293 [ # # ]: 0 : if (p2p->cfg->invitation_result)
3294 : 0 : p2p->cfg->invitation_result(
3295 : 0 : p2p->cfg->cb_ctx, -1, NULL, NULL,
3296 : 0 : p2p->invite_peer->info.p2p_device_addr,
3297 : : 0);
3298 : : }
3299 : 0 : p2p_set_state(p2p, P2P_IDLE);
3300 : : }
3301 : 0 : }
3302 : :
3303 : :
3304 : 401 : static void p2p_state_timeout(void *eloop_ctx, void *timeout_ctx)
3305 : : {
3306 : 401 : struct p2p_data *p2p = eloop_ctx;
3307 : :
3308 : 401 : p2p_dbg(p2p, "Timeout (state=%s)", p2p_state_txt(p2p->state));
3309 : :
3310 : 401 : p2p->in_listen = 0;
3311 : :
3312 [ + + + + : 401 : switch (p2p->state) {
- - - + -
- - - - -
- - ]
3313 : : case P2P_IDLE:
3314 : : /* Check if we timed out waiting for PD req */
3315 [ - + ]: 18 : if (p2p->pending_action_state == P2P_PENDING_PD)
3316 : 0 : p2p_timeout_prov_disc_req(p2p);
3317 : 18 : break;
3318 : : case P2P_SEARCH:
3319 : : /* Check if we timed out waiting for PD req */
3320 [ + + ]: 355 : if (p2p->pending_action_state == P2P_PENDING_PD)
3321 : 3 : p2p_timeout_prov_disc_req(p2p);
3322 [ + + ][ + + ]: 355 : if (p2p->search_delay && !p2p->in_search_delay) {
3323 : 5 : p2p_dbg(p2p, "Delay search operation by %u ms",
3324 : : p2p->search_delay);
3325 : 5 : p2p->in_search_delay = 1;
3326 : 5 : p2p_set_timeout(p2p, p2p->search_delay / 1000,
3327 : 5 : (p2p->search_delay % 1000) * 1000);
3328 : 5 : break;
3329 : : }
3330 : 350 : p2p->in_search_delay = 0;
3331 : 350 : p2p_search(p2p);
3332 : 350 : break;
3333 : : case P2P_CONNECT:
3334 : 14 : p2p_timeout_connect(p2p);
3335 : 14 : break;
3336 : : case P2P_CONNECT_LISTEN:
3337 : 8 : p2p_timeout_connect_listen(p2p);
3338 : 8 : break;
3339 : : case P2P_GO_NEG:
3340 : 0 : break;
3341 : : case P2P_LISTEN_ONLY:
3342 : : /* Check if we timed out waiting for PD req */
3343 [ # # ]: 0 : if (p2p->pending_action_state == P2P_PENDING_PD)
3344 : 0 : p2p_timeout_prov_disc_req(p2p);
3345 : :
3346 [ # # ]: 0 : if (p2p->ext_listen_only) {
3347 : 0 : p2p_dbg(p2p, "Extended Listen Timing - Listen State completed");
3348 : 0 : p2p->ext_listen_only = 0;
3349 : 0 : p2p_set_state(p2p, P2P_IDLE);
3350 : : }
3351 : 0 : break;
3352 : : case P2P_WAIT_PEER_CONNECT:
3353 : 0 : p2p_timeout_wait_peer_connect(p2p);
3354 : 0 : break;
3355 : : case P2P_WAIT_PEER_IDLE:
3356 : 6 : p2p_timeout_wait_peer_idle(p2p);
3357 : 6 : break;
3358 : : case P2P_SD_DURING_FIND:
3359 : 0 : p2p_timeout_sd_during_find(p2p);
3360 : 0 : break;
3361 : : case P2P_PROVISIONING:
3362 : 0 : break;
3363 : : case P2P_PD_DURING_FIND:
3364 : 0 : p2p_timeout_prov_disc_during_find(p2p);
3365 : 0 : break;
3366 : : case P2P_INVITE:
3367 : 0 : p2p_timeout_invite(p2p);
3368 : 0 : break;
3369 : : case P2P_INVITE_LISTEN:
3370 : 0 : p2p_timeout_invite_listen(p2p);
3371 : 0 : break;
3372 : : case P2P_SEARCH_WHEN_READY:
3373 : 0 : break;
3374 : : case P2P_CONTINUE_SEARCH_WHEN_READY:
3375 : 0 : break;
3376 : : }
3377 : 401 : }
3378 : :
3379 : :
3380 : 0 : int p2p_reject(struct p2p_data *p2p, const u8 *peer_addr)
3381 : : {
3382 : : struct p2p_device *dev;
3383 : :
3384 : 0 : dev = p2p_get_device(p2p, peer_addr);
3385 : 0 : p2p_dbg(p2p, "Local request to reject connection attempts by peer "
3386 : 0 : MACSTR, MAC2STR(peer_addr));
3387 [ # # ]: 0 : if (dev == NULL) {
3388 : 0 : p2p_dbg(p2p, "Peer " MACSTR " unknown", MAC2STR(peer_addr));
3389 : 0 : return -1;
3390 : : }
3391 : 0 : dev->status = P2P_SC_FAIL_REJECTED_BY_USER;
3392 : 0 : dev->flags |= P2P_DEV_USER_REJECTED;
3393 : 0 : return 0;
3394 : : }
3395 : :
3396 : :
3397 : 247 : const char * p2p_wps_method_text(enum p2p_wps_method method)
3398 : : {
3399 [ + + + + : 247 : switch (method) {
- ]
3400 : : case WPS_NOT_READY:
3401 : 179 : return "not-ready";
3402 : : case WPS_PIN_DISPLAY:
3403 : 31 : return "Display";
3404 : : case WPS_PIN_KEYPAD:
3405 : 31 : return "Keypad";
3406 : : case WPS_PBC:
3407 : 6 : return "PBC";
3408 : : }
3409 : :
3410 : 247 : return "??";
3411 : : }
3412 : :
3413 : :
3414 : 179 : static const char * p2p_go_state_text(enum p2p_go_state go_state)
3415 : : {
3416 [ + + + - ]: 179 : switch (go_state) {
3417 : : case UNKNOWN_GO:
3418 : 160 : return "unknown";
3419 : : case LOCAL_GO:
3420 : 9 : return "local";
3421 : : case REMOTE_GO:
3422 : 10 : return "remote";
3423 : : }
3424 : :
3425 : 179 : return "??";
3426 : : }
3427 : :
3428 : :
3429 : 262 : const struct p2p_peer_info * p2p_get_peer_info(struct p2p_data *p2p,
3430 : : const u8 *addr, int next)
3431 : : {
3432 : : struct p2p_device *dev;
3433 : :
3434 [ + - ]: 262 : if (addr)
3435 : 262 : dev = p2p_get_device(p2p, addr);
3436 : : else
3437 [ # # ]: 0 : dev = dl_list_first(&p2p->devices, struct p2p_device, list);
3438 : :
3439 [ + + ][ - + ]: 262 : if (dev && next) {
3440 [ # # ]: 0 : dev = dl_list_first(&dev->list, struct p2p_device, list);
3441 [ # # ]: 0 : if (&dev->list == &p2p->devices)
3442 : 0 : dev = NULL;
3443 : : }
3444 : :
3445 [ + + ]: 262 : if (dev == NULL)
3446 : 83 : return NULL;
3447 : :
3448 : 262 : return &dev->info;
3449 : : }
3450 : :
3451 : :
3452 : 179 : int p2p_get_peer_info_txt(const struct p2p_peer_info *info,
3453 : : char *buf, size_t buflen)
3454 : : {
3455 : : struct p2p_device *dev;
3456 : : int res;
3457 : : char *pos, *end;
3458 : : struct os_reltime now;
3459 : :
3460 [ - + ]: 179 : if (info == NULL)
3461 : 0 : return -1;
3462 : :
3463 : 179 : dev = (struct p2p_device *) (((u8 *) info) -
3464 : : offsetof(struct p2p_device, info));
3465 : :
3466 : 179 : pos = buf;
3467 : 179 : end = buf + buflen;
3468 : :
3469 : 179 : os_get_reltime(&now);
3470 [ + + ][ + + ]: 179 : res = os_snprintf(pos, end - pos,
[ + + ][ - + ]
[ - + ][ + + ]
[ + + ][ - + ]
[ - + ][ + + ]
[ - + ][ + + ]
[ - + ][ + + ]
[ + + ][ + + ]
[ + + ]
3471 : : "age=%d\n"
3472 : : "listen_freq=%d\n"
3473 : : "wps_method=%s\n"
3474 : : "interface_addr=" MACSTR "\n"
3475 : : "member_in_go_dev=" MACSTR "\n"
3476 : : "member_in_go_iface=" MACSTR "\n"
3477 : : "go_neg_req_sent=%d\n"
3478 : : "go_state=%s\n"
3479 : : "dialog_token=%u\n"
3480 : : "intended_addr=" MACSTR "\n"
3481 : : "country=%c%c\n"
3482 : : "oper_freq=%d\n"
3483 : : "req_config_methods=0x%x\n"
3484 : : "flags=%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s\n"
3485 : : "status=%d\n"
3486 : : "wait_count=%u\n"
3487 : : "invitation_reqs=%u\n",
3488 : 358 : (int) (now.sec - dev->last_seen.sec),
3489 : : dev->listen_freq,
3490 : : p2p_wps_method_text(dev->wps_method),
3491 : 1074 : MAC2STR(dev->interface_addr),
3492 : 1074 : MAC2STR(dev->member_in_go_dev),
3493 : 1074 : MAC2STR(dev->member_in_go_iface),
3494 : : dev->go_neg_req_sent,
3495 : : p2p_go_state_text(dev->go_state),
3496 : 179 : dev->dialog_token,
3497 : 1074 : MAC2STR(dev->intended_addr),
3498 : 290 : dev->country[0] ? dev->country[0] : '_',
3499 : 290 : dev->country[1] ? dev->country[1] : '_',
3500 : : dev->oper_freq,
3501 : 179 : dev->req_config_methods,
3502 : 179 : dev->flags & P2P_DEV_PROBE_REQ_ONLY ?
3503 : : "[PROBE_REQ_ONLY]" : "",
3504 : 179 : dev->flags & P2P_DEV_REPORTED ? "[REPORTED]" : "",
3505 : 179 : dev->flags & P2P_DEV_NOT_YET_READY ?
3506 : : "[NOT_YET_READY]" : "",
3507 : 179 : dev->flags & P2P_DEV_SD_INFO ? "[SD_INFO]" : "",
3508 : 179 : dev->flags & P2P_DEV_SD_SCHEDULE ? "[SD_SCHEDULE]" :
3509 : : "",
3510 : 179 : dev->flags & P2P_DEV_PD_PEER_DISPLAY ?
3511 : : "[PD_PEER_DISPLAY]" : "",
3512 : 179 : dev->flags & P2P_DEV_PD_PEER_KEYPAD ?
3513 : : "[PD_PEER_KEYPAD]" : "",
3514 : 179 : dev->flags & P2P_DEV_USER_REJECTED ?
3515 : : "[USER_REJECTED]" : "",
3516 : 179 : dev->flags & P2P_DEV_PEER_WAITING_RESPONSE ?
3517 : : "[PEER_WAITING_RESPONSE]" : "",
3518 : 179 : dev->flags & P2P_DEV_PREFER_PERSISTENT_GROUP ?
3519 : : "[PREFER_PERSISTENT_GROUP]" : "",
3520 : 179 : dev->flags & P2P_DEV_WAIT_GO_NEG_RESPONSE ?
3521 : : "[WAIT_GO_NEG_RESPONSE]" : "",
3522 : 179 : dev->flags & P2P_DEV_WAIT_GO_NEG_CONFIRM ?
3523 : : "[WAIT_GO_NEG_CONFIRM]" : "",
3524 : 179 : dev->flags & P2P_DEV_GROUP_CLIENT_ONLY ?
3525 : : "[GROUP_CLIENT_ONLY]" : "",
3526 : 179 : dev->flags & P2P_DEV_FORCE_FREQ ?
3527 : : "[FORCE_FREQ]" : "",
3528 : 179 : dev->flags & P2P_DEV_PD_FOR_JOIN ?
3529 : : "[PD_FOR_JOIN]" : "",
3530 : : dev->status,
3531 : : dev->wait_count,
3532 : : dev->invitation_reqs);
3533 [ + - ][ - + ]: 179 : if (res < 0 || res >= end - pos)
3534 : 0 : return pos - buf;
3535 : 179 : pos += res;
3536 : :
3537 [ - + ]: 179 : if (dev->ext_listen_period) {
3538 : 0 : res = os_snprintf(pos, end - pos,
3539 : : "ext_listen_period=%u\n"
3540 : : "ext_listen_interval=%u\n",
3541 : 0 : dev->ext_listen_period,
3542 : 0 : dev->ext_listen_interval);
3543 [ # # ][ # # ]: 0 : if (res < 0 || res >= end - pos)
3544 : 0 : return pos - buf;
3545 : 0 : pos += res;
3546 : : }
3547 : :
3548 [ + + ]: 179 : if (dev->oper_ssid_len) {
3549 : 28 : res = os_snprintf(pos, end - pos,
3550 : : "oper_ssid=%s\n",
3551 : 28 : wpa_ssid_txt(dev->oper_ssid,
3552 : : dev->oper_ssid_len));
3553 [ + - ][ - + ]: 28 : if (res < 0 || res >= end - pos)
3554 : 0 : return pos - buf;
3555 : 28 : pos += res;
3556 : : }
3557 : :
3558 : : #ifdef CONFIG_WIFI_DISPLAY
3559 [ + + ]: 179 : if (dev->info.wfd_subelems) {
3560 : 159 : res = os_snprintf(pos, end - pos, "wfd_subelems=");
3561 [ + - ][ - + ]: 159 : if (res < 0 || res >= end - pos)
3562 : 0 : return pos - buf;
3563 : 159 : pos += res;
3564 : :
3565 : 318 : pos += wpa_snprintf_hex(pos, end - pos,
3566 : 159 : wpabuf_head(dev->info.wfd_subelems),
3567 : 159 : wpabuf_len(dev->info.wfd_subelems));
3568 : :
3569 : 159 : res = os_snprintf(pos, end - pos, "\n");
3570 [ + - ][ - + ]: 159 : if (res < 0 || res >= end - pos)
3571 : 0 : return pos - buf;
3572 : 159 : pos += res;
3573 : : }
3574 : : #endif /* CONFIG_WIFI_DISPLAY */
3575 : :
3576 : 179 : return pos - buf;
3577 : : }
3578 : :
3579 : :
3580 : 0 : int p2p_peer_known(struct p2p_data *p2p, const u8 *addr)
3581 : : {
3582 : 0 : return p2p_get_device(p2p, addr) != NULL;
3583 : : }
3584 : :
3585 : :
3586 : 0 : void p2p_set_client_discoverability(struct p2p_data *p2p, int enabled)
3587 : : {
3588 [ # # ]: 0 : if (enabled) {
3589 : 0 : p2p_dbg(p2p, "Client discoverability enabled");
3590 : 0 : p2p->dev_capab |= P2P_DEV_CAPAB_CLIENT_DISCOVERABILITY;
3591 : : } else {
3592 : 0 : p2p_dbg(p2p, "Client discoverability disabled");
3593 : 0 : p2p->dev_capab &= ~P2P_DEV_CAPAB_CLIENT_DISCOVERABILITY;
3594 : : }
3595 : 0 : }
3596 : :
3597 : :
3598 : 1 : static struct wpabuf * p2p_build_presence_req(u32 duration1, u32 interval1,
3599 : : u32 duration2, u32 interval2)
3600 : : {
3601 : : struct wpabuf *req;
3602 : 1 : struct p2p_noa_desc desc1, desc2, *ptr1 = NULL, *ptr2 = NULL;
3603 : : u8 *len;
3604 : :
3605 : 1 : req = wpabuf_alloc(100);
3606 [ - + ]: 1 : if (req == NULL)
3607 : 0 : return NULL;
3608 : :
3609 [ - + ][ # # ]: 1 : if (duration1 || interval1) {
3610 : 1 : os_memset(&desc1, 0, sizeof(desc1));
3611 : 1 : desc1.count_type = 1;
3612 : 1 : desc1.duration = duration1;
3613 : 1 : desc1.interval = interval1;
3614 : 1 : ptr1 = &desc1;
3615 : :
3616 [ + - ][ - + ]: 1 : if (duration2 || interval2) {
3617 : 0 : os_memset(&desc2, 0, sizeof(desc2));
3618 : 0 : desc2.count_type = 2;
3619 : 0 : desc2.duration = duration2;
3620 : 0 : desc2.interval = interval2;
3621 : 0 : ptr2 = &desc2;
3622 : : }
3623 : : }
3624 : :
3625 : 1 : p2p_buf_add_action_hdr(req, P2P_PRESENCE_REQ, 1);
3626 : 1 : len = p2p_buf_add_ie_hdr(req);
3627 : 1 : p2p_buf_add_noa(req, 0, 0, 0, ptr1, ptr2);
3628 : 1 : p2p_buf_update_ie_hdr(req, len);
3629 : :
3630 : 1 : return req;
3631 : : }
3632 : :
3633 : :
3634 : 1 : int p2p_presence_req(struct p2p_data *p2p, const u8 *go_interface_addr,
3635 : : const u8 *own_interface_addr, unsigned int freq,
3636 : : u32 duration1, u32 interval1, u32 duration2,
3637 : : u32 interval2)
3638 : : {
3639 : : struct wpabuf *req;
3640 : :
3641 : 1 : p2p_dbg(p2p, "Send Presence Request to GO " MACSTR
3642 : : " (own interface " MACSTR ") freq=%u dur1=%u int1=%u "
3643 : : "dur2=%u int2=%u",
3644 : 12 : MAC2STR(go_interface_addr), MAC2STR(own_interface_addr),
3645 : : freq, duration1, interval1, duration2, interval2);
3646 : :
3647 : 1 : req = p2p_build_presence_req(duration1, interval1, duration2,
3648 : : interval2);
3649 [ - + ]: 1 : if (req == NULL)
3650 : 0 : return -1;
3651 : :
3652 : 1 : p2p->pending_action_state = P2P_NO_PENDING_ACTION;
3653 [ - + ]: 2 : if (p2p_send_action(p2p, freq, go_interface_addr, own_interface_addr,
3654 : : go_interface_addr,
3655 : 1 : wpabuf_head(req), wpabuf_len(req), 200) < 0) {
3656 : 0 : p2p_dbg(p2p, "Failed to send Action frame");
3657 : : }
3658 : 1 : wpabuf_free(req);
3659 : :
3660 : 1 : return 0;
3661 : : }
3662 : :
3663 : :
3664 : 1 : static struct wpabuf * p2p_build_presence_resp(u8 status, const u8 *noa,
3665 : : size_t noa_len, u8 dialog_token)
3666 : : {
3667 : : struct wpabuf *resp;
3668 : : u8 *len;
3669 : :
3670 : 1 : resp = wpabuf_alloc(100 + noa_len);
3671 [ - + ]: 1 : if (resp == NULL)
3672 : 0 : return NULL;
3673 : :
3674 : 1 : p2p_buf_add_action_hdr(resp, P2P_PRESENCE_RESP, dialog_token);
3675 : 1 : len = p2p_buf_add_ie_hdr(resp);
3676 : 1 : p2p_buf_add_status(resp, status);
3677 [ - + ]: 1 : if (noa) {
3678 : 0 : wpabuf_put_u8(resp, P2P_ATTR_NOTICE_OF_ABSENCE);
3679 : 0 : wpabuf_put_le16(resp, noa_len);
3680 : 0 : wpabuf_put_data(resp, noa, noa_len);
3681 : : } else
3682 : 1 : p2p_buf_add_noa(resp, 0, 0, 0, NULL, NULL);
3683 : 1 : p2p_buf_update_ie_hdr(resp, len);
3684 : :
3685 : 1 : return resp;
3686 : : }
3687 : :
3688 : :
3689 : 1 : static void p2p_process_presence_req(struct p2p_data *p2p, const u8 *da,
3690 : : const u8 *sa, const u8 *data, size_t len,
3691 : : int rx_freq)
3692 : : {
3693 : : struct p2p_message msg;
3694 : : u8 status;
3695 : : struct wpabuf *resp;
3696 : : size_t g;
3697 : 1 : struct p2p_group *group = NULL;
3698 : 1 : int parsed = 0;
3699 : : u8 noa[50];
3700 : : int noa_len;
3701 : :
3702 : 1 : p2p_dbg(p2p, "Received P2P Action - P2P Presence Request");
3703 : :
3704 [ + - ]: 1 : for (g = 0; g < p2p->num_groups; g++) {
3705 [ + - ]: 1 : if (os_memcmp(da, p2p_group_get_interface_addr(p2p->groups[g]),
3706 : : ETH_ALEN) == 0) {
3707 : 1 : group = p2p->groups[g];
3708 : 1 : break;
3709 : : }
3710 : : }
3711 [ - + ]: 1 : if (group == NULL) {
3712 : 0 : p2p_dbg(p2p, "Ignore P2P Presence Request for unknown group "
3713 : 0 : MACSTR, MAC2STR(da));
3714 : 0 : return;
3715 : : }
3716 : :
3717 [ - + ]: 1 : if (p2p_parse(data, len, &msg) < 0) {
3718 : 0 : p2p_dbg(p2p, "Failed to parse P2P Presence Request");
3719 : 0 : status = P2P_SC_FAIL_INVALID_PARAMS;
3720 : 0 : goto fail;
3721 : : }
3722 : 1 : parsed = 1;
3723 : :
3724 [ - + ]: 1 : if (msg.noa == NULL) {
3725 : 0 : p2p_dbg(p2p, "No NoA attribute in P2P Presence Request");
3726 : 0 : status = P2P_SC_FAIL_INVALID_PARAMS;
3727 : 0 : goto fail;
3728 : : }
3729 : :
3730 : 1 : status = p2p_group_presence_req(group, sa, msg.noa, msg.noa_len);
3731 : :
3732 : : fail:
3733 [ + - ]: 1 : if (p2p->cfg->get_noa)
3734 : 1 : noa_len = p2p->cfg->get_noa(p2p->cfg->cb_ctx, da, noa,
3735 : : sizeof(noa));
3736 : : else
3737 : 0 : noa_len = -1;
3738 [ - + ]: 1 : resp = p2p_build_presence_resp(status, noa_len > 0 ? noa : NULL,
3739 : 1 : noa_len > 0 ? noa_len : 0,
3740 : 1 : msg.dialog_token);
3741 [ + - ]: 1 : if (parsed)
3742 : 1 : p2p_parse_free(&msg);
3743 [ - + ]: 1 : if (resp == NULL)
3744 : 0 : return;
3745 : :
3746 : 1 : p2p->pending_action_state = P2P_NO_PENDING_ACTION;
3747 [ - + ]: 2 : if (p2p_send_action(p2p, rx_freq, sa, da, da,
3748 : 1 : wpabuf_head(resp), wpabuf_len(resp), 200) < 0) {
3749 : 0 : p2p_dbg(p2p, "Failed to send Action frame");
3750 : : }
3751 : 1 : wpabuf_free(resp);
3752 : : }
3753 : :
3754 : :
3755 : 1 : static void p2p_process_presence_resp(struct p2p_data *p2p, const u8 *da,
3756 : : const u8 *sa, const u8 *data, size_t len)
3757 : : {
3758 : : struct p2p_message msg;
3759 : :
3760 : 1 : p2p_dbg(p2p, "Received P2P Action - P2P Presence Response");
3761 : :
3762 [ - + ]: 1 : if (p2p_parse(data, len, &msg) < 0) {
3763 : 0 : p2p_dbg(p2p, "Failed to parse P2P Presence Response");
3764 : 0 : return;
3765 : : }
3766 : :
3767 [ + - ][ - + ]: 1 : if (msg.status == NULL || msg.noa == NULL) {
3768 : 0 : p2p_dbg(p2p, "No Status or NoA attribute in P2P Presence Response");
3769 : 0 : p2p_parse_free(&msg);
3770 : 0 : return;
3771 : : }
3772 : :
3773 [ + - ]: 1 : if (p2p->cfg->presence_resp) {
3774 : 1 : p2p->cfg->presence_resp(p2p->cfg->cb_ctx, sa, *msg.status,
3775 : : msg.noa, msg.noa_len);
3776 : : }
3777 : :
3778 [ + - ]: 1 : if (*msg.status) {
3779 : 1 : p2p_dbg(p2p, "P2P Presence Request was rejected: status %u",
3780 : 1 : *msg.status);
3781 : 1 : p2p_parse_free(&msg);
3782 : 1 : return;
3783 : : }
3784 : :
3785 : 0 : p2p_dbg(p2p, "P2P Presence Request was accepted");
3786 : 0 : wpa_hexdump(MSG_DEBUG, "P2P: P2P Presence Response - NoA",
3787 : 0 : msg.noa, msg.noa_len);
3788 : : /* TODO: process NoA */
3789 : 1 : p2p_parse_free(&msg);
3790 : : }
3791 : :
3792 : :
3793 : 0 : static void p2p_ext_listen_timeout(void *eloop_ctx, void *timeout_ctx)
3794 : : {
3795 : 0 : struct p2p_data *p2p = eloop_ctx;
3796 : :
3797 [ # # ]: 0 : if (p2p->ext_listen_interval) {
3798 : : /* Schedule next extended listen timeout */
3799 : 0 : eloop_register_timeout(p2p->ext_listen_interval_sec,
3800 : : p2p->ext_listen_interval_usec,
3801 : : p2p_ext_listen_timeout, p2p, NULL);
3802 : : }
3803 : :
3804 [ # # ][ # # ]: 0 : if (p2p->state == P2P_LISTEN_ONLY && p2p->ext_listen_only) {
3805 : : /*
3806 : : * This should not really happen, but it looks like the Listen
3807 : : * command may fail is something else (e.g., a scan) was
3808 : : * running at an inconvenient time. As a workaround, allow new
3809 : : * Extended Listen operation to be started.
3810 : : */
3811 : 0 : p2p_dbg(p2p, "Previous Extended Listen operation had not been completed - try again");
3812 : 0 : p2p->ext_listen_only = 0;
3813 : 0 : p2p_set_state(p2p, P2P_IDLE);
3814 : : }
3815 : :
3816 [ # # ]: 0 : if (p2p->state != P2P_IDLE) {
3817 : 0 : p2p_dbg(p2p, "Skip Extended Listen timeout in active state (%s)", p2p_state_txt(p2p->state));
3818 : 0 : return;
3819 : : }
3820 : :
3821 : 0 : p2p_dbg(p2p, "Extended Listen timeout");
3822 : 0 : p2p->ext_listen_only = 1;
3823 [ # # ]: 0 : if (p2p_listen(p2p, p2p->ext_listen_period) < 0) {
3824 : 0 : p2p_dbg(p2p, "Failed to start Listen state for Extended Listen Timing");
3825 : 0 : p2p->ext_listen_only = 0;
3826 : : }
3827 : : }
3828 : :
3829 : :
3830 : 0 : int p2p_ext_listen(struct p2p_data *p2p, unsigned int period,
3831 : : unsigned int interval)
3832 : : {
3833 [ # # ][ # # ]: 0 : if (period > 65535 || interval > 65535 || period > interval ||
[ # # ][ # # ]
3834 [ # # ][ # # ]: 0 : (period == 0 && interval > 0) || (period > 0 && interval == 0)) {
[ # # ]
3835 : 0 : p2p_dbg(p2p, "Invalid Extended Listen Timing request: period=%u interval=%u",
3836 : : period, interval);
3837 : 0 : return -1;
3838 : : }
3839 : :
3840 : 0 : eloop_cancel_timeout(p2p_ext_listen_timeout, p2p, NULL);
3841 : :
3842 [ # # ]: 0 : if (interval == 0) {
3843 : 0 : p2p_dbg(p2p, "Disabling Extended Listen Timing");
3844 : 0 : p2p->ext_listen_period = 0;
3845 : 0 : p2p->ext_listen_interval = 0;
3846 : 0 : return 0;
3847 : : }
3848 : :
3849 : 0 : p2p_dbg(p2p, "Enabling Extended Listen Timing: period %u msec, interval %u msec",
3850 : : period, interval);
3851 : 0 : p2p->ext_listen_period = period;
3852 : 0 : p2p->ext_listen_interval = interval;
3853 : 0 : p2p->ext_listen_interval_sec = interval / 1000;
3854 : 0 : p2p->ext_listen_interval_usec = (interval % 1000) * 1000;
3855 : :
3856 : 0 : eloop_register_timeout(p2p->ext_listen_interval_sec,
3857 : : p2p->ext_listen_interval_usec,
3858 : : p2p_ext_listen_timeout, p2p, NULL);
3859 : :
3860 : 0 : return 0;
3861 : : }
3862 : :
3863 : :
3864 : 55 : void p2p_deauth_notif(struct p2p_data *p2p, const u8 *bssid, u16 reason_code,
3865 : : const u8 *ie, size_t ie_len)
3866 : : {
3867 : : struct p2p_message msg;
3868 : :
3869 [ + - ][ + - ]: 55 : if (bssid == NULL || ie == NULL)
3870 : 55 : return;
3871 : :
3872 : 0 : os_memset(&msg, 0, sizeof(msg));
3873 [ # # ]: 0 : if (p2p_parse_ies(ie, ie_len, &msg))
3874 : 0 : return;
3875 [ # # ]: 0 : if (msg.minor_reason_code == NULL)
3876 : 0 : return;
3877 : :
3878 : 0 : p2p_dbg(p2p, "Deauthentication notification BSSID " MACSTR
3879 : : " reason_code=%u minor_reason_code=%u",
3880 : 0 : MAC2STR(bssid), reason_code, *msg.minor_reason_code);
3881 : :
3882 : 55 : p2p_parse_free(&msg);
3883 : : }
3884 : :
3885 : :
3886 : 0 : void p2p_disassoc_notif(struct p2p_data *p2p, const u8 *bssid, u16 reason_code,
3887 : : const u8 *ie, size_t ie_len)
3888 : : {
3889 : : struct p2p_message msg;
3890 : :
3891 [ # # ][ # # ]: 0 : if (bssid == NULL || ie == NULL)
3892 : 0 : return;
3893 : :
3894 : 0 : os_memset(&msg, 0, sizeof(msg));
3895 [ # # ]: 0 : if (p2p_parse_ies(ie, ie_len, &msg))
3896 : 0 : return;
3897 [ # # ]: 0 : if (msg.minor_reason_code == NULL)
3898 : 0 : return;
3899 : :
3900 : 0 : p2p_dbg(p2p, "Disassociation notification BSSID " MACSTR
3901 : : " reason_code=%u minor_reason_code=%u",
3902 : 0 : MAC2STR(bssid), reason_code, *msg.minor_reason_code);
3903 : :
3904 : 0 : p2p_parse_free(&msg);
3905 : : }
3906 : :
3907 : :
3908 : 0 : void p2p_set_managed_oper(struct p2p_data *p2p, int enabled)
3909 : : {
3910 [ # # ]: 0 : if (enabled) {
3911 : 0 : p2p_dbg(p2p, "Managed P2P Device operations enabled");
3912 : 0 : p2p->dev_capab |= P2P_DEV_CAPAB_INFRA_MANAGED;
3913 : : } else {
3914 : 0 : p2p_dbg(p2p, "Managed P2P Device operations disabled");
3915 : 0 : p2p->dev_capab &= ~P2P_DEV_CAPAB_INFRA_MANAGED;
3916 : : }
3917 : 0 : }
3918 : :
3919 : :
3920 : 0 : int p2p_set_listen_channel(struct p2p_data *p2p, u8 reg_class, u8 channel)
3921 : : {
3922 [ # # ]: 0 : if (p2p_channel_to_freq(reg_class, channel) < 0)
3923 : 0 : return -1;
3924 : :
3925 : 0 : p2p_dbg(p2p, "Set Listen channel: reg_class %u channel %u",
3926 : : reg_class, channel);
3927 : 0 : p2p->cfg->reg_class = reg_class;
3928 : 0 : p2p->cfg->channel = channel;
3929 : :
3930 : 0 : return 0;
3931 : : }
3932 : :
3933 : :
3934 : 0 : int p2p_set_ssid_postfix(struct p2p_data *p2p, const u8 *postfix, size_t len)
3935 : : {
3936 : 0 : p2p_dbg(p2p, "New SSID postfix: %s", wpa_ssid_txt(postfix, len));
3937 [ # # ]: 0 : if (postfix == NULL) {
3938 : 0 : p2p->cfg->ssid_postfix_len = 0;
3939 : 0 : return 0;
3940 : : }
3941 [ # # ]: 0 : if (len > sizeof(p2p->cfg->ssid_postfix))
3942 : 0 : return -1;
3943 : 0 : os_memcpy(p2p->cfg->ssid_postfix, postfix, len);
3944 : 0 : p2p->cfg->ssid_postfix_len = len;
3945 : 0 : return 0;
3946 : : }
3947 : :
3948 : :
3949 : 0 : int p2p_set_oper_channel(struct p2p_data *p2p, u8 op_reg_class, u8 op_channel,
3950 : : int cfg_op_channel)
3951 : : {
3952 [ # # ]: 0 : if (p2p_channel_to_freq(op_reg_class, op_channel) < 0)
3953 : 0 : return -1;
3954 : :
3955 : 0 : p2p_dbg(p2p, "Set Operating channel: reg_class %u channel %u",
3956 : : op_reg_class, op_channel);
3957 : 0 : p2p->cfg->op_reg_class = op_reg_class;
3958 : 0 : p2p->cfg->op_channel = op_channel;
3959 : 0 : p2p->cfg->cfg_op_channel = cfg_op_channel;
3960 : 0 : return 0;
3961 : : }
3962 : :
3963 : :
3964 : 1450 : int p2p_set_pref_chan(struct p2p_data *p2p, unsigned int num_pref_chan,
3965 : : const struct p2p_channel *pref_chan)
3966 : : {
3967 : : struct p2p_channel *n;
3968 : :
3969 [ + + ]: 1450 : if (pref_chan) {
3970 : 4 : n = os_malloc(num_pref_chan * sizeof(struct p2p_channel));
3971 [ - + ]: 4 : if (n == NULL)
3972 : 0 : return -1;
3973 : 4 : os_memcpy(n, pref_chan,
3974 : : num_pref_chan * sizeof(struct p2p_channel));
3975 : : } else
3976 : 1446 : n = NULL;
3977 : :
3978 : 1450 : os_free(p2p->cfg->pref_chan);
3979 : 1450 : p2p->cfg->pref_chan = n;
3980 : 1450 : p2p->cfg->num_pref_chan = num_pref_chan;
3981 : :
3982 : 1450 : return 0;
3983 : : }
3984 : :
3985 : :
3986 : 1460 : int p2p_set_no_go_freq(struct p2p_data *p2p,
3987 : : const struct wpa_freq_range_list *list)
3988 : : {
3989 : : struct wpa_freq_range *tmp;
3990 : :
3991 [ + - ][ + + ]: 1460 : if (list == NULL || list->num == 0) {
3992 : 1458 : os_free(p2p->no_go_freq.range);
3993 : 1458 : p2p->no_go_freq.range = NULL;
3994 : 1458 : p2p->no_go_freq.num = 0;
3995 : 1458 : return 0;
3996 : : }
3997 : :
3998 : 2 : tmp = os_calloc(list->num, sizeof(struct wpa_freq_range));
3999 [ - + ]: 2 : if (tmp == NULL)
4000 : 0 : return -1;
4001 : 2 : os_memcpy(tmp, list->range, list->num * sizeof(struct wpa_freq_range));
4002 : 2 : os_free(p2p->no_go_freq.range);
4003 : 2 : p2p->no_go_freq.range = tmp;
4004 : 2 : p2p->no_go_freq.num = list->num;
4005 : 2 : p2p_dbg(p2p, "Updated no GO chan list");
4006 : :
4007 : 1460 : return 0;
4008 : : }
4009 : :
4010 : :
4011 : 35 : int p2p_get_interface_addr(struct p2p_data *p2p, const u8 *dev_addr,
4012 : : u8 *iface_addr)
4013 : : {
4014 : 35 : struct p2p_device *dev = p2p_get_device(p2p, dev_addr);
4015 [ + - ][ + + ]: 35 : if (dev == NULL || is_zero_ether_addr(dev->interface_addr))
4016 : 29 : return -1;
4017 : 6 : os_memcpy(iface_addr, dev->interface_addr, ETH_ALEN);
4018 : 35 : return 0;
4019 : : }
4020 : :
4021 : :
4022 : 14 : int p2p_get_dev_addr(struct p2p_data *p2p, const u8 *iface_addr,
4023 : : u8 *dev_addr)
4024 : : {
4025 : 14 : struct p2p_device *dev = p2p_get_device_interface(p2p, iface_addr);
4026 [ + - ]: 14 : if (dev == NULL)
4027 : 14 : return -1;
4028 : 0 : os_memcpy(dev_addr, dev->info.p2p_device_addr, ETH_ALEN);
4029 : 14 : return 0;
4030 : : }
4031 : :
4032 : :
4033 : 0 : void p2p_set_peer_filter(struct p2p_data *p2p, const u8 *addr)
4034 : : {
4035 : 0 : os_memcpy(p2p->peer_filter, addr, ETH_ALEN);
4036 [ # # ]: 0 : if (is_zero_ether_addr(p2p->peer_filter))
4037 : 0 : p2p_dbg(p2p, "Disable peer filter");
4038 : : else
4039 : 0 : p2p_dbg(p2p, "Enable peer filter for " MACSTR,
4040 : 0 : MAC2STR(p2p->peer_filter));
4041 : 0 : }
4042 : :
4043 : :
4044 : 0 : void p2p_set_cross_connect(struct p2p_data *p2p, int enabled)
4045 : : {
4046 [ # # ]: 0 : p2p_dbg(p2p, "Cross connection %s", enabled ? "enabled" : "disabled");
4047 [ # # ]: 0 : if (p2p->cross_connect == enabled)
4048 : 0 : return;
4049 : 0 : p2p->cross_connect = enabled;
4050 : : /* TODO: may need to tear down any action group where we are GO(?) */
4051 : : }
4052 : :
4053 : :
4054 : 21 : int p2p_get_oper_freq(struct p2p_data *p2p, const u8 *iface_addr)
4055 : : {
4056 : 21 : struct p2p_device *dev = p2p_get_device_interface(p2p, iface_addr);
4057 [ + + ]: 21 : if (dev == NULL)
4058 : 15 : return -1;
4059 [ + - ]: 6 : if (dev->oper_freq <= 0)
4060 : 6 : return -1;
4061 : 21 : return dev->oper_freq;
4062 : : }
4063 : :
4064 : :
4065 : 0 : void p2p_set_intra_bss_dist(struct p2p_data *p2p, int enabled)
4066 : : {
4067 [ # # ]: 0 : p2p_dbg(p2p, "Intra BSS distribution %s",
4068 : : enabled ? "enabled" : "disabled");
4069 : 0 : p2p->cfg->p2p_intra_bss = enabled;
4070 : 0 : }
4071 : :
4072 : :
4073 : 1064 : void p2p_update_channel_list(struct p2p_data *p2p,
4074 : : const struct p2p_channels *chan,
4075 : : const struct p2p_channels *cli_chan)
4076 : : {
4077 : 1064 : p2p_dbg(p2p, "Update channel list");
4078 : 1064 : os_memcpy(&p2p->cfg->channels, chan, sizeof(struct p2p_channels));
4079 : 1064 : p2p_channels_dump(p2p, "channels", &p2p->cfg->channels);
4080 : 1064 : os_memcpy(&p2p->cfg->cli_channels, cli_chan,
4081 : : sizeof(struct p2p_channels));
4082 : 1064 : p2p_channels_dump(p2p, "cli_channels", &p2p->cfg->cli_channels);
4083 : 1064 : }
4084 : :
4085 : :
4086 : 258 : int p2p_send_action(struct p2p_data *p2p, unsigned int freq, const u8 *dst,
4087 : : const u8 *src, const u8 *bssid, const u8 *buf,
4088 : : size_t len, unsigned int wait_time)
4089 : : {
4090 [ + + ]: 258 : if (p2p->p2p_scan_running) {
4091 : 17 : p2p_dbg(p2p, "Delay Action frame TX until p2p_scan completes");
4092 [ + + ]: 17 : if (p2p->after_scan_tx) {
4093 : 1 : p2p_dbg(p2p, "Dropped previous pending Action frame TX");
4094 : 1 : os_free(p2p->after_scan_tx);
4095 : : }
4096 : 17 : p2p->after_scan_tx = os_malloc(sizeof(*p2p->after_scan_tx) +
4097 : : len);
4098 [ - + ]: 17 : if (p2p->after_scan_tx == NULL)
4099 : 0 : return -1;
4100 : 17 : p2p->after_scan_tx->freq = freq;
4101 : 17 : os_memcpy(p2p->after_scan_tx->dst, dst, ETH_ALEN);
4102 : 17 : os_memcpy(p2p->after_scan_tx->src, src, ETH_ALEN);
4103 : 17 : os_memcpy(p2p->after_scan_tx->bssid, bssid, ETH_ALEN);
4104 : 17 : p2p->after_scan_tx->len = len;
4105 : 17 : p2p->after_scan_tx->wait_time = wait_time;
4106 : 17 : os_memcpy(p2p->after_scan_tx + 1, buf, len);
4107 : 17 : return 0;
4108 : : }
4109 : :
4110 : 258 : return p2p->cfg->send_action(p2p->cfg->cb_ctx, freq, dst, src, bssid,
4111 : : buf, len, wait_time);
4112 : : }
4113 : :
4114 : :
4115 : 0 : void p2p_set_best_channels(struct p2p_data *p2p, int freq_24, int freq_5,
4116 : : int freq_overall)
4117 : : {
4118 : 0 : p2p_dbg(p2p, "Best channel: 2.4 GHz: %d, 5 GHz: %d, overall: %d",
4119 : : freq_24, freq_5, freq_overall);
4120 : 0 : p2p->best_freq_24 = freq_24;
4121 : 0 : p2p->best_freq_5 = freq_5;
4122 : 0 : p2p->best_freq_overall = freq_overall;
4123 : 0 : }
4124 : :
4125 : :
4126 : 91 : void p2p_set_own_freq_preference(struct p2p_data *p2p, int freq)
4127 : : {
4128 : 91 : p2p_dbg(p2p, "Own frequency preference: %d MHz", freq);
4129 : 91 : p2p->own_freq_preference = freq;
4130 : 91 : }
4131 : :
4132 : :
4133 : 0 : const u8 * p2p_get_go_neg_peer(struct p2p_data *p2p)
4134 : : {
4135 [ # # ][ # # ]: 0 : if (p2p == NULL || p2p->go_neg_peer == NULL)
4136 : 0 : return NULL;
4137 : 0 : return p2p->go_neg_peer->info.p2p_device_addr;
4138 : : }
4139 : :
4140 : :
4141 : : const struct p2p_peer_info *
4142 : 0 : p2p_get_peer_found(struct p2p_data *p2p, const u8 *addr, int next)
4143 : : {
4144 : : struct p2p_device *dev;
4145 : :
4146 [ # # ]: 0 : if (addr) {
4147 : 0 : dev = p2p_get_device(p2p, addr);
4148 [ # # ]: 0 : if (!dev)
4149 : 0 : return NULL;
4150 : :
4151 [ # # ]: 0 : if (!next) {
4152 [ # # ]: 0 : if (dev->flags & P2P_DEV_PROBE_REQ_ONLY)
4153 : 0 : return NULL;
4154 : :
4155 : 0 : return &dev->info;
4156 : : } else {
4157 : : do {
4158 [ # # ]: 0 : dev = dl_list_first(&dev->list,
4159 : : struct p2p_device,
4160 : : list);
4161 [ # # ]: 0 : if (&dev->list == &p2p->devices)
4162 : 0 : return NULL;
4163 [ # # ]: 0 : } while (dev->flags & P2P_DEV_PROBE_REQ_ONLY);
4164 : : }
4165 : : } else {
4166 [ # # ]: 0 : dev = dl_list_first(&p2p->devices, struct p2p_device, list);
4167 [ # # ]: 0 : if (!dev)
4168 : 0 : return NULL;
4169 [ # # ]: 0 : while (dev->flags & P2P_DEV_PROBE_REQ_ONLY) {
4170 [ # # ]: 0 : dev = dl_list_first(&dev->list,
4171 : : struct p2p_device,
4172 : : list);
4173 [ # # ]: 0 : if (&dev->list == &p2p->devices)
4174 : 0 : return NULL;
4175 : : }
4176 : : }
4177 : :
4178 : 0 : return &dev->info;
4179 : : }
4180 : :
4181 : :
4182 : 515 : int p2p_in_progress(struct p2p_data *p2p)
4183 : : {
4184 [ - + ]: 515 : if (p2p == NULL)
4185 : 0 : return 0;
4186 [ + - ][ + - ]: 515 : if (p2p->state == P2P_SEARCH || p2p->state == P2P_SEARCH_WHEN_READY ||
[ - + ]
4187 : 515 : p2p->state == P2P_CONTINUE_SEARCH_WHEN_READY)
4188 : 0 : return 2;
4189 [ + + ][ - + ]: 515 : return p2p->state != P2P_IDLE && p2p->state != P2P_PROVISIONING;
4190 : : }
4191 : :
4192 : :
4193 : 45 : void p2p_set_config_timeout(struct p2p_data *p2p, u8 go_timeout,
4194 : : u8 client_timeout)
4195 : : {
4196 [ + - ]: 45 : if (p2p) {
4197 : 45 : p2p->go_timeout = go_timeout;
4198 : 45 : p2p->client_timeout = client_timeout;
4199 : : }
4200 : 45 : }
4201 : :
4202 : :
4203 : 2 : void p2p_increase_search_delay(struct p2p_data *p2p, unsigned int delay)
4204 : : {
4205 [ + - ][ - + ]: 2 : if (p2p && p2p->search_delay < delay)
4206 : 0 : p2p->search_delay = delay;
4207 : 2 : }
4208 : :
4209 : :
4210 : : #ifdef CONFIG_WIFI_DISPLAY
4211 : :
4212 : 12 : static void p2p_update_wfd_ie_groups(struct p2p_data *p2p)
4213 : : {
4214 : : size_t g;
4215 : : struct p2p_group *group;
4216 : :
4217 [ - + ]: 12 : for (g = 0; g < p2p->num_groups; g++) {
4218 : 0 : group = p2p->groups[g];
4219 : 0 : p2p_group_force_beacon_update_ies(group);
4220 : : }
4221 : 12 : }
4222 : :
4223 : :
4224 : 6 : int p2p_set_wfd_ie_beacon(struct p2p_data *p2p, struct wpabuf *ie)
4225 : : {
4226 : 6 : wpabuf_free(p2p->wfd_ie_beacon);
4227 : 6 : p2p->wfd_ie_beacon = ie;
4228 : 6 : p2p_update_wfd_ie_groups(p2p);
4229 : 6 : return 0;
4230 : : }
4231 : :
4232 : :
4233 : 6 : int p2p_set_wfd_ie_probe_req(struct p2p_data *p2p, struct wpabuf *ie)
4234 : : {
4235 : 6 : wpabuf_free(p2p->wfd_ie_probe_req);
4236 : 6 : p2p->wfd_ie_probe_req = ie;
4237 : 6 : return 0;
4238 : : }
4239 : :
4240 : :
4241 : 6 : int p2p_set_wfd_ie_probe_resp(struct p2p_data *p2p, struct wpabuf *ie)
4242 : : {
4243 : 6 : wpabuf_free(p2p->wfd_ie_probe_resp);
4244 : 6 : p2p->wfd_ie_probe_resp = ie;
4245 : 6 : p2p_update_wfd_ie_groups(p2p);
4246 : 6 : return 0;
4247 : : }
4248 : :
4249 : :
4250 : 6 : int p2p_set_wfd_ie_assoc_req(struct p2p_data *p2p, struct wpabuf *ie)
4251 : : {
4252 : 6 : wpabuf_free(p2p->wfd_ie_assoc_req);
4253 : 6 : p2p->wfd_ie_assoc_req = ie;
4254 : 6 : return 0;
4255 : : }
4256 : :
4257 : :
4258 : 6 : int p2p_set_wfd_ie_invitation(struct p2p_data *p2p, struct wpabuf *ie)
4259 : : {
4260 : 6 : wpabuf_free(p2p->wfd_ie_invitation);
4261 : 6 : p2p->wfd_ie_invitation = ie;
4262 : 6 : return 0;
4263 : : }
4264 : :
4265 : :
4266 : 6 : int p2p_set_wfd_ie_prov_disc_req(struct p2p_data *p2p, struct wpabuf *ie)
4267 : : {
4268 : 6 : wpabuf_free(p2p->wfd_ie_prov_disc_req);
4269 : 6 : p2p->wfd_ie_prov_disc_req = ie;
4270 : 6 : return 0;
4271 : : }
4272 : :
4273 : :
4274 : 6 : int p2p_set_wfd_ie_prov_disc_resp(struct p2p_data *p2p, struct wpabuf *ie)
4275 : : {
4276 : 6 : wpabuf_free(p2p->wfd_ie_prov_disc_resp);
4277 : 6 : p2p->wfd_ie_prov_disc_resp = ie;
4278 : 6 : return 0;
4279 : : }
4280 : :
4281 : :
4282 : 6 : int p2p_set_wfd_ie_go_neg(struct p2p_data *p2p, struct wpabuf *ie)
4283 : : {
4284 : 6 : wpabuf_free(p2p->wfd_ie_go_neg);
4285 : 6 : p2p->wfd_ie_go_neg = ie;
4286 : 6 : return 0;
4287 : : }
4288 : :
4289 : :
4290 : 6 : int p2p_set_wfd_dev_info(struct p2p_data *p2p, const struct wpabuf *elem)
4291 : : {
4292 : 6 : wpabuf_free(p2p->wfd_dev_info);
4293 [ + + ]: 6 : if (elem) {
4294 : 3 : p2p->wfd_dev_info = wpabuf_dup(elem);
4295 [ - + ]: 3 : if (p2p->wfd_dev_info == NULL)
4296 : 0 : return -1;
4297 : : } else
4298 : 3 : p2p->wfd_dev_info = NULL;
4299 : :
4300 : 6 : return 0;
4301 : : }
4302 : :
4303 : :
4304 : 6 : int p2p_set_wfd_assoc_bssid(struct p2p_data *p2p, const struct wpabuf *elem)
4305 : : {
4306 : 6 : wpabuf_free(p2p->wfd_assoc_bssid);
4307 [ - + ]: 6 : if (elem) {
4308 : 0 : p2p->wfd_assoc_bssid = wpabuf_dup(elem);
4309 [ # # ]: 0 : if (p2p->wfd_assoc_bssid == NULL)
4310 : 0 : return -1;
4311 : : } else
4312 : 6 : p2p->wfd_assoc_bssid = NULL;
4313 : :
4314 : 6 : return 0;
4315 : : }
4316 : :
4317 : :
4318 : 6 : int p2p_set_wfd_coupled_sink_info(struct p2p_data *p2p,
4319 : : const struct wpabuf *elem)
4320 : : {
4321 : 6 : wpabuf_free(p2p->wfd_coupled_sink_info);
4322 [ - + ]: 6 : if (elem) {
4323 : 0 : p2p->wfd_coupled_sink_info = wpabuf_dup(elem);
4324 [ # # ]: 0 : if (p2p->wfd_coupled_sink_info == NULL)
4325 : 0 : return -1;
4326 : : } else
4327 : 6 : p2p->wfd_coupled_sink_info = NULL;
4328 : :
4329 : 6 : return 0;
4330 : : }
4331 : :
4332 : : #endif /* CONFIG_WIFI_DISPLAY */
4333 : :
4334 : :
4335 : 0 : int p2p_set_disc_int(struct p2p_data *p2p, int min_disc_int, int max_disc_int,
4336 : : int max_disc_tu)
4337 : : {
4338 [ # # ][ # # ]: 0 : if (min_disc_int > max_disc_int || min_disc_int < 0 || max_disc_int < 0)
[ # # ]
4339 : 0 : return -1;
4340 : :
4341 : 0 : p2p->min_disc_int = min_disc_int;
4342 : 0 : p2p->max_disc_int = max_disc_int;
4343 : 0 : p2p->max_disc_tu = max_disc_tu;
4344 : 0 : p2p_dbg(p2p, "Set discoverable interval: min=%d max=%d max_tu=%d",
4345 : : min_disc_int, max_disc_int, max_disc_tu);
4346 : :
4347 : 0 : return 0;
4348 : : }
4349 : :
4350 : :
4351 : 19614 : void p2p_dbg(struct p2p_data *p2p, const char *fmt, ...)
4352 : : {
4353 : : va_list ap;
4354 : : char buf[500];
4355 : :
4356 [ - + ]: 19614 : if (!p2p->cfg->debug_print)
4357 : 19614 : return;
4358 : :
4359 : 19614 : va_start(ap, fmt);
4360 : 19614 : vsnprintf(buf, sizeof(buf), fmt, ap);
4361 : 19614 : buf[sizeof(buf) - 1] = '\0';
4362 : 19614 : va_end(ap);
4363 : 19614 : p2p->cfg->debug_print(p2p->cfg->cb_ctx, MSG_DEBUG, buf);
4364 : : }
4365 : :
4366 : :
4367 : 1 : void p2p_info(struct p2p_data *p2p, const char *fmt, ...)
4368 : : {
4369 : : va_list ap;
4370 : : char buf[500];
4371 : :
4372 [ - + ]: 1 : if (!p2p->cfg->debug_print)
4373 : 1 : return;
4374 : :
4375 : 1 : va_start(ap, fmt);
4376 : 1 : vsnprintf(buf, sizeof(buf), fmt, ap);
4377 : 1 : buf[sizeof(buf) - 1] = '\0';
4378 : 1 : va_end(ap);
4379 : 1 : p2p->cfg->debug_print(p2p->cfg->cb_ctx, MSG_INFO, buf);
4380 : : }
4381 : :
4382 : :
4383 : 0 : void p2p_err(struct p2p_data *p2p, const char *fmt, ...)
4384 : : {
4385 : : va_list ap;
4386 : : char buf[500];
4387 : :
4388 [ # # ]: 0 : if (!p2p->cfg->debug_print)
4389 : 0 : return;
4390 : :
4391 : 0 : va_start(ap, fmt);
4392 : 0 : vsnprintf(buf, sizeof(buf), fmt, ap);
4393 : 0 : buf[sizeof(buf) - 1] = '\0';
4394 : 0 : va_end(ap);
4395 : 0 : p2p->cfg->debug_print(p2p->cfg->cb_ctx, MSG_ERROR, buf);
4396 : : }
|
