xref: /dragonfly/sys/dev/netif/bwn/bwn/if_bwn_util.c (revision 7d3e9a5b)
1 /*-
2  * Copyright (c) 2009-2010 Weongyo Jeong <weongyo@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  *    without modification.
11  * 2. Redistributions in binary form must reproduce at minimum a disclaimer
12  *    similar to the "NO WARRANTY" disclaimer below ("Disclaimer") and any
13  *    redistribution must be conditioned upon including a substantially
14  *    similar Disclaimer requirement for further binary redistribution.
15  *
16  * NO WARRANTY
17  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
18  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
19  * LIMITED TO, THE IMPLIED WARRANTIES OF NONINFRINGEMENT, MERCHANTABILITY
20  * AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL
21  * THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY,
22  * OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
23  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
24  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER
25  * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
26  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
27  * THE POSSIBILITY OF SUCH DAMAGES.
28  *
29  * $FreeBSD: head/sys/dev/bwn/if_bwn_util.c 299751 2016-05-14 19:52:04Z adrian $
30  */
31 
32 /*
33  * The Broadcom Wireless LAN controller driver.
34  */
35 
36 #include <sys/param.h>
37 #include <sys/systm.h>
38 #include <sys/kernel.h>
39 #include <sys/malloc.h>
40 #include <sys/module.h>
41 #include <sys/endian.h>
42 #include <sys/errno.h>
43 #include <sys/firmware.h>
44 #include <sys/lock.h>
45 #if !defined(__DragonFly__)
46 #include <machine/bus.h>
47 #include <machine/resource.h>
48 #endif
49 #include <sys/bus.h>
50 #include <sys/rman.h>
51 #include <sys/socket.h>
52 #include <sys/sockio.h>
53 
54 #include <net/ethernet.h>
55 #include <net/if.h>
56 #include <net/if_var.h>
57 #include <net/if_arp.h>
58 #include <net/if_dl.h>
59 #include <net/if_llc.h>
60 #include <net/if_media.h>
61 #include <net/if_types.h>
62 
63 #if defined(__DragonFly__)
64 #include <bus/pci/pcivar.h>
65 #include <bus/pci/pcireg.h>
66 #include <dev/netif/bwn/siba/siba_ids.h>
67 #include <dev/netif/bwn/siba/sibareg.h>
68 #include <dev/netif/bwn/siba/sibavar.h>
69 #else
70 #include <dev/pci/pcivar.h>
71 #include <dev/pci/pcireg.h>
72 #include <dev/siba/siba_ids.h>
73 #include <dev/siba/sibareg.h>
74 #include <dev/siba/sibavar.h>
75 #endif
76 
77 #if defined(__DragonFly__)
78 #include <netproto/802_11/ieee80211_var.h>
79 #include <netproto/802_11/ieee80211_radiotap.h>
80 #include <netproto/802_11/ieee80211_regdomain.h>
81 #include <netproto/802_11/ieee80211_phy.h>
82 #include <netproto/802_11/ieee80211_ratectl.h>
83 #else
84 #include <net80211/ieee80211_var.h>
85 #include <net80211/ieee80211_radiotap.h>
86 #include <net80211/ieee80211_regdomain.h>
87 #include <net80211/ieee80211_phy.h>
88 #include <net80211/ieee80211_ratectl.h>
89 #endif
90 
91 #if defined(__DragonFly__)
92 #include "if_bwnreg.h"
93 #include "if_bwnvar.h"
94 #else
95 #include <dev/bwn/if_bwnreg.h>
96 #include <dev/bwn/if_bwnvar.h>
97 #endif
98 
99 #if defined(__DragonFly__)
100 #include "if_bwn_chipid.h"
101 #include "if_bwn_debug.h"
102 #include "if_bwn_misc.h"
103 #include "if_bwn_util.h"
104 #else
105 #include <dev/bwn/if_bwn_chipid.h>
106 #include <dev/bwn/if_bwn_debug.h>
107 #include <dev/bwn/if_bwn_misc.h>
108 #include <dev/bwn/if_bwn_util.h>
109 #endif
110 
111 unsigned int
112 bwn_sqrt(struct bwn_mac *mac, unsigned int x)
113 {
114 	/* Table holding (10 * sqrt(x)) for x between 1 and 256. */
115 	static uint8_t sqrt_table[256] = {
116 		10, 14, 17, 20, 22, 24, 26, 28,
117 		30, 31, 33, 34, 36, 37, 38, 40,
118 		41, 42, 43, 44, 45, 46, 47, 48,
119 		50, 50, 51, 52, 53, 54, 55, 56,
120 		57, 58, 59, 60, 60, 61, 62, 63,
121 		64, 64, 65, 66, 67, 67, 68, 69,
122 		70, 70, 71, 72, 72, 73, 74, 74,
123 		75, 76, 76, 77, 78, 78, 79, 80,
124 		80, 81, 81, 82, 83, 83, 84, 84,
125 		85, 86, 86, 87, 87, 88, 88, 89,
126 		90, 90, 91, 91, 92, 92, 93, 93,
127 		94, 94, 95, 95, 96, 96, 97, 97,
128 		98, 98, 99, 100, 100, 100, 101, 101,
129 		102, 102, 103, 103, 104, 104, 105, 105,
130 		106, 106, 107, 107, 108, 108, 109, 109,
131 		110, 110, 110, 111, 111, 112, 112, 113,
132 		113, 114, 114, 114, 115, 115, 116, 116,
133 		117, 117, 117, 118, 118, 119, 119, 120,
134 		120, 120, 121, 121, 122, 122, 122, 123,
135 		123, 124, 124, 124, 125, 125, 126, 126,
136 		126, 127, 127, 128, 128, 128, 129, 129,
137 		130, 130, 130, 131, 131, 131, 132, 132,
138 		133, 133, 133, 134, 134, 134, 135, 135,
139 		136, 136, 136, 137, 137, 137, 138, 138,
140 		138, 139, 139, 140, 140, 140, 141, 141,
141 		141, 142, 142, 142, 143, 143, 143, 144,
142 		144, 144, 145, 145, 145, 146, 146, 146,
143 		147, 147, 147, 148, 148, 148, 149, 149,
144 		150, 150, 150, 150, 151, 151, 151, 152,
145 		152, 152, 153, 153, 153, 154, 154, 154,
146 		155, 155, 155, 156, 156, 156, 157, 157,
147 		157, 158, 158, 158, 159, 159, 159, 160
148 	};
149 
150 	if (x == 0)
151 		return (0);
152 	if (x >= 256) {
153 		unsigned int tmp;
154 
155 		for (tmp = 0; x >= (2 * tmp) + 1; x -= (2 * tmp++) + 1)
156 			/* do nothing */ ;
157 		return (tmp);
158 	}
159 	return (sqrt_table[x - 1] / 10);
160 }
161