mirror of https://github.com/ARMmbed/mbed-os.git
1184 lines
40 KiB
C
1184 lines
40 KiB
C
/*
|
|
* Copyright (c) 2018-2019, Arm Limited and affiliates.
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*
|
|
* Licensed under the Apache License, Version 2.0 (the "License");
|
|
* you may not use this file except in compliance with the License.
|
|
* You may obtain a copy of the License at
|
|
*
|
|
* http://www.apache.org/licenses/LICENSE-2.0
|
|
*
|
|
* Unless required by applicable law or agreed to in writing, software
|
|
* distributed under the License is distributed on an "AS IS" BASIS,
|
|
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|
* See the License for the specific language governing permissions and
|
|
* limitations under the License.
|
|
*/
|
|
|
|
#include "nsconfig.h"
|
|
#include <string.h>
|
|
#include <randLIB.h>
|
|
#include "ns_types.h"
|
|
#include "ns_list.h"
|
|
#include "ns_trace.h"
|
|
#include "nsdynmemLIB.h"
|
|
#include "fhss_config.h"
|
|
#include "eventOS_event.h"
|
|
#include "eventOS_scheduler.h"
|
|
#include "eventOS_event_timer.h"
|
|
#include "ns_address.h"
|
|
#include "NWK_INTERFACE/Include/protocol.h"
|
|
#include "RPL/rpl_protocol.h"
|
|
#include "RPL/rpl_control.h"
|
|
#include "RPL/rpl_data.h"
|
|
#include "6LoWPAN/ws/ws_config.h"
|
|
#include "Security/kmp/kmp_addr.h"
|
|
#include "Security/kmp/kmp_api.h"
|
|
#include "Security/protocols/sec_prot_certs.h"
|
|
#include "Security/protocols/sec_prot_keys.h"
|
|
#include "Security/protocols/key_sec_prot/key_sec_prot.h"
|
|
#include "Security/protocols/eap_tls_sec_prot/supp_eap_tls_sec_prot.h"
|
|
#include "Security/protocols/tls_sec_prot/tls_sec_prot.h"
|
|
#include "Security/protocols/fwh_sec_prot/supp_fwh_sec_prot.h"
|
|
#include "Security/protocols/gkh_sec_prot/supp_gkh_sec_prot.h"
|
|
#include "6LoWPAN/ws/ws_pae_controller.h"
|
|
#include "6LoWPAN/ws/ws_pae_timers.h"
|
|
#include "6LoWPAN/ws/ws_pae_supp.h"
|
|
#include "6LoWPAN/ws/ws_pae_lib.h"
|
|
#include "6LoWPAN/ws/ws_pae_nvm_store.h"
|
|
#include "6LoWPAN/ws/ws_pae_nvm_data.h"
|
|
#include "6LoWPAN/MAC/mpx_api.h"
|
|
#include "6LoWPAN/ws/ws_eapol_pdu.h"
|
|
#include "Security/kmp/kmp_eapol_pdu_if.h"
|
|
|
|
#ifdef HAVE_WS
|
|
#ifdef HAVE_PAE_SUPP
|
|
|
|
#define TRACE_GROUP "wsps"
|
|
|
|
#define PAE_TASKLET_INIT 1
|
|
#define PAE_TASKLET_EVENT 2
|
|
#define PAE_TASKLET_TIMER 3
|
|
|
|
// Wait for for authenticator to continue with authentication (e.g. after EAP-TLS to initiate 4WH)
|
|
#define WAIT_FOR_AUTHENTICATION_TICKS 30 * 10 // 30 seconds
|
|
|
|
// Wait for re-authentication after GTK update
|
|
#define WAIT_FOR_REAUTHENTICATION_TICKS 120 * 10 // 120 seconds
|
|
|
|
// How many times in maximum stored keys are used for authentication
|
|
#define STORED_KEYS_MAXIMUM_USE_COUNT 1
|
|
|
|
// Delay for sending the initial EAPOL-Key
|
|
#define INITIAL_KEY_TIMER_MIN 3
|
|
#define INITIAL_KEY_TIMER_MAX 30
|
|
|
|
typedef struct {
|
|
char network_name[33]; /**< Network name for keys */
|
|
sec_prot_gtk_keys_t *gtks; /**< Link to GTKs */
|
|
uint16_t new_pan_id; /**< new PAN ID indicated by bootstrap */
|
|
uint16_t key_pan_id; /**< PAN ID for keys */
|
|
bool updated : 1; /**< Network info has been updated */
|
|
} sec_prot_keys_nw_info_t;
|
|
|
|
typedef struct {
|
|
ns_list_link_t link; /**< Link */
|
|
kmp_service_t *kmp_service; /**< KMP service */
|
|
protocol_interface_info_entry_t *interface_ptr; /**< Interface */
|
|
ws_pae_supp_auth_completed *auth_completed; /**< Authentication completed callback, continue bootstrap */
|
|
ws_pae_supp_nw_key_insert *nw_key_insert; /**< Key insert callback */
|
|
ws_pae_supp_nw_key_index_set *nw_key_index_set; /**< Key index set callback */
|
|
supp_entry_t entry; /**< Supplicant data */
|
|
kmp_addr_t target_addr; /**< EAPOL target (parent) address */
|
|
uint16_t initial_key_timer; /**< Timer to trigger initial EAPOL-Key */
|
|
trickle_t auth_trickle_timer; /**< Trickle timer for re-sending initial EAPOL-key or for GTK mismatch */
|
|
trickle_params_t auth_trickle_params; /**< Trickle parameters for initial EAPOL-key or for GTK mismatch */
|
|
sec_prot_gtk_keys_t gtks; /**< GTKs */
|
|
uint8_t new_br_eui_64[8]; /**< Border router EUI-64 indicated by bootstrap */
|
|
sec_prot_keys_nw_info_t sec_keys_nw_info; /**< Security keys network information */
|
|
timer_settings_t *timer_settings; /**< Timer settings */
|
|
uint8_t nw_keys_used_cnt; /**< How many times bootstrap has been tried with current keys */
|
|
bool auth_trickle_running : 1; /**< Initial EAPOL-Key Trickle timer running */
|
|
bool auth_requested : 1; /**< Authentication has been requested by the bootstrap */
|
|
bool timer_running : 1; /**< Timer is running */
|
|
bool new_br_eui_64_set : 1; /**< Border router address has been set */
|
|
bool new_br_eui_64_fresh : 1; /**< Border router address is fresh (set during this authentication attempt) */
|
|
bool entry_address_active: 1;
|
|
} pae_supp_t;
|
|
|
|
|
|
#define TRICKLE_IMIN_180_SECS 180
|
|
|
|
static trickle_params_t initial_eapol_key_trickle_params = {
|
|
.Imin = TRICKLE_IMIN_180_SECS, /* 180 second; ticks are 1 second */
|
|
.Imax = TRICKLE_IMIN_180_SECS << 1, /* 360 second */
|
|
.k = 0, /* infinity - no consistency checking */
|
|
.TimerExpirations = 3
|
|
};
|
|
|
|
static void ws_pae_supp_free(pae_supp_t *pae_supp);
|
|
static void ws_pae_supp_authenticate_response(pae_supp_t *pae_supp, auth_result_e result);
|
|
static int8_t ws_pae_supp_initial_key_send(pae_supp_t *pae_supp);
|
|
static void ws_pae_supp_nvm_update(pae_supp_t *pae_supp);
|
|
static int8_t ws_pae_supp_nw_keys_valid_check(pae_supp_t *pae_supp, uint16_t pan_id);
|
|
static int8_t ws_pae_supp_nvm_nw_info_write(pae_supp_t *pae_supp);
|
|
static int8_t ws_pae_supp_nvm_keys_write(pae_supp_t *pae_supp);
|
|
static pae_supp_t *ws_pae_supp_get(protocol_interface_info_entry_t *interface_ptr);
|
|
static int8_t ws_pae_supp_event_send(kmp_service_t *service, void *data);
|
|
static void ws_pae_supp_tasklet_handler(arm_event_s *event);
|
|
static int8_t ws_pae_supp_timer_if_start(kmp_service_t *service, kmp_api_t *kmp);
|
|
static int8_t ws_pae_supp_timer_if_stop(kmp_service_t *service, kmp_api_t *kmp);
|
|
static int8_t ws_pae_supp_timer_start(pae_supp_t *pae_supp);
|
|
static int8_t ws_pae_supp_timer_stop(pae_supp_t *pae_supp);
|
|
static bool ws_pae_supp_timer_running(pae_supp_t *pae_supp);
|
|
static void ws_pae_supp_kmp_service_addr_get(kmp_service_t *service, kmp_api_t *kmp, kmp_addr_t *local_addr, kmp_addr_t *remote_addr);
|
|
static kmp_api_t *ws_pae_supp_kmp_service_api_get(kmp_service_t *service, kmp_api_t *kmp, kmp_type_e type);
|
|
static kmp_api_t *ws_pae_supp_kmp_incoming_ind(kmp_service_t *service, kmp_type_e type, const kmp_addr_t *addr);
|
|
static kmp_api_t *ws_pae_supp_kmp_tx_status_ind(kmp_service_t *service, uint8_t instance_id);
|
|
static kmp_api_t *ws_pae_supp_kmp_create_and_start(kmp_service_t *service, kmp_type_e type, pae_supp_t *pae_supp);
|
|
static int8_t ws_pae_supp_eapol_pdu_address_check(protocol_interface_info_entry_t *interface_ptr, const uint8_t *eui_64);
|
|
static int8_t ws_pae_supp_parent_eui_64_get(protocol_interface_info_entry_t *interface_ptr, uint8_t *eui_64);
|
|
|
|
static void ws_pae_supp_kmp_api_create_confirm(kmp_api_t *kmp, kmp_result_e result);
|
|
static void ws_pae_supp_kmp_api_create_indication(kmp_api_t *kmp, kmp_type_e type, kmp_addr_t *addr);
|
|
static void ws_pae_supp_kmp_api_finished_indication(kmp_api_t *kmp, kmp_result_e result, kmp_sec_keys_t *sec_keys);
|
|
static void ws_pae_supp_kmp_api_finished(kmp_api_t *kmp);
|
|
|
|
|
|
static const eapol_pdu_recv_cb_data_t eapol_pdu_recv_cb_data = {
|
|
.priority = EAPOL_PDU_RECV_HIGH_PRIORITY,
|
|
.addr_check = ws_pae_supp_eapol_pdu_address_check,
|
|
.receive = kmp_eapol_pdu_if_receive
|
|
};
|
|
|
|
static const char *NW_INFO_FILE = NW_INFO_FILE_NAME;
|
|
static const char *KEYS_FILE = KEYS_FILE_NAME;
|
|
|
|
static int8_t tasklet_id = -1;
|
|
static NS_LIST_DEFINE(pae_supp_list, pae_supp_t, link);
|
|
|
|
static void ws_pae_supp_address_set(pae_supp_t *pae_supp, kmp_addr_t *address)
|
|
{
|
|
if (address) {
|
|
// Sets target address in use
|
|
pae_supp->entry.addr = *address;
|
|
pae_supp->entry_address_active = true;
|
|
} else {
|
|
pae_supp->entry_address_active = false;
|
|
}
|
|
}
|
|
|
|
static bool ws_pae_supp_address_is_set(pae_supp_t *pae_supp)
|
|
{
|
|
return pae_supp->entry_address_active;
|
|
}
|
|
|
|
int8_t ws_pae_supp_authenticate(protocol_interface_info_entry_t *interface_ptr, uint16_t dest_pan_id, uint8_t *dest_eui_64)
|
|
{
|
|
pae_supp_t *pae_supp = ws_pae_supp_get(interface_ptr);
|
|
if (!pae_supp) {
|
|
return -1;
|
|
}
|
|
|
|
if (ws_pae_supp_nw_keys_valid_check(pae_supp, dest_pan_id) >= 0) {
|
|
pae_supp->auth_completed(interface_ptr, AUTH_RESULT_OK, NULL);
|
|
return 0;
|
|
}
|
|
|
|
// Delete GTKs
|
|
sec_prot_keys_gtks_init(pae_supp->sec_keys_nw_info.gtks);
|
|
|
|
/* PAN ID has changed, delete key data associated with border router
|
|
i.e PMK, PTK, EA-IE data (border router EUI-64) */
|
|
if (pae_supp->sec_keys_nw_info.key_pan_id != 0xFFFF && pae_supp->sec_keys_nw_info.key_pan_id != dest_pan_id) {
|
|
sec_prot_keys_pmk_delete(&pae_supp->entry.sec_keys);
|
|
sec_prot_keys_ptk_delete(&pae_supp->entry.sec_keys);
|
|
sec_prot_keys_ptk_eui_64_delete(&pae_supp->entry.sec_keys);
|
|
}
|
|
|
|
pae_supp->sec_keys_nw_info.key_pan_id = dest_pan_id;
|
|
|
|
// Prepare to receive new border router address
|
|
pae_supp->new_br_eui_64_fresh = false;
|
|
|
|
// Stores target/parent address
|
|
kmp_address_init(KMP_ADDR_EUI_64, &pae_supp->target_addr, dest_eui_64);
|
|
// Sets target address in use
|
|
ws_pae_supp_address_set(pae_supp, &pae_supp->target_addr);
|
|
|
|
pae_supp->auth_requested = true;
|
|
|
|
// Randomizes the sending of initial EAPOL-Key messsage
|
|
pae_supp->initial_key_timer = randLIB_get_random_in_range(INITIAL_KEY_TIMER_MIN, INITIAL_KEY_TIMER_MAX);
|
|
|
|
// Starts supplicant timer
|
|
ws_pae_supp_timer_start(pae_supp);
|
|
|
|
tr_debug("PAE active, timer %i", pae_supp->initial_key_timer);
|
|
|
|
return 1;
|
|
}
|
|
|
|
int8_t ws_pae_supp_nw_info_set(protocol_interface_info_entry_t *interface_ptr, uint16_t pan_id, char *network_name)
|
|
{
|
|
pae_supp_t *pae_supp = ws_pae_supp_get(interface_ptr);
|
|
if (!pae_supp) {
|
|
return -1;
|
|
}
|
|
|
|
// PAN ID has been modified
|
|
if (pan_id != 0xffff && pan_id != pae_supp->sec_keys_nw_info.new_pan_id) {
|
|
pae_supp->sec_keys_nw_info.new_pan_id = pan_id;
|
|
pae_supp->sec_keys_nw_info.updated = true;
|
|
}
|
|
|
|
// Network name has been modified
|
|
if (network_name && strncmp(pae_supp->sec_keys_nw_info.network_name, network_name, 33) != 0) {
|
|
strncpy(pae_supp->sec_keys_nw_info.network_name, network_name, 32);
|
|
pae_supp->sec_keys_nw_info.updated = true;
|
|
}
|
|
|
|
|
|
return 0;
|
|
}
|
|
|
|
int8_t ws_pae_supp_border_router_addr_write(protocol_interface_info_entry_t *interface_ptr, const uint8_t *eui_64)
|
|
{
|
|
pae_supp_t *pae_supp = ws_pae_supp_get(interface_ptr);
|
|
if (!pae_supp) {
|
|
return -1;
|
|
}
|
|
|
|
memcpy(pae_supp->new_br_eui_64, eui_64, 8);
|
|
pae_supp->new_br_eui_64_set = true;
|
|
pae_supp->new_br_eui_64_fresh = true;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int8_t ws_pae_supp_border_router_addr_read(protocol_interface_info_entry_t *interface_ptr, uint8_t *eui_64)
|
|
{
|
|
pae_supp_t *pae_supp = ws_pae_supp_get(interface_ptr);
|
|
if (!pae_supp) {
|
|
return -1;
|
|
}
|
|
|
|
uint8_t *br_eui_64 = sec_prot_keys_ptk_eui_64_get(&pae_supp->entry.sec_keys);
|
|
if (!br_eui_64) {
|
|
return -1;
|
|
}
|
|
|
|
memcpy(eui_64, br_eui_64, 8);
|
|
|
|
return 0;
|
|
}
|
|
|
|
int8_t ws_pae_supp_nw_key_valid(protocol_interface_info_entry_t *interface_ptr)
|
|
{
|
|
pae_supp_t *pae_supp = ws_pae_supp_get(interface_ptr);
|
|
if (!pae_supp) {
|
|
return -1;
|
|
}
|
|
|
|
tr_info("NW key valid");
|
|
|
|
// Stored keys are valid
|
|
pae_supp->nw_keys_used_cnt = 0;
|
|
|
|
// Update NVM if data has been changed
|
|
ws_pae_supp_nvm_update(pae_supp);
|
|
|
|
return 0;
|
|
}
|
|
|
|
int8_t ws_pae_supp_gtk_hash_update(protocol_interface_info_entry_t *interface_ptr, uint8_t *gtkhash)
|
|
{
|
|
pae_supp_t *pae_supp = ws_pae_supp_get(interface_ptr);
|
|
if (!pae_supp) {
|
|
return -1;
|
|
}
|
|
|
|
// Check GTK hashes and initiate EAPOL procedure if mismatch is detected */
|
|
gtk_mismatch_e mismatch = sec_prot_keys_gtks_hash_update(&pae_supp->gtks, gtkhash);
|
|
if (mismatch > GTK_NO_MISMATCH) {
|
|
tr_info("GTK hash update %s %s %s %s",
|
|
trace_array(>khash[0], 8),
|
|
trace_array(>khash[8], 8),
|
|
trace_array(>khash[16], 8),
|
|
trace_array(>khash[24], 8));
|
|
|
|
// Mismatch, initiate EAPOL
|
|
if (!pae_supp->auth_trickle_running) {
|
|
uint8_t timer_expirations = 3;
|
|
// For GTK lifetime mismatch send only once
|
|
if (mismatch == GTK_LIFETIME_MISMATCH) {
|
|
timer_expirations = 1;
|
|
}
|
|
|
|
pae_supp->auth_trickle_params.Imin = pae_supp->timer_settings->gtk_request_imin;
|
|
pae_supp->auth_trickle_params.Imax = pae_supp->timer_settings->gtk_request_imax;
|
|
pae_supp->auth_trickle_params.k = 0;
|
|
pae_supp->auth_trickle_params.TimerExpirations = timer_expirations;
|
|
|
|
// Starts trickle
|
|
trickle_start(&pae_supp->auth_trickle_timer, &pae_supp->auth_trickle_params);
|
|
pae_supp->auth_trickle_running = true;
|
|
|
|
// Starts supplicant timer
|
|
ws_pae_supp_timer_start(pae_supp);
|
|
|
|
tr_info("GTK update start imin: %i, imax: %i, max mismatch: %i, tr time: %i", pae_supp->timer_settings->gtk_request_imin, pae_supp->timer_settings->gtk_request_imax, pae_supp->timer_settings->gtk_max_mismatch, pae_supp->auth_trickle_timer.t);
|
|
} else {
|
|
// If trickle is already running, set inconsistent heard to speed up the trickle
|
|
trickle_inconsistent_heard(&pae_supp->auth_trickle_timer, &pae_supp->auth_trickle_params);
|
|
}
|
|
}
|
|
|
|
// Modify keys
|
|
pae_supp->nw_key_insert(pae_supp->interface_ptr, pae_supp->sec_keys_nw_info.gtks);
|
|
|
|
return 0;
|
|
}
|
|
|
|
int8_t ws_pae_supp_nw_key_index_update(protocol_interface_info_entry_t *interface_ptr, uint8_t index)
|
|
{
|
|
pae_supp_t *pae_supp = ws_pae_supp_get(interface_ptr);
|
|
if (!pae_supp) {
|
|
return -1;
|
|
}
|
|
|
|
if (sec_prot_keys_gtk_status_active_set(&pae_supp->gtks, index) >= 0) {
|
|
pae_supp->nw_key_index_set(interface_ptr, index);
|
|
} else {
|
|
tr_info("NW send key index: %i, no changes", index + 1);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int8_t ws_pae_supp_gtks_set(protocol_interface_info_entry_t *interface_ptr, sec_prot_gtk_keys_t *gtks)
|
|
{
|
|
pae_supp_t *pae_supp = ws_pae_supp_get(interface_ptr);
|
|
if (!pae_supp) {
|
|
return -1;
|
|
}
|
|
|
|
pae_supp->gtks = *gtks;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int8_t ws_pae_supp_eapol_target_remove(protocol_interface_info_entry_t *interface_ptr)
|
|
{
|
|
pae_supp_t *pae_supp = ws_pae_supp_get(interface_ptr);
|
|
if (!pae_supp) {
|
|
return -1;
|
|
}
|
|
|
|
// Sets target/parent address to null
|
|
ws_pae_supp_address_set(pae_supp, NULL);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void ws_pae_supp_nvm_update(pae_supp_t *pae_supp)
|
|
{
|
|
// Check if NW info or GTKs have been changed
|
|
if (pae_supp->sec_keys_nw_info.updated || sec_prot_keys_gtks_are_updated(pae_supp->sec_keys_nw_info.gtks)) {
|
|
ws_pae_supp_nvm_nw_info_write(pae_supp);
|
|
pae_supp->sec_keys_nw_info.updated = false;
|
|
sec_prot_keys_gtks_updated_reset(pae_supp->sec_keys_nw_info.gtks);
|
|
}
|
|
|
|
// Check if pairwise security keys have been changed
|
|
if (sec_prot_keys_are_updated(&pae_supp->entry.sec_keys)) {
|
|
ws_pae_supp_nvm_keys_write(pae_supp);
|
|
sec_prot_keys_updated_reset(&pae_supp->entry.sec_keys);
|
|
}
|
|
}
|
|
|
|
static int8_t ws_pae_supp_nvm_nw_info_write(pae_supp_t *pae_supp)
|
|
{
|
|
nvm_tlv_entry_t *tlv_entry = ws_pae_controller_nvm_tlv_get(pae_supp->interface_ptr);
|
|
if (!tlv_entry) {
|
|
return -1;
|
|
}
|
|
|
|
nvm_tlv_list_t tlv_list;
|
|
ns_list_init(&tlv_list);
|
|
|
|
ws_pae_nvm_store_nw_info_tlv_create(tlv_entry, pae_supp->sec_keys_nw_info.key_pan_id,
|
|
pae_supp->sec_keys_nw_info.network_name,
|
|
&pae_supp->gtks);
|
|
ns_list_add_to_end(&tlv_list, tlv_entry);
|
|
|
|
ws_pae_nvm_store_tlv_file_write(NW_INFO_FILE, &tlv_list);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int8_t ws_pae_supp_nvm_nw_info_read(pae_supp_t *pae_supp)
|
|
{
|
|
nvm_tlv_list_t tlv_list;
|
|
ns_list_init(&tlv_list);
|
|
|
|
ws_pae_nvm_store_tlv_file_read(NW_INFO_FILE, &tlv_list);
|
|
|
|
ns_list_foreach_safe(nvm_tlv_entry_t, entry, &tlv_list) {
|
|
ws_pae_nvm_store_nw_info_tlv_read(entry, &pae_supp->sec_keys_nw_info.key_pan_id,
|
|
pae_supp->sec_keys_nw_info.network_name,
|
|
&pae_supp->gtks);
|
|
ns_list_remove(&tlv_list, entry);
|
|
ns_dyn_mem_free(entry);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int8_t ws_pae_supp_nvm_keys_write(pae_supp_t *pae_supp)
|
|
{
|
|
nvm_tlv_entry_t *tlv_entry = ws_pae_controller_nvm_tlv_get(pae_supp->interface_ptr);
|
|
if (!tlv_entry) {
|
|
return -1;
|
|
}
|
|
|
|
nvm_tlv_list_t tlv_list;
|
|
ns_list_init(&tlv_list);
|
|
|
|
ws_pae_nvm_store_keys_tlv_create(tlv_entry, &pae_supp->entry.sec_keys);
|
|
ns_list_add_to_end(&tlv_list, tlv_entry);
|
|
|
|
ws_pae_nvm_store_tlv_file_write(KEYS_FILE, &tlv_list);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int8_t ws_pae_supp_nvm_keys_read(pae_supp_t *pae_supp)
|
|
{
|
|
nvm_tlv_list_t tlv_list;
|
|
ns_list_init(&tlv_list);
|
|
|
|
ws_pae_nvm_store_tlv_file_read(KEYS_FILE, &tlv_list);
|
|
|
|
ns_list_foreach_safe(nvm_tlv_entry_t, entry, &tlv_list) {
|
|
ws_pae_nvm_store_keys_tlv_read(entry, &pae_supp->entry.sec_keys);
|
|
ns_list_remove(&tlv_list, entry);
|
|
ns_dyn_mem_free(entry);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void ws_pae_supp_authenticate_response(pae_supp_t *pae_supp, auth_result_e result)
|
|
{
|
|
pae_supp->auth_trickle_running = false;
|
|
if (pae_supp->auth_requested && pae_supp->auth_completed) {
|
|
pae_supp->auth_requested = false;
|
|
uint8_t *target_eui_64 = NULL;
|
|
if (result != AUTH_RESULT_OK) {
|
|
target_eui_64 = pae_supp->target_addr.eui_64;
|
|
}
|
|
pae_supp->auth_completed(pae_supp->interface_ptr, result, target_eui_64);
|
|
}
|
|
}
|
|
|
|
static int8_t ws_pae_supp_initial_key_send(pae_supp_t *pae_supp)
|
|
{
|
|
if (!pae_supp->auth_requested) {
|
|
// If not making initial authentication updates target (RPL parent) for each EAPOL-key message
|
|
uint8_t parent_eui_64[8];
|
|
if (ws_pae_supp_parent_eui_64_get(pae_supp->interface_ptr, parent_eui_64) >= 0) {
|
|
// Stores target/parent address
|
|
kmp_address_init(KMP_ADDR_EUI_64, &pae_supp->target_addr, parent_eui_64);
|
|
// Sets parent address in use
|
|
ws_pae_supp_address_set(pae_supp, &pae_supp->target_addr);
|
|
} else if (ws_pae_supp_address_is_set(pae_supp)) {
|
|
/* If there is no RPL parent but there is target address from initial authentication
|
|
bootstrap, tries to use it. This can happen if BR updates keys after EAPOL authentication
|
|
but before bootstrap is completed and RPL parent is known */
|
|
tr_info("EAPOL initial auth target used");
|
|
} else {
|
|
// No target, failure
|
|
return -1;
|
|
}
|
|
|
|
ws_pae_lib_supp_timer_ticks_set(&pae_supp->entry, WAIT_FOR_REAUTHENTICATION_TICKS);
|
|
tr_info("PAE wait for auth seconds: %i", WAIT_FOR_REAUTHENTICATION_TICKS / 10);
|
|
}
|
|
|
|
kmp_api_t *kmp = ws_pae_supp_kmp_create_and_start(pae_supp->kmp_service, IEEE_802_1X_MKA_KEY, pae_supp);
|
|
if (!kmp) {
|
|
return -1;
|
|
}
|
|
|
|
tr_info("EAPOL target: %s", trace_array(kmp_address_eui_64_get(&pae_supp->entry.addr), 8));
|
|
|
|
kmp_api_create_request(kmp, IEEE_802_1X_MKA_KEY, &pae_supp->entry.addr, &pae_supp->entry.sec_keys);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int8_t ws_pae_supp_nw_keys_valid_check(pae_supp_t *pae_supp, uint16_t pan_id)
|
|
{
|
|
// Checks how many times authentication has been tried with current network keys
|
|
if (pae_supp->nw_keys_used_cnt >= STORED_KEYS_MAXIMUM_USE_COUNT) {
|
|
tr_debug("Keys not valid, delete GTKs");
|
|
|
|
// Delete GTKs
|
|
sec_prot_keys_gtks_init(pae_supp->sec_keys_nw_info.gtks);
|
|
sec_prot_keys_gtks_updated_set(pae_supp->sec_keys_nw_info.gtks);
|
|
ws_pae_supp_nvm_update(pae_supp);
|
|
|
|
pae_supp->nw_keys_used_cnt = 0;
|
|
return -1;
|
|
}
|
|
|
|
/* Checks if keys match to PAN ID and that needed keys exists (PMK, PTK and a GTK),
|
|
and calls inserts function that will update the network keys as needed */
|
|
if ((pan_id == pae_supp->sec_keys_nw_info.key_pan_id) &&
|
|
(sec_prot_keys_gtk_count(pae_supp->sec_keys_nw_info.gtks) > 0) &&
|
|
(sec_prot_keys_pmk_get(&pae_supp->entry.sec_keys) != NULL) &&
|
|
(sec_prot_keys_ptk_get(&pae_supp->entry.sec_keys) != NULL)) {
|
|
tr_debug("Existing keys used, counter %i", pae_supp->nw_keys_used_cnt);
|
|
if (pae_supp->nw_key_insert(pae_supp->interface_ptr, pae_supp->sec_keys_nw_info.gtks) >= 0) {
|
|
tr_debug("Keys inserted");
|
|
}
|
|
pae_supp->nw_keys_used_cnt++;
|
|
return 0;
|
|
} else {
|
|
pae_supp->nw_keys_used_cnt = 0;
|
|
return -1;
|
|
}
|
|
}
|
|
|
|
static void ws_pae_supp_keys_nw_info_init(sec_prot_keys_nw_info_t *sec_keys_nw_info, sec_prot_gtk_keys_t *gtks)
|
|
{
|
|
if (!sec_keys_nw_info) {
|
|
return;
|
|
}
|
|
|
|
memset(sec_keys_nw_info, 0, sizeof(sec_prot_keys_nw_info_t));
|
|
|
|
sec_keys_nw_info->gtks = gtks;
|
|
sec_keys_nw_info->new_pan_id = 0xFFFF;
|
|
sec_keys_nw_info->key_pan_id = 0xFFFF;
|
|
sec_keys_nw_info->updated = false;
|
|
}
|
|
|
|
void ws_pae_supp_cb_register(protocol_interface_info_entry_t *interface_ptr, ws_pae_supp_auth_completed *completed, ws_pae_supp_nw_key_insert *nw_key_insert, ws_pae_supp_nw_key_index_set *nw_key_index_set)
|
|
{
|
|
pae_supp_t *pae_supp = ws_pae_supp_get(interface_ptr);
|
|
if (!pae_supp) {
|
|
return;
|
|
}
|
|
|
|
pae_supp->auth_completed = completed;
|
|
pae_supp->nw_key_insert = nw_key_insert;
|
|
pae_supp->nw_key_index_set = nw_key_index_set;
|
|
}
|
|
|
|
int8_t ws_pae_supp_init(protocol_interface_info_entry_t *interface_ptr, const sec_prot_certs_t *certs, timer_settings_t *timer_settings)
|
|
{
|
|
if (!interface_ptr) {
|
|
return -1;
|
|
}
|
|
|
|
if (ws_pae_supp_get(interface_ptr) != NULL) {
|
|
return 0;
|
|
}
|
|
|
|
pae_supp_t *pae_supp = ns_dyn_mem_alloc(sizeof(pae_supp_t));
|
|
if (!pae_supp) {
|
|
return -1;
|
|
}
|
|
|
|
pae_supp->interface_ptr = interface_ptr;
|
|
pae_supp->auth_completed = NULL;
|
|
pae_supp->nw_key_insert = NULL;
|
|
pae_supp->nw_key_index_set = NULL;
|
|
pae_supp->initial_key_timer = 0;
|
|
pae_supp->nw_keys_used_cnt = 0;
|
|
pae_supp->timer_settings = timer_settings;
|
|
pae_supp->auth_trickle_running = false;
|
|
pae_supp->auth_requested = false;
|
|
pae_supp->timer_running = false;
|
|
pae_supp->new_br_eui_64_set = false;
|
|
pae_supp->new_br_eui_64_fresh = false;
|
|
pae_supp->entry_address_active = false;
|
|
|
|
ws_pae_lib_supp_init(&pae_supp->entry);
|
|
|
|
ws_pae_supp_keys_nw_info_init(&pae_supp->sec_keys_nw_info, &pae_supp->gtks);
|
|
|
|
kmp_address_init(KMP_ADDR_EUI_64, &pae_supp->target_addr, 0);
|
|
|
|
sec_prot_keys_gtks_init(&pae_supp->gtks);
|
|
sec_prot_keys_init(&pae_supp->entry.sec_keys, &pae_supp->gtks, certs);
|
|
memset(pae_supp->new_br_eui_64, 0, 8);
|
|
|
|
pae_supp->kmp_service = kmp_service_create();
|
|
if (!pae_supp->kmp_service) {
|
|
goto error;
|
|
}
|
|
|
|
if (kmp_service_cb_register(pae_supp->kmp_service, ws_pae_supp_kmp_incoming_ind, ws_pae_supp_kmp_tx_status_ind, ws_pae_supp_kmp_service_addr_get, ws_pae_supp_kmp_service_api_get) < 0) {
|
|
goto error;
|
|
}
|
|
|
|
if (kmp_service_event_if_register(pae_supp->kmp_service, ws_pae_supp_event_send)) {
|
|
goto error;
|
|
}
|
|
|
|
if (kmp_service_timer_if_register(pae_supp->kmp_service, ws_pae_supp_timer_if_start, ws_pae_supp_timer_if_stop)) {
|
|
goto error;
|
|
}
|
|
|
|
if (kmp_eapol_pdu_if_register(pae_supp->kmp_service, interface_ptr) < 0) {
|
|
goto error;
|
|
}
|
|
|
|
if (ws_eapol_pdu_cb_register(interface_ptr, &eapol_pdu_recv_cb_data) < 0) {
|
|
goto error;
|
|
}
|
|
|
|
if (supp_key_sec_prot_register(pae_supp->kmp_service) < 0) {
|
|
goto error;
|
|
}
|
|
|
|
if (supp_eap_tls_sec_prot_register(pae_supp->kmp_service) < 0) {
|
|
goto error;
|
|
}
|
|
|
|
if (client_tls_sec_prot_register(pae_supp->kmp_service) < 0) {
|
|
goto error;
|
|
}
|
|
|
|
if (supp_fwh_sec_prot_register(pae_supp->kmp_service) < 0) {
|
|
goto error;
|
|
}
|
|
|
|
if (supp_gkh_sec_prot_register(pae_supp->kmp_service) < 0) {
|
|
goto error;
|
|
}
|
|
|
|
if (tasklet_id < 0) {
|
|
tasklet_id = eventOS_event_handler_create(ws_pae_supp_tasklet_handler, PAE_TASKLET_INIT);
|
|
if (tasklet_id < 0) {
|
|
goto error;
|
|
}
|
|
}
|
|
|
|
if (ws_pae_supp_timer_stop(pae_supp) < 0) {
|
|
goto error;
|
|
}
|
|
|
|
ws_pae_supp_nvm_nw_info_read(pae_supp);
|
|
ws_pae_supp_nvm_keys_read(pae_supp);
|
|
|
|
ns_list_add_to_end(&pae_supp_list, pae_supp);
|
|
|
|
return 0;
|
|
|
|
error:
|
|
ws_pae_supp_free(pae_supp);
|
|
|
|
return -1;
|
|
}
|
|
|
|
int8_t ws_pae_supp_delete(protocol_interface_info_entry_t *interface_ptr)
|
|
{
|
|
if (!interface_ptr) {
|
|
return -1;
|
|
}
|
|
|
|
pae_supp_t *pae_supp = ws_pae_supp_get(interface_ptr);
|
|
if (!pae_supp) {
|
|
return -1;
|
|
}
|
|
|
|
ws_pae_supp_free(pae_supp);
|
|
return 0;
|
|
}
|
|
|
|
int8_t ws_pae_supp_timing_adjust(uint8_t timing)
|
|
{
|
|
supp_fwh_sec_prot_timing_adjust(timing);
|
|
supp_eap_sec_prot_timing_adjust(timing);
|
|
return 0;
|
|
}
|
|
|
|
static void ws_pae_supp_free(pae_supp_t *pae_supp)
|
|
{
|
|
if (!pae_supp) {
|
|
return;
|
|
}
|
|
|
|
ws_pae_lib_supp_delete(&pae_supp->entry);
|
|
|
|
kmp_eapol_pdu_if_unregister(pae_supp->kmp_service);
|
|
|
|
ws_eapol_pdu_cb_unregister(pae_supp->interface_ptr, &eapol_pdu_recv_cb_data);
|
|
|
|
kmp_service_delete(pae_supp->kmp_service);
|
|
|
|
ns_list_remove(&pae_supp_list, pae_supp);
|
|
ns_dyn_mem_free(pae_supp);
|
|
}
|
|
|
|
static pae_supp_t *ws_pae_supp_get(protocol_interface_info_entry_t *interface_ptr)
|
|
{
|
|
ns_list_foreach(pae_supp_t, entry, &pae_supp_list) {
|
|
if (entry->interface_ptr == interface_ptr) {
|
|
return entry;
|
|
}
|
|
}
|
|
|
|
return NULL;
|
|
}
|
|
|
|
static pae_supp_t *ws_pae_supp_by_kmp_service_get(kmp_service_t *service)
|
|
{
|
|
ns_list_foreach(pae_supp_t, entry, &pae_supp_list) {
|
|
if (entry->kmp_service == service) {
|
|
return entry;
|
|
}
|
|
}
|
|
|
|
return NULL;
|
|
}
|
|
|
|
static int8_t ws_pae_supp_event_send(kmp_service_t *service, void *data)
|
|
{
|
|
pae_supp_t *pae_supp = ws_pae_supp_by_kmp_service_get(service);
|
|
if (!pae_supp) {
|
|
return -1;
|
|
}
|
|
|
|
arm_event_s event = {
|
|
.receiver = tasklet_id,
|
|
.sender = 0,
|
|
.event_id = pae_supp->interface_ptr->id,
|
|
.data_ptr = data,
|
|
.event_type = PAE_TASKLET_EVENT,
|
|
.priority = ARM_LIB_LOW_PRIORITY_EVENT,
|
|
};
|
|
|
|
if (eventOS_event_send(&event) != 0) {
|
|
return -1;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void ws_pae_supp_tasklet_handler(arm_event_s *event)
|
|
{
|
|
if (event->event_type == PAE_TASKLET_INIT) {
|
|
|
|
} else if (event->event_type == PAE_TASKLET_EVENT) {
|
|
pae_supp_t *pae_supp = NULL;
|
|
|
|
ns_list_foreach(pae_supp_t, entry, &pae_supp_list) {
|
|
if (entry->interface_ptr->id == event->event_id) {
|
|
pae_supp = entry;
|
|
break;
|
|
}
|
|
}
|
|
|
|
if (pae_supp) {
|
|
kmp_service_event_if_event(pae_supp->kmp_service, event->data_ptr);
|
|
}
|
|
}
|
|
}
|
|
|
|
void ws_pae_supp_fast_timer(uint16_t ticks)
|
|
{
|
|
ns_list_foreach(pae_supp_t, pae_supp, &pae_supp_list) {
|
|
if (!ws_pae_supp_timer_running(pae_supp)) {
|
|
continue;
|
|
}
|
|
|
|
// Updates KMP timers and supplicant authentication ongoing timer
|
|
bool running = ws_pae_lib_supp_timer_update(&pae_supp->entry, ticks, kmp_service_timer_if_timeout);
|
|
|
|
// Checks whether timer needs to be active
|
|
if (!pae_supp->initial_key_timer && !pae_supp->auth_trickle_running && !running) {
|
|
tr_debug("PAE idle");
|
|
// If not already completed, restart bootstrap
|
|
ws_pae_supp_authenticate_response(pae_supp, AUTH_RESULT_ERR_UNSPEC);
|
|
|
|
ws_pae_supp_timer_stop(pae_supp);
|
|
}
|
|
}
|
|
}
|
|
|
|
void ws_pae_supp_slow_timer(uint16_t seconds)
|
|
{
|
|
ns_list_foreach(pae_supp_t, pae_supp, &pae_supp_list) {
|
|
|
|
// Checks whether initial EAPOL-Key message needs to be re-send or new GTK request to be sent
|
|
if (pae_supp->auth_trickle_running) {
|
|
if (trickle_timer(&pae_supp->auth_trickle_timer, &pae_supp->auth_trickle_params, seconds)) {
|
|
if (ws_pae_supp_initial_key_send(pae_supp) < 0) {
|
|
tr_info("EAPOL-Key send failed");
|
|
}
|
|
}
|
|
// Maximum number of trickle expires, authentication fails
|
|
if (!trickle_running(&pae_supp->auth_trickle_timer, &pae_supp->auth_trickle_params)) {
|
|
ws_pae_supp_authenticate_response(pae_supp, AUTH_RESULT_ERR_UNSPEC);
|
|
}
|
|
}
|
|
|
|
// Decrements GTK lifetimes
|
|
for (uint8_t i = 0; i < GTK_NUM; i++) {
|
|
if (!sec_prot_keys_gtk_is_set(&pae_supp->gtks, i)) {
|
|
continue;
|
|
}
|
|
sec_prot_keys_gtk_lifetime_decrement(&pae_supp->gtks, i, seconds);
|
|
}
|
|
|
|
if (pae_supp->initial_key_timer > 0) {
|
|
if (pae_supp->initial_key_timer > seconds) {
|
|
pae_supp->initial_key_timer -= seconds;
|
|
} else {
|
|
pae_supp->initial_key_timer = 0;
|
|
|
|
// Sends initial EAPOL-Key message
|
|
if (ws_pae_supp_initial_key_send(pae_supp) < 0) {
|
|
tr_info("EAPOL-Key send failed");
|
|
}
|
|
|
|
// Starts trickle
|
|
pae_supp->auth_trickle_params = initial_eapol_key_trickle_params;
|
|
trickle_start(&pae_supp->auth_trickle_timer, &pae_supp->auth_trickle_params);
|
|
pae_supp->auth_trickle_running = true;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
static int8_t ws_pae_supp_timer_if_start(kmp_service_t *service, kmp_api_t *kmp)
|
|
{
|
|
pae_supp_t *pae_supp = ws_pae_supp_by_kmp_service_get(service);
|
|
if (!pae_supp) {
|
|
return -1;
|
|
}
|
|
|
|
if (ws_pae_supp_timer_start(pae_supp) < 0) {
|
|
return -1;
|
|
}
|
|
|
|
kmp_entry_t *entry = kmp_api_data_get(kmp);
|
|
if (!entry) {
|
|
return -1;
|
|
}
|
|
ws_pae_lib_kmp_timer_start(&pae_supp->entry.kmp_list, entry);
|
|
return 0;
|
|
}
|
|
|
|
static int8_t ws_pae_supp_timer_if_stop(kmp_service_t *service, kmp_api_t *kmp)
|
|
{
|
|
pae_supp_t *pae_supp = ws_pae_supp_by_kmp_service_get(service);
|
|
if (!pae_supp) {
|
|
return -1;
|
|
}
|
|
|
|
kmp_entry_t *entry = kmp_api_data_get(kmp);
|
|
if (!entry) {
|
|
return -1;
|
|
}
|
|
ws_pae_lib_kmp_timer_stop(&pae_supp->entry.kmp_list, entry);
|
|
return 0;
|
|
}
|
|
|
|
static int8_t ws_pae_supp_timer_start(pae_supp_t *pae_supp)
|
|
{
|
|
pae_supp->timer_running = true;
|
|
return 0;
|
|
}
|
|
|
|
static int8_t ws_pae_supp_timer_stop(pae_supp_t *pae_supp)
|
|
{
|
|
pae_supp->timer_running = false;
|
|
return 0;
|
|
}
|
|
|
|
static bool ws_pae_supp_timer_running(pae_supp_t *pae_supp)
|
|
{
|
|
return pae_supp->timer_running;
|
|
}
|
|
|
|
static int8_t ws_pae_supp_eapol_pdu_address_check(protocol_interface_info_entry_t *interface_ptr, const uint8_t *eui_64)
|
|
{
|
|
pae_supp_t *pae_supp = ws_pae_supp_get(interface_ptr);
|
|
if (!pae_supp) {
|
|
return -1;
|
|
}
|
|
|
|
// Message from EAPOL target node, route to self
|
|
if (pae_supp->entry_address_active) {
|
|
if (memcmp(eui_64, pae_supp->entry.addr.eui_64, 8) == 0) {
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
// Get parent
|
|
uint8_t parent_eui_64[8];
|
|
if (ws_pae_supp_parent_eui_64_get(interface_ptr, parent_eui_64) < 0) {
|
|
return -1;
|
|
}
|
|
|
|
// Message from RPL parent, route to self
|
|
if (memcmp(parent_eui_64, eui_64, 8) == 0) {
|
|
return 0;
|
|
}
|
|
|
|
return -1;
|
|
}
|
|
|
|
static int8_t ws_pae_supp_parent_eui_64_get(protocol_interface_info_entry_t *interface_ptr, uint8_t *eui_64)
|
|
{
|
|
rpl_dodag_info_t dodag_info;
|
|
if (!interface_ptr->rpl_domain) {
|
|
return -1;
|
|
}
|
|
struct rpl_instance *instance = rpl_control_enumerate_instances(interface_ptr->rpl_domain, NULL);
|
|
if (instance && rpl_control_read_dodag_info(instance, &dodag_info)) {
|
|
// Get parent
|
|
const uint8_t *parent_ll_addr = rpl_control_preferred_parent_addr(instance, false);
|
|
if (parent_ll_addr) {
|
|
memcpy(eui_64, &parent_ll_addr[8], 8);
|
|
eui_64[0] |= 0x02;
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
return -1;
|
|
}
|
|
|
|
static void ws_pae_supp_kmp_service_addr_get(kmp_service_t *service, kmp_api_t *kmp, kmp_addr_t *local_addr, kmp_addr_t *remote_addr)
|
|
{
|
|
(void) kmp;
|
|
|
|
pae_supp_t *pae_supp = ws_pae_supp_by_kmp_service_get(service);
|
|
if (!pae_supp) {
|
|
return;
|
|
}
|
|
|
|
// Get own EUI-64
|
|
link_layer_address_s mac_params;
|
|
if (arm_nwk_mac_address_read(pae_supp->interface_ptr->id, &mac_params) >= 0) {
|
|
kmp_address_eui_64_set(local_addr, mac_params.mac_long);
|
|
}
|
|
|
|
// BR address has been received during authentication attempt
|
|
if (pae_supp->new_br_eui_64_fresh) {
|
|
kmp_address_eui_64_set(remote_addr, pae_supp->new_br_eui_64);
|
|
} else {
|
|
uint8_t *eui_64 = sec_prot_keys_ptk_eui_64_get(&pae_supp->entry.sec_keys);
|
|
// BR address is set on security keys (confirmed using 4WH)
|
|
if (eui_64) {
|
|
kmp_address_eui_64_set(remote_addr, eui_64);
|
|
} else {
|
|
// For initial EAPOL key, if BR address has been received during previous attempt, generate PMKID using it
|
|
if (pae_supp->new_br_eui_64_set && kmp_api_type_get(kmp) >= IEEE_802_1X_INITIAL_KEY) {
|
|
kmp_address_eui_64_set(remote_addr, pae_supp->new_br_eui_64);
|
|
} else {
|
|
memset(remote_addr, 0, sizeof(kmp_addr_t));
|
|
tr_error("No border router EUI-64");
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
static kmp_api_t *ws_pae_supp_kmp_service_api_get(kmp_service_t *service, kmp_api_t *kmp, kmp_type_e type)
|
|
{
|
|
(void) kmp;
|
|
|
|
pae_supp_t *pae_supp = ws_pae_supp_by_kmp_service_get(service);
|
|
if (!pae_supp) {
|
|
return NULL;
|
|
}
|
|
|
|
return ws_pae_lib_kmp_list_type_get(&pae_supp->entry.kmp_list, type);
|
|
}
|
|
|
|
static kmp_api_t *ws_pae_supp_kmp_incoming_ind(kmp_service_t *service, kmp_type_e type, const kmp_addr_t *addr)
|
|
{
|
|
// Should be MKA, 4WH or GKH and never initial EAPOL-key for supplicant
|
|
if (type > IEEE_802_1X_INITIAL_KEY) {
|
|
return NULL;
|
|
}
|
|
|
|
pae_supp_t *pae_supp = ws_pae_supp_by_kmp_service_get(service);
|
|
if (!pae_supp) {
|
|
return NULL;
|
|
}
|
|
|
|
if (!pae_supp->entry_address_active) {
|
|
// Does no longer wait for authentication, ignores message
|
|
return NULL;
|
|
}
|
|
|
|
// No longer runs trickle timer for re-sending initial EAPOL-key
|
|
pae_supp->auth_trickle_running = false;
|
|
|
|
// Updates parent address
|
|
kmp_address_copy(&pae_supp->entry.addr, addr);
|
|
|
|
// Check if ongoing
|
|
kmp_api_t *kmp = ws_pae_lib_kmp_list_type_get(&pae_supp->entry.kmp_list, type);
|
|
/* If kmp receiving is enabled or it is not GKH, routes message to existing KMP.
|
|
|
|
For GKH creates an instance to handle message. If message is not valid (e.g. repeated
|
|
message counter), GKH ignores message and waits for timeout. All further messages
|
|
are routed to that instance. If valid message arrives, GKH instance handles the
|
|
message, replies to authenticator and terminates. */
|
|
if (kmp && (!kmp_api_receive_disable(kmp) || type != IEEE_802_11_GKH)) {
|
|
return kmp;
|
|
}
|
|
|
|
// Create new instance
|
|
kmp = ws_pae_supp_kmp_create_and_start(service, type, pae_supp);
|
|
|
|
// For EAP-TLS create also TLS in addition to EAP-TLS
|
|
if (type == IEEE_802_1X_MKA) {
|
|
if (ws_pae_lib_kmp_list_type_get(&pae_supp->entry.kmp_list, TLS_PROT) != NULL) {
|
|
// TLS already exists, wait for it to be deleted
|
|
ws_pae_lib_kmp_list_delete(&pae_supp->entry.kmp_list, kmp);
|
|
return NULL;
|
|
}
|
|
// Create TLS instance */
|
|
if (ws_pae_supp_kmp_create_and_start(service, TLS_PROT, pae_supp) == NULL) {
|
|
ws_pae_lib_kmp_list_delete(&pae_supp->entry.kmp_list, kmp);
|
|
return NULL;
|
|
}
|
|
}
|
|
|
|
return kmp;
|
|
}
|
|
|
|
static kmp_api_t *ws_pae_supp_kmp_create_and_start(kmp_service_t *service, kmp_type_e type, pae_supp_t *pae_supp)
|
|
{
|
|
// Create new instance
|
|
kmp_api_t *kmp = kmp_api_create(service, type);
|
|
if (!kmp) {
|
|
return NULL;
|
|
}
|
|
|
|
// Updates parent address
|
|
kmp_api_addr_set(kmp, &pae_supp->entry.addr);
|
|
|
|
// Sets security keys to KMP
|
|
kmp_api_sec_keys_set(kmp, &pae_supp->entry.sec_keys);
|
|
|
|
kmp_api_cb_register(
|
|
kmp, ws_pae_supp_kmp_api_create_confirm,
|
|
ws_pae_supp_kmp_api_create_indication,
|
|
ws_pae_supp_kmp_api_finished_indication,
|
|
ws_pae_supp_kmp_api_finished);
|
|
|
|
kmp_entry_t *kmp_entry = ws_pae_lib_kmp_list_add(&pae_supp->entry.kmp_list, kmp);
|
|
if (!kmp_entry) {
|
|
kmp_api_delete(kmp);
|
|
return NULL;
|
|
}
|
|
|
|
kmp_api_data_set(kmp, kmp_entry);
|
|
|
|
if (kmp_api_start(kmp) < 0) {
|
|
ws_pae_lib_kmp_list_delete(&pae_supp->entry.kmp_list, kmp);
|
|
return NULL;
|
|
}
|
|
|
|
return kmp;
|
|
}
|
|
|
|
static void ws_pae_supp_kmp_api_create_confirm(kmp_api_t *kmp, kmp_result_e result)
|
|
{
|
|
kmp_service_t *service = kmp_api_service_get(kmp);
|
|
pae_supp_t *pae_supp = ws_pae_supp_by_kmp_service_get(service);
|
|
if (!pae_supp) {
|
|
return;
|
|
}
|
|
|
|
// KMP-CREATE.request has failed, authentication error
|
|
if (result != KMP_RESULT_OK) {
|
|
ws_pae_supp_authenticate_response(pae_supp, AUTH_RESULT_ERR_UNSPEC);
|
|
}
|
|
}
|
|
|
|
static void ws_pae_supp_kmp_api_create_indication(kmp_api_t *kmp, kmp_type_e type, kmp_addr_t *addr)
|
|
{
|
|
(void) addr;
|
|
(void) type;
|
|
|
|
// For now, accept every KMP-CREATE.indication
|
|
kmp_api_create_response(kmp, KMP_RESULT_OK);
|
|
}
|
|
|
|
static void ws_pae_supp_kmp_api_finished_indication(kmp_api_t *kmp, kmp_result_e result, kmp_sec_keys_t *sec_keys)
|
|
{
|
|
kmp_service_t *service = kmp_api_service_get(kmp);
|
|
pae_supp_t *pae_supp = ws_pae_supp_by_kmp_service_get(service);
|
|
if (!pae_supp) {
|
|
return;
|
|
}
|
|
|
|
kmp_type_e type = kmp_api_type_get(kmp);
|
|
|
|
// Whenever EAP-TLS, 4WH or GKH completes increase timer for wait for authentication
|
|
if (type < IEEE_802_1X_INITIAL_KEY && result == KMP_RESULT_OK) {
|
|
ws_pae_lib_supp_timer_ticks_set(&pae_supp->entry, WAIT_FOR_AUTHENTICATION_TICKS);
|
|
}
|
|
|
|
/* When 4WH or GKH completes inserts keys and indicates authentication completed
|
|
(if not alredy indicated) */
|
|
if ((type == IEEE_802_11_4WH || type == IEEE_802_11_GKH) && result == KMP_RESULT_OK) {
|
|
if (sec_keys) {
|
|
sec_prot_keys_t *keys = sec_keys;
|
|
pae_supp->nw_key_insert(pae_supp->interface_ptr, keys->gtks);
|
|
}
|
|
|
|
ws_pae_supp_authenticate_response(pae_supp, AUTH_RESULT_OK);
|
|
}
|
|
|
|
/* If initial EAPOL-key message sending fails to tx no acknowledge, indicates failure so
|
|
that bootstrap can decide if EAPOL target should be changed */
|
|
else if (type > IEEE_802_1X_INITIAL_KEY && result == KMP_RESULT_ERR_TX_NO_ACK) {
|
|
tr_info("Initial EAPOL-Key TX failure, target: %s", trace_array(kmp_address_eui_64_get(&pae_supp->entry.addr), 8));
|
|
ws_pae_supp_authenticate_response(pae_supp, AUTH_RESULT_ERR_TX_NO_ACK);
|
|
}
|
|
|
|
}
|
|
|
|
static void ws_pae_supp_kmp_api_finished(kmp_api_t *kmp)
|
|
{
|
|
kmp_service_t *service = kmp_api_service_get(kmp);
|
|
pae_supp_t *pae_supp = ws_pae_supp_by_kmp_service_get(service);
|
|
if (!pae_supp) {
|
|
return;
|
|
}
|
|
|
|
// Delete KMP
|
|
ws_pae_lib_kmp_list_delete(&pae_supp->entry.kmp_list, kmp);
|
|
}
|
|
|
|
static kmp_api_t *ws_pae_supp_kmp_tx_status_ind(kmp_service_t *service, uint8_t instance_id)
|
|
{
|
|
pae_supp_t *pae_supp = ws_pae_supp_by_kmp_service_get(service);
|
|
if (!pae_supp) {
|
|
return NULL;
|
|
}
|
|
|
|
kmp_api_t *kmp = ws_pae_lib_kmp_list_instance_id_get(&pae_supp->entry.kmp_list, instance_id);
|
|
if (!kmp) {
|
|
return NULL;
|
|
}
|
|
|
|
return kmp;
|
|
}
|
|
|
|
#endif /* HAVE_PAE_SUPP */
|
|
#endif /* HAVE_WS */
|
|
|