410 lines
11 KiB
C
410 lines
11 KiB
C
#define TRACE_MODULE _gtp_xact
|
|
#include "core_debug.h"
|
|
#include "core_pool.h"
|
|
#include "core_event.h"
|
|
|
|
#include "gtp_xact.h"
|
|
|
|
#define SIZE_OF_GTP_XACT_POOL 32
|
|
|
|
#define GTP_XACT_NEXT_ID(__id) \
|
|
((__id) == 0x800000 ? 1 : ((__id) + 1))
|
|
#define GTP_XACT_COMPARE_ID(__id1, __id2) \
|
|
((__id2) > (__id1) ? ((__id2) - (__id1) < 0x7fffff ? -1 : 1) : \
|
|
(__id1) > (__id2) ? ((__id1) - (__id2) < 0x7fffff ? 1 : -1) : 0)
|
|
|
|
#define GTP_XACT_LOCAL_DURATION 3000 /* 3 seconds */
|
|
#define GTP_XACT_LOCAL_RETRY_COUNT 3
|
|
#define GTP_XACT_REMOTE_DURATION \
|
|
(GTP_XACT_LOCAL_DURATION * GTP_XACT_LOCAL_RETRY_COUNT) /* 9 seconds */
|
|
#define GTP_XACT_REMOTE_RETRY_COUNT 1
|
|
|
|
/* 5.1 General format */
|
|
#define GTPV2C_HEADER_LEN 12
|
|
#define GTPV2C_TEID_LEN 4
|
|
|
|
typedef struct _gtpv2c_header_t {
|
|
ED4(c_uint8_t version:3;,
|
|
c_uint8_t piggybacked:1;,
|
|
c_uint8_t teid_presence:1;,
|
|
c_uint8_t spare1:3;)
|
|
c_uint8_t type;
|
|
c_uint16_t length;
|
|
union {
|
|
struct {
|
|
c_uint32_t teid;
|
|
/* sqn : 31bit ~ 8bit, spare : 7bit ~ 0bit */
|
|
#define GTP_XID_TO_SQN(__xid) ((__xid) << 8)
|
|
#define GTP_SQN_TO_XID(__sqn) ((__sqn) >> 8)
|
|
c_uint32_t sqn;
|
|
};
|
|
/* sqn : 31bit ~ 8bit, spare : 7bit ~ 0bit */
|
|
c_uint32_t spare2;
|
|
};
|
|
} __attribute__ ((packed)) gtpv2c_header_t;
|
|
|
|
|
|
static int gtp_xact_pool_initialized = 0;
|
|
pool_declare(gtp_xact_pool, gtp_xact_t, SIZE_OF_GTP_XACT_POOL);
|
|
|
|
status_t gtp_xact_init(gtp_xact_ctx_t *context,
|
|
tm_service_t *tm_service, c_uintptr_t event)
|
|
{
|
|
if (gtp_xact_pool_initialized == 0)
|
|
{
|
|
pool_init(>p_xact_pool, SIZE_OF_GTP_XACT_POOL);
|
|
}
|
|
gtp_xact_pool_initialized = 1;
|
|
|
|
memset(context, 0, sizeof(gtp_xact_ctx_t));
|
|
|
|
context->g_xact_id = 0;
|
|
|
|
context->tm_service = tm_service;
|
|
context->event = event;;
|
|
|
|
return CORE_OK;
|
|
}
|
|
|
|
status_t gtp_xact_final(void)
|
|
{
|
|
if (gtp_xact_pool_initialized == 1)
|
|
{
|
|
d_print("%d not freed in gtp_xact_pool[%d] of S11/S5-SM\n",
|
|
pool_size(>p_xact_pool) - pool_avail(>p_xact_pool),
|
|
pool_size(>p_xact_pool));
|
|
pool_final(>p_xact_pool);
|
|
}
|
|
gtp_xact_pool_initialized = 0;
|
|
|
|
return CORE_OK;
|
|
}
|
|
|
|
gtp_xact_t *gtp_xact_create(gtp_xact_ctx_t *context,
|
|
net_sock_t *sock, gtp_node_t *gnode, c_uint8_t org, c_uint32_t xid,
|
|
c_uint32_t duration, c_uint8_t retry_count)
|
|
{
|
|
gtp_xact_t *xact = NULL;
|
|
|
|
d_assert(context, return NULL, "Null param");
|
|
d_assert(sock, return NULL, "Null param");
|
|
d_assert(gnode, return NULL, "Null param");
|
|
|
|
pool_alloc_node(>p_xact_pool, &xact);
|
|
d_assert(xact, return NULL, "Transaction allocation failed");
|
|
|
|
memset(xact, 0, sizeof(gtp_xact_t));
|
|
|
|
xact->org = org;
|
|
xact->xid = xid;
|
|
xact->sock = sock;
|
|
xact->gnode = gnode;
|
|
|
|
xact->tm_wait = event_timer(context->tm_service, context->event,
|
|
duration, (c_uintptr_t)xact);
|
|
d_assert(xact->tm_wait,
|
|
pool_free_node(>p_xact_pool, xact); return NULL,
|
|
"Timer allocation failed");
|
|
xact->retry_count = retry_count;
|
|
tm_start(xact->tm_wait);
|
|
|
|
list_append(xact->org == GTP_LOCAL_ORIGINATOR ?
|
|
xact->gnode->local_list : xact->gnode->remote_list, xact);
|
|
|
|
d_trace(1, "[%d]%s Create : xid = 0x%x\n",
|
|
gnode->port,
|
|
xact->org == GTP_LOCAL_ORIGINATOR ? "LOCAL " : "REMOTE",
|
|
xact->xid);
|
|
|
|
return xact;
|
|
}
|
|
|
|
gtp_xact_t *gtp_xact_local_create(gtp_xact_ctx_t *context,
|
|
net_sock_t *sock, gtp_node_t *gnode)
|
|
{
|
|
return gtp_xact_create(context, sock, gnode, GTP_LOCAL_ORIGINATOR,
|
|
GTP_XACT_NEXT_ID(context->g_xact_id),
|
|
GTP_XACT_LOCAL_DURATION, GTP_XACT_LOCAL_RETRY_COUNT);
|
|
}
|
|
|
|
gtp_xact_t *gtp_xact_remote_create(gtp_xact_ctx_t *context,
|
|
net_sock_t *sock, gtp_node_t *gnode, c_uint32_t xid)
|
|
{
|
|
return gtp_xact_create(context, sock, gnode,
|
|
GTP_REMOTE_ORIGINATOR, xid,
|
|
GTP_XACT_REMOTE_DURATION, GTP_XACT_REMOTE_RETRY_COUNT);
|
|
}
|
|
|
|
status_t gtp_xact_delete(gtp_xact_t *xact)
|
|
{
|
|
d_assert(xact, , "Null param");
|
|
d_assert(xact->gnode, , "Null param");
|
|
d_assert(xact->tm_wait, , "Null param");
|
|
|
|
d_trace(1, "[%d]%s Delete : xid = 0x%x\n",
|
|
xact->gnode->port,
|
|
xact->org == GTP_LOCAL_ORIGINATOR ? "LOCAL " : "REMOTE",
|
|
xact->xid);
|
|
|
|
if (xact->pkbuf)
|
|
pkbuf_free(xact->pkbuf);
|
|
|
|
tm_delete(xact->tm_wait);
|
|
|
|
list_remove(xact->org == GTP_LOCAL_ORIGINATOR ? xact->gnode->local_list :
|
|
xact->gnode->remote_list, xact);
|
|
pool_free_node(>p_xact_pool, xact);
|
|
|
|
return CORE_OK;
|
|
}
|
|
|
|
status_t gtp_xact_associate(gtp_xact_t *xact1, gtp_xact_t *xact2)
|
|
{
|
|
d_assert(xact1, return CORE_ERROR, "Null param");
|
|
d_assert(xact2, return CORE_ERROR, "Null param");
|
|
|
|
d_assert(xact1->assoc_xact == NULL,
|
|
return CORE_ERROR, "Already assocaited");
|
|
d_assert(xact2->assoc_xact == NULL,
|
|
return CORE_ERROR, "Already assocaited");
|
|
|
|
xact1->assoc_xact = xact2;
|
|
xact2->assoc_xact = xact1;
|
|
|
|
return CORE_OK;
|
|
}
|
|
|
|
status_t gtp_xact_deassociate(gtp_xact_t *xact1, gtp_xact_t *xact2)
|
|
{
|
|
d_assert(xact1, return CORE_ERROR, "Null param");
|
|
d_assert(xact2, return CORE_ERROR, "Null param");
|
|
|
|
d_assert(xact1->assoc_xact != NULL,
|
|
return CORE_ERROR, "Already deassocaited");
|
|
d_assert(xact2->assoc_xact != NULL,
|
|
return CORE_ERROR, "Already deassocaited");
|
|
|
|
xact1->assoc_xact = NULL;
|
|
xact2->assoc_xact = NULL;
|
|
|
|
return CORE_OK;
|
|
}
|
|
|
|
status_t gtp_xact_commit(gtp_xact_t *xact, pkbuf_t *pkbuf)
|
|
{
|
|
xact->pkbuf = pkbuf;
|
|
|
|
d_assert(xact, goto out, "Null param");
|
|
d_assert(xact->sock, goto out, "Null param");
|
|
d_assert(xact->gnode, goto out, "Null param");
|
|
d_assert(xact->pkbuf, goto out, "Null param");
|
|
|
|
d_trace(1, "[%d]%s Commit : xid = 0x%x\n",
|
|
xact->gnode->port,
|
|
xact->org == GTP_LOCAL_ORIGINATOR ? "LOCAL " : "REMOTE",
|
|
xact->xid);
|
|
|
|
d_assert(gtp_send(xact->sock, xact->gnode, xact->pkbuf) == CORE_OK,
|
|
goto out, "gtp_send error");
|
|
|
|
return CORE_OK;
|
|
|
|
out:
|
|
pkbuf_free(pkbuf);
|
|
return CORE_ERROR;
|
|
}
|
|
|
|
status_t gtp_xact_timeout(gtp_xact_t *xact)
|
|
{
|
|
d_assert(xact, goto out, "Null param");
|
|
d_assert(xact->sock, goto out, "Null param");
|
|
d_assert(xact->gnode, goto out, "Null param");
|
|
|
|
d_trace(1, "[%d]%s Timeout : xid = 0x%x\n",
|
|
xact->gnode->port,
|
|
xact->org == GTP_LOCAL_ORIGINATOR ? "LOCAL " : "REMOTE",
|
|
xact->xid);
|
|
|
|
if (xact->org == GTP_REMOTE_ORIGINATOR)
|
|
{
|
|
gtp_xact_delete(xact);
|
|
}
|
|
else
|
|
{
|
|
if (--xact->retry_count > 0)
|
|
{
|
|
tm_start(xact->tm_wait);
|
|
|
|
d_assert(xact->pkbuf, goto out, "Null param");
|
|
d_assert(gtp_send(xact->sock, xact->gnode, xact->pkbuf) == CORE_OK,
|
|
goto out, "gtp_send error");
|
|
}
|
|
else
|
|
{
|
|
d_warn("[%d]%s No Reponse. Give up",
|
|
xact->gnode->port,
|
|
xact->org == GTP_LOCAL_ORIGINATOR ? "LOCAL " : "REMOTE");
|
|
gtp_xact_delete(xact);
|
|
}
|
|
}
|
|
|
|
return CORE_OK;
|
|
|
|
out:
|
|
gtp_xact_delete(xact);
|
|
return CORE_ERROR;
|
|
}
|
|
|
|
gtp_xact_t *gtp_xact_find(gtp_node_t *gnode, pkbuf_t *pkbuf)
|
|
{
|
|
gtpv2c_header_t *h = NULL;
|
|
c_uint32_t xid;
|
|
gtp_xact_t *xact = NULL;
|
|
|
|
d_assert(gnode, return NULL, "Null param");
|
|
d_assert(pkbuf, return NULL, "Null param");
|
|
d_assert(pkbuf->payload, return NULL, "Null param");
|
|
|
|
h = pkbuf->payload;
|
|
switch(h->type)
|
|
{
|
|
case GTP_CREATE_SESSION_REQUEST_TYPE:
|
|
case GTP_MODIFY_BEARER_REQUEST_TYPE:
|
|
case GTP_DELETE_SESSION_REQUEST_TYPE:
|
|
case GTP_CREATE_BEARER_REQUEST_TYPE:
|
|
case GTP_UPDATE_BEARER_REQUEST_TYPE:
|
|
case GTP_DELETE_BEARER_REQUEST_TYPE:
|
|
case GTP_RELEASE_ACCESS_BEARERS_REQUEST_TYPE:
|
|
case GTP_CREATE_INDIRECT_DATA_FORWARDING_TUNNEL_REQUEST_TYPE:
|
|
case GTP_DELETE_INDIRECT_DATA_FORWARDING_TUNNEL_REQUEST_TYPE:
|
|
xact = list_first(&gnode->initial_list);
|
|
break;
|
|
|
|
case GTP_CREATE_SESSION_RESPONSE_TYPE:
|
|
case GTP_MODIFY_BEARER_RESPONSE_TYPE:
|
|
case GTP_DELETE_SESSION_RESPONSE_TYPE:
|
|
case GTP_CREATE_BEARER_RESPONSE_TYPE:
|
|
case GTP_UPDATE_BEARER_RESPONSE_TYPE:
|
|
case GTP_DELETE_BEARER_RESPONSE_TYPE:
|
|
case GTP_RELEASE_ACCESS_BEARERS_RESPONSE_TYPE:
|
|
case GTP_CREATE_INDIRECT_DATA_FORWARDING_TUNNEL_RESPONSE_TYPE:
|
|
case GTP_DELETE_INDIRECT_DATA_FORWARDING_TUNNEL_RESPONSE_TYPE:
|
|
xact = list_first(&gnode->triggered_list);
|
|
break;
|
|
|
|
default:
|
|
d_error("Not implemented GTPv2 Message Type(%d)", h->type);
|
|
return NULL;
|
|
}
|
|
|
|
xid = GTP_SQN_TO_XID(h->sqn);
|
|
while(xact)
|
|
{
|
|
if (xact->xid == xid)
|
|
break;
|
|
xact = list_next(xact);
|
|
}
|
|
|
|
if (xact)
|
|
{
|
|
d_trace(1, "[%d]%s Find : xid = 0x%x\n",
|
|
gnode->port,
|
|
xact->org == GTP_LOCAL_ORIGINATOR ? "LOCAL " : "REMOTE",
|
|
xact->xid);
|
|
}
|
|
|
|
return xact;
|
|
}
|
|
|
|
gtp_xact_t *gtp_xact_recv(
|
|
gtp_xact_ctx_t *context, net_sock_t *sock, gtp_node_t *gnode,
|
|
gtp_message_t *gtp_message, pkbuf_t *pkbuf)
|
|
{
|
|
gtp_xact_t *xact = NULL;
|
|
gtpv2c_header_t *h = NULL;
|
|
|
|
d_assert(context, goto out, "Null param");
|
|
d_assert(sock, goto out, "Null param");
|
|
d_assert(gnode, goto out, "Null param");
|
|
d_assert(pkbuf, goto out, "Null param");
|
|
|
|
h = pkbuf->payload;
|
|
d_assert(h, goto out, "Null param");
|
|
|
|
xact = gtp_xact_find(gnode, pkbuf);
|
|
if (!xact)
|
|
{
|
|
xact = gtp_xact_remote_create(context, sock, gnode,
|
|
GTP_SQN_TO_XID(h->sqn));
|
|
}
|
|
|
|
if (h->teid_presence)
|
|
pkbuf_header(pkbuf, -GTPV2C_HEADER_LEN);
|
|
else
|
|
pkbuf_header(pkbuf, -(GTPV2C_HEADER_LEN-GTPV2C_TEID_LEN));
|
|
|
|
d_assert(gtp_parse_msg(gtp_message, h->type, pkbuf) == CORE_OK,
|
|
goto out, "parse error");
|
|
|
|
d_trace(1, "[%d]%s Receive : xid = 0x%x\n",
|
|
gnode->port,
|
|
xact->org == GTP_LOCAL_ORIGINATOR ? "LOCAL " : "REMOTE",
|
|
xact->xid);
|
|
|
|
return xact;
|
|
|
|
out:
|
|
pkbuf_free(pkbuf);
|
|
return NULL;
|
|
}
|
|
|
|
gtp_xact_t *gtp_xact_associated_send(gtp_xact_ctx_t *context,
|
|
net_sock_t *sock, gtp_node_t *gnode, c_uint8_t type, pkbuf_t *pkbuf,
|
|
gtp_xact_t *associated_xact)
|
|
{
|
|
status_t rv;
|
|
gtp_xact_t *xact = NULL;
|
|
gtpv2c_header_t *h = NULL;
|
|
|
|
d_assert(context, goto out, "Null param");
|
|
d_assert(sock, goto out, "Null param");
|
|
d_assert(gnode, goto out, "Null param");
|
|
d_assert(pkbuf, goto out, "Null param");
|
|
|
|
xact = gtp_xact_local_create(context, sock, gnode);
|
|
d_assert(xact, goto out, "Null param");
|
|
|
|
pkbuf_header(pkbuf, GTPV2C_HEADER_LEN);
|
|
h = pkbuf->payload;
|
|
d_assert(h, goto out, "Null param");
|
|
|
|
h->version = 2;
|
|
h->teid_presence = 1;
|
|
h->type = type;
|
|
h->length = htons(pkbuf->len - 4);
|
|
h->sqn = GTP_XID_TO_SQN(xact->xid);
|
|
|
|
if (associated_xact)
|
|
gtp_xact_associate(xact, associated_xact);
|
|
|
|
rv = gtp_xact_commit(xact, pkbuf);
|
|
d_assert(rv == CORE_OK, return NULL, "Null param");
|
|
|
|
d_trace(1, "[%d]%s Send : xid = 0x%x\n",
|
|
gnode->port,
|
|
xact->org == GTP_LOCAL_ORIGINATOR ? "LOCAL " : "REMOTE",
|
|
xact->xid);
|
|
|
|
return xact;
|
|
|
|
out:
|
|
pkbuf_free(pkbuf);
|
|
return NULL;
|
|
}
|
|
|
|
gtp_xact_t *gtp_xact_send(gtp_xact_ctx_t *context,
|
|
net_sock_t *sock, gtp_node_t *gnode, c_uint8_t type, pkbuf_t *pkbuf)
|
|
{
|
|
return gtp_xact_associated_send(context, sock, gnode, type, pkbuf, NULL);
|
|
}
|