53 lines
2.0 KiB
C
53 lines
2.0 KiB
C
/**
|
|
* \file
|
|
* CCM* convenience functions for LLSEC use
|
|
* \author
|
|
* Justin King-Lacroix <justin.kinglacroix@gmail.com>
|
|
*/
|
|
|
|
#include "lib/ccm-star.h"
|
|
#include "net/packetbuf.h"
|
|
#include <string.h>
|
|
|
|
/*---------------------------------------------------------------------------*/
|
|
void ccm_star_mic_packetbuf(const uint8_t *extended_source_address,
|
|
uint8_t *result,
|
|
uint8_t mic_len)
|
|
{
|
|
uint8_t *dataptr = packetbuf_dataptr();
|
|
uint8_t data_len = packetbuf_datalen();
|
|
uint8_t *headerptr = packetbuf_hdrptr();
|
|
uint8_t header_len = packetbuf_hdrlen();
|
|
uint8_t nonce[CCM_STAR_NONCE_LENGTH];
|
|
|
|
memcpy(nonce, extended_source_address, 8);
|
|
nonce[8] = packetbuf_attr(PACKETBUF_ATTR_FRAME_COUNTER_BYTES_2_3) >> 8;
|
|
nonce[9] = packetbuf_attr(PACKETBUF_ATTR_FRAME_COUNTER_BYTES_2_3) & 0xff;
|
|
nonce[10] = packetbuf_attr(PACKETBUF_ATTR_FRAME_COUNTER_BYTES_0_1) >> 8;
|
|
nonce[11] = packetbuf_attr(PACKETBUF_ATTR_FRAME_COUNTER_BYTES_0_1) & 0xff;
|
|
nonce[12] = packetbuf_attr(PACKETBUF_ATTR_SECURITY_LEVEL);
|
|
|
|
if(packetbuf_attr(PACKETBUF_ATTR_SECURITY_LEVEL) & (1 << 2)) {
|
|
CCM_STAR.mic(dataptr, data_len, nonce, headerptr, header_len, result, mic_len);
|
|
} else {
|
|
CCM_STAR.mic(dataptr, 0, nonce, headerptr, packetbuf_totlen(), result, mic_len);
|
|
}
|
|
}
|
|
/*---------------------------------------------------------------------------*/
|
|
void ccm_star_ctr_packetbuf(const uint8_t *extended_source_address)
|
|
{
|
|
uint8_t *dataptr = packetbuf_dataptr();
|
|
uint8_t data_len = packetbuf_datalen();
|
|
uint8_t nonce[CCM_STAR_NONCE_LENGTH];
|
|
|
|
memcpy(nonce, extended_source_address, 8);
|
|
nonce[8] = packetbuf_attr(PACKETBUF_ATTR_FRAME_COUNTER_BYTES_2_3) >> 8;
|
|
nonce[9] = packetbuf_attr(PACKETBUF_ATTR_FRAME_COUNTER_BYTES_2_3) & 0xff;
|
|
nonce[10] = packetbuf_attr(PACKETBUF_ATTR_FRAME_COUNTER_BYTES_0_1) >> 8;
|
|
nonce[11] = packetbuf_attr(PACKETBUF_ATTR_FRAME_COUNTER_BYTES_0_1) & 0xff;
|
|
nonce[12] = packetbuf_attr(PACKETBUF_ATTR_SECURITY_LEVEL);
|
|
|
|
CCM_STAR.ctr(dataptr, data_len, nonce);
|
|
}
|
|
/*---------------------------------------------------------------------------*/
|