forked from acouzens/open5gs
84 lines
2.3 KiB
C
84 lines
2.3 KiB
C
/*
|
|
* Copyright (C) 2019 by Sukchan Lee <acetcom@gmail.com>
|
|
*
|
|
* This file is part of Open5GS.
|
|
*
|
|
* This program is free software: you can redistribute it and/or modify
|
|
* it under the terms of the GNU Affero General Public License as published by
|
|
* the Free Software Foundation, either version 3 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program. If not, see <https://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#include "message.h"
|
|
|
|
ogs_pkbuf_t *ogs_asn_encode(const asn_TYPE_descriptor_t *td, void *sptr)
|
|
{
|
|
asn_enc_rval_t enc_ret = {0};
|
|
ogs_pkbuf_t *pkbuf = NULL;
|
|
|
|
ogs_assert(td);
|
|
ogs_assert(sptr);
|
|
|
|
pkbuf = ogs_pkbuf_alloc(NULL, OGS_MAX_SDU_LEN);
|
|
if (!pkbuf) {
|
|
ogs_error("ogs_pkbuf_alloc() failed");
|
|
return NULL;
|
|
}
|
|
ogs_pkbuf_put(pkbuf, OGS_MAX_SDU_LEN);
|
|
|
|
enc_ret = aper_encode_to_buffer(td, NULL,
|
|
sptr, pkbuf->data, OGS_MAX_SDU_LEN);
|
|
ogs_asn_free(td, sptr);
|
|
|
|
if (enc_ret.encoded < 0) {
|
|
ogs_error("Failed to encode ASN-PDU [%d]", (int)enc_ret.encoded);
|
|
ogs_pkbuf_free(pkbuf);
|
|
return NULL;
|
|
}
|
|
|
|
ogs_pkbuf_trim(pkbuf, ((enc_ret.encoded + 7) >> 3));
|
|
|
|
return pkbuf;
|
|
}
|
|
|
|
int ogs_asn_decode(const asn_TYPE_descriptor_t *td,
|
|
void *struct_ptr, size_t struct_size, ogs_pkbuf_t *pkbuf)
|
|
{
|
|
asn_dec_rval_t dec_ret = {0};
|
|
|
|
ogs_assert(td);
|
|
ogs_assert(struct_ptr);
|
|
ogs_assert(struct_size);
|
|
ogs_assert(pkbuf);
|
|
ogs_assert(pkbuf->data);
|
|
ogs_assert(pkbuf->len);
|
|
|
|
memset(struct_ptr, 0, struct_size);
|
|
dec_ret = aper_decode(NULL, td, (void **)&struct_ptr,
|
|
pkbuf->data, pkbuf->len, 0, 0);
|
|
|
|
if (dec_ret.code != RC_OK) {
|
|
ogs_warn("Failed to decode ASN-PDU [code:%d,consumed:%d]",
|
|
dec_ret.code, (int)dec_ret.consumed);
|
|
return OGS_ERROR;
|
|
}
|
|
|
|
return OGS_OK;
|
|
}
|
|
|
|
void ogs_asn_free(const asn_TYPE_descriptor_t *td, void *sptr)
|
|
{
|
|
ogs_assert(td);
|
|
ogs_assert(sptr);
|
|
|
|
ASN_STRUCT_FREE_CONTENTS_ONLY(*td, sptr);
|
|
}
|