forked from acouzens/open5gs
433 lines
13 KiB
C
433 lines
13 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 "mme-context.h"
|
|
|
|
#include "sgsap-build.h"
|
|
#include "sgsap-conv.h"
|
|
|
|
ogs_pkbuf_t *sgsap_build_location_update_request(mme_ue_t *mme_ue)
|
|
{
|
|
mme_csmap_t *csmap = NULL;
|
|
mme_vlr_t *vlr = NULL;
|
|
ogs_tlv_t *root = NULL;
|
|
ogs_pkbuf_t *pkbuf = NULL;
|
|
|
|
char mme_name[SGSAP_IE_MME_NAME_LEN+1];
|
|
int mme_name_len = 0;
|
|
served_gummei_t *served_gummei = &mme_self()->served_gummei[0];
|
|
char eps_update_type;
|
|
ogs_nas_lai_t lai;
|
|
|
|
ogs_assert(mme_ue);
|
|
csmap = mme_ue->csmap;
|
|
ogs_assert(csmap);
|
|
vlr = csmap->vlr;
|
|
ogs_assert(vlr);
|
|
|
|
root = ogs_tlv_add(NULL, OGS_TLV_MODE_T1_L1,
|
|
SGSAP_IE_IMSI_TYPE, SGSAP_IE_IMSI_LEN, 0,
|
|
&mme_ue->nas_mobile_identity_imsi);
|
|
|
|
mme_name_len = mme_name_build(mme_name,
|
|
served_gummei->mme_code[0],
|
|
served_gummei->mme_gid[0],
|
|
&served_gummei->plmn_id[0]);
|
|
ogs_tlv_add(root, OGS_TLV_MODE_T1_L1, SGSAP_IE_MME_NAME_TYPE,
|
|
mme_name_len, 0, mme_name);
|
|
eps_update_type = SGSAP_EPS_UPDATE_IMSI_ATTACH;
|
|
ogs_tlv_add(root, OGS_TLV_MODE_T1_L1, SGSAP_IE_EPS_UPDATE_TYPE,
|
|
SGSAP_IE_EPS_UPDATE_LEN, 0, &eps_update_type);
|
|
memcpy(&lai, &csmap->lai, sizeof(ogs_nas_lai_t));
|
|
lai.lac = htobe16(lai.lac);
|
|
ogs_tlv_add(root, OGS_TLV_MODE_T1_L1, SGSAP_IE_LAI_TYPE,
|
|
SGSAP_IE_LAI_LEN, 0, &lai);
|
|
|
|
pkbuf = ogs_pkbuf_alloc(NULL, OGS_MAX_SDU_LEN);
|
|
if (!pkbuf) {
|
|
ogs_error("ogs_pkbuf_alloc() failed");
|
|
ogs_tlv_free_all(root);
|
|
return NULL;
|
|
}
|
|
ogs_pkbuf_put_u8(pkbuf, SGSAP_LOCATION_UPDATE_REQUEST);
|
|
ogs_pkbuf_put(pkbuf, OGS_MAX_SDU_LEN-1);
|
|
|
|
ogs_pkbuf_trim(pkbuf, 1+ogs_tlv_render(root,
|
|
pkbuf->data+1, OGS_MAX_SDU_LEN-1));
|
|
|
|
ogs_tlv_free_all(root);
|
|
|
|
return pkbuf;
|
|
}
|
|
ogs_pkbuf_t *sgsap_build_tmsi_reallocation_complete(mme_ue_t *mme_ue)
|
|
{
|
|
mme_csmap_t *csmap = NULL;
|
|
mme_vlr_t *vlr = NULL;
|
|
ogs_tlv_t *root = NULL;
|
|
ogs_pkbuf_t *pkbuf = NULL;
|
|
|
|
ogs_assert(mme_ue);
|
|
csmap = mme_ue->csmap;
|
|
ogs_assert(csmap);
|
|
vlr = csmap->vlr;
|
|
ogs_assert(vlr);
|
|
|
|
root = ogs_tlv_add(NULL, OGS_TLV_MODE_T1_L1, SGSAP_IE_IMSI_TYPE,
|
|
SGSAP_IE_IMSI_LEN, 0, &mme_ue->nas_mobile_identity_imsi);
|
|
|
|
pkbuf = ogs_pkbuf_alloc(NULL, OGS_MAX_SDU_LEN);
|
|
if (!pkbuf) {
|
|
ogs_error("ogs_pkbuf_alloc() failed");
|
|
ogs_tlv_free_all(root);
|
|
return NULL;
|
|
}
|
|
ogs_pkbuf_put_u8(pkbuf, SGSAP_TMSI_REALLOCATION_COMPLETE);
|
|
ogs_pkbuf_put(pkbuf, OGS_MAX_SDU_LEN-1);
|
|
|
|
ogs_pkbuf_trim(pkbuf, 1+ogs_tlv_render(root,
|
|
pkbuf->data+1, OGS_MAX_SDU_LEN-1));
|
|
|
|
ogs_tlv_free_all(root);
|
|
|
|
return pkbuf;
|
|
}
|
|
|
|
ogs_pkbuf_t *sgsap_build_detach_indication(mme_ue_t *mme_ue)
|
|
{
|
|
mme_csmap_t *csmap = NULL;
|
|
mme_vlr_t *vlr = NULL;
|
|
ogs_tlv_t *root = NULL;
|
|
ogs_pkbuf_t *pkbuf = NULL;
|
|
|
|
char mme_name[SGSAP_IE_MME_NAME_LEN+1];
|
|
int mme_name_len = 0;
|
|
served_gummei_t *served_gummei = &mme_self()->served_gummei[0];
|
|
uint8_t type = SGSAP_EPS_DETACH_INDICATION;
|
|
uint8_t indication = SGSAP_EPS_DETACH_UE_INITIATED;
|
|
|
|
ogs_assert(mme_ue);
|
|
csmap = mme_ue->csmap;
|
|
ogs_assert(csmap);
|
|
vlr = csmap->vlr;
|
|
ogs_assert(vlr);
|
|
|
|
switch (mme_ue->nas_eps.detach.value) {
|
|
/* 0 0 1 : EPS detach */
|
|
case OGS_NAS_DETACH_TYPE_FROM_UE_EPS_DETACH:
|
|
type = SGSAP_EPS_DETACH_INDICATION;
|
|
indication = SGSAP_EPS_DETACH_UE_INITIATED;
|
|
break;
|
|
/* 0 1 0 : IMSI detach */
|
|
case OGS_NAS_DETACH_TYPE_FROM_UE_IMSI_DETACH:
|
|
type = SGSAP_IMSI_DETACH_INDICATION;
|
|
indication = SGSAP_IMSI_DETACH_EXPLICIT_UE_INITIATED;
|
|
break;
|
|
case 6: /* 1 1 0 : reserved */
|
|
case 7: /* 1 1 1 : reserved */
|
|
ogs_warn("Unknown Detach type[%d]", mme_ue->nas_eps.detach.value);
|
|
break;
|
|
/* 0 1 1 : combined EPS/IMSI detach */
|
|
case OGS_NAS_DETACH_TYPE_FROM_UE_COMBINED_EPS_IMSI_DETACH:
|
|
type = SGSAP_IMSI_DETACH_INDICATION;
|
|
indication = SGSAP_IMSI_DETACH_COMBINED_UE_INITIATED;
|
|
default: /* all other values */
|
|
break;
|
|
}
|
|
|
|
root = ogs_tlv_add(NULL, OGS_TLV_MODE_T1_L1, SGSAP_IE_IMSI_TYPE,
|
|
SGSAP_IE_IMSI_LEN, 0, &mme_ue->nas_mobile_identity_imsi);
|
|
|
|
mme_name_len = mme_name_build(mme_name,
|
|
served_gummei->mme_code[0],
|
|
served_gummei->mme_gid[0],
|
|
&served_gummei->plmn_id[0]);
|
|
ogs_tlv_add(root, OGS_TLV_MODE_T1_L1, SGSAP_IE_MME_NAME_TYPE,
|
|
mme_name_len, 0, mme_name);
|
|
if (type == SGSAP_EPS_DETACH_INDICATION) {
|
|
ogs_debug("[SGSAP] EPS-DETACH-INDICATION");
|
|
ogs_tlv_add(root, OGS_TLV_MODE_T1_L1,
|
|
SGSAP_IE_EPS_DETACH_INDICATION_TYPE,
|
|
SGSAP_IE_EPS_DETACH_INDICATION_LEN, 0, &indication);
|
|
} else if (type == SGSAP_IMSI_DETACH_INDICATION) {
|
|
ogs_debug("[SGSAP] IMSI-DETACH-INDICATION");
|
|
ogs_tlv_add(root, OGS_TLV_MODE_T1_L1,
|
|
SGSAP_IE_IMSI_DETACH_INDICATION_TYPE,
|
|
SGSAP_IE_IMSI_DETACH_INDICATION_LEN, 0, &indication);
|
|
} else
|
|
ogs_assert_if_reached();
|
|
|
|
ogs_debug(" IMSI[%s]", mme_ue->imsi_bcd);
|
|
ogs_debug(" INDICATION[%d]", indication);
|
|
|
|
pkbuf = ogs_pkbuf_alloc(NULL, OGS_MAX_SDU_LEN);
|
|
if (!pkbuf) {
|
|
ogs_error("ogs_pkbuf_alloc() failed");
|
|
ogs_tlv_free_all(root);
|
|
return NULL;
|
|
}
|
|
ogs_pkbuf_put_u8(pkbuf, type);
|
|
ogs_pkbuf_put(pkbuf, OGS_MAX_SDU_LEN-1);
|
|
|
|
ogs_pkbuf_trim(pkbuf, 1+ogs_tlv_render(root,
|
|
pkbuf->data+1, OGS_MAX_SDU_LEN-1));
|
|
|
|
ogs_tlv_free_all(root);
|
|
|
|
return pkbuf;
|
|
}
|
|
|
|
ogs_pkbuf_t *sgsap_build_mo_csfb_indication(mme_ue_t *mme_ue)
|
|
{
|
|
mme_csmap_t *csmap = NULL;
|
|
mme_vlr_t *vlr = NULL;
|
|
ogs_tlv_t *root = NULL;
|
|
ogs_pkbuf_t *pkbuf = NULL;
|
|
|
|
ogs_gtp2_uli_tai_t tai;
|
|
ogs_gtp2_uli_e_cgi_t e_cgi;
|
|
|
|
ogs_assert(mme_ue);
|
|
csmap = mme_ue->csmap;
|
|
ogs_assert(csmap);
|
|
vlr = csmap->vlr;
|
|
ogs_assert(vlr);
|
|
|
|
root = ogs_tlv_add(NULL, OGS_TLV_MODE_T1_L1, SGSAP_IE_IMSI_TYPE,
|
|
SGSAP_IE_IMSI_LEN, 0, &mme_ue->nas_mobile_identity_imsi);
|
|
|
|
memset(&tai, 0, sizeof(tai));
|
|
ogs_nas_from_plmn_id(&tai.nas_plmn_id, &mme_ue->tai.plmn_id);
|
|
tai.tac = htobe16(mme_ue->tai.tac);
|
|
|
|
ogs_tlv_add(root, OGS_TLV_MODE_T1_L1,
|
|
SGSAP_IE_TAI_TYPE, SGSAP_IE_TAI_LEN, 0, &tai);
|
|
|
|
memset(&e_cgi, 0, sizeof(e_cgi));
|
|
ogs_nas_from_plmn_id(&e_cgi.nas_plmn_id, &mme_ue->e_cgi.plmn_id);
|
|
e_cgi.cell_id = htobe32(mme_ue->e_cgi.cell_id);
|
|
|
|
ogs_tlv_add(root, OGS_TLV_MODE_T1_L1,
|
|
SGSAP_IE_E_CGI_TYPE, SGSAP_IE_E_CGI_LEN, 0, &e_cgi);
|
|
|
|
pkbuf = ogs_pkbuf_alloc(NULL, OGS_MAX_SDU_LEN);
|
|
if (!pkbuf) {
|
|
ogs_error("ogs_pkbuf_alloc() failed");
|
|
ogs_tlv_free_all(root);
|
|
return NULL;
|
|
}
|
|
ogs_pkbuf_put_u8(pkbuf, SGSAP_MO_CSFB_INDICIATION);
|
|
ogs_pkbuf_put(pkbuf, OGS_MAX_SDU_LEN-1);
|
|
|
|
ogs_pkbuf_trim(pkbuf, 1+ogs_tlv_render(root,
|
|
pkbuf->data+1, OGS_MAX_SDU_LEN-1));
|
|
|
|
ogs_tlv_free_all(root);
|
|
|
|
return pkbuf;
|
|
}
|
|
|
|
ogs_pkbuf_t *sgsap_build_paging_reject(
|
|
ogs_nas_mobile_identity_imsi_t *nas_mobile_identity_imsi,
|
|
int nas_mobile_identity_imsi_len, uint8_t sgs_cause)
|
|
{
|
|
ogs_tlv_t *root = NULL;
|
|
ogs_pkbuf_t *pkbuf = NULL;
|
|
|
|
ogs_assert(nas_mobile_identity_imsi);
|
|
ogs_assert(nas_mobile_identity_imsi_len == SGSAP_IE_IMSI_LEN);
|
|
|
|
root = ogs_tlv_add(NULL, OGS_TLV_MODE_T1_L1,
|
|
SGSAP_IE_IMSI_TYPE, SGSAP_IE_IMSI_LEN, 0, nas_mobile_identity_imsi);
|
|
ogs_tlv_add(root, OGS_TLV_MODE_T1_L1,
|
|
SGSAP_IE_SGS_CAUSE_TYPE, SGSAP_IE_SGS_CAUSE_LEN, 0, &sgs_cause);
|
|
|
|
ogs_debug(" CAUSE[%d]", sgs_cause);
|
|
|
|
pkbuf = ogs_pkbuf_alloc(NULL, OGS_MAX_SDU_LEN);
|
|
if (!pkbuf) {
|
|
ogs_error("ogs_pkbuf_alloc() failed");
|
|
ogs_tlv_free_all(root);
|
|
return NULL;
|
|
}
|
|
ogs_pkbuf_put_u8(pkbuf, SGSAP_PAGING_REJECT);
|
|
ogs_pkbuf_put(pkbuf, OGS_MAX_SDU_LEN-1);
|
|
|
|
ogs_pkbuf_trim(pkbuf, 1+ogs_tlv_render(root,
|
|
pkbuf->data+1, OGS_MAX_SDU_LEN-1));
|
|
|
|
ogs_tlv_free_all(root);
|
|
|
|
return pkbuf;
|
|
}
|
|
|
|
ogs_pkbuf_t *sgsap_build_service_request(mme_ue_t *mme_ue, uint8_t emm_mode)
|
|
{
|
|
mme_csmap_t *csmap = NULL;
|
|
mme_vlr_t *vlr = NULL;
|
|
ogs_tlv_t *root = NULL;
|
|
ogs_pkbuf_t *pkbuf = NULL;
|
|
|
|
ogs_assert(mme_ue);
|
|
csmap = mme_ue->csmap;
|
|
ogs_assert(csmap);
|
|
vlr = csmap->vlr;
|
|
ogs_assert(vlr);
|
|
|
|
root = ogs_tlv_add(NULL, OGS_TLV_MODE_T1_L1,
|
|
SGSAP_IE_IMSI_TYPE, SGSAP_IE_IMSI_LEN, 0,
|
|
&mme_ue->nas_mobile_identity_imsi);
|
|
|
|
ogs_tlv_add(root, OGS_TLV_MODE_T1_L1,
|
|
SGSAP_IE_SERVICE_INDICATOR_TYPE,
|
|
SGSAP_IE_SERVICE_INDICATOR_LEN, 0, &mme_ue->service_indicator);
|
|
|
|
ogs_tlv_add(root,
|
|
OGS_TLV_MODE_T1_L1,
|
|
SGSAP_IE_UE_EMM_MODE_TYPE,
|
|
SGSAP_IE_UE_EMM_MODE_LEN, 0, &emm_mode);
|
|
|
|
pkbuf = ogs_pkbuf_alloc(NULL, OGS_MAX_SDU_LEN);
|
|
if (!pkbuf) {
|
|
ogs_error("ogs_pkbuf_alloc() failed");
|
|
ogs_tlv_free_all(root);
|
|
return NULL;
|
|
}
|
|
ogs_pkbuf_put_u8(pkbuf, SGSAP_SERVICE_REQUEST);
|
|
ogs_pkbuf_put(pkbuf, OGS_MAX_SDU_LEN-1);
|
|
|
|
ogs_pkbuf_trim(pkbuf, 1+ogs_tlv_render(root,
|
|
pkbuf->data+1, OGS_MAX_SDU_LEN-1));
|
|
|
|
ogs_tlv_free_all(root);
|
|
|
|
return pkbuf;
|
|
}
|
|
|
|
ogs_pkbuf_t *sgsap_build_reset_ack(mme_vlr_t *vlr)
|
|
{
|
|
ogs_tlv_t *root = NULL;
|
|
ogs_pkbuf_t *pkbuf = NULL;
|
|
|
|
char mme_name[SGSAP_IE_MME_NAME_LEN+1];
|
|
int mme_name_len = 0;
|
|
served_gummei_t *served_gummei = &mme_self()->served_gummei[0];
|
|
|
|
ogs_assert(vlr);
|
|
|
|
mme_name_len = mme_name_build(mme_name,
|
|
served_gummei->mme_code[0],
|
|
served_gummei->mme_gid[0],
|
|
&served_gummei->plmn_id[0]);
|
|
root = ogs_tlv_add(NULL, OGS_TLV_MODE_T1_L1, SGSAP_IE_MME_NAME_TYPE,
|
|
mme_name_len, 0, mme_name);
|
|
|
|
pkbuf = ogs_pkbuf_alloc(NULL, OGS_MAX_SDU_LEN);
|
|
if (!pkbuf) {
|
|
ogs_error("ogs_pkbuf_alloc() failed");
|
|
ogs_tlv_free_all(root);
|
|
return NULL;
|
|
}
|
|
ogs_pkbuf_put_u8(pkbuf, SGSAP_RESET_ACK);
|
|
ogs_pkbuf_put(pkbuf, OGS_MAX_SDU_LEN-1);
|
|
|
|
ogs_pkbuf_trim(pkbuf, 1+ogs_tlv_render(root,
|
|
pkbuf->data+1, OGS_MAX_SDU_LEN-1));
|
|
|
|
ogs_tlv_free_all(root);
|
|
|
|
return pkbuf;
|
|
}
|
|
|
|
ogs_pkbuf_t *sgsap_build_uplink_unidata(mme_ue_t *mme_ue,
|
|
ogs_nas_eps_message_container_t *nas_message_container)
|
|
{
|
|
mme_csmap_t *csmap = NULL;
|
|
mme_vlr_t *vlr = NULL;
|
|
ogs_tlv_t *root = NULL;
|
|
ogs_pkbuf_t *pkbuf = NULL;
|
|
|
|
ogs_assert(nas_message_container);
|
|
|
|
ogs_assert(mme_ue);
|
|
csmap = mme_ue->csmap;
|
|
ogs_assert(csmap);
|
|
vlr = csmap->vlr;
|
|
ogs_assert(vlr);
|
|
|
|
root = ogs_tlv_add(NULL, OGS_TLV_MODE_T1_L1, SGSAP_IE_IMSI_TYPE,
|
|
SGSAP_IE_IMSI_LEN, 0,
|
|
&mme_ue->nas_mobile_identity_imsi);
|
|
|
|
ogs_tlv_add(root, OGS_TLV_MODE_T1_L1, SGSAP_IE_NAS_MESSAGE_CONTAINER_TYPE,
|
|
nas_message_container->length, 0, nas_message_container->buffer);
|
|
|
|
pkbuf = ogs_pkbuf_alloc(NULL, OGS_MAX_SDU_LEN);
|
|
if (!pkbuf) {
|
|
ogs_error("ogs_pkbuf_alloc() failed");
|
|
ogs_tlv_free_all(root);
|
|
return NULL;
|
|
}
|
|
ogs_pkbuf_put_u8(pkbuf, SGSAP_UPLINK_UNITDATA);
|
|
ogs_pkbuf_put(pkbuf, OGS_MAX_SDU_LEN-1);
|
|
|
|
ogs_pkbuf_trim(pkbuf, 1+ogs_tlv_render(root,
|
|
pkbuf->data+1, OGS_MAX_SDU_LEN-1));
|
|
|
|
ogs_tlv_free_all(root);
|
|
|
|
return pkbuf;
|
|
}
|
|
|
|
ogs_pkbuf_t *sgsap_build_ue_unreachable(mme_ue_t *mme_ue, uint8_t sgs_cause)
|
|
{
|
|
mme_csmap_t *csmap = NULL;
|
|
mme_vlr_t *vlr = NULL;
|
|
ogs_tlv_t *root = NULL;
|
|
ogs_pkbuf_t *pkbuf = NULL;
|
|
|
|
ogs_assert(mme_ue);
|
|
csmap = mme_ue->csmap;
|
|
ogs_assert(csmap);
|
|
vlr = csmap->vlr;
|
|
ogs_assert(vlr);
|
|
|
|
root = ogs_tlv_add(NULL, OGS_TLV_MODE_T1_L1, SGSAP_IE_IMSI_TYPE,
|
|
SGSAP_IE_IMSI_LEN, 0,
|
|
&mme_ue->nas_mobile_identity_imsi);
|
|
|
|
ogs_tlv_add(root, OGS_TLV_MODE_T1_L1, SGSAP_IE_SGS_CAUSE_TYPE,
|
|
SGSAP_IE_SGS_CAUSE_LEN, 0, &sgs_cause);
|
|
|
|
pkbuf = ogs_pkbuf_alloc(NULL, OGS_MAX_SDU_LEN);
|
|
if (!pkbuf) {
|
|
ogs_error("ogs_pkbuf_alloc() failed");
|
|
ogs_tlv_free_all(root);
|
|
return NULL;
|
|
}
|
|
ogs_pkbuf_put_u8(pkbuf, SGSAP_UE_UNREACHABLE);
|
|
ogs_pkbuf_put(pkbuf, OGS_MAX_SDU_LEN-1);
|
|
|
|
ogs_pkbuf_trim(pkbuf, 1+ogs_tlv_render(root,
|
|
pkbuf->data+1, OGS_MAX_SDU_LEN-1));
|
|
|
|
ogs_tlv_free_all(root);
|
|
|
|
return pkbuf;
|
|
}
|