1 /*
2 * P2P - IE builder
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 "common/ieee802_11_defs.h"
13 #include "wps/wps_i.h"
14 #include "p2p_i.h"
15
16
p2p_buf_add_action_hdr(struct wpabuf * buf,u8 subtype,u8 dialog_token)17 void p2p_buf_add_action_hdr(struct wpabuf *buf, u8 subtype, u8 dialog_token)
18 {
19 wpabuf_put_u8(buf, WLAN_ACTION_VENDOR_SPECIFIC);
20 wpabuf_put_be32(buf, P2P_IE_VENDOR_TYPE);
21
22 wpabuf_put_u8(buf, subtype); /* OUI Subtype */
23 wpabuf_put_u8(buf, dialog_token);
24 wpa_printf(MSG_DEBUG, "P2P: * Dialog Token: %d", dialog_token);
25 }
26
27
p2p_buf_add_public_action_hdr(struct wpabuf * buf,u8 subtype,u8 dialog_token)28 void p2p_buf_add_public_action_hdr(struct wpabuf *buf, u8 subtype,
29 u8 dialog_token)
30 {
31 wpabuf_put_u8(buf, WLAN_ACTION_PUBLIC);
32 wpabuf_put_u8(buf, WLAN_PA_VENDOR_SPECIFIC);
33 wpabuf_put_be32(buf, P2P_IE_VENDOR_TYPE);
34
35 wpabuf_put_u8(buf, subtype); /* OUI Subtype */
36 wpabuf_put_u8(buf, dialog_token);
37 wpa_printf(MSG_DEBUG, "P2P: * Dialog Token: %d", dialog_token);
38 }
39
40
p2p_buf_add_ie_hdr(struct wpabuf * buf)41 u8 * p2p_buf_add_ie_hdr(struct wpabuf *buf)
42 {
43 u8 *len;
44
45 /* P2P IE header */
46 wpabuf_put_u8(buf, WLAN_EID_VENDOR_SPECIFIC);
47 len = wpabuf_put(buf, 1); /* IE length to be filled */
48 wpabuf_put_be32(buf, P2P_IE_VENDOR_TYPE);
49 wpa_printf(MSG_DEBUG, "P2P: * P2P IE header");
50 return len;
51 }
52
53
p2p_buf_update_ie_hdr(struct wpabuf * buf,u8 * len)54 void p2p_buf_update_ie_hdr(struct wpabuf *buf, u8 *len)
55 {
56 /* Update P2P IE Length */
57 *len = (u8 *) wpabuf_put(buf, 0) - len - 1;
58 }
59
60
p2p_buf_add_capability(struct wpabuf * buf,u8 dev_capab,u8 group_capab)61 void p2p_buf_add_capability(struct wpabuf *buf, u8 dev_capab, u8 group_capab)
62 {
63 /* P2P Capability */
64 wpabuf_put_u8(buf, P2P_ATTR_CAPABILITY);
65 wpabuf_put_le16(buf, 2);
66 wpabuf_put_u8(buf, dev_capab); /* Device Capabilities */
67 wpabuf_put_u8(buf, group_capab); /* Group Capabilities */
68 wpa_printf(MSG_DEBUG, "P2P: * Capability dev=%02x group=%02x",
69 dev_capab, group_capab);
70 }
71
72
p2p_buf_add_go_intent(struct wpabuf * buf,u8 go_intent)73 void p2p_buf_add_go_intent(struct wpabuf *buf, u8 go_intent)
74 {
75 /* Group Owner Intent */
76 wpabuf_put_u8(buf, P2P_ATTR_GROUP_OWNER_INTENT);
77 wpabuf_put_le16(buf, 1);
78 wpabuf_put_u8(buf, go_intent);
79 wpa_printf(MSG_DEBUG, "P2P: * GO Intent: Intent %u Tie breaker %u",
80 go_intent >> 1, go_intent & 0x01);
81 }
82
83
p2p_buf_add_listen_channel(struct wpabuf * buf,const char * country,u8 reg_class,u8 channel)84 void p2p_buf_add_listen_channel(struct wpabuf *buf, const char *country,
85 u8 reg_class, u8 channel)
86 {
87 /* Listen Channel */
88 wpabuf_put_u8(buf, P2P_ATTR_LISTEN_CHANNEL);
89 wpabuf_put_le16(buf, 5);
90 wpabuf_put_data(buf, country, 3);
91 wpabuf_put_u8(buf, reg_class); /* Regulatory Class */
92 wpabuf_put_u8(buf, channel); /* Channel Number */
93 wpa_printf(MSG_DEBUG, "P2P: * Listen Channel: Regulatory Class %u "
94 "Channel %u", reg_class, channel);
95 }
96
97
p2p_buf_add_operating_channel(struct wpabuf * buf,const char * country,u8 reg_class,u8 channel)98 void p2p_buf_add_operating_channel(struct wpabuf *buf, const char *country,
99 u8 reg_class, u8 channel)
100 {
101 /* Operating Channel */
102 wpabuf_put_u8(buf, P2P_ATTR_OPERATING_CHANNEL);
103 wpabuf_put_le16(buf, 5);
104 wpabuf_put_data(buf, country, 3);
105 wpabuf_put_u8(buf, reg_class); /* Regulatory Class */
106 wpabuf_put_u8(buf, channel); /* Channel Number */
107 wpa_printf(MSG_DEBUG, "P2P: * Operating Channel: Regulatory Class %u "
108 "Channel %u", reg_class, channel);
109 }
110
111
p2p_buf_add_channel_list(struct wpabuf * buf,const char * country,struct p2p_channels * chan)112 void p2p_buf_add_channel_list(struct wpabuf *buf, const char *country,
113 struct p2p_channels *chan)
114 {
115 u8 *len;
116 size_t i;
117
118 /* Channel List */
119 wpabuf_put_u8(buf, P2P_ATTR_CHANNEL_LIST);
120 len = wpabuf_put(buf, 2); /* IE length to be filled */
121 wpabuf_put_data(buf, country, 3); /* Country String */
122
123 for (i = 0; i < chan->reg_classes; i++) {
124 struct p2p_reg_class *c = &chan->reg_class[i];
125 wpabuf_put_u8(buf, c->reg_class);
126 wpabuf_put_u8(buf, c->channels);
127 wpabuf_put_data(buf, c->channel, c->channels);
128 }
129
130 /* Update attribute length */
131 WPA_PUT_LE16(len, (u8 *) wpabuf_put(buf, 0) - len - 2);
132 wpa_hexdump(MSG_DEBUG, "P2P: * Channel List",
133 len + 2, (u8 *) wpabuf_put(buf, 0) - len - 2);
134 }
135
136
p2p_buf_add_status(struct wpabuf * buf,u8 status)137 void p2p_buf_add_status(struct wpabuf *buf, u8 status)
138 {
139 /* Status */
140 wpabuf_put_u8(buf, P2P_ATTR_STATUS);
141 wpabuf_put_le16(buf, 1);
142 wpabuf_put_u8(buf, status);
143 wpa_printf(MSG_DEBUG, "P2P: * Status: %d", status);
144 }
145
146
p2p_buf_add_device_info(struct wpabuf * buf,struct p2p_data * p2p,struct p2p_device * peer)147 void p2p_buf_add_device_info(struct wpabuf *buf, struct p2p_data *p2p,
148 struct p2p_device *peer)
149 {
150 u8 *len;
151 u16 methods;
152 size_t nlen, i;
153
154 /* P2P Device Info */
155 wpabuf_put_u8(buf, P2P_ATTR_DEVICE_INFO);
156 len = wpabuf_put(buf, 2); /* IE length to be filled */
157
158 /* P2P Device address */
159 wpabuf_put_data(buf, p2p->cfg->dev_addr, ETH_ALEN);
160
161 /* Config Methods */
162 methods = 0;
163 if (peer && peer->wps_method != WPS_NOT_READY) {
164 if (peer->wps_method == WPS_PBC)
165 methods |= WPS_CONFIG_PUSHBUTTON;
166 else if (peer->wps_method == WPS_PIN_DISPLAY ||
167 peer->wps_method == WPS_PIN_KEYPAD)
168 methods |= WPS_CONFIG_DISPLAY | WPS_CONFIG_KEYPAD;
169 } else if (p2p->cfg->config_methods) {
170 methods |= p2p->cfg->config_methods &
171 (WPS_CONFIG_PUSHBUTTON | WPS_CONFIG_DISPLAY |
172 WPS_CONFIG_KEYPAD);
173 } else {
174 methods |= WPS_CONFIG_PUSHBUTTON;
175 methods |= WPS_CONFIG_DISPLAY | WPS_CONFIG_KEYPAD;
176 }
177 wpabuf_put_be16(buf, methods);
178
179 /* Primary Device Type */
180 wpabuf_put_data(buf, p2p->cfg->pri_dev_type,
181 sizeof(p2p->cfg->pri_dev_type));
182
183 /* Number of Secondary Device Types */
184 wpabuf_put_u8(buf, p2p->cfg->num_sec_dev_types);
185
186 /* Secondary Device Type List */
187 for (i = 0; i < p2p->cfg->num_sec_dev_types; i++)
188 wpabuf_put_data(buf, p2p->cfg->sec_dev_type[i],
189 WPS_DEV_TYPE_LEN);
190
191 /* Device Name */
192 nlen = p2p->cfg->dev_name ? os_strlen(p2p->cfg->dev_name) : 0;
193 wpabuf_put_be16(buf, ATTR_DEV_NAME);
194 wpabuf_put_be16(buf, nlen);
195 wpabuf_put_data(buf, p2p->cfg->dev_name, nlen);
196
197 /* Update attribute length */
198 WPA_PUT_LE16(len, (u8 *) wpabuf_put(buf, 0) - len - 2);
199 wpa_printf(MSG_DEBUG, "P2P: * Device Info");
200 }
201
202
p2p_buf_add_device_id(struct wpabuf * buf,const u8 * dev_addr)203 void p2p_buf_add_device_id(struct wpabuf *buf, const u8 *dev_addr)
204 {
205 /* P2P Device ID */
206 wpabuf_put_u8(buf, P2P_ATTR_DEVICE_ID);
207 wpabuf_put_le16(buf, ETH_ALEN);
208 wpabuf_put_data(buf, dev_addr, ETH_ALEN);
209 wpa_printf(MSG_DEBUG, "P2P: * Device ID: " MACSTR, MAC2STR(dev_addr));
210 }
211
212
p2p_buf_add_config_timeout(struct wpabuf * buf,u8 go_timeout,u8 client_timeout)213 void p2p_buf_add_config_timeout(struct wpabuf *buf, u8 go_timeout,
214 u8 client_timeout)
215 {
216 /* Configuration Timeout */
217 wpabuf_put_u8(buf, P2P_ATTR_CONFIGURATION_TIMEOUT);
218 wpabuf_put_le16(buf, 2);
219 wpabuf_put_u8(buf, go_timeout);
220 wpabuf_put_u8(buf, client_timeout);
221 wpa_printf(MSG_DEBUG, "P2P: * Configuration Timeout: GO %d (*10ms) "
222 "client %d (*10ms)", go_timeout, client_timeout);
223 }
224
225
p2p_buf_add_intended_addr(struct wpabuf * buf,const u8 * interface_addr)226 void p2p_buf_add_intended_addr(struct wpabuf *buf, const u8 *interface_addr)
227 {
228 /* Intended P2P Interface Address */
229 wpabuf_put_u8(buf, P2P_ATTR_INTENDED_INTERFACE_ADDR);
230 wpabuf_put_le16(buf, ETH_ALEN);
231 wpabuf_put_data(buf, interface_addr, ETH_ALEN);
232 wpa_printf(MSG_DEBUG, "P2P: * Intended P2P Interface Address " MACSTR,
233 MAC2STR(interface_addr));
234 }
235
236
p2p_buf_add_group_bssid(struct wpabuf * buf,const u8 * bssid)237 void p2p_buf_add_group_bssid(struct wpabuf *buf, const u8 *bssid)
238 {
239 /* P2P Group BSSID */
240 wpabuf_put_u8(buf, P2P_ATTR_GROUP_BSSID);
241 wpabuf_put_le16(buf, ETH_ALEN);
242 wpabuf_put_data(buf, bssid, ETH_ALEN);
243 wpa_printf(MSG_DEBUG, "P2P: * P2P Group BSSID " MACSTR,
244 MAC2STR(bssid));
245 }
246
247
p2p_buf_add_group_id(struct wpabuf * buf,const u8 * dev_addr,const u8 * ssid,size_t ssid_len)248 void p2p_buf_add_group_id(struct wpabuf *buf, const u8 *dev_addr,
249 const u8 *ssid, size_t ssid_len)
250 {
251 /* P2P Group ID */
252 wpabuf_put_u8(buf, P2P_ATTR_GROUP_ID);
253 wpabuf_put_le16(buf, ETH_ALEN + ssid_len);
254 wpabuf_put_data(buf, dev_addr, ETH_ALEN);
255 wpabuf_put_data(buf, ssid, ssid_len);
256 wpa_printf(MSG_DEBUG, "P2P: * P2P Group ID " MACSTR,
257 MAC2STR(dev_addr));
258 wpa_hexdump_ascii(MSG_DEBUG, "P2P: P2P Group ID SSID", ssid, ssid_len);
259 }
260
261
p2p_buf_add_invitation_flags(struct wpabuf * buf,u8 flags)262 void p2p_buf_add_invitation_flags(struct wpabuf *buf, u8 flags)
263 {
264 /* Invitation Flags */
265 wpabuf_put_u8(buf, P2P_ATTR_INVITATION_FLAGS);
266 wpabuf_put_le16(buf, 1);
267 wpabuf_put_u8(buf, flags);
268 wpa_printf(MSG_DEBUG, "P2P: * Invitation Flags: bitmap 0x%x", flags);
269 }
270
271
p2p_buf_add_noa_desc(struct wpabuf * buf,struct p2p_noa_desc * desc)272 static void p2p_buf_add_noa_desc(struct wpabuf *buf, struct p2p_noa_desc *desc)
273 {
274 if (desc == NULL)
275 return;
276
277 wpabuf_put_u8(buf, desc->count_type);
278 wpabuf_put_le32(buf, desc->duration);
279 wpabuf_put_le32(buf, desc->interval);
280 wpabuf_put_le32(buf, desc->start_time);
281 }
282
283
p2p_buf_add_noa(struct wpabuf * buf,u8 noa_index,u8 opp_ps,u8 ctwindow,struct p2p_noa_desc * desc1,struct p2p_noa_desc * desc2)284 void p2p_buf_add_noa(struct wpabuf *buf, u8 noa_index, u8 opp_ps, u8 ctwindow,
285 struct p2p_noa_desc *desc1, struct p2p_noa_desc *desc2)
286 {
287 /* Notice of Absence */
288 wpabuf_put_u8(buf, P2P_ATTR_NOTICE_OF_ABSENCE);
289 wpabuf_put_le16(buf, 2 + (desc1 ? 13 : 0) + (desc2 ? 13 : 0));
290 wpabuf_put_u8(buf, noa_index);
291 wpabuf_put_u8(buf, (opp_ps ? 0x80 : 0) | (ctwindow & 0x7f));
292 p2p_buf_add_noa_desc(buf, desc1);
293 p2p_buf_add_noa_desc(buf, desc2);
294 wpa_printf(MSG_DEBUG, "P2P: * Notice of Absence");
295 }
296
297
p2p_buf_add_ext_listen_timing(struct wpabuf * buf,u16 period,u16 interval)298 void p2p_buf_add_ext_listen_timing(struct wpabuf *buf, u16 period,
299 u16 interval)
300 {
301 /* Extended Listen Timing */
302 wpabuf_put_u8(buf, P2P_ATTR_EXT_LISTEN_TIMING);
303 wpabuf_put_le16(buf, 4);
304 wpabuf_put_le16(buf, period);
305 wpabuf_put_le16(buf, interval);
306 wpa_printf(MSG_DEBUG, "P2P: * Extended Listen Timing (period %u msec "
307 "interval %u msec)", period, interval);
308 }
309
310
p2p_buf_add_p2p_interface(struct wpabuf * buf,struct p2p_data * p2p)311 void p2p_buf_add_p2p_interface(struct wpabuf *buf, struct p2p_data *p2p)
312 {
313 /* P2P Interface */
314 wpabuf_put_u8(buf, P2P_ATTR_INTERFACE);
315 wpabuf_put_le16(buf, ETH_ALEN + 1 + ETH_ALEN);
316 /* P2P Device address */
317 wpabuf_put_data(buf, p2p->cfg->dev_addr, ETH_ALEN);
318 /*
319 * FIX: Fetch interface address list from driver. Do not include
320 * the P2P Device address if it is never used as interface address.
321 */
322 /* P2P Interface Address Count */
323 wpabuf_put_u8(buf, 1);
324 wpabuf_put_data(buf, p2p->cfg->dev_addr, ETH_ALEN);
325 }
326
327
p2p_buf_add_oob_go_neg_channel(struct wpabuf * buf,const char * country,u8 oper_class,u8 channel,enum p2p_role_indication role)328 void p2p_buf_add_oob_go_neg_channel(struct wpabuf *buf, const char *country,
329 u8 oper_class, u8 channel,
330 enum p2p_role_indication role)
331 {
332 /* OOB Group Owner Negotiation Channel */
333 wpabuf_put_u8(buf, P2P_ATTR_OOB_GO_NEG_CHANNEL);
334 wpabuf_put_le16(buf, 6);
335 wpabuf_put_data(buf, country, 3);
336 wpabuf_put_u8(buf, oper_class); /* Operating Class */
337 wpabuf_put_u8(buf, channel); /* Channel Number */
338 wpabuf_put_u8(buf, (u8) role); /* Role indication */
339 wpa_printf(MSG_DEBUG, "P2P: * OOB GO Negotiation Channel: Operating "
340 "Class %u Channel %u Role %d",
341 oper_class, channel, role);
342 }
343
344
p2p_add_wps_string(struct wpabuf * buf,enum wps_attribute attr,const char * val)345 static int p2p_add_wps_string(struct wpabuf *buf, enum wps_attribute attr,
346 const char *val)
347 {
348 size_t len;
349
350 len = val ? os_strlen(val) : 0;
351 if (wpabuf_tailroom(buf) < 4 + len)
352 return -1;
353 wpabuf_put_be16(buf, attr);
354 #ifndef CONFIG_WPS_STRICT
355 if (len == 0) {
356 /*
357 * Some deployed WPS implementations fail to parse zeor-length
358 * attributes. As a workaround, send a space character if the
359 * device attribute string is empty.
360 */
361 if (wpabuf_tailroom(buf) < 3)
362 return -1;
363 wpabuf_put_be16(buf, 1);
364 wpabuf_put_u8(buf, ' ');
365 return 0;
366 }
367 #endif /* CONFIG_WPS_STRICT */
368 wpabuf_put_be16(buf, len);
369 if (val)
370 wpabuf_put_data(buf, val, len);
371 return 0;
372 }
373
374
p2p_build_wps_ie(struct p2p_data * p2p,struct wpabuf * buf,int pw_id,int all_attr)375 int p2p_build_wps_ie(struct p2p_data *p2p, struct wpabuf *buf, int pw_id,
376 int all_attr)
377 {
378 u8 *len;
379 int i;
380
381 if (wpabuf_tailroom(buf) < 6)
382 return -1;
383 wpabuf_put_u8(buf, WLAN_EID_VENDOR_SPECIFIC);
384 len = wpabuf_put(buf, 1);
385 wpabuf_put_be32(buf, WPS_DEV_OUI_WFA);
386
387 if (wps_build_version(buf) < 0)
388 return -1;
389
390 if (all_attr) {
391 if (wpabuf_tailroom(buf) < 5)
392 return -1;
393 wpabuf_put_be16(buf, ATTR_WPS_STATE);
394 wpabuf_put_be16(buf, 1);
395 wpabuf_put_u8(buf, WPS_STATE_NOT_CONFIGURED);
396 }
397
398 if (pw_id >= 0) {
399 if (wpabuf_tailroom(buf) < 6)
400 return -1;
401 /* Device Password ID */
402 wpabuf_put_be16(buf, ATTR_DEV_PASSWORD_ID);
403 wpabuf_put_be16(buf, 2);
404 wpa_printf(MSG_DEBUG, "P2P: WPS IE Device Password ID: %d",
405 pw_id);
406 wpabuf_put_be16(buf, pw_id);
407 }
408
409 if (all_attr) {
410 if (wpabuf_tailroom(buf) < 5)
411 return -1;
412 wpabuf_put_be16(buf, ATTR_RESPONSE_TYPE);
413 wpabuf_put_be16(buf, 1);
414 wpabuf_put_u8(buf, WPS_RESP_ENROLLEE_INFO);
415
416 if (wps_build_uuid_e(buf, p2p->cfg->uuid) < 0 ||
417 p2p_add_wps_string(buf, ATTR_MANUFACTURER,
418 p2p->cfg->manufacturer) < 0 ||
419 p2p_add_wps_string(buf, ATTR_MODEL_NAME,
420 p2p->cfg->model_name) < 0 ||
421 p2p_add_wps_string(buf, ATTR_MODEL_NUMBER,
422 p2p->cfg->model_number) < 0 ||
423 p2p_add_wps_string(buf, ATTR_SERIAL_NUMBER,
424 p2p->cfg->serial_number) < 0)
425 return -1;
426
427 if (wpabuf_tailroom(buf) < 4 + WPS_DEV_TYPE_LEN)
428 return -1;
429 wpabuf_put_be16(buf, ATTR_PRIMARY_DEV_TYPE);
430 wpabuf_put_be16(buf, WPS_DEV_TYPE_LEN);
431 wpabuf_put_data(buf, p2p->cfg->pri_dev_type, WPS_DEV_TYPE_LEN);
432
433 if (p2p_add_wps_string(buf, ATTR_DEV_NAME, p2p->cfg->dev_name)
434 < 0)
435 return -1;
436
437 if (wpabuf_tailroom(buf) < 6)
438 return -1;
439 wpabuf_put_be16(buf, ATTR_CONFIG_METHODS);
440 wpabuf_put_be16(buf, 2);
441 wpabuf_put_be16(buf, p2p->cfg->config_methods);
442 }
443
444 if (wps_build_wfa_ext(buf, 0, NULL, 0) < 0)
445 return -1;
446
447 if (all_attr && p2p->cfg->num_sec_dev_types) {
448 if (wpabuf_tailroom(buf) <
449 4 + WPS_DEV_TYPE_LEN * p2p->cfg->num_sec_dev_types)
450 return -1;
451 wpabuf_put_be16(buf, ATTR_SECONDARY_DEV_TYPE_LIST);
452 wpabuf_put_be16(buf, WPS_DEV_TYPE_LEN *
453 p2p->cfg->num_sec_dev_types);
454 wpabuf_put_data(buf, p2p->cfg->sec_dev_type,
455 WPS_DEV_TYPE_LEN *
456 p2p->cfg->num_sec_dev_types);
457 }
458
459 /* Add the WPS vendor extensions */
460 for (i = 0; i < P2P_MAX_WPS_VENDOR_EXT; i++) {
461 if (p2p->wps_vendor_ext[i] == NULL)
462 break;
463 if (wpabuf_tailroom(buf) <
464 4 + wpabuf_len(p2p->wps_vendor_ext[i]))
465 continue;
466 wpabuf_put_be16(buf, ATTR_VENDOR_EXT);
467 wpabuf_put_be16(buf, wpabuf_len(p2p->wps_vendor_ext[i]));
468 wpabuf_put_buf(buf, p2p->wps_vendor_ext[i]);
469 }
470
471 p2p_buf_update_ie_hdr(buf, len);
472
473 return 0;
474 }
475