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 = 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;
}
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 = {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);
}
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 = 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);
}
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 (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;
}
if (!fst_session_is_ready_pending(s)) {
fst_printf_session(s, MSG_WARNING,
"FST Request from " MACSTR
" dropped due to inappropriate state %s",
MAC2STR(mgmt->da),
fst_session_state_name(s->state));
return;
}
/*
* If FST Setup Request arrived with the same FSTS ID as one we
* initialized before, it means the other side either didn't
* receive our FST Request or skipped it for some reason (for
* example, due to numerical MAC comparison).
*
* In this case, 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);
fst_printf_session(s, MSG_WARNING, "reset due to FST request");
}
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_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];
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));
}
new_iface = fst_group_get_peer_other_connection(iface, mgmt->sa,
req->stie.new_band_id,
new_iface_peer_addr);
if (!new_iface) {
fst_printf_iface(iface, MSG_WARNING,
"FST Request dropped: new iface not found");
return;
}
fst_printf_iface(iface, MSG_INFO,
"FST Request: new iface (%s:" MACSTR ") found",
fst_iface_get_name(new_iface),
MAC2STR(new_iface_peer_addr));
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);
}