ieee80211_tdma.c revision 188925
1/*-
2 * Copyright (c) 2007-2009 Sam Leffler, Errno Consulting
3 * Copyright (c) 2007-2009 Intel Corporation
4 * All rights reserved.
5 *
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions
8 * are met:
9 * 1. Redistributions of source code must retain the above copyright
10 *    notice, this list of conditions and the following disclaimer.
11 * 2. Redistributions in binary form must reproduce the above copyright
12 *    notice, this list of conditions and the following disclaimer in the
13 *    documentation and/or other materials provided with the distribution.
14 *
15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
16 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
17 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
18 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
19 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
20 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
21 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
22 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
23 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
24 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
25 */
26
27#include <sys/cdefs.h>
28#ifdef __FreeBSD__
29__FBSDID("$FreeBSD: head/sys/net80211/ieee80211_tdma.c 188925 2009-02-22 18:48:54Z sam $");
30#endif
31
32/*
33 * IEEE 802.11 TDMA mode support.
34 */
35#include "opt_inet.h"
36#include "opt_wlan.h"
37
38#ifdef IEEE80211_SUPPORT_TDMA
39#include <sys/param.h>
40#include <sys/systm.h>
41#include <sys/mbuf.h>
42#include <sys/malloc.h>
43#include <sys/kernel.h>
44
45#include <sys/socket.h>
46#include <sys/sockio.h>
47#include <sys/endian.h>
48#include <sys/errno.h>
49#include <sys/proc.h>
50#include <sys/sysctl.h>
51
52#include <net/if.h>
53#include <net/if_media.h>
54#include <net/if_llc.h>
55#include <net/ethernet.h>
56
57#include <net/bpf.h>
58
59#include <net80211/ieee80211_var.h>
60#include <net80211/ieee80211_tdma.h>
61#include <net80211/ieee80211_input.h>
62
63#include "opt_tdma.h"
64#ifndef TDMA_SLOTLEN_DEFAULT
65#define	TDMA_SLOTLEN_DEFAULT	10*1000		/* 10ms */
66#endif
67#ifndef TDMA_SLOTCNT_DEFAULT
68#define	TDMA_SLOTCNT_DEFAULT	2		/* 2x (pt-to-pt) */
69#endif
70#ifndef TDMA_BINTVAL_DEFAULT
71#define	TDMA_BINTVAL_DEFAULT	5		/* 5x ~= 100TU beacon intvl */
72#endif
73#ifndef TDMA_TXRATE_11B_DEFAULT
74#define	TDMA_TXRATE_11B_DEFAULT	2*11
75#endif
76#ifndef TDMA_TXRATE_11G_DEFAULT
77#define	TDMA_TXRATE_11G_DEFAULT	2*24
78#endif
79#ifndef TDMA_TXRATE_11A_DEFAULT
80#define	TDMA_TXRATE_11A_DEFAULT	2*24
81#endif
82#ifndef TDMA_TXRATE_STURBO_A_DEFAULT
83#define	TDMA_TXRATE_STURBO_A_DEFAULT	2*24
84#endif
85#ifndef TDMA_TXRATE_HALF_DEFAULT
86#define	TDMA_TXRATE_HALF_DEFAULT	2*12
87#endif
88#ifndef TDMA_TXRATE_QUARTER_DEFAULT
89#define	TDMA_TXRATE_QUARTER_DEFAULT	2*6
90#endif
91#ifndef TDMA_TXRATE_11NA_DEFAULT
92#define	TDMA_TXRATE_11NA_DEFAULT	(4 | IEEE80211_RATE_MCS)
93#endif
94#ifndef TDMA_TXRATE_11NG_DEFAULT
95#define	TDMA_TXRATE_11NG_DEFAULT	(4 | IEEE80211_RATE_MCS)
96#endif
97
98static void tdma_vdetach(struct ieee80211vap *vap);
99static int tdma_newstate(struct ieee80211vap *, enum ieee80211_state, int);
100static void tdma_beacon_miss(struct ieee80211vap *vap);
101static void tdma_recv_mgmt(struct ieee80211_node *, struct mbuf *,
102	int subtype, int rssi, int noise, uint32_t rstamp);
103static int tdma_update(struct ieee80211vap *vap,
104	const struct ieee80211_tdma_param *tdma, struct ieee80211_node *ni,
105	int pickslot);
106static int tdma_process_params(struct ieee80211_node *ni,
107	const u_int8_t *ie, u_int32_t rstamp, const struct ieee80211_frame *wh);
108
109static void
110settxparms(struct ieee80211vap *vap, enum ieee80211_phymode mode, int rate)
111{
112	vap->iv_txparms[mode].ucastrate = rate;
113	vap->iv_txparms[mode].mcastrate = rate;
114}
115
116static void
117setackpolicy(struct ieee80211com *ic, int noack)
118{
119	struct ieee80211_wme_state *wme = &ic->ic_wme;
120	int ac;
121
122	for (ac = 0; ac < WME_NUM_AC; ac++) {
123		wme->wme_chanParams.cap_wmeParams[ac].wmep_noackPolicy = noack;
124		wme->wme_wmeChanParams.cap_wmeParams[ac].wmep_noackPolicy = noack;
125	}
126}
127
128void
129ieee80211_tdma_vattach(struct ieee80211vap *vap)
130{
131	struct ieee80211_tdma_state *ts;
132
133	KASSERT(vap->iv_caps & IEEE80211_C_TDMA,
134	     ("not a tdma vap, caps 0x%x", vap->iv_caps));
135
136	ts = (struct ieee80211_tdma_state *) malloc(
137	     sizeof(struct ieee80211_tdma_state), M_80211_VAP, M_NOWAIT | M_ZERO);
138	if (ts == NULL) {
139		printf("%s: cannot allocate TDMA state block\n", __func__);
140		/* NB: fall back to adhdemo mode */
141		vap->iv_caps &= ~IEEE80211_C_TDMA;
142		return;
143	}
144	/* NB: default configuration is passive so no beacons */
145	ts->tdma_slotlen = TDMA_SLOTLEN_DEFAULT;
146	ts->tdma_slotcnt = TDMA_SLOTCNT_DEFAULT;
147	ts->tdma_bintval = TDMA_BINTVAL_DEFAULT;
148	ts->tdma_slot = 1;			/* passive operation */
149
150	/* setup default fixed rates */
151	settxparms(vap, IEEE80211_MODE_11A, TDMA_TXRATE_11A_DEFAULT);
152	settxparms(vap, IEEE80211_MODE_11B, TDMA_TXRATE_11B_DEFAULT);
153	settxparms(vap, IEEE80211_MODE_11G, TDMA_TXRATE_11G_DEFAULT);
154	settxparms(vap, IEEE80211_MODE_STURBO_A, TDMA_TXRATE_STURBO_A_DEFAULT);
155	settxparms(vap, IEEE80211_MODE_11NA, TDMA_TXRATE_11NA_DEFAULT);
156	settxparms(vap, IEEE80211_MODE_11NG, TDMA_TXRATE_11NG_DEFAULT);
157	settxparms(vap, IEEE80211_MODE_HALF, TDMA_TXRATE_HALF_DEFAULT);
158	settxparms(vap, IEEE80211_MODE_QUARTER, TDMA_TXRATE_QUARTER_DEFAULT);
159
160	setackpolicy(vap->iv_ic, 1);	/* disable ACK's */
161
162	ts->tdma_opdetach = vap->iv_opdetach;
163	vap->iv_opdetach = tdma_vdetach;
164	ts->tdma_newstate = vap->iv_newstate;
165	vap->iv_newstate = tdma_newstate;
166	vap->iv_bmiss = tdma_beacon_miss;
167	ts->tdma_recv_mgmt = vap->iv_recv_mgmt;
168	vap->iv_recv_mgmt = tdma_recv_mgmt;
169
170	vap->iv_tdma = ts;
171}
172
173static void
174tdma_vdetach(struct ieee80211vap *vap)
175{
176	struct ieee80211_tdma_state *ts = vap->iv_tdma;
177
178	ts->tdma_opdetach(vap);
179	free(vap->iv_tdma, M_80211_VAP);
180
181	setackpolicy(vap->iv_ic, 0);	/* enable ACK's */
182}
183
184static void
185sta_leave(void *arg, struct ieee80211_node *ni)
186{
187	struct ieee80211vap *vap = arg;
188
189	if (ni->ni_vap == vap && ni != vap->iv_bss)
190		ieee80211_node_leave(ni);
191}
192
193/*
194 * TDMA state machine handler.
195 */
196static int
197tdma_newstate(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg)
198{
199	struct ieee80211_tdma_state *ts = vap->iv_tdma;
200	struct ieee80211com *ic = vap->iv_ic;
201	enum ieee80211_state ostate;
202	int status;
203
204	IEEE80211_LOCK_ASSERT(ic);
205
206	ostate = vap->iv_state;
207	IEEE80211_DPRINTF(vap, IEEE80211_MSG_STATE, "%s: %s -> %s (%d)\n",
208	    __func__, ieee80211_state_name[ostate],
209	    ieee80211_state_name[nstate], arg);
210
211	if (vap->iv_flags_ext & IEEE80211_FEXT_SWBMISS)
212		callout_stop(&vap->iv_swbmiss);
213	if (nstate == IEEE80211_S_SCAN &&
214	    (ostate == IEEE80211_S_INIT || ostate == IEEE80211_S_RUN) &&
215	    ts->tdma_slot != 0) {
216		/*
217		 * Override adhoc behaviour when operating as a slave;
218		 * we need to scan even if the channel is locked.
219		 */
220		vap->iv_state = nstate;			/* state transition */
221		ieee80211_cancel_scan(vap);		/* background scan */
222		if (ostate == IEEE80211_S_RUN) {
223			/* purge station table; entries are stale */
224			ieee80211_iterate_nodes(&ic->ic_sta, sta_leave, vap);
225		}
226		if (vap->iv_flags_ext & IEEE80211_FEXT_SCANREQ) {
227			ieee80211_check_scan(vap,
228			    vap->iv_scanreq_flags,
229			    vap->iv_scanreq_duration,
230			    vap->iv_scanreq_mindwell,
231			    vap->iv_scanreq_maxdwell,
232			    vap->iv_scanreq_nssid, vap->iv_scanreq_ssid);
233			vap->iv_flags_ext &= ~IEEE80211_FEXT_SCANREQ;
234		} else
235			ieee80211_check_scan_current(vap);
236		status = 0;
237	} else {
238		status = ts->tdma_newstate(vap, nstate, arg);
239	}
240	if (status == 0 &&
241	    nstate == IEEE80211_S_RUN && ostate != IEEE80211_S_RUN &&
242	    (vap->iv_flags_ext & IEEE80211_FEXT_SWBMISS) &&
243	    ts->tdma_slot != 0 &&
244	    vap->iv_des_chan == IEEE80211_CHAN_ANYC) {
245		/*
246		 * Start s/w beacon miss timer for slave devices w/o
247		 * hardware support.  Note we do this only if we're
248		 * not locked to a channel (i.e. roam to follow the
249		 * master). The 2x is a fudge for our doing this in
250		 * software.
251		 */
252		vap->iv_swbmiss_period = IEEE80211_TU_TO_TICKS(
253		    2 * vap->iv_bmissthreshold * ts->tdma_bintval *
254		    ((ts->tdma_slotcnt * ts->tdma_slotlen) / 1024));
255		vap->iv_swbmiss_count = 0;
256		callout_reset(&vap->iv_swbmiss, vap->iv_swbmiss_period,
257			ieee80211_swbmiss, vap);
258	}
259	return status;
260}
261
262static void
263tdma_beacon_miss(struct ieee80211vap *vap)
264{
265	struct ieee80211_tdma_state *ts = vap->iv_tdma;
266
267	KASSERT((vap->iv_ic->ic_flags & IEEE80211_F_SCAN) == 0, ("scanning"));
268	KASSERT(vap->iv_state == IEEE80211_S_RUN,
269	    ("wrong state %d", vap->iv_state));
270
271	IEEE80211_DPRINTF(vap,
272		IEEE80211_MSG_STATE | IEEE80211_MSG_TDMA | IEEE80211_MSG_DEBUG,
273		"beacon miss, mode %u state %s\n",
274		vap->iv_opmode, ieee80211_state_name[vap->iv_state]);
275
276	if (ts->tdma_peer != NULL) {	/* XXX? can this be null? */
277		ieee80211_notify_node_leave(vap->iv_bss);
278		ts->tdma_peer = NULL;
279		/*
280		 * Treat beacon miss like an associate failure wrt the
281		 * scan policy; this forces the entry in the scan cache
282		 * to be ignored after several tries.
283		 */
284		ieee80211_scan_assoc_fail(vap, vap->iv_bss->ni_macaddr,
285		    IEEE80211_STATUS_TIMEOUT);
286	}
287#if 0
288	ts->tdma_inuse = 0;		/* clear slot usage */
289#endif
290	ieee80211_new_state(vap, IEEE80211_S_SCAN, 0);
291}
292
293static void
294tdma_recv_mgmt(struct ieee80211_node *ni, struct mbuf *m0,
295	int subtype, int rssi, int noise, uint32_t rstamp)
296{
297	struct ieee80211com *ic = ni->ni_ic;
298	struct ieee80211vap *vap = ni->ni_vap;
299	struct ieee80211_tdma_state *ts = vap->iv_tdma;
300
301	if (subtype == IEEE80211_FC0_SUBTYPE_BEACON &&
302	    (ic->ic_flags & IEEE80211_F_SCAN) == 0) {
303		struct ieee80211_frame *wh = mtod(m0, struct ieee80211_frame *);
304		struct ieee80211_scanparams scan;
305
306		if (ieee80211_parse_beacon(ni, m0, &scan) != 0)
307			return;
308		if (scan.tdma == NULL) {
309			/*
310			 * TDMA stations must beacon a TDMA ie; ignore
311			 * any other station.
312			 * XXX detect overlapping bss and change channel
313			 */
314			IEEE80211_DISCARD(vap,
315			    IEEE80211_MSG_ELEMID | IEEE80211_MSG_INPUT,
316			    wh, ieee80211_mgt_subtype_name[subtype >>
317				IEEE80211_FC0_SUBTYPE_SHIFT],
318			    "%s", "no TDMA ie");
319			vap->iv_stats.is_rx_mgtdiscard++;
320			return;
321		}
322		if (ni == vap->iv_bss &&
323		    !IEEE80211_ADDR_EQ(wh->i_addr2, ni->ni_macaddr)) {
324			/*
325			 * Fake up a node for this newly
326			 * discovered member of the IBSS.
327			 */
328			ni = ieee80211_add_neighbor(vap, wh, &scan);
329			if (ni == NULL) {
330				/* NB: stat kept for alloc failure */
331				return;
332			}
333		}
334		/*
335		 * Check for state updates.
336		 */
337		if (IEEE80211_ADDR_EQ(wh->i_addr2, ni->ni_bssid)) {
338			/*
339			 * Count frame now that we know it's to be processed.
340			 */
341			vap->iv_stats.is_rx_beacon++;
342			IEEE80211_NODE_STAT(ni, rx_beacons);
343			/*
344			 * Record tsf of last beacon.  NB: this must be
345			 * done before calling tdma_process_params
346			 * as deeper routines reference it.
347			 */
348			memcpy(&ni->ni_tstamp.data, scan.tstamp,
349				sizeof(ni->ni_tstamp.data));
350			/*
351			 * Count beacon frame for s/w bmiss handling.
352			 */
353			vap->iv_swbmiss_count++;
354			/*
355			 * Process tdma ie.  The contents are used to sync
356			 * the slot timing, reconfigure the bss, etc.
357			 */
358			(void) tdma_process_params(ni, scan.tdma, rstamp, wh);
359			return;
360		}
361		/*
362		 * NB: defer remaining work to the adhoc code; this causes
363		 *     2x parsing of the frame but should happen infrequently
364		 */
365	}
366	ts->tdma_recv_mgmt(ni, m0, subtype, rssi, noise, rstamp);
367}
368
369/*
370 * Update TDMA state on receipt of a beacon frame with
371 * a TDMA information element.  The sender's identity
372 * is provided so we can track who our peer is.  If pickslot
373 * is non-zero we scan the slot allocation state in the ie
374 * locate a free slot for our use.
375 */
376static int
377tdma_update(struct ieee80211vap *vap, const struct ieee80211_tdma_param *tdma,
378	struct ieee80211_node *ni, int pickslot)
379{
380	struct ieee80211_tdma_state *ts = vap->iv_tdma;
381	int slotlen, slotcnt, slot, bintval;
382
383	KASSERT(vap->iv_caps & IEEE80211_C_TDMA,
384	     ("not a tdma vap, caps 0x%x", vap->iv_caps));
385
386	slotlen = le16toh(tdma->tdma_slotlen);
387	slotcnt = tdma->tdma_slotcnt;
388	bintval = tdma->tdma_bintval;
389
390	/* XXX rate-limit printf's */
391	if (!(2 <= slotcnt && slotcnt <= IEEE80211_TDMA_MAXSLOTS)) {
392		printf("%s: bogus slot cnt %u\n", __func__, slotcnt);
393		return 0;
394	}
395	/* XXX magic constants */
396	if (slotlen < 2 || slotlen > (0xfffff/100)) {
397		printf("%s: bogus slot len %u\n", __func__, slotlen);
398		return 0;
399	}
400	if (bintval < 1) {
401		printf("%s: bogus beacon interval %u\n", __func__, bintval);
402		return 0;
403	}
404	if (pickslot) {
405		/*
406		 * Pick unoccupied slot.  Note we never choose slot 0.
407		 */
408		for (slot = slotcnt-1; slot > 0; slot--)
409			if (isclr(tdma->tdma_inuse, slot))
410				break;
411		if (slot <= 0) {
412			printf("%s: no free slot, slotcnt %u inuse: 0x%x\n",
413				__func__, slotcnt, tdma->tdma_inuse[0]);
414			/* XXX need to do something better */
415			return 0;
416		}
417	} else
418		slot = ts->tdma_slot;
419
420	if (slotcnt != ts->tdma_slotcnt ||
421	    100*slotlen != ts->tdma_slotlen ||
422	    bintval != ts->tdma_bintval ||
423	    slot != ts->tdma_slot ||
424	    ts->tdma_peer != ni) {
425		/*
426		 * New/changed parameters; update runtime state.
427		 */
428		/* XXX overwrites user parameters */
429		ts->tdma_slotcnt = slotcnt;
430		ts->tdma_slotlen = 100*slotlen;
431		ts->tdma_slot = slot;
432		ts->tdma_bintval = bintval;
433		/* mark beacon to be updated before next xmit */
434		ieee80211_beacon_notify(vap, IEEE80211_BEACON_TDMA);
435
436		IEEE80211_DPRINTF(vap, IEEE80211_MSG_TDMA,
437		    "%s: slot %u slotcnt %u slotlen %u us bintval %u\n",
438		    __func__, slot, slotcnt, 100*slotlen, tdma->tdma_bintval);
439	}
440	/*
441	 * Notify driver.  Note we can be called before
442	 * entering RUN state if we scanned and are
443	 * joining an existing bss.  In that case do not
444	 * call the driver because not all necessary state
445	 * has been setup.  The next beacon will dtrt.
446	 */
447	if (vap->iv_state == IEEE80211_S_RUN)
448		vap->iv_ic->ic_tdma_update(ni, tdma);
449	/*
450	 * Dispatch join event on first beacon from new master.
451	 */
452	if (ts->tdma_peer != ni) {
453		if (ts->tdma_peer != NULL)
454			ieee80211_notify_node_leave(vap->iv_bss);
455		ieee80211_notify_node_join(ni, 1);
456		/* NB: no reference, we just use the address */
457		ts->tdma_peer = ni;
458	}
459	return 1;
460}
461
462/*
463 * Process received TDMA parameters.
464 */
465static int
466tdma_process_params(struct ieee80211_node *ni,
467	const u_int8_t *ie, u_int32_t rstamp, const struct ieee80211_frame *wh)
468{
469	struct ieee80211vap *vap = ni->ni_vap;
470	struct ieee80211_tdma_state *ts = vap->iv_tdma;
471	const struct ieee80211_tdma_param *tdma =
472		(const struct ieee80211_tdma_param *) ie;
473	u_int len = ie[1];
474
475	KASSERT(vap->iv_caps & IEEE80211_C_TDMA,
476	     ("not a tdma vap, caps 0x%x", vap->iv_caps));
477
478	if (len < sizeof(*tdma) - 2) {
479		IEEE80211_DISCARD_IE(vap,
480		    IEEE80211_MSG_ELEMID | IEEE80211_MSG_TDMA,
481		    wh, "tdma", "too short, len %u", len);
482		return IEEE80211_REASON_IE_INVALID;
483	}
484	if (tdma->tdma_version != TDMA_VERSION) {
485		IEEE80211_DISCARD_IE(vap,
486		    IEEE80211_MSG_ELEMID | IEEE80211_MSG_TDMA,
487		    wh, "tdma", "bad version %u", tdma->tdma_version);
488		return IEEE80211_REASON_IE_INVALID;
489	}
490	/*
491	 * Can reach here while scanning, update
492	 * operational state only in RUN state.
493	 */
494	if (vap->iv_state == IEEE80211_S_RUN) {
495		if (tdma->tdma_slot != ts->tdma_slot &&
496		    isclr(ts->tdma_inuse, tdma->tdma_slot)) {
497			IEEE80211_NOTE(vap, IEEE80211_MSG_TDMA, ni,
498			    "discovered in slot %u", tdma->tdma_slot);
499			setbit(ts->tdma_inuse, tdma->tdma_slot);
500			/* XXX dispatch event only when operating as master */
501			if (ts->tdma_slot == 0)
502				ieee80211_notify_node_join(ni, 1);
503		}
504		setbit(ts->tdma_active, tdma->tdma_slot);
505		if (tdma->tdma_slot == ts->tdma_slot-1) {
506			/*
507			 * Slave tsf synchronization to station
508			 * just before us in the schedule. The driver
509			 * is responsible for copying the timestamp
510			 * of the received beacon into our beacon
511			 * frame so the sender can calculate round
512			 * trip time.  We cannot do that here because
513			 * we don't know how to update our beacon frame.
514			 */
515			(void) tdma_update(vap, tdma, ni, 0);
516			/* XXX reschedule swbmiss timer on parameter change */
517		} else if (tdma->tdma_slot == ts->tdma_slot+1) {
518			uint64_t tstamp;
519			int32_t rtt;
520			/*
521			 * Use returned timstamp to calculate the
522			 * roundtrip time.
523			 */
524			memcpy(&tstamp, tdma->tdma_tstamp, 8);
525			/* XXX use only 15 bits of rstamp */
526			rtt = rstamp - (le64toh(tstamp) & 0x7fff);
527			if (rtt < 0)
528				rtt += 0x7fff;
529			/* XXX hack to quiet normal use */
530			IEEE80211_DPRINTF(vap, IEEE80211_MSG_DOT1X,
531			    "tdma rtt %5u [rstamp %5u tstamp %llu]\n",
532			    rtt, rstamp,
533			    (unsigned long long) le64toh(tstamp));
534		} else if (tdma->tdma_slot == ts->tdma_slot &&
535		    le64toh(ni->ni_tstamp.tsf) > vap->iv_bss->ni_tstamp.tsf) {
536			/*
537			 * Station using the same slot as us and has
538			 * been around longer than us; we must move.
539			 * Note this can happen if stations do not
540			 * see each other while scanning.
541			 */
542			IEEE80211_DPRINTF(vap, IEEE80211_MSG_TDMA,
543			    "slot %u collision rxtsf %llu tsf %llu\n",
544			    tdma->tdma_slot,
545			    (unsigned long long) le64toh(ni->ni_tstamp.tsf),
546			    vap->iv_bss->ni_tstamp.tsf);
547			setbit(ts->tdma_inuse, tdma->tdma_slot);
548
549			(void) tdma_update(vap, tdma, ni, 1);
550		}
551	}
552	return 0;
553}
554
555int
556ieee80211_tdma_getslot(struct ieee80211vap *vap)
557{
558	struct ieee80211_tdma_state *ts = vap->iv_tdma;
559
560	KASSERT(vap->iv_caps & IEEE80211_C_TDMA,
561	     ("not a tdma vap, caps 0x%x", vap->iv_caps));
562	return ts->tdma_slot;
563}
564
565/*
566 * Parse a TDMA ie on station join and use it to setup node state.
567 */
568void
569ieee80211_parse_tdma(struct ieee80211_node *ni, const uint8_t *ie)
570{
571	struct ieee80211vap *vap = ni->ni_vap;
572
573	if (vap->iv_caps & IEEE80211_C_TDMA) {
574		const struct ieee80211_tdma_param *tdma =
575		    (const struct ieee80211_tdma_param *)ie;
576		struct ieee80211_tdma_state *ts = vap->iv_tdma;
577		/*
578		 * Adopt TDMA configuration when joining an
579		 * existing network.
580		 */
581		setbit(ts->tdma_inuse, tdma->tdma_slot);
582		(void) tdma_update(vap, tdma, ni, 1);
583		/*
584		 * Propagate capabilities based on the local
585		 * configuration and the remote station's advertised
586		 * capabilities. In particular this permits us to
587		 * enable use of QoS to disable ACK's.
588		 */
589		if ((vap->iv_flags & IEEE80211_F_WME) &&
590		    ni->ni_ies.wme_ie != NULL)
591			ni->ni_flags |= IEEE80211_NODE_QOS;
592	}
593}
594
595#define	TDMA_OUI_BYTES		0x00, 0x03, 0x7f
596/*
597 * Add a TDMA parameters element to a frame.
598 */
599uint8_t *
600ieee80211_add_tdma(uint8_t *frm, struct ieee80211vap *vap)
601{
602#define	ADDSHORT(frm, v) do {			\
603	frm[0] = (v) & 0xff;			\
604	frm[1] = (v) >> 8;			\
605	frm += 2;				\
606} while (0)
607	static const struct ieee80211_tdma_param param = {
608		.tdma_id	= IEEE80211_ELEMID_VENDOR,
609		.tdma_len	= sizeof(struct ieee80211_tdma_param) - 2,
610		.tdma_oui	= { TDMA_OUI_BYTES },
611		.tdma_type	= TDMA_OUI_TYPE,
612		.tdma_subtype	= TDMA_SUBTYPE_PARAM,
613		.tdma_version	= TDMA_VERSION,
614	};
615	const struct ieee80211_tdma_state *tdma = vap->iv_tdma;
616	uint16_t slotlen;
617
618	KASSERT(vap->iv_caps & IEEE80211_C_TDMA,
619	     ("not a tdma vap, caps 0x%x", vap->iv_caps));
620
621	memcpy(frm, &param, sizeof(param));
622	frm += __offsetof(struct ieee80211_tdma_param, tdma_slot);
623	*frm++ = tdma->tdma_slot;
624	*frm++ = tdma->tdma_slotcnt;
625	/* NB: convert units to fit in 16-bits */
626	slotlen = tdma->tdma_slotlen / 100;	/* 100us units */
627	ADDSHORT(frm, slotlen);
628	*frm++ = tdma->tdma_bintval;
629	*frm++ = tdma->tdma_inuse[0];
630	frm += 10;				/* pad+timestamp */
631	return frm;
632#undef ADDSHORT
633}
634#undef TDMA_OUI_BYTES
635
636/*
637 * Update TDMA state at TBTT.
638 */
639void
640ieee80211_tdma_update_beacon(struct ieee80211vap *vap,
641	struct ieee80211_beacon_offsets *bo)
642{
643	struct ieee80211_tdma_state *ts = vap->iv_tdma;
644
645	KASSERT(vap->iv_caps & IEEE80211_C_TDMA,
646	     ("not a tdma vap, caps 0x%x", vap->iv_caps));
647
648	if (isset(bo->bo_flags,  IEEE80211_BEACON_TDMA)) {
649		(void) ieee80211_add_tdma(bo->bo_tdma, vap);
650		clrbit(bo->bo_flags, IEEE80211_BEACON_TDMA);
651	}
652	if (ts->tdma_slot != 0)		/* only on master */
653		return;
654	if (ts->tdma_count <= 0) {
655		/*
656		 * Time to update the mask of active/inuse stations.
657		 * We track stations that we've received a beacon
658		 * frame from and update this mask periodically.
659		 * This allows us to miss a few beacons before marking
660		 * a slot free for re-use.
661		 */
662		ts->tdma_inuse[0] = ts->tdma_active[0];
663		ts->tdma_active[0] = 0x01;
664		/* update next time 'round */
665		/* XXX use notify framework */
666		setbit(bo->bo_flags, IEEE80211_BEACON_TDMA);
667		/* NB: use s/w beacon miss threshold; may be too high */
668		ts->tdma_count = vap->iv_bmissthreshold-1;
669	} else
670		ts->tdma_count--;
671}
672
673int
674ieee80211_tdma_ioctl_get80211(struct ieee80211vap *vap,
675	struct ieee80211req *ireq)
676{
677	struct ieee80211_tdma_state *ts = vap->iv_tdma;
678
679	if ((vap->iv_caps & IEEE80211_C_TDMA) == 0)
680		return EOPNOTSUPP;
681
682	switch (ireq->i_type) {
683	case IEEE80211_IOC_TDMA_SLOT:
684		ireq->i_val = ts->tdma_slot;
685		break;
686	case IEEE80211_IOC_TDMA_SLOTCNT:
687		ireq->i_val = ts->tdma_slotcnt;
688		break;
689	case IEEE80211_IOC_TDMA_SLOTLEN:
690		ireq->i_val = ts->tdma_slotlen;
691		break;
692	case IEEE80211_IOC_TDMA_BINTERVAL:
693		ireq->i_val = ts->tdma_bintval;
694		break;
695	default:
696		return EINVAL;
697	}
698	return 0;
699}
700
701int
702ieee80211_tdma_ioctl_set80211(struct ieee80211vap *vap,
703	struct ieee80211req *ireq)
704{
705	struct ieee80211_tdma_state *ts = vap->iv_tdma;
706
707	if ((vap->iv_caps & IEEE80211_C_TDMA) == 0)
708		return EOPNOTSUPP;
709
710	switch (ireq->i_type) {
711	case IEEE80211_IOC_TDMA_SLOT:
712		if (!(0 <= ireq->i_val && ireq->i_val <= ts->tdma_slotcnt))
713			return EINVAL;
714		if (ireq->i_val != ts->tdma_slot) {
715			ts->tdma_slot = ireq->i_val;
716			return ERESTART;
717		}
718		break;
719	case IEEE80211_IOC_TDMA_SLOTCNT:
720		if (!(2 <= ireq->i_val &&
721		      ireq->i_val <= IEEE80211_TDMA_MAXSLOTS))
722			return EINVAL;
723		if (ireq->i_val != ts->tdma_slotcnt) {
724			ts->tdma_slotcnt = ireq->i_val;
725			return ERESTART;
726		}
727		break;
728	case IEEE80211_IOC_TDMA_SLOTLEN:
729		/*
730		 * XXX
731		 * 150 insures at least 1/8 TU
732		 * 0xfffff is the max duration for bursting
733		 * (implict by way of 16-bit data type for i_val)
734		 */
735		if (ireq->i_val < 150)
736			return EINVAL;
737		if (ireq->i_val != ts->tdma_slotlen) {
738			ts->tdma_slotlen = ireq->i_val;
739			return ERESTART;
740		}
741		break;
742	case IEEE80211_IOC_TDMA_BINTERVAL:
743		if (ireq->i_val < 1)
744			return EINVAL;
745		if (ireq->i_val != ts->tdma_bintval) {
746			ts->tdma_bintval = ireq->i_val;
747			return ERESTART;
748		}
749		break;
750	default:
751		return EINVAL;
752	}
753	return 0;
754}
755#endif /* IEEE80211_SUPPORT_TDMA */
756