496 lines
17 KiB
C
496 lines
17 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 "context.h"
|
|
#include "pfcp-path.h"
|
|
#include "gtp-path.h"
|
|
#include "n4-handler.h"
|
|
|
|
static void upf_n4_handle_create_urr(upf_sess_t *sess, ogs_pfcp_tlv_create_urr_t *create_urr_arr,
|
|
uint8_t *cause_value, uint8_t *offending_ie_value)
|
|
{
|
|
int i;
|
|
ogs_pfcp_urr_t *urr;
|
|
|
|
*cause_value = OGS_PFCP_CAUSE_REQUEST_ACCEPTED;
|
|
|
|
for (i = 0; i < OGS_MAX_NUM_OF_URR; i++) {
|
|
urr = ogs_pfcp_handle_create_urr(&sess->pfcp, &create_urr_arr[i],
|
|
cause_value, offending_ie_value);
|
|
if (!urr)
|
|
return;
|
|
|
|
/* TODO: here we should check for Reporting Triggers IMTH=1 instead? */
|
|
if ((urr->meas_method & OGS_PFCP_MEASUREMENT_METHOD_DURATION) && urr->time_threshold > 0) {
|
|
/* if ISTM bit set in Measurement Information: */
|
|
if (urr->meas_info.istm) {
|
|
upf_sess_urr_acc_time_threshold_setup(sess, urr);
|
|
} /* else: TODO: call upf_sess_urr_acc_time_threshold_setup() upon first pkt received */
|
|
}
|
|
}
|
|
}
|
|
|
|
void upf_n4_handle_session_establishment_request(
|
|
upf_sess_t *sess, ogs_pfcp_xact_t *xact,
|
|
ogs_pfcp_session_establishment_request_t *req)
|
|
{
|
|
ogs_pfcp_pdr_t *pdr = NULL;
|
|
ogs_pfcp_far_t *far = NULL;
|
|
ogs_pfcp_pdr_t *created_pdr[OGS_MAX_NUM_OF_PDR];
|
|
int num_of_created_pdr = 0;
|
|
uint8_t cause_value = 0;
|
|
uint8_t offending_ie_value = 0;
|
|
int i;
|
|
|
|
ogs_assert(xact);
|
|
ogs_assert(req);
|
|
|
|
ogs_debug("Session Establishment Request");
|
|
|
|
cause_value = OGS_PFCP_CAUSE_REQUEST_ACCEPTED;
|
|
|
|
if (!sess) {
|
|
ogs_error("No Context");
|
|
ogs_pfcp_send_error_message(xact, 0,
|
|
OGS_PFCP_SESSION_ESTABLISHMENT_RESPONSE_TYPE,
|
|
OGS_PFCP_CAUSE_MANDATORY_IE_MISSING, 0);
|
|
return;
|
|
}
|
|
|
|
for (i = 0; i < OGS_MAX_NUM_OF_PDR; i++) {
|
|
created_pdr[i] = ogs_pfcp_handle_create_pdr(&sess->pfcp,
|
|
&req->create_pdr[i], &cause_value, &offending_ie_value);
|
|
if (created_pdr[i] == NULL)
|
|
break;
|
|
}
|
|
num_of_created_pdr = i;
|
|
if (cause_value != OGS_PFCP_CAUSE_REQUEST_ACCEPTED)
|
|
goto cleanup;
|
|
|
|
for (i = 0; i < OGS_MAX_NUM_OF_FAR; i++) {
|
|
if (ogs_pfcp_handle_create_far(&sess->pfcp, &req->create_far[i],
|
|
&cause_value, &offending_ie_value) == NULL)
|
|
break;
|
|
}
|
|
if (cause_value != OGS_PFCP_CAUSE_REQUEST_ACCEPTED)
|
|
goto cleanup;
|
|
|
|
upf_n4_handle_create_urr(sess, &req->create_urr[0], &cause_value, &offending_ie_value);
|
|
if (cause_value != OGS_PFCP_CAUSE_REQUEST_ACCEPTED)
|
|
goto cleanup;
|
|
|
|
for (i = 0; i < OGS_MAX_NUM_OF_QER; i++) {
|
|
if (ogs_pfcp_handle_create_qer(&sess->pfcp, &req->create_qer[i],
|
|
&cause_value, &offending_ie_value) == NULL)
|
|
break;
|
|
}
|
|
if (cause_value != OGS_PFCP_CAUSE_REQUEST_ACCEPTED)
|
|
goto cleanup;
|
|
|
|
ogs_pfcp_handle_create_bar(&sess->pfcp, &req->create_bar,
|
|
&cause_value, &offending_ie_value);
|
|
if (cause_value != OGS_PFCP_CAUSE_REQUEST_ACCEPTED)
|
|
goto cleanup;
|
|
|
|
/* Setup GTP Node */
|
|
ogs_list_for_each(&sess->pfcp.far_list, far) {
|
|
ogs_assert(OGS_ERROR != ogs_pfcp_setup_far_gtpu_node(far));
|
|
if (far->gnode)
|
|
ogs_pfcp_far_f_teid_hash_set(far);
|
|
}
|
|
|
|
for (i = 0; i < num_of_created_pdr; i++) {
|
|
pdr = created_pdr[i];
|
|
ogs_assert(pdr);
|
|
|
|
/* Setup UE IP address */
|
|
if (pdr->ue_ip_addr_len) {
|
|
if (req->pdn_type.presence == 1) {
|
|
ogs_assert(OGS_PFCP_CAUSE_REQUEST_ACCEPTED ==
|
|
upf_sess_set_ue_ip(sess, req->pdn_type.u8, pdr));
|
|
} else {
|
|
ogs_error("No PDN Type");
|
|
}
|
|
}
|
|
|
|
/* Setup UPF-N3-TEID & QFI Hash */
|
|
if (pdr->f_teid_len) {
|
|
ogs_pfcp_object_type_e type = OGS_PFCP_OBJ_PDR_TYPE;
|
|
|
|
if (ogs_pfcp_self()->up_function_features.ftup &&
|
|
pdr->f_teid.ch) {
|
|
|
|
ogs_pfcp_pdr_t *choosed_pdr = NULL;
|
|
|
|
if (pdr->f_teid.chid) {
|
|
type = OGS_PFCP_OBJ_SESS_TYPE;
|
|
|
|
choosed_pdr = ogs_pfcp_pdr_find_by_choose_id(
|
|
&sess->pfcp, pdr->f_teid.choose_id);
|
|
if (!choosed_pdr) {
|
|
pdr->chid = true;
|
|
pdr->choose_id = pdr->f_teid.choose_id;
|
|
}
|
|
}
|
|
|
|
if (choosed_pdr) {
|
|
pdr->f_teid_len = choosed_pdr->f_teid_len;
|
|
memcpy(&pdr->f_teid, &choosed_pdr->f_teid, pdr->f_teid_len);
|
|
} else {
|
|
ogs_gtpu_resource_t *resource = NULL;
|
|
resource = ogs_pfcp_find_gtpu_resource(
|
|
&ogs_gtp_self()->gtpu_resource_list,
|
|
pdr->dnn, OGS_PFCP_INTERFACE_ACCESS);
|
|
if (resource) {
|
|
ogs_assert(OGS_OK ==
|
|
ogs_pfcp_user_plane_ip_resource_info_to_f_teid(
|
|
&resource->info, &pdr->f_teid, &pdr->f_teid_len));
|
|
if (resource->info.teidri)
|
|
pdr->f_teid.teid = OGS_PFCP_GTPU_INDEX_TO_TEID(
|
|
pdr->index, resource->info.teidri,
|
|
resource->info.teid_range);
|
|
else
|
|
pdr->f_teid.teid = pdr->index;
|
|
} else {
|
|
ogs_assert(OGS_OK ==
|
|
ogs_pfcp_sockaddr_to_f_teid(
|
|
ogs_gtp_self()->gtpu_addr,
|
|
ogs_gtp_self()->gtpu_addr6,
|
|
&pdr->f_teid, &pdr->f_teid_len));
|
|
pdr->f_teid.teid = pdr->index;
|
|
}
|
|
}
|
|
}
|
|
|
|
ogs_pfcp_object_teid_hash_set(type, pdr);
|
|
}
|
|
}
|
|
|
|
/* Send Buffered Packet to gNB/SGW */
|
|
ogs_list_for_each(&sess->pfcp.pdr_list, pdr) {
|
|
if (pdr->src_if == OGS_PFCP_INTERFACE_CORE) { /* Downlink */
|
|
ogs_pfcp_send_buffered_packet(pdr);
|
|
}
|
|
}
|
|
|
|
ogs_assert(OGS_OK ==
|
|
upf_pfcp_send_session_establishment_response(
|
|
xact, sess, created_pdr, num_of_created_pdr));
|
|
return;
|
|
|
|
cleanup:
|
|
ogs_pfcp_sess_clear(&sess->pfcp);
|
|
ogs_pfcp_send_error_message(xact, sess ? sess->smf_n4_seid : 0,
|
|
OGS_PFCP_SESSION_ESTABLISHMENT_RESPONSE_TYPE,
|
|
cause_value, offending_ie_value);
|
|
}
|
|
|
|
void upf_n4_handle_session_modification_request(
|
|
upf_sess_t *sess, ogs_pfcp_xact_t *xact,
|
|
ogs_pfcp_session_modification_request_t *req)
|
|
{
|
|
ogs_pfcp_pdr_t *pdr = NULL;
|
|
ogs_pfcp_far_t *far = NULL;
|
|
ogs_pfcp_pdr_t *created_pdr[OGS_MAX_NUM_OF_PDR];
|
|
int num_of_created_pdr = 0;
|
|
uint8_t cause_value = 0;
|
|
uint8_t offending_ie_value = 0;
|
|
int i;
|
|
|
|
ogs_assert(xact);
|
|
ogs_assert(req);
|
|
|
|
ogs_debug("Session Modification Request");
|
|
|
|
cause_value = OGS_PFCP_CAUSE_REQUEST_ACCEPTED;
|
|
|
|
if (!sess) {
|
|
ogs_error("No Context");
|
|
ogs_pfcp_send_error_message(xact, 0,
|
|
OGS_PFCP_SESSION_MODIFICATION_RESPONSE_TYPE,
|
|
OGS_PFCP_CAUSE_SESSION_CONTEXT_NOT_FOUND, 0);
|
|
return;
|
|
}
|
|
|
|
for (i = 0; i < OGS_MAX_NUM_OF_PDR; i++) {
|
|
created_pdr[i] = ogs_pfcp_handle_create_pdr(&sess->pfcp,
|
|
&req->create_pdr[i], &cause_value, &offending_ie_value);
|
|
if (created_pdr[i] == NULL)
|
|
break;
|
|
}
|
|
num_of_created_pdr = i;
|
|
if (cause_value != OGS_PFCP_CAUSE_REQUEST_ACCEPTED)
|
|
goto cleanup;
|
|
|
|
for (i = 0; i < OGS_MAX_NUM_OF_PDR; i++) {
|
|
if (ogs_pfcp_handle_update_pdr(&sess->pfcp, &req->update_pdr[i],
|
|
&cause_value, &offending_ie_value) == NULL)
|
|
break;
|
|
}
|
|
if (cause_value != OGS_PFCP_CAUSE_REQUEST_ACCEPTED)
|
|
goto cleanup;
|
|
|
|
for (i = 0; i < OGS_MAX_NUM_OF_PDR; i++) {
|
|
if (ogs_pfcp_handle_remove_pdr(&sess->pfcp, &req->remove_pdr[i],
|
|
&cause_value, &offending_ie_value) == false)
|
|
break;
|
|
}
|
|
if (cause_value != OGS_PFCP_CAUSE_REQUEST_ACCEPTED)
|
|
goto cleanup;
|
|
|
|
for (i = 0; i < OGS_MAX_NUM_OF_FAR; i++) {
|
|
if (ogs_pfcp_handle_create_far(&sess->pfcp, &req->create_far[i],
|
|
&cause_value, &offending_ie_value) == NULL)
|
|
break;
|
|
}
|
|
if (cause_value != OGS_PFCP_CAUSE_REQUEST_ACCEPTED)
|
|
goto cleanup;
|
|
|
|
for (i = 0; i < OGS_MAX_NUM_OF_FAR; i++) {
|
|
if (ogs_pfcp_handle_update_far_flags(&sess->pfcp, &req->update_far[i],
|
|
&cause_value, &offending_ie_value) == NULL)
|
|
break;
|
|
}
|
|
if (cause_value != OGS_PFCP_CAUSE_REQUEST_ACCEPTED)
|
|
goto cleanup;
|
|
|
|
/* Send End Marker to gNB */
|
|
ogs_list_for_each(&sess->pfcp.pdr_list, pdr) {
|
|
far = pdr->far;
|
|
if (far && far->smreq_flags.send_end_marker_packets)
|
|
ogs_assert(OGS_ERROR != ogs_pfcp_send_end_marker(pdr));
|
|
}
|
|
/* Clear PFCPSMReq-Flags */
|
|
ogs_list_for_each(&sess->pfcp.far_list, far)
|
|
far->smreq_flags.value = 0;
|
|
|
|
for (i = 0; i < OGS_MAX_NUM_OF_FAR; i++) {
|
|
if (ogs_pfcp_handle_update_far(&sess->pfcp, &req->update_far[i],
|
|
&cause_value, &offending_ie_value) == NULL)
|
|
break;
|
|
}
|
|
if (cause_value != OGS_PFCP_CAUSE_REQUEST_ACCEPTED)
|
|
goto cleanup;
|
|
|
|
for (i = 0; i < OGS_MAX_NUM_OF_FAR; i++) {
|
|
if (ogs_pfcp_handle_remove_far(&sess->pfcp, &req->remove_far[i],
|
|
&cause_value, &offending_ie_value) == false)
|
|
break;
|
|
}
|
|
if (cause_value != OGS_PFCP_CAUSE_REQUEST_ACCEPTED)
|
|
goto cleanup;
|
|
|
|
upf_n4_handle_create_urr(sess, &req->create_urr[0], &cause_value, &offending_ie_value);
|
|
if (cause_value != OGS_PFCP_CAUSE_REQUEST_ACCEPTED)
|
|
goto cleanup;
|
|
|
|
for (i = 0; i < OGS_MAX_NUM_OF_URR; i++) {
|
|
if (ogs_pfcp_handle_update_urr(&sess->pfcp, &req->update_urr[i],
|
|
&cause_value, &offending_ie_value) == NULL)
|
|
break;
|
|
}
|
|
if (cause_value != OGS_PFCP_CAUSE_REQUEST_ACCEPTED)
|
|
goto cleanup;
|
|
|
|
for (i = 0; i < OGS_MAX_NUM_OF_URR; i++) {
|
|
if (ogs_pfcp_handle_remove_urr(&sess->pfcp, &req->remove_urr[i],
|
|
&cause_value, &offending_ie_value) == false)
|
|
break;
|
|
}
|
|
if (cause_value != OGS_PFCP_CAUSE_REQUEST_ACCEPTED)
|
|
goto cleanup;
|
|
|
|
for (i = 0; i < OGS_MAX_NUM_OF_QER; i++) {
|
|
if (ogs_pfcp_handle_create_qer(&sess->pfcp, &req->create_qer[i],
|
|
&cause_value, &offending_ie_value) == NULL)
|
|
break;
|
|
}
|
|
if (cause_value != OGS_PFCP_CAUSE_REQUEST_ACCEPTED)
|
|
goto cleanup;
|
|
|
|
for (i = 0; i < OGS_MAX_NUM_OF_QER; i++) {
|
|
if (ogs_pfcp_handle_update_qer(&sess->pfcp, &req->update_qer[i],
|
|
&cause_value, &offending_ie_value) == NULL)
|
|
break;
|
|
}
|
|
if (cause_value != OGS_PFCP_CAUSE_REQUEST_ACCEPTED)
|
|
goto cleanup;
|
|
|
|
for (i = 0; i < OGS_MAX_NUM_OF_QER; i++) {
|
|
if (ogs_pfcp_handle_remove_qer(&sess->pfcp, &req->remove_qer[i],
|
|
&cause_value, &offending_ie_value) == false)
|
|
break;
|
|
}
|
|
if (cause_value != OGS_PFCP_CAUSE_REQUEST_ACCEPTED)
|
|
goto cleanup;
|
|
|
|
ogs_pfcp_handle_create_bar(&sess->pfcp, &req->create_bar,
|
|
&cause_value, &offending_ie_value);
|
|
if (cause_value != OGS_PFCP_CAUSE_REQUEST_ACCEPTED)
|
|
goto cleanup;
|
|
|
|
ogs_pfcp_handle_remove_bar(&sess->pfcp, &req->remove_bar,
|
|
&cause_value, &offending_ie_value);
|
|
if (cause_value != OGS_PFCP_CAUSE_REQUEST_ACCEPTED)
|
|
goto cleanup;
|
|
|
|
/* Setup GTP Node */
|
|
ogs_list_for_each(&sess->pfcp.far_list, far) {
|
|
ogs_assert(OGS_ERROR != ogs_pfcp_setup_far_gtpu_node(far));
|
|
if (far->gnode)
|
|
ogs_pfcp_far_f_teid_hash_set(far);
|
|
}
|
|
|
|
/* Setup UPF-N3-TEID & QFI Hash */
|
|
for (i = 0; i < num_of_created_pdr; i++) {
|
|
pdr = created_pdr[i];
|
|
ogs_assert(pdr);
|
|
|
|
if (pdr->f_teid_len) {
|
|
ogs_pfcp_object_type_e type = OGS_PFCP_OBJ_PDR_TYPE;
|
|
|
|
if (ogs_pfcp_self()->up_function_features.ftup &&
|
|
pdr->f_teid.ch) {
|
|
|
|
ogs_pfcp_pdr_t *choosed_pdr = NULL;
|
|
|
|
if (pdr->f_teid.chid) {
|
|
type = OGS_PFCP_OBJ_SESS_TYPE;
|
|
|
|
choosed_pdr = ogs_pfcp_pdr_find_by_choose_id(
|
|
&sess->pfcp, pdr->f_teid.choose_id);
|
|
if (!choosed_pdr) {
|
|
pdr->chid = true;
|
|
pdr->choose_id = pdr->f_teid.choose_id;
|
|
}
|
|
}
|
|
|
|
if (choosed_pdr) {
|
|
pdr->f_teid_len = choosed_pdr->f_teid_len;
|
|
memcpy(&pdr->f_teid, &choosed_pdr->f_teid, pdr->f_teid_len);
|
|
|
|
} else {
|
|
ogs_gtpu_resource_t *resource = NULL;
|
|
resource = ogs_pfcp_find_gtpu_resource(
|
|
&ogs_gtp_self()->gtpu_resource_list,
|
|
pdr->dnn, OGS_PFCP_INTERFACE_ACCESS);
|
|
if (resource) {
|
|
ogs_assert(OGS_OK ==
|
|
ogs_pfcp_user_plane_ip_resource_info_to_f_teid(
|
|
&resource->info, &pdr->f_teid, &pdr->f_teid_len));
|
|
if (resource->info.teidri)
|
|
pdr->f_teid.teid = OGS_PFCP_GTPU_INDEX_TO_TEID(
|
|
pdr->index, resource->info.teidri,
|
|
resource->info.teid_range);
|
|
else
|
|
pdr->f_teid.teid = pdr->index;
|
|
} else {
|
|
ogs_assert(OGS_OK ==
|
|
ogs_pfcp_sockaddr_to_f_teid(
|
|
ogs_gtp_self()->gtpu_addr,
|
|
ogs_gtp_self()->gtpu_addr6,
|
|
&pdr->f_teid, &pdr->f_teid_len));
|
|
pdr->f_teid.teid = pdr->index;
|
|
}
|
|
}
|
|
}
|
|
|
|
ogs_pfcp_object_teid_hash_set(type, pdr);
|
|
}
|
|
}
|
|
|
|
/* Send Buffered Packet to gNB/SGW */
|
|
ogs_list_for_each(&sess->pfcp.pdr_list, pdr) {
|
|
if (pdr->src_if == OGS_PFCP_INTERFACE_CORE) { /* Downlink */
|
|
ogs_pfcp_send_buffered_packet(pdr);
|
|
}
|
|
}
|
|
|
|
ogs_assert(OGS_OK ==
|
|
upf_pfcp_send_session_modification_response(
|
|
xact, sess, created_pdr, num_of_created_pdr));
|
|
return;
|
|
|
|
cleanup:
|
|
ogs_pfcp_sess_clear(&sess->pfcp);
|
|
ogs_pfcp_send_error_message(xact, sess ? sess->smf_n4_seid : 0,
|
|
OGS_PFCP_SESSION_MODIFICATION_RESPONSE_TYPE,
|
|
cause_value, offending_ie_value);
|
|
}
|
|
|
|
void upf_n4_handle_session_deletion_request(
|
|
upf_sess_t *sess, ogs_pfcp_xact_t *xact,
|
|
ogs_pfcp_session_deletion_request_t *req)
|
|
{
|
|
ogs_assert(xact);
|
|
ogs_assert(req);
|
|
|
|
ogs_debug("Session Deletion Request");
|
|
|
|
if (!sess) {
|
|
ogs_error("No Context");
|
|
ogs_pfcp_send_error_message(xact, 0,
|
|
OGS_PFCP_SESSION_DELETION_RESPONSE_TYPE,
|
|
OGS_PFCP_CAUSE_SESSION_CONTEXT_NOT_FOUND, 0);
|
|
return;
|
|
}
|
|
|
|
ogs_assert(sess);
|
|
|
|
upf_pfcp_send_session_deletion_response(xact, sess);
|
|
|
|
upf_sess_remove(sess);
|
|
}
|
|
|
|
void upf_n4_handle_session_report_response(
|
|
upf_sess_t *sess, ogs_pfcp_xact_t *xact,
|
|
ogs_pfcp_session_report_response_t *rsp)
|
|
{
|
|
uint8_t cause_value = 0;
|
|
|
|
ogs_assert(xact);
|
|
ogs_assert(rsp);
|
|
|
|
ogs_pfcp_xact_commit(xact);
|
|
|
|
ogs_debug("Session Report Response");
|
|
|
|
cause_value = OGS_PFCP_CAUSE_REQUEST_ACCEPTED;
|
|
|
|
if (!sess) {
|
|
ogs_warn("No Context");
|
|
cause_value = OGS_PFCP_CAUSE_SESSION_CONTEXT_NOT_FOUND;
|
|
}
|
|
|
|
if (rsp->cause.presence) {
|
|
if (rsp->cause.u8 != OGS_PFCP_CAUSE_REQUEST_ACCEPTED) {
|
|
ogs_error("PFCP Cause[%d] : Not Accepted", rsp->cause.u8);
|
|
cause_value = rsp->cause.u8;
|
|
}
|
|
} else {
|
|
ogs_error("No Cause");
|
|
cause_value = OGS_PFCP_CAUSE_MANDATORY_IE_MISSING;
|
|
}
|
|
|
|
if (cause_value != OGS_PFCP_CAUSE_REQUEST_ACCEPTED) {
|
|
ogs_error("Cause request not accepted[%d]", cause_value);
|
|
return;
|
|
}
|
|
}
|