1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630 |
- /*
- * FST module - FST Session implementation
- * Copyright (c) 2014, Qualcomm Atheros, Inc.
- *
- * This software may be distributed under the terms of the BSD license.
- * See README for more details.
- */
- #include "utils/includes.h"
- #include "utils/common.h"
- #include "utils/eloop.h"
- #include "common/defs.h"
- #include "fst/fst_internal.h"
- #include "fst/fst_defs.h"
- #include "fst/fst_ctrl_iface.h"
- #ifdef CONFIG_FST_TEST
- #include "fst/fst_ctrl_defs.h"
- #endif /* CONFIG_FST_TEST */
- #define US_80211_TU 1024
- #define US_TO_TU(m) ((m) * / US_80211_TU)
- #define TU_TO_US(m) ((m) * US_80211_TU)
- #define FST_LLT_SWITCH_IMMEDIATELY 0
- #define fst_printf_session(s, level, format, ...) \
- fst_printf((level), "%u (0x%08x): [" MACSTR "," MACSTR "] :" format, \
- (s)->id, (s)->data.fsts_id, \
- MAC2STR((s)->data.old_peer_addr), \
- MAC2STR((s)->data.new_peer_addr), \
- ##__VA_ARGS__)
- #define fst_printf_siface(s, iface, level, format, ...) \
- fst_printf_session((s), (level), "%s: " format, \
- fst_iface_get_name(iface), ##__VA_ARGS__)
- #define fst_printf_sframe(s, is_old, level, format, ...) \
- fst_printf_siface((s), \
- (is_old) ? (s)->data.old_iface : (s)->data.new_iface, \
- (level), format, ##__VA_ARGS__)
- #define FST_LLT_MS_DEFAULT 50
- #define FST_ACTION_MAX_SUPPORTED FST_ACTION_ON_CHANNEL_TUNNEL
- const char * const fst_action_names[] = {
- [FST_ACTION_SETUP_REQUEST] = "Setup Request",
- [FST_ACTION_SETUP_RESPONSE] = "Setup Response",
- [FST_ACTION_TEAR_DOWN] = "Tear Down",
- [FST_ACTION_ACK_REQUEST] = "Ack Request",
- [FST_ACTION_ACK_RESPONSE] = "Ack Response",
- [FST_ACTION_ON_CHANNEL_TUNNEL] = "On Channel Tunnel",
- };
- struct fst_session {
- struct {
- /* Session configuration that can be zeroed on reset */
- u8 old_peer_addr[ETH_ALEN];
- u8 new_peer_addr[ETH_ALEN];
- struct fst_iface *new_iface;
- struct fst_iface *old_iface;
- u32 llt_ms;
- u8 pending_setup_req_dlgt;
- u32 fsts_id; /* FSTS ID, see spec, 8.4.2.147
- * Session Transition element */
- } data;
- /* Session object internal fields which won't be zeroed on reset */
- struct dl_list global_sessions_lentry;
- u32 id; /* Session object ID used to identify
- * specific session object */
- struct fst_group *group;
- enum fst_session_state state;
- Boolean stt_armed;
- };
- static struct dl_list global_sessions_list;
- static u32 global_session_id = 0;
- #define foreach_fst_session(s) \
- dl_list_for_each((s), &global_sessions_list, \
- struct fst_session, global_sessions_lentry)
- #define foreach_fst_session_safe(s, temp) \
- dl_list_for_each_safe((s), (temp), &global_sessions_list, \
- struct fst_session, global_sessions_lentry)
- static void fst_session_global_inc_id(void)
- {
- global_session_id++;
- if (global_session_id == FST_INVALID_SESSION_ID)
- global_session_id++;
- }
- int fst_session_global_init(void)
- {
- dl_list_init(&global_sessions_list);
- return 0;
- }
- void fst_session_global_deinit(void)
- {
- WPA_ASSERT(dl_list_empty(&global_sessions_list));
- }
- static inline void fst_session_notify_ctrl(struct fst_session *s,
- enum fst_event_type event_type,
- union fst_event_extra *extra)
- {
- foreach_fst_ctrl_call(on_event, event_type, NULL, s, extra);
- }
- static void fst_session_set_state(struct fst_session *s,
- enum fst_session_state state,
- union fst_session_state_switch_extra *extra)
- {
- if (s->state != state) {
- union fst_event_extra evext = {
- .session_state = {
- .old_state = s->state,
- .new_state = state,
- },
- };
- if (extra)
- evext.session_state.extra = *extra;
- fst_session_notify_ctrl(s, EVENT_FST_SESSION_STATE_CHANGED,
- &evext);
- fst_printf_session(s, MSG_INFO, "State: %s => %s",
- fst_session_state_name(s->state),
- fst_session_state_name(state));
- s->state = state;
- }
- }
- static u32 fst_find_free_session_id(void)
- {
- u32 i, id = FST_INVALID_SESSION_ID;
- struct fst_session *s;
- for (i = 0; i < (u32) -1; i++) {
- Boolean in_use = FALSE;
- foreach_fst_session(s) {
- if (s->id == global_session_id) {
- fst_session_global_inc_id();
- in_use = TRUE;
- break;
- }
- }
- if (!in_use) {
- id = global_session_id;
- fst_session_global_inc_id();
- break;
- }
- }
- return id;
- }
- static void fst_session_timeout_handler(void *eloop_data, void *user_ctx)
- {
- struct fst_session *s = user_ctx;
- union fst_session_state_switch_extra extra = {
- .to_initial = {
- .reason = REASON_STT,
- },
- };
- fst_printf_session(s, MSG_WARNING, "Session State Timeout");
- fst_session_set_state(s, FST_SESSION_STATE_INITIAL, &extra);
- }
- static void fst_session_stt_arm(struct fst_session *s)
- {
- /* Action frames sometimes get delayed. Use relaxed timeout (2*) */
- eloop_register_timeout(0, 2 * TU_TO_US(FST_DEFAULT_SESSION_TIMEOUT_TU),
- fst_session_timeout_handler, NULL, s);
- s->stt_armed = TRUE;
- }
- static void fst_session_stt_disarm(struct fst_session *s)
- {
- if (s->stt_armed) {
- eloop_cancel_timeout(fst_session_timeout_handler, NULL, s);
- s->stt_armed = FALSE;
- }
- }
- static Boolean fst_session_is_in_transition(struct fst_session *s)
- {
- /* See spec, 10.32.2.2 Transitioning between states */
- return s->stt_armed;
- }
- static int fst_session_is_in_progress(struct fst_session *s)
- {
- return s->state != FST_SESSION_STATE_INITIAL;
- }
- static int fst_session_is_ready_pending(struct fst_session *s)
- {
- return s->state == FST_SESSION_STATE_SETUP_COMPLETION &&
- fst_session_is_in_transition(s);
- }
- static int fst_session_is_ready(struct fst_session *s)
- {
- return s->state == FST_SESSION_STATE_SETUP_COMPLETION &&
- !fst_session_is_in_transition(s);
- }
- static int fst_session_is_switch_requested(struct fst_session *s)
- {
- return s->state == FST_SESSION_STATE_TRANSITION_DONE &&
- fst_session_is_in_transition(s);
- }
- static struct fst_session *
- fst_find_session_in_progress(const u8 *peer_addr, struct fst_group *g)
- {
- struct fst_session *s;
- foreach_fst_session(s) {
- if (s->group == g &&
- (os_memcmp(s->data.old_peer_addr, peer_addr,
- ETH_ALEN) == 0 ||
- os_memcmp(s->data.new_peer_addr, peer_addr,
- ETH_ALEN) == 0) &&
- fst_session_is_in_progress(s))
- return s;
- }
- return NULL;
- }
- static void fst_session_reset_ex(struct fst_session *s, enum fst_reason reason)
- {
- union fst_session_state_switch_extra evext = {
- .to_initial = {
- .reason = reason,
- },
- };
- if (s->state == FST_SESSION_STATE_SETUP_COMPLETION ||
- s->state == FST_SESSION_STATE_TRANSITION_DONE)
- fst_session_tear_down_setup(s);
- fst_session_stt_disarm(s);
- os_memset(&s->data, 0, sizeof(s->data));
- fst_session_set_state(s, FST_SESSION_STATE_INITIAL, &evext);
- }
- static int fst_session_send_action(struct fst_session *s, Boolean old_iface,
- const void *payload, size_t size,
- const struct wpabuf *extra_buf)
- {
- size_t len;
- int res;
- struct wpabuf *buf;
- u8 action;
- struct fst_iface *iface =
- old_iface ? s->data.old_iface : s->data.new_iface;
- WPA_ASSERT(payload != NULL);
- WPA_ASSERT(size != 0);
- action = *(const u8 *) payload;
- WPA_ASSERT(action <= FST_ACTION_MAX_SUPPORTED);
- if (!iface) {
- fst_printf_session(s, MSG_ERROR,
- "no %s interface for FST Action '%s' sending",
- old_iface ? "old" : "new",
- fst_action_names[action]);
- return -1;
- }
- len = sizeof(u8) /* category */ + size;
- if (extra_buf)
- len += wpabuf_size(extra_buf);
- buf = wpabuf_alloc(len);
- if (!buf) {
- fst_printf_session(s, MSG_ERROR,
- "cannot allocate buffer of %zu bytes for FST Action '%s' sending",
- len, fst_action_names[action]);
- return -1;
- }
- wpabuf_put_u8(buf, WLAN_ACTION_FST);
- wpabuf_put_data(buf, payload, size);
- if (extra_buf)
- wpabuf_put_buf(buf, extra_buf);
- res = fst_iface_send_action(iface,
- old_iface ? s->data.old_peer_addr :
- s->data.new_peer_addr, buf);
- if (res < 0)
- fst_printf_siface(s, iface, MSG_ERROR,
- "failed to send FST Action '%s'",
- fst_action_names[action]);
- else
- fst_printf_siface(s, iface, MSG_DEBUG, "FST Action '%s' sent",
- fst_action_names[action]);
- wpabuf_free(buf);
- return res;
- }
- static int fst_session_send_tear_down(struct fst_session *s)
- {
- struct fst_tear_down td;
- int res;
- if (!fst_session_is_in_progress(s)) {
- fst_printf_session(s, MSG_ERROR, "No FST setup to tear down");
- return -1;
- }
- WPA_ASSERT(s->data.old_iface != NULL);
- WPA_ASSERT(s->data.new_iface != NULL);
- os_memset(&td, 0, sizeof(td));
- td.action = FST_ACTION_TEAR_DOWN;
- td.fsts_id = host_to_le32(s->data.fsts_id);
- res = fst_session_send_action(s, TRUE, &td, sizeof(td), NULL);
- if (!res)
- fst_printf_sframe(s, TRUE, MSG_INFO, "FST TearDown sent");
- else
- fst_printf_sframe(s, TRUE, MSG_ERROR,
- "failed to send FST TearDown");
- return res;
- }
- static void fst_session_handle_setup_request(struct fst_iface *iface,
- const struct ieee80211_mgmt *mgmt,
- size_t frame_len)
- {
- struct fst_session *s;
- const struct fst_setup_req *req;
- struct fst_iface *new_iface = NULL;
- struct fst_group *g;
- u8 new_iface_peer_addr[ETH_ALEN];
- const struct wpabuf *peer_mbies;
- size_t plen;
- if (frame_len < IEEE80211_HDRLEN + 1 + sizeof(*req)) {
- fst_printf_iface(iface, MSG_WARNING,
- "FST Request dropped: too short (%zu < %zu)",
- frame_len,
- IEEE80211_HDRLEN + 1 + sizeof(*req));
- return;
- }
- plen = frame_len - IEEE80211_HDRLEN - 1;
- req = (const struct fst_setup_req *)
- (((const u8 *) mgmt) + IEEE80211_HDRLEN + 1);
- if (req->stie.element_id != WLAN_EID_SESSION_TRANSITION ||
- req->stie.length < 11) {
- fst_printf_iface(iface, MSG_WARNING,
- "FST Request dropped: invalid STIE");
- return;
- }
- if (req->stie.new_band_id == req->stie.old_band_id) {
- fst_printf_iface(iface, MSG_WARNING,
- "FST Request dropped: new and old band IDs are the same");
- return;
- }
- g = fst_iface_get_group(iface);
- if (plen > sizeof(*req)) {
- fst_iface_update_mb_ie(iface, mgmt->sa, (const u8 *) (req + 1),
- plen - sizeof(*req));
- fst_printf_iface(iface, MSG_INFO,
- "FST Request: MB IEs updated for " MACSTR,
- MAC2STR(mgmt->sa));
- }
- peer_mbies = fst_iface_get_peer_mb_ie(iface, mgmt->sa);
- if (peer_mbies) {
- new_iface = fst_group_get_new_iface_by_stie_and_mbie(
- g, wpabuf_head(peer_mbies), wpabuf_len(peer_mbies),
- &req->stie, new_iface_peer_addr);
- if (new_iface)
- fst_printf_iface(iface, MSG_INFO,
- "FST Request: new iface (%s:" MACSTR
- ") found by MB IEs",
- fst_iface_get_name(new_iface),
- MAC2STR(new_iface_peer_addr));
- }
- if (!new_iface) {
- new_iface = fst_group_find_new_iface_by_stie(
- g, iface, mgmt->sa, &req->stie,
- new_iface_peer_addr);
- if (new_iface)
- fst_printf_iface(iface, MSG_INFO,
- "FST Request: new iface (%s:" MACSTR
- ") found by others",
- fst_iface_get_name(new_iface),
- MAC2STR(new_iface_peer_addr));
- }
- if (!new_iface) {
- fst_printf_iface(iface, MSG_WARNING,
- "FST Request dropped: new iface not found");
- return;
- }
- s = fst_find_session_in_progress(mgmt->sa, g);
- if (s) {
- union fst_session_state_switch_extra evext = {
- .to_initial = {
- .reason = REASON_SETUP,
- },
- };
- /*
- * 10.32.2.2 Transitioning between states:
- * Upon receipt of an FST Setup Request frame, the responder
- * shall respond with an FST Setup Response frame unless it has
- * a pending FST Setup Request frame addressed to the initiator
- * and the responder has a numerically larger MAC address than
- * the initiator’s MAC address, in which case, the responder
- * shall delete the received FST Setup Request.
- */
- if (fst_session_is_ready_pending(s) &&
- /* waiting for Setup Response */
- os_memcmp(mgmt->da, mgmt->sa, ETH_ALEN) > 0) {
- fst_printf_session(s, MSG_WARNING,
- "FST Request dropped due to MAC comparison (our MAC is "
- MACSTR ")",
- MAC2STR(mgmt->da));
- return;
- }
- /*
- * State is SETUP_COMPLETION (either in transition or not) or
- * TRANSITION_DONE (in transition).
- * Setup Request arriving in this state could mean:
- * 1. peer sent it before receiving our Setup Request (race
- * condition)
- * 2. peer didn't receive our Setup Response. Peer is retrying
- * after STT timeout
- * 3. peer's FST state machines are out of sync due to some
- * other reason
- *
- * We will reset our session and create a new one instead.
- */
- fst_printf_session(s, MSG_WARNING,
- "resetting due to FST request");
- /*
- * If FST Setup Request arrived with the same FSTS ID as one we
- * initialized before, there's no need to tear down the session.
- * Moreover, as FSTS ID is the same, the other side will
- * associate this tear down with the session it initiated that
- * will break the sync.
- */
- if (le_to_host32(req->stie.fsts_id) != s->data.fsts_id)
- fst_session_send_tear_down(s);
- else
- fst_printf_session(s, MSG_WARNING,
- "Skipping TearDown as the FST request has the same FSTS ID as initiated");
- fst_session_set_state(s, FST_SESSION_STATE_INITIAL, &evext);
- fst_session_stt_disarm(s);
- }
- s = fst_session_create(g);
- if (!s) {
- fst_printf(MSG_WARNING,
- "FST Request dropped: cannot create session for %s and %s",
- fst_iface_get_name(iface),
- fst_iface_get_name(new_iface));
- return;
- }
- fst_session_set_iface(s, iface, TRUE);
- fst_session_set_peer_addr(s, mgmt->sa, TRUE);
- fst_session_set_iface(s, new_iface, FALSE);
- fst_session_set_peer_addr(s, new_iface_peer_addr, FALSE);
- fst_session_set_llt(s, FST_LLT_VAL_TO_MS(le_to_host32(req->llt)));
- s->data.pending_setup_req_dlgt = req->dialog_token;
- s->data.fsts_id = le_to_host32(req->stie.fsts_id);
- fst_session_stt_arm(s);
- fst_session_notify_ctrl(s, EVENT_FST_SETUP, NULL);
- fst_session_set_state(s, FST_SESSION_STATE_SETUP_COMPLETION, NULL);
- }
- static void fst_session_handle_setup_response(struct fst_session *s,
- struct fst_iface *iface,
- const struct ieee80211_mgmt *mgmt,
- size_t frame_len)
- {
- const struct fst_setup_res *res;
- size_t plen = frame_len - IEEE80211_HDRLEN - 1;
- enum hostapd_hw_mode hw_mode;
- u8 channel;
- union fst_session_state_switch_extra evext = {
- .to_initial = {
- .reject_code = 0,
- },
- };
- if (iface != s->data.old_iface) {
- fst_printf_session(s, MSG_WARNING,
- "FST Response dropped: %s is not the old iface",
- fst_iface_get_name(iface));
- return;
- }
- if (!fst_session_is_ready_pending(s)) {
- fst_printf_session(s, MSG_WARNING,
- "FST Response dropped due to wrong state: %s",
- fst_session_state_name(s->state));
- return;
- }
- if (plen < sizeof(*res)) {
- fst_printf_session(s, MSG_WARNING,
- "Too short FST Response dropped");
- return;
- }
- res = (const struct fst_setup_res *)
- (((const u8 *) mgmt) + IEEE80211_HDRLEN + 1);
- if (res->stie.element_id != WLAN_EID_SESSION_TRANSITION ||
- res->stie.length < 11) {
- fst_printf_iface(iface, MSG_WARNING,
- "FST Response dropped: invalid STIE");
- return;
- }
- if (res->dialog_token != s->data.pending_setup_req_dlgt) {
- fst_printf_session(s, MSG_WARNING,
- "FST Response dropped due to wrong dialog token (%u != %u)",
- s->data.pending_setup_req_dlgt,
- res->dialog_token);
- return;
- }
- if (res->status_code == WLAN_STATUS_SUCCESS &&
- le_to_host32(res->stie.fsts_id) != s->data.fsts_id) {
- fst_printf_session(s, MSG_WARNING,
- "FST Response dropped due to wrong FST Session ID (%u)",
- le_to_host32(res->stie.fsts_id));
- return;
- }
- fst_session_stt_disarm(s);
- if (res->status_code != WLAN_STATUS_SUCCESS) {
- /*
- * 10.32.2.2 Transitioning between states
- * The initiator shall set the STT to the value of the
- * FSTSessionTimeOut field at ... and at each ACK frame sent in
- * response to a received FST Setup Response with the Status
- * Code field equal to PENDING_ADMITTING_FST_SESSION or
- * PENDING_GAP_IN_BA_WINDOW.
- */
- evext.to_initial.reason = REASON_REJECT;
- evext.to_initial.reject_code = res->status_code;
- evext.to_initial.initiator = FST_INITIATOR_REMOTE;
- fst_session_set_state(s, FST_SESSION_STATE_INITIAL, &evext);
- fst_printf_session(s, MSG_WARNING,
- "FST Setup rejected by remote side with status %u",
- res->status_code);
- return;
- }
- fst_iface_get_channel_info(s->data.new_iface, &hw_mode, &channel);
- if (fst_hw_mode_to_band(hw_mode) != res->stie.new_band_id) {
- evext.to_initial.reason = REASON_ERROR_PARAMS;
- fst_session_set_state(s, FST_SESSION_STATE_INITIAL, &evext);
- fst_printf_session(s, MSG_WARNING,
- "invalid FST Setup parameters");
- fst_session_tear_down_setup(s);
- return;
- }
- fst_printf_session(s, MSG_INFO,
- "%s: FST Setup established for %s (llt=%u)",
- fst_iface_get_name(s->data.old_iface),
- fst_iface_get_name(s->data.new_iface),
- s->data.llt_ms);
- fst_session_notify_ctrl(s, EVENT_FST_ESTABLISHED, NULL);
- if (s->data.llt_ms == FST_LLT_SWITCH_IMMEDIATELY)
- fst_session_initiate_switch(s);
- }
- static void fst_session_handle_tear_down(struct fst_session *s,
- struct fst_iface *iface,
- const struct ieee80211_mgmt *mgmt,
- size_t frame_len)
- {
- const struct fst_tear_down *td;
- size_t plen = frame_len - IEEE80211_HDRLEN - 1;
- union fst_session_state_switch_extra evext = {
- .to_initial = {
- .reason = REASON_TEARDOWN,
- .initiator = FST_INITIATOR_REMOTE,
- },
- };
- if (plen < sizeof(*td)) {
- fst_printf_session(s, MSG_WARNING,
- "Too short FST Tear Down dropped");
- return;
- }
- td = (const struct fst_tear_down *)
- (((const u8 *) mgmt) + IEEE80211_HDRLEN + 1);
- if (le_to_host32(td->fsts_id) != s->data.fsts_id) {
- fst_printf_siface(s, iface, MSG_WARNING,
- "tear down for wrong FST Setup ID (%u)",
- le_to_host32(td->fsts_id));
- return;
- }
- fst_session_stt_disarm(s);
- fst_session_set_state(s, FST_SESSION_STATE_INITIAL, &evext);
- }
- static void fst_session_handle_ack_request(struct fst_session *s,
- struct fst_iface *iface,
- const struct ieee80211_mgmt *mgmt,
- size_t frame_len)
- {
- const struct fst_ack_req *req;
- size_t plen = frame_len - IEEE80211_HDRLEN - 1;
- struct fst_ack_res res;
- union fst_session_state_switch_extra evext = {
- .to_initial = {
- .reason = REASON_SWITCH,
- .initiator = FST_INITIATOR_REMOTE,
- },
- };
- if (!fst_session_is_ready(s) && !fst_session_is_switch_requested(s)) {
- fst_printf_siface(s, iface, MSG_ERROR,
- "cannot initiate switch due to wrong session state (%s)",
- fst_session_state_name(s->state));
- return;
- }
- WPA_ASSERT(s->data.new_iface != NULL);
- if (iface != s->data.new_iface) {
- fst_printf_siface(s, iface, MSG_ERROR,
- "Ack received on wrong interface");
- return;
- }
- if (plen < sizeof(*req)) {
- fst_printf_session(s, MSG_WARNING,
- "Too short FST Ack Request dropped");
- return;
- }
- req = (const struct fst_ack_req *)
- (((const u8 *) mgmt) + IEEE80211_HDRLEN + 1);
- if (le_to_host32(req->fsts_id) != s->data.fsts_id) {
- fst_printf_siface(s, iface, MSG_WARNING,
- "Ack for wrong FST Setup ID (%u)",
- le_to_host32(req->fsts_id));
- return;
- }
- os_memset(&res, 0, sizeof(res));
- res.action = FST_ACTION_ACK_RESPONSE;
- res.dialog_token = req->dialog_token;
- res.fsts_id = req->fsts_id;
- if (!fst_session_send_action(s, FALSE, &res, sizeof(res), NULL)) {
- fst_printf_sframe(s, FALSE, MSG_INFO, "FST Ack Response sent");
- fst_session_stt_disarm(s);
- fst_session_set_state(s, FST_SESSION_STATE_TRANSITION_DONE,
- NULL);
- fst_session_set_state(s, FST_SESSION_STATE_TRANSITION_CONFIRMED,
- NULL);
- fst_session_set_state(s, FST_SESSION_STATE_INITIAL, &evext);
- }
- }
- static void
- fst_session_handle_ack_response(struct fst_session *s,
- struct fst_iface *iface,
- const struct ieee80211_mgmt *mgmt,
- size_t frame_len)
- {
- const struct fst_ack_res *res;
- size_t plen = frame_len - IEEE80211_HDRLEN - 1;
- union fst_session_state_switch_extra evext = {
- .to_initial = {
- .reason = REASON_SWITCH,
- .initiator = FST_INITIATOR_LOCAL,
- },
- };
- if (!fst_session_is_switch_requested(s)) {
- fst_printf_siface(s, iface, MSG_ERROR,
- "Ack Response in inappropriate session state (%s)",
- fst_session_state_name(s->state));
- return;
- }
- WPA_ASSERT(s->data.new_iface != NULL);
- if (iface != s->data.new_iface) {
- fst_printf_siface(s, iface, MSG_ERROR,
- "Ack response received on wrong interface");
- return;
- }
- if (plen < sizeof(*res)) {
- fst_printf_session(s, MSG_WARNING,
- "Too short FST Ack Response dropped");
- return;
- }
- res = (const struct fst_ack_res *)
- (((const u8 *) mgmt) + IEEE80211_HDRLEN + 1);
- if (le_to_host32(res->fsts_id) != s->data.fsts_id) {
- fst_printf_siface(s, iface, MSG_ERROR,
- "Ack response for wrong FST Setup ID (%u)",
- le_to_host32(res->fsts_id));
- return;
- }
- fst_session_set_state(s, FST_SESSION_STATE_TRANSITION_CONFIRMED, NULL);
- fst_session_set_state(s, FST_SESSION_STATE_INITIAL, &evext);
- fst_session_stt_disarm(s);
- }
- struct fst_session * fst_session_create(struct fst_group *g)
- {
- struct fst_session *s;
- u32 id;
- WPA_ASSERT(!is_zero_ether_addr(own_addr));
- id = fst_find_free_session_id();
- if (id == FST_INVALID_SESSION_ID) {
- fst_printf(MSG_ERROR, "Cannot assign new session ID");
- return NULL;
- }
- s = os_zalloc(sizeof(*s));
- if (!s) {
- fst_printf(MSG_ERROR, "Cannot allocate new session object");
- return NULL;
- }
- s->id = id;
- s->group = g;
- s->state = FST_SESSION_STATE_INITIAL;
- s->data.llt_ms = FST_LLT_MS_DEFAULT;
- fst_printf(MSG_INFO, "Session %u created", s->id);
- dl_list_add_tail(&global_sessions_list, &s->global_sessions_lentry);
- foreach_fst_ctrl_call(on_session_added, s);
- return s;
- }
- void fst_session_set_iface(struct fst_session *s, struct fst_iface *iface,
- Boolean is_old)
- {
- if (is_old)
- s->data.old_iface = iface;
- else
- s->data.new_iface = iface;
- }
- void fst_session_set_llt(struct fst_session *s, u32 llt)
- {
- s->data.llt_ms = llt;
- }
- void fst_session_set_peer_addr(struct fst_session *s, const u8 *addr,
- Boolean is_old)
- {
- u8 *a = is_old ? s->data.old_peer_addr : s->data.new_peer_addr;
- os_memcpy(a, addr, ETH_ALEN);
- }
- int fst_session_initiate_setup(struct fst_session *s)
- {
- struct fst_setup_req req;
- int res;
- u32 fsts_id;
- u8 dialog_token;
- struct fst_session *_s;
- if (fst_session_is_in_progress(s)) {
- fst_printf_session(s, MSG_ERROR, "Session in progress");
- return -EINVAL;
- }
- if (is_zero_ether_addr(s->data.old_peer_addr)) {
- fst_printf_session(s, MSG_ERROR, "No old peer MAC address");
- return -EINVAL;
- }
- if (is_zero_ether_addr(s->data.new_peer_addr)) {
- fst_printf_session(s, MSG_ERROR, "No new peer MAC address");
- return -EINVAL;
- }
- if (!s->data.old_iface) {
- fst_printf_session(s, MSG_ERROR, "No old interface defined");
- return -EINVAL;
- }
- if (!s->data.new_iface) {
- fst_printf_session(s, MSG_ERROR, "No new interface defined");
- return -EINVAL;
- }
- if (s->data.new_iface == s->data.old_iface) {
- fst_printf_session(s, MSG_ERROR,
- "Same interface set as old and new");
- return -EINVAL;
- }
- if (!fst_iface_is_connected(s->data.old_iface, s->data.old_peer_addr,
- FALSE)) {
- fst_printf_session(s, MSG_ERROR,
- "The preset old peer address is not connected");
- return -EINVAL;
- }
- if (!fst_iface_is_connected(s->data.new_iface, s->data.new_peer_addr,
- FALSE)) {
- fst_printf_session(s, MSG_ERROR,
- "The preset new peer address is not connected");
- return -EINVAL;
- }
- _s = fst_find_session_in_progress(s->data.old_peer_addr, s->group);
- if (_s) {
- fst_printf_session(s, MSG_ERROR,
- "There is another session in progress (old): %u",
- _s->id);
- return -EINVAL;
- }
- _s = fst_find_session_in_progress(s->data.new_peer_addr, s->group);
- if (_s) {
- fst_printf_session(s, MSG_ERROR,
- "There is another session in progress (new): %u",
- _s->id);
- return -EINVAL;
- }
- dialog_token = fst_group_assign_dialog_token(s->group);
- fsts_id = fst_group_assign_fsts_id(s->group);
- os_memset(&req, 0, sizeof(req));
- fst_printf_siface(s, s->data.old_iface, MSG_INFO,
- "initiating FST setup for %s (llt=%u ms)",
- fst_iface_get_name(s->data.new_iface), s->data.llt_ms);
- req.action = FST_ACTION_SETUP_REQUEST;
- req.dialog_token = dialog_token;
- req.llt = host_to_le32(FST_LLT_MS_TO_VAL(s->data.llt_ms));
- /* 8.4.2.147 Session Transition element */
- req.stie.element_id = WLAN_EID_SESSION_TRANSITION;
- req.stie.length = sizeof(req.stie) - 2;
- req.stie.fsts_id = host_to_le32(fsts_id);
- req.stie.session_control = SESSION_CONTROL(SESSION_TYPE_BSS, 0);
- req.stie.new_band_id = fst_iface_get_band_id(s->data.new_iface);
- req.stie.new_band_op = 1;
- req.stie.new_band_setup = 0;
- req.stie.old_band_id = fst_iface_get_band_id(s->data.old_iface);
- req.stie.old_band_op = 1;
- req.stie.old_band_setup = 0;
- res = fst_session_send_action(s, TRUE, &req, sizeof(req),
- fst_iface_get_mbie(s->data.old_iface));
- if (!res) {
- s->data.fsts_id = fsts_id;
- s->data.pending_setup_req_dlgt = dialog_token;
- fst_printf_sframe(s, TRUE, MSG_INFO, "FST Setup Request sent");
- fst_session_set_state(s, FST_SESSION_STATE_SETUP_COMPLETION,
- NULL);
- fst_session_stt_arm(s);
- }
- return res;
- }
- int fst_session_respond(struct fst_session *s, u8 status_code)
- {
- struct fst_setup_res res;
- enum hostapd_hw_mode hw_mode;
- u8 channel;
- if (!fst_session_is_ready_pending(s)) {
- fst_printf_session(s, MSG_ERROR, "incorrect state: %s",
- fst_session_state_name(s->state));
- return -EINVAL;
- }
- if (is_zero_ether_addr(s->data.old_peer_addr)) {
- fst_printf_session(s, MSG_ERROR, "No peer MAC address");
- return -EINVAL;
- }
- if (!s->data.old_iface) {
- fst_printf_session(s, MSG_ERROR, "No old interface defined");
- return -EINVAL;
- }
- if (!s->data.new_iface) {
- fst_printf_session(s, MSG_ERROR, "No new interface defined");
- return -EINVAL;
- }
- if (s->data.new_iface == s->data.old_iface) {
- fst_printf_session(s, MSG_ERROR,
- "Same interface set as old and new");
- return -EINVAL;
- }
- if (!fst_iface_is_connected(s->data.old_iface,
- s->data.old_peer_addr, FALSE)) {
- fst_printf_session(s, MSG_ERROR,
- "The preset peer address is not in the peer list");
- return -EINVAL;
- }
- fst_session_stt_disarm(s);
- os_memset(&res, 0, sizeof(res));
- res.action = FST_ACTION_SETUP_RESPONSE;
- res.dialog_token = s->data.pending_setup_req_dlgt;
- res.status_code = status_code;
- res.stie.element_id = WLAN_EID_SESSION_TRANSITION;
- res.stie.length = sizeof(res.stie) - 2;
- if (status_code == WLAN_STATUS_SUCCESS) {
- res.stie.fsts_id = host_to_le32(s->data.fsts_id);
- res.stie.session_control = SESSION_CONTROL(SESSION_TYPE_BSS, 0);
- fst_iface_get_channel_info(s->data.new_iface, &hw_mode,
- &channel);
- res.stie.new_band_id = fst_hw_mode_to_band(hw_mode);
- res.stie.new_band_op = 1;
- res.stie.new_band_setup = 0;
- fst_iface_get_channel_info(s->data.old_iface, &hw_mode,
- &channel);
- res.stie.old_band_id = fst_hw_mode_to_band(hw_mode);
- res.stie.old_band_op = 1;
- res.stie.old_band_setup = 0;
- fst_printf_session(s, MSG_INFO,
- "%s: FST Setup Request accepted for %s (llt=%u)",
- fst_iface_get_name(s->data.old_iface),
- fst_iface_get_name(s->data.new_iface),
- s->data.llt_ms);
- } else {
- fst_printf_session(s, MSG_WARNING,
- "%s: FST Setup Request rejected with code %d",
- fst_iface_get_name(s->data.old_iface),
- status_code);
- }
- if (fst_session_send_action(s, TRUE, &res, sizeof(res),
- fst_iface_get_mbie(s->data.old_iface))) {
- fst_printf_sframe(s, TRUE, MSG_ERROR,
- "cannot send FST Setup Response with code %d",
- status_code);
- return -EINVAL;
- }
- fst_printf_sframe(s, TRUE, MSG_INFO, "FST Setup Response sent");
- if (status_code != WLAN_STATUS_SUCCESS) {
- union fst_session_state_switch_extra evext = {
- .to_initial = {
- .reason = REASON_REJECT,
- .reject_code = status_code,
- .initiator = FST_INITIATOR_LOCAL,
- },
- };
- fst_session_set_state(s, FST_SESSION_STATE_INITIAL, &evext);
- }
- return 0;
- }
- int fst_session_initiate_switch(struct fst_session *s)
- {
- struct fst_ack_req req;
- int res;
- u8 dialog_token;
- if (!fst_session_is_ready(s)) {
- fst_printf_session(s, MSG_ERROR,
- "cannot initiate switch due to wrong setup state (%d)",
- s->state);
- return -1;
- }
- dialog_token = fst_group_assign_dialog_token(s->group);
- WPA_ASSERT(s->data.new_iface != NULL);
- WPA_ASSERT(s->data.old_iface != NULL);
- fst_printf_session(s, MSG_INFO, "initiating FST switch: %s => %s",
- fst_iface_get_name(s->data.old_iface),
- fst_iface_get_name(s->data.new_iface));
- os_memset(&req, 0, sizeof(req));
- req.action = FST_ACTION_ACK_REQUEST;
- req.dialog_token = dialog_token;
- req.fsts_id = host_to_le32(s->data.fsts_id);
- res = fst_session_send_action(s, FALSE, &req, sizeof(req), NULL);
- if (!res) {
- fst_printf_sframe(s, FALSE, MSG_INFO, "FST Ack Request sent");
- fst_session_set_state(s, FST_SESSION_STATE_TRANSITION_DONE,
- NULL);
- fst_session_stt_arm(s);
- } else {
- fst_printf_sframe(s, FALSE, MSG_ERROR,
- "Cannot send FST Ack Request");
- }
- return res;
- }
- void fst_session_handle_action(struct fst_session *s,
- struct fst_iface *iface,
- const struct ieee80211_mgmt *mgmt,
- size_t frame_len)
- {
- switch (mgmt->u.action.u.fst_action.action) {
- case FST_ACTION_SETUP_REQUEST:
- WPA_ASSERT(0);
- break;
- case FST_ACTION_SETUP_RESPONSE:
- fst_session_handle_setup_response(s, iface, mgmt, frame_len);
- break;
- case FST_ACTION_TEAR_DOWN:
- fst_session_handle_tear_down(s, iface, mgmt, frame_len);
- break;
- case FST_ACTION_ACK_REQUEST:
- fst_session_handle_ack_request(s, iface, mgmt, frame_len);
- break;
- case FST_ACTION_ACK_RESPONSE:
- fst_session_handle_ack_response(s, iface, mgmt, frame_len);
- break;
- case FST_ACTION_ON_CHANNEL_TUNNEL:
- default:
- fst_printf_sframe(s, FALSE, MSG_ERROR,
- "Unsupported FST Action frame");
- break;
- }
- }
- int fst_session_tear_down_setup(struct fst_session *s)
- {
- int res;
- union fst_session_state_switch_extra evext = {
- .to_initial = {
- .reason = REASON_TEARDOWN,
- .initiator = FST_INITIATOR_LOCAL,
- },
- };
- res = fst_session_send_tear_down(s);
- fst_session_set_state(s, FST_SESSION_STATE_INITIAL, &evext);
- return res;
- }
- void fst_session_reset(struct fst_session *s)
- {
- fst_session_reset_ex(s, REASON_RESET);
- }
- void fst_session_delete(struct fst_session *s)
- {
- fst_printf(MSG_INFO, "Session %u deleted", s->id);
- dl_list_del(&s->global_sessions_lentry);
- foreach_fst_ctrl_call(on_session_removed, s);
- os_free(s);
- }
- struct fst_group * fst_session_get_group(struct fst_session *s)
- {
- return s->group;
- }
- struct fst_iface * fst_session_get_iface(struct fst_session *s, Boolean is_old)
- {
- return is_old ? s->data.old_iface : s->data.new_iface;
- }
- u32 fst_session_get_id(struct fst_session *s)
- {
- return s->id;
- }
- const u8 * fst_session_get_peer_addr(struct fst_session *s, Boolean is_old)
- {
- return is_old ? s->data.old_peer_addr : s->data.new_peer_addr;
- }
- u32 fst_session_get_llt(struct fst_session *s)
- {
- return s->data.llt_ms;
- }
- enum fst_session_state fst_session_get_state(struct fst_session *s)
- {
- return s->state;
- }
- struct fst_session * fst_session_get_by_id(u32 id)
- {
- struct fst_session *s;
- foreach_fst_session(s) {
- if (id == s->id)
- return s;
- }
- return NULL;
- }
- void fst_session_enum(struct fst_group *g, fst_session_enum_clb clb, void *ctx)
- {
- struct fst_session *s;
- foreach_fst_session(s) {
- if (!g || s->group == g)
- clb(s->group, s, ctx);
- }
- }
- void fst_session_on_action_rx(struct fst_iface *iface,
- const struct ieee80211_mgmt *mgmt,
- size_t len)
- {
- struct fst_session *s;
- if (len < IEEE80211_HDRLEN + 2 ||
- mgmt->u.action.category != WLAN_ACTION_FST) {
- fst_printf_iface(iface, MSG_ERROR,
- "invalid Action frame received");
- return;
- }
- if (mgmt->u.action.u.fst_action.action <= FST_ACTION_MAX_SUPPORTED) {
- fst_printf_iface(iface, MSG_DEBUG,
- "FST Action '%s' received!",
- fst_action_names[mgmt->u.action.u.fst_action.action]);
- } else {
- fst_printf_iface(iface, MSG_WARNING,
- "unknown FST Action (%u) received!",
- mgmt->u.action.u.fst_action.action);
- return;
- }
- if (mgmt->u.action.u.fst_action.action == FST_ACTION_SETUP_REQUEST) {
- fst_session_handle_setup_request(iface, mgmt, len);
- return;
- }
- s = fst_find_session_in_progress(mgmt->sa, fst_iface_get_group(iface));
- if (s) {
- fst_session_handle_action(s, iface, mgmt, len);
- } else {
- fst_printf_iface(iface, MSG_WARNING,
- "FST Action '%s' dropped: no session in progress found",
- fst_action_names[mgmt->u.action.u.fst_action.action]);
- }
- }
- int fst_session_set_str_ifname(struct fst_session *s, const char *ifname,
- Boolean is_old)
- {
- struct fst_group *g = fst_session_get_group(s);
- struct fst_iface *i;
- i = fst_group_get_iface_by_name(g, ifname);
- if (!i) {
- fst_printf_session(s, MSG_WARNING,
- "Cannot set iface %s: no such iface within group '%s'",
- ifname, fst_group_get_id(g));
- return -1;
- }
- fst_session_set_iface(s, i, is_old);
- return 0;
- }
- int fst_session_set_str_peer_addr(struct fst_session *s, const char *mac,
- Boolean is_old)
- {
- u8 peer_addr[ETH_ALEN];
- int res = fst_read_peer_addr(mac, peer_addr);
- if (res)
- return res;
- fst_session_set_peer_addr(s, peer_addr, is_old);
- return 0;
- }
- int fst_session_set_str_llt(struct fst_session *s, const char *llt_str)
- {
- char *endp;
- long int llt = strtol(llt_str, &endp, 0);
- if (*endp || llt < 0 || (unsigned long int) llt > FST_MAX_LLT_MS) {
- fst_printf_session(s, MSG_WARNING,
- "Cannot set llt %s: Invalid llt value (1..%u expected)",
- llt_str, FST_MAX_LLT_MS);
- return -1;
- }
- fst_session_set_llt(s, (u32) llt);
- return 0;
- }
- void fst_session_global_on_iface_detached(struct fst_iface *iface)
- {
- struct fst_session *s;
- foreach_fst_session(s) {
- if (fst_session_is_in_progress(s) &&
- (s->data.new_iface == iface ||
- s->data.old_iface == iface))
- fst_session_reset_ex(s, REASON_DETACH_IFACE);
- }
- }
- struct fst_session * fst_session_global_get_first_by_group(struct fst_group *g)
- {
- struct fst_session *s;
- foreach_fst_session(s) {
- if (s->group == g)
- return s;
- }
- return NULL;
- }
- #ifdef CONFIG_FST_TEST
- static int get_group_fill_session(struct fst_group **g, struct fst_session *s)
- {
- const u8 *old_addr, *new_addr;
- struct fst_get_peer_ctx *ctx;
- os_memset(s, 0, sizeof(*s));
- foreach_fst_group(*g) {
- s->data.new_iface = fst_group_first_iface(*g);
- if (s->data.new_iface)
- break;
- }
- if (!s->data.new_iface)
- return -EINVAL;
- s->data.old_iface = dl_list_entry(s->data.new_iface->group_lentry.next,
- struct fst_iface, group_lentry);
- if (!s->data.old_iface)
- return -EINVAL;
- old_addr = fst_iface_get_peer_first(s->data.old_iface, &ctx, TRUE);
- if (!old_addr)
- return -EINVAL;
- new_addr = fst_iface_get_peer_first(s->data.new_iface, &ctx, TRUE);
- if (!new_addr)
- return -EINVAL;
- os_memcpy(s->data.old_peer_addr, old_addr, ETH_ALEN);
- os_memcpy(s->data.new_peer_addr, new_addr, ETH_ALEN);
- return 0;
- }
- #define FST_MAX_COMMAND_WORD_NAME_LENGTH 16
- int fst_test_req_send_fst_request(const char *params)
- {
- int fsts_id;
- Boolean is_valid;
- char *endp;
- struct fst_setup_req req;
- struct fst_session s;
- struct fst_group *g;
- enum hostapd_hw_mode hw_mode;
- u8 channel;
- char additional_param[FST_MAX_COMMAND_WORD_NAME_LENGTH];
- if (params[0] != ' ')
- return -EINVAL;
- params++;
- fsts_id = fst_read_next_int_param(params, &is_valid, &endp);
- if (!is_valid)
- return -EINVAL;
- if (get_group_fill_session(&g, &s))
- return -EINVAL;
- req.action = FST_ACTION_SETUP_REQUEST;
- req.dialog_token = g->dialog_token;
- req.llt = host_to_le32(FST_LLT_MS_DEFAULT);
- /* 8.4.2.147 Session Transition element */
- req.stie.element_id = WLAN_EID_SESSION_TRANSITION;
- req.stie.length = sizeof(req.stie) - 2;
- req.stie.fsts_id = host_to_le32(fsts_id);
- req.stie.session_control = SESSION_CONTROL(SESSION_TYPE_BSS, 0);
- fst_iface_get_channel_info(s.data.new_iface, &hw_mode, &channel);
- req.stie.new_band_id = fst_hw_mode_to_band(hw_mode);
- req.stie.new_band_op = 1;
- req.stie.new_band_setup = 0;
- fst_iface_get_channel_info(s.data.old_iface, &hw_mode, &channel);
- req.stie.old_band_id = fst_hw_mode_to_band(hw_mode);
- req.stie.old_band_op = 1;
- req.stie.old_band_setup = 0;
- if (!fst_read_next_text_param(endp, additional_param,
- sizeof(additional_param), &endp)) {
- if (!os_strcasecmp(additional_param, FST_CTR_PVAL_BAD_NEW_BAND))
- req.stie.new_band_id = req.stie.old_band_id;
- }
- return fst_session_send_action(&s, TRUE, &req, sizeof(req),
- s.data.old_iface->mb_ie);
- }
- int fst_test_req_send_fst_response(const char *params)
- {
- int fsts_id;
- Boolean is_valid;
- char *endp;
- struct fst_setup_res res;
- struct fst_session s;
- struct fst_group *g;
- enum hostapd_hw_mode hw_mode;
- u8 status_code;
- u8 channel;
- char response[FST_MAX_COMMAND_WORD_NAME_LENGTH];
- struct fst_session *_s;
- if (params[0] != ' ')
- return -EINVAL;
- params++;
- fsts_id = fst_read_next_int_param(params, &is_valid, &endp);
- if (!is_valid)
- return -EINVAL;
- if (get_group_fill_session(&g, &s))
- return -EINVAL;
- status_code = WLAN_STATUS_SUCCESS;
- if (!fst_read_next_text_param(endp, response, sizeof(response),
- &endp)) {
- if (!os_strcasecmp(response, FST_CS_PVAL_RESPONSE_REJECT))
- status_code = WLAN_STATUS_PENDING_ADMITTING_FST_SESSION;
- }
- os_memset(&res, 0, sizeof(res));
- res.action = FST_ACTION_SETUP_RESPONSE;
- /*
- * If some session has just received an FST Setup Request, then
- * use the correct dialog token copied from this request.
- */
- _s = fst_find_session_in_progress(fst_session_get_peer_addr(&s, TRUE),
- g);
- res.dialog_token = (_s && fst_session_is_ready_pending(_s)) ?
- _s->data.pending_setup_req_dlgt : g->dialog_token;
- res.status_code = status_code;
- res.stie.element_id = WLAN_EID_SESSION_TRANSITION;
- res.stie.length = sizeof(res.stie) - 2;
- if (res.status_code == WLAN_STATUS_SUCCESS) {
- res.stie.fsts_id = host_to_le32(fsts_id);
- res.stie.session_control = SESSION_CONTROL(SESSION_TYPE_BSS, 0);
- fst_iface_get_channel_info(s.data.new_iface, &hw_mode,
- &channel);
- res.stie.new_band_id = fst_hw_mode_to_band(hw_mode);
- res.stie.new_band_op = 1;
- res.stie.new_band_setup = 0;
- fst_iface_get_channel_info(s.data.old_iface, &hw_mode,
- &channel);
- res.stie.old_band_id = fst_hw_mode_to_band(hw_mode);
- res.stie.old_band_op = 1;
- res.stie.old_band_setup = 0;
- }
- if (!fst_read_next_text_param(endp, response, sizeof(response),
- &endp)) {
- if (!os_strcasecmp(response, FST_CTR_PVAL_BAD_NEW_BAND))
- res.stie.new_band_id = res.stie.old_band_id;
- }
- return fst_session_send_action(&s, TRUE, &res, sizeof(res),
- s.data.old_iface->mb_ie);
- }
- int fst_test_req_send_ack_request(const char *params)
- {
- int fsts_id;
- Boolean is_valid;
- char *endp;
- struct fst_ack_req req;
- struct fst_session s;
- struct fst_group *g;
- if (params[0] != ' ')
- return -EINVAL;
- params++;
- fsts_id = fst_read_next_int_param(params, &is_valid, &endp);
- if (!is_valid)
- return -EINVAL;
- if (get_group_fill_session(&g, &s))
- return -EINVAL;
- os_memset(&req, 0, sizeof(req));
- req.action = FST_ACTION_ACK_REQUEST;
- req.dialog_token = g->dialog_token;
- req.fsts_id = host_to_le32(fsts_id);
- return fst_session_send_action(&s, FALSE, &req, sizeof(req), NULL);
- }
- int fst_test_req_send_ack_response(const char *params)
- {
- int fsts_id;
- Boolean is_valid;
- char *endp;
- struct fst_ack_res res;
- struct fst_session s;
- struct fst_group *g;
- if (params[0] != ' ')
- return -EINVAL;
- params++;
- fsts_id = fst_read_next_int_param(params, &is_valid, &endp);
- if (!is_valid)
- return -EINVAL;
- if (get_group_fill_session(&g, &s))
- return -EINVAL;
- os_memset(&res, 0, sizeof(res));
- res.action = FST_ACTION_ACK_RESPONSE;
- res.dialog_token = g->dialog_token;
- res.fsts_id = host_to_le32(fsts_id);
- return fst_session_send_action(&s, FALSE, &res, sizeof(res), NULL);
- }
- int fst_test_req_send_tear_down(const char *params)
- {
- int fsts_id;
- Boolean is_valid;
- char *endp;
- struct fst_tear_down td;
- struct fst_session s;
- struct fst_group *g;
- if (params[0] != ' ')
- return -EINVAL;
- params++;
- fsts_id = fst_read_next_int_param(params, &is_valid, &endp);
- if (!is_valid)
- return -EINVAL;
- if (get_group_fill_session(&g, &s))
- return -EINVAL;
- os_memset(&td, 0, sizeof(td));
- td.action = FST_ACTION_TEAR_DOWN;
- td.fsts_id = host_to_le32(fsts_id);
- return fst_session_send_action(&s, TRUE, &td, sizeof(td), NULL);
- }
- u32 fst_test_req_get_fsts_id(const char *params)
- {
- int sid;
- Boolean is_valid;
- char *endp;
- struct fst_session *s;
- if (params[0] != ' ')
- return FST_FSTS_ID_NOT_FOUND;
- params++;
- sid = fst_read_next_int_param(params, &is_valid, &endp);
- if (!is_valid)
- return FST_FSTS_ID_NOT_FOUND;
- s = fst_session_get_by_id(sid);
- if (!s)
- return FST_FSTS_ID_NOT_FOUND;
- return s->data.fsts_id;
- }
- int fst_test_req_get_local_mbies(const char *request, char *buf, size_t buflen)
- {
- char *endp;
- char ifname[FST_MAX_COMMAND_WORD_NAME_LENGTH];
- struct fst_group *g;
- struct fst_iface *iface;
- if (request[0] != ' ')
- return -EINVAL;
- request++;
- if (fst_read_next_text_param(request, ifname, sizeof(ifname), &endp) ||
- !*ifname)
- goto problem;
- g = dl_list_first(&fst_global_groups_list, struct fst_group,
- global_groups_lentry);
- if (!g)
- goto problem;
- iface = fst_group_get_iface_by_name(g, ifname);
- if (!iface || !iface->mb_ie)
- goto problem;
- return wpa_snprintf_hex(buf, buflen, wpabuf_head(iface->mb_ie),
- wpabuf_len(iface->mb_ie));
- problem:
- return os_snprintf(buf, buflen, "FAIL\n");
- }
- #endif /* CONFIG_FST_TEST */
|