1 /* $NetBSD: ieee80211_rssadapt.c,v 1.7 2004/05/25 04:33:59 atatat Exp $ */ 2 /*- 3 * Copyright (c) 2003, 2004 David Young. All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or 6 * without modification, are permitted provided that the following 7 * conditions 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 11 * copyright notice, this list of conditions and the following 12 * disclaimer in the documentation and/or other materials provided 13 * with the distribution. 14 * 3. The name of David Young may not be used to endorse or promote 15 * products derived from this software without specific prior 16 * written permission. 17 * 18 * THIS SOFTWARE IS PROVIDED BY David Young ``AS IS'' AND ANY 19 * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, 20 * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A 21 * PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL David 22 * Young BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, 23 * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED 24 * TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 25 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND 26 * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 27 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 28 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY 29 * OF SUCH DAMAGE. 30 */ 31 32 #include <sys/param.h> 33 #include <sys/types.h> 34 #include <sys/kernel.h> /* for hz */ 35 #include <sys/sysctl.h> 36 37 #include <net/if.h> 38 #include <net/if_media.h> 39 #include <net/if_ether.h> 40 41 #include <net80211/ieee80211_var.h> 42 #include <net80211/ieee80211.h> 43 #include <net80211/ieee80211_compat.h> 44 #include <net80211/ieee80211_rssadapt.h> 45 46 #ifdef interpolate 47 #undef interpolate 48 #endif 49 #define interpolate(parm, old, new) ((parm##_old * (old) + \ 50 (parm##_denom - parm##_old) * (new)) / \ 51 parm##_denom) 52 53 #ifdef IEEE80211_DEBUG 54 static struct timeval lastrateadapt; /* time of last rate adaptation msg */ 55 static int currssadaptps = 0; /* rate-adaptation msgs this second */ 56 static int ieee80211_adaptrate = 4; /* rate-adaptation max msgs/sec */ 57 58 #define RSSADAPT_DO_PRINT() \ 59 ((ieee80211_rssadapt_debug > 0) && \ 60 ppsratecheck(&lastrateadapt, &currssadaptps, ieee80211_adaptrate)) 61 #define RSSADAPT_PRINTF(X) \ 62 if (RSSADAPT_DO_PRINT()) \ 63 printf X 64 65 int ieee80211_rssadapt_debug = 0; 66 67 #else 68 #define RSSADAPT_DO_PRINT() (0) 69 #define RSSADAPT_PRINTF(X) 70 #endif 71 72 static struct ieee80211_rssadapt_expavgctl master_expavgctl = { 73 rc_decay_denom : 16, 74 rc_decay_old : 15, 75 rc_thresh_denom : 8, 76 rc_thresh_old : 4, 77 rc_avgrssi_denom : 8, 78 rc_avgrssi_old : 4 79 }; 80 81 #ifdef __NetBSD__ 82 #ifdef IEEE80211_DEBUG 83 /* TBD factor with sysctl_ath_verify, sysctl_ieee80211_verify. */ 84 static int 85 sysctl_ieee80211_rssadapt_debug(SYSCTLFN_ARGS) 86 { 87 int error, t; 88 struct sysctlnode node; 89 90 node = *rnode; 91 t = *(int*)rnode->sysctl_data; 92 node.sysctl_data = &t; 93 error = sysctl_lookup(SYSCTLFN_CALL(&node)); 94 if (error || newp == NULL) 95 return (error); 96 97 IEEE80211_DPRINTF(("%s: t = %d, nodenum = %d, rnodenum = %d\n", 98 __func__, t, node.sysctl_num, rnode->sysctl_num)); 99 100 if (t < 0 || t > 2) 101 return (EINVAL); 102 *(int*)rnode->sysctl_data = t; 103 104 return (0); 105 } 106 #endif /* IEEE80211_DEBUG */ 107 108 /* TBD factor with sysctl_ath_verify, sysctl_ieee80211_verify. */ 109 static int 110 sysctl_ieee80211_rssadapt_expavgctl(SYSCTLFN_ARGS) 111 { 112 struct ieee80211_rssadapt_expavgctl rc; 113 int error; 114 struct sysctlnode node; 115 116 node = *rnode; 117 rc = *(struct ieee80211_rssadapt_expavgctl *)rnode->sysctl_data; 118 node.sysctl_data = &rc; 119 error = sysctl_lookup(SYSCTLFN_CALL(&node)); 120 if (error || newp == NULL) 121 return (error); 122 123 IEEE80211_DPRINTF(("%s: decay = %d/%d, thresh = %d/%d, " 124 "avgrssi = %d/%d, nodenum = %d, rnodenum = %d\n", 125 __func__, rc.rc_decay_old, rc.rc_decay_denom, 126 rc.rc_thresh_old, rc.rc_thresh_denom, 127 rc.rc_avgrssi_old, rc.rc_avgrssi_denom, 128 node.sysctl_num, rnode->sysctl_num)); 129 130 if (rc.rc_decay_old < 0 || 131 rc.rc_decay_denom < rc.rc_decay_old) 132 return (EINVAL); 133 134 if (rc.rc_thresh_old < 0 || 135 rc.rc_thresh_denom < rc.rc_thresh_old) 136 return (EINVAL); 137 138 if (rc.rc_avgrssi_old < 0 || 139 rc.rc_avgrssi_denom < rc.rc_avgrssi_old) 140 return (EINVAL); 141 142 *(struct ieee80211_rssadapt_expavgctl *)rnode->sysctl_data = rc; 143 144 return (0); 145 } 146 147 /* 148 * Setup sysctl(3) MIB, net.ieee80211.* 149 * 150 * TBD condition CTLFLAG_PERMANENT on being an LKM or not 151 */ 152 SYSCTL_SETUP(sysctl_ieee80211_rssadapt, 153 "sysctl ieee80211 rssadapt subtree setup") 154 { 155 int rc; 156 struct sysctlnode *node; 157 158 if ((rc = sysctl_createv(clog, 0, NULL, &node, 159 CTLFLAG_PERMANENT, CTLTYPE_NODE, "net", NULL, 160 NULL, 0, NULL, 0, CTL_NET, CTL_EOL)) != 0) 161 goto err; 162 163 if ((rc = sysctl_createv(clog, 0, &node, &node, 164 CTLFLAG_PERMANENT, CTLTYPE_NODE, "link", NULL, 165 NULL, 0, NULL, 0, PF_LINK, CTL_EOL)) != 0) 166 goto err; 167 168 if ((rc = sysctl_createv(clog, 0, &node, &node, 169 CTLFLAG_PERMANENT, CTLTYPE_NODE, "ieee80211", NULL, 170 NULL, 0, NULL, 0, CTL_CREATE, CTL_EOL)) != 0) 171 goto err; 172 173 if ((rc = sysctl_createv(clog, 0, &node, &node, 174 CTLFLAG_PERMANENT, CTLTYPE_NODE, "rssadapt", 175 SYSCTL_DESCR("Received Signal Strength adaptation controls"), 176 NULL, 0, NULL, 0, CTL_CREATE, CTL_EOL)) != 0) 177 goto err; 178 179 #ifdef IEEE80211_DEBUG 180 /* control debugging printfs */ 181 if ((rc = sysctl_createv(clog, 0, &node, NULL, 182 CTLFLAG_PERMANENT|CTLFLAG_READWRITE, CTLTYPE_INT, "debug", 183 SYSCTL_DESCR("Enable RSS adaptation debugging output"), 184 sysctl_ieee80211_rssadapt_debug, 0, &ieee80211_rssadapt_debug, 0, 185 CTL_CREATE, CTL_EOL)) != 0) 186 goto err; 187 #endif /* IEEE80211_DEBUG */ 188 189 /* control rate of decay for exponential averages */ 190 if ((rc = sysctl_createv(clog, 0, &node, NULL, 191 CTLFLAG_PERMANENT|CTLFLAG_READWRITE, CTLTYPE_STRUCT, 192 "expavgctl", SYSCTL_DESCR("RSS exponential averaging control"), 193 sysctl_ieee80211_rssadapt_expavgctl, 0, 194 &master_expavgctl, sizeof(master_expavgctl), CTL_CREATE, 195 CTL_EOL)) != 0) 196 goto err; 197 198 return; 199 err: 200 printf("%s: sysctl_createv failed (rc = %d)\n", __func__, rc); 201 } 202 #endif /* __NetBSD__ */ 203 204 int 205 ieee80211_rssadapt_choose(struct ieee80211_rssadapt *ra, 206 struct ieee80211_rateset *rs, struct ieee80211_frame *wh, u_int len, 207 int fixed_rate, const char *dvname, int do_not_adapt) 208 { 209 u_int16_t (*thrs)[IEEE80211_RATE_SIZE]; 210 int flags = 0, i, rateidx = 0, thridx, top; 211 212 if ((wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK) == IEEE80211_FC0_TYPE_CTL) 213 flags |= IEEE80211_RATE_BASIC; 214 215 for (i = 0, top = IEEE80211_RSSADAPT_BKT0; 216 i < IEEE80211_RSSADAPT_BKTS; 217 i++, top <<= IEEE80211_RSSADAPT_BKTPOWER) { 218 thridx = i; 219 if (len <= top) 220 break; 221 } 222 223 thrs = &ra->ra_rate_thresh[thridx]; 224 225 if (fixed_rate != -1) { 226 if ((rs->rs_rates[fixed_rate] & flags) == flags) { 227 rateidx = fixed_rate; 228 goto out; 229 } 230 flags |= IEEE80211_RATE_BASIC; 231 i = fixed_rate; 232 } else 233 i = rs->rs_nrates; 234 235 while (--i >= 0) { 236 rateidx = i; 237 if ((rs->rs_rates[i] & flags) != flags) 238 continue; 239 if (do_not_adapt) 240 break; 241 if ((*thrs)[i] < ra->ra_avg_rssi) 242 break; 243 } 244 245 out: 246 #ifdef IEEE80211_DEBUG 247 if (ieee80211_rssadapt_debug && dvname != NULL) { 248 printf("%s: dst %s threshold[%d, %d.%d] %d < %d\n", 249 dvname, ether_sprintf(wh->i_addr1), len, 250 (rs->rs_rates[rateidx] & IEEE80211_RATE_VAL) / 2, 251 (rs->rs_rates[rateidx] & IEEE80211_RATE_VAL) * 5 % 10, 252 (*thrs)[rateidx], ra->ra_avg_rssi); 253 } 254 #endif /* IEEE80211_DEBUG */ 255 return rateidx; 256 } 257 258 void 259 ieee80211_rssadapt_updatestats(struct ieee80211_rssadapt *ra) 260 { 261 long interval; 262 263 ra->ra_pktrate = 264 (ra->ra_pktrate + 10 * (ra->ra_nfail + ra->ra_nok)) / 2; 265 ra->ra_nfail = ra->ra_nok = 0; 266 267 /* a node is eligible for its rate to be raised every 1/10 to 10 268 * seconds, more eligible in proportion to recent packet rates. 269 */ 270 interval = MAX(100000, 10000000 / MAX(1, 10 * ra->ra_pktrate)); 271 ra->ra_raise_interval.tv_sec = interval / (1000 * 1000); 272 ra->ra_raise_interval.tv_usec = interval % (1000 * 1000); 273 } 274 275 void 276 ieee80211_rssadapt_input(struct ieee80211com *ic, struct ieee80211_node *ni, 277 struct ieee80211_rssadapt *ra, int rssi) 278 { 279 #ifdef IEEE80211_DEBUG 280 int last_avg_rssi = ra->ra_avg_rssi; 281 #endif 282 283 ra->ra_avg_rssi = interpolate(master_expavgctl.rc_avgrssi, 284 ra->ra_avg_rssi, (rssi << 8)); 285 286 RSSADAPT_PRINTF(("%s: src %s rssi %d avg %d -> %d\n", 287 ic->ic_if.if_xname, ether_sprintf(ni->ni_macaddr), 288 rssi, last_avg_rssi, ra->ra_avg_rssi)); 289 } 290 291 /* 292 * Adapt the data rate to suit the conditions. When a transmitted 293 * packet is dropped after IEEE80211_RSSADAPT_RETRY_LIMIT retransmissions, 294 * raise the RSS threshold for transmitting packets of similar length at 295 * the same data rate. 296 */ 297 void 298 ieee80211_rssadapt_lower_rate(struct ieee80211com *ic, 299 struct ieee80211_node *ni, struct ieee80211_rssadapt *ra, 300 struct ieee80211_rssdesc *id) 301 { 302 struct ieee80211_rateset *rs = &ni->ni_rates; 303 u_int16_t last_thr; 304 u_int i, thridx, top; 305 306 ra->ra_nfail++; 307 308 if (id->id_rateidx >= rs->rs_nrates) { 309 RSSADAPT_PRINTF(("ieee80211_rssadapt_lower_rate: " 310 "%s rate #%d > #%d out of bounds\n", 311 ether_sprintf(ni->ni_macaddr), id->id_rateidx, 312 rs->rs_nrates - 1)); 313 return; 314 } 315 316 for (i = 0, top = IEEE80211_RSSADAPT_BKT0; 317 i < IEEE80211_RSSADAPT_BKTS; 318 i++, top <<= IEEE80211_RSSADAPT_BKTPOWER) { 319 thridx = i; 320 if (id->id_len <= top) 321 break; 322 } 323 324 last_thr = ra->ra_rate_thresh[thridx][id->id_rateidx]; 325 ra->ra_rate_thresh[thridx][id->id_rateidx] = 326 interpolate(master_expavgctl.rc_thresh, last_thr, 327 (id->id_rssi << 8)); 328 329 RSSADAPT_PRINTF(("%s: dst %s rssi %d threshold[%d, %d.%d] %d -> %d\n", 330 ic->ic_if.if_xname, ether_sprintf(ni->ni_macaddr), 331 id->id_rssi, id->id_len, 332 (rs->rs_rates[id->id_rateidx] & IEEE80211_RATE_VAL) / 2, 333 (rs->rs_rates[id->id_rateidx] & IEEE80211_RATE_VAL) * 5 % 10, 334 last_thr, ra->ra_rate_thresh[thridx][id->id_rateidx])); 335 } 336 337 void 338 ieee80211_rssadapt_raise_rate(struct ieee80211com *ic, 339 struct ieee80211_rssadapt *ra, struct ieee80211_rssdesc *id) 340 { 341 u_int16_t (*thrs)[IEEE80211_RATE_SIZE], newthr, oldthr; 342 struct ieee80211_node *ni = id->id_node; 343 struct ieee80211_rateset *rs = &ni->ni_rates; 344 int i, rate, top; 345 #ifdef IEEE80211_DEBUG 346 int j; 347 #endif 348 349 ra->ra_nok++; 350 351 if (!ratecheck(&ra->ra_last_raise, &ra->ra_raise_interval)) 352 return; 353 354 for (i = 0, top = IEEE80211_RSSADAPT_BKT0; 355 i < IEEE80211_RSSADAPT_BKTS; 356 i++, top <<= IEEE80211_RSSADAPT_BKTPOWER) { 357 thrs = &ra->ra_rate_thresh[i]; 358 if (id->id_len <= top) 359 break; 360 } 361 362 if (id->id_rateidx + 1 < rs->rs_nrates && 363 (*thrs)[id->id_rateidx + 1] > (*thrs)[id->id_rateidx]) { 364 rate = (rs->rs_rates[id->id_rateidx + 1] & IEEE80211_RATE_VAL); 365 366 RSSADAPT_PRINTF(("%s: threshold[%d, %d.%d] decay %d ", 367 ic->ic_if.if_xname, 368 IEEE80211_RSSADAPT_BKT0 << (IEEE80211_RSSADAPT_BKTPOWER* i), 369 rate / 2, rate * 5 % 10, (*thrs)[id->id_rateidx + 1])); 370 oldthr = (*thrs)[id->id_rateidx + 1]; 371 if ((*thrs)[id->id_rateidx] == 0) 372 newthr = ra->ra_avg_rssi; 373 else 374 newthr = (*thrs)[id->id_rateidx]; 375 (*thrs)[id->id_rateidx + 1] = 376 interpolate(master_expavgctl.rc_decay, oldthr, newthr); 377 378 RSSADAPT_PRINTF(("-> %d\n", (*thrs)[id->id_rateidx + 1])); 379 } 380 381 #ifdef IEEE80211_DEBUG 382 if (RSSADAPT_DO_PRINT()) { 383 printf("%s: dst %s thresholds\n", ic->ic_if.if_xname, 384 ether_sprintf(ni->ni_macaddr)); 385 for (i = 0; i < IEEE80211_RSSADAPT_BKTS; i++) { 386 printf("%d-byte", IEEE80211_RSSADAPT_BKT0 << (IEEE80211_RSSADAPT_BKTPOWER * i)); 387 for (j = 0; j < rs->rs_nrates; j++) { 388 rate = (rs->rs_rates[j] & IEEE80211_RATE_VAL); 389 printf(", T[%d.%d] = %d", rate / 2, 390 rate * 5 % 10, ra->ra_rate_thresh[i][j]); 391 } 392 printf("\n"); 393 } 394 } 395 #endif /* IEEE80211_DEBUG */ 396 } 397