sysmocom
/
open5gs
forked from acouzens/open5gs
11
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity
open5gs/tests/common/gmm-build.c

730 lines
27 KiB
C
Raw Permalink Blame History

/*
* Copyright (C) 2019,2020 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 "test-common.h"
ogs_pkbuf_t *testgmm_build_registration_request(
test_ue_t *test_ue, ogs_pkbuf_t *nasbuf,
bool integrity_protected, bool ciphered)
{
int i;
uint16_t psimask = 0;
ogs_nas_s_nssai_ie_t *s_nssai = NULL;
ogs_nas_5gs_message_t message;
ogs_pkbuf_t *pkbuf = NULL;
ogs_nas_5gs_registration_request_t *registration_request =
&message.gmm.registration_request;
ogs_nas_5gs_registration_type_t *registration_type =
&registration_request->registration_type;
ogs_nas_5gmm_capability_t *gmm_capability =
&registration_request->gmm_capability;
ogs_nas_ue_security_capability_t *ue_security_capability =
&registration_request->ue_security_capability;
ogs_nas_s1_ue_network_capability_t *s1_ue_network_capability =
&registration_request->s1_ue_network_capability;
ogs_nas_uplink_data_status_t *uplink_data_status =
&registration_request->uplink_data_status;
ogs_nas_pdu_session_status_t *pdu_session_status =
&registration_request->pdu_session_status;
ogs_nas_allowed_pdu_session_status_t *allowed_pdu_session_status =
&registration_request->allowed_pdu_session_status;
ogs_nas_nssai_t *requested_nssai = &registration_request->requested_nssai;
ogs_nas_5gs_tracking_area_identity_t *last_visited_registered_tai =
&registration_request->last_visited_registered_tai;
ogs_nas_ue_usage_setting_t *ue_usage_setting =
&registration_request->ue_usage_setting;
ogs_nas_5gs_update_type_t *update_type = &registration_request->update_type;
ogs_nas_message_container_t *nas_message_container =
&registration_request->nas_message_container;
ogs_nas_5gs_mobile_identity_guti_t mobile_identity_guti;
ogs_assert(test_ue);
memset(&message, 0, sizeof(message));
if (integrity_protected) {
if (ciphered)
message.h.security_header_type =
OGS_NAS_SECURITY_HEADER_INTEGRITY_PROTECTED_AND_CIPHERED;
else
message.h.security_header_type =
OGS_NAS_SECURITY_HEADER_INTEGRITY_PROTECTED;
message.h.extended_protocol_discriminator =
OGS_NAS_EXTENDED_PROTOCOL_DISCRIMINATOR_5GMM;
}
message.gmm.h.extended_protocol_discriminator =
OGS_NAS_EXTENDED_PROTOCOL_DISCRIMINATOR_5GMM;
message.gmm.h.message_type = OGS_NAS_5GS_REGISTRATION_REQUEST;
registration_type->data = test_ue->nas.data;
if (test_ue->registration_request_param.guti) {
ogs_nas_5gs_nas_guti_to_mobility_identity_guti(
&test_ue->nas_5gs_guti, &mobile_identity_guti);
registration_request->mobile_identity.length =
sizeof(ogs_nas_5gs_mobile_identity_guti_t);
registration_request->mobile_identity.buffer =
&mobile_identity_guti;
} else {
registration_request->mobile_identity.length =
test_ue->mobile_identity.length;
registration_request->mobile_identity.buffer =
test_ue->mobile_identity.buffer;
}
if (test_ue->registration_request_param.uplink_data_status) {
registration_request->presencemask |=
OGS_NAS_5GS_REGISTRATION_REQUEST_UPLINK_DATA_STATUS_PRESENT;
uplink_data_status->length = 2;
uplink_data_status->psi |=
test_ue->registration_request_param.psimask.uplink_data_status << 8;
uplink_data_status->psi |=
test_ue->registration_request_param.psimask.uplink_data_status >> 8;
}
if (test_ue->registration_request_param.pdu_session_status) {
registration_request->presencemask |=
OGS_NAS_5GS_REGISTRATION_REQUEST_PDU_SESSION_STATUS_PRESENT;
pdu_session_status->length = 2;
pdu_session_status->psi |=
test_ue->registration_request_param.psimask.pdu_session_status << 8;
pdu_session_status->psi |=
test_ue->registration_request_param.psimask.pdu_session_status >> 8;
}
if (test_ue->registration_request_param.allowed_pdu_session_status) {
registration_request->presencemask |=
OGS_NAS_5GS_REGISTRATION_REQUEST_ALLOWED_PDU_SESSION_STATUS_PRESENT;
allowed_pdu_session_status->length = 2;
allowed_pdu_session_status->psi |= test_ue->
registration_request_param.psimask.allowed_pdu_session_status << 8;
allowed_pdu_session_status->psi |= test_ue->
registration_request_param.psimask.allowed_pdu_session_status >> 8;
}
if (test_ue->registration_request_param.gmm_capability) {
registration_request->presencemask |=
OGS_NAS_5GS_REGISTRATION_REQUEST_5GMM_CAPABILITY_PRESENT;
gmm_capability->length = 1;
gmm_capability->lte_positioning_protocol_capability = 0;
gmm_capability->ho_attach = 1;
gmm_capability->s1_mode = 1;
}
registration_request->presencemask |=
OGS_NAS_5GS_REGISTRATION_REQUEST_UE_SECURITY_CAPABILITY_PRESENT;
ue_security_capability->length = 2;
ue_security_capability->nr_ea = test_ue->ue_security_capability.nr_ea;
ue_security_capability->nr_ia = test_ue->ue_security_capability.nr_ia;
if (test_ue->ue_security_capability.eutra_ea ||
test_ue->ue_security_capability.eutra_ia) {
ue_security_capability->length = 4;
ue_security_capability->eutra_ea =
test_ue->ue_security_capability.eutra_ea;
ue_security_capability->eutra_ia =
test_ue->ue_security_capability.eutra_ia;
}
if (test_ue->registration_request_param.s1_ue_network_capability) {
registration_request->presencemask |=
OGS_NAS_5GS_REGISTRATION_REQUEST_S1_UE_NETWORK_CAPABILITY_PRESENT;
s1_ue_network_capability->length = 7;
s1_ue_network_capability->eea = test_ue->ue_network_capability.eea;
s1_ue_network_capability->eia = test_ue->ue_network_capability.eia;
s1_ue_network_capability->uea = 0xc0;
s1_ue_network_capability->uia = 0xc0;
s1_ue_network_capability->notification_procedure = 1;
s1_ue_network_capability->extended_protocol_configuration_options = 1;
s1_ue_network_capability->n1_mode = 1;
s1_ue_network_capability->dual_connectivity_with_nr = 1;
}
if (test_ue->registration_request_param.requested_nssai) {
/* Set Requested NSSAI */
registration_request->presencemask |=
OGS_NAS_5GS_REGISTRATION_REQUEST_REQUESTED_NSSAI_PRESENT;
requested_nssai->length = 0;
ogs_nas_build_nssai(requested_nssai,
test_ue->requested_nssai.s_nssai,
test_ue->requested_nssai.num_of_s_nssai);
}
if (test_ue->registration_request_param.last_visited_registered_tai) {
/* Set Last visited registered TAI */
registration_request->presencemask |=
OGS_NAS_5GS_REGISTRATION_REQUEST_LAST_VISITED_REGISTERED_TAI_PRESENT;
ogs_nas_from_plmn_id(&last_visited_registered_tai->nas_plmn_id,
&test_self()->nr_tai.plmn_id);
last_visited_registered_tai->tac.v = test_self()->nr_tai.tac.v;
}
if (test_ue->registration_request_param.ue_usage_setting) {
/* Set UE's usage setting */
registration_request->presencemask |=
OGS_NAS_5GS_REGISTRATION_REQUEST_UE_USAGE_SETTING_PRESENT;
ue_usage_setting->length = 1;
ue_usage_setting->data_centric = 1;
}
if (test_ue->registration_request_param.update_type) {
/* Set 5GS update type */
registration_request->presencemask |=
OGS_NAS_5GS_REGISTRATION_REQUEST_5GS_UPDATE_TYPE_PRESENT;
update_type->length = 1;
update_type->sms_over_nas_supported = 1;
}
if (nasbuf) {
registration_request->presencemask |=
OGS_NAS_5GS_REGISTRATION_REQUEST_NAS_MESSAGE_CONTAINER_PRESENT;
switch (test_ue->selected_enc_algorithm) {
case OGS_NAS_SECURITY_ALGORITHMS_128_NEA1:
case OGS_NAS_SECURITY_ALGORITHMS_128_NEA2:
case OGS_NAS_SECURITY_ALGORITHMS_128_NEA3:
ogs_nas_encrypt(test_ue->selected_enc_algorithm,
test_ue->knas_enc, test_ue->ul_count,
test_ue->nas.access_type,
OGS_NAS_SECURITY_UPLINK_DIRECTION, nasbuf);
break;
default:
break;
}
nas_message_container->length = nasbuf->len;
nas_message_container->buffer = nasbuf->data;
}
if (integrity_protected)
pkbuf = test_nas_5gs_security_encode(test_ue, &message);
else
pkbuf = ogs_nas_5gs_plain_encode(&message);
if (nasbuf)
ogs_pkbuf_free(nasbuf);
return pkbuf;
}
ogs_pkbuf_t *testgmm_build_registration_complete(test_ue_t *test_ue)
{
ogs_nas_5gs_message_t message;
ogs_pkbuf_t *pkbuf = NULL;
ogs_nas_5gs_registration_complete_t *registration_complete =
&message.gmm.registration_complete;
ogs_assert(test_ue);
memset(&message, 0, sizeof(message));
message.h.security_header_type =
OGS_NAS_SECURITY_HEADER_INTEGRITY_PROTECTED_AND_CIPHERED;
message.h.extended_protocol_discriminator =
OGS_NAS_EXTENDED_PROTOCOL_DISCRIMINATOR_5GMM;
message.gmm.h.extended_protocol_discriminator =
OGS_NAS_EXTENDED_PROTOCOL_DISCRIMINATOR_5GMM;
message.gmm.h.message_type = OGS_NAS_5GS_REGISTRATION_COMPLETE;
return test_nas_5gs_security_encode(test_ue, &message);
}
ogs_pkbuf_t *testgmm_build_service_request(
test_ue_t *test_ue, uint8_t service_type, ogs_pkbuf_t *nasbuf,
bool integrity_protected, bool ciphered)
{
ogs_nas_5gs_message_t message;
ogs_pkbuf_t *pkbuf = NULL;
ogs_nas_5gs_service_request_t *service_request =
&message.gmm.service_request;
ogs_nas_5gs_mobile_identity_s_tmsi_t mobile_identity_s_tmsi;
ogs_nas_message_container_t *nas_message_container =
&service_request->nas_message_container;
ogs_nas_uplink_data_status_t *uplink_data_status =
&service_request->uplink_data_status;
ogs_nas_pdu_session_status_t *pdu_session_status =
&service_request->pdu_session_status;
ogs_nas_allowed_pdu_session_status_t *allowed_pdu_session_status =
&service_request->allowed_pdu_session_status;
ogs_assert(test_ue);
uplink_data_status = &service_request->uplink_data_status;
memset(&message, 0, sizeof(message));
if (integrity_protected) {
message.h.extended_protocol_discriminator =
OGS_NAS_EXTENDED_PROTOCOL_DISCRIMINATOR_5GMM;
if (ciphered)
message.h.security_header_type =
OGS_NAS_SECURITY_HEADER_INTEGRITY_PROTECTED_AND_CIPHERED;
else
message.h.security_header_type =
OGS_NAS_SECURITY_HEADER_INTEGRITY_PROTECTED;
}
message.gmm.h.extended_protocol_discriminator =
OGS_NAS_EXTENDED_PROTOCOL_DISCRIMINATOR_5GMM;
message.gmm.h.message_type = OGS_NAS_5GS_SERVICE_REQUEST;
service_request->ngksi.type = service_type;
service_request->ngksi.tsc = test_ue->nas.tsc;
service_request->ngksi.value = test_ue->nas.ksi;
ogs_assert(test_ue->nas_5gs_guti.m_tmsi);
memset(&mobile_identity_s_tmsi, 0, sizeof(mobile_identity_s_tmsi));
/*
* TS24.501
* 9.11.3.4 5GS mobile identity
* Figure 9.11.3.4.5 5GS mobile identity IE for type of identity "5G-S-TMSI"
*
* Octet 1 : 5GS mobile identity IEI
* Octet 2-3 : Length of 5GS mobile identity contents
* Octet 4 : 1 1 1 1 0 1 0 0
*
* <Octet 4>
* h.supi_format = 0xf (1 1 1 1)
* h.odd_even = 0 (Spare 0)
* h.type = 1 0 0 (Type of identity : 5G-S-TMSI)
*/
mobile_identity_s_tmsi.h.supi_format = 0xf;
mobile_identity_s_tmsi.h.type = OGS_NAS_5GS_MOBILE_IDENTITY_S_TMSI;
mobile_identity_s_tmsi.m_tmsi = htobe32(test_ue->nas_5gs_guti.m_tmsi);
mobile_identity_s_tmsi.set1 = test_ue->nas_5gs_guti.amf_id.set1;
mobile_identity_s_tmsi.set2 = test_ue->nas_5gs_guti.amf_id.set2;
mobile_identity_s_tmsi.pointer = test_ue->nas_5gs_guti.amf_id.pointer;
service_request->s_tmsi.length = sizeof(mobile_identity_s_tmsi);
service_request->s_tmsi.buffer = &mobile_identity_s_tmsi;
if (nasbuf) {
service_request->presencemask |=
OGS_NAS_5GS_SERVICE_REQUEST_NAS_MESSAGE_CONTAINER_PRESENT;
switch (test_ue->selected_enc_algorithm) {
case OGS_NAS_SECURITY_ALGORITHMS_128_NEA1:
case OGS_NAS_SECURITY_ALGORITHMS_128_NEA2:
case OGS_NAS_SECURITY_ALGORITHMS_128_NEA3:
ogs_nas_encrypt(test_ue->selected_enc_algorithm,
test_ue->knas_enc, test_ue->ul_count,
test_ue->nas.access_type,
OGS_NAS_SECURITY_UPLINK_DIRECTION, nasbuf);
break;
default:
break;
}
nas_message_container->length = nasbuf->len;
nas_message_container->buffer = nasbuf->data;
}
if (test_ue->service_request_param.uplink_data_status) {
service_request->presencemask |=
OGS_NAS_5GS_SERVICE_REQUEST_UPLINK_DATA_STATUS_PRESENT;
uplink_data_status->length = 2;
uplink_data_status->psi |=
test_ue->service_request_param.psimask.uplink_data_status << 8;
uplink_data_status->psi |=
test_ue->service_request_param.psimask.uplink_data_status >> 8;
}
if (test_ue->service_request_param.pdu_session_status) {
service_request->presencemask |=
OGS_NAS_5GS_SERVICE_REQUEST_PDU_SESSION_STATUS_PRESENT;
pdu_session_status->length = 2;
pdu_session_status->psi |=
test_ue->service_request_param.psimask.pdu_session_status << 8;
pdu_session_status->psi |=
test_ue->service_request_param.psimask.pdu_session_status >> 8;
}
if (test_ue->service_request_param.allowed_pdu_session_status) {
service_request->presencemask |=
OGS_NAS_5GS_SERVICE_REQUEST_ALLOWED_PDU_SESSION_STATUS_PRESENT;
allowed_pdu_session_status->length = 2;
allowed_pdu_session_status->psi |= test_ue->
service_request_param.psimask.allowed_pdu_session_status << 8;
allowed_pdu_session_status->psi |= test_ue->
service_request_param.psimask.allowed_pdu_session_status >> 8;
}
if (integrity_protected)
pkbuf = test_nas_5gs_security_encode(test_ue, &message);
else
pkbuf = ogs_nas_5gs_plain_encode(&message);
if (nasbuf)
ogs_pkbuf_free(nasbuf);
return pkbuf;
}
ogs_pkbuf_t *testgmm_build_de_registration_request(
test_ue_t *test_ue, bool switch_off,
bool integrity_protected, bool ciphered)
{
ogs_nas_5gs_message_t message;
ogs_pkbuf_t *pkbuf = NULL;
ogs_nas_5gs_deregistration_request_from_ue_t
*deregistration_request_from_ue =
&message.gmm.deregistration_request_from_ue;
ogs_nas_de_registration_type_t *de_registration_type =
&deregistration_request_from_ue->de_registration_type;
ogs_nas_5gs_mobile_identity_guti_t mobile_identity_guti;
ogs_assert(test_ue);
memset(&message, 0, sizeof(message));
if (integrity_protected) {
if (ciphered)
message.h.security_header_type =
OGS_NAS_SECURITY_HEADER_INTEGRITY_PROTECTED_AND_CIPHERED;
else
message.h.security_header_type =
OGS_NAS_SECURITY_HEADER_INTEGRITY_PROTECTED;
message.h.extended_protocol_discriminator =
OGS_NAS_EXTENDED_PROTOCOL_DISCRIMINATOR_5GMM;
}
message.gmm.h.extended_protocol_discriminator =
OGS_NAS_EXTENDED_PROTOCOL_DISCRIMINATOR_5GMM;
message.gmm.h.message_type = OGS_NAS_5GS_DEREGISTRATION_REQUEST_FROM_UE;
de_registration_type->ksi = test_ue->nas.ksi;
de_registration_type->switch_off = switch_off;
de_registration_type->access_type = test_ue->nas.access_type;
if (test_ue->nas_5gs_guti.m_tmsi) {
ogs_nas_5gs_nas_guti_to_mobility_identity_guti(
&test_ue->nas_5gs_guti, &mobile_identity_guti);
deregistration_request_from_ue->mobile_identity.length =
sizeof(ogs_nas_5gs_mobile_identity_guti_t);
deregistration_request_from_ue->mobile_identity.buffer =
&mobile_identity_guti;
} else {
deregistration_request_from_ue->mobile_identity.length =
test_ue->mobile_identity.length;
deregistration_request_from_ue->mobile_identity.buffer =
test_ue->mobile_identity.buffer;
}
if (integrity_protected)
return test_nas_5gs_security_encode(test_ue, &message);
else
return ogs_nas_5gs_plain_encode(&message);
}
ogs_pkbuf_t *testgmm_build_identity_response(test_ue_t *test_ue)
{
ogs_nas_5gs_message_t message;
ogs_pkbuf_t *pkbuf = NULL;
ogs_nas_5gs_identity_response_t *identity_response =
&message.gmm.identity_response;
ogs_assert(test_ue);
memset(&message, 0, sizeof(message));
message.gmm.h.extended_protocol_discriminator =
OGS_NAS_EXTENDED_PROTOCOL_DISCRIMINATOR_5GMM;
message.gmm.h.message_type = OGS_NAS_5GS_IDENTITY_RESPONSE;
identity_response->mobile_identity.length =
test_ue->mobile_identity.length;
identity_response->mobile_identity.buffer =
test_ue->mobile_identity.buffer;
return ogs_nas_5gs_plain_encode(&message);
}
ogs_pkbuf_t *testgmm_build_authentication_response(test_ue_t *test_ue)
{
ogs_nas_5gs_message_t message;
ogs_pkbuf_t *pkbuf = NULL;
ogs_nas_5gs_authentication_response_t *authentication_response =
&message.gmm.authentication_response;
ogs_nas_authentication_response_parameter_t
*authentication_response_parameter =
&authentication_response->authentication_response_parameter;
uint8_t ik[OGS_KEY_LEN];
uint8_t ck[OGS_KEY_LEN];
uint8_t ak[OGS_AK_LEN];
uint8_t res[OGS_MAX_RES_LEN];
uint8_t res_star[OGS_MAX_RES_LEN];
uint8_t kausf[OGS_SHA256_DIGEST_SIZE];
uint8_t kseaf[OGS_SHA256_DIGEST_SIZE];
char *serving_network_name;
ogs_assert(test_ue);
memset(&message, 0, sizeof(message));
message.gmm.h.extended_protocol_discriminator =
OGS_NAS_EXTENDED_PROTOCOL_DISCRIMINATOR_5GMM;
message.gmm.h.message_type = OGS_NAS_5GS_AUTHENTICATION_RESPONSE;
authentication_response->presencemask |=
OGS_NAS_5GS_AUTHENTICATION_RESPONSE_AUTHENTICATION_RESPONSE_PARAMETER_PRESENT;
milenage_f2345(test_ue->opc, test_ue->k, test_ue->rand,
res, ck, ik, ak, NULL);
serving_network_name =
ogs_serving_network_name_from_plmn_id(&test_self()->nr_tai.plmn_id);
ogs_assert(serving_network_name);
ogs_kdf_xres_star(
ck, ik,
serving_network_name, test_ue->rand, res, 8,
authentication_response_parameter->res);
authentication_response_parameter->length = OGS_AUTN_LEN;
memcpy(res_star, authentication_response_parameter->res,
authentication_response_parameter->length);
ogs_kdf_kausf(ck, ik, serving_network_name, test_ue->autn, kausf);
ogs_kdf_kseaf(serving_network_name, kausf, kseaf);
ogs_kdf_kamf(test_ue->supi, test_ue->abba, test_ue->abba_len,
kseaf, test_ue->kamf);
ogs_free(serving_network_name);
return ogs_nas_5gs_plain_encode(&message);
}
ogs_pkbuf_t *testgmm_build_authentication_failure(
test_ue_t *test_ue, ogs_nas_5gmm_cause_t gmm_cause, uint64_t sqn_ms)
{
ogs_nas_5gs_message_t message;
ogs_pkbuf_t *pkbuf = NULL;
ogs_nas_5gs_authentication_failure_t *authentication_failure =
&message.gmm.authentication_failure;
ogs_nas_authentication_failure_parameter_t
*authentication_failure_parameter =
&authentication_failure->authentication_failure_parameter;
uint8_t ak[OGS_AK_LEN];
#if 0
uint8_t sqn_ms[OGS_SQN_LEN] = "\x00\x00\x11\x22\x33\x44";
uint8_t sqn_ms[OGS_SQN_LEN] = "\x00\x00\x00\x00\x1f\x60"; /* Issues 482 */
#endif
uint8_t sqn[OGS_SQN_LEN];
uint8_t mac_s[OGS_MAC_S_LEN];
uint8_t amf[2] = { 0, 0 };
uint8_t auts[OGS_AUTS_LEN];
int i = 0;
ogs_assert(test_ue);
memset(&message, 0, sizeof(message));
message.gmm.h.extended_protocol_discriminator =
OGS_NAS_EXTENDED_PROTOCOL_DISCRIMINATOR_5GMM;
message.gmm.h.message_type = OGS_NAS_5GS_AUTHENTICATION_FAILURE;
authentication_failure->gmm_cause = gmm_cause;
if (gmm_cause == OGS_5GMM_CAUSE_SYNCH_FAILURE) {
authentication_failure->presencemask |=
OGS_NAS_5GS_AUTHENTICATION_RESPONSE_AUTHENTICATION_RESPONSE_PARAMETER_PRESENT;
milenage_f2345(test_ue->opc, test_ue->k, test_ue->rand,
NULL, NULL, NULL, NULL, ak);
ogs_uint64_to_buffer(sqn_ms, 6, sqn);
milenage_f1(test_ue->opc, test_ue->k, test_ue->rand,
sqn, amf, NULL, auts + OGS_SQN_LEN);
for (i = 0; i < OGS_SQN_LEN; i++)
auts[i] = sqn[i] ^ ak[i];
authentication_failure_parameter->length = OGS_AUTS_LEN;
memcpy(authentication_failure_parameter->auts, auts,
authentication_failure_parameter->length);
}
return ogs_nas_5gs_plain_encode(&message);
}
ogs_pkbuf_t *testgmm_build_security_mode_complete(
test_ue_t *test_ue, ogs_pkbuf_t *nasbuf)
{
ogs_nas_5gs_message_t message;
ogs_pkbuf_t *pkbuf = NULL;
ogs_nas_5gs_security_mode_complete_t *security_mode_complete =
&message.gmm.security_mode_complete;
ogs_nas_message_container_t *nas_message_container =
&security_mode_complete->nas_message_container;
ogs_nas_5gs_mobile_identity_t *imeisv =
&security_mode_complete->imeisv;
ogs_nas_mobile_identity_imeisv_t mobile_identity_imeisv;
ogs_assert(test_ue);
memset(&message, 0, sizeof(message));
message.h.security_header_type =
OGS_NAS_SECURITY_HEADER_INTEGRITY_PROTECTED_AND_CIPHTERD_WITH_NEW_INTEGRITY_CONTEXT;
message.h.extended_protocol_discriminator =
OGS_NAS_EXTENDED_PROTOCOL_DISCRIMINATOR_5GMM;
message.gmm.h.extended_protocol_discriminator =
OGS_NAS_EXTENDED_PROTOCOL_DISCRIMINATOR_5GMM;
message.gmm.h.message_type = OGS_NAS_5GS_SECURITY_MODE_COMPLETE;
if (test_ue->mobile_identity_imeisv.type ==
OGS_NAS_5GS_MOBILE_IDENTITY_IMEISV) {
security_mode_complete->presencemask |=
OGS_NAS_5GS_SECURITY_MODE_COMPLETE_IMEISV_PRESENT;
memset(&mobile_identity_imeisv, 0, sizeof(mobile_identity_imeisv));
imeisv->length = sizeof(mobile_identity_imeisv);
imeisv->buffer = &test_ue->mobile_identity_imeisv;
}
if (nasbuf) {
security_mode_complete->presencemask |=
OGS_NAS_5GS_SECURITY_MODE_COMPLETE_NAS_MESSAGE_CONTAINER_PRESENT;
nas_message_container->length = nasbuf->len;
nas_message_container->buffer = nasbuf->data;
}
pkbuf = test_nas_5gs_security_encode(test_ue, &message);
if (nasbuf)
ogs_pkbuf_free(nasbuf);
return pkbuf;
}
ogs_pkbuf_t *testgmm_build_configuration_update_complete(test_ue_t *test_ue)
{
ogs_nas_5gs_message_t message;
ogs_pkbuf_t *pkbuf = NULL;
ogs_assert(test_ue);
memset(&message, 0, sizeof(message));
message.h.security_header_type =
OGS_NAS_SECURITY_HEADER_INTEGRITY_PROTECTED_AND_CIPHERED;
message.h.extended_protocol_discriminator =
OGS_NAS_EXTENDED_PROTOCOL_DISCRIMINATOR_5GMM;
message.gmm.h.extended_protocol_discriminator =
OGS_NAS_EXTENDED_PROTOCOL_DISCRIMINATOR_5GMM;
message.gmm.h.message_type = OGS_NAS_5GS_CONFIGURATION_UPDATE_COMPLETE;
return test_nas_5gs_security_encode(test_ue, &message);
}
ogs_pkbuf_t *testgmm_build_ul_nas_transport(test_sess_t *test_sess,
uint8_t payload_type, ogs_pkbuf_t *payload)
{
test_ue_t *test_ue = NULL;
ogs_pkbuf_t *pkbuf = NULL;
ogs_nas_5gs_message_t message;
ogs_nas_5gs_ul_nas_transport_t *ul_nas_transport =
&message.gmm.ul_nas_transport;
ogs_nas_payload_container_type_t *payload_container_type = NULL;
ogs_nas_payload_container_t *payload_container = NULL;
ogs_nas_pdu_session_identity_2_t *pdu_session_id = NULL;
ogs_nas_request_type_t *request_type = NULL;
ogs_nas_s_nssai_t *nas_s_nssai = NULL;
ogs_assert(test_sess);
test_ue = test_sess->test_ue;
ogs_assert(test_ue);
ogs_assert(payload_type);
ogs_assert(payload);
payload_container_type = &ul_nas_transport->payload_container_type;
payload_container = &ul_nas_transport->payload_container;
pdu_session_id = &ul_nas_transport->pdu_session_id;
request_type = &ul_nas_transport->request_type;
nas_s_nssai = &ul_nas_transport->s_nssai;
memset(&message, 0, sizeof(message));
message.h.security_header_type =
OGS_NAS_SECURITY_HEADER_INTEGRITY_PROTECTED_AND_CIPHERED;
message.h.extended_protocol_discriminator =
OGS_NAS_EXTENDED_PROTOCOL_DISCRIMINATOR_5GMM;
message.gmm.h.extended_protocol_discriminator =
OGS_NAS_EXTENDED_PROTOCOL_DISCRIMINATOR_5GMM;
message.gmm.h.message_type = OGS_NAS_5GS_UL_NAS_TRANSPORT;
payload_container_type->value = payload_type;
payload_container->length = payload->len;
payload_container->buffer = payload->data;
ul_nas_transport->presencemask |=
OGS_NAS_5GS_UL_NAS_TRANSPORT_PDU_SESSION_ID_PRESENT;
*pdu_session_id = test_sess->psi;
if (test_sess->ul_nas_transport_param.request_type) {
ul_nas_transport->presencemask |=
OGS_NAS_5GS_UL_NAS_TRANSPORT_REQUEST_TYPE_PRESENT;
request_type->value = test_sess->ul_nas_transport_param.request_type;
}
if (test_sess->ul_nas_transport_param.s_nssai) {
ul_nas_transport->presencemask |=
OGS_NAS_5GS_UL_NAS_TRANSPORT_S_NSSAI_PRESENT;
ogs_nas_build_s_nssai(
nas_s_nssai,
&test_ue->allowed_nssai.
s_nssai[test_ue->allowed_nssai.num_of_s_nssai-1]);
}
if (test_sess->ul_nas_transport_param.dnn) {
ul_nas_transport->presencemask |=
OGS_NAS_5GS_UL_NAS_TRANSPORT_DNN_PRESENT;
ul_nas_transport->dnn.length = strlen(test_sess->dnn);
ogs_cpystrn(ul_nas_transport->dnn.value, test_sess->dnn,
ogs_min(ul_nas_transport->dnn.length, OGS_MAX_DNN_LEN) + 1);
}
pkbuf = test_nas_5gs_security_encode(test_ue, &message);
ogs_pkbuf_free(payload);
return pkbuf;
}
ogs_pkbuf_t *testgmm_build_gmm_status(
test_ue_t *test_ue, ogs_nas_5gmm_cause_t gmm_cause)
{
ogs_nas_5gs_message_t message;
ogs_pkbuf_t *pkbuf = NULL;
ogs_nas_5gs_5gmm_status_t *gmm_status = &message.gmm.gmm_status;
ogs_assert(test_ue);
ogs_assert(gmm_status);
memset(&message, 0, sizeof(message));
message.gmm.h.extended_protocol_discriminator =
OGS_NAS_EXTENDED_PROTOCOL_DISCRIMINATOR_5GMM;
message.gmm.h.message_type = OGS_NAS_5GS_5GMM_STATUS;
gmm_status->gmm_cause = gmm_cause;
return ogs_nas_5gs_plain_encode(&message);
}
Reference in New Issue View Git Blame Copy Permalink