xref: /freebsd/sys/dev/rtwn/rtl8821a/r21a_beacon.c (revision aa1a8ff2d6dbc51ef058f46f3db5a8bb77967145)
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 #include "opt_wlan.h"
29 
30 #include <sys/param.h>
31 #include <sys/lock.h>
32 #include <sys/mutex.h>
33 #include <sys/mbuf.h>
34 #include <sys/kernel.h>
35 #include <sys/socket.h>
36 #include <sys/systm.h>
37 #include <sys/malloc.h>
38 #include <sys/queue.h>
39 #include <sys/taskqueue.h>
40 #include <sys/bus.h>
41 #include <sys/endian.h>
42 #include <sys/linker.h>
43 
44 #include <net/if.h>
45 #include <net/ethernet.h>
46 #include <net/if_media.h>
47 
48 #include <net80211/ieee80211_var.h>
49 #include <net80211/ieee80211_radiotap.h>
50 
51 #include <dev/rtwn/if_rtwnreg.h>
52 #include <dev/rtwn/if_rtwnvar.h>
53 
54 #include <dev/rtwn/rtl8812a/r12a.h>
55 #include <dev/rtwn/rtl8812a/r12a_tx_desc.h>
56 
57 #include <dev/rtwn/rtl8821a/r21a.h>
58 #include <dev/rtwn/rtl8821a/r21a_reg.h>
59 
60 void
61 r21a_beacon_init(struct rtwn_softc *sc, void *buf, int id)
62 {
63 	struct r12a_tx_desc *txd = (struct r12a_tx_desc *)buf;
64 
65 	r12a_beacon_init(sc, buf, id);
66 
67 	/* XXX sequence number for beacon 1 is not stable. */
68 	txd->txdw3 &= ~htole32(R12A_TXDW3_SEQ_SEL_M);
69 	txd->txdw3 |= htole32(SM(R12A_TXDW3_SEQ_SEL, id * 2));
70 }
71 
72 void
73 r21a_beacon_select(struct rtwn_softc *sc, int id)
74 {
75 	switch (id) {
76 	case 0:
77 		/* Switch to port 0 beacon. */
78 		rtwn_setbits_1_shift(sc, R21A_DWBCN1_CTRL,
79 		    R21A_DWBCN1_CTRL_SEL_BCN1, 0, 2);
80 		break;
81 	case 1:
82 		/* Switch to port 1 beacon. */
83 		rtwn_setbits_1_shift(sc, R21A_DWBCN1_CTRL,
84 		    0, R21A_DWBCN1_CTRL_SEL_BCN1, 2);
85 		break;
86 	default:
87 		KASSERT(0, ("wrong port id %d\n", id));
88 		break;
89 	}
90 }
91