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