139 lines
3.1 KiB
C
139 lines
3.1 KiB
C
|
#include <stdint.h>
|
||
|
|
||
|
#include <osmocom/core/msgb.h>
|
||
|
|
||
|
#include "rua_common.h"
|
||
|
#include "hnbgw.h"
|
||
|
|
||
|
extern int asn1_xer_print;
|
||
|
|
||
|
static struct msgb *rua_msgb_alloc(void)
|
||
|
{
|
||
|
return msgb_alloc(1024, "RUA Tx");
|
||
|
}
|
||
|
|
||
|
#if 0
|
||
|
ssize_t rua_generate_initiating_message(uint8_t ** buffer,
|
||
|
uint32_t * length,
|
||
|
e_RUA_ProcedureCode procedureCode,
|
||
|
RUA_Criticality_t criticality,
|
||
|
asn_TYPE_descriptor_t * td, void *sptr)
|
||
|
{
|
||
|
RUA_RUA_PDU_t pdu;
|
||
|
ssize_t encoded;
|
||
|
|
||
|
memset(&pdu, 0, sizeof(pdu));
|
||
|
|
||
|
pdu.present = RUA_RUA_PDU_PR_initiatingMessage;
|
||
|
pdu.choice.initiatingMessage.procedureCode = procedureCode;
|
||
|
pdu.choice.initiatingMessage.criticality = criticality;
|
||
|
ANY_fromType_aper(&pdu.choice.initiatingMessage.value, td, sptr);
|
||
|
|
||
|
if (asn1_xer_print)
|
||
|
xer_fprint(stdout, &asn_DEF_RUA_RUA_PDU, (void *)&pdu);
|
||
|
|
||
|
if ((encoded =
|
||
|
aper_encode_to_new_buffer(&asn_DEF_RUA_RUA_PDU, 0, &pdu,
|
||
|
(void **)buffer)) < 0) {
|
||
|
return -1;
|
||
|
}
|
||
|
|
||
|
*length = encoded;
|
||
|
return encoded;
|
||
|
}
|
||
|
#endif
|
||
|
|
||
|
struct msgb *rua_generate_successful_outcome(
|
||
|
e_RUA_ProcedureCode procedureCode,
|
||
|
RUA_Criticality_t criticality,
|
||
|
asn_TYPE_descriptor_t * td,
|
||
|
void *sptr)
|
||
|
{
|
||
|
|
||
|
RUA_RUA_PDU_t pdu;
|
||
|
struct msgb *msg = rua_msgb_alloc();
|
||
|
asn_enc_rval_t rval;
|
||
|
int rc;
|
||
|
|
||
|
memset(&pdu, 0, sizeof(pdu));
|
||
|
pdu.present = RUA_RUA_PDU_PR_successfulOutcome;
|
||
|
pdu.choice.successfulOutcome.procedureCode = procedureCode;
|
||
|
pdu.choice.successfulOutcome.criticality = criticality;
|
||
|
rc = ANY_fromType_aper(&pdu.choice.successfulOutcome.value, td, sptr);
|
||
|
if (rc < 0) {
|
||
|
LOGP(DMAIN, LOGL_ERROR, "Error in ANY_fromType_aper\n");
|
||
|
msgb_free(msg);
|
||
|
return NULL;
|
||
|
}
|
||
|
|
||
|
rval = aper_encode_to_buffer(&asn_DEF_RUA_RUA_PDU, &pdu,
|
||
|
msg->data, msgb_tailroom(msg));
|
||
|
if (rval.encoded < 0) {
|
||
|
LOGP(DMAIN, LOGL_ERROR, "Error encoding type %s\n", rval.failed_type->name);
|
||
|
msgb_free(msg);
|
||
|
return NULL;
|
||
|
}
|
||
|
|
||
|
msgb_put(msg, rval.encoded);
|
||
|
|
||
|
return msg;
|
||
|
}
|
||
|
|
||
|
#if 0
|
||
|
ssize_t rua_generate_unsuccessful_outcome(uint8_t ** buffer,
|
||
|
uint32_t * length,
|
||
|
e_RUA_ProcedureCode procedureCode,
|
||
|
RUA_Criticality_t criticality,
|
||
|
asn_TYPE_descriptor_t * td,
|
||
|
void *sptr)
|
||
|
{
|
||
|
|
||
|
RUA_RUA_PDU_t pdu;
|
||
|
ssize_t encoded;
|
||
|
|
||
|
memset(&pdu, 0, sizeof(pdu));
|
||
|
|
||
|
pdu.present = RUA_RUA_PDU_PR_unsuccessfulOutcome;
|
||
|
pdu.choice.successfulOutcome.procedureCode = procedureCode;
|
||
|
pdu.choice.successfulOutcome.criticality = criticality;
|
||
|
ANY_fromType_aper(&pdu.choice.successfulOutcome.value, td, sptr);
|
||
|
|
||
|
if ((encoded =
|
||
|
aper_encode_to_new_buffer(&asn_DEF_RUA_RUA_PDU, 0, &pdu,
|
||
|
(void **)buffer)) < 0) {
|
||
|
return -1;
|
||
|
}
|
||
|
|
||
|
*length = encoded;
|
||
|
|
||
|
return encoded;
|
||
|
}
|
||
|
#endif
|
||
|
|
||
|
RUA_IE_t *rua_new_ie(RUA_ProtocolIE_ID_t id,
|
||
|
RUA_Criticality_t criticality,
|
||
|
asn_TYPE_descriptor_t * type, void *sptr)
|
||
|
{
|
||
|
|
||
|
RUA_IE_t *buff;
|
||
|
|
||
|
if ((buff = malloc(sizeof(*buff))) == NULL) {
|
||
|
// Possible error on malloc
|
||
|
return NULL;
|
||
|
}
|
||
|
memset((void *)buff, 0, sizeof(*buff));
|
||
|
|
||
|
buff->id = id;
|
||
|
buff->criticality = criticality;
|
||
|
|
||
|
ANY_fromType_aper(&buff->value, type, sptr);
|
||
|
|
||
|
if (asn1_xer_print)
|
||
|
if (xer_fprint(stdout, &asn_DEF_RUA_IE, buff) < 0) {
|
||
|
free(buff);
|
||
|
return NULL;
|
||
|
}
|
||
|
|
||
|
return buff;
|
||
|
}
|