P2P: Add Device Password ID to GO Neg Request RX event
[mech_eap.git] / src / p2p / p2p_go_neg.c
1 /*
2  * Wi-Fi Direct - P2P Group Owner Negotiation
3  * Copyright (c) 2009-2010, Atheros Communications
4  *
5  * This program is free software; you can redistribute it and/or modify
6  * it under the terms of the GNU General Public License version 2 as
7  * published by the Free Software Foundation.
8  *
9  * Alternatively, this software may be distributed under the terms of BSD
10  * license.
11  *
12  * See README and COPYING for more details.
13  */
14
15 #include "includes.h"
16
17 #include "common.h"
18 #include "common/ieee802_11_defs.h"
19 #include "wps/wps_defs.h"
20 #include "p2p_i.h"
21 #include "p2p.h"
22
23
24 static int p2p_go_det(u8 own_intent, u8 peer_value)
25 {
26         u8 peer_intent = peer_value >> 1;
27         if (own_intent == peer_intent) {
28                 if (own_intent == P2P_MAX_GO_INTENT)
29                         return -1; /* both devices want to become GO */
30
31                 /* Use tie breaker bit to determine GO */
32                 return (peer_value & 0x01) ? 0 : 1;
33         }
34
35         return own_intent > peer_intent;
36 }
37
38
39 int p2p_peer_channels_check(struct p2p_data *p2p, struct p2p_channels *own,
40                             struct p2p_device *dev,
41                             const u8 *channel_list, size_t channel_list_len)
42 {
43         const u8 *pos, *end;
44         struct p2p_channels *ch;
45         size_t channels;
46         struct p2p_channels intersection;
47
48         ch = &dev->channels;
49         os_memset(ch, 0, sizeof(*ch));
50         pos = channel_list;
51         end = channel_list + channel_list_len;
52
53         if (end - pos < 3)
54                 return -1;
55         os_memcpy(dev->country, pos, 3);
56         wpa_hexdump_ascii(MSG_DEBUG, "P2P: Peer country", pos, 3);
57         if (pos[2] != 0x04 && os_memcmp(pos, p2p->cfg->country, 2) != 0) {
58                 wpa_msg(p2p->cfg->msg_ctx, MSG_INFO,
59                         "P2P: Mismatching country (ours=%c%c peer's=%c%c)",
60                         p2p->cfg->country[0], p2p->cfg->country[1],
61                         pos[0], pos[1]);
62                 return -1;
63         }
64         pos += 3;
65
66         while (pos + 2 < end) {
67                 struct p2p_reg_class *cl = &ch->reg_class[ch->reg_classes];
68                 cl->reg_class = *pos++;
69                 if (pos + 1 + pos[0] > end) {
70                         wpa_msg(p2p->cfg->msg_ctx, MSG_INFO,
71                                 "P2P: Invalid peer Channel List");
72                         return -1;
73                 }
74                 channels = *pos++;
75                 cl->channels = channels > P2P_MAX_REG_CLASS_CHANNELS ?
76                         P2P_MAX_REG_CLASS_CHANNELS : channels;
77                 os_memcpy(cl->channel, pos, cl->channels);
78                 pos += channels;
79                 ch->reg_classes++;
80                 if (ch->reg_classes == P2P_MAX_REG_CLASSES)
81                         break;
82         }
83
84         p2p_channels_intersect(own, &dev->channels, &intersection);
85         wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, "P2P: Own reg_classes %d "
86                 "peer reg_classes %d intersection reg_classes %d",
87                 (int) own->reg_classes,
88                 (int) dev->channels.reg_classes,
89                 (int) intersection.reg_classes);
90         if (intersection.reg_classes == 0) {
91                 wpa_msg(p2p->cfg->msg_ctx, MSG_INFO,
92                         "P2P: No common channels found");
93                 return -1;
94         }
95         return 0;
96 }
97
98
99 static int p2p_peer_channels(struct p2p_data *p2p, struct p2p_device *dev,
100                              const u8 *channel_list, size_t channel_list_len)
101 {
102         return p2p_peer_channels_check(p2p, &p2p->channels, dev,
103                                        channel_list, channel_list_len);
104 }
105
106
107 static u16 p2p_wps_method_pw_id(enum p2p_wps_method wps_method)
108 {
109         switch (wps_method) {
110         case WPS_PIN_LABEL:
111                 return DEV_PW_DEFAULT;
112         case WPS_PIN_DISPLAY:
113                 return DEV_PW_REGISTRAR_SPECIFIED;
114         case WPS_PIN_KEYPAD:
115                 return DEV_PW_USER_SPECIFIED;
116         case WPS_PBC:
117                 return DEV_PW_PUSHBUTTON;
118         default:
119                 return DEV_PW_DEFAULT;
120         }
121 }
122
123
124 static const char * p2p_wps_method_str(enum p2p_wps_method wps_method)
125 {
126         switch (wps_method) {
127         case WPS_PIN_LABEL:
128                 return "Label";
129         case WPS_PIN_DISPLAY:
130                 return "Display";
131         case WPS_PIN_KEYPAD:
132                 return "Keypad";
133         case WPS_PBC:
134                 return "PBC";
135         default:
136                 return "??";
137         }
138 }
139
140
141 static struct wpabuf * p2p_build_go_neg_req(struct p2p_data *p2p,
142                                             struct p2p_device *peer)
143 {
144         struct wpabuf *buf;
145         u8 *len;
146         u8 group_capab;
147
148         buf = wpabuf_alloc(1000);
149         if (buf == NULL)
150                 return NULL;
151
152         peer->dialog_token++;
153         if (peer->dialog_token == 0)
154                 peer->dialog_token = 1;
155         p2p_buf_add_public_action_hdr(buf, P2P_GO_NEG_REQ, peer->dialog_token);
156
157         len = p2p_buf_add_ie_hdr(buf);
158         group_capab = 0;
159         if (peer->flags & P2P_DEV_PREFER_PERSISTENT_GROUP)
160                 group_capab |= P2P_GROUP_CAPAB_PERSISTENT_GROUP;
161         if (p2p->cross_connect)
162                 group_capab |= P2P_GROUP_CAPAB_CROSS_CONN;
163         p2p_buf_add_capability(buf, p2p->dev_capab, group_capab);
164         p2p_buf_add_go_intent(buf, (p2p->go_intent << 1) |
165                               p2p->next_tie_breaker);
166         p2p->next_tie_breaker = !p2p->next_tie_breaker;
167         p2p_buf_add_config_timeout(buf, 100, 20);
168         p2p_buf_add_listen_channel(buf, p2p->cfg->country, p2p->cfg->reg_class,
169                                    p2p->cfg->channel);
170         if (p2p->ext_listen_interval)
171                 p2p_buf_add_ext_listen_timing(buf, p2p->ext_listen_period,
172                                               p2p->ext_listen_interval);
173         p2p_buf_add_intended_addr(buf, p2p->intended_addr);
174         p2p_buf_add_channel_list(buf, p2p->cfg->country, &p2p->channels);
175         p2p_buf_add_device_info(buf, p2p, peer);
176         p2p_buf_add_operating_channel(buf, p2p->cfg->country,
177                                       p2p->op_reg_class, p2p->op_channel);
178         p2p_buf_update_ie_hdr(buf, len);
179
180         /* WPS IE with Device Password ID attribute */
181         p2p_build_wps_ie(p2p, buf, p2p_wps_method_pw_id(peer->wps_method), 0);
182
183         return buf;
184 }
185
186
187 int p2p_connect_send(struct p2p_data *p2p, struct p2p_device *dev)
188 {
189         struct wpabuf *req;
190         int freq;
191
192         freq = dev->listen_freq > 0 ? dev->listen_freq : dev->oper_freq;
193         if (freq <= 0) {
194                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
195                         "P2P: No Listen/Operating frequency known for the "
196                         "peer " MACSTR " to send GO Negotiation Request",
197                         MAC2STR(dev->p2p_device_addr));
198                 return -1;
199         }
200
201         req = p2p_build_go_neg_req(p2p, dev);
202         if (req == NULL)
203                 return -1;
204         wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
205                 "P2P: Sending GO Negotiation Request");
206         p2p_set_state(p2p, P2P_CONNECT);
207         p2p->pending_action_state = P2P_PENDING_GO_NEG_REQUEST;
208         p2p->go_neg_peer = dev;
209         dev->flags |= P2P_DEV_WAIT_GO_NEG_RESPONSE;
210         if (p2p->cfg->send_action(p2p->cfg->cb_ctx, freq,
211                                   dev->p2p_device_addr, p2p->cfg->dev_addr,
212                                   dev->p2p_device_addr,
213                                   wpabuf_head(req), wpabuf_len(req), 200) < 0)
214         {
215                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
216                         "P2P: Failed to send Action frame");
217                 /* Use P2P find to recover and retry */
218                 p2p_set_timeout(p2p, 0, 0);
219         }
220
221         wpabuf_free(req);
222
223         return 0;
224 }
225
226
227 static struct wpabuf * p2p_build_go_neg_resp(struct p2p_data *p2p,
228                                              struct p2p_device *peer,
229                                              u8 dialog_token, u8 status,
230                                              u8 tie_breaker)
231 {
232         struct wpabuf *buf;
233         u8 *len;
234         u8 group_capab;
235
236         wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
237                 "P2P: Building GO Negotiation Response");
238         buf = wpabuf_alloc(1000);
239         if (buf == NULL)
240                 return NULL;
241
242         p2p_buf_add_public_action_hdr(buf, P2P_GO_NEG_RESP, dialog_token);
243
244         len = p2p_buf_add_ie_hdr(buf);
245         p2p_buf_add_status(buf, status);
246         group_capab = 0;
247         if (peer && peer->go_state == LOCAL_GO) {
248                 if (peer->flags & P2P_DEV_PREFER_PERSISTENT_GROUP)
249                         group_capab |= P2P_GROUP_CAPAB_PERSISTENT_GROUP;
250                 if (p2p->cross_connect)
251                         group_capab |= P2P_GROUP_CAPAB_CROSS_CONN;
252         }
253         p2p_buf_add_capability(buf, p2p->dev_capab, group_capab);
254         p2p_buf_add_go_intent(buf, (p2p->go_intent << 1) | tie_breaker);
255         p2p_buf_add_config_timeout(buf, 100, 20);
256         if (peer && peer->go_state == REMOTE_GO) {
257                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, "P2P: Omit Operating "
258                         "Channel attribute");
259         } else {
260                 p2p_buf_add_operating_channel(buf, p2p->cfg->country,
261                                               p2p->op_reg_class,
262                                               p2p->op_channel);
263         }
264         p2p_buf_add_intended_addr(buf, p2p->intended_addr);
265         if (status || peer == NULL) {
266                 p2p_buf_add_channel_list(buf, p2p->cfg->country,
267                                          &p2p->channels);
268         } else if (peer->go_state == REMOTE_GO) {
269                 p2p_buf_add_channel_list(buf, p2p->cfg->country,
270                                          &p2p->channels);
271         } else {
272                 struct p2p_channels res;
273                 p2p_channels_intersect(&p2p->channels, &peer->channels,
274                                        &res);
275                 p2p_buf_add_channel_list(buf, p2p->cfg->country, &res);
276         }
277         p2p_buf_add_device_info(buf, p2p, peer);
278         if (peer && peer->go_state == LOCAL_GO) {
279                 p2p_buf_add_group_id(buf, p2p->cfg->dev_addr, p2p->ssid,
280                                      p2p->ssid_len);
281         }
282         p2p_buf_update_ie_hdr(buf, len);
283
284         /* WPS IE with Device Password ID attribute */
285         p2p_build_wps_ie(p2p, buf,
286                          p2p_wps_method_pw_id(peer ? peer->wps_method :
287                                               WPS_NOT_READY), 0);
288
289         return buf;
290 }
291
292
293 void p2p_process_go_neg_req(struct p2p_data *p2p, const u8 *sa,
294                             const u8 *data, size_t len, int rx_freq)
295 {
296         struct p2p_device *dev = NULL;
297         struct wpabuf *resp;
298         struct p2p_message msg;
299         u8 status = P2P_SC_FAIL_INVALID_PARAMS;
300         int tie_breaker = 0;
301         int freq;
302
303         wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
304                 "P2P: Received GO Negotiation Request from " MACSTR
305                 "(freq=%d)", MAC2STR(sa), rx_freq);
306
307         if (p2p_parse(data, len, &msg))
308                 return;
309
310         if (!msg.capability) {
311                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
312                         "P2P: Mandatory Capability attribute missing from GO "
313                         "Negotiation Request");
314 #ifdef CONFIG_P2P_STRICT
315                 goto fail;
316 #endif /* CONFIG_P2P_STRICT */
317         }
318
319         if (msg.go_intent)
320                 tie_breaker = *msg.go_intent & 0x01;
321         else {
322                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
323                         "P2P: Mandatory GO Intent attribute missing from GO "
324                         "Negotiation Request");
325 #ifdef CONFIG_P2P_STRICT
326                 goto fail;
327 #endif /* CONFIG_P2P_STRICT */
328         }
329
330         if (!msg.config_timeout) {
331                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
332                         "P2P: Mandatory Configuration Timeout attribute "
333                         "missing from GO Negotiation Request");
334 #ifdef CONFIG_P2P_STRICT
335                 goto fail;
336 #endif /* CONFIG_P2P_STRICT */
337         }
338
339         if (!msg.listen_channel) {
340                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
341                         "P2P: No Listen Channel attribute received");
342                 goto fail;
343         }
344         if (!msg.operating_channel) {
345                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
346                         "P2P: No Operating Channel attribute received");
347                 goto fail;
348         }
349         if (!msg.channel_list) {
350                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
351                         "P2P: No Channel List attribute received");
352                 goto fail;
353         }
354         if (!msg.intended_addr) {
355                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
356                         "P2P: No Intended P2P Interface Address attribute "
357                         "received");
358                 goto fail;
359         }
360         if (!msg.p2p_device_info) {
361                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
362                         "P2P: No P2P Device Info attribute received");
363                 goto fail;
364         }
365
366         if (os_memcmp(msg.p2p_device_addr, sa, ETH_ALEN) != 0) {
367                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
368                         "P2P: Unexpected GO Negotiation Request SA=" MACSTR
369                         " != dev_addr=" MACSTR,
370                         MAC2STR(sa), MAC2STR(msg.p2p_device_addr));
371                 goto fail;
372         }
373
374         dev = p2p_get_device(p2p, sa);
375
376         if (msg.status && *msg.status) {
377                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
378                         "P2P: Unexpected Status attribute (%d) in GO "
379                         "Negotiation Request", *msg.status);
380                 goto fail;
381         }
382
383         if (dev == NULL)
384                 dev = p2p_add_dev_from_go_neg_req(p2p, sa, &msg);
385         else if (dev->flags & P2P_DEV_PROBE_REQ_ONLY)
386                 p2p_add_dev_info(p2p, sa, dev, &msg);
387         if (dev && dev->flags & P2P_DEV_USER_REJECTED) {
388                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
389                         "P2P: User has rejected this peer");
390                 status = P2P_SC_FAIL_REJECTED_BY_USER;
391         } else if (dev == NULL || dev->wps_method == WPS_NOT_READY) {
392                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
393                         "P2P: Not ready for GO negotiation with " MACSTR,
394                         MAC2STR(sa));
395                 status = P2P_SC_FAIL_INFO_CURRENTLY_UNAVAILABLE;
396                 if (dev)
397                         dev->flags |= P2P_DEV_PEER_WAITING_RESPONSE;
398                 p2p->cfg->go_neg_req_rx(p2p->cfg->cb_ctx, sa,
399                                         msg.dev_password_id);
400         } else if (p2p->go_neg_peer && p2p->go_neg_peer != dev) {
401                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
402                         "P2P: Already in Group Formation with another peer");
403                 status = P2P_SC_FAIL_UNABLE_TO_ACCOMMODATE;
404         } else {
405                 int go;
406
407                 if (!p2p->go_neg_peer) {
408                         wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, "P2P: Starting "
409                                 "GO Negotiation with previously authorized "
410                                 "peer");
411                         if (!(dev->flags & P2P_DEV_FORCE_FREQ)) {
412                                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
413                                         "P2P: Use default channel settings");
414                                 p2p->op_reg_class = p2p->cfg->op_reg_class;
415                                 p2p->op_channel = p2p->cfg->op_channel;
416                                 os_memcpy(&p2p->channels, &p2p->cfg->channels,
417                                           sizeof(struct p2p_channels));
418                         } else {
419                                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
420                                         "P2P: Use previously configured "
421                                         "forced channel settings");
422                         }
423                 }
424
425                 dev->flags &= ~P2P_DEV_NOT_YET_READY;
426
427                 if (!msg.go_intent) {
428                         wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
429                                 "P2P: No GO Intent attribute received");
430                         goto fail;
431                 }
432                 if ((*msg.go_intent >> 1) > P2P_MAX_GO_INTENT) {
433                         wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
434                                 "P2P: Invalid GO Intent value (%u) received",
435                                 *msg.go_intent >> 1);
436                         goto fail;
437                 }
438
439                 if (dev->go_neg_req_sent &&
440                     os_memcmp(sa, p2p->cfg->dev_addr, ETH_ALEN) > 0) {
441                         wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
442                                 "P2P: Do not reply since peer has higher "
443                                 "address and GO Neg Request already sent");
444                         p2p_parse_free(&msg);
445                         return;
446                 }
447
448                 go = p2p_go_det(p2p->go_intent, *msg.go_intent);
449                 if (go < 0) {
450                         wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
451                                 "P2P: Incompatible GO Intent");
452                         status = P2P_SC_FAIL_BOTH_GO_INTENT_15;
453                         goto fail;
454                 }
455
456                 if (p2p_peer_channels(p2p, dev, msg.channel_list,
457                                       msg.channel_list_len) < 0) {
458                         wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
459                                 "P2P: No common channels found");
460                         status = P2P_SC_FAIL_NO_COMMON_CHANNELS;
461                         goto fail;
462                 }
463
464                 switch (msg.dev_password_id) {
465                 case DEV_PW_DEFAULT:
466                         wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
467                                 "P2P: PIN from peer Label");
468                         if (dev->wps_method != WPS_PIN_KEYPAD) {
469                                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
470                                         "P2P: We have wps_method=%s -> "
471                                         "incompatible",
472                                         p2p_wps_method_str(dev->wps_method));
473                                 status = P2P_SC_FAIL_INCOMPATIBLE_PROV_METHOD;
474                                 goto fail;
475                         }
476                         break;
477                 case DEV_PW_REGISTRAR_SPECIFIED:
478                         wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
479                                 "P2P: PIN from peer Display");
480                         if (dev->wps_method != WPS_PIN_KEYPAD) {
481                                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
482                                         "P2P: We have wps_method=%s -> "
483                                         "incompatible",
484                                         p2p_wps_method_str(dev->wps_method));
485                                 status = P2P_SC_FAIL_INCOMPATIBLE_PROV_METHOD;
486                                 goto fail;
487                         }
488                         break;
489                 case DEV_PW_USER_SPECIFIED:
490                         wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
491                                 "P2P: Peer entered PIN on Keypad");
492                         if (dev->wps_method != WPS_PIN_LABEL &&
493                             dev->wps_method != WPS_PIN_DISPLAY) {
494                                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
495                                         "P2P: We have wps_method=%s -> "
496                                         "incompatible",
497                                         p2p_wps_method_str(dev->wps_method));
498                                 status = P2P_SC_FAIL_INCOMPATIBLE_PROV_METHOD;
499                                 goto fail;
500                         }
501                         break;
502                 case DEV_PW_PUSHBUTTON:
503                         wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
504                                 "P2P: Peer using pushbutton");
505                         if (dev->wps_method != WPS_PBC) {
506                                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
507                                         "P2P: We have wps_method=%s -> "
508                                         "incompatible",
509                                         p2p_wps_method_str(dev->wps_method));
510                                 status = P2P_SC_FAIL_INCOMPATIBLE_PROV_METHOD;
511                                 goto fail;
512                         }
513                         break;
514                 default:
515                         wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
516                                 "P2P: Unsupported Device Password ID %d",
517                                 msg.dev_password_id);
518                         status = P2P_SC_FAIL_INCOMPATIBLE_PROV_METHOD;
519                         goto fail;
520                 }
521
522                 if (go) {
523                         struct p2p_channels intersection;
524                         size_t i;
525                         p2p_channels_intersect(&p2p->channels, &dev->channels,
526                                                &intersection);
527                         if (intersection.reg_classes == 0 ||
528                             intersection.reg_class[0].channels == 0) {
529                                 status = P2P_SC_FAIL_NO_COMMON_CHANNELS;
530                                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
531                                         "P2P: No common channels found");
532                                 goto fail;
533                         }
534                         for (i = 0; i < intersection.reg_classes; i++) {
535                                 struct p2p_reg_class *c;
536                                 c = &intersection.reg_class[i];
537                                 wpa_printf(MSG_DEBUG, "P2P: reg_class %u",
538                                            c->reg_class);
539                                 wpa_hexdump(MSG_DEBUG, "P2P: channels",
540                                             c->channel, c->channels);
541                         }
542                         if (!p2p_channels_includes(&intersection,
543                                                    p2p->op_reg_class,
544                                                    p2p->op_channel)) {
545                                 struct p2p_reg_class *cl;
546                                 cl = &intersection.reg_class[0];
547                                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
548                                         "P2P: Selected operating channel "
549                                         "(reg_class %u channel %u) not "
550                                         "acceptable to the peer - pick "
551                                         "another channel (reg_class %u "
552                                         "channel %u)",
553                                         p2p->op_reg_class, p2p->op_channel,
554                                         cl->reg_class, cl->channel[0]);
555                                 p2p->op_reg_class = cl->reg_class;
556                                 p2p->op_channel = cl->channel[0];
557                         }
558
559                         p2p_build_ssid(p2p, p2p->ssid, &p2p->ssid_len);
560                 }
561
562                 dev->go_state = go ? LOCAL_GO : REMOTE_GO;
563                 dev->oper_freq = p2p_channel_to_freq((const char *)
564                                                      msg.operating_channel,
565                                                      msg.operating_channel[3],
566                                                      msg.operating_channel[4]);
567                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, "P2P: Peer operating "
568                         "channel preference: %d MHz", dev->oper_freq);
569
570                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
571                         "P2P: GO Negotiation with " MACSTR, MAC2STR(sa));
572                 if (p2p->state != P2P_IDLE)
573                         p2p_stop_find(p2p);
574                 p2p_set_state(p2p, P2P_GO_NEG);
575                 p2p_clear_timeout(p2p);
576                 dev->dialog_token = msg.dialog_token;
577                 os_memcpy(dev->intended_addr, msg.intended_addr, ETH_ALEN);
578                 p2p->go_neg_peer = dev;
579                 status = P2P_SC_SUCCESS;
580         }
581
582 fail:
583         resp = p2p_build_go_neg_resp(p2p, dev, msg.dialog_token, status,
584                                      !tie_breaker);
585         p2p_parse_free(&msg);
586         if (resp == NULL)
587                 return;
588         wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
589                 "P2P: Sending GO Negotiation Response");
590         if (rx_freq > 0)
591                 freq = rx_freq;
592         else
593                 freq = p2p_channel_to_freq(p2p->cfg->country,
594                                            p2p->cfg->reg_class,
595                                            p2p->cfg->channel);
596         if (freq < 0) {
597                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
598                         "P2P: Unknown regulatory class/channel");
599                 wpabuf_free(resp);
600                 return;
601         }
602         if (status == P2P_SC_SUCCESS) {
603                 p2p->pending_action_state = P2P_PENDING_GO_NEG_RESPONSE;
604                 dev->flags |= P2P_DEV_WAIT_GO_NEG_CONFIRM;
605         } else
606                 p2p->pending_action_state =
607                         P2P_PENDING_GO_NEG_RESPONSE_FAILURE;
608         if (p2p->cfg->send_action(p2p->cfg->cb_ctx, freq, sa,
609                                   p2p->cfg->dev_addr, p2p->cfg->dev_addr,
610                                   wpabuf_head(resp), wpabuf_len(resp), 200) <
611             0) {
612                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
613                         "P2P: Failed to send Action frame");
614         }
615
616         wpabuf_free(resp);
617 }
618
619
620 static struct wpabuf * p2p_build_go_neg_conf(struct p2p_data *p2p,
621                                              struct p2p_device *peer,
622                                              u8 dialog_token, u8 status,
623                                              const u8 *resp_chan, int go)
624 {
625         struct wpabuf *buf;
626         u8 *len;
627         struct p2p_channels res;
628         u8 group_capab;
629
630         wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
631                 "P2P: Building GO Negotiation Confirm");
632         buf = wpabuf_alloc(1000);
633         if (buf == NULL)
634                 return NULL;
635
636         p2p_buf_add_public_action_hdr(buf, P2P_GO_NEG_CONF, dialog_token);
637
638         len = p2p_buf_add_ie_hdr(buf);
639         p2p_buf_add_status(buf, status);
640         group_capab = 0;
641         if (peer->go_state == LOCAL_GO) {
642                 if (peer->flags & P2P_DEV_PREFER_PERSISTENT_GROUP)
643                         group_capab |= P2P_GROUP_CAPAB_PERSISTENT_GROUP;
644                 if (p2p->cross_connect)
645                         group_capab |= P2P_GROUP_CAPAB_CROSS_CONN;
646         }
647         p2p_buf_add_capability(buf, p2p->dev_capab, group_capab);
648         if (go || resp_chan == NULL)
649                 p2p_buf_add_operating_channel(buf, p2p->cfg->country,
650                                               p2p->op_reg_class,
651                                               p2p->op_channel);
652         else
653                 p2p_buf_add_operating_channel(buf, (const char *) resp_chan,
654                                               resp_chan[3], resp_chan[4]);
655         p2p_channels_intersect(&p2p->channels, &peer->channels, &res);
656         p2p_buf_add_channel_list(buf, p2p->cfg->country, &res);
657         if (go) {
658                 p2p_buf_add_group_id(buf, p2p->cfg->dev_addr, p2p->ssid,
659                                      p2p->ssid_len);
660         }
661         p2p_buf_update_ie_hdr(buf, len);
662
663         return buf;
664 }
665
666
667 void p2p_process_go_neg_resp(struct p2p_data *p2p, const u8 *sa,
668                              const u8 *data, size_t len, int rx_freq)
669 {
670         struct p2p_device *dev;
671         struct wpabuf *conf;
672         int go = -1;
673         struct p2p_message msg;
674         u8 status = P2P_SC_SUCCESS;
675         int freq;
676
677         wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
678                 "P2P: Received GO Negotiation Response from " MACSTR
679                 " (freq=%d)", MAC2STR(sa), rx_freq);
680         dev = p2p_get_device(p2p, sa);
681         if (dev == NULL || dev->wps_method == WPS_NOT_READY ||
682             dev != p2p->go_neg_peer) {
683                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
684                         "P2P: Not ready for GO negotiation with " MACSTR,
685                         MAC2STR(sa));
686                 return;
687         }
688
689         if (p2p_parse(data, len, &msg))
690                 return;
691
692         if (!(dev->flags & P2P_DEV_WAIT_GO_NEG_RESPONSE)) {
693                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
694                         "P2P: Was not expecting GO Negotiation Response - "
695                         "ignore");
696                 p2p_parse_free(&msg);
697                 return;
698         }
699         dev->flags &= ~P2P_DEV_WAIT_GO_NEG_RESPONSE;
700
701         if (msg.dialog_token != dev->dialog_token) {
702                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
703                         "P2P: Unexpected Dialog Token %u (expected %u)",
704                         msg.dialog_token, dev->dialog_token);
705                 p2p_parse_free(&msg);
706                 return;
707         }
708
709         if (!msg.status) {
710                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
711                         "P2P: No Status attribute received");
712                 status = P2P_SC_FAIL_INVALID_PARAMS;
713                 goto fail;
714         }
715         if (*msg.status) {
716                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
717                         "P2P: GO Negotiation rejected: status %d",
718                         *msg.status);
719                 dev->go_neg_req_sent = 0;
720                 if (*msg.status == P2P_SC_FAIL_INFO_CURRENTLY_UNAVAILABLE) {
721                         wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
722                                 "P2P: Wait for the peer to become ready for "
723                                 "GO Negotiation");
724                         dev->flags |= P2P_DEV_NOT_YET_READY;
725                         dev->wait_count = 0;
726                         p2p_set_state(p2p, P2P_WAIT_PEER_IDLE);
727                         p2p_set_timeout(p2p, 0, 0);
728                 } else {
729                         wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
730                                 "P2P: Stop GO Negotiation attempt");
731                         p2p_go_neg_failed(p2p, dev, *msg.status);
732                 }
733                 p2p->cfg->send_action_done(p2p->cfg->cb_ctx);
734                 p2p_parse_free(&msg);
735                 return;
736         }
737
738         if (!msg.capability) {
739                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
740                         "P2P: Mandatory Capability attribute missing from GO "
741                         "Negotiation Response");
742 #ifdef CONFIG_P2P_STRICT
743                 status = P2P_SC_FAIL_INVALID_PARAMS;
744                 goto fail;
745 #endif /* CONFIG_P2P_STRICT */
746         }
747
748         if (!msg.p2p_device_info) {
749                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
750                         "P2P: Mandatory P2P Device Info attribute missing "
751                         "from GO Negotiation Response");
752 #ifdef CONFIG_P2P_STRICT
753                 status = P2P_SC_FAIL_INVALID_PARAMS;
754                 goto fail;
755 #endif /* CONFIG_P2P_STRICT */
756         }
757
758         if (!msg.intended_addr) {
759                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
760                         "P2P: No Intended P2P Interface Address attribute "
761                         "received");
762                 status = P2P_SC_FAIL_INVALID_PARAMS;
763                 goto fail;
764         }
765
766         if (!msg.go_intent) {
767                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
768                         "P2P: No GO Intent attribute received");
769                 status = P2P_SC_FAIL_INVALID_PARAMS;
770                 goto fail;
771         }
772         if ((*msg.go_intent >> 1) > P2P_MAX_GO_INTENT) {
773                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
774                         "P2P: Invalid GO Intent value (%u) received",
775                         *msg.go_intent >> 1);
776                 status = P2P_SC_FAIL_INVALID_PARAMS;
777                 goto fail;
778         }
779
780         go = p2p_go_det(p2p->go_intent, *msg.go_intent);
781         if (go < 0) {
782                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
783                         "P2P: Incompatible GO Intent");
784                 status = P2P_SC_FAIL_INCOMPATIBLE_PARAMS;
785                 goto fail;
786         }
787
788         if (!go && msg.group_id) {
789                 /* TODO: Store SSID for Provisioning step */
790         } else if (!go) {
791                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
792                         "P2P: Mandatory P2P Group ID attribute missing from "
793                         "GO Negotiation Response");
794 #ifdef CONFIG_P2P_STRICT
795                 status = P2P_SC_FAIL_INVALID_PARAMS;
796                 goto fail;
797 #endif /* CONFIG_P2P_STRICT */
798         }
799
800         if (!msg.config_timeout) {
801                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
802                         "P2P: Mandatory Configuration Timeout attribute "
803                         "missing from GO Negotiation Response");
804 #ifdef CONFIG_P2P_STRICT
805                 status = P2P_SC_FAIL_INVALID_PARAMS;
806                 goto fail;
807 #endif /* CONFIG_P2P_STRICT */
808         }
809
810         if (!msg.operating_channel && !go) {
811                 /*
812                  * Note: P2P Client may omit Operating Channel attribute to
813                  * indicate it does not have a preference.
814                  */
815                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
816                         "P2P: No Operating Channel attribute received");
817                 status = P2P_SC_FAIL_INVALID_PARAMS;
818                 goto fail;
819         }
820         if (!msg.channel_list) {
821                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
822                         "P2P: No Channel List attribute received");
823                 status = P2P_SC_FAIL_INVALID_PARAMS;
824                 goto fail;
825         }
826
827         if (p2p_peer_channels(p2p, dev, msg.channel_list,
828                               msg.channel_list_len) < 0) {
829                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
830                         "P2P: No common channels found");
831                 status = P2P_SC_FAIL_NO_COMMON_CHANNELS;
832                 goto fail;
833         }
834
835         if (msg.operating_channel) {
836                 dev->oper_freq = p2p_channel_to_freq((const char *)
837                                                      msg.operating_channel,
838                                                      msg.operating_channel[3],
839                                                      msg.operating_channel[4]);
840                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, "P2P: Peer operating "
841                         "channel preference: %d MHz", dev->oper_freq);
842         } else
843                 dev->oper_freq = 0;
844
845         switch (msg.dev_password_id) {
846         case DEV_PW_DEFAULT:
847                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
848                         "P2P: PIN from peer Label");
849                 if (dev->wps_method != WPS_PIN_KEYPAD) {
850                         wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
851                                 "P2P: We have wps_method=%s -> "
852                                 "incompatible",
853                                 p2p_wps_method_str(dev->wps_method));
854                         status = P2P_SC_FAIL_INCOMPATIBLE_PROV_METHOD;
855                         goto fail;
856                 }
857                 break;
858         case DEV_PW_REGISTRAR_SPECIFIED:
859                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
860                         "P2P: PIN from peer Display");
861                 if (dev->wps_method != WPS_PIN_KEYPAD) {
862                         wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
863                                 "P2P: We have wps_method=%s -> "
864                                 "incompatible",
865                                 p2p_wps_method_str(dev->wps_method));
866                         status = P2P_SC_FAIL_INCOMPATIBLE_PROV_METHOD;
867                         goto fail;
868                 }
869                 break;
870         case DEV_PW_USER_SPECIFIED:
871                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
872                         "P2P: Peer entered PIN on Keypad");
873                 if (dev->wps_method != WPS_PIN_LABEL &&
874                     dev->wps_method != WPS_PIN_DISPLAY) {
875                         wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
876                                 "P2P: We have wps_method=%s -> "
877                                 "incompatible",
878                                 p2p_wps_method_str(dev->wps_method));
879                         status = P2P_SC_FAIL_INCOMPATIBLE_PROV_METHOD;
880                         goto fail;
881                 }
882                 break;
883         case DEV_PW_PUSHBUTTON:
884                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
885                         "P2P: Peer using pushbutton");
886                 if (dev->wps_method != WPS_PBC) {
887                         wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
888                                 "P2P: We have wps_method=%s -> "
889                                 "incompatible",
890                                 p2p_wps_method_str(dev->wps_method));
891                         status = P2P_SC_FAIL_INCOMPATIBLE_PROV_METHOD;
892                         goto fail;
893                 }
894                 break;
895         default:
896                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
897                         "P2P: Unsupported Device Password ID %d",
898                         msg.dev_password_id);
899                 status = P2P_SC_FAIL_INCOMPATIBLE_PROV_METHOD;
900                 goto fail;
901         }
902
903         if (go) {
904                 struct p2p_channels intersection;
905                 size_t i;
906                 p2p_channels_intersect(&p2p->channels, &dev->channels,
907                                        &intersection);
908                 if (intersection.reg_classes == 0 ||
909                     intersection.reg_class[0].channels == 0) {
910                         status = P2P_SC_FAIL_NO_COMMON_CHANNELS;
911                         wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
912                                 "P2P: No common channels found");
913                         goto fail;
914                 }
915                 for (i = 0; i < intersection.reg_classes; i++) {
916                         struct p2p_reg_class *c;
917                         c = &intersection.reg_class[i];
918                         wpa_printf(MSG_DEBUG, "P2P: reg_class %u",
919                                    c->reg_class);
920                         wpa_hexdump(MSG_DEBUG, "P2P: channels",
921                                     c->channel, c->channels);
922                 }
923                 if (!p2p_channels_includes(&intersection, p2p->op_reg_class,
924                                            p2p->op_channel)) {
925                         struct p2p_reg_class *cl;
926                         cl = &intersection.reg_class[0];
927                         wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
928                                 "P2P: Selected operating channel "
929                                 "(reg_class %u channel %u) not "
930                                 "acceptable to the peer - pick "
931                                 "another channel (reg_class %u "
932                                 "channel %u)",
933                                 p2p->op_reg_class, p2p->op_channel,
934                                 cl->reg_class, cl->channel[0]);
935                         p2p->op_reg_class = cl->reg_class;
936                         p2p->op_channel = cl->channel[0];
937                 }
938
939                 p2p_build_ssid(p2p, p2p->ssid, &p2p->ssid_len);
940         }
941
942         p2p_set_state(p2p, P2P_GO_NEG);
943         p2p_clear_timeout(p2p);
944
945         wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
946                 "P2P: GO Negotiation with " MACSTR, MAC2STR(sa));
947         os_memcpy(dev->intended_addr, msg.intended_addr, ETH_ALEN);
948
949 fail:
950         conf = p2p_build_go_neg_conf(p2p, dev, msg.dialog_token, status,
951                                      msg.operating_channel, go);
952         p2p_parse_free(&msg);
953         if (conf == NULL)
954                 return;
955         wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
956                 "P2P: Sending GO Negotiation Confirm");
957         if (status == P2P_SC_SUCCESS) {
958                 p2p->pending_action_state = P2P_PENDING_GO_NEG_CONFIRM;
959                 dev->go_state = go ? LOCAL_GO : REMOTE_GO;
960         } else
961                 p2p->pending_action_state = P2P_NO_PENDING_ACTION;
962         if (rx_freq > 0)
963                 freq = rx_freq;
964         else
965                 freq = dev->listen_freq;
966         if (p2p->cfg->send_action(p2p->cfg->cb_ctx, freq, sa,
967                                   p2p->cfg->dev_addr, sa,
968                                   wpabuf_head(conf), wpabuf_len(conf), 200) <
969             0) {
970                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
971                         "P2P: Failed to send Action frame");
972                 p2p_go_neg_failed(p2p, dev, -1);
973         }
974         wpabuf_free(conf);
975 }
976
977
978 void p2p_process_go_neg_conf(struct p2p_data *p2p, const u8 *sa,
979                              const u8 *data, size_t len)
980 {
981         struct p2p_device *dev;
982         struct p2p_message msg;
983
984         wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
985                 "P2P: Received GO Negotiation Confirm from " MACSTR,
986                 MAC2STR(sa));
987         dev = p2p_get_device(p2p, sa);
988         if (dev == NULL || dev->wps_method == WPS_NOT_READY ||
989             dev != p2p->go_neg_peer) {
990                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
991                         "P2P: Not ready for GO negotiation with " MACSTR,
992                         MAC2STR(sa));
993                 return;
994         }
995
996         if (p2p->pending_action_state == P2P_PENDING_GO_NEG_RESPONSE) {
997                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, "P2P: Stopped waiting "
998                         "for TX status on GO Negotiation Response since we "
999                         "already received Confirmation");
1000                 p2p->pending_action_state = P2P_NO_PENDING_ACTION;
1001         }
1002
1003         if (p2p_parse(data, len, &msg))
1004                 return;
1005
1006         if (!(dev->flags & P2P_DEV_WAIT_GO_NEG_CONFIRM)) {
1007                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
1008                         "P2P: Was not expecting GO Negotiation Confirm - "
1009                         "ignore");
1010                 return;
1011         }
1012         dev->flags &= ~P2P_DEV_WAIT_GO_NEG_CONFIRM;
1013
1014         if (msg.dialog_token != dev->dialog_token) {
1015                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
1016                         "P2P: Unexpected Dialog Token %u (expected %u)",
1017                         msg.dialog_token, dev->dialog_token);
1018                 p2p_parse_free(&msg);
1019                 return;
1020         }
1021
1022         if (!msg.status) {
1023                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
1024                         "P2P: No Status attribute received");
1025                 p2p_parse_free(&msg);
1026                 return;
1027         }
1028         if (*msg.status) {
1029                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
1030                         "P2P: GO Negotiation rejected: status %d",
1031                         *msg.status);
1032                 p2p_parse_free(&msg);
1033                 return;
1034         }
1035
1036         if (dev->go_state == REMOTE_GO && msg.group_id) {
1037                 /* TODO: Store SSID for Provisioning step */
1038         } else if (dev->go_state == REMOTE_GO) {
1039                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
1040                         "P2P: Mandatory P2P Group ID attribute missing from "
1041                         "GO Negotiation Confirmation");
1042 #ifdef CONFIG_P2P_STRICT
1043                 p2p_parse_free(&msg);
1044                 return;
1045 #endif /* CONFIG_P2P_STRICT */
1046         }
1047
1048         if (!msg.operating_channel) {
1049                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
1050                         "P2P: Mandatory Operating Channel attribute missing "
1051                         "from GO Negotiation Confirmation");
1052 #ifdef CONFIG_P2P_STRICT
1053                 p2p_parse_free(&msg);
1054                 return;
1055 #endif /* CONFIG_P2P_STRICT */
1056         }
1057
1058         if (!msg.channel_list) {
1059                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
1060                         "P2P: Mandatory Operating Channel attribute missing "
1061                         "from GO Negotiation Confirmation");
1062 #ifdef CONFIG_P2P_STRICT
1063                 p2p_parse_free(&msg);
1064                 return;
1065 #endif /* CONFIG_P2P_STRICT */
1066         }
1067
1068         p2p_parse_free(&msg);
1069
1070         if (dev->go_state == UNKNOWN_GO) {
1071                 /*
1072                  * This should not happen since GO negotiation has already
1073                  * been completed.
1074                  */
1075                 wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
1076                         "P2P: Unexpected GO Neg state - do not know which end "
1077                         "becomes GO");
1078                 return;
1079         }
1080
1081         p2p_go_complete(p2p, dev);
1082 }