4  * Copyright (c) 2011-2014, Qualcomm Atheros, Inc.
5  * Copyright (c) 2011-2014, Jouni Malinen <j@w1.fi>
29 /* GAS query wait-time / duration in ms */
36  * struct gas_query_pending - Pending GAS query
64  * struct gas_query - Internal GAS query data
96  * gas_query_init - Initialize GAS query component
108 	gas->wpa_s = wpa_s;  in gas_query_init()
109 	dl_list_init(&gas->pending);  in gas_query_init()
140 	struct gas_query *gas = query->gas;  in gas_query_free()
143 		dl_list_del(&query->list);  in gas_query_free()
145 	if (gas->work && gas->work->ctx == query) {  in gas_query_free()
146 		radio_work_done(gas->work);  in gas_query_free()
147 		gas->work = NULL;  in gas_query_free()
150 	wpabuf_free(query->req);  in gas_query_free()
151 	wpabuf_free(query->adv_proto);  in gas_query_free()
152 	wpabuf_free(query->resp);  in gas_query_free()
161 	wpa_msg(gas->wpa_s, MSG_INFO, GAS_QUERY_DONE "addr=" MACSTR  in gas_query_done()
163 		MAC2STR(query->addr), query->dialog_token, query->freq,  in gas_query_done()
164 		query->status_code, gas_result_txt(result));  in gas_query_done()
165 	if (gas->current == query)  in gas_query_done()
166 		gas->current = NULL;  in gas_query_done()
167 	if (query->offchannel_tx_started)  in gas_query_done()
168 		offchannel_send_action_done(gas->wpa_s);  in gas_query_done()
172 	dl_list_del(&query->list);  in gas_query_done()
173 	query->cb(query->ctx, query->addr, query->dialog_token, result,  in gas_query_done()
174 		  query->adv_proto, query->resp, query->status_code);  in gas_query_done()
180  * gas_query_deinit - Deinitialize GAS query component
190 	dl_list_for_each_safe(query, next, &gas->pending,  in gas_query_deinit()
202 	struct wpa_supplicant *wpa_s = gas->wpa_s;  in gas_query_get_pending()
204 	dl_list_for_each(q, &gas->pending, struct gas_query_pending, list) {  in gas_query_get_pending()
205 		if (ether_addr_equal(q->addr, addr) &&  in gas_query_get_pending()
206 		    q->dialog_token == dialog_token)  in gas_query_get_pending()
208 		if (wpa_s->valid_links &&  in gas_query_get_pending()
209 		    ether_addr_equal(wpa_s->ap_mld_addr, addr) &&  in gas_query_get_pending()
210 		    wpas_ap_link_address(wpa_s, q->addr))  in gas_query_get_pending()
220 	if (wpabuf_resize(&query->resp, len) < 0) {  in gas_query_append()
222 		return -1;  in gas_query_append()
224 	wpabuf_put_data(query->resp, data, len);  in gas_query_append()
236 	struct gas_query *gas = wpa_s->gas;  in gas_query_tx_status()
239 	if (gas->current == NULL) {  in gas_query_tx_status()
241 			   MACSTR " result=%d - no query in progress",  in gas_query_tx_status()
246 	query = gas->current;  in gas_query_tx_status()
248 	dur = ms_from_time(&query->last_oper);  in gas_query_tx_status()
251 		   freq, MAC2STR(dst), result, query, query->dialog_token, dur);  in gas_query_tx_status()
252 	if (!ether_addr_equal(dst, query->addr)) {  in gas_query_tx_status()
256 	os_get_reltime(&query->last_oper);  in gas_query_tx_status()
269 		if (query->wait_comeback && !query->retry) {  in gas_query_tx_status()
287 	int res, prot = pmf_in_use(gas->wpa_s, query->addr);  in gas_query_tx()
295 		   MAC2STR(query->addr), (unsigned int) wpabuf_len(req),  in gas_query_tx()
296 		   query->freq, prot, MAC2STR(query->sa));  in gas_query_tx()
301 	os_get_reltime(&query->last_oper);  in gas_query_tx()
302 	if (gas->wpa_s->max_remain_on_chan &&  in gas_query_tx()
303 	    wait_time > gas->wpa_s->max_remain_on_chan)  in gas_query_tx()
304 		wait_time = gas->wpa_s->max_remain_on_chan;  in gas_query_tx()
305 	if (!query->wildcard_bssid &&  in gas_query_tx()
306 	    (!gas->wpa_s->conf->gas_address3 ||  in gas_query_tx()
307 	     (gas->wpa_s->current_ssid &&  in gas_query_tx()
308 	      gas->wpa_s->wpa_state >= WPA_ASSOCIATED &&  in gas_query_tx()
309 	      ether_addr_equal(query->addr, gas->wpa_s->bssid))))  in gas_query_tx()
310 		bssid = query->addr;  in gas_query_tx()
314 	res = offchannel_send_action(gas->wpa_s, query->freq, query->addr,  in gas_query_tx()
315 				     query->sa, bssid, wpabuf_head(req),  in gas_query_tx()
320 		query->offchannel_tx_started = 1;  in gas_query_tx()
331 	req = gas_build_comeback_req(query->dialog_token);  in gas_query_tx_comeback_req()
337 	wait_time = (query->retry || !query->offchannel_tx_started) ?  in gas_query_tx_comeback_req()
342 			   MACSTR, MAC2STR(query->addr));  in gas_query_tx_comeback_req()
358 		   query->retry);  in gas_query_rx_comeback_timeout()
359 	if (gas->current != query || query->retry)  in gas_query_rx_comeback_timeout()
361 	dialog_token = gas_query_new_dialog_token(gas, query->addr);  in gas_query_rx_comeback_timeout()
366 	query->retry = 1;  in gas_query_rx_comeback_timeout()
367 	query->dialog_token = dialog_token;  in gas_query_rx_comeback_timeout()
368 	*(wpabuf_mhead_u8(query->req) + 2) = dialog_token;  in gas_query_rx_comeback_timeout()
369 	query->wait_comeback = 0;  in gas_query_rx_comeback_timeout()
370 	query->next_frag_id = 0;  in gas_query_rx_comeback_timeout()
371 	wpabuf_free(query->adv_proto);  in gas_query_rx_comeback_timeout()
372 	query->adv_proto = NULL;  in gas_query_rx_comeback_timeout()
385 		   MAC2STR(query->addr));  in gas_query_tx_comeback_timeout()
396 	if (comeback_delay > 1 && query->offchannel_tx_started) {  in gas_query_tx_comeback_req_delay()
397 		offchannel_send_action_done(gas->wpa_s);  in gas_query_tx_comeback_req_delay()
398 		query->offchannel_tx_started = 0;  in gas_query_tx_comeback_req_delay()
402 	usecs = comeback_delay * 1024 - secs * 1000000;  in gas_query_tx_comeback_req_delay()
404 		   " in %u secs %u usecs", MAC2STR(query->addr), secs, usecs);  in gas_query_tx_comeback_req_delay()
418 		   MAC2STR(query->addr), query->dialog_token, comeback_delay);  in gas_query_rx_initial()
420 	query->adv_proto = wpabuf_alloc_copy(adv_proto, adv_proto_len);  in gas_query_rx_initial()
421 	if (query->adv_proto == NULL) {  in gas_query_rx_initial()
428 		query->wait_comeback = 1;  in gas_query_rx_initial()
452 		   MAC2STR(query->addr), query->dialog_token, frag_id,  in gas_query_rx_comeback()
456 	if (adv_proto_len != wpabuf_len(query->adv_proto) ||  in gas_query_rx_comeback()
457 	    os_memcmp(adv_proto, wpabuf_head(query->adv_proto),  in gas_query_rx_comeback()
458 		      wpabuf_len(query->adv_proto)) != 0) {  in gas_query_rx_comeback()
461 			   MACSTR, MAC2STR(query->addr));  in gas_query_rx_comeback()
469 				   "with non-zero frag_id and comeback_delay "  in gas_query_rx_comeback()
470 				   "from " MACSTR, MAC2STR(query->addr));  in gas_query_rx_comeback()
478 	if (frag_id != query->next_frag_id) {  in gas_query_rx_comeback()
480 			   "from " MACSTR, MAC2STR(query->addr));  in gas_query_rx_comeback()
481 		if (frag_id + 1 == query->next_frag_id) {  in gas_query_rx_comeback()
489 	query->next_frag_id++;  in gas_query_rx_comeback()
506  * gas_query_rx - Indicate reception of a Public Action or Protected Dual frame
515  * Returns: 0 if the Public Action frame was a GAS frame or -1 if not
530 		return -1;  in gas_query_rx()
538 		return -1; /* Not a GAS response */  in gas_query_rx()
541 	pmf = pmf_in_use(gas->wpa_s, sa);  in gas_query_rx()
555 		return -1;  in gas_query_rx()
559 		   ms_from_time(&query->last_oper), MAC2STR(sa));  in gas_query_rx()
561 	if (query->wait_comeback && action == WLAN_PA_GAS_INITIAL_RESP) {  in gas_query_rx()
568 	if (!query->wait_comeback && action == WLAN_PA_GAS_COMEBACK_RESP) {  in gas_query_rx()
575 	query->status_code = WPA_GET_LE16(pos);  in gas_query_rx()
578 	if (query->status_code == WLAN_STATUS_QUERY_RESP_OUTSTANDING &&  in gas_query_rx()
580 		wpa_printf(MSG_DEBUG, "GAS: Allow non-zero status for outstanding comeback response");  in gas_query_rx()
581 	} else if (query->status_code != WLAN_STATUS_SUCCESS) {  in gas_query_rx()
583 			   "%u failed - status code %u",  in gas_query_rx()
584 			   MAC2STR(sa), dialog_token, query->status_code);  in gas_query_rx()
607 	left = data + len - adv_proto;  in gas_query_rx()
608 	if (left < 2 || adv_proto[1] > left - 2) {  in gas_query_rx()
622 	if (adv_proto_len > (size_t) (data + len - pos))  in gas_query_rx()
635 	left = data + len - pos;  in gas_query_rx()
645 			   left - resp_len, MAC2STR(sa));  in gas_query_rx()
667 		   MAC2STR(query->addr), query->dialog_token);  in gas_query_timeout()
676 	dl_list_for_each(q, &gas->pending, struct gas_query_pending, list) {  in gas_query_dialog_token_available()
677 		if (ether_addr_equal(dst, q->addr) &&  in gas_query_dialog_token_available()
678 		    dialog_token == q->dialog_token)  in gas_query_dialog_token_available()
688 	struct gas_query_pending *query = work->ctx;  in gas_query_start_cb()
689 	struct gas_query *gas = query->gas;  in gas_query_start_cb()
690 	struct wpa_supplicant *wpa_s = gas->wpa_s;  in gas_query_start_cb()
693 		if (work->started) {  in gas_query_start_cb()
694 			gas->work = NULL;  in gas_query_start_cb()
703 	if (!query->maintain_addr && !wpa_s->conf->gas_rand_mac_addr) {  in gas_query_start_cb()
711 		os_memcpy(query->sa, wpa_s->own_addr, ETH_ALEN);  in gas_query_start_cb()
714 	gas->work = work;  in gas_query_start_cb()
722 	if (gas_query_tx(gas, query, query->req,  in gas_query_tx_initial_req()
725 			   MACSTR, MAC2STR(query->addr));  in gas_query_tx_initial_req()
729 	gas->current = query;  in gas_query_tx_initial_req()
732 		   query->dialog_token);  in gas_query_tx_initial_req()
757 	return -1;  in gas_query_new_dialog_token()
764 	struct wpa_supplicant *wpa_s = gas->wpa_s;  in gas_query_set_sa()
767 	if (query->maintain_addr ||  in gas_query_set_sa()
768 	    !wpa_s->conf->gas_rand_mac_addr ||  in gas_query_set_sa()
769 	    !(wpa_s->current_bss ?  in gas_query_set_sa()
770 	      (wpa_s->drv_flags &  in gas_query_set_sa()
772 	      (wpa_s->drv_flags & WPA_DRIVER_FLAGS_MGMT_TX_RANDOM_TA))) {  in gas_query_set_sa()
776 			   query->maintain_addr ? " (maintain_addr)" : "",  in gas_query_set_sa()
777 			   !wpa_s->conf->gas_rand_mac_addr ? " (no gas_rand_mac_adr set)" : "",  in gas_query_set_sa()
778 			   !(wpa_s->current_bss ?  in gas_query_set_sa()
779 			     (wpa_s->drv_flags &  in gas_query_set_sa()
781 			     (wpa_s->drv_flags &  in gas_query_set_sa()
784 		os_memcpy(query->sa, wpa_s->own_addr, ETH_ALEN);  in gas_query_set_sa()
790 	if (wpa_s->conf->gas_rand_mac_addr == gas->last_rand_sa_type &&  in gas_query_set_sa()
791 	    gas->last_mac_addr_rand.sec != 0 &&  in gas_query_set_sa()
792 	    !os_reltime_expired(&now, &gas->last_mac_addr_rand,  in gas_query_set_sa()
793 				wpa_s->conf->gas_rand_addr_lifetime)) {  in gas_query_set_sa()
796 			   MACSTR, MAC2STR(gas->rand_addr));  in gas_query_set_sa()
797 		os_memcpy(query->sa, gas->rand_addr, ETH_ALEN);  in gas_query_set_sa()
801 	if (wpa_s->conf->gas_rand_mac_addr == 1 &&  in gas_query_set_sa()
802 	    random_mac_addr(gas->rand_addr) < 0) {  in gas_query_set_sa()
804 		return -1;  in gas_query_set_sa()
807 	if (wpa_s->conf->gas_rand_mac_addr == 2 &&  in gas_query_set_sa()
808 	    random_mac_addr_keep_oui(gas->rand_addr) < 0) {  in gas_query_set_sa()
811 		return -1;  in gas_query_set_sa()
815 		   MACSTR, MAC2STR(gas->rand_addr));  in gas_query_set_sa()
816 	os_memcpy(query->sa, gas->rand_addr, ETH_ALEN);  in gas_query_set_sa()
817 	os_get_reltime(&gas->last_mac_addr_rand);  in gas_query_set_sa()
818 	gas->last_rand_sa_type = wpa_s->conf->gas_rand_mac_addr;  in gas_query_set_sa()
825  * gas_query_req - Request a GAS query
836  * Returns: dialog token (>= 0) on success or -1 on failure
850 		return -1;  in gas_query_req()
854 		return -1;  in gas_query_req()
858 		return -1;  in gas_query_req()
860 	query->gas = gas;  in gas_query_req()
861 	query->maintain_addr = !!maintain_addr;  in gas_query_req()
864 		return -1;  in gas_query_req()
866 	os_memcpy(query->addr, dst, ETH_ALEN);  in gas_query_req()
867 	query->dialog_token = dialog_token;  in gas_query_req()
868 	query->wildcard_bssid = !!wildcard_bssid;  in gas_query_req()
869 	query->freq = freq;  in gas_query_req()
870 	query->cb = cb;  in gas_query_req()
871 	query->ctx = ctx;  in gas_query_req()
872 	query->req = req;  in gas_query_req()
873 	dl_list_add(&gas->pending, &query->list);  in gas_query_req()
877 	wpa_msg(gas->wpa_s, MSG_INFO, GAS_QUERY_START "addr=" MACSTR  in gas_query_req()
879 		MAC2STR(query->addr), query->dialog_token, query->freq);  in gas_query_req()
881 	if (radio_add_work(gas->wpa_s, freq, "gas-query", 0, gas_query_start_cb,  in gas_query_req()
883 		query->req = NULL; /* caller will free this in error case */  in gas_query_req()
885 		return -1;  in gas_query_req()
896 	dl_list_for_each(query, &gas->pending, struct gas_query_pending, list) {  in gas_query_stop()
897 		if (query->dialog_token == dialog_token) {  in gas_query_stop()
898 			if (!gas->work) {  in gas_query_stop()
899 				/* The pending radio work has not yet been  in gas_query_stop()
902 				 * Need to remove that radio work now to avoid  in gas_query_stop()
905 				radio_remove_pending_work(gas->wpa_s, query);  in gas_query_stop()
912 	return -1;  in gas_query_stop()