117 lines
3.5 KiB
C++
117 lines
3.5 KiB
C++
/*
|
|
SPDX-License-Identifier: GPL-3.0-or-later
|
|
Copyright © 2015-2022 Amebis
|
|
Copyright © 2016 GÉANT
|
|
*/
|
|
|
|
#include "PCH.h"
|
|
|
|
#pragma comment(lib, "Ws2_32.lib")
|
|
|
|
using namespace std;
|
|
using namespace winstd;
|
|
|
|
|
|
//////////////////////////////////////////////////////////////////////
|
|
// eap::packable
|
|
//////////////////////////////////////////////////////////////////////
|
|
|
|
eap::packable::packable()
|
|
{
|
|
}
|
|
|
|
|
|
eap::packable::~packable()
|
|
{
|
|
}
|
|
|
|
|
|
void eap::packable::operator<<(_Inout_ cursor_out &cursor) const
|
|
{
|
|
UNREFERENCED_PARAMETER(cursor);
|
|
}
|
|
|
|
|
|
size_t eap::packable::get_pk_size() const
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
|
|
void eap::packable::operator>>(_Inout_ cursor_in &cursor)
|
|
{
|
|
UNREFERENCED_PARAMETER(cursor);
|
|
}
|
|
|
|
|
|
//////////////////////////////////////////////////////////////////////
|
|
// eap::diameter_avp_append
|
|
//////////////////////////////////////////////////////////////////////
|
|
|
|
void eap::diameter_avp_append(
|
|
_In_ unsigned int code,
|
|
_In_ unsigned char flags,
|
|
_In_bytecount_(size) const void *data,
|
|
_In_ unsigned int size,
|
|
_Inout_ sanitizing_blob &packet)
|
|
{
|
|
unsigned int
|
|
padding = (unsigned int)((4 - size) % 4),
|
|
size_outer;
|
|
|
|
packet.reserve(
|
|
packet.size() +
|
|
(size_outer =
|
|
sizeof(diameter_avp_header) + // Diameter header
|
|
size) + // Data
|
|
padding); // Data padding
|
|
|
|
// Diameter AVP header
|
|
diameter_avp_header hdr;
|
|
*reinterpret_cast<unsigned int*>(hdr.code) = htonl(code);
|
|
hdr.flags = flags;
|
|
hton24(size_outer, hdr.length);
|
|
packet.insert(packet.end(), reinterpret_cast<const unsigned char*>(&hdr), reinterpret_cast<const unsigned char*>(&hdr + 1));
|
|
|
|
// Data
|
|
packet.insert(packet.end(), reinterpret_cast<const unsigned char*>(data), reinterpret_cast<const unsigned char*>(data) + size);
|
|
packet.insert(packet.end(), padding, 0);
|
|
}
|
|
|
|
|
|
//////////////////////////////////////////////////////////////////////
|
|
// eap::diameter_avp_append
|
|
//////////////////////////////////////////////////////////////////////
|
|
|
|
void eap::diameter_avp_append(
|
|
_In_ unsigned int code,
|
|
_In_ unsigned int vendor_id,
|
|
_In_ unsigned char flags,
|
|
_In_bytecount_(size) const void *data,
|
|
_In_ unsigned int size,
|
|
_Inout_ sanitizing_blob &packet)
|
|
{
|
|
unsigned int
|
|
padding = (unsigned int)((4 - size) % 4),
|
|
size_outer;
|
|
|
|
packet.reserve(
|
|
packet.size() +
|
|
(size_outer =
|
|
sizeof(diameter_avp_header_ven) + // Diameter header
|
|
size) + // Data
|
|
padding); // Data padding
|
|
|
|
// Diameter AVP header
|
|
diameter_avp_header_ven hdr;
|
|
*reinterpret_cast<unsigned int*>(hdr.code) = htonl(code);
|
|
hdr.flags = flags | diameter_avp_flag_vendor;
|
|
hton24(size_outer, hdr.length);
|
|
*reinterpret_cast<unsigned int*>(hdr.vendor) = htonl(vendor_id);
|
|
packet.insert(packet.end(), reinterpret_cast<const unsigned char*>(&hdr), reinterpret_cast<const unsigned char*>(&hdr + 1));
|
|
|
|
// Data
|
|
packet.insert(packet.end(), reinterpret_cast<const unsigned char*>(data), reinterpret_cast<const unsigned char*>(data) + size);
|
|
packet.insert(packet.end(), padding, 0);
|
|
}
|