18 static struct wpabuf * p2p_build_invitation_req(struct p2p_data *p2p,  in p2p_build_invitation_req()  argument
30 	struct wpabuf *wfd_ie = p2p->wfd_ie_invitation;  in p2p_build_invitation_req()
31 	if (wfd_ie && p2p->inv_role == P2P_INVITE_ROLE_ACTIVE_GO) {  in p2p_build_invitation_req()
33 		for (i = 0; i < p2p->num_groups; i++) {  in p2p_build_invitation_req()
34 			struct p2p_group *g = p2p->groups[i];  in p2p_build_invitation_req()
37 					      p2p->inv_bssid))  in p2p_build_invitation_req()
50 	if (p2p->vendor_elem && p2p->vendor_elem[VENDOR_ELEM_P2P_INV_REQ])  in p2p_build_invitation_req()
51 		extra += wpabuf_len(p2p->vendor_elem[VENDOR_ELEM_P2P_INV_REQ]);  in p2p_build_invitation_req()
64 	if (p2p->inv_role == P2P_INVITE_ROLE_ACTIVE_GO || !p2p->inv_persistent)  in p2p_build_invitation_req()
67 		p2p_buf_add_config_timeout(buf, p2p->go_timeout,  in p2p_build_invitation_req()
68 					   p2p->client_timeout);  in p2p_build_invitation_req()
69 	p2p_buf_add_invitation_flags(buf, p2p->inv_persistent ?  in p2p_build_invitation_req()
71 	if (p2p->inv_role != P2P_INVITE_ROLE_CLIENT ||  in p2p_build_invitation_req()
73 		p2p_buf_add_operating_channel(buf, p2p->cfg->country,  in p2p_build_invitation_req()
74 					      p2p->op_reg_class,  in p2p_build_invitation_req()
75 					      p2p->op_channel);  in p2p_build_invitation_req()
76 	if (p2p->inv_bssid_set)  in p2p_build_invitation_req()
77 		p2p_buf_add_group_bssid(buf, p2p->inv_bssid);  in p2p_build_invitation_req()
78 	is_6ghz_capab = is_p2p_6ghz_capable(p2p) &&  in p2p_build_invitation_req()
79 		p2p_is_peer_6ghz_capab(p2p, peer->info.p2p_device_addr);  in p2p_build_invitation_req()
80 	p2p_buf_add_channel_list(buf, p2p->cfg->country, &p2p->channels,  in p2p_build_invitation_req()
84 	else if (p2p->inv_role == P2P_INVITE_ROLE_CLIENT)  in p2p_build_invitation_req()
87 		dev_addr = p2p->cfg->dev_addr;  in p2p_build_invitation_req()
88 	p2p_buf_add_group_id(buf, dev_addr, p2p->inv_ssid, p2p->inv_ssid_len);  in p2p_build_invitation_req()
89 	p2p_buf_add_device_info(buf, p2p, peer);  in p2p_build_invitation_req()
92 	p2p_buf_add_pref_channel_list(buf, p2p->pref_freq_list,  in p2p_build_invitation_req()
93 				      p2p->num_pref_freq);  in p2p_build_invitation_req()
100 	if (p2p->vendor_elem && p2p->vendor_elem[VENDOR_ELEM_P2P_INV_REQ])  in p2p_build_invitation_req()
101 		wpabuf_put_buf(buf, p2p->vendor_elem[VENDOR_ELEM_P2P_INV_REQ]);  in p2p_build_invitation_req()
105 		p2p_build_wps_ie(p2p, buf, dev_pw_id, 0);  in p2p_build_invitation_req()
112 static struct wpabuf * p2p_build_invitation_resp(struct p2p_data *p2p,  in p2p_build_invitation_resp()  argument
124 	struct wpabuf *wfd_ie = p2p->wfd_ie_invitation;  in p2p_build_invitation_resp()
127 		for (i = 0; i < p2p->num_groups; i++) {  in p2p_build_invitation_resp()
128 			struct p2p_group *g = p2p->groups[i];  in p2p_build_invitation_resp()
144 	if (p2p->vendor_elem && p2p->vendor_elem[VENDOR_ELEM_P2P_INV_RESP])  in p2p_build_invitation_resp()
145 		extra += wpabuf_len(p2p->vendor_elem[VENDOR_ELEM_P2P_INV_RESP]);  in p2p_build_invitation_resp()
158 		p2p_buf_add_operating_channel(buf, p2p->cfg->country,  in p2p_build_invitation_resp()
165 		is_6ghz_capab = is_p2p_6ghz_capable(p2p) &&  in p2p_build_invitation_resp()
166 			p2p_is_peer_6ghz_capab(p2p, peer->info.p2p_device_addr);  in p2p_build_invitation_resp()
167 		p2p_buf_add_channel_list(buf, p2p->cfg->country, channels,  in p2p_build_invitation_resp()
177 	if (p2p->vendor_elem && p2p->vendor_elem[VENDOR_ELEM_P2P_INV_RESP])  in p2p_build_invitation_resp()
178 		wpabuf_put_buf(buf, p2p->vendor_elem[VENDOR_ELEM_P2P_INV_RESP]);  in p2p_build_invitation_resp()
184 void p2p_process_invitation_req(struct p2p_data *p2p, const u8 *sa,  in p2p_process_invitation_req()  argument
201 	p2p_dbg(p2p, "Received Invitation Request from " MACSTR " (freq=%d)",  in p2p_process_invitation_req()
207 	dev = p2p_get_device(p2p, sa);  in p2p_process_invitation_req()
209 		p2p_dbg(p2p, "Invitation Request from unknown peer " MACSTR,  in p2p_process_invitation_req()
212 		if (p2p_add_device(p2p, sa, rx_freq, NULL, 0, data + 1, len - 1,  in p2p_process_invitation_req()
214 			p2p_dbg(p2p, "Invitation Request add device failed "  in p2p_process_invitation_req()
220 		dev = p2p_get_device(p2p, sa);  in p2p_process_invitation_req()
222 			p2p_dbg(p2p, "Reject Invitation Request from unknown peer "  in p2p_process_invitation_req()
230 		p2p_dbg(p2p, "Mandatory attribute missing in Invitation Request from "  in p2p_process_invitation_req()
244 		p2p_dbg(p2p, "Mandatory Invitation Flags attribute missing from Invitation Request");  in p2p_process_invitation_req()
248 	p2p_channels_union(&p2p->cfg->channels, &p2p->cfg->cli_channels,  in p2p_process_invitation_req()
251 	if (p2p_peer_channels_check(p2p, &all_channels, dev,  in p2p_process_invitation_req()
254 		p2p_dbg(p2p, "No common channels found");  in p2p_process_invitation_req()
259 	p2p_channels_dump(p2p, "own channels", &p2p->cfg->channels);  in p2p_process_invitation_req()
260 	p2p_channels_dump(p2p, "own client channels", &all_channels);  in p2p_process_invitation_req()
261 	p2p_channels_dump(p2p, "peer channels", &dev->channels);  in p2p_process_invitation_req()
264 	p2p_channels_dump(p2p, "intersection", &intersection);  in p2p_process_invitation_req()
266 	if (p2p->cfg->invitation_process) {  in p2p_process_invitation_req()
267 		status = p2p->cfg->invitation_process(  in p2p_process_invitation_req()
268 			p2p->cfg->cb_ctx, sa, msg.group_bssid, msg.group_id,  in p2p_process_invitation_req()
275 		p2p_channels_intersect(&p2p->cfg->channels, &dev->channels,  in p2p_process_invitation_req()
277 		p2p_channels_dump(p2p, "intersection(GO)", &intersection);  in p2p_process_invitation_req()
279 			p2p_dbg(p2p, "No common channels found (GO)");  in p2p_process_invitation_req()
286 		p2p_dbg(p2p, "Invitation processing forced frequency %d MHz",  in p2p_process_invitation_req()
289 			p2p_dbg(p2p, "Unknown forced freq %d MHz from invitation_process()",  in p2p_process_invitation_req()
297 			p2p_dbg(p2p, "forced freq %d MHz not in the supported channels intersection",  in p2p_process_invitation_req()
306 		p2p_dbg(p2p, "No forced channel from invitation processing - figure out best one to use");  in p2p_process_invitation_req()
309 		p2p->op_reg_class = p2p->cfg->op_reg_class;  in p2p_process_invitation_req()
310 		p2p->op_channel = p2p->cfg->op_channel;  in p2p_process_invitation_req()
311 		p2p_dbg(p2p, "Own default op_class %d channel %d",  in p2p_process_invitation_req()
312 			p2p->op_reg_class, p2p->op_channel);  in p2p_process_invitation_req()
320 			p2p_dbg(p2p, "Peer operating channel preference: %d MHz",  in p2p_process_invitation_req()
326 				p2p->op_reg_class = msg.operating_channel[3];  in p2p_process_invitation_req()
327 				p2p->op_channel = msg.operating_channel[4];  in p2p_process_invitation_req()
328 				p2p_dbg(p2p, "Use peer preference op_class %d channel %d",  in p2p_process_invitation_req()
329 					p2p->op_reg_class, p2p->op_channel);  in p2p_process_invitation_req()
331 				p2p_dbg(p2p, "Cannot use peer channel preference");  in p2p_process_invitation_req()
337 		    !p2p_channels_includes(&intersection, p2p->op_reg_class,  in p2p_process_invitation_req()
338 					   p2p->op_channel)) {  in p2p_process_invitation_req()
339 …p2p_dbg(p2p, "Initially selected channel (op_class %d channel %d) not in channel intersection - tr…  in p2p_process_invitation_req()
340 				p2p->op_reg_class, p2p->op_channel);  in p2p_process_invitation_req()
341 			p2p_reselect_channel(p2p, &intersection);  in p2p_process_invitation_req()
342 			p2p_dbg(p2p, "Re-selection result: op_class %d channel %d",  in p2p_process_invitation_req()
343 				p2p->op_reg_class, p2p->op_channel);  in p2p_process_invitation_req()
345 						   p2p->op_reg_class,  in p2p_process_invitation_req()
346 						   p2p->op_channel)) {  in p2p_process_invitation_req()
347 				p2p_dbg(p2p, "Peer does not support selected operating channel (reg_class=%u channel=%u)",  in p2p_process_invitation_req()
348 					p2p->op_reg_class, p2p->op_channel);  in p2p_process_invitation_req()
353 			   !p2p->cfg->cfg_op_channel) {  in p2p_process_invitation_req()
354 …p2p_dbg(p2p, "Try to reselect channel selection with peer information received; previously selecte…  in p2p_process_invitation_req()
355 				p2p->op_reg_class, p2p->op_channel);  in p2p_process_invitation_req()
356 			p2p_reselect_channel(p2p, &intersection);  in p2p_process_invitation_req()
363 		p2p_check_pref_chan(p2p, go, dev, &msg);  in p2p_process_invitation_req()
365 		op_freq = p2p_channel_to_freq(p2p->op_reg_class,  in p2p_process_invitation_req()
366 					      p2p->op_channel);  in p2p_process_invitation_req()
368 			p2p_dbg(p2p, "Unknown operational channel (country=%c%c reg_class=%u channel=%u)",  in p2p_process_invitation_req()
369 				p2p->cfg->country[0], p2p->cfg->country[1],  in p2p_process_invitation_req()
370 				p2p->op_reg_class, p2p->op_channel);  in p2p_process_invitation_req()
374 		p2p_dbg(p2p, "Selected operating channel - %d MHz", op_freq);  in p2p_process_invitation_req()
377 			reg_class = p2p->op_reg_class;  in p2p_process_invitation_req()
378 			channel = p2p->op_channel;  in p2p_process_invitation_req()
388 	resp = p2p_build_invitation_resp(p2p, dev, msg.dialog_token, status,  in p2p_process_invitation_req()
397 		freq = p2p_channel_to_freq(p2p->cfg->reg_class,  in p2p_process_invitation_req()
398 					   p2p->cfg->channel);  in p2p_process_invitation_req()
400 		p2p_dbg(p2p, "Unknown regulatory class/channel");  in p2p_process_invitation_req()
408 	os_memcpy(p2p->inv_sa, sa, ETH_ALEN);  in p2p_process_invitation_req()
410 		os_memcpy(p2p->inv_group_bssid, msg.group_bssid, ETH_ALEN);  in p2p_process_invitation_req()
411 		p2p->inv_group_bssid_ptr = p2p->inv_group_bssid;  in p2p_process_invitation_req()
413 		p2p->inv_group_bssid_ptr = NULL;  in p2p_process_invitation_req()
416 			os_memcpy(p2p->inv_ssid, msg.group_id + ETH_ALEN,  in p2p_process_invitation_req()
418 			p2p->inv_ssid_len = msg.group_id_len - ETH_ALEN;  in p2p_process_invitation_req()
420 		os_memcpy(p2p->inv_go_dev_addr, msg.group_id, ETH_ALEN);  in p2p_process_invitation_req()
422 		p2p->inv_ssid_len = 0;  in p2p_process_invitation_req()
423 		os_memset(p2p->inv_go_dev_addr, 0, ETH_ALEN);  in p2p_process_invitation_req()
425 	p2p->inv_status = status;  in p2p_process_invitation_req()
426 	p2p->inv_op_freq = op_freq;  in p2p_process_invitation_req()
428 	p2p->pending_action_state = P2P_PENDING_INVITATION_RESPONSE;  in p2p_process_invitation_req()
429 	if (p2p_send_action(p2p, freq, sa, p2p->cfg->dev_addr,  in p2p_process_invitation_req()
430 			    p2p->cfg->dev_addr,  in p2p_process_invitation_req()
432 		p2p_dbg(p2p, "Failed to send Action frame");  in p2p_process_invitation_req()
441 void p2p_process_invitation_resp(struct p2p_data *p2p, const u8 *sa,  in p2p_process_invitation_resp()  argument
448 	p2p_dbg(p2p, "Received Invitation Response from " MACSTR,  in p2p_process_invitation_resp()
451 	dev = p2p_get_device(p2p, sa);  in p2p_process_invitation_resp()
453 		p2p_dbg(p2p, "Ignore Invitation Response from unknown peer "  in p2p_process_invitation_resp()
455 		p2p->cfg->send_action_done(p2p->cfg->cb_ctx);  in p2p_process_invitation_resp()
459 	if (dev != p2p->invite_peer) {  in p2p_process_invitation_resp()
460 		p2p_dbg(p2p, "Ignore unexpected Invitation Response from peer "  in p2p_process_invitation_resp()
462 		p2p->cfg->send_action_done(p2p->cfg->cb_ctx);  in p2p_process_invitation_resp()
467 		p2p->cfg->send_action_done(p2p->cfg->cb_ctx);  in p2p_process_invitation_resp()
472 		p2p_dbg(p2p, "Mandatory Status attribute missing in Invitation Response from "  in p2p_process_invitation_resp()
475 		p2p->cfg->send_action_done(p2p->cfg->cb_ctx);  in p2p_process_invitation_resp()
490 	    p2p->retry_invite_req_sent &&  in p2p_process_invitation_resp()
492 		p2p_dbg(p2p, "Unexpected Dialog Token %u (expected %u)",  in p2p_process_invitation_resp()
499 	    p2p->retry_invite_req &&  in p2p_process_invitation_resp()
500 	    p2p_channel_random_social(&p2p->cfg->channels, &p2p->op_reg_class,  in p2p_process_invitation_resp()
501 				      &p2p->op_channel, NULL, NULL) == 0) {  in p2p_process_invitation_resp()
502 		p2p->retry_invite_req = 0;  in p2p_process_invitation_resp()
503 		p2p->cfg->send_action_done(p2p->cfg->cb_ctx);  in p2p_process_invitation_resp()
504 		p2p->cfg->stop_listen(p2p->cfg->cb_ctx);  in p2p_process_invitation_resp()
505 		p2p_set_state(p2p, P2P_INVITE);  in p2p_process_invitation_resp()
506 		p2p_dbg(p2p, "Resend Invitation Request setting op_class %u channel %u as operating channel",  in p2p_process_invitation_resp()
507 			p2p->op_reg_class, p2p->op_channel);  in p2p_process_invitation_resp()
508 		p2p->retry_invite_req_sent = 1;  in p2p_process_invitation_resp()
509 		p2p_invite_send(p2p, p2p->invite_peer, p2p->invite_go_dev_addr,  in p2p_process_invitation_resp()
510 				p2p->invite_dev_pw_id);  in p2p_process_invitation_resp()
514 	p2p->cfg->send_action_done(p2p->cfg->cb_ctx);  in p2p_process_invitation_resp()
515 	p2p->retry_invite_req = 0;  in p2p_process_invitation_resp()
518 		p2p_dbg(p2p, "Mandatory Channel List attribute missing in Invitation Response from "  in p2p_process_invitation_resp()
525 		channels = &p2p->channels;  in p2p_process_invitation_resp()
528 		channels = &p2p->channels;  in p2p_process_invitation_resp()
529 	} else if (p2p_peer_channels_check(p2p, &p2p->channels, dev,  in p2p_process_invitation_resp()
532 		p2p_dbg(p2p, "No common channels found");  in p2p_process_invitation_resp()
536 		p2p_channels_intersect(&p2p->channels, &dev->channels,  in p2p_process_invitation_resp()
541 	if (p2p->cfg->invitation_result) {  in p2p_process_invitation_resp()
543 		int freq = p2p_channel_to_freq(p2p->op_reg_class,  in p2p_process_invitation_resp()
544 					       p2p->op_channel);  in p2p_process_invitation_resp()
560 		p2p_check_pref_chan(p2p, 0, dev, &msg);  in p2p_process_invitation_resp()
562 		p2p->cfg->invitation_result(p2p->cfg->cb_ctx, *msg.status,  in p2p_process_invitation_resp()
569 	p2p_clear_timeout(p2p);  in p2p_process_invitation_resp()
570 	p2p_set_state(p2p, P2P_IDLE);  in p2p_process_invitation_resp()
571 	p2p->invite_peer = NULL;  in p2p_process_invitation_resp()
575 int p2p_invite_send(struct p2p_data *p2p, struct p2p_device *dev,  in p2p_invite_send()  argument
585 		p2p_dbg(p2p, "No Listen/Operating frequency known for the peer "  in p2p_invite_send()
591 	req = p2p_build_invitation_req(p2p, dev, go_dev_addr, dev_pw_id);  in p2p_invite_send()
594 	if (p2p->state != P2P_IDLE)  in p2p_invite_send()
595 		p2p_stop_listen_for_freq(p2p, freq);  in p2p_invite_send()
596 	p2p_dbg(p2p, "Sending Invitation Request");  in p2p_invite_send()
597 	p2p_set_state(p2p, P2P_INVITE);  in p2p_invite_send()
598 	p2p->pending_action_state = P2P_PENDING_INVITATION_REQUEST;  in p2p_invite_send()
599 	p2p->invite_peer = dev;  in p2p_invite_send()
604 	if (p2p_send_action(p2p, freq, dev->info.p2p_device_addr,  in p2p_invite_send()
605 			    p2p->cfg->dev_addr, dev->info.p2p_device_addr,  in p2p_invite_send()
607 			    p2p->inv_role == P2P_INVITE_ROLE_ACTIVE_GO ?  in p2p_invite_send()
609 		p2p_dbg(p2p, "Failed to send Action frame");  in p2p_invite_send()
611 		p2p_set_timeout(p2p, 0, 0);  in p2p_invite_send()
622 void p2p_invitation_req_cb(struct p2p_data *p2p, int success)  in p2p_invitation_req_cb()  argument
624 	p2p_dbg(p2p, "Invitation Request TX callback: success=%d", success);  in p2p_invitation_req_cb()
626 	if (p2p->invite_peer == NULL) {  in p2p_invitation_req_cb()
627 		p2p_dbg(p2p, "No pending Invite");  in p2p_invitation_req_cb()
632 		p2p->invite_peer->flags &= ~P2P_DEV_WAIT_INV_REQ_ACK;  in p2p_invitation_req_cb()
638 	p2p_set_state(p2p, P2P_INVITE);  in p2p_invitation_req_cb()
639 	p2p_set_timeout(p2p, 0, success ? 500000 : 100000);  in p2p_invitation_req_cb()
643 void p2p_invitation_resp_cb(struct p2p_data *p2p, int success)  in p2p_invitation_resp_cb()  argument
645 	p2p_dbg(p2p, "Invitation Response TX callback: success=%d", success);  in p2p_invitation_resp_cb()
646 	p2p->cfg->send_action_done(p2p->cfg->cb_ctx);  in p2p_invitation_resp_cb()
649 …p2p_dbg(p2p, "Assume Invitation Response was actually received by the peer even though Ack was not…  in p2p_invitation_resp_cb()
651 	if (p2p->cfg->invitation_received) {  in p2p_invitation_resp_cb()
652 		p2p->cfg->invitation_received(p2p->cfg->cb_ctx,  in p2p_invitation_resp_cb()
653 					      p2p->inv_sa,  in p2p_invitation_resp_cb()
654 					      p2p->inv_group_bssid_ptr,  in p2p_invitation_resp_cb()
655 					      p2p->inv_ssid, p2p->inv_ssid_len,  in p2p_invitation_resp_cb()
656 					      p2p->inv_go_dev_addr,  in p2p_invitation_resp_cb()
657 					      p2p->inv_status,  in p2p_invitation_resp_cb()
658 					      p2p->inv_op_freq);  in p2p_invitation_resp_cb()
663 int p2p_invite(struct p2p_data *p2p, const u8 *peer, enum p2p_invite_role role,  in p2p_invite()  argument
670 	p2p_dbg(p2p, "Request to invite peer " MACSTR " role=%d persistent=%d "  in p2p_invite()
673 		p2p->allow_6ghz);  in p2p_invite()
675 		p2p_dbg(p2p, "Invitation for BSSID " MACSTR, MAC2STR(bssid));  in p2p_invite()
677 		p2p_dbg(p2p, "Invitation for GO Device Address " MACSTR,  in p2p_invite()
679 		os_memcpy(p2p->invite_go_dev_addr_buf, go_dev_addr, ETH_ALEN);  in p2p_invite()
680 		p2p->invite_go_dev_addr = p2p->invite_go_dev_addr_buf;  in p2p_invite()
682 		p2p->invite_go_dev_addr = NULL;  in p2p_invite()
686 		p2p_dbg(p2p, "Invitation to use Device Password ID %d",  in p2p_invite()
689 	p2p->invite_dev_pw_id = dev_pw_id;  in p2p_invite()
690 	p2p->retry_invite_req = role == P2P_INVITE_ROLE_GO &&  in p2p_invite()
692 	p2p->retry_invite_req_sent = 0;  in p2p_invite()
694 	dev = p2p_get_device(p2p, peer);  in p2p_invite()
697 		p2p_dbg(p2p, "Cannot invite unknown P2P Device " MACSTR,  in p2p_invite()
702 	if (p2p_prepare_channel(p2p, dev, force_freq, pref_freq,  in p2p_invite()
715 			p2p_dbg(p2p, "Cannot invite a P2P Device " MACSTR  in p2p_invite()
724 	if (p2p->state != P2P_IDLE)  in p2p_invite()
725 		p2p_stop_find(p2p);  in p2p_invite()
727 	p2p->inv_role = role;  in p2p_invite()
728 	p2p->inv_bssid_set = bssid != NULL;  in p2p_invite()
730 		os_memcpy(p2p->inv_bssid, bssid, ETH_ALEN);  in p2p_invite()
731 	os_memcpy(p2p->inv_ssid, ssid, ssid_len);  in p2p_invite()
732 	p2p->inv_ssid_len = ssid_len;  in p2p_invite()
733 	p2p->inv_persistent = persistent_group;  in p2p_invite()
734 	return p2p_invite_send(p2p, dev, go_dev_addr, dev_pw_id);  in p2p_invite()