| 1 |
/* |
| 2 |
* FST module implementation |
| 3 |
* Copyright (c) 2014, Qualcomm Atheros, Inc. |
| 4 |
* |
| 5 |
* This software may be distributed under the terms of the BSD license. |
| 6 |
* See README for more details. |
| 7 |
*/ |
| 8 |
|
| 9 |
#include "utils/includes.h" |
| 10 |
|
| 11 |
#include "utils/common.h" |
| 12 |
#include "utils/eloop.h" |
| 13 |
#include "fst/fst.h" |
| 14 |
#include "fst/fst_internal.h" |
| 15 |
#include "fst/fst_defs.h" |
| 16 |
#include "fst/fst_ctrl_iface.h" |
| 17 |
|
| 18 |
static int fst_global_initialized = 0; |
| 19 |
struct dl_list fst_global_ctrls_list; |
| 20 |
|
| 21 |
|
| 22 |
static void fst_ctrl_iface_notify_peer_state_change(struct fst_iface *iface, |
| 23 |
bool connected, |
| 24 |
const u8 *peer_addr) |
| 25 |
{ |
| 26 |
union fst_event_extra extra; |
| 27 |
|
| 28 |
extra.peer_state.connected = connected; |
| 29 |
os_strlcpy(extra.peer_state.ifname, fst_iface_get_name(iface), |
| 30 |
sizeof(extra.peer_state.ifname)); |
| 31 |
os_memcpy(extra.peer_state.addr, peer_addr, ETH_ALEN); |
| 32 |
|
| 33 |
foreach_fst_ctrl_call(on_event, EVENT_PEER_STATE_CHANGED, |
| 34 |
iface, NULL, &extra); |
| 35 |
} |
| 36 |
|
| 37 |
|
| 38 |
struct fst_iface * fst_attach(const char *ifname, const u8 *own_addr, |
| 39 |
const struct fst_wpa_obj *iface_obj, |
| 40 |
const struct fst_iface_cfg *cfg) |
| 41 |
{ |
| 42 |
struct fst_group *g; |
| 43 |
struct fst_group *group = NULL; |
| 44 |
struct fst_iface *iface = NULL; |
| 45 |
bool new_group = false; |
| 46 |
|
| 47 |
WPA_ASSERT(ifname != NULL); |
| 48 |
WPA_ASSERT(iface_obj != NULL); |
| 49 |
WPA_ASSERT(cfg != NULL); |
| 50 |
|
| 51 |
foreach_fst_group(g) { |
| 52 |
if (os_strcmp(cfg->group_id, fst_group_get_id(g)) == 0) { |
| 53 |
group = g; |
| 54 |
break; |
| 55 |
} |
| 56 |
} |
| 57 |
|
| 58 |
if (!group) { |
| 59 |
group = fst_group_create(cfg->group_id); |
| 60 |
if (!group) { |
| 61 |
fst_printf(MSG_ERROR, "%s: FST group cannot be created", |
| 62 |
cfg->group_id); |
| 63 |
return NULL; |
| 64 |
} |
| 65 |
new_group = true; |
| 66 |
} |
| 67 |
|
| 68 |
iface = fst_iface_create(group, ifname, own_addr, iface_obj, cfg); |
| 69 |
if (!iface) { |
| 70 |
fst_printf_group(group, MSG_ERROR, "cannot create iface for %s", |
| 71 |
ifname); |
| 72 |
if (new_group) |
| 73 |
fst_group_delete(group); |
| 74 |
return NULL; |
| 75 |
} |
| 76 |
|
| 77 |
fst_group_attach_iface(group, iface); |
| 78 |
fst_group_update_ie(group); |
| 79 |
|
| 80 |
foreach_fst_ctrl_call(on_iface_added, iface); |
| 81 |
|
| 82 |
fst_printf_iface(iface, MSG_DEBUG, |
| 83 |
"iface attached to group %s (prio=%d, llt=%d)", |
| 84 |
cfg->group_id, cfg->priority, cfg->llt); |
| 85 |
|
| 86 |
return iface; |
| 87 |
} |
| 88 |
|
| 89 |
|
| 90 |
void fst_detach(struct fst_iface *iface) |
| 91 |
{ |
| 92 |
struct fst_group *group = fst_iface_get_group(iface); |
| 93 |
|
| 94 |
fst_printf_iface(iface, MSG_DEBUG, "iface detached from group %s", |
| 95 |
fst_group_get_id(group)); |
| 96 |
fst_session_global_on_iface_detached(iface); |
| 97 |
foreach_fst_ctrl_call(on_iface_removed, iface); |
| 98 |
fst_group_detach_iface(group, iface); |
| 99 |
fst_iface_delete(iface); |
| 100 |
fst_group_update_ie(group); |
| 101 |
fst_group_delete_if_empty(group); |
| 102 |
} |
| 103 |
|
| 104 |
|
| 105 |
int fst_global_init(void) |
| 106 |
{ |
| 107 |
dl_list_init(&fst_global_groups_list); |
| 108 |
dl_list_init(&fst_global_ctrls_list); |
| 109 |
fst_session_global_init(); |
| 110 |
fst_global_initialized = 1; |
| 111 |
return 0; |
| 112 |
} |
| 113 |
|
| 114 |
|
| 115 |
void fst_global_deinit(void) |
| 116 |
{ |
| 117 |
struct fst_group *group; |
| 118 |
struct fst_ctrl_handle *h; |
| 119 |
|
| 120 |
if (!fst_global_initialized) |
| 121 |
return; |
| 122 |
|
| 123 |
fst_session_global_deinit(); |
| 124 |
while ((group = fst_first_group()) != NULL) |
| 125 |
fst_group_delete(group); |
| 126 |
while ((h = dl_list_first(&fst_global_ctrls_list, |
| 127 |
struct fst_ctrl_handle, |
| 128 |
global_ctrls_lentry))) |
| 129 |
fst_global_del_ctrl(h); |
| 130 |
fst_global_initialized = 0; |
| 131 |
} |
| 132 |
|
| 133 |
|
| 134 |
struct fst_ctrl_handle * fst_global_add_ctrl(const struct fst_ctrl *ctrl) |
| 135 |
{ |
| 136 |
struct fst_ctrl_handle *h; |
| 137 |
|
| 138 |
if (!ctrl) |
| 139 |
return NULL; |
| 140 |
|
| 141 |
h = os_zalloc(sizeof(*h)); |
| 142 |
if (!h) |
| 143 |
return NULL; |
| 144 |
|
| 145 |
if (ctrl->init && ctrl->init()) { |
| 146 |
os_free(h); |
| 147 |
return NULL; |
| 148 |
} |
| 149 |
|
| 150 |
h->ctrl = *ctrl; |
| 151 |
dl_list_add_tail(&fst_global_ctrls_list, &h->global_ctrls_lentry); |
| 152 |
|
| 153 |
return h; |
| 154 |
} |
| 155 |
|
| 156 |
|
| 157 |
void fst_global_del_ctrl(struct fst_ctrl_handle *h) |
| 158 |
{ |
| 159 |
dl_list_del(&h->global_ctrls_lentry); |
| 160 |
if (h->ctrl.deinit) |
| 161 |
h->ctrl.deinit(); |
| 162 |
os_free(h); |
| 163 |
} |
| 164 |
|
| 165 |
|
| 166 |
void fst_rx_action(struct fst_iface *iface, const struct ieee80211_mgmt *mgmt, |
| 167 |
size_t len) |
| 168 |
{ |
| 169 |
if (fst_iface_is_connected(iface, mgmt->sa, false)) |
| 170 |
fst_session_on_action_rx(iface, mgmt, len); |
| 171 |
else |
| 172 |
wpa_printf(MSG_DEBUG, |
| 173 |
"FST: Ignore FST Action frame - no FST connection with " |
| 174 |
MACSTR, MAC2STR(mgmt->sa)); |
| 175 |
} |
| 176 |
|
| 177 |
|
| 178 |
void fst_notify_peer_connected(struct fst_iface *iface, const u8 *addr) |
| 179 |
{ |
| 180 |
if (is_zero_ether_addr(addr)) |
| 181 |
return; |
| 182 |
|
| 183 |
#ifndef HOSTAPD |
| 184 |
fst_group_update_ie(fst_iface_get_group(iface)); |
| 185 |
#endif /* HOSTAPD */ |
| 186 |
|
| 187 |
fst_printf_iface(iface, MSG_DEBUG, MACSTR " became connected", |
| 188 |
MAC2STR(addr)); |
| 189 |
|
| 190 |
fst_ctrl_iface_notify_peer_state_change(iface, true, addr); |
| 191 |
} |
| 192 |
|
| 193 |
|
| 194 |
void fst_notify_peer_disconnected(struct fst_iface *iface, const u8 *addr) |
| 195 |
{ |
| 196 |
if (is_zero_ether_addr(addr)) |
| 197 |
return; |
| 198 |
|
| 199 |
#ifndef HOSTAPD |
| 200 |
fst_group_update_ie(fst_iface_get_group(iface)); |
| 201 |
#endif /* HOSTAPD */ |
| 202 |
|
| 203 |
fst_printf_iface(iface, MSG_DEBUG, MACSTR " became disconnected", |
| 204 |
MAC2STR(addr)); |
| 205 |
|
| 206 |
fst_ctrl_iface_notify_peer_state_change(iface, false, addr); |
| 207 |
} |
| 208 |
|
| 209 |
|
| 210 |
bool fst_are_ifaces_aggregated(struct fst_iface *iface1, |
| 211 |
struct fst_iface *iface2) |
| 212 |
{ |
| 213 |
return fst_iface_get_group(iface1) == fst_iface_get_group(iface2); |
| 214 |
} |
| 215 |
|
| 216 |
|
| 217 |
void fst_update_mac_addr(struct fst_iface *iface, const u8 *addr) |
| 218 |
{ |
| 219 |
fst_printf_iface(iface, MSG_DEBUG, "new MAC address " MACSTR, |
| 220 |
MAC2STR(addr)); |
| 221 |
os_memcpy(iface->own_addr, addr, sizeof(iface->own_addr)); |
| 222 |
fst_group_update_ie(fst_iface_get_group(iface)); |
| 223 |
} |
| 224 |
|
| 225 |
|
| 226 |
enum mb_band_id fst_hw_mode_to_band(enum hostapd_hw_mode mode) |
| 227 |
{ |
| 228 |
switch (mode) { |
| 229 |
case HOSTAPD_MODE_IEEE80211B: |
| 230 |
case HOSTAPD_MODE_IEEE80211G: |
| 231 |
return MB_BAND_ID_WIFI_2_4GHZ; |
| 232 |
case HOSTAPD_MODE_IEEE80211A: |
| 233 |
return MB_BAND_ID_WIFI_5GHZ; |
| 234 |
case HOSTAPD_MODE_IEEE80211AD: |
| 235 |
return MB_BAND_ID_WIFI_60GHZ; |
| 236 |
default: |
| 237 |
WPA_ASSERT(0); |
| 238 |
return MB_BAND_ID_WIFI_2_4GHZ; |
| 239 |
} |
| 240 |
} |