xref: /freebsd/sys/dev/rtwn/rtl8821a/r21a_beacon.c (revision c66ec88fed842fbaad62c30d510644ceb7bd2d71)
1 /*-
2  * Copyright (c) 2016 Andriy Voskoboinyk <avos@FreeBSD.org>
3  * All rights reserved.
4  *
5  * Redistribution and use in source and binary forms, with or without
6  * modification, are permitted provided that the following conditions
7  * are met:
8  * 1. Redistributions of source code must retain the above copyright
9  *    notice, this list of conditions and the following disclaimer.
10  * 2. Redistributions in binary form must reproduce the above copyright
11  *    notice, this list of conditions and the following disclaimer in the
12  *    documentation and/or other materials provided with the distribution.
13  *
14  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
24  * SUCH DAMAGE.
25  */
26 
27 #include <sys/cdefs.h>
28 __FBSDID("$FreeBSD$");
29 
30 #include "opt_wlan.h"
31 
32 #include <sys/param.h>
33 #include <sys/lock.h>
34 #include <sys/mutex.h>
35 #include <sys/mbuf.h>
36 #include <sys/kernel.h>
37 #include <sys/socket.h>
38 #include <sys/systm.h>
39 #include <sys/malloc.h>
40 #include <sys/queue.h>
41 #include <sys/taskqueue.h>
42 #include <sys/bus.h>
43 #include <sys/endian.h>
44 #include <sys/linker.h>
45 
46 #include <net/if.h>
47 #include <net/ethernet.h>
48 #include <net/if_media.h>
49 
50 #include <net80211/ieee80211_var.h>
51 #include <net80211/ieee80211_radiotap.h>
52 
53 #include <dev/rtwn/if_rtwnreg.h>
54 #include <dev/rtwn/if_rtwnvar.h>
55 
56 #include <dev/rtwn/rtl8812a/r12a.h>
57 #include <dev/rtwn/rtl8812a/r12a_tx_desc.h>
58 
59 #include <dev/rtwn/rtl8821a/r21a.h>
60 #include <dev/rtwn/rtl8821a/r21a_reg.h>
61 
62 void
63 r21a_beacon_init(struct rtwn_softc *sc, void *buf, int id)
64 {
65 	struct r12a_tx_desc *txd = (struct r12a_tx_desc *)buf;
66 
67 	r12a_beacon_init(sc, buf, id);
68 
69 	/* XXX sequence number for beacon 1 is not stable. */
70 	txd->txdw3 &= ~htole32(R12A_TXDW3_SEQ_SEL_M);
71 	txd->txdw3 |= htole32(SM(R12A_TXDW3_SEQ_SEL, id * 2));
72 }
73 
74 void
75 r21a_beacon_select(struct rtwn_softc *sc, int id)
76 {
77 	switch (id) {
78 	case 0:
79 		/* Switch to port 0 beacon. */
80 		rtwn_setbits_1_shift(sc, R21A_DWBCN1_CTRL,
81 		    R21A_DWBCN1_CTRL_SEL_BCN1, 0, 2);
82 		break;
83 	case 1:
84 		/* Switch to port 1 beacon. */
85 		rtwn_setbits_1_shift(sc, R21A_DWBCN1_CTRL,
86 		    0, R21A_DWBCN1_CTRL_SEL_BCN1, 2);
87 		break;
88 	default:
89 		KASSERT(0, ("wrong port id %d\n", id));
90 		break;
91 	}
92 }
93