387 lines
10 KiB
C
387 lines
10 KiB
C
#include <stdint.h>
|
|
#include <unistd.h>
|
|
#include <stdlib.h>
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
|
|
#define _GNU_SOURCE
|
|
#include <getopt.h>
|
|
|
|
#include <osmocom/core/select.h>
|
|
#include <osmocom/core/prim.h>
|
|
#include <osmocom/core/talloc.h>
|
|
#include <osmocom/core/logging.h>
|
|
#include <osmocom/core/application.h>
|
|
#include <osmocom/vty/logging.h>
|
|
|
|
#include <osmocom/gsm/gsm48.h>
|
|
|
|
#include <osmocom/sigtran/sua.h>
|
|
#include <osmocom/sigtran/sccp_sap.h>
|
|
|
|
#include "test_common.h"
|
|
|
|
#include <osmocom/ranap/ranap_ies_defs.h>
|
|
#include <osmocom/ranap/ranap_common_cn.h>
|
|
#include <osmocom/ranap/ranap_msg_factory.h>
|
|
#include <osmocom/iuh/hnbgw.h>
|
|
|
|
int asn1_xer_print = 1;
|
|
const char *cmdline_bind_addr = "127.0.0.1";
|
|
|
|
struct ue_conn_ctx {
|
|
struct llist_head list;
|
|
struct osmo_sccp_link *link;
|
|
uint32_t conn_id;
|
|
};
|
|
|
|
static LLIST_HEAD(conn_ctx_list);
|
|
|
|
struct ue_conn_ctx *ue_conn_ctx_alloc(struct osmo_sccp_link *link, uint32_t conn_id)
|
|
{
|
|
struct ue_conn_ctx *ctx = talloc_zero(NULL, struct ue_conn_ctx);
|
|
|
|
ctx->link = link;
|
|
ctx->conn_id = conn_id;
|
|
llist_add(&ctx->list, &conn_ctx_list);
|
|
|
|
return ctx;
|
|
}
|
|
|
|
struct ue_conn_ctx *ue_conn_ctx_find(struct osmo_sccp_link *link, uint32_t conn_id)
|
|
{
|
|
struct ue_conn_ctx *ctx;
|
|
|
|
llist_for_each_entry(ctx, &conn_ctx_list, list) {
|
|
if (ctx->link == link && ctx->conn_id == conn_id)
|
|
return ctx;
|
|
}
|
|
return NULL;
|
|
}
|
|
|
|
/***********************************************************************
|
|
* RANAP handling
|
|
***********************************************************************/
|
|
|
|
static int ranap_handle_co_initial_ue(struct ue_conn_ctx *ctx, RANAP_InitialUE_MessageIEs_t *ies)
|
|
{
|
|
struct gprs_ra_id ra_id;
|
|
uint16_t sai;
|
|
struct msgb *msg = msgb_alloc(256, "RANAP->NAS");
|
|
uint8_t *cur;
|
|
struct osmo_scu_prim *prim;
|
|
|
|
ranap_parse_lai(&ra_id, &ies->lai);
|
|
sai = asn1str_to_u16(&ies->sai.sAC);
|
|
cur = msgb_put(msg, ies->nas_pdu.size);
|
|
memcpy(msg, ies->nas_pdu.buf, ies->nas_pdu.size);
|
|
msgb_free(msg);
|
|
/* FIXME: set msgb_gmmh() */
|
|
|
|
/* FIXME: Feed into the MM layer */
|
|
//rc = gsm0408_gprs_rcvmsg_iu(msg, ra_id, sai, conn_id);
|
|
|
|
msg = ranap_new_msg_dt(0, NULL, 0);
|
|
|
|
msg->l2h = msg->data;
|
|
prim = (struct osmo_scu_prim *) msgb_push(msg, sizeof(*prim));
|
|
prim->u.data.conn_id = ctx->conn_id;
|
|
osmo_prim_init(&prim->oph, SCCP_SAP_USER, OSMO_SCU_PRIM_N_DATA,
|
|
PRIM_OP_REQUEST, msg);
|
|
|
|
osmo_sua_user_link_down(ctx->link, &prim->oph);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ranap_handle_co_dt(void *ctx, RANAP_DirectTransferIEs_t *ies)
|
|
{
|
|
struct gprs_ra_id _ra_id, *ra_id = NULL;
|
|
uint16_t _sai, *sai = NULL;
|
|
struct msgb *msg = msgb_alloc(256, "RANAP->NAS");
|
|
uint8_t *cur;
|
|
|
|
if (ies->presenceMask & DIRECTTRANSFERIES_RANAP_LAI_PRESENT) {
|
|
ranap_parse_lai(&_ra_id, &ies->lai);
|
|
ra_id = &_ra_id;
|
|
if (ies->presenceMask & DIRECTTRANSFERIES_RANAP_RAC_PRESENT) {
|
|
_ra_id.rac = asn1str_to_u8(&ies->rac);
|
|
}
|
|
if (ies->presenceMask & DIRECTTRANSFERIES_RANAP_SAI_PRESENT) {
|
|
_sai = asn1str_to_u16(&ies->sai.sAC);
|
|
sai = &_sai;
|
|
}
|
|
}
|
|
|
|
cur = msgb_put(msg, ies->nas_pdu.size);
|
|
memcpy(msg, ies->nas_pdu.buf, ies->nas_pdu.size);
|
|
/* FIXME: set msgb_gmmh() */
|
|
|
|
/* FIXME: Feed into the MM/CC/SMS-CP layer */
|
|
//rc = gsm0408_gprs_rcvmsg_iu(msg, ra_id, sai, conn_id);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ranap_handle_co_err_ind(void *ctx, RANAP_ErrorIndicationIEs_t *ies)
|
|
{
|
|
if (ies->presenceMask & ERRORINDICATIONIES_RANAP_CAUSE_PRESENT)
|
|
LOGP(DRANAP, LOGL_ERROR, "Rx Error Indication (%s)\n",
|
|
ranap_cause_str(&ies->cause));
|
|
else
|
|
LOGP(DRANAP, LOGL_ERROR, "Rx Error Indication\n");
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ranap_handle_co_iu_rel_req(struct ue_conn_ctx *ctx, RANAP_Iu_ReleaseRequestIEs_t *ies)
|
|
{
|
|
struct msgb *msg;
|
|
struct osmo_scu_prim *prim;
|
|
|
|
LOGP(DRANAP, LOGL_INFO, "Received Iu Release Request, Sending Release Command\n");
|
|
msg = ranap_new_msg_iu_rel_cmd(&ies->cause);
|
|
msg->l2h = msg->data;
|
|
prim = (struct osmo_scu_prim *) msgb_push(msg, sizeof(*prim));
|
|
prim->u.data.conn_id = ctx->conn_id;
|
|
osmo_prim_init(&prim->oph, SCCP_SAP_USER,
|
|
OSMO_SCU_PRIM_N_DATA,
|
|
PRIM_OP_REQUEST, msg);
|
|
osmo_sua_user_link_down(ctx->link, &prim->oph);
|
|
return 0;
|
|
}
|
|
|
|
/* Entry point for connection-oriented ANAP message */
|
|
static void cn_ranap_handle_co(void *ctx, ranap_message *message)
|
|
{
|
|
int rc = 0;
|
|
|
|
switch (message->direction) {
|
|
case RANAP_RANAP_PDU_PR_initiatingMessage:
|
|
switch (message->procedureCode) {
|
|
case RANAP_ProcedureCode_id_InitialUE_Message:
|
|
rc = ranap_handle_co_initial_ue(ctx, &message->msg.initialUE_MessageIEs);
|
|
break;
|
|
case RANAP_ProcedureCode_id_DirectTransfer:
|
|
rc = ranap_handle_co_dt(ctx, &message->msg.directTransferIEs);
|
|
break;
|
|
case RANAP_ProcedureCode_id_ErrorIndication:
|
|
rc = ranap_handle_co_err_ind(ctx, &message->msg.errorIndicationIEs);
|
|
break;
|
|
case RANAP_ProcedureCode_id_Iu_ReleaseRequest:
|
|
/* Iu Release Request */
|
|
rc = ranap_handle_co_iu_rel_req(ctx, &message->msg.iu_ReleaseRequestIEs);
|
|
break;
|
|
}
|
|
break;
|
|
case RANAP_RANAP_PDU_PR_successfulOutcome:
|
|
switch (message->procedureCode) {
|
|
case RANAP_ProcedureCode_id_RAB_Assignment:
|
|
/* RAB Assignment Response */
|
|
break;
|
|
case RANAP_ProcedureCode_id_SecurityModeControl:
|
|
/* Security Mode Complete */
|
|
break;
|
|
case RANAP_ProcedureCode_id_Iu_Release:
|
|
/* Iu Release Complete */
|
|
break;
|
|
}
|
|
case RANAP_RANAP_PDU_PR_unsuccessfulOutcome:
|
|
case RANAP_RANAP_PDU_PR_outcome:
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
|
|
static int ranap_handle_cl_reset_req(void *ctx, RANAP_ResetIEs_t *ies)
|
|
{
|
|
/* FIXME: send reset response */
|
|
|
|
LOGP(DRANAP, LOGL_ERROR, "Rx Reset Request\n");
|
|
}
|
|
|
|
static int ranap_handle_cl_err_ind(void *ctx, RANAP_ErrorIndicationIEs_t *ies)
|
|
{
|
|
if (ies->presenceMask & ERRORINDICATIONIES_RANAP_CAUSE_PRESENT)
|
|
LOGP(DRANAP, LOGL_ERROR, "Rx Error Indication (%s)\n",
|
|
ranap_cause_str(&ies->cause));
|
|
else
|
|
LOGP(DRANAP, LOGL_ERROR, "Rx Error Indication\n");
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* Entry point for connection-less RANAP message */
|
|
static void cn_ranap_handle_cl(void *ctx, ranap_message *message)
|
|
{
|
|
int rc = 0;
|
|
|
|
switch (message->direction) {
|
|
case RANAP_RANAP_PDU_PR_initiatingMessage:
|
|
switch (message->procedureCode) {
|
|
case RANAP_ProcedureCode_id_Reset:
|
|
/* received reset.req, send reset.resp */
|
|
rc = ranap_handle_cl_reset_req(ctx, &message->msg.resetIEs);
|
|
break;
|
|
case RANAP_ProcedureCode_id_ErrorIndication:
|
|
rc = ranap_handle_cl_err_ind(ctx, &message->msg.errorIndicationIEs);
|
|
break;
|
|
}
|
|
break;
|
|
case RANAP_RANAP_PDU_PR_successfulOutcome:
|
|
case RANAP_RANAP_PDU_PR_unsuccessfulOutcome:
|
|
case RANAP_RANAP_PDU_PR_outcome:
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
|
|
/***********************************************************************
|
|
*
|
|
***********************************************************************/
|
|
|
|
int tx_unitdata(struct osmo_sccp_link *link);
|
|
int tx_conn_req(struct osmo_sccp_link *link, uint32_t conn_id);
|
|
|
|
struct osmo_prim_hdr *make_conn_req(uint32_t conn_id);
|
|
struct osmo_prim_hdr *make_dt1_req(uint32_t conn_id, const uint8_t *data, unsigned int len);
|
|
|
|
struct osmo_prim_hdr *make_conn_resp(struct osmo_scu_connect_param *param)
|
|
{
|
|
struct msgb *msg = msgb_alloc(1024, "conn_resp");
|
|
struct osmo_scu_prim *prim;
|
|
|
|
prim = (struct osmo_scu_prim *) msgb_put(msg, sizeof(*prim));
|
|
osmo_prim_init(&prim->oph, SCCP_SAP_USER,
|
|
OSMO_SCU_PRIM_N_CONNECT,
|
|
PRIM_OP_RESPONSE, msg);
|
|
memcpy(&prim->u.connect, param, sizeof(prim->u.connect));
|
|
return &prim->oph;
|
|
}
|
|
|
|
static int sccp_sap_up(struct osmo_prim_hdr *oph, void *link)
|
|
{
|
|
struct osmo_scu_prim *prim = (struct osmo_scu_prim *) oph;
|
|
struct osmo_prim_hdr *resp = NULL;
|
|
const uint8_t payload[] = { 0xb1, 0xb2, 0xb3 };
|
|
int rc;
|
|
struct ue_conn_ctx *ue;
|
|
|
|
printf("sccp_sap_up(%s)\n", osmo_scu_prim_name(oph));
|
|
|
|
switch (OSMO_PRIM_HDR(oph)) {
|
|
case OSMO_PRIM(OSMO_SCU_PRIM_N_CONNECT, PRIM_OP_CONFIRM):
|
|
/* confirmation of outbound connection */
|
|
break;
|
|
case OSMO_PRIM(OSMO_SCU_PRIM_N_CONNECT, PRIM_OP_INDICATION):
|
|
/* indication of new inbound connection request*/
|
|
printf("N-CONNECT.ind(X->%u)\n", prim->u.connect.conn_id);
|
|
if (/* prim->u.connect.called_addr.ssn != OSMO_SCCP_SSN_RANAP || */
|
|
!msgb_l2(oph->msg) || msgb_l2len(oph->msg) == 0) {
|
|
LOGP(DMAIN, LOGL_NOTICE, "Received invalid N-CONNECT.ind\n");
|
|
return 0;
|
|
}
|
|
/* FIXME: allocate UE context */
|
|
ue = ue_conn_ctx_alloc(link, prim->u.connect.conn_id);
|
|
/* first ensure the local SUA/SCCP socket is ACTIVE */
|
|
resp = make_conn_resp(&prim->u.connect);
|
|
osmo_sua_user_link_down(link, resp);
|
|
/* then handle the RANAP payload */
|
|
rc = ranap_cn_rx_co(cn_ranap_handle_co, ue, msgb_l2(oph->msg), msgb_l2len(oph->msg));
|
|
break;
|
|
case OSMO_PRIM(OSMO_SCU_PRIM_N_DISCONNECT, PRIM_OP_INDICATION):
|
|
/* indication of disconnect */
|
|
printf("N-DISCONNECT.ind(%u)\n", prim->u.disconnect.conn_id);
|
|
ue = ue_conn_ctx_find(link, prim->u.disconnect.conn_id);
|
|
rc = ranap_cn_rx_co(cn_ranap_handle_co, ue, msgb_l2(oph->msg), msgb_l2len(oph->msg));
|
|
break;
|
|
case OSMO_PRIM(OSMO_SCU_PRIM_N_DATA, PRIM_OP_INDICATION):
|
|
/* connection-oriented data received */
|
|
printf("N-DATA.ind(%u, %s)\n", prim->u.data.conn_id,
|
|
osmo_hexdump(msgb_l2(oph->msg), msgb_l2len(oph->msg)));
|
|
/* resolve UE context */
|
|
ue = ue_conn_ctx_find(link, prim->u.data.conn_id);
|
|
rc = ranap_cn_rx_co(cn_ranap_handle_co, ue, msgb_l2(oph->msg), msgb_l2len(oph->msg));
|
|
break;
|
|
case OSMO_PRIM(OSMO_SCU_PRIM_N_UNITDATA, PRIM_OP_INDICATION):
|
|
/* connection-oriented data received */
|
|
printf("N-UNITDATA.ind(%s)\n",
|
|
osmo_hexdump(msgb_l2(oph->msg), msgb_l2len(oph->msg)));
|
|
rc = ranap_cn_rx_cl(cn_ranap_handle_cl, link, msgb_l2(oph->msg), msgb_l2len(oph->msg));
|
|
break;
|
|
}
|
|
|
|
msgb_free(oph->msg);
|
|
return 0;
|
|
}
|
|
|
|
static void print_usage()
|
|
{
|
|
printf("Usage: dummy-cn\n");
|
|
}
|
|
|
|
static void print_help()
|
|
{
|
|
printf(" -h --help This text.\n");
|
|
printf(" -b --bind addr Bind to local IP address (default 127.0.0.1)\n");
|
|
}
|
|
|
|
static void handle_options(int argc, char **argv)
|
|
{
|
|
while (1) {
|
|
int option_index = 0, c;
|
|
static struct option long_options[] = {
|
|
{"help", 0, 0, 'h'},
|
|
{"bind", 1, 0, 'b'},
|
|
{0, 0, 0, 0}
|
|
};
|
|
|
|
c = getopt_long(argc, argv, "hb:V",
|
|
long_options, &option_index);
|
|
if (c == -1)
|
|
break;
|
|
|
|
switch (c) {
|
|
case 'h':
|
|
print_usage();
|
|
print_help();
|
|
exit(0);
|
|
case 'b':
|
|
cmdline_bind_addr = optarg;
|
|
break;
|
|
default:
|
|
printf("Unknown cmdline argument (-h shows help)\n");
|
|
exit(1);
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
int main(int argc, char **argv)
|
|
{
|
|
struct osmo_sccp_user *user;
|
|
void *ctx = talloc_named_const(NULL, 1, "root");
|
|
int rc;
|
|
int port = 14001;
|
|
|
|
osmo_sua_set_log_area(DSUA);
|
|
ranap_set_log_area(DRANAP);
|
|
|
|
test_common_init();
|
|
|
|
handle_options(argc, argv);
|
|
|
|
user = osmo_sua_user_create(ctx, sccp_sap_up, ctx);
|
|
|
|
rc = osmo_sua_server_listen(user, cmdline_bind_addr, port);
|
|
if (rc < 0) {
|
|
exit(1);
|
|
}
|
|
|
|
printf("dummy-cn listening on %s %d\n", cmdline_bind_addr, port);
|
|
|
|
while (1) {
|
|
osmo_select_main(0);
|
|
}
|
|
}
|