mirror of
https://github.com/vanhoefm/fragattacks.git
synced 2024-11-26 17:28:29 -05:00
887d9d01ab
This adds initial implementation of IEEE Std 802.1X-2010 PAE for MACsec. Signed-off-by: Jouni Malinen <jouni@qca.qualcomm.com>
3527 lines
87 KiB
C
3527 lines
87 KiB
C
/*
|
|
* IEEE 802.1X-2010 Key Agree Protocol of PAE state machine
|
|
* Copyright (c) 2013, Qualcomm Atheros, Inc.
|
|
*
|
|
* This software may be distributed under the terms of the BSD license.
|
|
* See README for more details.
|
|
*/
|
|
|
|
#include <time.h>
|
|
#include "includes.h"
|
|
#include "common.h"
|
|
#include "list.h"
|
|
#include "eloop.h"
|
|
#include "wpabuf.h"
|
|
#include "state_machine.h"
|
|
#include "l2_packet/l2_packet.h"
|
|
#include "common/eapol_common.h"
|
|
#include "crypto/aes_wrap.h"
|
|
#include "ieee802_1x_cp.h"
|
|
#include "ieee802_1x_key.h"
|
|
#include "ieee802_1x_kay.h"
|
|
#include "ieee802_1x_kay_i.h"
|
|
#include "ieee802_1x_secy_ops.h"
|
|
|
|
|
|
#define DEFAULT_SA_KEY_LEN 16
|
|
#define DEFAULT_ICV_LEN 16
|
|
#define MAX_ICV_LEN 32 /* 32 bytes, 256 bits */
|
|
|
|
#define PENDING_PN_EXHAUSTION 0xC0000000
|
|
|
|
/* IEEE Std 802.1X-2010, Table 9-1 - MKA Algorithm Agility */
|
|
#define MKA_ALGO_AGILITY_2009 { 0x00, 0x80, 0xC2, 0x01 }
|
|
static u8 mka_algo_agility[4] = MKA_ALGO_AGILITY_2009;
|
|
|
|
/* IEEE802.1AE-2006 Table 14-1 MACsec Cipher Suites */
|
|
static struct macsec_ciphersuite cipher_suite_tbl[] = {
|
|
/* GCM-AES-128 */
|
|
{
|
|
CS_ID_GCM_AES_128,
|
|
CS_NAME_GCM_AES_128,
|
|
MACSEC_CAP_INTEG_AND_CONF_0_30_50,
|
|
16,
|
|
|
|
0 /* index */
|
|
},
|
|
};
|
|
#define CS_TABLE_SIZE (ARRAY_SIZE(cipher_suite_tbl))
|
|
#define DEFAULT_CS_INDEX 0
|
|
|
|
static struct mka_alg mka_alg_tbl[] = {
|
|
{
|
|
MKA_ALGO_AGILITY_2009,
|
|
/* 128-bit CAK, KEK, ICK, ICV */
|
|
16, 16, 16, 16,
|
|
ieee802_1x_cak_128bits_aes_cmac,
|
|
ieee802_1x_ckn_128bits_aes_cmac,
|
|
ieee802_1x_kek_128bits_aes_cmac,
|
|
ieee802_1x_ick_128bits_aes_cmac,
|
|
ieee802_1x_icv_128bits_aes_cmac,
|
|
|
|
1, /* index */
|
|
},
|
|
};
|
|
#define MKA_ALG_TABLE_SIZE (ARRAY_SIZE(mka_alg_tbl))
|
|
|
|
|
|
static int is_ki_equal(struct ieee802_1x_mka_ki *ki1,
|
|
struct ieee802_1x_mka_ki *ki2)
|
|
{
|
|
return os_memcmp(ki1->mi, ki2->mi, MI_LEN) == 0 &&
|
|
ki1->kn == ki2->kn;
|
|
}
|
|
|
|
|
|
struct mka_param_body_handler {
|
|
int (*body_tx)(struct ieee802_1x_mka_participant *participant,
|
|
struct wpabuf *buf);
|
|
int (*body_rx)(struct ieee802_1x_mka_participant *participant,
|
|
const u8 *mka_msg, size_t msg_len);
|
|
int (*body_length)(struct ieee802_1x_mka_participant *participant);
|
|
Boolean (*body_present)(struct ieee802_1x_mka_participant *participant);
|
|
};
|
|
|
|
|
|
static void set_mka_param_body_len(void *body, unsigned int len)
|
|
{
|
|
struct ieee802_1x_mka_hdr *hdr = body;
|
|
hdr->length = (len >> 8) & 0x0f;
|
|
hdr->length1 = len & 0xff;
|
|
}
|
|
|
|
|
|
static unsigned int get_mka_param_body_len(const void *body)
|
|
{
|
|
const struct ieee802_1x_mka_hdr *hdr = body;
|
|
return (hdr->length << 8) | hdr->length1;
|
|
}
|
|
|
|
|
|
static int get_mka_param_body_type(const void *body)
|
|
{
|
|
const struct ieee802_1x_mka_hdr *hdr = body;
|
|
return hdr->type;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_mka_dump_basic_body -
|
|
*/
|
|
static void
|
|
ieee802_1x_mka_dump_basic_body(struct ieee802_1x_mka_basic_body *body)
|
|
{
|
|
size_t body_len;
|
|
|
|
if (!body)
|
|
return;
|
|
|
|
body_len = get_mka_param_body_len(body);
|
|
wpa_printf(MSG_DEBUG, "*** MKA Basic Parameter set ***");
|
|
wpa_printf(MSG_DEBUG, "\tVersion.......: %d", body->version);
|
|
wpa_printf(MSG_DEBUG, "\tPriority......: %d", body->priority);
|
|
wpa_printf(MSG_DEBUG, "\tKeySvr........: %d", body->key_server);
|
|
wpa_printf(MSG_DEBUG, "\tMACSecDesired.: %d", body->macsec_desired);
|
|
wpa_printf(MSG_DEBUG, "\tMACSecCapable.: %d", body->macsec_capbility);
|
|
wpa_printf(MSG_DEBUG, "\tBody Length...: %d", (int) body_len);
|
|
wpa_printf(MSG_DEBUG, "\tSCI MAC.......: " MACSTR,
|
|
MAC2STR(body->actor_sci.addr));
|
|
wpa_printf(MSG_DEBUG, "\tSCI Port .....: %d",
|
|
be_to_host16(body->actor_sci.port));
|
|
wpa_hexdump(MSG_DEBUG, "\tMember Id.....:",
|
|
body->actor_mi, sizeof(body->actor_mi));
|
|
wpa_printf(MSG_DEBUG, "\tMessage Number: %d",
|
|
be_to_host32(body->actor_mn));
|
|
wpa_hexdump(MSG_DEBUG, "\tAlgo Agility..:",
|
|
body->algo_agility, sizeof(body->algo_agility));
|
|
wpa_hexdump_ascii(MSG_DEBUG, "\tCAK Name......:", body->ckn,
|
|
body_len + MKA_HDR_LEN - sizeof(*body));
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_mka_dump_peer_body -
|
|
*/
|
|
static void
|
|
ieee802_1x_mka_dump_peer_body(struct ieee802_1x_mka_peer_body *body)
|
|
{
|
|
size_t body_len;
|
|
size_t i;
|
|
u8 *mi;
|
|
u32 mn;
|
|
|
|
if (body == NULL)
|
|
return;
|
|
|
|
body_len = get_mka_param_body_len(body);
|
|
if (body->type == MKA_LIVE_PEER_LIST) {
|
|
wpa_printf(MSG_DEBUG, "*** Live Peer List ***");
|
|
wpa_printf(MSG_DEBUG, "\tBody Length...: %d", (int) body_len);
|
|
} else if (body->type == MKA_POTENTIAL_PEER_LIST) {
|
|
wpa_printf(MSG_DEBUG, "*** Potential Live Peer List ***");
|
|
wpa_printf(MSG_DEBUG, "\tBody Length...: %d", (int) body_len);
|
|
}
|
|
|
|
for (i = 0; i < body_len; i += MI_LEN + sizeof(mn)) {
|
|
mi = body->peer + i;
|
|
os_memcpy(&mn, mi + MI_LEN, sizeof(mn));
|
|
wpa_hexdump_ascii(MSG_DEBUG, "\tMember Id.....:", mi, MI_LEN);
|
|
wpa_printf(MSG_DEBUG, "\tMessage Number: %d", be_to_host32(mn));
|
|
}
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_mka_dump_dist_sak_body -
|
|
*/
|
|
static void
|
|
ieee802_1x_mka_dump_dist_sak_body(struct ieee802_1x_mka_dist_sak_body *body)
|
|
{
|
|
size_t body_len;
|
|
|
|
if (body == NULL)
|
|
return;
|
|
|
|
body_len = get_mka_param_body_len(body);
|
|
wpa_printf(MSG_INFO, "*** Distributed SAK ***");
|
|
wpa_printf(MSG_INFO, "\tDistributed AN........: %d", body->dan);
|
|
wpa_printf(MSG_INFO, "\tConfidentiality Offset: %d",
|
|
body->confid_offset);
|
|
wpa_printf(MSG_INFO, "\tBody Length...........: %d", (int) body_len);
|
|
if (!body_len)
|
|
return;
|
|
|
|
wpa_printf(MSG_INFO, "\tKey Number............: %d",
|
|
be_to_host32(body->kn));
|
|
wpa_hexdump(MSG_INFO, "\tAES Key Wrap of SAK...:", body->sak, 24);
|
|
}
|
|
|
|
|
|
static const char * yes_no(int val)
|
|
{
|
|
return val ? "Yes" : "No";
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_mka_dump_sak_use_body -
|
|
*/
|
|
static void
|
|
ieee802_1x_mka_dump_sak_use_body(struct ieee802_1x_mka_sak_use_body *body)
|
|
{
|
|
int body_len;
|
|
|
|
if (body == NULL)
|
|
return;
|
|
|
|
body_len = get_mka_param_body_len(body);
|
|
wpa_printf(MSG_DEBUG, "*** MACsec SAK Use ***");
|
|
wpa_printf(MSG_DEBUG, "\tLatest Key AN....: %d", body->lan);
|
|
wpa_printf(MSG_DEBUG, "\tLatest Key Tx....: %s", yes_no(body->ltx));
|
|
wpa_printf(MSG_DEBUG, "\tLatest Key Rx....: %s", yes_no(body->lrx));
|
|
wpa_printf(MSG_DEBUG, "\tOld Key AN....: %d", body->oan);
|
|
wpa_printf(MSG_DEBUG, "\tOld Key Tx....: %s", yes_no(body->otx));
|
|
wpa_printf(MSG_DEBUG, "\tOld Key Rx....: %s", yes_no(body->orx));
|
|
wpa_printf(MSG_DEBUG, "\tPlain Key Tx....: %s", yes_no(body->ptx));
|
|
wpa_printf(MSG_DEBUG, "\tPlain Key Rx....: %s", yes_no(body->prx));
|
|
wpa_printf(MSG_DEBUG, "\tDelay Protect....: %s",
|
|
yes_no(body->delay_protect));
|
|
wpa_printf(MSG_DEBUG, "\tBody Length......: %d", body_len);
|
|
if (!body_len)
|
|
return;
|
|
|
|
wpa_hexdump(MSG_DEBUG, "\tKey Server MI....:",
|
|
body->lsrv_mi, sizeof(body->lsrv_mi));
|
|
wpa_printf(MSG_DEBUG, "\tKey Number.......: %u",
|
|
be_to_host32(body->lkn));
|
|
wpa_printf(MSG_DEBUG, "\tLowest PN........: %u",
|
|
be_to_host32(body->llpn));
|
|
wpa_hexdump_ascii(MSG_DEBUG, "\tOld Key Server MI....:",
|
|
body->osrv_mi, sizeof(body->osrv_mi));
|
|
wpa_printf(MSG_DEBUG, "\tOld Key Number.......: %u",
|
|
be_to_host32(body->okn));
|
|
wpa_printf(MSG_DEBUG, "\tOld Lowest PN........: %u",
|
|
be_to_host32(body->olpn));
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_get_participant -
|
|
*/
|
|
static struct ieee802_1x_mka_participant *
|
|
ieee802_1x_kay_get_participant(struct ieee802_1x_kay *kay, const u8 *ckn)
|
|
{
|
|
struct ieee802_1x_mka_participant *participant;
|
|
|
|
dl_list_for_each(participant, &kay->participant_list,
|
|
struct ieee802_1x_mka_participant, list) {
|
|
if (os_memcmp(participant->ckn.name, ckn,
|
|
participant->ckn.len) == 0)
|
|
return participant;
|
|
}
|
|
|
|
wpa_printf(MSG_DEBUG, "KaY: participant is not found");
|
|
|
|
return NULL;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_get_principal_participant -
|
|
*/
|
|
static struct ieee802_1x_mka_participant *
|
|
ieee802_1x_kay_get_principal_participant(struct ieee802_1x_kay *kay)
|
|
{
|
|
struct ieee802_1x_mka_participant *participant;
|
|
|
|
dl_list_for_each(participant, &kay->participant_list,
|
|
struct ieee802_1x_mka_participant, list) {
|
|
if (participant->principal)
|
|
return participant;
|
|
}
|
|
|
|
wpa_printf(MSG_DEBUG, "KaY: principal participant is not founded");
|
|
return NULL;
|
|
}
|
|
|
|
|
|
static struct ieee802_1x_kay_peer * get_peer_mi(struct dl_list *peers,
|
|
const u8 *mi)
|
|
{
|
|
struct ieee802_1x_kay_peer *peer;
|
|
|
|
dl_list_for_each(peer, peers, struct ieee802_1x_kay_peer, list) {
|
|
if (os_memcmp(peer->mi, mi, MI_LEN) == 0)
|
|
return peer;
|
|
}
|
|
|
|
return NULL;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_is_in_potential_peer
|
|
*/
|
|
static Boolean
|
|
ieee802_1x_kay_is_in_potential_peer(
|
|
struct ieee802_1x_mka_participant *participant, const u8 *mi)
|
|
{
|
|
return get_peer_mi(&participant->potential_peers, mi) != NULL;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_is_in_live_peer
|
|
*/
|
|
static Boolean
|
|
ieee802_1x_kay_is_in_live_peer(
|
|
struct ieee802_1x_mka_participant *participant, const u8 *mi)
|
|
{
|
|
return get_peer_mi(&participant->live_peers, mi) != NULL;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_is_in_peer
|
|
*/
|
|
static Boolean
|
|
ieee802_1x_kay_is_in_peer(struct ieee802_1x_mka_participant *participant,
|
|
const u8 *mi)
|
|
{
|
|
return ieee802_1x_kay_is_in_live_peer(participant, mi) ||
|
|
ieee802_1x_kay_is_in_potential_peer(participant, mi);
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_get_peer
|
|
*/
|
|
static struct ieee802_1x_kay_peer *
|
|
ieee802_1x_kay_get_peer(struct ieee802_1x_mka_participant *participant,
|
|
const u8 *mi)
|
|
{
|
|
struct ieee802_1x_kay_peer *peer;
|
|
|
|
peer = get_peer_mi(&participant->live_peers, mi);
|
|
if (peer)
|
|
return peer;
|
|
|
|
return get_peer_mi(&participant->potential_peers, mi);
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_get_live_peer
|
|
*/
|
|
static struct ieee802_1x_kay_peer *
|
|
ieee802_1x_kay_get_live_peer(struct ieee802_1x_mka_participant *participant,
|
|
const u8 *mi)
|
|
{
|
|
return get_peer_mi(&participant->live_peers, mi);
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_get_cipher_suite
|
|
*/
|
|
static struct macsec_ciphersuite *
|
|
ieee802_1x_kay_get_cipher_suite(struct ieee802_1x_mka_participant *participant,
|
|
u8 *cs_id)
|
|
{
|
|
unsigned int i;
|
|
|
|
for (i = 0; i < CS_TABLE_SIZE; i++) {
|
|
if (os_memcmp(cipher_suite_tbl[i].id, cs_id, CS_ID_LEN) == 0)
|
|
break;
|
|
}
|
|
if (i >= CS_TABLE_SIZE)
|
|
return NULL;
|
|
|
|
return &cipher_suite_tbl[i];
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_get_peer_sci
|
|
*/
|
|
static struct ieee802_1x_kay_peer *
|
|
ieee802_1x_kay_get_peer_sci(struct ieee802_1x_mka_participant *participant,
|
|
const struct ieee802_1x_mka_sci *sci)
|
|
{
|
|
struct ieee802_1x_kay_peer *peer;
|
|
|
|
dl_list_for_each(peer, &participant->live_peers,
|
|
struct ieee802_1x_kay_peer, list) {
|
|
if (os_memcmp(&peer->sci, sci, sizeof(peer->sci)) == 0)
|
|
return peer;
|
|
}
|
|
|
|
dl_list_for_each(peer, &participant->potential_peers,
|
|
struct ieee802_1x_kay_peer, list) {
|
|
if (os_memcmp(&peer->sci, sci, sizeof(peer->sci)) == 0)
|
|
return peer;
|
|
}
|
|
|
|
return NULL;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_init_receive_sa -
|
|
*/
|
|
static struct receive_sa *
|
|
ieee802_1x_kay_init_receive_sa(struct receive_sc *psc, u8 an, u32 lowest_pn,
|
|
struct data_key *key)
|
|
{
|
|
struct receive_sa *psa;
|
|
|
|
if (!psc || !key)
|
|
return NULL;
|
|
|
|
psa = os_zalloc(sizeof(*psa));
|
|
if (!psa) {
|
|
wpa_printf(MSG_ERROR, "%s: out of memory", __func__);
|
|
return NULL;
|
|
}
|
|
|
|
psa->pkey = key;
|
|
psa->lowest_pn = lowest_pn;
|
|
psa->next_pn = lowest_pn;
|
|
psa->an = an;
|
|
psa->sc = psc;
|
|
|
|
os_get_time(&psa->created_time);
|
|
psa->in_use = FALSE;
|
|
|
|
dl_list_add(&psc->sa_list, &psa->list);
|
|
wpa_printf(MSG_DEBUG,
|
|
"KaY: Create receive SA(AN: %d lowest_pn: %u of SC(channel: %d)",
|
|
(int) an, lowest_pn, psc->channel);
|
|
|
|
return psa;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_deinit_receive_sa -
|
|
*/
|
|
static void ieee802_1x_kay_deinit_receive_sa(struct receive_sa *psa)
|
|
{
|
|
psa->pkey = NULL;
|
|
wpa_printf(MSG_DEBUG,
|
|
"KaY: Delete receive SA(an: %d) of SC(channel: %d)",
|
|
psa->an, psa->sc->channel);
|
|
dl_list_del(&psa->list);
|
|
os_free(psa);
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_init_receive_sc -
|
|
*/
|
|
static struct receive_sc *
|
|
ieee802_1x_kay_init_receive_sc(const struct ieee802_1x_mka_sci *psci,
|
|
int channel)
|
|
{
|
|
struct receive_sc *psc;
|
|
|
|
if (!psci)
|
|
return NULL;
|
|
|
|
psc = os_zalloc(sizeof(*psc));
|
|
if (!psc) {
|
|
wpa_printf(MSG_ERROR, "%s: out of memory", __func__);
|
|
return NULL;
|
|
}
|
|
|
|
os_memcpy(&psc->sci, psci, sizeof(psc->sci));
|
|
psc->channel = channel;
|
|
|
|
os_get_time(&psc->created_time);
|
|
psc->receiving = FALSE;
|
|
|
|
dl_list_init(&psc->sa_list);
|
|
wpa_printf(MSG_DEBUG, "KaY: Create receive SC(channel: %d)", channel);
|
|
wpa_hexdump(MSG_DEBUG, "SCI: ", (u8 *)psci, sizeof(*psci));
|
|
|
|
return psc;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_deinit_receive_sc -
|
|
**/
|
|
static void
|
|
ieee802_1x_kay_deinit_receive_sc(
|
|
struct ieee802_1x_mka_participant *participant, struct receive_sc *psc)
|
|
{
|
|
struct receive_sa *psa, *pre_sa;
|
|
|
|
wpa_printf(MSG_DEBUG, "KaY: Delete receive SC(channel: %d)",
|
|
psc->channel);
|
|
dl_list_for_each_safe(psa, pre_sa, &psc->sa_list, struct receive_sa,
|
|
list) {
|
|
secy_disable_receive_sa(participant->kay, psa);
|
|
ieee802_1x_kay_deinit_receive_sa(psa);
|
|
}
|
|
dl_list_del(&psc->list);
|
|
os_free(psc);
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_create_live_peer
|
|
*/
|
|
static struct ieee802_1x_kay_peer *
|
|
ieee802_1x_kay_create_live_peer(struct ieee802_1x_mka_participant *participant,
|
|
u8 *mi, u32 mn)
|
|
{
|
|
struct ieee802_1x_kay_peer *peer;
|
|
struct receive_sc *rxsc;
|
|
u32 sc_ch = 0;
|
|
|
|
peer = os_zalloc(sizeof(*peer));
|
|
if (peer == NULL) {
|
|
wpa_printf(MSG_ERROR, "KaY-%s: out of memory", __func__);
|
|
return NULL;
|
|
}
|
|
|
|
os_memcpy(peer->mi, mi, MI_LEN);
|
|
peer->mn = mn;
|
|
peer->expire = time(NULL) + MKA_LIFE_TIME / 1000;
|
|
peer->sak_used = FALSE;
|
|
os_memcpy(&peer->sci, &participant->current_peer_sci,
|
|
sizeof(peer->sci));
|
|
dl_list_add(&participant->live_peers, &peer->list);
|
|
|
|
secy_get_available_receive_sc(participant->kay, &sc_ch);
|
|
|
|
rxsc = ieee802_1x_kay_init_receive_sc(&peer->sci, sc_ch);
|
|
if (!rxsc)
|
|
return NULL;
|
|
|
|
dl_list_add(&participant->rxsc_list, &rxsc->list);
|
|
secy_create_receive_sc(participant->kay, rxsc);
|
|
|
|
wpa_printf(MSG_DEBUG, "KaY: Live peer created");
|
|
wpa_hexdump(MSG_DEBUG, "\tMI: ", peer->mi, sizeof(peer->mi));
|
|
wpa_printf(MSG_DEBUG, "\tMN: %d", peer->mn);
|
|
wpa_hexdump(MSG_DEBUG, "\tSCI Addr: ", peer->sci.addr, ETH_ALEN);
|
|
wpa_printf(MSG_DEBUG, "\tPort: %d", peer->sci.port);
|
|
|
|
return peer;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_create_potential_peer
|
|
*/
|
|
static struct ieee802_1x_kay_peer *
|
|
ieee802_1x_kay_create_potential_peer(
|
|
struct ieee802_1x_mka_participant *participant, const u8 *mi, u32 mn)
|
|
{
|
|
struct ieee802_1x_kay_peer *peer;
|
|
|
|
peer = os_zalloc(sizeof(*peer));
|
|
if (peer == NULL) {
|
|
wpa_printf(MSG_ERROR, "KaY-%s: out of memory", __func__);
|
|
return NULL;
|
|
}
|
|
|
|
os_memcpy(peer->mi, mi, MI_LEN);
|
|
peer->mn = mn;
|
|
peer->expire = time(NULL) + MKA_LIFE_TIME / 1000;
|
|
peer->sak_used = FALSE;
|
|
|
|
dl_list_add(&participant->potential_peers, &peer->list);
|
|
|
|
wpa_printf(MSG_DEBUG, "KaY: potential peer created");
|
|
wpa_hexdump(MSG_DEBUG, "\tMI: ", peer->mi, sizeof(peer->mi));
|
|
wpa_printf(MSG_DEBUG, "\tMN: %d", peer->mn);
|
|
wpa_hexdump(MSG_DEBUG, "\tSCI Addr: ", peer->sci.addr, ETH_ALEN);
|
|
wpa_printf(MSG_DEBUG, "\tPort: %d", peer->sci.port);
|
|
|
|
return peer;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_move_live_peer
|
|
*/
|
|
static struct ieee802_1x_kay_peer *
|
|
ieee802_1x_kay_move_live_peer(struct ieee802_1x_mka_participant *participant,
|
|
u8 *mi, u32 mn)
|
|
{
|
|
struct ieee802_1x_kay_peer *peer;
|
|
struct receive_sc *rxsc;
|
|
u32 sc_ch = 0;
|
|
|
|
dl_list_for_each(peer, &participant->potential_peers,
|
|
struct ieee802_1x_kay_peer, list) {
|
|
if (os_memcmp(peer->mi, mi, MI_LEN) == 0)
|
|
break;
|
|
}
|
|
|
|
os_memcpy(&peer->sci, &participant->current_peer_sci,
|
|
sizeof(peer->sci));
|
|
peer->mn = mn;
|
|
peer->expire = time(NULL) + MKA_LIFE_TIME / 1000;
|
|
|
|
wpa_printf(MSG_DEBUG, "KaY: move potential peer to live peer");
|
|
wpa_hexdump(MSG_DEBUG, "\tMI: ", peer->mi, sizeof(peer->mi));
|
|
wpa_printf(MSG_DEBUG, "\tMN: %d", peer->mn);
|
|
wpa_hexdump(MSG_DEBUG, "\tSCI Addr: ", peer->sci.addr, ETH_ALEN);
|
|
wpa_printf(MSG_DEBUG, "\tPort: %d", peer->sci.port);
|
|
|
|
dl_list_del(&peer->list);
|
|
dl_list_add_tail(&participant->live_peers, &peer->list);
|
|
|
|
secy_get_available_receive_sc(participant->kay, &sc_ch);
|
|
|
|
rxsc = ieee802_1x_kay_init_receive_sc(&peer->sci, sc_ch);
|
|
if (!rxsc)
|
|
return NULL;
|
|
|
|
dl_list_add(&participant->rxsc_list, &rxsc->list);
|
|
secy_create_receive_sc(participant->kay, rxsc);
|
|
|
|
return peer;
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
* ieee802_1x_mka_basic_body_present -
|
|
*/
|
|
static Boolean
|
|
ieee802_1x_mka_basic_body_present(
|
|
struct ieee802_1x_mka_participant *participant)
|
|
{
|
|
return TRUE;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_mka_basic_body_length -
|
|
*/
|
|
static int
|
|
ieee802_1x_mka_basic_body_length(struct ieee802_1x_mka_participant *participant)
|
|
{
|
|
int length;
|
|
|
|
length = sizeof(struct ieee802_1x_mka_basic_body);
|
|
length += participant->ckn.len;
|
|
return (length + 0x3) & ~0x3;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_mka_encode_basic_body
|
|
*/
|
|
static int
|
|
ieee802_1x_mka_encode_basic_body(
|
|
struct ieee802_1x_mka_participant *participant,
|
|
struct wpabuf *buf)
|
|
{
|
|
struct ieee802_1x_mka_basic_body *body;
|
|
struct ieee802_1x_kay *kay = participant->kay;
|
|
unsigned int length = ieee802_1x_mka_basic_body_length(participant);
|
|
|
|
body = wpabuf_put(buf, length);
|
|
|
|
body->version = kay->mka_version;
|
|
body->priority = kay->actor_priority;
|
|
if (participant->is_elected)
|
|
body->key_server = participant->is_key_server;
|
|
else
|
|
body->key_server = participant->can_be_key_server;
|
|
|
|
body->macsec_desired = kay->macsec_desired;
|
|
body->macsec_capbility = kay->macsec_capable;
|
|
set_mka_param_body_len(body, length - MKA_HDR_LEN);
|
|
|
|
os_memcpy(body->actor_sci.addr, kay->actor_sci.addr,
|
|
sizeof(kay->actor_sci.addr));
|
|
body->actor_sci.port = host_to_be16(kay->actor_sci.port);
|
|
|
|
os_memcpy(body->actor_mi, participant->mi, sizeof(body->actor_mi));
|
|
participant->mn = participant->mn + 1;
|
|
body->actor_mn = host_to_be32(participant->mn);
|
|
os_memcpy(body->algo_agility, participant->kay->algo_agility,
|
|
sizeof(body->algo_agility));
|
|
|
|
os_memcpy(body->ckn, participant->ckn.name, participant->ckn.len);
|
|
|
|
ieee802_1x_mka_dump_basic_body(body);
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_mka_decode_basic_body -
|
|
*/
|
|
static struct ieee802_1x_mka_participant *
|
|
ieee802_1x_mka_decode_basic_body(struct ieee802_1x_kay *kay, const u8 *mka_msg,
|
|
size_t msg_len)
|
|
{
|
|
struct ieee802_1x_mka_participant *participant;
|
|
const struct ieee802_1x_mka_basic_body *body;
|
|
struct ieee802_1x_kay_peer *peer;
|
|
|
|
body = (const struct ieee802_1x_mka_basic_body *) mka_msg;
|
|
|
|
if (body->version > MKA_VERSION_ID) {
|
|
wpa_printf(MSG_DEBUG,
|
|
"KaY: peer's version(%d) greater than mka current version(%d)",
|
|
body->version, MKA_VERSION_ID);
|
|
}
|
|
if (kay->is_obliged_key_server && body->key_server) {
|
|
wpa_printf(MSG_DEBUG, "I must be as key server");
|
|
return NULL;
|
|
}
|
|
|
|
participant = ieee802_1x_kay_get_participant(kay, body->ckn);
|
|
if (!participant) {
|
|
wpa_printf(MSG_DEBUG, "Peer is not included in my CA");
|
|
return NULL;
|
|
}
|
|
|
|
/* If the peer's MI is my MI, I will choose new MI */
|
|
if (os_memcmp(body->actor_mi, participant->mi, MI_LEN) == 0) {
|
|
os_get_random(participant->mi, sizeof(participant->mi));
|
|
participant->mn = 0;
|
|
}
|
|
|
|
os_memcpy(participant->current_peer_id.mi, body->actor_mi, MI_LEN);
|
|
participant->current_peer_id.mn = be_to_host32(body->actor_mn);
|
|
os_memcpy(participant->current_peer_sci.addr, body->actor_sci.addr,
|
|
sizeof(participant->current_peer_sci.addr));
|
|
participant->current_peer_sci.port = be_to_host16(body->actor_sci.port);
|
|
|
|
/* handler peer */
|
|
peer = ieee802_1x_kay_get_peer(participant, body->actor_mi);
|
|
if (!peer) {
|
|
/* Check duplicated SCI */
|
|
/* TODO: What policy should be applied to detect duplicated SCI
|
|
* is active attacker or a valid peer whose MI is be changed?
|
|
*/
|
|
peer = ieee802_1x_kay_get_peer_sci(participant,
|
|
&body->actor_sci);
|
|
if (peer) {
|
|
wpa_printf(MSG_WARNING,
|
|
"KaY: duplicated SCI detected, Maybe active attacker");
|
|
dl_list_del(&peer->list);
|
|
os_free(peer);
|
|
}
|
|
|
|
peer = ieee802_1x_kay_create_potential_peer(
|
|
participant, body->actor_mi,
|
|
be_to_host32(body->actor_mn));
|
|
if (!peer)
|
|
return NULL;
|
|
|
|
peer->macsec_desired = body->macsec_desired;
|
|
peer->macsec_capbility = body->macsec_capbility;
|
|
peer->is_key_server = (Boolean) body->key_server;
|
|
peer->key_server_priority = body->priority;
|
|
} else if (peer->mn < be_to_host32(body->actor_mn)) {
|
|
peer->mn = be_to_host32(body->actor_mn);
|
|
peer->expire = time(NULL) + MKA_LIFE_TIME / 1000;
|
|
peer->macsec_desired = body->macsec_desired;
|
|
peer->macsec_capbility = body->macsec_capbility;
|
|
peer->is_key_server = (Boolean) body->key_server;
|
|
peer->key_server_priority = body->priority;
|
|
} else {
|
|
wpa_printf(MSG_WARNING, "KaY: The peer MN have received");
|
|
return NULL;
|
|
}
|
|
|
|
return participant;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_mka_live_peer_body_present
|
|
*/
|
|
static Boolean
|
|
ieee802_1x_mka_live_peer_body_present(
|
|
struct ieee802_1x_mka_participant *participant)
|
|
{
|
|
return !dl_list_empty(&participant->live_peers);
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_get_live_peer_length
|
|
*/
|
|
static int
|
|
ieee802_1x_mka_get_live_peer_length(
|
|
struct ieee802_1x_mka_participant *participant)
|
|
{
|
|
int len = MKA_HDR_LEN;
|
|
struct ieee802_1x_kay_peer *peer;
|
|
|
|
dl_list_for_each(peer, &participant->live_peers,
|
|
struct ieee802_1x_kay_peer, list)
|
|
len += sizeof(struct ieee802_1x_mka_peer_id);
|
|
|
|
return (len + 0x3) & ~0x3;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_mka_encode_live_peer_body -
|
|
*/
|
|
static int
|
|
ieee802_1x_mka_encode_live_peer_body(
|
|
struct ieee802_1x_mka_participant *participant,
|
|
struct wpabuf *buf)
|
|
{
|
|
struct ieee802_1x_mka_peer_body *body;
|
|
struct ieee802_1x_kay_peer *peer;
|
|
unsigned int length;
|
|
struct ieee802_1x_mka_peer_id *body_peer;
|
|
|
|
length = ieee802_1x_mka_get_live_peer_length(participant);
|
|
body = wpabuf_put(buf, sizeof(struct ieee802_1x_mka_peer_body));
|
|
|
|
body->type = MKA_LIVE_PEER_LIST;
|
|
set_mka_param_body_len(body, length - MKA_HDR_LEN);
|
|
|
|
dl_list_for_each(peer, &participant->live_peers,
|
|
struct ieee802_1x_kay_peer, list) {
|
|
body_peer = wpabuf_put(buf,
|
|
sizeof(struct ieee802_1x_mka_peer_id));
|
|
os_memcpy(body_peer->mi, peer->mi, MI_LEN);
|
|
body_peer->mn = host_to_be32(peer->mn);
|
|
body_peer++;
|
|
}
|
|
|
|
ieee802_1x_mka_dump_peer_body(body);
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* ieee802_1x_mka_potential_peer_body_present
|
|
*/
|
|
static Boolean
|
|
ieee802_1x_mka_potential_peer_body_present(
|
|
struct ieee802_1x_mka_participant *participant)
|
|
{
|
|
return !dl_list_empty(&participant->potential_peers);
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_get_potential_peer_length
|
|
*/
|
|
static int
|
|
ieee802_1x_mka_get_potential_peer_length(
|
|
struct ieee802_1x_mka_participant *participant)
|
|
{
|
|
int len = MKA_HDR_LEN;
|
|
struct ieee802_1x_kay_peer *peer;
|
|
|
|
dl_list_for_each(peer, &participant->potential_peers,
|
|
struct ieee802_1x_kay_peer, list)
|
|
len += sizeof(struct ieee802_1x_mka_peer_id);
|
|
|
|
return (len + 0x3) & ~0x3;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_mka_encode_potential_peer_body -
|
|
*/
|
|
static int
|
|
ieee802_1x_mka_encode_potential_peer_body(
|
|
struct ieee802_1x_mka_participant *participant,
|
|
struct wpabuf *buf)
|
|
{
|
|
struct ieee802_1x_mka_peer_body *body;
|
|
struct ieee802_1x_kay_peer *peer;
|
|
unsigned int length;
|
|
struct ieee802_1x_mka_peer_id *body_peer;
|
|
|
|
length = ieee802_1x_mka_get_potential_peer_length(participant);
|
|
body = wpabuf_put(buf, sizeof(struct ieee802_1x_mka_peer_body));
|
|
|
|
body->type = MKA_POTENTIAL_PEER_LIST;
|
|
set_mka_param_body_len(body, length - MKA_HDR_LEN);
|
|
|
|
dl_list_for_each(peer, &participant->potential_peers,
|
|
struct ieee802_1x_kay_peer, list) {
|
|
body_peer = wpabuf_put(buf,
|
|
sizeof(struct ieee802_1x_mka_peer_id));
|
|
os_memcpy(body_peer->mi, peer->mi, MI_LEN);
|
|
body_peer->mn = host_to_be32(peer->mn);
|
|
body_peer++;
|
|
}
|
|
|
|
ieee802_1x_mka_dump_peer_body(body);
|
|
return 0;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_mka_i_in_peerlist -
|
|
*/
|
|
static Boolean
|
|
ieee802_1x_mka_i_in_peerlist(struct ieee802_1x_mka_participant *participant,
|
|
const u8 *mka_msg, size_t msg_len)
|
|
{
|
|
Boolean included = FALSE;
|
|
struct ieee802_1x_mka_hdr *hdr;
|
|
size_t body_len;
|
|
size_t left_len;
|
|
int body_type;
|
|
u32 peer_mn;
|
|
const u8 *peer_mi;
|
|
const u8 *pos;
|
|
size_t i;
|
|
|
|
pos = mka_msg;
|
|
left_len = msg_len;
|
|
while (left_len > (MKA_HDR_LEN + DEFAULT_ICV_LEN)) {
|
|
hdr = (struct ieee802_1x_mka_hdr *) pos;
|
|
body_len = get_mka_param_body_len(hdr);
|
|
body_type = get_mka_param_body_type(hdr);
|
|
|
|
if (body_type != MKA_LIVE_PEER_LIST &&
|
|
body_type != MKA_POTENTIAL_PEER_LIST)
|
|
goto SKIP_PEER;
|
|
|
|
ieee802_1x_mka_dump_peer_body(
|
|
(struct ieee802_1x_mka_peer_body *)pos);
|
|
|
|
if (left_len < (MKA_HDR_LEN + body_len + DEFAULT_ICV_LEN)) {
|
|
wpa_printf(MSG_ERROR,
|
|
"KaY: MKA Peer Packet Body Length (%d bytes) is less than the Parameter Set Header Length (%d bytes) + the Parameter Set Body Length (%d bytes) + %d bytes of ICV",
|
|
(int) left_len, (int) MKA_HDR_LEN,
|
|
(int) body_len, DEFAULT_ICV_LEN);
|
|
goto SKIP_PEER;
|
|
}
|
|
|
|
if ((body_len % 16) != 0) {
|
|
wpa_printf(MSG_ERROR,
|
|
"KaY: MKA Peer Packet Body Length (%d bytes) should multiple of 16 octets",
|
|
(int) body_len);
|
|
goto SKIP_PEER;
|
|
}
|
|
|
|
for (i = 0; i < body_len; i += MI_LEN + sizeof(peer_mn)) {
|
|
peer_mi = MKA_HDR_LEN + pos + i;
|
|
os_memcpy(&peer_mn, peer_mi + MI_LEN, sizeof(peer_mn));
|
|
peer_mn = be_to_host32(peer_mn);
|
|
if (os_memcmp(peer_mi, participant->mi, MI_LEN) == 0 &&
|
|
peer_mn == participant->mn) {
|
|
included = TRUE;
|
|
break;
|
|
}
|
|
}
|
|
|
|
if (included)
|
|
return TRUE;
|
|
|
|
SKIP_PEER:
|
|
left_len -= body_len + MKA_HDR_LEN;
|
|
pos += body_len + MKA_HDR_LEN;
|
|
}
|
|
|
|
return FALSE;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_mka_decode_live_peer_body -
|
|
*/
|
|
static int ieee802_1x_mka_decode_live_peer_body(
|
|
struct ieee802_1x_mka_participant *participant,
|
|
const u8 *peer_msg, size_t msg_len)
|
|
{
|
|
const struct ieee802_1x_mka_hdr *hdr;
|
|
struct ieee802_1x_kay_peer *peer;
|
|
size_t body_len;
|
|
u32 peer_mn;
|
|
const u8 *peer_mi;
|
|
size_t i;
|
|
Boolean is_included;
|
|
|
|
is_included = ieee802_1x_kay_is_in_live_peer(
|
|
participant, participant->current_peer_id.mi);
|
|
|
|
hdr = (const struct ieee802_1x_mka_hdr *) peer_msg;
|
|
body_len = get_mka_param_body_len(hdr);
|
|
|
|
for (i = 0; i < body_len; i += MI_LEN + sizeof(peer_mn)) {
|
|
peer_mi = MKA_HDR_LEN + peer_msg + i;
|
|
os_memcpy(&peer_mn, peer_mi + MI_LEN, sizeof(peer_mn));
|
|
peer_mn = be_to_host32(peer_mn);
|
|
|
|
/* it is myself */
|
|
if (os_memcmp(peer_mi, participant->mi, MI_LEN) == 0) {
|
|
/* My message id is used by other participant */
|
|
if (peer_mn > participant->mn) {
|
|
os_get_random(participant->mi,
|
|
sizeof(participant->mi));
|
|
participant->mn = 0;
|
|
}
|
|
continue;
|
|
}
|
|
if (!is_included)
|
|
continue;
|
|
|
|
peer = ieee802_1x_kay_get_peer(participant, peer_mi);
|
|
if (NULL != peer) {
|
|
peer->mn = peer_mn;
|
|
peer->expire = time(NULL) + MKA_LIFE_TIME / 1000;
|
|
} else {
|
|
if (!ieee802_1x_kay_create_potential_peer(
|
|
participant, peer_mi, peer_mn)) {
|
|
return -1;
|
|
}
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_mka_decode_potential_peer_body -
|
|
*/
|
|
static int
|
|
ieee802_1x_mka_decode_potential_peer_body(
|
|
struct ieee802_1x_mka_participant *participant,
|
|
const u8 *peer_msg, size_t msg_len)
|
|
{
|
|
struct ieee802_1x_mka_hdr *hdr;
|
|
size_t body_len;
|
|
u32 peer_mn;
|
|
const u8 *peer_mi;
|
|
size_t i;
|
|
|
|
hdr = (struct ieee802_1x_mka_hdr *) peer_msg;
|
|
body_len = get_mka_param_body_len(hdr);
|
|
|
|
for (i = 0; i < body_len; i += MI_LEN + sizeof(peer_mn)) {
|
|
peer_mi = MKA_HDR_LEN + peer_msg + i;
|
|
os_memcpy(&peer_mn, peer_mi + MI_LEN, sizeof(peer_mn));
|
|
peer_mn = be_to_host32(peer_mn);
|
|
|
|
/* it is myself */
|
|
if (os_memcmp(peer_mi, participant->mi, MI_LEN) == 0) {
|
|
/* My message id is used by other participant */
|
|
if (peer_mn > participant->mn) {
|
|
os_get_random(participant->mi,
|
|
sizeof(participant->mi));
|
|
participant->mn = 0;
|
|
}
|
|
continue;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_mka_sak_use_body_present
|
|
*/
|
|
static Boolean
|
|
ieee802_1x_mka_sak_use_body_present(
|
|
struct ieee802_1x_mka_participant *participant)
|
|
{
|
|
if (participant->to_use_sak)
|
|
return TRUE;
|
|
else
|
|
return FALSE;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_mka_get_sak_use_length
|
|
*/
|
|
static int
|
|
ieee802_1x_mka_get_sak_use_length(
|
|
struct ieee802_1x_mka_participant *participant)
|
|
{
|
|
int length = MKA_HDR_LEN;
|
|
|
|
if (participant->kay->macsec_desired && participant->advised_desired)
|
|
length = sizeof(struct ieee802_1x_mka_sak_use_body);
|
|
else
|
|
length = MKA_HDR_LEN;
|
|
|
|
length = (length + 0x3) & ~0x3;
|
|
|
|
return length;
|
|
}
|
|
|
|
|
|
/**
|
|
*
|
|
*/
|
|
static u32
|
|
ieee802_1x_mka_get_lpn(struct ieee802_1x_mka_participant *principal,
|
|
struct ieee802_1x_mka_ki *ki)
|
|
{
|
|
struct receive_sa *rxsa;
|
|
struct receive_sc *rxsc;
|
|
u32 lpn = 0;
|
|
|
|
dl_list_for_each(rxsc, &principal->rxsc_list, struct receive_sc, list) {
|
|
dl_list_for_each(rxsa, &rxsc->sa_list, struct receive_sa, list)
|
|
{
|
|
if (is_ki_equal(&rxsa->pkey->key_identifier, ki)) {
|
|
secy_get_receive_lowest_pn(principal->kay,
|
|
rxsa);
|
|
|
|
lpn = lpn > rxsa->lowest_pn ?
|
|
lpn : rxsa->lowest_pn;
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
if (lpn == 0)
|
|
lpn = 1;
|
|
|
|
return lpn;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_mka_encode_sak_use_body -
|
|
*/
|
|
static int
|
|
ieee802_1x_mka_encode_sak_use_body(
|
|
struct ieee802_1x_mka_participant *participant,
|
|
struct wpabuf *buf)
|
|
{
|
|
struct ieee802_1x_mka_sak_use_body *body;
|
|
unsigned int length;
|
|
u32 pn = 1;
|
|
|
|
length = ieee802_1x_mka_get_sak_use_length(participant);
|
|
body = wpabuf_put(buf, sizeof(struct ieee802_1x_mka_sak_use_body));
|
|
|
|
body->type = MKA_SAK_USE;
|
|
set_mka_param_body_len(body, length - MKA_HDR_LEN);
|
|
|
|
if (length == MKA_HDR_LEN) {
|
|
body->ptx = TRUE;
|
|
body->prx = TRUE;
|
|
body->lan = 0;
|
|
body->lrx = FALSE;
|
|
body->ltx = FALSE;
|
|
body->delay_protect = FALSE;
|
|
return 0;
|
|
}
|
|
|
|
/* data protect, lowest accept packet number */
|
|
body->delay_protect = participant->kay->macsec_replay_protect;
|
|
pn = ieee802_1x_mka_get_lpn(participant, &participant->lki);
|
|
if (pn > participant->kay->pn_exhaustion) {
|
|
wpa_printf(MSG_WARNING, "KaY: My LPN exhaustion");
|
|
if (participant->is_key_server)
|
|
participant->new_sak = TRUE;
|
|
}
|
|
|
|
body->llpn = host_to_be32(pn);
|
|
pn = ieee802_1x_mka_get_lpn(participant, &participant->oki);
|
|
body->olpn = host_to_be32(pn);
|
|
|
|
/* plain tx, plain rx */
|
|
if (participant->kay->macsec_protect)
|
|
body->ptx = FALSE;
|
|
else
|
|
body->ptx = TRUE;
|
|
|
|
if (participant->kay->macsec_validate == Strict)
|
|
body->prx = FALSE;
|
|
else
|
|
body->prx = TRUE;
|
|
|
|
/* latest key: rx, tx, key server member identifier key number */
|
|
body->lan = participant->lan;
|
|
os_memcpy(body->lsrv_mi, participant->lki.mi,
|
|
sizeof(body->lsrv_mi));
|
|
body->lkn = host_to_be32(participant->lki.kn);
|
|
body->lrx = participant->lrx;
|
|
body->ltx = participant->ltx;
|
|
|
|
/* old key: rx, tx, key server member identifier key number */
|
|
body->oan = participant->oan;
|
|
if (participant->oki.kn != participant->lki.kn &&
|
|
participant->oki.kn != 0) {
|
|
body->otx = TRUE;
|
|
body->orx = TRUE;
|
|
os_memcpy(body->osrv_mi, participant->oki.mi,
|
|
sizeof(body->osrv_mi));
|
|
body->okn = host_to_be32(participant->oki.kn);
|
|
} else {
|
|
body->otx = FALSE;
|
|
body->orx = FALSE;
|
|
}
|
|
|
|
/* set CP's variable */
|
|
if (body->ltx) {
|
|
if (!participant->kay->tx_enable)
|
|
participant->kay->tx_enable = TRUE;
|
|
|
|
if (!participant->kay->port_enable)
|
|
participant->kay->port_enable = TRUE;
|
|
}
|
|
if (body->lrx) {
|
|
if (!participant->kay->rx_enable)
|
|
participant->kay->rx_enable = TRUE;
|
|
}
|
|
|
|
ieee802_1x_mka_dump_sak_use_body(body);
|
|
return 0;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_mka_decode_sak_use_body -
|
|
*/
|
|
static int
|
|
ieee802_1x_mka_decode_sak_use_body(
|
|
struct ieee802_1x_mka_participant *participant,
|
|
const u8 *mka_msg, size_t msg_len)
|
|
{
|
|
struct ieee802_1x_mka_hdr *hdr;
|
|
struct ieee802_1x_mka_sak_use_body *body;
|
|
struct ieee802_1x_kay_peer *peer;
|
|
struct transmit_sa *txsa;
|
|
struct data_key *sa_key = NULL;
|
|
size_t body_len;
|
|
struct ieee802_1x_mka_ki ki;
|
|
u32 lpn;
|
|
Boolean all_receiving;
|
|
Boolean founded;
|
|
|
|
if (!participant->principal) {
|
|
wpa_printf(MSG_WARNING, "KaY: Participant is not principal");
|
|
return -1;
|
|
}
|
|
peer = ieee802_1x_kay_get_live_peer(participant,
|
|
participant->current_peer_id.mi);
|
|
if (!peer) {
|
|
wpa_printf(MSG_WARNING, "KaY: the peer is not my live peer");
|
|
return -1;
|
|
}
|
|
|
|
hdr = (struct ieee802_1x_mka_hdr *) mka_msg;
|
|
body_len = get_mka_param_body_len(hdr);
|
|
body = (struct ieee802_1x_mka_sak_use_body *) mka_msg;
|
|
ieee802_1x_mka_dump_sak_use_body(body);
|
|
|
|
if ((body_len != 0) && (body_len < 40)) {
|
|
wpa_printf(MSG_ERROR,
|
|
"KaY: MKA Use SAK Packet Body Length (%d bytes) should be 0, 40, or more octets",
|
|
(int) body_len);
|
|
return -1;
|
|
}
|
|
|
|
/* TODO: what action should I take when peer does not support MACsec */
|
|
if (body_len == 0) {
|
|
wpa_printf(MSG_WARNING, "KaY: Peer does not support MACsec");
|
|
return 0;
|
|
}
|
|
|
|
/* TODO: when the plain tx or rx of peer is true, should I change
|
|
* the attribute of controlled port
|
|
*/
|
|
if (body->prx)
|
|
wpa_printf(MSG_WARNING, "KaY: peer's plain rx are TRUE");
|
|
|
|
if (body->ptx)
|
|
wpa_printf(MSG_WARNING, "KaY: peer's plain tx are TRUE");
|
|
|
|
/* check latest key is valid */
|
|
if (body->ltx || body->lrx) {
|
|
founded = FALSE;
|
|
os_memcpy(ki.mi, body->lsrv_mi, sizeof(ki.mi));
|
|
ki.kn = ntohl(body->lkn);
|
|
dl_list_for_each(sa_key, &participant->sak_list,
|
|
struct data_key, list) {
|
|
if (is_ki_equal(&sa_key->key_identifier, &ki)) {
|
|
founded = TRUE;
|
|
break;
|
|
}
|
|
}
|
|
if (!founded) {
|
|
wpa_printf(MSG_WARNING, "KaY: Latest key is invalid");
|
|
return -1;
|
|
}
|
|
if (os_memcmp(participant->lki.mi, body->lsrv_mi,
|
|
sizeof(participant->lki.mi)) == 0 &&
|
|
ntohl(body->lkn) == participant->lki.kn &&
|
|
body->lan == participant->lan) {
|
|
peer->sak_used = TRUE;
|
|
}
|
|
if (body->ltx && peer->is_key_server) {
|
|
ieee802_1x_cp_set_servertransmitting(
|
|
participant->kay->cp, TRUE);
|
|
ieee802_1x_cp_sm_step(participant->kay->cp);
|
|
}
|
|
}
|
|
|
|
/* check old key is valid */
|
|
if (body->otx || body->orx) {
|
|
if (os_memcmp(participant->oki.mi, body->osrv_mi,
|
|
sizeof(participant->oki.mi)) != 0 ||
|
|
ntohl(body->okn) != participant->oki.kn ||
|
|
body->oan != participant->oan) {
|
|
wpa_printf(MSG_WARNING, "KaY: Old key is invalid");
|
|
return -1;
|
|
}
|
|
}
|
|
|
|
/* TODO: how to set the MACsec hardware when delay_protect is true */
|
|
if (body->delay_protect && (!ntohl(body->llpn) || !ntohl(body->olpn))) {
|
|
wpa_printf(MSG_WARNING,
|
|
"KaY: Lowest packet number should greater than 0 when delay_protect is TRUE");
|
|
return -1;
|
|
}
|
|
|
|
/* check all live peer have used the sak for receiving sa */
|
|
all_receiving = TRUE;
|
|
dl_list_for_each(peer, &participant->live_peers,
|
|
struct ieee802_1x_kay_peer, list) {
|
|
if (!peer->sak_used) {
|
|
all_receiving = FALSE;
|
|
break;
|
|
}
|
|
}
|
|
if (all_receiving) {
|
|
participant->to_dist_sak = FALSE;
|
|
ieee802_1x_cp_set_allreceiving(participant->kay->cp, TRUE);
|
|
ieee802_1x_cp_sm_step(participant->kay->cp);
|
|
}
|
|
|
|
/* if i'm key server, and detects peer member pn exhaustion, rekey.*/
|
|
lpn = ntohl(body->llpn);
|
|
if (lpn > participant->kay->pn_exhaustion) {
|
|
if (participant->is_key_server) {
|
|
participant->new_sak = TRUE;
|
|
wpa_printf(MSG_WARNING, "KaY: Peer LPN exhaustion");
|
|
}
|
|
}
|
|
|
|
founded = FALSE;
|
|
dl_list_for_each(txsa, &participant->txsc->sa_list,
|
|
struct transmit_sa, list) {
|
|
if (sa_key != NULL && txsa->pkey == sa_key) {
|
|
founded = TRUE;
|
|
break;
|
|
}
|
|
}
|
|
if (!founded) {
|
|
wpa_printf(MSG_WARNING, "KaY: Can't find txsa");
|
|
return -1;
|
|
}
|
|
|
|
/* FIXME: Secy creates txsa with default npn. If MKA detected Latest Key
|
|
* npn is larger than txsa's npn, set it to txsa.
|
|
*/
|
|
secy_get_transmit_next_pn(participant->kay, txsa);
|
|
if (lpn > txsa->next_pn) {
|
|
secy_set_transmit_next_pn(participant->kay, txsa);
|
|
wpa_printf(MSG_INFO, "KaY: update lpn =0x%x", lpn);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_mka_dist_sak_body_present
|
|
*/
|
|
static Boolean
|
|
ieee802_1x_mka_dist_sak_body_present(
|
|
struct ieee802_1x_mka_participant *participant)
|
|
{
|
|
if (!participant->to_dist_sak || !participant->new_key)
|
|
return FALSE;
|
|
|
|
return TRUE;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_get_dist_sak_length
|
|
*/
|
|
static int
|
|
ieee802_1x_mka_get_dist_sak_length(
|
|
struct ieee802_1x_mka_participant *participant)
|
|
{
|
|
int length;
|
|
int cs_index = participant->kay->macsec_csindex;
|
|
|
|
if (participant->advised_desired) {
|
|
length = sizeof(struct ieee802_1x_mka_dist_sak_body);
|
|
if (cs_index != DEFAULT_CS_INDEX)
|
|
length += CS_ID_LEN;
|
|
|
|
length += cipher_suite_tbl[cs_index].sak_len + 8;
|
|
} else {
|
|
length = MKA_HDR_LEN;
|
|
}
|
|
length = (length + 0x3) & ~0x3;
|
|
|
|
return length;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_mka_encode_dist_sak_body -
|
|
*/
|
|
static int
|
|
ieee802_1x_mka_encode_dist_sak_body(
|
|
struct ieee802_1x_mka_participant *participant,
|
|
struct wpabuf *buf)
|
|
{
|
|
struct ieee802_1x_mka_dist_sak_body *body;
|
|
struct data_key *sak;
|
|
unsigned int length;
|
|
int cs_index;
|
|
int sak_pos;
|
|
|
|
length = ieee802_1x_mka_get_dist_sak_length(participant);
|
|
body = wpabuf_put(buf, length);
|
|
body->type = MKA_DISTRIBUTED_SAK;
|
|
set_mka_param_body_len(body, length - MKA_HDR_LEN);
|
|
if (length == MKA_HDR_LEN) {
|
|
body->confid_offset = 0;
|
|
body->dan = 0;
|
|
return 0;
|
|
}
|
|
|
|
sak = participant->new_key;
|
|
body->confid_offset = sak->confidentiality_offset;
|
|
body->dan = sak->an;
|
|
body->kn = host_to_be32(sak->key_identifier.kn);
|
|
cs_index = participant->kay->macsec_csindex;
|
|
sak_pos = 0;
|
|
if (cs_index != DEFAULT_CS_INDEX) {
|
|
os_memcpy(body->sak, cipher_suite_tbl[cs_index].id, CS_ID_LEN);
|
|
sak_pos = CS_ID_LEN;
|
|
}
|
|
if (aes_wrap(participant->kek.key,
|
|
cipher_suite_tbl[cs_index].sak_len / 8,
|
|
sak->key, body->sak + sak_pos)) {
|
|
wpa_printf(MSG_ERROR, "KaY: AES wrap failed");
|
|
return -1;
|
|
}
|
|
|
|
ieee802_1x_mka_dump_dist_sak_body(body);
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_init_data_key -
|
|
*/
|
|
static struct data_key *
|
|
ieee802_1x_kay_init_data_key(const struct key_conf *conf)
|
|
{
|
|
struct data_key *pkey;
|
|
|
|
if (!conf)
|
|
return NULL;
|
|
|
|
pkey = os_zalloc(sizeof(*pkey));
|
|
if (pkey == NULL) {
|
|
wpa_printf(MSG_ERROR, "%s: out of memory", __func__);
|
|
return NULL;
|
|
}
|
|
|
|
pkey->key = os_zalloc(conf->key_len);
|
|
if (pkey->key == NULL) {
|
|
wpa_printf(MSG_ERROR, "%s: out of memory", __func__);
|
|
os_free(pkey);
|
|
return NULL;
|
|
}
|
|
|
|
os_memcpy(pkey->key, conf->key, conf->key_len);
|
|
os_memcpy(&pkey->key_identifier, &conf->ki,
|
|
sizeof(pkey->key_identifier));
|
|
pkey->confidentiality_offset = conf->offset;
|
|
pkey->an = conf->an;
|
|
pkey->transmits = conf->tx;
|
|
pkey->receives = conf->rx;
|
|
os_get_time(&pkey->created_time);
|
|
|
|
pkey->user = 1;
|
|
|
|
return pkey;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_decode_dist_sak_body -
|
|
*/
|
|
static int
|
|
ieee802_1x_mka_decode_dist_sak_body(
|
|
struct ieee802_1x_mka_participant *participant,
|
|
const u8 *mka_msg, size_t msg_len)
|
|
{
|
|
struct ieee802_1x_mka_hdr *hdr;
|
|
struct ieee802_1x_mka_dist_sak_body *body;
|
|
struct ieee802_1x_kay_peer *peer;
|
|
struct macsec_ciphersuite *cs;
|
|
size_t body_len;
|
|
struct key_conf *conf;
|
|
struct data_key *sa_key = NULL;
|
|
struct ieee802_1x_mka_ki sak_ki;
|
|
int sak_len;
|
|
u8 *wrap_sak;
|
|
u8 *unwrap_sak;
|
|
|
|
hdr = (struct ieee802_1x_mka_hdr *) mka_msg;
|
|
body_len = get_mka_param_body_len(hdr);
|
|
if ((body_len != 0) && (body_len != 28) && (body_len < 36)) {
|
|
wpa_printf(MSG_ERROR,
|
|
"KaY: MKA Use SAK Packet Body Length (%d bytes) should be 0, 28, 36, or more octets",
|
|
(int) body_len);
|
|
return -1;
|
|
}
|
|
|
|
if (!participant->principal) {
|
|
wpa_printf(MSG_ERROR,
|
|
"KaY: I can't accept the distributed SAK as I am not principal");
|
|
return -1;
|
|
}
|
|
if (participant->is_key_server) {
|
|
wpa_printf(MSG_ERROR,
|
|
"KaY: I can't accept the distributed SAK as myself is key server ");
|
|
return -1;
|
|
}
|
|
if (!participant->kay->macsec_desired ||
|
|
participant->kay->macsec_capable == MACSEC_CAP_NOT_IMPLEMENTED) {
|
|
wpa_printf(MSG_ERROR,
|
|
"KaY: I am not MACsec-desired or without MACsec capable");
|
|
return -1;
|
|
}
|
|
|
|
peer = ieee802_1x_kay_get_live_peer(participant,
|
|
participant->current_peer_id.mi);
|
|
if (!peer) {
|
|
wpa_printf(MSG_ERROR,
|
|
"KaY: The key server is not in my live peers list");
|
|
return -1;
|
|
}
|
|
if (os_memcmp(&participant->kay->key_server_sci,
|
|
&peer->sci, sizeof(struct ieee802_1x_mka_sci)) != 0) {
|
|
wpa_printf(MSG_ERROR, "KaY: The key server is not elected");
|
|
return -1;
|
|
}
|
|
if (body_len == 0) {
|
|
participant->kay->authenticated = TRUE;
|
|
participant->kay->secured = FALSE;
|
|
participant->kay->failed = FALSE;
|
|
participant->advised_desired = FALSE;
|
|
ieee802_1x_cp_connect_authenticated(participant->kay->cp);
|
|
ieee802_1x_cp_sm_step(participant->kay->cp);
|
|
wpa_printf(MSG_WARNING, "KaY:The Key server advise no MACsec");
|
|
participant->to_use_sak = TRUE;
|
|
return 0;
|
|
}
|
|
participant->advised_desired = TRUE;
|
|
participant->kay->authenticated = FALSE;
|
|
participant->kay->secured = TRUE;
|
|
participant->kay->failed = FALSE;
|
|
ieee802_1x_cp_connect_secure(participant->kay->cp);
|
|
ieee802_1x_cp_sm_step(participant->kay->cp);
|
|
|
|
body = (struct ieee802_1x_mka_dist_sak_body *)mka_msg;
|
|
ieee802_1x_mka_dump_dist_sak_body(body);
|
|
dl_list_for_each(sa_key, &participant->sak_list, struct data_key, list)
|
|
{
|
|
if (os_memcmp(sa_key->key_identifier.mi,
|
|
participant->current_peer_id.mi, MI_LEN) == 0 &&
|
|
sa_key->key_identifier.kn == be_to_host32(body->kn)) {
|
|
wpa_printf(MSG_WARNING, "KaY:The Key has installed");
|
|
return 0;
|
|
}
|
|
}
|
|
if (body_len == 28) {
|
|
sak_len = DEFAULT_SA_KEY_LEN;
|
|
wrap_sak = body->sak;
|
|
participant->kay->macsec_csindex = DEFAULT_CS_INDEX;
|
|
} else {
|
|
cs = ieee802_1x_kay_get_cipher_suite(participant, body->sak);
|
|
if (!cs) {
|
|
wpa_printf(MSG_ERROR,
|
|
"KaY: I can't support the Cipher Suite advised by key server");
|
|
return -1;
|
|
}
|
|
sak_len = cs->sak_len;
|
|
wrap_sak = body->sak + CS_ID_LEN;
|
|
participant->kay->macsec_csindex = cs->index;
|
|
}
|
|
|
|
unwrap_sak = os_zalloc(sak_len);
|
|
if (!unwrap_sak) {
|
|
wpa_printf(MSG_ERROR, "KaY-%s: Out of memory", __func__);
|
|
return -1;
|
|
}
|
|
if (aes_unwrap(participant->kek.key, sak_len >> 3, wrap_sak,
|
|
unwrap_sak)) {
|
|
wpa_printf(MSG_ERROR, "KaY: AES unwrap failed");
|
|
os_free(unwrap_sak);
|
|
return -1;
|
|
}
|
|
wpa_hexdump(MSG_DEBUG, "\tAES Key Unwrap of SAK:", unwrap_sak, sak_len);
|
|
|
|
conf = os_zalloc(sizeof(*conf));
|
|
if (!conf) {
|
|
wpa_printf(MSG_ERROR, "KaY-%s: Out of memory", __func__);
|
|
os_free(unwrap_sak);
|
|
return -1;
|
|
}
|
|
conf->key_len = sak_len;
|
|
|
|
conf->key = os_zalloc(conf->key_len);
|
|
if (!conf->key) {
|
|
wpa_printf(MSG_ERROR, "KaY-%s: Out of memory", __func__);
|
|
os_free(unwrap_sak);
|
|
os_free(conf);
|
|
return -1;
|
|
}
|
|
|
|
os_memcpy(conf->key, unwrap_sak, conf->key_len);
|
|
|
|
os_memcpy(&sak_ki.mi, &participant->current_peer_id.mi,
|
|
sizeof(sak_ki.mi));
|
|
sak_ki.kn = be_to_host32(body->kn);
|
|
|
|
os_memcpy(conf->ki.mi, sak_ki.mi, MI_LEN);
|
|
conf->ki.kn = sak_ki.kn;
|
|
conf->an = body->dan;
|
|
conf->offset = body->confid_offset;
|
|
conf->rx = TRUE;
|
|
conf->tx = TRUE;
|
|
|
|
sa_key = ieee802_1x_kay_init_data_key(conf);
|
|
if (!sa_key) {
|
|
os_free(unwrap_sak);
|
|
os_free(conf->key);
|
|
os_free(conf);
|
|
return -1;
|
|
}
|
|
|
|
dl_list_add(&participant->sak_list, &sa_key->list);
|
|
|
|
ieee802_1x_cp_set_ciphersuite(
|
|
participant->kay->cp,
|
|
cipher_suite_tbl[participant->kay->macsec_csindex].id);
|
|
ieee802_1x_cp_sm_step(participant->kay->cp);
|
|
ieee802_1x_cp_set_offset(participant->kay->cp, body->confid_offset);
|
|
ieee802_1x_cp_sm_step(participant->kay->cp);
|
|
ieee802_1x_cp_set_distributedki(participant->kay->cp, &sak_ki);
|
|
ieee802_1x_cp_set_distributedan(participant->kay->cp, body->dan);
|
|
ieee802_1x_cp_signal_newsak(participant->kay->cp);
|
|
ieee802_1x_cp_sm_step(participant->kay->cp);
|
|
|
|
participant->to_use_sak = TRUE;
|
|
|
|
os_free(unwrap_sak);
|
|
os_free(conf->key);
|
|
os_free(conf);
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_mka_icv_body_present
|
|
*/
|
|
static Boolean
|
|
ieee802_1x_mka_icv_body_present(struct ieee802_1x_mka_participant *participant)
|
|
{
|
|
return TRUE;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_get_icv_length
|
|
*/
|
|
static int
|
|
ieee802_1x_mka_get_icv_length(struct ieee802_1x_mka_participant *participant)
|
|
{
|
|
int length;
|
|
|
|
length = sizeof(struct ieee802_1x_mka_icv_body);
|
|
length += mka_alg_tbl[participant->kay->mka_algindex].icv_len;
|
|
|
|
return (length + 0x3) & ~0x3;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_mka_encode_icv_body -
|
|
*/
|
|
static int
|
|
ieee802_1x_mka_encode_icv_body(struct ieee802_1x_mka_participant *participant,
|
|
struct wpabuf *buf)
|
|
{
|
|
struct ieee802_1x_mka_icv_body *body;
|
|
unsigned int length;
|
|
u8 cmac[MAX_ICV_LEN];
|
|
|
|
length = ieee802_1x_mka_get_icv_length(participant);
|
|
if (length != DEFAULT_ICV_LEN) {
|
|
body = wpabuf_put(buf, MKA_HDR_LEN);
|
|
body->type = MKA_ICV_INDICATOR;
|
|
set_mka_param_body_len(body, length - MKA_HDR_LEN);
|
|
}
|
|
|
|
if (mka_alg_tbl[participant->kay->mka_algindex].icv_hash(
|
|
participant->ick.key, wpabuf_head(buf), buf->used, cmac)) {
|
|
wpa_printf(MSG_ERROR, "KaY, omac1_aes_128 failed");
|
|
return -1;
|
|
}
|
|
|
|
if (length != DEFAULT_ICV_LEN) {
|
|
os_memcpy(wpabuf_put(buf, length - MKA_HDR_LEN), cmac,
|
|
length - MKA_HDR_LEN);
|
|
} else {
|
|
os_memcpy(wpabuf_put(buf, length), cmac, length);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* ieee802_1x_mka_decode_icv_body -
|
|
*/
|
|
static u8 *
|
|
ieee802_1x_mka_decode_icv_body(struct ieee802_1x_mka_participant *participant,
|
|
const u8 *mka_msg, size_t msg_len)
|
|
{
|
|
struct ieee802_1x_mka_hdr *hdr;
|
|
struct ieee802_1x_mka_icv_body *body;
|
|
size_t body_len;
|
|
size_t left_len;
|
|
int body_type;
|
|
const u8 *pos;
|
|
|
|
pos = mka_msg;
|
|
left_len = msg_len;
|
|
while (left_len > (MKA_HDR_LEN + DEFAULT_ICV_LEN)) {
|
|
hdr = (struct ieee802_1x_mka_hdr *) pos;
|
|
body_len = get_mka_param_body_len(hdr);
|
|
body_type = get_mka_param_body_type(hdr);
|
|
|
|
if (left_len < (body_len + MKA_HDR_LEN))
|
|
break;
|
|
|
|
if (body_type != MKA_ICV_INDICATOR) {
|
|
left_len -= MKA_HDR_LEN + body_len;
|
|
pos += MKA_HDR_LEN + body_len;
|
|
continue;
|
|
}
|
|
|
|
body = (struct ieee802_1x_mka_icv_body *)pos;
|
|
if (body_len
|
|
< mka_alg_tbl[participant->kay->mka_algindex].icv_len) {
|
|
return NULL;
|
|
}
|
|
|
|
return body->icv;
|
|
}
|
|
|
|
return (u8 *) (mka_msg + msg_len - DEFAULT_ICV_LEN);
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_mka_decode_dist_cak_body-
|
|
*/
|
|
static int
|
|
ieee802_1x_mka_decode_dist_cak_body(
|
|
struct ieee802_1x_mka_participant *participant,
|
|
const u8 *mka_msg, size_t msg_len)
|
|
{
|
|
struct ieee802_1x_mka_hdr *hdr;
|
|
size_t body_len;
|
|
|
|
hdr = (struct ieee802_1x_mka_hdr *) mka_msg;
|
|
body_len = get_mka_param_body_len(hdr);
|
|
if (body_len < 28) {
|
|
wpa_printf(MSG_ERROR,
|
|
"KaY: MKA Use SAK Packet Body Length (%d bytes) should be 28 or more octets",
|
|
(int) body_len);
|
|
return -1;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_mka_decode_kmd_body -
|
|
*/
|
|
static int
|
|
ieee802_1x_mka_decode_kmd_body(
|
|
struct ieee802_1x_mka_participant *participant,
|
|
const u8 *mka_msg, size_t msg_len)
|
|
{
|
|
struct ieee802_1x_mka_hdr *hdr;
|
|
size_t body_len;
|
|
|
|
hdr = (struct ieee802_1x_mka_hdr *) mka_msg;
|
|
body_len = get_mka_param_body_len(hdr);
|
|
if (body_len < 5) {
|
|
wpa_printf(MSG_ERROR,
|
|
"KaY: MKA Use SAK Packet Body Length (%d bytes) should be 5 or more octets",
|
|
(int) body_len);
|
|
return -1;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_mka_decode_announce_body -
|
|
*/
|
|
static int ieee802_1x_mka_decode_announce_body(
|
|
struct ieee802_1x_mka_participant *participant,
|
|
const u8 *mka_msg, size_t msg_len)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
|
|
static struct mka_param_body_handler mak_body_handler[] = {
|
|
/* basic parameter set */
|
|
{
|
|
ieee802_1x_mka_encode_basic_body,
|
|
NULL,
|
|
ieee802_1x_mka_basic_body_length,
|
|
ieee802_1x_mka_basic_body_present
|
|
},
|
|
|
|
/* live peer list parameter set */
|
|
{
|
|
ieee802_1x_mka_encode_live_peer_body,
|
|
ieee802_1x_mka_decode_live_peer_body,
|
|
ieee802_1x_mka_get_live_peer_length,
|
|
ieee802_1x_mka_live_peer_body_present
|
|
},
|
|
|
|
/* potential peer list parameter set */
|
|
{
|
|
ieee802_1x_mka_encode_potential_peer_body,
|
|
ieee802_1x_mka_decode_potential_peer_body,
|
|
ieee802_1x_mka_get_potential_peer_length,
|
|
ieee802_1x_mka_potential_peer_body_present
|
|
},
|
|
|
|
/* sak use parameter set */
|
|
{
|
|
ieee802_1x_mka_encode_sak_use_body,
|
|
ieee802_1x_mka_decode_sak_use_body,
|
|
ieee802_1x_mka_get_sak_use_length,
|
|
ieee802_1x_mka_sak_use_body_present
|
|
},
|
|
|
|
/* distribute sak parameter set */
|
|
{
|
|
ieee802_1x_mka_encode_dist_sak_body,
|
|
ieee802_1x_mka_decode_dist_sak_body,
|
|
ieee802_1x_mka_get_dist_sak_length,
|
|
ieee802_1x_mka_dist_sak_body_present
|
|
},
|
|
|
|
/* distribute cak parameter set */
|
|
{
|
|
NULL,
|
|
ieee802_1x_mka_decode_dist_cak_body,
|
|
NULL,
|
|
NULL
|
|
},
|
|
|
|
/* kmd parameter set */
|
|
{
|
|
NULL,
|
|
ieee802_1x_mka_decode_kmd_body,
|
|
NULL,
|
|
NULL
|
|
},
|
|
|
|
/* announce parameter set */
|
|
{
|
|
NULL,
|
|
ieee802_1x_mka_decode_announce_body,
|
|
NULL,
|
|
NULL
|
|
},
|
|
|
|
/* icv parameter set */
|
|
{
|
|
ieee802_1x_mka_encode_icv_body,
|
|
NULL,
|
|
ieee802_1x_mka_get_icv_length,
|
|
ieee802_1x_mka_icv_body_present
|
|
},
|
|
};
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_deinit_data_key -
|
|
*/
|
|
void ieee802_1x_kay_deinit_data_key(struct data_key *pkey)
|
|
{
|
|
if (!pkey)
|
|
return;
|
|
|
|
pkey->user--;
|
|
if (pkey->user > 1)
|
|
return;
|
|
|
|
dl_list_del(&pkey->list);
|
|
os_free(pkey->key);
|
|
os_free(pkey);
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_generate_new_sak -
|
|
*/
|
|
static int
|
|
ieee802_1x_kay_generate_new_sak(struct ieee802_1x_mka_participant *participant)
|
|
{
|
|
struct data_key *sa_key = NULL;
|
|
struct key_conf *conf;
|
|
struct ieee802_1x_kay_peer *peer;
|
|
struct ieee802_1x_kay *kay = participant->kay;
|
|
int ctx_len, ctx_offset;
|
|
u8 *context;
|
|
|
|
/* check condition for generating a fresh SAK:
|
|
* must have one live peer
|
|
* and MKA life time elapse since last distribution
|
|
* or potential peer is empty
|
|
*/
|
|
if (dl_list_empty(&participant->live_peers)) {
|
|
wpa_printf(MSG_ERROR,
|
|
"KaY: Live peers list must not empty when generating fresh SAK");
|
|
return -1;
|
|
}
|
|
|
|
/* FIXME: A fresh SAK not generated until
|
|
* the live peer list contains at least one peer and
|
|
* MKA life time has elapsed since the prior SAK was first distributed,
|
|
* or the Key server's potential peer is empty
|
|
* but I can't understand the second item, so
|
|
* here only check first item and ingore
|
|
* && (!dl_list_empty(&participant->potential_peers))) {
|
|
*/
|
|
if ((time(NULL) - kay->dist_time) < MKA_LIFE_TIME / 1000) {
|
|
wpa_printf(MSG_ERROR,
|
|
"KaY: Life time have not elapsed since prior SAK distributed");
|
|
return -1;
|
|
}
|
|
|
|
conf = os_zalloc(sizeof(*conf));
|
|
if (!conf) {
|
|
wpa_printf(MSG_ERROR, "KaY-%s: Out of memory", __func__);
|
|
return -1;
|
|
}
|
|
conf->key_len = cipher_suite_tbl[kay->macsec_csindex].sak_len;
|
|
|
|
conf->key = os_zalloc(conf->key_len);
|
|
if (!conf->key) {
|
|
os_free(conf);
|
|
wpa_printf(MSG_ERROR, "KaY-%s: Out of memory", __func__);
|
|
return -1;
|
|
}
|
|
|
|
ctx_len = conf->key_len + sizeof(kay->dist_kn);
|
|
dl_list_for_each(peer, &participant->live_peers,
|
|
struct ieee802_1x_kay_peer, list)
|
|
ctx_len += sizeof(peer->mi);
|
|
ctx_len += sizeof(participant->mi);
|
|
|
|
context = os_zalloc(ctx_len);
|
|
if (!context) {
|
|
os_free(conf->key);
|
|
os_free(conf);
|
|
return -1;
|
|
}
|
|
ctx_offset = 0;
|
|
os_get_random(context + ctx_offset, conf->key_len);
|
|
ctx_offset += conf->key_len;
|
|
dl_list_for_each(peer, &participant->live_peers,
|
|
struct ieee802_1x_kay_peer, list) {
|
|
os_memcpy(context + ctx_offset, peer->mi, sizeof(peer->mi));
|
|
ctx_offset += sizeof(peer->mi);
|
|
}
|
|
os_memcpy(context + ctx_offset, participant->mi,
|
|
sizeof(participant->mi));
|
|
ctx_offset += sizeof(participant->mi);
|
|
os_memcpy(context + ctx_offset, &kay->dist_kn, sizeof(kay->dist_kn));
|
|
|
|
if (conf->key_len == 16) {
|
|
ieee802_1x_sak_128bits_aes_cmac(participant->cak.key,
|
|
context, ctx_len, conf->key);
|
|
} else if (conf->key_len == 32) {
|
|
ieee802_1x_sak_128bits_aes_cmac(participant->cak.key,
|
|
context, ctx_len, conf->key);
|
|
} else {
|
|
wpa_printf(MSG_ERROR, "KaY: SAK Length not support");
|
|
os_free(conf->key);
|
|
os_free(conf);
|
|
os_free(context);
|
|
return -1;
|
|
}
|
|
wpa_hexdump(MSG_DEBUG, "KaY: generated new SAK",
|
|
conf->key, conf->key_len);
|
|
|
|
os_memcpy(conf->ki.mi, participant->mi, MI_LEN);
|
|
conf->ki.kn = participant->kay->dist_kn;
|
|
conf->an = participant->kay->dist_an;
|
|
conf->offset = kay->macsec_confidentiality;
|
|
conf->rx = TRUE;
|
|
conf->tx = TRUE;
|
|
|
|
sa_key = ieee802_1x_kay_init_data_key(conf);
|
|
if (!sa_key) {
|
|
os_free(conf->key);
|
|
os_free(conf);
|
|
os_free(context);
|
|
return -1;
|
|
}
|
|
participant->new_key = sa_key;
|
|
|
|
dl_list_add(&participant->sak_list, &sa_key->list);
|
|
ieee802_1x_cp_set_ciphersuite(participant->kay->cp,
|
|
cipher_suite_tbl[kay->macsec_csindex].id);
|
|
ieee802_1x_cp_sm_step(kay->cp);
|
|
ieee802_1x_cp_set_offset(kay->cp, conf->offset);
|
|
ieee802_1x_cp_sm_step(kay->cp);
|
|
ieee802_1x_cp_set_distributedki(kay->cp, &conf->ki);
|
|
ieee802_1x_cp_set_distributedan(kay->cp, conf->an);
|
|
ieee802_1x_cp_signal_newsak(kay->cp);
|
|
ieee802_1x_cp_sm_step(kay->cp);
|
|
|
|
dl_list_for_each(peer, &participant->live_peers,
|
|
struct ieee802_1x_kay_peer, list)
|
|
peer->sak_used = FALSE;
|
|
|
|
participant->kay->dist_kn++;
|
|
participant->kay->dist_an++;
|
|
if (participant->kay->dist_an > 3)
|
|
participant->kay->dist_an = 0;
|
|
|
|
participant->kay->dist_time = time(NULL);
|
|
|
|
os_free(conf->key);
|
|
os_free(conf);
|
|
os_free(context);
|
|
return 0;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_elect_key_server - elect the key server
|
|
* when to elect: whenever the live peers list changes
|
|
*/
|
|
static int
|
|
ieee802_1x_kay_elect_key_server(struct ieee802_1x_mka_participant *participant)
|
|
{
|
|
struct ieee802_1x_kay_peer *peer;
|
|
struct ieee802_1x_kay_peer *key_server = NULL;
|
|
struct ieee802_1x_kay *kay = participant->kay;
|
|
Boolean i_is_key_server;
|
|
int i;
|
|
|
|
if (participant->is_obliged_key_server) {
|
|
participant->new_sak = TRUE;
|
|
participant->to_dist_sak = FALSE;
|
|
ieee802_1x_cp_set_electedself(kay->cp, TRUE);
|
|
return 0;
|
|
}
|
|
|
|
/* elect the key server among the peers */
|
|
dl_list_for_each(peer, &participant->live_peers,
|
|
struct ieee802_1x_kay_peer, list) {
|
|
if (!peer->is_key_server)
|
|
continue;
|
|
|
|
if (!key_server) {
|
|
key_server = peer;
|
|
continue;
|
|
}
|
|
|
|
if (peer->key_server_priority <
|
|
key_server->key_server_priority) {
|
|
key_server = peer;
|
|
} else if (peer->key_server_priority ==
|
|
key_server->key_server_priority) {
|
|
for (i = 0; i < 6; i++) {
|
|
if (peer->sci.addr[i] <
|
|
key_server->sci.addr[i])
|
|
key_server = peer;
|
|
}
|
|
}
|
|
}
|
|
|
|
/* elect the key server between me and the above elected peer */
|
|
i_is_key_server = FALSE;
|
|
if (key_server && participant->can_be_key_server) {
|
|
if (kay->actor_priority
|
|
< key_server->key_server_priority) {
|
|
i_is_key_server = TRUE;
|
|
} else if (kay->actor_priority
|
|
== key_server->key_server_priority) {
|
|
for (i = 0; i < 6; i++) {
|
|
if (kay->actor_sci.addr[i]
|
|
< key_server->sci.addr[i]) {
|
|
i_is_key_server = TRUE;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
if (!key_server && !i_is_key_server) {
|
|
participant->principal = FALSE;
|
|
participant->is_key_server = FALSE;
|
|
participant->is_elected = FALSE;
|
|
return 0;
|
|
}
|
|
|
|
if (i_is_key_server) {
|
|
ieee802_1x_cp_set_electedself(kay->cp, TRUE);
|
|
if (os_memcmp(&kay->key_server_sci, &kay->actor_sci,
|
|
sizeof(kay->key_server_sci))) {
|
|
ieee802_1x_cp_signal_chgdserver(kay->cp);
|
|
ieee802_1x_cp_sm_step(kay->cp);
|
|
}
|
|
|
|
participant->is_key_server = TRUE;
|
|
participant->principal = TRUE;
|
|
participant->new_sak = TRUE;
|
|
wpa_printf(MSG_DEBUG, "KaY: I is elected as key server");
|
|
participant->to_dist_sak = FALSE;
|
|
participant->is_elected = TRUE;
|
|
|
|
os_memcpy(&kay->key_server_sci, &kay->actor_sci,
|
|
sizeof(kay->key_server_sci));
|
|
kay->key_server_priority = kay->actor_priority;
|
|
}
|
|
|
|
if (key_server) {
|
|
ieee802_1x_cp_set_electedself(kay->cp, FALSE);
|
|
if (os_memcmp(&kay->key_server_sci, &key_server->sci,
|
|
sizeof(kay->key_server_sci))) {
|
|
ieee802_1x_cp_signal_chgdserver(kay->cp);
|
|
ieee802_1x_cp_sm_step(kay->cp);
|
|
}
|
|
|
|
participant->is_key_server = FALSE;
|
|
participant->principal = TRUE;
|
|
participant->is_elected = TRUE;
|
|
|
|
os_memcpy(&kay->key_server_sci, &key_server->sci,
|
|
sizeof(kay->key_server_sci));
|
|
kay->key_server_priority = key_server->key_server_priority;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_decide_macsec_use - the key server determinate
|
|
* how to use MACsec: whether use MACsec and its capability
|
|
* protectFrames will be advised if the key server and one of its live peers are
|
|
* MACsec capable and one of those request MACsec protection
|
|
*/
|
|
static int
|
|
ieee802_1x_kay_decide_macsec_use(
|
|
struct ieee802_1x_mka_participant *participant)
|
|
{
|
|
struct ieee802_1x_kay *kay = participant->kay;
|
|
struct ieee802_1x_kay_peer *peer;
|
|
enum macsec_cap less_capability;
|
|
Boolean has_peer;
|
|
|
|
if (!participant->is_key_server)
|
|
return -1;
|
|
|
|
/* key server self is MACsec-desired and requesting MACsec */
|
|
if (!kay->macsec_desired) {
|
|
participant->advised_desired = FALSE;
|
|
return -1;
|
|
}
|
|
if (kay->macsec_capable == MACSEC_CAP_NOT_IMPLEMENTED) {
|
|
participant->advised_desired = FALSE;
|
|
return -1;
|
|
}
|
|
less_capability = kay->macsec_capable;
|
|
|
|
/* at least one of peers is MACsec-desired and requesting MACsec */
|
|
has_peer = FALSE;
|
|
dl_list_for_each(peer, &participant->live_peers,
|
|
struct ieee802_1x_kay_peer, list) {
|
|
if (!peer->macsec_desired)
|
|
continue;
|
|
|
|
if (peer->macsec_capbility == MACSEC_CAP_NOT_IMPLEMENTED)
|
|
continue;
|
|
|
|
less_capability = (less_capability < peer->macsec_capbility) ?
|
|
less_capability : peer->macsec_capbility;
|
|
has_peer = TRUE;
|
|
}
|
|
|
|
if (has_peer) {
|
|
participant->advised_desired = TRUE;
|
|
participant->advised_capability = less_capability;
|
|
kay->authenticated = FALSE;
|
|
kay->secured = TRUE;
|
|
kay->failed = FALSE;
|
|
ieee802_1x_cp_connect_secure(kay->cp);
|
|
ieee802_1x_cp_sm_step(kay->cp);
|
|
} else {
|
|
participant->advised_desired = FALSE;
|
|
participant->advised_capability = MACSEC_CAP_NOT_IMPLEMENTED;
|
|
participant->to_use_sak = FALSE;
|
|
kay->authenticated = TRUE;
|
|
kay->secured = FALSE;
|
|
kay->failed = FALSE;
|
|
kay->ltx_kn = 0;
|
|
kay->ltx_an = 0;
|
|
kay->lrx_kn = 0;
|
|
kay->lrx_an = 0;
|
|
kay->otx_kn = 0;
|
|
kay->otx_an = 0;
|
|
kay->orx_kn = 0;
|
|
kay->orx_an = 0;
|
|
ieee802_1x_cp_connect_authenticated(kay->cp);
|
|
ieee802_1x_cp_sm_step(kay->cp);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const u8 pae_group_addr[ETH_ALEN] = {
|
|
0x01, 0x80, 0xc2, 0x00, 0x00, 0x03
|
|
};
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_encode_mkpdu -
|
|
*/
|
|
static int
|
|
ieee802_1x_kay_encode_mkpdu(struct ieee802_1x_mka_participant *participant,
|
|
struct wpabuf *pbuf)
|
|
{
|
|
unsigned int i;
|
|
struct ieee8023_hdr *ether_hdr;
|
|
struct ieee802_1x_hdr *eapol_hdr;
|
|
|
|
ether_hdr = wpabuf_put(pbuf, sizeof(*ether_hdr));
|
|
os_memcpy(ether_hdr->dest, pae_group_addr, sizeof(ether_hdr->dest));
|
|
os_memcpy(ether_hdr->src, participant->kay->actor_sci.addr,
|
|
sizeof(ether_hdr->dest));
|
|
ether_hdr->ethertype = host_to_be16(ETH_P_EAPOL);
|
|
|
|
eapol_hdr = wpabuf_put(pbuf, sizeof(*eapol_hdr));
|
|
eapol_hdr->version = EAPOL_VERSION;
|
|
eapol_hdr->type = IEEE802_1X_TYPE_EAPOL_MKA;
|
|
eapol_hdr->length = host_to_be16(pbuf->size - pbuf->used);
|
|
|
|
for (i = 0; i < ARRAY_SIZE(mak_body_handler); i++) {
|
|
if (mak_body_handler[i].body_present &&
|
|
mak_body_handler[i].body_present(participant)) {
|
|
if (mak_body_handler[i].body_tx(participant, pbuf))
|
|
return -1;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* ieee802_1x_participant_send_mkpdu -
|
|
*/
|
|
static int
|
|
ieee802_1x_participant_send_mkpdu(
|
|
struct ieee802_1x_mka_participant *participant)
|
|
{
|
|
struct wpabuf *buf;
|
|
struct ieee802_1x_kay *kay = participant->kay;
|
|
size_t length = 0;
|
|
unsigned int i;
|
|
|
|
wpa_printf(MSG_DEBUG, "KaY: to enpacket and send the MKPDU");
|
|
length += sizeof(struct ieee802_1x_hdr) + sizeof(struct ieee8023_hdr);
|
|
for (i = 0; i < ARRAY_SIZE(mak_body_handler); i++) {
|
|
if (mak_body_handler[i].body_present &&
|
|
mak_body_handler[i].body_present(participant))
|
|
length += mak_body_handler[i].body_length(participant);
|
|
}
|
|
|
|
buf = wpabuf_alloc(length);
|
|
if (!buf) {
|
|
wpa_printf(MSG_ERROR, "KaY: out of memory");
|
|
return -1;
|
|
}
|
|
|
|
if (ieee802_1x_kay_encode_mkpdu(participant, buf)) {
|
|
wpa_printf(MSG_ERROR, "KaY: encode mkpdu fail!");
|
|
return -1;
|
|
}
|
|
|
|
l2_packet_send(kay->l2_mka, NULL, 0, wpabuf_head(buf), wpabuf_len(buf));
|
|
wpabuf_free(buf);
|
|
|
|
kay->active = TRUE;
|
|
participant->active = TRUE;
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
static void ieee802_1x_kay_deinit_transmit_sa(struct transmit_sa *psa);
|
|
/**
|
|
* ieee802_1x_participant_timer -
|
|
*/
|
|
static void ieee802_1x_participant_timer(void *eloop_ctx, void *timeout_ctx)
|
|
{
|
|
struct ieee802_1x_mka_participant *participant;
|
|
struct ieee802_1x_kay *kay;
|
|
struct ieee802_1x_kay_peer *peer, *pre_peer;
|
|
time_t now = time(NULL);
|
|
Boolean lp_changed;
|
|
struct receive_sc *rxsc, *pre_rxsc;
|
|
struct transmit_sa *txsa, *pre_txsa;
|
|
|
|
participant = (struct ieee802_1x_mka_participant *)eloop_ctx;
|
|
kay = participant->kay;
|
|
if (participant->cak_life) {
|
|
if (now > participant->cak_life) {
|
|
kay->authenticated = FALSE;
|
|
kay->secured = FALSE;
|
|
kay->failed = TRUE;
|
|
ieee802_1x_kay_delete_mka(kay, &participant->ckn);
|
|
return;
|
|
}
|
|
}
|
|
|
|
/* should delete MKA instance if there are not live peers
|
|
* when the MKA life elapsed since its creating */
|
|
if (participant->mka_life) {
|
|
if (dl_list_empty(&participant->live_peers)) {
|
|
if (now > participant->mka_life) {
|
|
kay->authenticated = FALSE;
|
|
kay->secured = FALSE;
|
|
kay->failed = TRUE;
|
|
ieee802_1x_kay_delete_mka(kay,
|
|
&participant->ckn);
|
|
return;
|
|
}
|
|
} else {
|
|
participant->mka_life = 0;
|
|
}
|
|
}
|
|
|
|
lp_changed = FALSE;
|
|
dl_list_for_each_safe(peer, pre_peer, &participant->live_peers,
|
|
struct ieee802_1x_kay_peer, list) {
|
|
if (now > peer->expire) {
|
|
wpa_printf(MSG_DEBUG, "KaY: Live peer removed");
|
|
wpa_hexdump(MSG_DEBUG, "\tMI: ", peer->mi,
|
|
sizeof(peer->mi));
|
|
wpa_printf(MSG_DEBUG, "\tMN: %d", peer->mn);
|
|
dl_list_for_each_safe(rxsc, pre_rxsc,
|
|
&participant->rxsc_list,
|
|
struct receive_sc, list) {
|
|
if (os_memcmp(&rxsc->sci, &peer->sci,
|
|
sizeof(rxsc->sci)) == 0) {
|
|
secy_delete_receive_sc(kay, rxsc);
|
|
ieee802_1x_kay_deinit_receive_sc(
|
|
participant, rxsc);
|
|
}
|
|
}
|
|
dl_list_del(&peer->list);
|
|
os_free(peer);
|
|
lp_changed = TRUE;
|
|
}
|
|
}
|
|
|
|
if (lp_changed) {
|
|
if (dl_list_empty(&participant->live_peers)) {
|
|
participant->advised_desired = FALSE;
|
|
participant->advised_capability =
|
|
MACSEC_CAP_NOT_IMPLEMENTED;
|
|
participant->to_use_sak = FALSE;
|
|
kay->authenticated = TRUE;
|
|
kay->secured = FALSE;
|
|
kay->failed = FALSE;
|
|
kay->ltx_kn = 0;
|
|
kay->ltx_an = 0;
|
|
kay->lrx_kn = 0;
|
|
kay->lrx_an = 0;
|
|
kay->otx_kn = 0;
|
|
kay->otx_an = 0;
|
|
kay->orx_kn = 0;
|
|
kay->orx_an = 0;
|
|
dl_list_for_each_safe(txsa, pre_txsa,
|
|
&participant->txsc->sa_list,
|
|
struct transmit_sa, list) {
|
|
secy_disable_transmit_sa(kay, txsa);
|
|
ieee802_1x_kay_deinit_transmit_sa(txsa);
|
|
}
|
|
|
|
ieee802_1x_cp_connect_authenticated(kay->cp);
|
|
ieee802_1x_cp_sm_step(kay->cp);
|
|
} else {
|
|
ieee802_1x_kay_elect_key_server(participant);
|
|
ieee802_1x_kay_decide_macsec_use(participant);
|
|
}
|
|
}
|
|
|
|
dl_list_for_each_safe(peer, pre_peer, &participant->potential_peers,
|
|
struct ieee802_1x_kay_peer, list) {
|
|
if (now > peer->expire) {
|
|
wpa_printf(MSG_DEBUG, "KaY: Potential peer removed");
|
|
wpa_hexdump(MSG_DEBUG, "\tMI: ", peer->mi,
|
|
sizeof(peer->mi));
|
|
wpa_printf(MSG_DEBUG, "\tMN: %d", peer->mn);
|
|
dl_list_del(&peer->list);
|
|
os_free(peer);
|
|
}
|
|
}
|
|
|
|
if (participant->new_sak) {
|
|
if (!ieee802_1x_kay_generate_new_sak(participant))
|
|
participant->to_dist_sak = TRUE;
|
|
|
|
participant->new_sak = FALSE;
|
|
}
|
|
|
|
if (participant->retry_count < MAX_RETRY_CNT) {
|
|
ieee802_1x_participant_send_mkpdu(participant);
|
|
participant->retry_count++;
|
|
}
|
|
|
|
eloop_register_timeout(MKA_HELLO_TIME / 1000, 0,
|
|
ieee802_1x_participant_timer,
|
|
participant, NULL);
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_init_transmit_sa -
|
|
*/
|
|
static struct transmit_sa *
|
|
ieee802_1x_kay_init_transmit_sa(struct transmit_sc *psc, u8 an, u32 next_PN,
|
|
struct data_key *key)
|
|
{
|
|
struct transmit_sa *psa;
|
|
|
|
key->tx_latest = TRUE;
|
|
key->rx_latest = TRUE;
|
|
|
|
psa = os_zalloc(sizeof(*psa));
|
|
if (!psa) {
|
|
wpa_printf(MSG_ERROR, "%s: out of memory", __func__);
|
|
return NULL;
|
|
}
|
|
|
|
if (key->confidentiality_offset >= CONFIDENTIALITY_OFFSET_0 &&
|
|
key->confidentiality_offset <= CONFIDENTIALITY_OFFSET_50)
|
|
psa->confidentiality = TRUE;
|
|
else
|
|
psa->confidentiality = FALSE;
|
|
|
|
psa->an = an;
|
|
psa->pkey = key;
|
|
psa->next_pn = next_PN;
|
|
psa->sc = psc;
|
|
|
|
os_get_time(&psa->created_time);
|
|
psa->in_use = FALSE;
|
|
|
|
dl_list_add(&psc->sa_list, &psa->list);
|
|
wpa_printf(MSG_DEBUG,
|
|
"KaY: Create transmit SA(an: %d, next_PN: %u) of SC(channel: %d)",
|
|
(int) an, next_PN, psc->channel);
|
|
|
|
return psa;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_deinit_transmit_sa -
|
|
*/
|
|
static void ieee802_1x_kay_deinit_transmit_sa(struct transmit_sa *psa)
|
|
{
|
|
psa->pkey = NULL;
|
|
wpa_printf(MSG_DEBUG,
|
|
"KaY: Delete transmit SA(an: %d) of SC(channel: %d)",
|
|
psa->an, psa->sc->channel);
|
|
dl_list_del(&psa->list);
|
|
os_free(psa);
|
|
}
|
|
|
|
|
|
/**
|
|
* init_transmit_sc -
|
|
*/
|
|
static struct transmit_sc *
|
|
ieee802_1x_kay_init_transmit_sc(const struct ieee802_1x_mka_sci *sci,
|
|
int channel)
|
|
{
|
|
struct transmit_sc *psc;
|
|
|
|
psc = os_zalloc(sizeof(*psc));
|
|
if (!psc) {
|
|
wpa_printf(MSG_ERROR, "%s: out of memory", __func__);
|
|
return NULL;
|
|
}
|
|
os_memcpy(&psc->sci, sci, sizeof(psc->sci));
|
|
psc->channel = channel;
|
|
|
|
os_get_time(&psc->created_time);
|
|
psc->transmitting = FALSE;
|
|
psc->encoding_sa = FALSE;
|
|
psc->enciphering_sa = FALSE;
|
|
|
|
dl_list_init(&psc->sa_list);
|
|
wpa_printf(MSG_DEBUG, "KaY: Create transmit SC(channel: %d)", channel);
|
|
wpa_hexdump(MSG_DEBUG, "SCI: ", (u8 *)sci , sizeof(*sci));
|
|
|
|
return psc;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_deinit_transmit_sc -
|
|
*/
|
|
static void
|
|
ieee802_1x_kay_deinit_transmit_sc(
|
|
struct ieee802_1x_mka_participant *participant, struct transmit_sc *psc)
|
|
{
|
|
struct transmit_sa *psa, *tmp;
|
|
|
|
wpa_printf(MSG_DEBUG, "KaY: Delete transmit SC(channel: %d)",
|
|
psc->channel);
|
|
dl_list_for_each_safe(psa, tmp, &psc->sa_list, struct transmit_sa,
|
|
list) {
|
|
secy_disable_transmit_sa(participant->kay, psa);
|
|
ieee802_1x_kay_deinit_transmit_sa(psa);
|
|
}
|
|
|
|
os_free(psc);
|
|
}
|
|
|
|
|
|
/****************** Interface between CP and KAY *********************/
|
|
/**
|
|
* ieee802_1x_kay_set_latest_sa_attr -
|
|
*/
|
|
int ieee802_1x_kay_set_latest_sa_attr(struct ieee802_1x_kay *kay,
|
|
struct ieee802_1x_mka_ki *lki, u8 lan,
|
|
Boolean ltx, Boolean lrx)
|
|
{
|
|
struct ieee802_1x_mka_participant *principal;
|
|
|
|
principal = ieee802_1x_kay_get_principal_participant(kay);
|
|
if (!principal)
|
|
return -1;
|
|
|
|
if (!lki)
|
|
os_memset(&principal->lki, 0, sizeof(principal->lki));
|
|
else
|
|
os_memcpy(&principal->lki, lki, sizeof(principal->lki));
|
|
|
|
principal->lan = lan;
|
|
principal->ltx = ltx;
|
|
principal->lrx = lrx;
|
|
if (!lki) {
|
|
kay->ltx_kn = 0;
|
|
kay->lrx_kn = 0;
|
|
} else {
|
|
kay->ltx_kn = lki->kn;
|
|
kay->lrx_kn = lki->kn;
|
|
}
|
|
kay->ltx_an = lan;
|
|
kay->lrx_an = lan;
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_set_old_sa_attr -
|
|
*/
|
|
int ieee802_1x_kay_set_old_sa_attr(struct ieee802_1x_kay *kay,
|
|
struct ieee802_1x_mka_ki *oki,
|
|
u8 oan, Boolean otx, Boolean orx)
|
|
{
|
|
struct ieee802_1x_mka_participant *principal;
|
|
|
|
principal = ieee802_1x_kay_get_principal_participant(kay);
|
|
if (!principal)
|
|
return -1;
|
|
|
|
if (!oki)
|
|
os_memset(&principal->oki, 0, sizeof(principal->oki));
|
|
else
|
|
os_memcpy(&principal->oki, oki, sizeof(principal->oki));
|
|
|
|
principal->oan = oan;
|
|
principal->otx = otx;
|
|
principal->orx = orx;
|
|
|
|
if (!oki) {
|
|
kay->otx_kn = 0;
|
|
kay->orx_kn = 0;
|
|
} else {
|
|
kay->otx_kn = oki->kn;
|
|
kay->orx_kn = oki->kn;
|
|
}
|
|
kay->otx_an = oan;
|
|
kay->orx_an = oan;
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_create_sas -
|
|
*/
|
|
int ieee802_1x_kay_create_sas(struct ieee802_1x_kay *kay,
|
|
struct ieee802_1x_mka_ki *lki)
|
|
{
|
|
struct data_key *sa_key, *latest_sak;
|
|
struct ieee802_1x_mka_participant *principal;
|
|
struct receive_sc *rxsc;
|
|
struct receive_sa *rxsa;
|
|
struct transmit_sa *txsa;
|
|
|
|
principal = ieee802_1x_kay_get_principal_participant(kay);
|
|
if (!principal)
|
|
return -1;
|
|
|
|
latest_sak = NULL;
|
|
dl_list_for_each(sa_key, &principal->sak_list, struct data_key, list) {
|
|
if (is_ki_equal(&sa_key->key_identifier, lki)) {
|
|
sa_key->rx_latest = TRUE;
|
|
sa_key->tx_latest = TRUE;
|
|
latest_sak = sa_key;
|
|
principal->to_use_sak = TRUE;
|
|
} else {
|
|
sa_key->rx_latest = FALSE;
|
|
sa_key->tx_latest = FALSE;
|
|
}
|
|
}
|
|
if (!latest_sak) {
|
|
wpa_printf(MSG_ERROR, "lki related sak not found");
|
|
return -1;
|
|
}
|
|
|
|
dl_list_for_each(rxsc, &principal->rxsc_list, struct receive_sc, list) {
|
|
rxsa = ieee802_1x_kay_init_receive_sa(rxsc, latest_sak->an, 1,
|
|
latest_sak);
|
|
if (!rxsa)
|
|
return -1;
|
|
|
|
secy_create_receive_sa(kay, rxsa);
|
|
}
|
|
|
|
txsa = ieee802_1x_kay_init_transmit_sa(principal->txsc, latest_sak->an,
|
|
1, latest_sak);
|
|
if (!txsa)
|
|
return -1;
|
|
|
|
secy_create_transmit_sa(kay, txsa);
|
|
|
|
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_delete_sas -
|
|
*/
|
|
int ieee802_1x_kay_delete_sas(struct ieee802_1x_kay *kay,
|
|
struct ieee802_1x_mka_ki *ki)
|
|
{
|
|
struct data_key *sa_key, *pre_key;
|
|
struct transmit_sa *txsa, *pre_txsa;
|
|
struct receive_sa *rxsa, *pre_rxsa;
|
|
struct receive_sc *rxsc;
|
|
struct ieee802_1x_mka_participant *principal;
|
|
|
|
wpa_printf(MSG_DEBUG, "KaY: Entry into %s", __func__);
|
|
principal = ieee802_1x_kay_get_principal_participant(kay);
|
|
if (!principal)
|
|
return -1;
|
|
|
|
/* remove the transmit sa */
|
|
dl_list_for_each_safe(txsa, pre_txsa, &principal->txsc->sa_list,
|
|
struct transmit_sa, list) {
|
|
if (is_ki_equal(&txsa->pkey->key_identifier, ki)) {
|
|
secy_disable_transmit_sa(kay, txsa);
|
|
ieee802_1x_kay_deinit_transmit_sa(txsa);
|
|
}
|
|
}
|
|
|
|
/* remove the receive sa */
|
|
dl_list_for_each(rxsc, &principal->rxsc_list, struct receive_sc, list) {
|
|
dl_list_for_each_safe(rxsa, pre_rxsa, &rxsc->sa_list,
|
|
struct receive_sa, list) {
|
|
if (is_ki_equal(&rxsa->pkey->key_identifier, ki)) {
|
|
secy_disable_receive_sa(kay, rxsa);
|
|
ieee802_1x_kay_deinit_receive_sa(rxsa);
|
|
}
|
|
}
|
|
}
|
|
|
|
/* remove the sak */
|
|
dl_list_for_each_safe(sa_key, pre_key, &principal->sak_list,
|
|
struct data_key, list) {
|
|
if (is_ki_equal(&sa_key->key_identifier, ki)) {
|
|
ieee802_1x_kay_deinit_data_key(sa_key);
|
|
break;
|
|
}
|
|
if (principal->new_key == sa_key)
|
|
principal->new_key = NULL;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_enable_tx_sas -
|
|
*/
|
|
int ieee802_1x_kay_enable_tx_sas(struct ieee802_1x_kay *kay,
|
|
struct ieee802_1x_mka_ki *lki)
|
|
{
|
|
struct ieee802_1x_mka_participant *principal;
|
|
struct transmit_sa *txsa;
|
|
|
|
principal = ieee802_1x_kay_get_principal_participant(kay);
|
|
if (!principal)
|
|
return -1;
|
|
|
|
dl_list_for_each(txsa, &principal->txsc->sa_list, struct transmit_sa,
|
|
list) {
|
|
if (is_ki_equal(&txsa->pkey->key_identifier, lki)) {
|
|
txsa->in_use = TRUE;
|
|
secy_enable_transmit_sa(kay, txsa);
|
|
ieee802_1x_cp_set_usingtransmitas(
|
|
principal->kay->cp, TRUE);
|
|
ieee802_1x_cp_sm_step(principal->kay->cp);
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_enable_rx_sas -
|
|
*/
|
|
int ieee802_1x_kay_enable_rx_sas(struct ieee802_1x_kay *kay,
|
|
struct ieee802_1x_mka_ki *lki)
|
|
{
|
|
struct ieee802_1x_mka_participant *principal;
|
|
struct receive_sa *rxsa;
|
|
struct receive_sc *rxsc;
|
|
|
|
principal = ieee802_1x_kay_get_principal_participant(kay);
|
|
if (!principal)
|
|
return -1;
|
|
|
|
dl_list_for_each(rxsc, &principal->rxsc_list, struct receive_sc, list) {
|
|
dl_list_for_each(rxsa, &rxsc->sa_list, struct receive_sa, list)
|
|
{
|
|
if (is_ki_equal(&rxsa->pkey->key_identifier, lki)) {
|
|
rxsa->in_use = TRUE;
|
|
secy_enable_receive_sa(kay, rxsa);
|
|
ieee802_1x_cp_set_usingreceivesas(
|
|
principal->kay->cp, TRUE);
|
|
ieee802_1x_cp_sm_step(principal->kay->cp);
|
|
}
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_enable_new_info -
|
|
*/
|
|
int ieee802_1x_kay_enable_new_info(struct ieee802_1x_kay *kay)
|
|
{
|
|
struct ieee802_1x_mka_participant *principal;
|
|
|
|
principal = ieee802_1x_kay_get_principal_participant(kay);
|
|
if (!principal)
|
|
return -1;
|
|
|
|
if (principal->retry_count < MAX_RETRY_CNT) {
|
|
ieee802_1x_participant_send_mkpdu(principal);
|
|
principal->retry_count++;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_cp_conf -
|
|
*/
|
|
int ieee802_1x_kay_cp_conf(struct ieee802_1x_kay *kay,
|
|
struct ieee802_1x_cp_conf *pconf)
|
|
{
|
|
pconf->protect = kay->macsec_protect;
|
|
pconf->replay_protect = kay->macsec_replay_protect;
|
|
pconf->validate = kay->macsec_validate;
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_alloc_cp_sm -
|
|
*/
|
|
static struct ieee802_1x_cp_sm *
|
|
ieee802_1x_kay_alloc_cp_sm(struct ieee802_1x_kay *kay)
|
|
{
|
|
struct ieee802_1x_cp_conf conf;
|
|
|
|
os_memset(&conf, 0, sizeof(conf));
|
|
conf.protect = kay->macsec_protect;
|
|
conf.replay_protect = kay->macsec_replay_protect;
|
|
conf.validate = kay->macsec_validate;
|
|
conf.replay_window = kay->macsec_replay_window;
|
|
|
|
return ieee802_1x_cp_sm_init(kay, &conf);
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_mkpdu_sanity_check -
|
|
* sanity check specified in clause 11.11.2 of IEEE802.1X-2010
|
|
*/
|
|
static int ieee802_1x_kay_mkpdu_sanity_check(struct ieee802_1x_kay *kay,
|
|
const u8 *buf, size_t len)
|
|
{
|
|
struct ieee8023_hdr *eth_hdr;
|
|
struct ieee802_1x_hdr *eapol_hdr;
|
|
struct ieee802_1x_mka_hdr *mka_hdr;
|
|
struct ieee802_1x_mka_basic_body *body;
|
|
size_t mka_msg_len;
|
|
struct ieee802_1x_mka_participant *participant;
|
|
size_t body_len;
|
|
u8 icv[MAX_ICV_LEN];
|
|
u8 *msg_icv;
|
|
|
|
eth_hdr = (struct ieee8023_hdr *) buf;
|
|
eapol_hdr = (struct ieee802_1x_hdr *) (eth_hdr + 1);
|
|
mka_hdr = (struct ieee802_1x_mka_hdr *) (eapol_hdr + 1);
|
|
|
|
/* destination address should be not individual address */
|
|
if (os_memcmp(eth_hdr->dest, pae_group_addr, ETH_ALEN) != 0) {
|
|
wpa_printf(MSG_MSGDUMP,
|
|
"KaY: ethernet destination address is not PAE group address");
|
|
return -1;
|
|
}
|
|
|
|
/* MKPDU should not less than 32 octets */
|
|
mka_msg_len = be_to_host16(eapol_hdr->length);
|
|
if (mka_msg_len < 32) {
|
|
wpa_printf(MSG_MSGDUMP, "KaY: MKPDU is less than 32 octets");
|
|
return -1;
|
|
}
|
|
/* MKPDU should multiple 4 octets */
|
|
if ((mka_msg_len % 4) != 0) {
|
|
wpa_printf(MSG_MSGDUMP,
|
|
"KaY: MKPDU is not multiple of 4 octets");
|
|
return -1;
|
|
}
|
|
|
|
body = (struct ieee802_1x_mka_basic_body *) mka_hdr;
|
|
ieee802_1x_mka_dump_basic_body(body);
|
|
body_len = get_mka_param_body_len(body);
|
|
/* EAPOL-MKA body should comprise basic parameter set and ICV */
|
|
if (mka_msg_len < MKA_HDR_LEN + body_len + DEFAULT_ICV_LEN) {
|
|
wpa_printf(MSG_ERROR,
|
|
"KaY: Received EAPOL-MKA Packet Body Length (%d bytes) is less than the Basic Parameter Set Header Length (%d bytes) + the Basic Parameter Set Body Length (%d bytes) + %d bytes of ICV",
|
|
(int) mka_msg_len, (int) MKA_HDR_LEN,
|
|
(int) body_len, DEFAULT_ICV_LEN);
|
|
return -1;
|
|
}
|
|
|
|
/* CKN should be owned by I */
|
|
participant = ieee802_1x_kay_get_participant(kay, body->ckn);
|
|
if (!participant) {
|
|
wpa_printf(MSG_DEBUG, "CKN is not included in my CA");
|
|
return -1;
|
|
}
|
|
|
|
/* algorithm agility check */
|
|
if (os_memcmp(body->algo_agility, mka_algo_agility,
|
|
sizeof(body->algo_agility)) != 0) {
|
|
wpa_printf(MSG_ERROR,
|
|
"KaY: peer's algorithm agility not supported for me");
|
|
return -1;
|
|
}
|
|
|
|
/* ICV check */
|
|
/*
|
|
* The ICV will comprise the final octets of the packet body, whatever
|
|
* its size, not the fixed length 16 octets, indicated by the EAPOL
|
|
* packet body length.
|
|
*/
|
|
if (mka_alg_tbl[kay->mka_algindex].icv_hash(
|
|
participant->ick.key,
|
|
buf, len - mka_alg_tbl[kay->mka_algindex].icv_len, icv)) {
|
|
wpa_printf(MSG_ERROR, "KaY: omac1_aes_128 failed");
|
|
return -1;
|
|
}
|
|
msg_icv = ieee802_1x_mka_decode_icv_body(participant, (u8 *) mka_hdr,
|
|
mka_msg_len);
|
|
|
|
if (msg_icv) {
|
|
if (os_memcmp(msg_icv, icv,
|
|
mka_alg_tbl[kay->mka_algindex].icv_len) != 0) {
|
|
wpa_printf(MSG_ERROR,
|
|
"KaY: Computed ICV is not equal to Received ICV");
|
|
return -1;
|
|
}
|
|
} else {
|
|
wpa_printf(MSG_ERROR, "KaY: No ICV");
|
|
return -1;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_decode_mkpdu -
|
|
*/
|
|
static int ieee802_1x_kay_decode_mkpdu(struct ieee802_1x_kay *kay,
|
|
const u8 *buf, size_t len)
|
|
{
|
|
struct ieee802_1x_mka_participant *participant;
|
|
struct ieee802_1x_mka_hdr *hdr;
|
|
size_t body_len;
|
|
size_t left_len;
|
|
int body_type;
|
|
int i;
|
|
const u8 *pos;
|
|
Boolean my_included;
|
|
Boolean handled[256];
|
|
|
|
if (ieee802_1x_kay_mkpdu_sanity_check(kay, buf, len))
|
|
return -1;
|
|
|
|
/* handle basic parameter set */
|
|
pos = buf + sizeof(struct ieee8023_hdr) + sizeof(struct ieee802_1x_hdr);
|
|
left_len = len - sizeof(struct ieee8023_hdr) -
|
|
sizeof(struct ieee802_1x_hdr);
|
|
participant = ieee802_1x_mka_decode_basic_body(kay, pos, left_len);
|
|
if (!participant)
|
|
return -1;
|
|
|
|
/* to skip basic parameter set */
|
|
hdr = (struct ieee802_1x_mka_hdr *) pos;
|
|
body_len = get_mka_param_body_len(hdr);
|
|
pos += body_len + MKA_HDR_LEN;
|
|
left_len -= body_len + MKA_HDR_LEN;
|
|
|
|
/* check i am in the peer's peer list */
|
|
my_included = ieee802_1x_mka_i_in_peerlist(participant, pos, left_len);
|
|
if (my_included) {
|
|
/* accept the peer as live peer */
|
|
if (!ieee802_1x_kay_is_in_peer(
|
|
participant,
|
|
participant->current_peer_id.mi)) {
|
|
if (!ieee802_1x_kay_create_live_peer(
|
|
participant,
|
|
participant->current_peer_id.mi,
|
|
participant->current_peer_id.mn))
|
|
return -1;
|
|
ieee802_1x_kay_elect_key_server(participant);
|
|
ieee802_1x_kay_decide_macsec_use(participant);
|
|
}
|
|
if (ieee802_1x_kay_is_in_potential_peer(
|
|
participant, participant->current_peer_id.mi)) {
|
|
ieee802_1x_kay_move_live_peer(
|
|
participant, participant->current_peer_id.mi,
|
|
participant->current_peer_id.mn);
|
|
ieee802_1x_kay_elect_key_server(participant);
|
|
ieee802_1x_kay_decide_macsec_use(participant);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Handle other parameter set than basic parameter set.
|
|
* Each parameter set should be present only once.
|
|
*/
|
|
for (i = 0; i < 256; i++)
|
|
handled[i] = FALSE;
|
|
|
|
handled[0] = TRUE;
|
|
while (left_len > MKA_HDR_LEN + DEFAULT_ICV_LEN) {
|
|
hdr = (struct ieee802_1x_mka_hdr *) pos;
|
|
body_len = get_mka_param_body_len(hdr);
|
|
body_type = get_mka_param_body_type(hdr);
|
|
|
|
if (body_type == MKA_ICV_INDICATOR)
|
|
return 0;
|
|
|
|
if (left_len < (MKA_HDR_LEN + body_len + DEFAULT_ICV_LEN)) {
|
|
wpa_printf(MSG_ERROR,
|
|
"KaY: MKA Peer Packet Body Length (%d bytes) is less than the Parameter Set Header Length (%d bytes) + the Parameter Set Body Length (%d bytes) + %d bytes of ICV",
|
|
(int) left_len, (int) MKA_HDR_LEN,
|
|
(int) body_len, DEFAULT_ICV_LEN);
|
|
goto next_para_set;
|
|
}
|
|
|
|
if (handled[body_type])
|
|
goto next_para_set;
|
|
|
|
handled[body_type] = TRUE;
|
|
if (mak_body_handler[body_type].body_rx) {
|
|
mak_body_handler[body_type].body_rx
|
|
(participant, pos, left_len);
|
|
} else {
|
|
wpa_printf(MSG_ERROR,
|
|
"The type %d not supported in this MKA version %d",
|
|
body_type, MKA_VERSION_ID);
|
|
}
|
|
|
|
next_para_set:
|
|
pos += body_len + MKA_HDR_LEN;
|
|
left_len -= body_len + MKA_HDR_LEN;
|
|
}
|
|
|
|
kay->active = TRUE;
|
|
participant->retry_count = 0;
|
|
participant->active = TRUE;
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
static void kay_l2_receive(void *ctx, const u8 *src_addr, const u8 *buf,
|
|
size_t len)
|
|
{
|
|
struct ieee802_1x_kay *kay = ctx;
|
|
struct ieee8023_hdr *eth_hdr;
|
|
struct ieee802_1x_hdr *eapol_hdr;
|
|
|
|
/* must contain at least ieee8023_hdr + ieee802_1x_hdr */
|
|
if (len < sizeof(*eth_hdr) + sizeof(*eapol_hdr)) {
|
|
wpa_printf(MSG_MSGDUMP, "KaY: EAPOL frame too short (%lu)",
|
|
(unsigned long) len);
|
|
return;
|
|
}
|
|
|
|
eth_hdr = (struct ieee8023_hdr *) buf;
|
|
eapol_hdr = (struct ieee802_1x_hdr *) (eth_hdr + 1);
|
|
if (len != sizeof(*eth_hdr) + sizeof(*eapol_hdr) +
|
|
ntohs(eapol_hdr->length)) {
|
|
wpa_printf(MSG_MSGDUMP, "KAY: EAPOL MPDU is invalid: (%lu-%lu)",
|
|
(unsigned long) len,
|
|
(unsigned long) ntohs(eapol_hdr->length));
|
|
return;
|
|
}
|
|
|
|
if (eapol_hdr->version < EAPOL_VERSION) {
|
|
wpa_printf(MSG_MSGDUMP, "KaY: version %d does not support MKA",
|
|
eapol_hdr->version);
|
|
return;
|
|
}
|
|
if (ntohs(eth_hdr->ethertype) != ETH_P_PAE ||
|
|
eapol_hdr->type != IEEE802_1X_TYPE_EAPOL_MKA)
|
|
return;
|
|
|
|
wpa_hexdump(MSG_DEBUG, "RX EAPOL-MKA: ", buf, len);
|
|
if (dl_list_empty(&kay->participant_list)) {
|
|
wpa_printf(MSG_ERROR, "KaY: no MKA participant instance");
|
|
return;
|
|
}
|
|
|
|
ieee802_1x_kay_decode_mkpdu(kay, buf, len);
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_init -
|
|
*/
|
|
struct ieee802_1x_kay *
|
|
ieee802_1x_kay_init(struct ieee802_1x_kay_ctx *ctx, enum macsec_policy policy,
|
|
const char *ifname, const u8 *addr)
|
|
{
|
|
struct ieee802_1x_kay *kay;
|
|
|
|
kay = os_zalloc(sizeof(*kay));
|
|
if (!kay) {
|
|
wpa_printf(MSG_ERROR, "KaY-%s: out of memory", __func__);
|
|
return NULL;
|
|
}
|
|
|
|
kay->ctx = ctx;
|
|
|
|
kay->enable = TRUE;
|
|
kay->active = FALSE;
|
|
|
|
kay->authenticated = FALSE;
|
|
kay->secured = FALSE;
|
|
kay->failed = FALSE;
|
|
kay->policy = policy;
|
|
|
|
os_strlcpy(kay->if_name, ifname, IFNAMSIZ);
|
|
os_memcpy(kay->actor_sci.addr, addr, ETH_ALEN);
|
|
kay->actor_sci.port = 0x0001;
|
|
kay->actor_priority = DEFAULT_PRIO_NOT_KEY_SERVER;
|
|
|
|
/* While actor acts as a key server, shall distribute sakey */
|
|
kay->dist_kn = 1;
|
|
kay->dist_an = 0;
|
|
kay->dist_time = 0;
|
|
|
|
kay->pn_exhaustion = PENDING_PN_EXHAUSTION;
|
|
kay->macsec_csindex = DEFAULT_CS_INDEX;
|
|
kay->mka_algindex = DEFAULT_MKA_ALG_INDEX;
|
|
kay->mka_version = MKA_VERSION_ID;
|
|
|
|
os_memcpy(kay->algo_agility, mka_algo_agility,
|
|
sizeof(kay->algo_agility));
|
|
|
|
dl_list_init(&kay->participant_list);
|
|
|
|
if (policy == DO_NOT_SECURE) {
|
|
kay->macsec_capable = MACSEC_CAP_NOT_IMPLEMENTED;
|
|
kay->macsec_desired = FALSE;
|
|
kay->macsec_protect = FALSE;
|
|
kay->macsec_validate = FALSE;
|
|
kay->macsec_replay_protect = FALSE;
|
|
kay->macsec_replay_window = 0;
|
|
kay->macsec_confidentiality = CONFIDENTIALITY_NONE;
|
|
} else {
|
|
kay->macsec_capable = MACSEC_CAP_INTEG_AND_CONF_0_30_50;
|
|
kay->macsec_desired = TRUE;
|
|
kay->macsec_protect = TRUE;
|
|
kay->macsec_validate = TRUE;
|
|
kay->macsec_replay_protect = FALSE;
|
|
kay->macsec_replay_window = 0;
|
|
kay->macsec_confidentiality = CONFIDENTIALITY_OFFSET_0;
|
|
}
|
|
|
|
wpa_printf(MSG_DEBUG, "KaY: state machine created");
|
|
|
|
/* Initialize the SecY must be prio to CP, as CP will control SecY */
|
|
secy_init_macsec(kay);
|
|
secy_get_available_transmit_sc(kay, &kay->sc_ch);
|
|
|
|
wpa_printf(MSG_DEBUG, "KaY: secy init macsec done");
|
|
|
|
/* init CP */
|
|
kay->cp = ieee802_1x_kay_alloc_cp_sm(kay);
|
|
if (kay->cp == NULL) {
|
|
ieee802_1x_kay_deinit(kay);
|
|
return NULL;
|
|
}
|
|
|
|
if (policy == DO_NOT_SECURE) {
|
|
ieee802_1x_cp_connect_authenticated(kay->cp);
|
|
ieee802_1x_cp_sm_step(kay->cp);
|
|
} else {
|
|
kay->l2_mka = l2_packet_init(kay->if_name, NULL, ETH_P_PAE,
|
|
kay_l2_receive, kay, 1);
|
|
if (kay->l2_mka == NULL) {
|
|
wpa_printf(MSG_WARNING,
|
|
"KaY: Failed to initialize L2 packet processing for MKA packet");
|
|
ieee802_1x_kay_deinit(kay);
|
|
return NULL;
|
|
}
|
|
}
|
|
|
|
return kay;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_deinit -
|
|
*/
|
|
void
|
|
ieee802_1x_kay_deinit(struct ieee802_1x_kay *kay)
|
|
{
|
|
struct ieee802_1x_mka_participant *participant;
|
|
|
|
if (!kay)
|
|
return;
|
|
|
|
wpa_printf(MSG_DEBUG, "KaY: state machine removed");
|
|
|
|
while (!dl_list_empty(&kay->participant_list)) {
|
|
participant = dl_list_entry(kay->participant_list.next,
|
|
struct ieee802_1x_mka_participant,
|
|
list);
|
|
ieee802_1x_kay_delete_mka(kay, &participant->ckn);
|
|
}
|
|
|
|
ieee802_1x_cp_sm_deinit(kay->cp);
|
|
secy_deinit_macsec(kay);
|
|
|
|
if (kay->l2_mka) {
|
|
l2_packet_deinit(kay->l2_mka);
|
|
kay->l2_mka = NULL;
|
|
}
|
|
|
|
os_free(kay->ctx);
|
|
os_free(kay);
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_create_mka -
|
|
*/
|
|
struct ieee802_1x_mka_participant *
|
|
ieee802_1x_kay_create_mka(struct ieee802_1x_kay *kay, struct mka_key_name *ckn,
|
|
struct mka_key *cak, u32 life,
|
|
enum mka_created_mode mode, Boolean is_authenticator)
|
|
{
|
|
struct ieee802_1x_mka_participant *participant;
|
|
unsigned int usecs;
|
|
|
|
if (!kay || !ckn || !cak) {
|
|
wpa_printf(MSG_ERROR, "KaY: ckn or cak is null");
|
|
return NULL;
|
|
}
|
|
|
|
if (cak->len != mka_alg_tbl[kay->mka_algindex].cak_len) {
|
|
wpa_printf(MSG_ERROR, "KaY: CAK length not follow key schema");
|
|
return NULL;
|
|
}
|
|
if (ckn->len > MAX_CKN_LEN) {
|
|
wpa_printf(MSG_ERROR, "KaY: CKN is out of range(<=32 bytes)");
|
|
return NULL;
|
|
}
|
|
if (!kay->enable) {
|
|
wpa_printf(MSG_ERROR, "KaY: Now is at disable state");
|
|
return NULL;
|
|
}
|
|
|
|
participant = os_zalloc(sizeof(*participant));
|
|
if (!participant) {
|
|
wpa_printf(MSG_ERROR, "KaY-%s: out of memory", __func__);
|
|
return NULL;
|
|
}
|
|
|
|
participant->ckn.len = ckn->len;
|
|
os_memcpy(participant->ckn.name, ckn->name, ckn->len);
|
|
participant->cak.len = cak->len;
|
|
os_memcpy(participant->cak.key, cak->key, cak->len);
|
|
if (life)
|
|
participant->cak_life = life + time(NULL);
|
|
|
|
switch (mode) {
|
|
case EAP_EXCHANGE:
|
|
if (is_authenticator) {
|
|
participant->is_obliged_key_server = TRUE;
|
|
participant->can_be_key_server = TRUE;
|
|
participant->is_key_server = TRUE;
|
|
participant->principal = TRUE;
|
|
|
|
os_memcpy(&kay->key_server_sci, &kay->actor_sci,
|
|
sizeof(kay->key_server_sci));
|
|
kay->key_server_priority = kay->actor_priority;
|
|
participant->is_elected = TRUE;
|
|
} else {
|
|
participant->is_obliged_key_server = FALSE;
|
|
participant->can_be_key_server = FALSE;
|
|
participant->is_key_server = FALSE;
|
|
participant->is_elected = TRUE;
|
|
}
|
|
break;
|
|
|
|
default:
|
|
participant->is_obliged_key_server = FALSE;
|
|
participant->can_be_key_server = TRUE;
|
|
participant->is_key_server = FALSE;
|
|
participant->is_elected = FALSE;
|
|
break;
|
|
}
|
|
|
|
participant->cached = FALSE;
|
|
|
|
participant->active = FALSE;
|
|
participant->participant = FALSE;
|
|
participant->retain = FALSE;
|
|
participant->activate = DEFAULT;
|
|
|
|
if (participant->is_key_server)
|
|
participant->principal = TRUE;
|
|
|
|
dl_list_init(&participant->live_peers);
|
|
dl_list_init(&participant->potential_peers);
|
|
|
|
participant->retry_count = 0;
|
|
participant->kay = kay;
|
|
|
|
os_get_random(participant->mi, sizeof(participant->mi));
|
|
participant->mn = 0;
|
|
|
|
participant->lrx = FALSE;
|
|
participant->ltx = FALSE;
|
|
participant->orx = FALSE;
|
|
participant->otx = FALSE;
|
|
participant->to_dist_sak = FALSE;
|
|
participant->to_use_sak = FALSE;
|
|
participant->new_sak = FALSE;
|
|
dl_list_init(&participant->sak_list);
|
|
participant->new_key = NULL;
|
|
dl_list_init(&participant->rxsc_list);
|
|
participant->txsc = ieee802_1x_kay_init_transmit_sc(&kay->actor_sci,
|
|
kay->sc_ch);
|
|
secy_create_transmit_sc(kay, participant->txsc);
|
|
|
|
/* to derive KEK from CAK and CKN */
|
|
participant->kek.len = mka_alg_tbl[kay->mka_algindex].kek_len;
|
|
if (mka_alg_tbl[kay->mka_algindex].kek_trfm(participant->cak.key,
|
|
participant->ckn.name,
|
|
participant->ckn.len,
|
|
participant->kek.key)) {
|
|
wpa_printf(MSG_ERROR, "KaY: Derived KEK failed");
|
|
goto fail;
|
|
}
|
|
wpa_hexdump_key(MSG_DEBUG, "KaY: Derived KEK",
|
|
participant->kek.key, participant->kek.len);
|
|
|
|
/* to derive ICK from CAK and CKN */
|
|
participant->ick.len = mka_alg_tbl[kay->mka_algindex].ick_len;
|
|
if (mka_alg_tbl[kay->mka_algindex].ick_trfm(participant->cak.key,
|
|
participant->ckn.name,
|
|
participant->ckn.len,
|
|
participant->ick.key)) {
|
|
wpa_printf(MSG_ERROR, "KaY: Derived ICK failed");
|
|
goto fail;
|
|
}
|
|
wpa_hexdump_key(MSG_DEBUG, "KaY: Derived ICK",
|
|
participant->ick.key, participant->ick.len);
|
|
|
|
dl_list_add(&kay->participant_list, &participant->list);
|
|
wpa_hexdump(MSG_DEBUG, "KaY: Participant created:",
|
|
ckn->name, ckn->len);
|
|
|
|
usecs = os_random() % (MKA_HELLO_TIME * 1000);
|
|
eloop_register_timeout(0, usecs, ieee802_1x_participant_timer,
|
|
participant, NULL);
|
|
participant->mka_life = MKA_LIFE_TIME / 1000 + time(NULL) +
|
|
usecs / 1000000;
|
|
|
|
return participant;
|
|
|
|
fail:
|
|
os_free(participant);
|
|
return NULL;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_delete_mka -
|
|
*/
|
|
void
|
|
ieee802_1x_kay_delete_mka(struct ieee802_1x_kay *kay, struct mka_key_name *ckn)
|
|
{
|
|
struct ieee802_1x_mka_participant *participant;
|
|
struct ieee802_1x_kay_peer *peer;
|
|
struct data_key *sak;
|
|
struct receive_sc *rxsc;
|
|
|
|
if (!kay || !ckn)
|
|
return;
|
|
|
|
wpa_printf(MSG_DEBUG, "KaY: participant removed");
|
|
|
|
/* get the participant */
|
|
participant = ieee802_1x_kay_get_participant(kay, ckn->name);
|
|
if (!participant) {
|
|
wpa_hexdump(MSG_DEBUG, "KaY: participant is not found",
|
|
ckn->name, ckn->len);
|
|
return;
|
|
}
|
|
|
|
dl_list_del(&participant->list);
|
|
|
|
/* remove live peer */
|
|
while (!dl_list_empty(&participant->live_peers)) {
|
|
peer = dl_list_entry(participant->live_peers.next,
|
|
struct ieee802_1x_kay_peer, list);
|
|
dl_list_del(&peer->list);
|
|
os_free(peer);
|
|
}
|
|
|
|
/* remove potential peer */
|
|
while (!dl_list_empty(&participant->potential_peers)) {
|
|
peer = dl_list_entry(participant->potential_peers.next,
|
|
struct ieee802_1x_kay_peer, list);
|
|
dl_list_del(&peer->list);
|
|
os_free(peer);
|
|
}
|
|
|
|
/* remove sak */
|
|
while (!dl_list_empty(&participant->sak_list)) {
|
|
sak = dl_list_entry(participant->sak_list.next,
|
|
struct data_key, list);
|
|
dl_list_del(&sak->list);
|
|
os_free(sak->key);
|
|
os_free(sak);
|
|
}
|
|
while (!dl_list_empty(&participant->rxsc_list)) {
|
|
rxsc = dl_list_entry(participant->rxsc_list.next,
|
|
struct receive_sc, list);
|
|
secy_delete_receive_sc(kay, rxsc);
|
|
ieee802_1x_kay_deinit_receive_sc(participant, rxsc);
|
|
}
|
|
secy_delete_transmit_sc(kay, participant->txsc);
|
|
ieee802_1x_kay_deinit_transmit_sc(participant, participant->txsc);
|
|
|
|
os_memset(&participant->cak, 0, sizeof(participant->cak));
|
|
os_memset(&participant->kek, 0, sizeof(participant->kek));
|
|
os_memset(&participant->ick, 0, sizeof(participant->ick));
|
|
os_free(participant);
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_mka_participate -
|
|
*/
|
|
void ieee802_1x_kay_mka_participate(struct ieee802_1x_kay *kay,
|
|
struct mka_key_name *ckn,
|
|
Boolean status)
|
|
{
|
|
struct ieee802_1x_mka_participant *participant;
|
|
|
|
if (!kay || !ckn)
|
|
return;
|
|
|
|
participant = ieee802_1x_kay_get_participant(kay, ckn->name);
|
|
if (!participant)
|
|
return;
|
|
|
|
participant->active = status;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_new_sak -
|
|
*/
|
|
int
|
|
ieee802_1x_kay_new_sak(struct ieee802_1x_kay *kay)
|
|
{
|
|
struct ieee802_1x_mka_participant *participant;
|
|
|
|
if (!kay)
|
|
return -1;
|
|
|
|
participant = ieee802_1x_kay_get_principal_participant(kay);
|
|
if (!participant)
|
|
return -1;
|
|
|
|
participant->new_sak = TRUE;
|
|
wpa_printf(MSG_DEBUG, "KaY: new SAK signal");
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
/**
|
|
* ieee802_1x_kay_change_cipher_suite -
|
|
*/
|
|
int
|
|
ieee802_1x_kay_change_cipher_suite(struct ieee802_1x_kay *kay, int cs_index)
|
|
{
|
|
struct ieee802_1x_mka_participant *participant;
|
|
|
|
if (!kay)
|
|
return -1;
|
|
|
|
if ((unsigned int) cs_index >= CS_TABLE_SIZE) {
|
|
wpa_printf(MSG_ERROR,
|
|
"KaY: Configured cipher suite index is out of range");
|
|
return -1;
|
|
}
|
|
if (kay->macsec_csindex == cs_index)
|
|
return -2;
|
|
|
|
if (cs_index == 0)
|
|
kay->macsec_desired = FALSE;
|
|
|
|
kay->macsec_csindex = cs_index;
|
|
kay->macsec_capable = cipher_suite_tbl[kay->macsec_csindex].capable;
|
|
|
|
participant = ieee802_1x_kay_get_principal_participant(kay);
|
|
if (participant) {
|
|
wpa_printf(MSG_INFO, "KaY: Cipher Suite changed");
|
|
participant->new_sak = TRUE;
|
|
}
|
|
|
|
return 0;
|
|
}
|