1 /* 2 * Some IBSS support code for cfg80211. 3 * 4 * Copyright 2009 Johannes Berg <johannes@sipsolutions.net> 5 */ 6 7 #include <linux/etherdevice.h> 8 #include <linux/if_arp.h> 9 #include <net/cfg80211.h> 10 #include "nl80211.h" 11 12 13 void cfg80211_ibss_joined(struct net_device *dev, const u8 *bssid, gfp_t gfp) 14 { 15 struct wireless_dev *wdev = dev->ieee80211_ptr; 16 struct cfg80211_bss *bss; 17 #ifdef CONFIG_WIRELESS_EXT 18 union iwreq_data wrqu; 19 #endif 20 21 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC)) 22 return; 23 24 if (WARN_ON(!wdev->ssid_len)) 25 return; 26 27 if (memcmp(bssid, wdev->bssid, ETH_ALEN) == 0) 28 return; 29 30 bss = cfg80211_get_bss(wdev->wiphy, NULL, bssid, 31 wdev->ssid, wdev->ssid_len, 32 WLAN_CAPABILITY_IBSS, WLAN_CAPABILITY_IBSS); 33 34 if (WARN_ON(!bss)) 35 return; 36 37 if (wdev->current_bss) { 38 cfg80211_unhold_bss(wdev->current_bss); 39 cfg80211_put_bss(wdev->current_bss); 40 } 41 42 cfg80211_hold_bss(bss); 43 wdev->current_bss = bss; 44 memcpy(wdev->bssid, bssid, ETH_ALEN); 45 46 nl80211_send_ibss_bssid(wiphy_to_dev(wdev->wiphy), dev, bssid, gfp); 47 #ifdef CONFIG_WIRELESS_EXT 48 memset(&wrqu, 0, sizeof(wrqu)); 49 memcpy(wrqu.ap_addr.sa_data, bssid, ETH_ALEN); 50 wireless_send_event(dev, SIOCGIWAP, &wrqu, NULL); 51 #endif 52 } 53 EXPORT_SYMBOL(cfg80211_ibss_joined); 54 55 int cfg80211_join_ibss(struct cfg80211_registered_device *rdev, 56 struct net_device *dev, 57 struct cfg80211_ibss_params *params) 58 { 59 struct wireless_dev *wdev = dev->ieee80211_ptr; 60 int err; 61 62 if (wdev->ssid_len) 63 return -EALREADY; 64 65 #ifdef CONFIG_WIRELESS_EXT 66 wdev->wext.ibss.channel = params->channel; 67 #endif 68 err = rdev->ops->join_ibss(&rdev->wiphy, dev, params); 69 70 if (err) 71 return err; 72 73 memcpy(wdev->ssid, params->ssid, params->ssid_len); 74 wdev->ssid_len = params->ssid_len; 75 76 return 0; 77 } 78 79 void cfg80211_clear_ibss(struct net_device *dev, bool nowext) 80 { 81 struct wireless_dev *wdev = dev->ieee80211_ptr; 82 83 if (wdev->current_bss) { 84 cfg80211_unhold_bss(wdev->current_bss); 85 cfg80211_put_bss(wdev->current_bss); 86 } 87 88 wdev->current_bss = NULL; 89 wdev->ssid_len = 0; 90 memset(wdev->bssid, 0, ETH_ALEN); 91 #ifdef CONFIG_WIRELESS_EXT 92 if (!nowext) 93 wdev->wext.ibss.ssid_len = 0; 94 #endif 95 } 96 97 int cfg80211_leave_ibss(struct cfg80211_registered_device *rdev, 98 struct net_device *dev, bool nowext) 99 { 100 int err; 101 102 err = rdev->ops->leave_ibss(&rdev->wiphy, dev); 103 104 if (err) 105 return err; 106 107 cfg80211_clear_ibss(dev, nowext); 108 109 return 0; 110 } 111 112 #ifdef CONFIG_WIRELESS_EXT 113 static int cfg80211_ibss_wext_join(struct cfg80211_registered_device *rdev, 114 struct wireless_dev *wdev) 115 { 116 enum ieee80211_band band; 117 int i; 118 119 if (!wdev->wext.ibss.beacon_interval) 120 wdev->wext.ibss.beacon_interval = 100; 121 122 /* try to find an IBSS channel if none requested ... */ 123 if (!wdev->wext.ibss.channel) { 124 for (band = 0; band < IEEE80211_NUM_BANDS; band++) { 125 struct ieee80211_supported_band *sband; 126 struct ieee80211_channel *chan; 127 128 sband = rdev->wiphy.bands[band]; 129 if (!sband) 130 continue; 131 132 for (i = 0; i < sband->n_channels; i++) { 133 chan = &sband->channels[i]; 134 if (chan->flags & IEEE80211_CHAN_NO_IBSS) 135 continue; 136 if (chan->flags & IEEE80211_CHAN_DISABLED) 137 continue; 138 wdev->wext.ibss.channel = chan; 139 break; 140 } 141 142 if (wdev->wext.ibss.channel) 143 break; 144 } 145 146 if (!wdev->wext.ibss.channel) 147 return -EINVAL; 148 } 149 150 /* don't join -- SSID is not there */ 151 if (!wdev->wext.ibss.ssid_len) 152 return 0; 153 154 if (!netif_running(wdev->netdev)) 155 return 0; 156 157 return cfg80211_join_ibss(wiphy_to_dev(wdev->wiphy), 158 wdev->netdev, &wdev->wext.ibss); 159 } 160 161 int cfg80211_ibss_wext_siwfreq(struct net_device *dev, 162 struct iw_request_info *info, 163 struct iw_freq *freq, char *extra) 164 { 165 struct wireless_dev *wdev = dev->ieee80211_ptr; 166 struct ieee80211_channel *chan; 167 int err; 168 169 /* call only for ibss! */ 170 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC)) 171 return -EINVAL; 172 173 if (!wiphy_to_dev(wdev->wiphy)->ops->join_ibss) 174 return -EOPNOTSUPP; 175 176 chan = cfg80211_wext_freq(wdev->wiphy, freq); 177 if (chan && IS_ERR(chan)) 178 return PTR_ERR(chan); 179 180 if (chan && 181 (chan->flags & IEEE80211_CHAN_NO_IBSS || 182 chan->flags & IEEE80211_CHAN_DISABLED)) 183 return -EINVAL; 184 185 if (wdev->wext.ibss.channel == chan) 186 return 0; 187 188 if (wdev->ssid_len) { 189 err = cfg80211_leave_ibss(wiphy_to_dev(wdev->wiphy), 190 dev, true); 191 if (err) 192 return err; 193 } 194 195 if (chan) { 196 wdev->wext.ibss.channel = chan; 197 wdev->wext.ibss.channel_fixed = true; 198 } else { 199 /* cfg80211_ibss_wext_join will pick one if needed */ 200 wdev->wext.ibss.channel_fixed = false; 201 } 202 203 return cfg80211_ibss_wext_join(wiphy_to_dev(wdev->wiphy), wdev); 204 } 205 /* temporary symbol - mark GPL - in the future the handler won't be */ 206 EXPORT_SYMBOL_GPL(cfg80211_ibss_wext_siwfreq); 207 208 int cfg80211_ibss_wext_giwfreq(struct net_device *dev, 209 struct iw_request_info *info, 210 struct iw_freq *freq, char *extra) 211 { 212 struct wireless_dev *wdev = dev->ieee80211_ptr; 213 struct ieee80211_channel *chan = NULL; 214 215 /* call only for ibss! */ 216 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC)) 217 return -EINVAL; 218 219 if (wdev->current_bss) 220 chan = wdev->current_bss->channel; 221 else if (wdev->wext.ibss.channel) 222 chan = wdev->wext.ibss.channel; 223 224 if (chan) { 225 freq->m = chan->center_freq; 226 freq->e = 6; 227 return 0; 228 } 229 230 /* no channel if not joining */ 231 return -EINVAL; 232 } 233 /* temporary symbol - mark GPL - in the future the handler won't be */ 234 EXPORT_SYMBOL_GPL(cfg80211_ibss_wext_giwfreq); 235 236 int cfg80211_ibss_wext_siwessid(struct net_device *dev, 237 struct iw_request_info *info, 238 struct iw_point *data, char *ssid) 239 { 240 struct wireless_dev *wdev = dev->ieee80211_ptr; 241 size_t len = data->length; 242 int err; 243 244 /* call only for ibss! */ 245 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC)) 246 return -EINVAL; 247 248 if (!wiphy_to_dev(wdev->wiphy)->ops->join_ibss) 249 return -EOPNOTSUPP; 250 251 if (wdev->ssid_len) { 252 err = cfg80211_leave_ibss(wiphy_to_dev(wdev->wiphy), 253 dev, true); 254 if (err) 255 return err; 256 } 257 258 /* iwconfig uses nul termination in SSID.. */ 259 if (len > 0 && ssid[len - 1] == '\0') 260 len--; 261 262 wdev->wext.ibss.ssid = wdev->ssid; 263 memcpy(wdev->wext.ibss.ssid, ssid, len); 264 wdev->wext.ibss.ssid_len = len; 265 266 return cfg80211_ibss_wext_join(wiphy_to_dev(wdev->wiphy), wdev); 267 } 268 /* temporary symbol - mark GPL - in the future the handler won't be */ 269 EXPORT_SYMBOL_GPL(cfg80211_ibss_wext_siwessid); 270 271 int cfg80211_ibss_wext_giwessid(struct net_device *dev, 272 struct iw_request_info *info, 273 struct iw_point *data, char *ssid) 274 { 275 struct wireless_dev *wdev = dev->ieee80211_ptr; 276 277 /* call only for ibss! */ 278 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC)) 279 return -EINVAL; 280 281 data->flags = 0; 282 283 if (wdev->ssid_len) { 284 data->flags = 1; 285 data->length = wdev->ssid_len; 286 memcpy(ssid, wdev->ssid, data->length); 287 } else if (wdev->wext.ibss.ssid && wdev->wext.ibss.ssid_len) { 288 data->flags = 1; 289 data->length = wdev->wext.ibss.ssid_len; 290 memcpy(ssid, wdev->wext.ibss.ssid, data->length); 291 } 292 293 return 0; 294 } 295 /* temporary symbol - mark GPL - in the future the handler won't be */ 296 EXPORT_SYMBOL_GPL(cfg80211_ibss_wext_giwessid); 297 298 int cfg80211_ibss_wext_siwap(struct net_device *dev, 299 struct iw_request_info *info, 300 struct sockaddr *ap_addr, char *extra) 301 { 302 struct wireless_dev *wdev = dev->ieee80211_ptr; 303 u8 *bssid = ap_addr->sa_data; 304 int err; 305 306 /* call only for ibss! */ 307 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC)) 308 return -EINVAL; 309 310 if (!wiphy_to_dev(wdev->wiphy)->ops->join_ibss) 311 return -EOPNOTSUPP; 312 313 if (ap_addr->sa_family != ARPHRD_ETHER) 314 return -EINVAL; 315 316 /* automatic mode */ 317 if (is_zero_ether_addr(bssid) || is_broadcast_ether_addr(bssid)) 318 bssid = NULL; 319 320 /* both automatic */ 321 if (!bssid && !wdev->wext.ibss.bssid) 322 return 0; 323 324 /* fixed already - and no change */ 325 if (wdev->wext.ibss.bssid && bssid && 326 compare_ether_addr(bssid, wdev->wext.ibss.bssid) == 0) 327 return 0; 328 329 if (wdev->ssid_len) { 330 err = cfg80211_leave_ibss(wiphy_to_dev(wdev->wiphy), 331 dev, true); 332 if (err) 333 return err; 334 } 335 336 if (bssid) { 337 memcpy(wdev->wext.bssid, bssid, ETH_ALEN); 338 wdev->wext.ibss.bssid = wdev->wext.bssid; 339 } else 340 wdev->wext.ibss.bssid = NULL; 341 342 return cfg80211_ibss_wext_join(wiphy_to_dev(wdev->wiphy), wdev); 343 } 344 /* temporary symbol - mark GPL - in the future the handler won't be */ 345 EXPORT_SYMBOL_GPL(cfg80211_ibss_wext_siwap); 346 347 int cfg80211_ibss_wext_giwap(struct net_device *dev, 348 struct iw_request_info *info, 349 struct sockaddr *ap_addr, char *extra) 350 { 351 struct wireless_dev *wdev = dev->ieee80211_ptr; 352 353 /* call only for ibss! */ 354 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC)) 355 return -EINVAL; 356 357 ap_addr->sa_family = ARPHRD_ETHER; 358 359 if (wdev->wext.ibss.bssid) { 360 memcpy(ap_addr->sa_data, wdev->wext.ibss.bssid, ETH_ALEN); 361 return 0; 362 } 363 364 memcpy(ap_addr->sa_data, wdev->bssid, ETH_ALEN); 365 return 0; 366 } 367 /* temporary symbol - mark GPL - in the future the handler won't be */ 368 EXPORT_SYMBOL_GPL(cfg80211_ibss_wext_giwap); 369 #endif 370