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