]>
Commit | Line | Data |
---|---|---|
9cb34130 | 1 | # P2P helper functions |
b21540e6 | 2 | # Copyright (c) 2013-2019, Jouni Malinen <j@w1.fi> |
9cb34130 JM |
3 | # |
4 | # This software may be distributed under the terms of the BSD license. | |
5 | # See README for more details. | |
6 | ||
7 | import logging | |
8 | logger = logging.getLogger() | |
9 | import threading | |
10 | import time | |
9c06eda0 MH |
11 | try: |
12 | from Queue import Queue | |
13 | except ImportError: | |
14 | from queue import Queue | |
9cb34130 JM |
15 | |
16 | import hwsim_utils | |
17 | ||
18 | MGMT_SUBTYPE_PROBE_REQ = 4 | |
19 | MGMT_SUBTYPE_ACTION = 13 | |
20 | ACTION_CATEG_PUBLIC = 4 | |
21 | ||
22 | P2P_GO_NEG_REQ = 0 | |
23 | P2P_GO_NEG_RESP = 1 | |
24 | P2P_GO_NEG_CONF = 2 | |
25 | P2P_INVITATION_REQ = 3 | |
26 | P2P_INVITATION_RESP = 4 | |
27 | P2P_DEV_DISC_REQ = 5 | |
28 | P2P_DEV_DISC_RESP = 6 | |
29 | P2P_PROV_DISC_REQ = 7 | |
30 | P2P_PROV_DISC_RESP = 8 | |
31 | ||
32 | P2P_ATTR_STATUS = 0 | |
33 | P2P_ATTR_MINOR_REASON_CODE = 1 | |
34 | P2P_ATTR_CAPABILITY = 2 | |
35 | P2P_ATTR_DEVICE_ID = 3 | |
36 | P2P_ATTR_GROUP_OWNER_INTENT = 4 | |
37 | P2P_ATTR_CONFIGURATION_TIMEOUT = 5 | |
38 | P2P_ATTR_LISTEN_CHANNEL = 6 | |
39 | P2P_ATTR_GROUP_BSSID = 7 | |
40 | P2P_ATTR_EXT_LISTEN_TIMING = 8 | |
41 | P2P_ATTR_INTENDED_INTERFACE_ADDR = 9 | |
42 | P2P_ATTR_MANAGEABILITY = 10 | |
43 | P2P_ATTR_CHANNEL_LIST = 11 | |
44 | P2P_ATTR_NOTICE_OF_ABSENCE = 12 | |
45 | P2P_ATTR_DEVICE_INFO = 13 | |
46 | P2P_ATTR_GROUP_INFO = 14 | |
47 | P2P_ATTR_GROUP_ID = 15 | |
48 | P2P_ATTR_INTERFACE = 16 | |
49 | P2P_ATTR_OPERATING_CHANNEL = 17 | |
50 | P2P_ATTR_INVITATION_FLAGS = 18 | |
51 | P2P_ATTR_OOB_GO_NEG_CHANNEL = 19 | |
52 | P2P_ATTR_SERVICE_HASH = 21 | |
53 | P2P_ATTR_SESSION_INFORMATION_DATA = 22 | |
54 | P2P_ATTR_CONNECTION_CAPABILITY = 23 | |
55 | P2P_ATTR_ADVERTISEMENT_ID = 24 | |
56 | P2P_ATTR_ADVERTISED_SERVICE = 25 | |
57 | P2P_ATTR_SESSION_ID = 26 | |
58 | P2P_ATTR_FEATURE_CAPABILITY = 27 | |
59 | P2P_ATTR_PERSISTENT_GROUP = 28 | |
60 | P2P_ATTR_VENDOR_SPECIFIC = 221 | |
61 | ||
62 | P2P_SC_SUCCESS = 0 | |
63 | P2P_SC_FAIL_INFO_CURRENTLY_UNAVAILABLE = 1 | |
64 | P2P_SC_FAIL_INCOMPATIBLE_PARAMS = 2 | |
65 | P2P_SC_FAIL_LIMIT_REACHED = 3 | |
66 | P2P_SC_FAIL_INVALID_PARAMS = 4 | |
67 | P2P_SC_FAIL_UNABLE_TO_ACCOMMODATE = 5 | |
68 | P2P_SC_FAIL_PREV_PROTOCOL_ERROR = 6 | |
69 | P2P_SC_FAIL_NO_COMMON_CHANNELS = 7 | |
70 | P2P_SC_FAIL_UNKNOWN_GROUP = 8 | |
71 | P2P_SC_FAIL_BOTH_GO_INTENT_15 = 9 | |
72 | P2P_SC_FAIL_INCOMPATIBLE_PROV_METHOD = 10 | |
73 | P2P_SC_FAIL_REJECTED_BY_USER = 11 | |
74 | ||
75 | WSC_ATTR_CONFIG_METHODS = 0x1008 | |
76 | ||
77 | WLAN_EID_SSID = 0 | |
78 | WLAN_EID_SUPP_RATES = 1 | |
79 | WLAN_EID_VENDOR_SPECIFIC = 221 | |
80 | ||
601e5572 JM |
81 | def go_neg_pin_authorized_persistent(i_dev, r_dev, i_intent=None, r_intent=None, |
82 | i_method='enter', r_method='display', | |
83 | test_data=True, r_listen=True): | |
84 | if r_listen: | |
85 | r_dev.p2p_listen() | |
9cb34130 JM |
86 | i_dev.p2p_listen() |
87 | pin = r_dev.wps_read_pin() | |
88 | logger.info("Start GO negotiation " + i_dev.ifname + " -> " + r_dev.ifname) | |
89 | r_dev.p2p_go_neg_auth(i_dev.p2p_dev_addr(), pin, r_method, | |
90 | go_intent=r_intent, persistent=True) | |
601e5572 JM |
91 | if r_listen: |
92 | r_dev.p2p_listen() | |
9cb34130 JM |
93 | i_res = i_dev.p2p_go_neg_init(r_dev.p2p_dev_addr(), pin, i_method, |
94 | timeout=20, go_intent=i_intent, | |
95 | persistent=True) | |
96 | r_res = r_dev.p2p_go_neg_auth_result() | |
97 | logger.debug("i_res: " + str(i_res)) | |
98 | logger.debug("r_res: " + str(r_res)) | |
99 | r_dev.dump_monitor() | |
100 | i_dev.dump_monitor() | |
101 | logger.info("Group formed") | |
102 | if test_data: | |
103 | hwsim_utils.test_connectivity_p2p(r_dev, i_dev) | |
104 | return [i_res, r_res] | |
105 | ||
106 | def terminate_group(go, cli): | |
107 | logger.info("Terminate persistent group") | |
b21540e6 | 108 | cli.close_monitor_group() |
9cb34130 JM |
109 | go.remove_group() |
110 | cli.wait_go_ending_session() | |
111 | ||
601e5572 | 112 | def invite(inv, resp, extra=None, persistent_reconnect=True, use_listen=True): |
9cb34130 JM |
113 | addr = resp.p2p_dev_addr() |
114 | if persistent_reconnect: | |
115 | resp.global_request("SET persistent_reconnect 1") | |
116 | else: | |
117 | resp.global_request("SET persistent_reconnect 0") | |
601e5572 JM |
118 | if use_listen: |
119 | resp.p2p_listen() | |
120 | else: | |
121 | resp.p2p_find(social=True) | |
9cb34130 JM |
122 | if not inv.discover_peer(addr, social=True): |
123 | raise Exception("Peer " + addr + " not found") | |
124 | inv.dump_monitor() | |
125 | peer = inv.get_peer(addr) | |
126 | cmd = "P2P_INVITE persistent=" + peer['persistent'] + " peer=" + addr | |
127 | if extra: | |
bc6e3288 | 128 | cmd = cmd + " " + extra |
9cb34130 JM |
129 | inv.global_request(cmd) |
130 | ||
131 | def check_result(go, cli): | |
6e9554e3 JM |
132 | ev = go.wait_global_event(["P2P-GROUP-STARTED", |
133 | "Failed to start AP functionality"], timeout=30) | |
9cb34130 JM |
134 | if ev is None: |
135 | raise Exception("Timeout on group re-invocation (on GO)") | |
6e9554e3 JM |
136 | if "P2P-GROUP-STARTED" not in ev: |
137 | raise Exception("GO failed to start the group for re-invocation") | |
9cb34130 JM |
138 | if "[PERSISTENT]" not in ev: |
139 | raise Exception("Re-invoked group not marked persistent") | |
140 | go_res = go.group_form_result(ev) | |
141 | if go_res['role'] != 'GO': | |
142 | raise Exception("Persistent group GO did not become GO") | |
143 | if not go_res['persistent']: | |
144 | raise Exception("Persistent group not re-invoked as persistent (GO)") | |
145 | ev = cli.wait_global_event(["P2P-GROUP-STARTED"], timeout=30) | |
146 | if ev is None: | |
147 | raise Exception("Timeout on group re-invocation (on client)") | |
148 | if "[PERSISTENT]" not in ev: | |
149 | raise Exception("Re-invoked group not marked persistent") | |
150 | cli_res = cli.group_form_result(ev) | |
151 | if cli_res['role'] != 'client': | |
152 | raise Exception("Persistent group client did not become client") | |
153 | if not cli_res['persistent']: | |
154 | raise Exception("Persistent group not re-invoked as persistent (cli)") | |
155 | return [go_res, cli_res] | |
156 | ||
601e5572 | 157 | def form(go, cli, test_data=True, reverse_init=False, r_listen=True): |
9cb34130 JM |
158 | logger.info("Form a persistent group") |
159 | if reverse_init: | |
160 | [i_res, r_res] = go_neg_pin_authorized_persistent(i_dev=cli, i_intent=0, | |
161 | r_dev=go, r_intent=15, | |
601e5572 JM |
162 | test_data=test_data, |
163 | r_listen=r_listen) | |
9cb34130 JM |
164 | else: |
165 | [i_res, r_res] = go_neg_pin_authorized_persistent(i_dev=go, i_intent=15, | |
166 | r_dev=cli, r_intent=0, | |
601e5572 JM |
167 | test_data=test_data, |
168 | r_listen=r_listen) | |
9cb34130 JM |
169 | if not i_res['persistent'] or not r_res['persistent']: |
170 | raise Exception("Formed group was not persistent") | |
171 | terminate_group(go, cli) | |
172 | if reverse_init: | |
173 | return r_res | |
174 | else: | |
175 | return i_res | |
176 | ||
b134397b | 177 | def invite_from_cli(go, cli, terminate=True): |
9cb34130 JM |
178 | logger.info("Re-invoke persistent group from client") |
179 | invite(cli, go) | |
180 | [go_res, cli_res] = check_result(go, cli) | |
181 | hwsim_utils.test_connectivity_p2p(go, cli) | |
b134397b JM |
182 | if terminate: |
183 | terminate_group(go, cli) | |
9cb34130 JM |
184 | return [go_res, cli_res] |
185 | ||
2403edb8 | 186 | def invite_from_go(go, cli, terminate=True, extra=None): |
9cb34130 | 187 | logger.info("Re-invoke persistent group from GO") |
2403edb8 | 188 | invite(go, cli, extra=extra) |
9cb34130 JM |
189 | [go_res, cli_res] = check_result(go, cli) |
190 | hwsim_utils.test_connectivity_p2p(go, cli) | |
b134397b JM |
191 | if terminate: |
192 | terminate_group(go, cli) | |
9cb34130 JM |
193 | return [go_res, cli_res] |
194 | ||
195 | def autogo(go, freq=None, persistent=None): | |
196 | logger.info("Start autonomous GO " + go.ifname) | |
197 | res = go.p2p_start_go(freq=freq, persistent=persistent) | |
198 | logger.debug("res: " + str(res)) | |
199 | return res | |
200 | ||
201 | def connect_cli(go, client, social=False, freq=None): | |
202 | logger.info("Try to connect the client to the GO") | |
203 | pin = client.wps_read_pin() | |
204 | go.p2p_go_authorize_client(pin) | |
205 | res = client.p2p_connect_group(go.p2p_dev_addr(), pin, timeout=60, | |
206 | social=social, freq=freq) | |
207 | logger.info("Client connected") | |
208 | hwsim_utils.test_connectivity_p2p(go, client) | |
209 | return res | |
210 | ||
211 | def check_grpform_results(i_res, r_res): | |
212 | if i_res['result'] != 'success' or r_res['result'] != 'success': | |
213 | raise Exception("Failed group formation") | |
214 | if i_res['ssid'] != r_res['ssid']: | |
215 | raise Exception("SSID mismatch") | |
216 | if i_res['freq'] != r_res['freq']: | |
217 | raise Exception("freq mismatch") | |
218 | if 'go_neg_freq' in r_res and i_res['go_neg_freq'] != r_res['go_neg_freq']: | |
219 | raise Exception("go_neg_freq mismatch") | |
220 | if i_res['freq'] != i_res['go_neg_freq']: | |
221 | raise Exception("freq/go_neg_freq mismatch") | |
222 | if i_res['role'] != i_res['go_neg_role']: | |
223 | raise Exception("role/go_neg_role mismatch") | |
224 | if 'go_neg_role' in r_res and r_res['role'] != r_res['go_neg_role']: | |
225 | raise Exception("role/go_neg_role mismatch") | |
226 | if i_res['go_dev_addr'] != r_res['go_dev_addr']: | |
227 | raise Exception("GO Device Address mismatch") | |
228 | ||
229 | def go_neg_init(i_dev, r_dev, pin, i_method, i_intent, res): | |
230 | logger.debug("Initiate GO Negotiation from i_dev") | |
231 | try: | |
232 | i_res = i_dev.p2p_go_neg_init(r_dev.p2p_dev_addr(), pin, i_method, timeout=20, go_intent=i_intent) | |
233 | logger.debug("i_res: " + str(i_res)) | |
bab493b9 | 234 | except Exception as e: |
9cb34130 JM |
235 | i_res = None |
236 | logger.info("go_neg_init thread caught an exception from p2p_go_neg_init: " + str(e)) | |
237 | res.put(i_res) | |
238 | ||
239 | def go_neg_pin(i_dev, r_dev, i_intent=None, r_intent=None, i_method='enter', r_method='display'): | |
240 | r_dev.p2p_listen() | |
241 | i_dev.p2p_listen() | |
242 | pin = r_dev.wps_read_pin() | |
243 | logger.info("Start GO negotiation " + i_dev.ifname + " -> " + r_dev.ifname) | |
244 | r_dev.dump_monitor() | |
9c06eda0 | 245 | res = Queue() |
9cb34130 JM |
246 | t = threading.Thread(target=go_neg_init, args=(i_dev, r_dev, pin, i_method, i_intent, res)) |
247 | t.start() | |
248 | logger.debug("Wait for GO Negotiation Request on r_dev") | |
249 | ev = r_dev.wait_global_event(["P2P-GO-NEG-REQUEST"], timeout=15) | |
250 | if ev is None: | |
251 | raise Exception("GO Negotiation timed out") | |
252 | r_dev.dump_monitor() | |
253 | logger.debug("Re-initiate GO Negotiation from r_dev") | |
254 | r_res = r_dev.p2p_go_neg_init(i_dev.p2p_dev_addr(), pin, r_method, go_intent=r_intent, timeout=20) | |
255 | logger.debug("r_res: " + str(r_res)) | |
256 | r_dev.dump_monitor() | |
257 | t.join() | |
258 | i_res = res.get() | |
259 | if i_res is None: | |
260 | raise Exception("go_neg_init thread failed") | |
261 | logger.debug("i_res: " + str(i_res)) | |
262 | logger.info("Group formed") | |
263 | hwsim_utils.test_connectivity_p2p(r_dev, i_dev) | |
264 | i_dev.dump_monitor() | |
265 | return [i_res, r_res] | |
266 | ||
35b61a49 JM |
267 | def go_neg_pin_authorized(i_dev, r_dev, i_intent=None, r_intent=None, |
268 | expect_failure=False, i_go_neg_status=None, | |
269 | i_method='enter', r_method='display', test_data=True, | |
270 | i_freq=None, r_freq=None, | |
271 | i_freq2=None, r_freq2=None, | |
272 | i_max_oper_chwidth=None, r_max_oper_chwidth=None, | |
273 | i_ht40=False, i_vht=False, r_ht40=False, r_vht=False): | |
9cb34130 JM |
274 | i_dev.p2p_listen() |
275 | pin = r_dev.wps_read_pin() | |
276 | logger.info("Start GO negotiation " + i_dev.ifname + " -> " + r_dev.ifname) | |
35b61a49 JM |
277 | r_dev.p2p_go_neg_auth(i_dev.p2p_dev_addr(), pin, r_method, |
278 | go_intent=r_intent, freq=r_freq, freq2=r_freq2, | |
279 | max_oper_chwidth=r_max_oper_chwidth, ht40=r_ht40, | |
280 | vht=r_vht) | |
9cb34130 | 281 | r_dev.p2p_listen() |
35b61a49 JM |
282 | i_res = i_dev.p2p_go_neg_init(r_dev.p2p_dev_addr(), pin, i_method, |
283 | timeout=20, go_intent=i_intent, | |
284 | expect_failure=expect_failure, freq=i_freq, | |
285 | freq2=i_freq2, | |
286 | max_oper_chwidth=i_max_oper_chwidth, | |
287 | ht40=i_ht40, vht=i_vht) | |
9cb34130 JM |
288 | r_res = r_dev.p2p_go_neg_auth_result(expect_failure=expect_failure) |
289 | logger.debug("i_res: " + str(i_res)) | |
290 | logger.debug("r_res: " + str(r_res)) | |
291 | r_dev.dump_monitor() | |
292 | i_dev.dump_monitor() | |
293 | if i_go_neg_status: | |
294 | if i_res['result'] != 'go-neg-failed': | |
295 | raise Exception("Expected GO Negotiation failure not reported") | |
296 | if i_res['status'] != i_go_neg_status: | |
297 | raise Exception("Expected GO Negotiation status not seen") | |
298 | if expect_failure: | |
299 | return | |
300 | logger.info("Group formed") | |
301 | if test_data: | |
302 | hwsim_utils.test_connectivity_p2p(r_dev, i_dev) | |
303 | return [i_res, r_res] | |
304 | ||
305 | def go_neg_init_pbc(i_dev, r_dev, i_intent, res, freq, provdisc): | |
306 | logger.debug("Initiate GO Negotiation from i_dev") | |
307 | try: | |
308 | i_res = i_dev.p2p_go_neg_init(r_dev.p2p_dev_addr(), None, "pbc", | |
309 | timeout=20, go_intent=i_intent, freq=freq, | |
310 | provdisc=provdisc) | |
311 | logger.debug("i_res: " + str(i_res)) | |
bab493b9 | 312 | except Exception as e: |
9cb34130 JM |
313 | i_res = None |
314 | logger.info("go_neg_init_pbc thread caught an exception from p2p_go_neg_init: " + str(e)) | |
315 | res.put(i_res) | |
316 | ||
317 | def go_neg_pbc(i_dev, r_dev, i_intent=None, r_intent=None, i_freq=None, r_freq=None, provdisc=False, r_listen=False): | |
318 | if r_listen: | |
319 | r_dev.p2p_listen() | |
320 | else: | |
321 | r_dev.p2p_find(social=True) | |
322 | i_dev.p2p_find(social=True) | |
323 | logger.info("Start GO negotiation " + i_dev.ifname + " -> " + r_dev.ifname) | |
324 | r_dev.dump_monitor() | |
9c06eda0 | 325 | res = Queue() |
9cb34130 JM |
326 | t = threading.Thread(target=go_neg_init_pbc, args=(i_dev, r_dev, i_intent, res, i_freq, provdisc)) |
327 | t.start() | |
328 | logger.debug("Wait for GO Negotiation Request on r_dev") | |
329 | ev = r_dev.wait_global_event(["P2P-GO-NEG-REQUEST"], timeout=15) | |
330 | if ev is None: | |
331 | raise Exception("GO Negotiation timed out") | |
332 | r_dev.dump_monitor() | |
333 | # Allow some time for the GO Neg Resp to go out before initializing new | |
334 | # GO Negotiation. | |
335 | time.sleep(0.2) | |
336 | logger.debug("Re-initiate GO Negotiation from r_dev") | |
337 | r_res = r_dev.p2p_go_neg_init(i_dev.p2p_dev_addr(), None, "pbc", | |
338 | go_intent=r_intent, timeout=20, freq=r_freq) | |
339 | logger.debug("r_res: " + str(r_res)) | |
340 | r_dev.dump_monitor() | |
341 | t.join() | |
342 | i_res = res.get() | |
343 | if i_res is None: | |
344 | raise Exception("go_neg_init_pbc thread failed") | |
345 | logger.debug("i_res: " + str(i_res)) | |
346 | logger.info("Group formed") | |
347 | hwsim_utils.test_connectivity_p2p(r_dev, i_dev) | |
348 | i_dev.dump_monitor() | |
349 | return [i_res, r_res] | |
350 | ||
351 | def go_neg_pbc_authorized(i_dev, r_dev, i_intent=None, r_intent=None, | |
352 | expect_failure=False, i_freq=None, r_freq=None): | |
353 | i_dev.p2p_listen() | |
354 | logger.info("Start GO negotiation " + i_dev.ifname + " -> " + r_dev.ifname) | |
355 | r_dev.p2p_go_neg_auth(i_dev.p2p_dev_addr(), None, "pbc", | |
356 | go_intent=r_intent, freq=r_freq) | |
357 | r_dev.p2p_listen() | |
358 | i_res = i_dev.p2p_go_neg_init(r_dev.p2p_dev_addr(), None, "pbc", timeout=20, | |
359 | go_intent=i_intent, | |
360 | expect_failure=expect_failure, freq=i_freq) | |
361 | r_res = r_dev.p2p_go_neg_auth_result(expect_failure=expect_failure) | |
362 | logger.debug("i_res: " + str(i_res)) | |
363 | logger.debug("r_res: " + str(r_res)) | |
364 | r_dev.dump_monitor() | |
365 | i_dev.dump_monitor() | |
366 | if expect_failure: | |
367 | return | |
368 | logger.info("Group formed") | |
369 | return [i_res, r_res] | |
370 | ||
cf4643aa JM |
371 | def remove_group(dev1, dev2, allow_failure=False): |
372 | try: | |
373 | dev1.remove_group() | |
374 | except: | |
375 | if not allow_failure: | |
376 | raise | |
9cb34130 JM |
377 | try: |
378 | dev2.remove_group() | |
379 | except: | |
380 | pass |