[thirdparty/hostap.git] / src / ap / ieee802_11_shared.c

/*
 * hostapd / IEEE 802.11 Management
 * Copyright (c) 2002-2012, Jouni Malinen <j@w1.fi>
 *
 * This software may be distributed under the terms of the BSD license.
 * See README for more details.
 */

#include "utils/includes.h"

#include "utils/common.h"
#include "common/ieee802_11_defs.h"
#include "hostapd.h"
#include "sta_info.h"
#include "ap_config.h"
#include "ap_drv_ops.h"
#include "ieee802_11.h"


#ifdef CONFIG_IEEE80211W

u8 * hostapd_eid_assoc_comeback_time(struct hostapd_data *hapd,
				     struct sta_info *sta, u8 *eid)
{
	u8 *pos = eid;
	u32 timeout, tu;
	struct os_time now, passed;

	*pos++ = WLAN_EID_TIMEOUT_INTERVAL;
	*pos++ = 5;
	*pos++ = WLAN_TIMEOUT_ASSOC_COMEBACK;
	os_get_time(&now);
	os_time_sub(&now, &sta->sa_query_start, &passed);
	tu = (passed.sec * 1000000 + passed.usec) / 1024;
	if (hapd->conf->assoc_sa_query_max_timeout > tu)
		timeout = hapd->conf->assoc_sa_query_max_timeout - tu;
	else
		timeout = 0;
	if (timeout < hapd->conf->assoc_sa_query_max_timeout)
		timeout++; /* add some extra time for local timers */
	WPA_PUT_LE32(pos, timeout);
	pos += 4;

	return pos;
}


/* MLME-SAQuery.request */
void ieee802_11_send_sa_query_req(struct hostapd_data *hapd,
				  const u8 *addr, const u8 *trans_id)
{
	struct ieee80211_mgmt mgmt;
	u8 *end;

	wpa_printf(MSG_DEBUG, "IEEE 802.11: Sending SA Query Request to "
		   MACSTR, MAC2STR(addr));
	wpa_hexdump(MSG_DEBUG, "IEEE 802.11: SA Query Transaction ID",
		    trans_id, WLAN_SA_QUERY_TR_ID_LEN);

	os_memset(&mgmt, 0, sizeof(mgmt));
	mgmt.frame_control = IEEE80211_FC(WLAN_FC_TYPE_MGMT,
					  WLAN_FC_STYPE_ACTION);
	os_memcpy(mgmt.da, addr, ETH_ALEN);
	os_memcpy(mgmt.sa, hapd->own_addr, ETH_ALEN);
	os_memcpy(mgmt.bssid, hapd->own_addr, ETH_ALEN);
	mgmt.u.action.category = WLAN_ACTION_SA_QUERY;
	mgmt.u.action.u.sa_query_req.action = WLAN_SA_QUERY_REQUEST;
	os_memcpy(mgmt.u.action.u.sa_query_req.trans_id, trans_id,
		  WLAN_SA_QUERY_TR_ID_LEN);
	end = mgmt.u.action.u.sa_query_req.trans_id + WLAN_SA_QUERY_TR_ID_LEN;
	if (hostapd_drv_send_mlme(hapd, &mgmt, end - (u8 *) &mgmt, 0) < 0)
		perror("ieee802_11_send_sa_query_req: send");
}


static void ieee802_11_send_sa_query_resp(struct hostapd_data *hapd,
					  const u8 *sa, const u8 *trans_id)
{
	struct sta_info *sta;
	struct ieee80211_mgmt resp;
	u8 *end;

	wpa_printf(MSG_DEBUG, "IEEE 802.11: Received SA Query Request from "
		   MACSTR, MAC2STR(sa));
	wpa_hexdump(MSG_DEBUG, "IEEE 802.11: SA Query Transaction ID",
		    trans_id, WLAN_SA_QUERY_TR_ID_LEN);

	sta = ap_get_sta(hapd, sa);
	if (sta == NULL || !(sta->flags & WLAN_STA_ASSOC)) {
		wpa_printf(MSG_DEBUG, "IEEE 802.11: Ignore SA Query Request "
			   "from unassociated STA " MACSTR, MAC2STR(sa));
		return;
	}

	wpa_printf(MSG_DEBUG, "IEEE 802.11: Sending SA Query Response to "
		   MACSTR, MAC2STR(sa));

	os_memset(&resp, 0, sizeof(resp));
	resp.frame_control = IEEE80211_FC(WLAN_FC_TYPE_MGMT,
					  WLAN_FC_STYPE_ACTION);
	os_memcpy(resp.da, sa, ETH_ALEN);
	os_memcpy(resp.sa, hapd->own_addr, ETH_ALEN);
	os_memcpy(resp.bssid, hapd->own_addr, ETH_ALEN);
	resp.u.action.category = WLAN_ACTION_SA_QUERY;
	resp.u.action.u.sa_query_req.action = WLAN_SA_QUERY_RESPONSE;
	os_memcpy(resp.u.action.u.sa_query_req.trans_id, trans_id,
		  WLAN_SA_QUERY_TR_ID_LEN);
	end = resp.u.action.u.sa_query_req.trans_id + WLAN_SA_QUERY_TR_ID_LEN;
	if (hostapd_drv_send_mlme(hapd, &resp, end - (u8 *) &resp, 0) < 0)
		perror("ieee80211_mgmt_sa_query_request: send");
}


void ieee802_11_sa_query_action(struct hostapd_data *hapd, const u8 *sa,
				const u8 action_type, const u8 *trans_id)
{
	struct sta_info *sta;
	int i;

	if (action_type == WLAN_SA_QUERY_REQUEST) {
		ieee802_11_send_sa_query_resp(hapd, sa, trans_id);
		return;
	}

	if (action_type != WLAN_SA_QUERY_RESPONSE) {
		wpa_printf(MSG_DEBUG, "IEEE 802.11: Unexpected SA Query "
			   "Action %d", action_type);
		return;
	}

	wpa_printf(MSG_DEBUG, "IEEE 802.11: Received SA Query Response from "
		   MACSTR, MAC2STR(sa));
	wpa_hexdump(MSG_DEBUG, "IEEE 802.11: SA Query Transaction ID",
		    trans_id, WLAN_SA_QUERY_TR_ID_LEN);

	/* MLME-SAQuery.confirm */

	sta = ap_get_sta(hapd, sa);
	if (sta == NULL || sta->sa_query_trans_id == NULL) {
		wpa_printf(MSG_DEBUG, "IEEE 802.11: No matching STA with "
			   "pending SA Query request found");
		return;
	}

	for (i = 0; i < sta->sa_query_count; i++) {
		if (os_memcmp(sta->sa_query_trans_id +
			      i * WLAN_SA_QUERY_TR_ID_LEN,
			      trans_id, WLAN_SA_QUERY_TR_ID_LEN) == 0)
			break;
	}

	if (i >= sta->sa_query_count) {
		wpa_printf(MSG_DEBUG, "IEEE 802.11: No matching SA Query "
			   "transaction identifier found");
		return;
	}

	hostapd_logger(hapd, sta->addr, HOSTAPD_MODULE_IEEE80211,
		       HOSTAPD_LEVEL_DEBUG,
		       "Reply to pending SA Query received");
	ap_sta_stop_sa_query(hapd, sta);
}

#endif /* CONFIG_IEEE80211W */


u8 * hostapd_eid_ext_capab(struct hostapd_data *hapd, u8 *eid)
{
	u8 *pos = eid;
	u8 len = 0;

	if (hapd->conf->tdls & (TDLS_PROHIBIT | TDLS_PROHIBIT_CHAN_SWITCH))
		len = 5;
	if (len < 4 && hapd->conf->interworking)
		len = 4;
	if (len < 3 && hapd->conf->wnm_sleep_mode)
		len = 3;
	if (len < 7 && hapd->conf->ssid.utf8_ssid)
		len = 7;
#ifdef CONFIG_WNM
	if (len < 4)
		len = 4;
#endif /* CONFIG_WNM */
	if (len == 0)
		return eid;

	*pos++ = WLAN_EID_EXT_CAPAB;
	*pos++ = len;
	*pos++ = 0x00;
	*pos++ = 0x00;

	*pos = 0x00;
	if (hapd->conf->wnm_sleep_mode)
		*pos |= 0x02; /* Bit 17 - WNM-Sleep Mode */
	if (hapd->conf->bss_transition)
		*pos |= 0x08; /* Bit 19 - BSS Transition */
	pos++;

	if (len < 4)
		return pos;
	*pos = 0x00;
#ifdef CONFIG_WNM
	*pos |= 0x02; /* Bit 25 - SSID List */
#endif /* CONFIG_WNM */
	if (hapd->conf->time_advertisement == 2)
		*pos |= 0x08; /* Bit 27 - UTC TSF Offset */
	if (hapd->conf->interworking)
		*pos |= 0x80; /* Bit 31 - Interworking */
	pos++;

	if (len < 5)
		return pos;
	*pos = 0x00;
	if (hapd->conf->tdls & TDLS_PROHIBIT)
		*pos |= 0x40; /* Bit 38 - TDLS Prohibited */
	if (hapd->conf->tdls & TDLS_PROHIBIT_CHAN_SWITCH)
		*pos |= 0x80; /* Bit 39 - TDLS Channel Switching Prohibited */
	pos++;

	if (len < 6)
		return pos;
	*pos = 0x00;
	pos++;

	if (len < 7)
		return pos;
	*pos = 0x00;
	if (hapd->conf->ssid.utf8_ssid)
		*pos |= 0x01; /* Bit 48 - UTF-8 SSID */
	pos++;

	return pos;
}


u8 * hostapd_eid_interworking(struct hostapd_data *hapd, u8 *eid)
{
	u8 *pos = eid;
#ifdef CONFIG_INTERWORKING
	u8 *len;

	if (!hapd->conf->interworking)
		return eid;

	*pos++ = WLAN_EID_INTERWORKING;
	len = pos++;

	*pos = hapd->conf->access_network_type;
	if (hapd->conf->internet)
		*pos |= INTERWORKING_ANO_INTERNET;
	if (hapd->conf->asra)
		*pos |= INTERWORKING_ANO_ASRA;
	if (hapd->conf->esr)
		*pos |= INTERWORKING_ANO_ESR;
	if (hapd->conf->uesa)
		*pos |= INTERWORKING_ANO_UESA;
	pos++;

	if (hapd->conf->venue_info_set) {
		*pos++ = hapd->conf->venue_group;
		*pos++ = hapd->conf->venue_type;
	}

	if (!is_zero_ether_addr(hapd->conf->hessid)) {
		os_memcpy(pos, hapd->conf->hessid, ETH_ALEN);
		pos += ETH_ALEN;
	}

	*len = pos - len - 1;
#endif /* CONFIG_INTERWORKING */

	return pos;
}


u8 * hostapd_eid_adv_proto(struct hostapd_data *hapd, u8 *eid)
{
	u8 *pos = eid;
#ifdef CONFIG_INTERWORKING

	/* TODO: Separate configuration for ANQP? */
	if (!hapd->conf->interworking)
		return eid;

	*pos++ = WLAN_EID_ADV_PROTO;
	*pos++ = 2;
	*pos++ = 0x7F; /* Query Response Length Limit | PAME-BI */
	*pos++ = ACCESS_NETWORK_QUERY_PROTOCOL;
#endif /* CONFIG_INTERWORKING */

	return pos;
}


u8 * hostapd_eid_roaming_consortium(struct hostapd_data *hapd, u8 *eid)
{
	u8 *pos = eid;
#ifdef CONFIG_INTERWORKING
	u8 *len;
	unsigned int i, count;

	if (!hapd->conf->interworking ||
	    hapd->conf->roaming_consortium == NULL ||
	    hapd->conf->roaming_consortium_count == 0)
		return eid;

	*pos++ = WLAN_EID_ROAMING_CONSORTIUM;
	len = pos++;

	/* Number of ANQP OIs (in addition to the max 3 listed here) */
	if (hapd->conf->roaming_consortium_count > 3 + 255)
		*pos++ = 255;
	else if (hapd->conf->roaming_consortium_count > 3)
		*pos++ = hapd->conf->roaming_consortium_count - 3;
	else
		*pos++ = 0;

	/* OU #1 and #2 Lengths */
	*pos = hapd->conf->roaming_consortium[0].len;
	if (hapd->conf->roaming_consortium_count > 1)
		*pos |= hapd->conf->roaming_consortium[1].len << 4;
	pos++;

	if (hapd->conf->roaming_consortium_count > 3)
		count = 3;
	else
		count = hapd->conf->roaming_consortium_count;

	for (i = 0; i < count; i++) {
		os_memcpy(pos, hapd->conf->roaming_consortium[i].oi,
			  hapd->conf->roaming_consortium[i].len);
		pos += hapd->conf->roaming_consortium[i].len;
	}

	*len = pos - len - 1;
#endif /* CONFIG_INTERWORKING */

	return pos;
}


u8 * hostapd_eid_time_adv(struct hostapd_data *hapd, u8 *eid)
{
	if (hapd->conf->time_advertisement != 2)
		return eid;

	if (hapd->time_adv == NULL &&
	    hostapd_update_time_adv(hapd) < 0)
		return eid;

	if (hapd->time_adv == NULL)
		return eid;

	os_memcpy(eid, wpabuf_head(hapd->time_adv),
		  wpabuf_len(hapd->time_adv));
	eid += wpabuf_len(hapd->time_adv);

	return eid;
}


u8 * hostapd_eid_time_zone(struct hostapd_data *hapd, u8 *eid)
{
	size_t len;

	if (hapd->conf->time_advertisement != 2)
		return eid;

	len = os_strlen(hapd->conf->time_zone);

	*eid++ = WLAN_EID_TIME_ZONE;
	*eid++ = len;
	os_memcpy(eid, hapd->conf->time_zone, len);
	eid += len;

	return eid;
}


int hostapd_update_time_adv(struct hostapd_data *hapd)
{
	const int elen = 2 + 1 + 10 + 5 + 1;
	struct os_time t;
	struct os_tm tm;
	u8 *pos;

	if (hapd->conf->time_advertisement != 2)
		return 0;

	if (os_get_time(&t) < 0 || os_gmtime(t.sec, &tm) < 0)
		return -1;

	if (!hapd->time_adv) {
		hapd->time_adv = wpabuf_alloc(elen);
		if (hapd->time_adv == NULL)
			return -1;
		pos = wpabuf_put(hapd->time_adv, elen);
	} else
		pos = wpabuf_mhead_u8(hapd->time_adv);

	*pos++ = WLAN_EID_TIME_ADVERTISEMENT;
	*pos++ = 1 + 10 + 5 + 1;

	*pos++ = 2; /* UTC time at which the TSF timer is 0 */

	/* Time Value at TSF 0 */
	/* FIX: need to calculate this based on the current TSF value */
	WPA_PUT_LE16(pos, tm.year); /* Year */
	pos += 2;
	*pos++ = tm.month; /* Month */
	*pos++ = tm.day; /* Day of month */
	*pos++ = tm.hour; /* Hours */
	*pos++ = tm.min; /* Minutes */
	*pos++ = tm.sec; /* Seconds */
	WPA_PUT_LE16(pos, 0); /* Milliseconds (not used) */
	pos += 2;
	*pos++ = 0; /* Reserved */

	/* Time Error */
	/* TODO: fill in an estimate on the error */
	*pos++ = 0;
	*pos++ = 0;
	*pos++ = 0;
	*pos++ = 0;
	*pos++ = 0;

	*pos++ = hapd->time_update_counter++;

	return 0;
}


u8 * hostapd_eid_bss_max_idle_period(struct hostapd_data *hapd, u8 *eid)
{
	u8 *pos = eid;

#ifdef CONFIG_WNM
	if (hapd->conf->ap_max_inactivity > 0) {
		unsigned int val;
		*pos++ = WLAN_EID_BSS_MAX_IDLE_PERIOD;
		*pos++ = 3;
		val = hapd->conf->ap_max_inactivity;
		if (val > 68000)
			val = 68000;
		val *= 1000;
		val /= 1024;
		if (val == 0)
			val = 1;
		if (val > 65535)
			val = 65535;
		WPA_PUT_LE16(pos, val);
		pos += 2;
		*pos++ = 0x00; /* TODO: Protected Keep-Alive Required */
	}
#endif /* CONFIG_WNM */

	return pos;
}
Commit	Line	Data
d4370eac MP	1	/*
d4370eac MP	2	* hostapd / IEEE 802.11 Management
b6668734	3	* Copyright (c) 2002-2012, Jouni Malinen <j@w1.fi>
d4370eac	4	*
0f3d578e JM	5	* This software may be distributed under the terms of the BSD license.
0f3d578e JM	6	* See README for more details.
d4370eac MP	7	*/
	8
	9	#include "utils/includes.h"
	10
	11	#include "utils/common.h"
	12	#include "common/ieee802_11_defs.h"
	13	#include "hostapd.h"
	14	#include "sta_info.h"
	15	#include "ap_config.h"
	16	#include "ap_drv_ops.h"
39b97072	17	#include "ieee802_11.h"
d4370eac MP	18
	19
	20	#ifdef CONFIG_IEEE80211W
	21
	22	u8 * hostapd_eid_assoc_comeback_time(struct hostapd_data *hapd,
	23	struct sta_info sta, u8 eid)
	24	{
	25	u8 *pos = eid;
	26	u32 timeout, tu;
	27	struct os_time now, passed;
	28
	29	*pos++ = WLAN_EID_TIMEOUT_INTERVAL;
	30	*pos++ = 5;
	31	*pos++ = WLAN_TIMEOUT_ASSOC_COMEBACK;
	32	os_get_time(&now);
	33	os_time_sub(&now, &sta->sa_query_start, &passed);
	34	tu = (passed.sec * 1000000 + passed.usec) / 1024;
	35	if (hapd->conf->assoc_sa_query_max_timeout > tu)
	36	timeout = hapd->conf->assoc_sa_query_max_timeout - tu;
	37	else
	38	timeout = 0;
	39	if (timeout < hapd->conf->assoc_sa_query_max_timeout)
	40	timeout++; /* add some extra time for local timers */
	41	WPA_PUT_LE32(pos, timeout);
	42	pos += 4;
	43
	44	return pos;
	45	}
	46
	47
	48	/* MLME-SAQuery.request */
	49	void ieee802_11_send_sa_query_req(struct hostapd_data *hapd,
	50	const u8 addr, const u8 trans_id)
	51	{
	52	struct ieee80211_mgmt mgmt;
	53	u8 *end;
	54
	55	wpa_printf(MSG_DEBUG, "IEEE 802.11: Sending SA Query Request to "
	56	MACSTR, MAC2STR(addr));
	57	wpa_hexdump(MSG_DEBUG, "IEEE 802.11: SA Query Transaction ID",
	58	trans_id, WLAN_SA_QUERY_TR_ID_LEN);
	59
	60	os_memset(&mgmt, 0, sizeof(mgmt));
	61	mgmt.frame_control = IEEE80211_FC(WLAN_FC_TYPE_MGMT,
	62	WLAN_FC_STYPE_ACTION);
	63	os_memcpy(mgmt.da, addr, ETH_ALEN);
	64	os_memcpy(mgmt.sa, hapd->own_addr, ETH_ALEN);
	65	os_memcpy(mgmt.bssid, hapd->own_addr, ETH_ALEN);
	66	mgmt.u.action.category = WLAN_ACTION_SA_QUERY;
	67	mgmt.u.action.u.sa_query_req.action = WLAN_SA_QUERY_REQUEST;
	68	os_memcpy(mgmt.u.action.u.sa_query_req.trans_id, trans_id,
	69	WLAN_SA_QUERY_TR_ID_LEN);
	70	end = mgmt.u.action.u.sa_query_req.trans_id + WLAN_SA_QUERY_TR_ID_LEN;
8cfa3527	71	if (hostapd_drv_send_mlme(hapd, &mgmt, end - (u8 *) &mgmt, 0) < 0)
d4370eac MP	72	perror("ieee802_11_send_sa_query_req: send");
	73	}
	74
	75
19df9b07 JM	76	static void ieee802_11_send_sa_query_resp(struct hostapd_data *hapd,
19df9b07 JM	77	const u8 sa, const u8 trans_id)
d4370eac MP	78	{
	79	struct sta_info *sta;
	80	struct ieee80211_mgmt resp;
	81	u8 *end;
	82
	83	wpa_printf(MSG_DEBUG, "IEEE 802.11: Received SA Query Request from "
	84	MACSTR, MAC2STR(sa));
	85	wpa_hexdump(MSG_DEBUG, "IEEE 802.11: SA Query Transaction ID",
	86	trans_id, WLAN_SA_QUERY_TR_ID_LEN);
	87
	88	sta = ap_get_sta(hapd, sa);
	89	if (sta == NULL \|\| !(sta->flags & WLAN_STA_ASSOC)) {
	90	wpa_printf(MSG_DEBUG, "IEEE 802.11: Ignore SA Query Request "
	91	"from unassociated STA " MACSTR, MAC2STR(sa));
	92	return;
	93	}
	94
	95	wpa_printf(MSG_DEBUG, "IEEE 802.11: Sending SA Query Response to "
	96	MACSTR, MAC2STR(sa));
	97
	98	os_memset(&resp, 0, sizeof(resp));
	99	resp.frame_control = IEEE80211_FC(WLAN_FC_TYPE_MGMT,
	100	WLAN_FC_STYPE_ACTION);
	101	os_memcpy(resp.da, sa, ETH_ALEN);
	102	os_memcpy(resp.sa, hapd->own_addr, ETH_ALEN);
	103	os_memcpy(resp.bssid, hapd->own_addr, ETH_ALEN);
	104	resp.u.action.category = WLAN_ACTION_SA_QUERY;
	105	resp.u.action.u.sa_query_req.action = WLAN_SA_QUERY_RESPONSE;
	106	os_memcpy(resp.u.action.u.sa_query_req.trans_id, trans_id,
	107	WLAN_SA_QUERY_TR_ID_LEN);
	108	end = resp.u.action.u.sa_query_req.trans_id + WLAN_SA_QUERY_TR_ID_LEN;
8cfa3527	109	if (hostapd_drv_send_mlme(hapd, &resp, end - (u8 *) &resp, 0) < 0)
d4370eac MP	110	perror("ieee80211_mgmt_sa_query_request: send");
	111	}
	112
	113
	114	void ieee802_11_sa_query_action(struct hostapd_data hapd, const u8 sa,
	115	const u8 action_type, const u8 *trans_id)
	116	{
	117	struct sta_info *sta;
	118	int i;
	119
	120	if (action_type == WLAN_SA_QUERY_REQUEST) {
	121	ieee802_11_send_sa_query_resp(hapd, sa, trans_id);
	122	return;
	123	}
	124
	125	if (action_type != WLAN_SA_QUERY_RESPONSE) {
	126	wpa_printf(MSG_DEBUG, "IEEE 802.11: Unexpected SA Query "
	127	"Action %d", action_type);
	128	return;
	129	}
	130
	131	wpa_printf(MSG_DEBUG, "IEEE 802.11: Received SA Query Response from "
	132	MACSTR, MAC2STR(sa));
	133	wpa_hexdump(MSG_DEBUG, "IEEE 802.11: SA Query Transaction ID",
	134	trans_id, WLAN_SA_QUERY_TR_ID_LEN);
	135
	136	/* MLME-SAQuery.confirm */
	137
	138	sta = ap_get_sta(hapd, sa);
	139	if (sta == NULL \|\| sta->sa_query_trans_id == NULL) {
	140	wpa_printf(MSG_DEBUG, "IEEE 802.11: No matching STA with "
	141	"pending SA Query request found");
	142	return;
	143	}
	144
	145	for (i = 0; i < sta->sa_query_count; i++) {
	146	if (os_memcmp(sta->sa_query_trans_id +
	147	i * WLAN_SA_QUERY_TR_ID_LEN,
	148	trans_id, WLAN_SA_QUERY_TR_ID_LEN) == 0)
	149	break;
	150	}
	151
	152	if (i >= sta->sa_query_count) {
	153	wpa_printf(MSG_DEBUG, "IEEE 802.11: No matching SA Query "
	154	"transaction identifier found");
	155	return;
	156	}
	157
	158	hostapd_logger(hapd, sta->addr, HOSTAPD_MODULE_IEEE80211,
	159	HOSTAPD_LEVEL_DEBUG,
	160	"Reply to pending SA Query received");
	161	ap_sta_stop_sa_query(hapd, sta);
	162	}
	163
	164	#endif /* CONFIG_IEEE80211W */
06c4d247 JM	165
	166
	167	u8 * hostapd_eid_ext_capab(struct hostapd_data hapd, u8 eid)
	168	{
	169	u8 *pos = eid;
	170	u8 len = 0;
	171
	172	if (hapd->conf->tdls & (TDLS_PROHIBIT \| TDLS_PROHIBIT_CHAN_SWITCH))
	173	len = 5;
	174	if (len < 4 && hapd->conf->interworking)
	175	len = 4;
c79938a5 JM	176	if (len < 3 && hapd->conf->wnm_sleep_mode)
c79938a5 JM	177	len = 3;
b93c8509 JM	178	if (len < 7 && hapd->conf->ssid.utf8_ssid)
b93c8509 JM	179	len = 7;
0a66ce3c JM	180	#ifdef CONFIG_WNM
	181	if (len < 4)
	182	len = 4;
	183	#endif /* CONFIG_WNM */
06c4d247 JM	184	if (len == 0)
	185	return eid;
	186
	187	*pos++ = WLAN_EID_EXT_CAPAB;
	188	*pos++ = len;
	189	*pos++ = 0x00;
	190	*pos++ = 0x00;
06c4d247	191
c79938a5 JM	192	*pos = 0x00;
	193	if (hapd->conf->wnm_sleep_mode)
	194	pos \|= 0x02; / Bit 17 - WNM-Sleep Mode */
2049a875 JM	195	if (hapd->conf->bss_transition)
2049a875 JM	196	pos \|= 0x08; / Bit 19 - BSS Transition */
c79938a5 JM	197	pos++;
	198
	199	if (len < 4)
	200	return pos;
06c4d247	201	*pos = 0x00;
0a66ce3c JM	202	#ifdef CONFIG_WNM
	203	pos \|= 0x02; / Bit 25 - SSID List */
	204	#endif /* CONFIG_WNM */
39b97072 JM	205	if (hapd->conf->time_advertisement == 2)
39b97072 JM	206	pos \|= 0x08; / Bit 27 - UTC TSF Offset */
06c4d247 JM	207	if (hapd->conf->interworking)
	208	pos \|= 0x80; / Bit 31 - Interworking */
	209	pos++;
	210
	211	if (len < 5)
	212	return pos;
	213	*pos = 0x00;
	214	if (hapd->conf->tdls & TDLS_PROHIBIT)
	215	pos \|= 0x40; / Bit 38 - TDLS Prohibited */
	216	if (hapd->conf->tdls & TDLS_PROHIBIT_CHAN_SWITCH)
	217	pos \|= 0x80; / Bit 39 - TDLS Channel Switching Prohibited */
	218	pos++;
	219
b93c8509 JM	220	if (len < 6)
	221	return pos;
	222	*pos = 0x00;
	223	pos++;
	224
	225	if (len < 7)
	226	return pos;
	227	*pos = 0x00;
	228	if (hapd->conf->ssid.utf8_ssid)
	229	pos \|= 0x01; / Bit 48 - UTF-8 SSID */
	230	pos++;
	231
06c4d247 JM	232	return pos;
	233	}
	234
	235
	236	u8 * hostapd_eid_interworking(struct hostapd_data hapd, u8 eid)
	237	{
	238	u8 *pos = eid;
	239	#ifdef CONFIG_INTERWORKING
	240	u8 *len;
	241
	242	if (!hapd->conf->interworking)
	243	return eid;
	244
	245	*pos++ = WLAN_EID_INTERWORKING;
	246	len = pos++;
	247
	248	*pos = hapd->conf->access_network_type;
	249	if (hapd->conf->internet)
	250	*pos \|= INTERWORKING_ANO_INTERNET;
	251	if (hapd->conf->asra)
	252	*pos \|= INTERWORKING_ANO_ASRA;
	253	if (hapd->conf->esr)
	254	*pos \|= INTERWORKING_ANO_ESR;
	255	if (hapd->conf->uesa)
	256	*pos \|= INTERWORKING_ANO_UESA;
	257	pos++;
	258
	259	if (hapd->conf->venue_info_set) {
	260	*pos++ = hapd->conf->venue_group;
	261	*pos++ = hapd->conf->venue_type;
	262	}
	263
	264	if (!is_zero_ether_addr(hapd->conf->hessid)) {
	265	os_memcpy(pos, hapd->conf->hessid, ETH_ALEN);
	266	pos += ETH_ALEN;
	267	}
	268
	269	*len = pos - len - 1;
	270	#endif /* CONFIG_INTERWORKING */
	271
	272	return pos;
	273	}
c7c178e1 JM	274
	275
	276	u8 * hostapd_eid_adv_proto(struct hostapd_data hapd, u8 eid)
	277	{
	278	u8 *pos = eid;
	279	#ifdef CONFIG_INTERWORKING
	280
	281	/* TODO: Separate configuration for ANQP? */
	282	if (!hapd->conf->interworking)
	283	return eid;
	284
	285	*pos++ = WLAN_EID_ADV_PROTO;
	286	*pos++ = 2;
1d21e9dd	287	pos++ = 0x7F; / Query Response Length Limit \| PAME-BI */
c7c178e1 JM	288	*pos++ = ACCESS_NETWORK_QUERY_PROTOCOL;
	289	#endif /* CONFIG_INTERWORKING */
	290
	291	return pos;
	292	}
4b2a77ab JM	293
	294
	295	u8 * hostapd_eid_roaming_consortium(struct hostapd_data hapd, u8 eid)
	296	{
	297	u8 *pos = eid;
	298	#ifdef CONFIG_INTERWORKING
	299	u8 *len;
	300	unsigned int i, count;
	301
	302	if (!hapd->conf->interworking \|\|
	303	hapd->conf->roaming_consortium == NULL \|\|
	304	hapd->conf->roaming_consortium_count == 0)
	305	return eid;
	306
	307	*pos++ = WLAN_EID_ROAMING_CONSORTIUM;
	308	len = pos++;
	309
	310	/* Number of ANQP OIs (in addition to the max 3 listed here) */
	311	if (hapd->conf->roaming_consortium_count > 3 + 255)
	312	*pos++ = 255;
	313	else if (hapd->conf->roaming_consortium_count > 3)
	314	*pos++ = hapd->conf->roaming_consortium_count - 3;
	315	else
	316	*pos++ = 0;
	317
	318	/* OU #1 and #2 Lengths */
	319	*pos = hapd->conf->roaming_consortium[0].len;
	320	if (hapd->conf->roaming_consortium_count > 1)
	321	*pos \|= hapd->conf->roaming_consortium[1].len << 4;
	322	pos++;
	323
	324	if (hapd->conf->roaming_consortium_count > 3)
	325	count = 3;
	326	else
	327	count = hapd->conf->roaming_consortium_count;
	328
	329	for (i = 0; i < count; i++) {
	330	os_memcpy(pos, hapd->conf->roaming_consortium[i].oi,
	331	hapd->conf->roaming_consortium[i].len);
	332	pos += hapd->conf->roaming_consortium[i].len;
	333	}
	334
	335	*len = pos - len - 1;
	336	#endif /* CONFIG_INTERWORKING */
	337
	338	return pos;
	339	}
39b97072 JM	340
	341
	342	u8 * hostapd_eid_time_adv(struct hostapd_data hapd, u8 eid)
	343	{
	344	if (hapd->conf->time_advertisement != 2)
	345	return eid;
	346
	347	if (hapd->time_adv == NULL &&
	348	hostapd_update_time_adv(hapd) < 0)
	349	return eid;
	350
4c8a333b JM	351	if (hapd->time_adv == NULL)
	352	return eid;
	353
39b97072 JM	354	os_memcpy(eid, wpabuf_head(hapd->time_adv),
	355	wpabuf_len(hapd->time_adv));
	356	eid += wpabuf_len(hapd->time_adv);
	357
	358	return eid;
	359	}
	360
	361
	362	u8 * hostapd_eid_time_zone(struct hostapd_data hapd, u8 eid)
	363	{
	364	size_t len;
	365
	366	if (hapd->conf->time_advertisement != 2)
	367	return eid;
	368
	369	len = os_strlen(hapd->conf->time_zone);
	370
	371	*eid++ = WLAN_EID_TIME_ZONE;
	372	*eid++ = len;
	373	os_memcpy(eid, hapd->conf->time_zone, len);
	374	eid += len;
	375
	376	return eid;
	377	}
	378
	379
	380	int hostapd_update_time_adv(struct hostapd_data *hapd)
	381	{
	382	const int elen = 2 + 1 + 10 + 5 + 1;
	383	struct os_time t;
	384	struct os_tm tm;
	385	u8 *pos;
	386
	387	if (hapd->conf->time_advertisement != 2)
	388	return 0;
	389
	390	if (os_get_time(&t) < 0 \|\| os_gmtime(t.sec, &tm) < 0)
	391	return -1;
	392
	393	if (!hapd->time_adv) {
	394	hapd->time_adv = wpabuf_alloc(elen);
	395	if (hapd->time_adv == NULL)
	396	return -1;
	397	pos = wpabuf_put(hapd->time_adv, elen);
	398	} else
	399	pos = wpabuf_mhead_u8(hapd->time_adv);
	400
	401	*pos++ = WLAN_EID_TIME_ADVERTISEMENT;
	402	*pos++ = 1 + 10 + 5 + 1;
	403
	404	pos++ = 2; / UTC time at which the TSF timer is 0 */
	405
	406	/* Time Value at TSF 0 */
	407	/* FIX: need to calculate this based on the current TSF value */
	408	WPA_PUT_LE16(pos, tm.year); /* Year */
	409	pos += 2;
	410	pos++ = tm.month; / Month */
	411	pos++ = tm.day; / Day of month */
	412	pos++ = tm.hour; / Hours */
	413	pos++ = tm.min; / Minutes */
	414	pos++ = tm.sec; / Seconds */
	415	WPA_PUT_LE16(pos, 0); /* Milliseconds (not used) */
	416	pos += 2;
	417	pos++ = 0; / Reserved */
418
419	/* Time Error */
420	/* TODO: fill in an estimate on the error */
421	*pos++ = 0;
422	*pos++ = 0;
423	*pos++ = 0;
424	*pos++ = 0;
425	*pos++ = 0;
426
427	*pos++ = hapd->time_update_counter++;
428
429	return 0;
430	}
b6668734 JM	431
	432
	433	u8 * hostapd_eid_bss_max_idle_period(struct hostapd_data hapd, u8 eid)
	434	{
	435	u8 *pos = eid;
	436
	437	#ifdef CONFIG_WNM
	438	if (hapd->conf->ap_max_inactivity > 0) {
	439	unsigned int val;
	440	*pos++ = WLAN_EID_BSS_MAX_IDLE_PERIOD;
	441	*pos++ = 3;
	442	val = hapd->conf->ap_max_inactivity;
	443	if (val > 68000)
	444	val = 68000;
	445	val *= 1000;
	446	val /= 1024;
	447	if (val == 0)
	448	val = 1;
	449	if (val > 65535)
	450	val = 65535;
	451	WPA_PUT_LE16(pos, val);
	452	pos += 2;
	453	pos++ = 0x00; / TODO: Protected Keep-Alive Required */
	454	}
	455	#endif /* CONFIG_WNM */
	456
	457	return pos;
	458	}