mirror of https://github.com/pvnis/srsRAN_4G.git
You cannot select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
676 lines
19 KiB
C++
676 lines
19 KiB
C++
/**
|
|
*
|
|
* \section COPYRIGHT
|
|
*
|
|
* Copyright 2013-2017 Software Radio Systems Limited
|
|
*
|
|
* \section LICENSE
|
|
*
|
|
* This file is part of srsLTE.
|
|
*
|
|
* srsLTE 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.
|
|
*
|
|
* srsLTE 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 Affero General Public License for more details.
|
|
*
|
|
* A copy of the GNU Affero General Public License can be found in
|
|
* the LICENSE file in the top-level directory of this distribution
|
|
* and at http://www.gnu.org/licenses/.
|
|
*
|
|
*/
|
|
|
|
#include <iostream>
|
|
#include <algorithm>
|
|
#include <boost/thread/mutex.hpp>
|
|
#include <fcntl.h>
|
|
#include <sys/ioctl.h>
|
|
#include <netinet/in.h>
|
|
#include <sys/socket.h>
|
|
#include <linux/if.h>
|
|
#include <linux/if_tun.h>
|
|
#include <linux/ip.h>
|
|
#include "spgw/spgw.h"
|
|
#include "mme/mme_gtpc.h"
|
|
#include "srslte/upper/gtpu.h"
|
|
|
|
namespace srsepc{
|
|
|
|
spgw* spgw::m_instance = NULL;
|
|
pthread_mutex_t spgw_instance_mutex = PTHREAD_MUTEX_INITIALIZER;
|
|
|
|
const uint16_t SPGW_BUFFER_SIZE = 2500;
|
|
|
|
spgw::spgw():
|
|
m_running(false),
|
|
m_sgi_up(false),
|
|
m_s1u_up(false),
|
|
m_next_ctrl_teid(1),
|
|
m_next_user_teid(1)
|
|
{
|
|
return;
|
|
}
|
|
|
|
spgw::~spgw()
|
|
{
|
|
return;
|
|
}
|
|
|
|
spgw*
|
|
spgw::get_instance(void)
|
|
{
|
|
pthread_mutex_lock(&spgw_instance_mutex);
|
|
if(NULL == m_instance) {
|
|
m_instance = new spgw();
|
|
}
|
|
pthread_mutex_unlock(&spgw_instance_mutex);
|
|
return(m_instance);
|
|
}
|
|
|
|
void
|
|
spgw::cleanup(void)
|
|
{
|
|
pthread_mutex_lock(&spgw_instance_mutex);
|
|
if(NULL != m_instance) {
|
|
delete m_instance;
|
|
m_instance = NULL;
|
|
}
|
|
pthread_mutex_unlock(&spgw_instance_mutex);
|
|
}
|
|
|
|
int
|
|
spgw::init(spgw_args_t* args, srslte::log_filter *spgw_log)
|
|
{
|
|
srslte::error_t err;
|
|
m_pool = srslte::byte_buffer_pool::get_instance();
|
|
|
|
//Init log
|
|
m_spgw_log = spgw_log;
|
|
m_mme_gtpc = mme_gtpc::get_instance();
|
|
|
|
//Init SGi interface
|
|
err = init_sgi_if(args);
|
|
if (err != srslte::ERROR_NONE)
|
|
{
|
|
m_spgw_log->console("Could not initialize the SGi interface.\n");
|
|
return -1;
|
|
}
|
|
|
|
//Init S1-U
|
|
err = init_s1u(args);
|
|
if (err != srslte::ERROR_NONE)
|
|
{
|
|
m_spgw_log->console("Could not initialize the S1-U interface.\n");
|
|
return -1;
|
|
}
|
|
//Initialize UE ip pool
|
|
err = init_ue_ip(args);
|
|
if (err != srslte::ERROR_NONE)
|
|
{
|
|
m_spgw_log->console("Could not initialize the S1-U interface.\n");
|
|
return -1;
|
|
}
|
|
|
|
//Init mutex
|
|
pthread_mutex_init(&m_mutex,NULL);
|
|
m_spgw_log->info("SP-GW Initialized.\n");
|
|
m_spgw_log->console("SP-GW Initialized.\n");
|
|
return 0;
|
|
}
|
|
|
|
void
|
|
spgw::stop()
|
|
{
|
|
if(m_running)
|
|
{
|
|
m_running = false;
|
|
thread_cancel();
|
|
wait_thread_finish();
|
|
|
|
//Clean up SGi interface
|
|
if(m_sgi_up)
|
|
{
|
|
close(m_sgi_if);
|
|
close(m_sgi_sock);
|
|
}
|
|
//Clean up S1-U socket
|
|
if(m_s1u_up)
|
|
{
|
|
close(m_s1u);
|
|
}
|
|
}
|
|
std::map<uint32_t,spgw_tunnel_ctx*>::iterator it = m_teid_to_tunnel_ctx.begin(); //Map control TEID to tunnel ctx. Usefull to get reply ctrl TEID, UE IP, etc.
|
|
while(it!=m_teid_to_tunnel_ctx.end())
|
|
{
|
|
m_spgw_log->info("Deleting SP-GW GTP-C Tunnel. IMSI: %lu\n", it->second->imsi);
|
|
m_spgw_log->console("Deleting SP-GW GTP-C Tunnel. IMSI: %lu\n", it->second->imsi);
|
|
delete it->second;
|
|
m_teid_to_tunnel_ctx.erase(it++);
|
|
}
|
|
return;
|
|
}
|
|
|
|
srslte::error_t
|
|
spgw::init_sgi_if(spgw_args_t *args)
|
|
{
|
|
char dev[IFNAMSIZ] = "srs_spgw_sgi";
|
|
struct ifreq ifr;
|
|
|
|
if(m_sgi_up)
|
|
{
|
|
return(srslte::ERROR_ALREADY_STARTED);
|
|
}
|
|
|
|
|
|
// Construct the TUN device
|
|
m_sgi_if = open("/dev/net/tun", O_RDWR);
|
|
m_spgw_log->info("TUN file descriptor = %d\n", m_sgi_if);
|
|
if(m_sgi_if < 0)
|
|
{
|
|
m_spgw_log->error("Failed to open TUN device: %s\n", strerror(errno));
|
|
return(srslte::ERROR_CANT_START);
|
|
}
|
|
|
|
memset(&ifr, 0, sizeof(ifr));
|
|
ifr.ifr_flags = IFF_TUN | IFF_NO_PI;
|
|
strncpy(ifr.ifr_ifrn.ifrn_name, dev, IFNAMSIZ-1);
|
|
ifr.ifr_ifrn.ifrn_name[IFNAMSIZ-1]='\0';
|
|
|
|
if(ioctl(m_sgi_if, TUNSETIFF, &ifr) < 0)
|
|
{
|
|
m_spgw_log->error("Failed to set TUN device name: %s\n", strerror(errno));
|
|
close(m_sgi_if);
|
|
return(srslte::ERROR_CANT_START);
|
|
}
|
|
|
|
// Bring up the interface
|
|
m_sgi_sock = socket(AF_INET, SOCK_DGRAM, 0);
|
|
|
|
if(ioctl(m_sgi_sock, SIOCGIFFLAGS, &ifr) < 0)
|
|
{
|
|
m_spgw_log->error("Failed to bring up socket: %s\n", strerror(errno));
|
|
close(m_sgi_if);
|
|
return(srslte::ERROR_CANT_START);
|
|
}
|
|
ifr.ifr_flags |= IFF_UP | IFF_RUNNING;
|
|
if(ioctl(m_sgi_sock, SIOCSIFFLAGS, &ifr) < 0)
|
|
{
|
|
m_spgw_log->error("Failed to set socket flags: %s\n", strerror(errno));
|
|
close(m_sgi_if);
|
|
return(srslte::ERROR_CANT_START);
|
|
}
|
|
|
|
//Set IP of the interface
|
|
struct sockaddr_in *addr = (struct sockaddr_in*)&ifr.ifr_addr;
|
|
addr->sin_family = AF_INET;
|
|
addr->sin_addr.s_addr = inet_addr(args->sgi_if_addr.c_str());
|
|
addr->sin_port = 0;
|
|
|
|
if (ioctl(m_sgi_sock, SIOCSIFADDR, &ifr) < 0) {
|
|
m_spgw_log->error("Failed to set TUN interface IP. Address: %s, Error: %s\n", args->sgi_if_addr.c_str(), strerror(errno));
|
|
close(m_sgi_if);
|
|
close(m_sgi_sock);
|
|
return srslte::ERROR_CANT_START;
|
|
}
|
|
|
|
ifr.ifr_netmask.sa_family = AF_INET;
|
|
((struct sockaddr_in *)&ifr.ifr_netmask)->sin_addr.s_addr = inet_addr("255.255.255.0");
|
|
if (ioctl(m_sgi_sock, SIOCSIFNETMASK, &ifr) < 0) {
|
|
m_spgw_log->error("Failed to set TUN interface Netmask. Error: %s\n", strerror(errno));
|
|
close(m_sgi_if);
|
|
close(m_sgi_sock);
|
|
return srslte::ERROR_CANT_START;
|
|
}
|
|
|
|
//Set initial time of setup
|
|
gettimeofday(&m_t_last_dl, NULL);
|
|
|
|
m_sgi_up = true;
|
|
return(srslte::ERROR_NONE);
|
|
}
|
|
|
|
srslte::error_t
|
|
spgw::init_s1u(spgw_args_t *args)
|
|
{
|
|
//Open S1-U socket
|
|
m_s1u = socket(AF_INET,SOCK_DGRAM,0);
|
|
if (m_s1u == -1)
|
|
{
|
|
m_spgw_log->error("Failed to open socket: %s\n", strerror(errno));
|
|
return srslte::ERROR_CANT_START;
|
|
}
|
|
m_s1u_up = true;
|
|
|
|
//Bind the socket
|
|
m_s1u_addr.sin_family = AF_INET;
|
|
m_s1u_addr.sin_addr.s_addr=inet_addr(args->gtpu_bind_addr.c_str());
|
|
m_s1u_addr.sin_port=htons(GTPU_RX_PORT);
|
|
|
|
if (bind(m_s1u,(struct sockaddr *)&m_s1u_addr,sizeof(struct sockaddr_in))) {
|
|
m_spgw_log->error("Failed to bind socket: %s\n", strerror(errno));
|
|
return srslte::ERROR_CANT_START;
|
|
}
|
|
m_spgw_log->info("S1-U socket = %d\n", m_s1u);
|
|
m_spgw_log->info("S1-U IP = %s, Port = %d \n", inet_ntoa(m_s1u_addr.sin_addr),ntohs(m_s1u_addr.sin_port));
|
|
|
|
return srslte::ERROR_NONE;
|
|
}
|
|
|
|
srslte::error_t
|
|
spgw::init_ue_ip(spgw_args_t *args)
|
|
{
|
|
m_h_next_ue_ip = ntohl(inet_addr(args->sgi_if_addr.c_str()));
|
|
return srslte::ERROR_NONE;
|
|
}
|
|
|
|
void
|
|
spgw::run_thread()
|
|
{
|
|
//Mark the thread as running
|
|
m_running=true;
|
|
srslte::byte_buffer_t *msg;
|
|
msg = m_pool->allocate();
|
|
|
|
struct sockaddr src_addr;
|
|
socklen_t addrlen;
|
|
struct iphdr *ip_pkt;
|
|
int sgi = m_sgi_if;
|
|
|
|
fd_set set;
|
|
//struct timeval to;
|
|
int max_fd = std::max(m_s1u,sgi);
|
|
while (m_running)
|
|
{
|
|
msg->reset();
|
|
FD_ZERO(&set);
|
|
FD_SET(m_s1u, &set);
|
|
FD_SET(sgi, &set);
|
|
|
|
//m_spgw_log->info("Waiting for S1-U or SGi packets.\n");
|
|
int n = select(max_fd+1, &set, NULL, NULL, NULL);
|
|
if (n == -1)
|
|
{
|
|
m_spgw_log->error("Error from select\n");
|
|
}
|
|
else if (n)
|
|
{
|
|
//m_spgw_log->info("Data is available now.\n");
|
|
if (FD_ISSET(m_s1u, &set))
|
|
{
|
|
msg->N_bytes = recvfrom(m_s1u, msg->msg, SRSLTE_MAX_BUFFER_SIZE_BYTES, 0, &src_addr, &addrlen );
|
|
handle_s1u_pdu(msg);
|
|
}
|
|
if (FD_ISSET(m_sgi_if, &set))
|
|
{
|
|
msg->N_bytes = read(sgi, msg->msg, SRSLTE_MAX_BUFFER_SIZE_BYTES);
|
|
handle_sgi_pdu(msg);
|
|
}
|
|
}
|
|
else
|
|
{
|
|
m_spgw_log->debug("No data from select.\n");
|
|
}
|
|
}
|
|
m_pool->deallocate(msg);
|
|
return;
|
|
}
|
|
|
|
void
|
|
spgw::handle_sgi_pdu(srslte::byte_buffer_t *msg)
|
|
{
|
|
uint8_t version=0;
|
|
uint32_t dest_ip;
|
|
struct in_addr dest_addr;
|
|
std::map<uint32_t,srslte::gtpc_f_teid_ie>::iterator gtp_fteid_it;
|
|
bool ip_found = false;
|
|
srslte::gtpc_f_teid_ie enb_fteid;
|
|
|
|
struct timeval t_now, t_delta;
|
|
|
|
version = msg->msg[0]>>4;
|
|
((uint8_t*)&dest_ip)[0] = msg->msg[16];
|
|
((uint8_t*)&dest_ip)[1] = msg->msg[17];
|
|
((uint8_t*)&dest_ip)[2] = msg->msg[18];
|
|
((uint8_t*)&dest_ip)[3] = msg->msg[19];
|
|
|
|
dest_addr.s_addr = dest_ip;
|
|
|
|
//m_spgw_log->console("IP version: %d\n", version);
|
|
//m_spgw_log->console("Received packet to IP: %s\n", inet_ntoa(dest_addr));
|
|
|
|
pthread_mutex_lock(&m_mutex);
|
|
gtp_fteid_it = m_ip_to_teid.find(dest_ip);
|
|
if(gtp_fteid_it != m_ip_to_teid.end())
|
|
{
|
|
ip_found = true;
|
|
enb_fteid = gtp_fteid_it->second;
|
|
}
|
|
pthread_mutex_unlock(&m_mutex);
|
|
|
|
if(ip_found == false)
|
|
{
|
|
//m_spgw_log->console("IP Packet is not for any UE\n");
|
|
return;
|
|
}
|
|
struct sockaddr_in enb_addr;
|
|
enb_addr.sin_family = AF_INET;
|
|
enb_addr.sin_port = htons(GTPU_RX_PORT);
|
|
enb_addr.sin_addr.s_addr = enb_fteid.ipv4;
|
|
//m_spgw_log->console("UE F-TEID found, TEID 0x%x, eNB IP %s\n", enb_fteid.teid, inet_ntoa(enb_addr.sin_addr));
|
|
|
|
//Setup GTP-U header
|
|
srslte::gtpu_header_t header;
|
|
header.flags = 0x30;
|
|
header.message_type = 0xFF;
|
|
header.length = msg->N_bytes;
|
|
header.teid = enb_fteid.teid;
|
|
|
|
//Write header into packet
|
|
if(!srslte::gtpu_write_header(&header, msg))
|
|
{
|
|
m_spgw_log->console("Error writing GTP-U header on PDU\n");
|
|
}
|
|
|
|
|
|
//Send packet to destination
|
|
int n = sendto(m_s1u,msg->msg,msg->N_bytes,0,(struct sockaddr*) &enb_addr,sizeof(enb_addr));
|
|
if(n<0)
|
|
{
|
|
m_spgw_log->error("Error sending packet to eNB\n");
|
|
return;
|
|
}
|
|
else if((unsigned int) n!=msg->N_bytes)
|
|
{
|
|
m_spgw_log->error("Mis-match between packet bytes and sent bytes: Sent: %d, Packet: %d \n",n,msg->N_bytes);
|
|
}
|
|
|
|
gettimeofday(&t_now, NULL);
|
|
t_delta.tv_sec = t_now.tv_sec - m_t_last_dl.tv_sec;
|
|
t_delta.tv_usec = t_now.tv_sec - m_t_last_dl.tv_usec;
|
|
if(t_delta.tv_sec>=5)
|
|
{
|
|
m_t_last_dl = t_now;
|
|
m_spgw_log->console("Sent %d bytes DL over the last %d.%d seconds. Bitrate = \n",msg->N_bytes, t_delta.tv_sec, t_delta.tv_usec/1000);
|
|
}
|
|
return;
|
|
}
|
|
|
|
|
|
void
|
|
spgw::handle_s1u_pdu(srslte::byte_buffer_t *msg)
|
|
{
|
|
//m_spgw_log->console("Received PDU from S1-U. Bytes=%d\n",msg->N_bytes);
|
|
srslte::gtpu_header_t header;
|
|
srslte::gtpu_read_header(msg, &header);
|
|
|
|
//m_spgw_log->console("TEID 0x%x. Bytes=%d\n", header.teid, msg->N_bytes);
|
|
int n = write(m_sgi_if, msg->msg, msg->N_bytes);
|
|
if(n<0)
|
|
{
|
|
m_spgw_log->error("Could not write to TUN interface.\n",n);
|
|
}
|
|
else
|
|
{
|
|
//m_spgw_log->console("Forwarded packet to TUN interface. Bytes= %d/%d\n", n, msg->N_bytes);
|
|
}
|
|
return;
|
|
}
|
|
|
|
/*
|
|
* Helper Functions
|
|
*/
|
|
uint64_t
|
|
spgw::get_new_ctrl_teid()
|
|
{
|
|
return m_next_ctrl_teid++;
|
|
}
|
|
|
|
uint64_t
|
|
spgw::get_new_user_teid()
|
|
{
|
|
return m_next_user_teid++;
|
|
}
|
|
|
|
in_addr_t
|
|
spgw::get_new_ue_ipv4()
|
|
{
|
|
m_h_next_ue_ip++;
|
|
return ntohl(m_h_next_ue_ip);//FIXME Tmp hack
|
|
}
|
|
|
|
spgw_tunnel_ctx_t*
|
|
spgw::create_gtp_ctx(struct srslte::gtpc_create_session_request *cs_req)
|
|
{
|
|
//Setup uplink control TEID
|
|
uint64_t spgw_uplink_ctrl_teid = get_new_ctrl_teid();
|
|
//Setup uplink user TEID
|
|
uint64_t spgw_uplink_user_teid = get_new_user_teid();
|
|
//Allocate UE IP
|
|
in_addr_t ue_ip = get_new_ue_ipv4();
|
|
//in_addr_t ue_ip = inet_addr("172.16.0.2");
|
|
uint8_t default_bearer_id = 5;
|
|
|
|
m_spgw_log->console("SPGW: Allocated Ctrl TEID %d\n", spgw_uplink_ctrl_teid);
|
|
m_spgw_log->console("SPGW: Allocated User TEID %d\n", spgw_uplink_user_teid);
|
|
struct in_addr ue_ip_;
|
|
ue_ip_.s_addr=ue_ip;
|
|
m_spgw_log->console("SPGW: Allocate UE IP %s\n", inet_ntoa(ue_ip_));
|
|
|
|
|
|
//Save the UE IP to User TEID map
|
|
spgw_tunnel_ctx_t *tunnel_ctx = new spgw_tunnel_ctx_t;
|
|
bzero(tunnel_ctx,sizeof(spgw_tunnel_ctx_t));
|
|
|
|
tunnel_ctx->imsi = cs_req->imsi;
|
|
tunnel_ctx->ebi = default_bearer_id;
|
|
tunnel_ctx->up_user_fteid.teid = spgw_uplink_user_teid;
|
|
tunnel_ctx->up_user_fteid.ipv4 = m_s1u_addr.sin_addr.s_addr;
|
|
tunnel_ctx->dw_ctrl_fteid.teid = cs_req->sender_f_teid.teid;
|
|
tunnel_ctx->dw_ctrl_fteid.ipv4 = cs_req->sender_f_teid.ipv4;
|
|
|
|
tunnel_ctx->up_ctrl_fteid.teid = spgw_uplink_ctrl_teid;
|
|
tunnel_ctx->ue_ipv4 = ue_ip;
|
|
m_teid_to_tunnel_ctx.insert(std::pair<uint32_t,spgw_tunnel_ctx_t*>(spgw_uplink_ctrl_teid,tunnel_ctx));
|
|
m_imsi_to_ctr_teid.insert(std::pair<uint64_t,uint32_t>(cs_req->imsi,spgw_uplink_ctrl_teid));
|
|
return tunnel_ctx;
|
|
}
|
|
|
|
bool
|
|
spgw::delete_gtp_ctx(uint32_t ctrl_teid)
|
|
{
|
|
spgw_tunnel_ctx_t *tunnel_ctx;
|
|
if(!m_teid_to_tunnel_ctx.count(ctrl_teid)){
|
|
m_spgw_log->error("Could not find GTP context to delete.\n");
|
|
return false;
|
|
}
|
|
tunnel_ctx = m_teid_to_tunnel_ctx[ctrl_teid];
|
|
|
|
//Remove GTP-U connections, if any.
|
|
if(m_ip_to_teid.count(tunnel_ctx->ue_ipv4))
|
|
{
|
|
pthread_mutex_lock(&m_mutex);
|
|
m_ip_to_teid.erase(tunnel_ctx->ue_ipv4);
|
|
pthread_mutex_unlock(&m_mutex);
|
|
}
|
|
//Remove Ctrl TEID from IMSI to control TEID map
|
|
m_imsi_to_ctr_teid.erase(tunnel_ctx->imsi);
|
|
|
|
//Remove GTP context from control TEID mapping
|
|
m_teid_to_tunnel_ctx.erase(ctrl_teid);
|
|
delete tunnel_ctx;
|
|
return true;
|
|
}
|
|
|
|
void
|
|
spgw::handle_create_session_request(struct srslte::gtpc_create_session_request *cs_req, struct srslte::gtpc_pdu *cs_resp_pdu)
|
|
{
|
|
m_spgw_log->info("Received Create Session Request\n");
|
|
spgw_tunnel_ctx_t *tunnel_ctx;
|
|
int default_bearer_id = 5;
|
|
//Check if IMSI has active GTP-C and/or GTP-U
|
|
bool gtpc_present = m_imsi_to_ctr_teid.count(cs_req->imsi);
|
|
if(gtpc_present)
|
|
{
|
|
m_spgw_log->console("SPGW: GTP-C context for IMSI %015ul already exists.\n", cs_req->imsi);
|
|
delete_gtp_ctx(m_imsi_to_ctr_teid[cs_req->imsi]);
|
|
m_spgw_log->console("SPGW: Deleted previous context.\n");
|
|
}
|
|
|
|
m_spgw_log->info("Creating new GTP-C context\n");
|
|
tunnel_ctx = create_gtp_ctx(cs_req);
|
|
|
|
//Create session response message
|
|
srslte::gtpc_header *header = &cs_resp_pdu->header;
|
|
srslte::gtpc_create_session_response *cs_resp = &cs_resp_pdu->choice.create_session_response;
|
|
|
|
//Setup GTP-C header
|
|
header->piggyback = false;
|
|
header->teid_present = true;
|
|
header->teid = tunnel_ctx->dw_ctrl_fteid.teid; //Send create session requesponse to the UE's MME Ctrl TEID
|
|
header->type = srslte::GTPC_MSG_TYPE_CREATE_SESSION_RESPONSE;
|
|
|
|
//Initialize to zero
|
|
bzero(cs_resp,sizeof(struct srslte::gtpc_create_session_response));
|
|
//Setup Cause
|
|
cs_resp->cause.cause_value = srslte::GTPC_CAUSE_VALUE_REQUEST_ACCEPTED;
|
|
//Setup sender F-TEID (ctrl)
|
|
cs_resp->sender_f_teid.ipv4_present = true;
|
|
cs_resp->sender_f_teid = tunnel_ctx->up_ctrl_fteid;
|
|
|
|
//Bearer context created
|
|
cs_resp->eps_bearer_context_created.ebi = default_bearer_id;
|
|
cs_resp->eps_bearer_context_created.cause.cause_value = srslte::GTPC_CAUSE_VALUE_REQUEST_ACCEPTED;
|
|
cs_resp->eps_bearer_context_created.s1_u_sgw_f_teid_present=true;
|
|
cs_resp->eps_bearer_context_created.s1_u_sgw_f_teid = tunnel_ctx->up_user_fteid;
|
|
//Fill in the PAA
|
|
cs_resp->paa_present = true;
|
|
cs_resp->paa.pdn_type = srslte::GTPC_PDN_TYPE_IPV4;
|
|
cs_resp->paa.ipv4_present = true;
|
|
cs_resp->paa.ipv4 = tunnel_ctx->ue_ipv4;
|
|
m_spgw_log->info("Sending Create Session Response\n");
|
|
m_mme_gtpc->handle_create_session_response(cs_resp_pdu);
|
|
return;
|
|
}
|
|
|
|
|
|
|
|
|
|
void
|
|
spgw::handle_modify_bearer_request(struct srslte::gtpc_pdu *mb_req_pdu, struct srslte::gtpc_pdu *mb_resp_pdu)
|
|
{
|
|
m_spgw_log->info("Received Modified Bearer Request\n");
|
|
|
|
//Get control tunnel info from mb_req PDU
|
|
uint32_t ctrl_teid = mb_req_pdu->header.teid;
|
|
std::map<uint32_t,spgw_tunnel_ctx_t*>::iterator tunnel_it = m_teid_to_tunnel_ctx.find(ctrl_teid);
|
|
if(tunnel_it == m_teid_to_tunnel_ctx.end())
|
|
{
|
|
m_spgw_log->warning("Could not find TEID %d to modify\n",ctrl_teid);
|
|
return;
|
|
}
|
|
spgw_tunnel_ctx_t *tunnel_ctx = tunnel_it->second;
|
|
|
|
//Store user DW link TEID
|
|
srslte::gtpc_modify_bearer_request *mb_req = &mb_req_pdu->choice.modify_bearer_request;
|
|
tunnel_ctx->dw_user_fteid.teid = mb_req->eps_bearer_context_to_modify.s1_u_enb_f_teid.teid;
|
|
tunnel_ctx->dw_user_fteid.ipv4 = mb_req->eps_bearer_context_to_modify.s1_u_enb_f_teid.ipv4;
|
|
//Set up actual tunnel
|
|
m_spgw_log->info("Setting Up GTP-U tunnel. Tunnel info: \n");
|
|
struct in_addr addr;
|
|
addr.s_addr = tunnel_ctx->ue_ipv4;
|
|
m_spgw_log->info("IMSI: %lu, UE IP, %s \n",tunnel_ctx->imsi, inet_ntoa(addr));
|
|
m_spgw_log->info("S-GW Rx Ctrl TEID 0x%x, MME Rx Ctrl TEID 0x%x\n", tunnel_ctx->up_ctrl_fteid.teid, tunnel_ctx->dw_ctrl_fteid.teid);
|
|
m_spgw_log->info("S-GW Rx Ctrl IP (NA), MME Rx Ctrl IP (NA)\n");
|
|
|
|
struct in_addr addr2;
|
|
addr2.s_addr = tunnel_ctx->up_user_fteid.ipv4;
|
|
m_spgw_log->info("S-GW Rx User TEID 0x%x, S-GW Rx User IP %s\n", tunnel_ctx->up_user_fteid.teid, inet_ntoa(addr2));
|
|
|
|
struct in_addr addr3;
|
|
addr3.s_addr = tunnel_ctx->dw_user_fteid.ipv4;
|
|
m_spgw_log->info("eNB Rx User TEID 0x%x, eNB Rx User IP %s\n", tunnel_ctx->dw_user_fteid.teid, inet_ntoa(addr3));
|
|
|
|
//Setup IP to F-TEID map
|
|
//bool ret = false;
|
|
pthread_mutex_lock(&m_mutex);
|
|
m_ip_to_teid[tunnel_ctx->ue_ipv4]=tunnel_ctx->dw_user_fteid;
|
|
//ret = m_ip_to_teid.insert(std::pair<uint32_t,srslte::gtpc_f_teid_ie>(tunnel_ctx->ue_ipv4, tunnel_ctx->dw_user_fteid));
|
|
pthread_mutex_unlock(&m_mutex);
|
|
|
|
//Setting up Modify bearer response PDU
|
|
//Header
|
|
srslte::gtpc_header *header = &mb_resp_pdu->header;
|
|
header->piggyback = false;
|
|
header->teid_present = true;
|
|
header->teid = tunnel_ctx->dw_ctrl_fteid.teid; //
|
|
header->type = srslte::GTPC_MSG_TYPE_MODIFY_BEARER_RESPONSE;
|
|
|
|
//PDU
|
|
srslte::gtpc_modify_bearer_response *mb_resp = &mb_resp_pdu->choice.modify_bearer_response;
|
|
mb_resp->cause.cause_value = srslte::GTPC_CAUSE_VALUE_REQUEST_ACCEPTED;
|
|
mb_resp->eps_bearer_context_modified.ebi = tunnel_ctx->ebi;
|
|
//printf("%d %d\n",mb_resp->eps_bearer_context_modified.ebi, tunnel_ctx->ebi);
|
|
mb_resp->eps_bearer_context_modified.cause.cause_value = srslte::GTPC_CAUSE_VALUE_REQUEST_ACCEPTED;
|
|
}
|
|
|
|
void
|
|
spgw::handle_delete_session_request(struct srslte::gtpc_pdu *del_req_pdu, struct srslte::gtpc_pdu *del_resp_pdu)
|
|
{
|
|
//Find tunel ctxt
|
|
uint32_t ctrl_teid = del_req_pdu->header.teid;
|
|
std::map<uint32_t,spgw_tunnel_ctx_t*>::iterator tunnel_it = m_teid_to_tunnel_ctx.find(ctrl_teid);
|
|
if(tunnel_it == m_teid_to_tunnel_ctx.end())
|
|
{
|
|
m_spgw_log->warning("Could not find TEID %d to delete\n",ctrl_teid);
|
|
return;
|
|
}
|
|
spgw_tunnel_ctx_t *tunnel_ctx = tunnel_it->second;
|
|
in_addr_t ue_ipv4 = tunnel_ctx->ue_ipv4;
|
|
|
|
//Delete data tunnel
|
|
pthread_mutex_lock(&m_mutex);
|
|
std::map<in_addr_t,srslte::gtp_fteid_t>::iterator data_it = m_ip_to_teid.find(tunnel_ctx->ue_ipv4);
|
|
if(data_it != m_ip_to_teid.end())
|
|
{
|
|
m_ip_to_teid.erase(data_it);
|
|
}
|
|
pthread_mutex_unlock(&m_mutex);
|
|
m_teid_to_tunnel_ctx.erase(tunnel_it);
|
|
|
|
delete tunnel_ctx;
|
|
return;
|
|
}
|
|
|
|
void
|
|
spgw::handle_release_access_bearers_request(struct srslte::gtpc_pdu *rel_req_pdu, struct srslte::gtpc_pdu *rel_resp_pdu)
|
|
{
|
|
//Find tunel ctxt
|
|
uint32_t ctrl_teid = rel_req_pdu->header.teid;
|
|
std::map<uint32_t,spgw_tunnel_ctx_t*>::iterator tunnel_it = m_teid_to_tunnel_ctx.find(ctrl_teid);
|
|
if(tunnel_it == m_teid_to_tunnel_ctx.end())
|
|
{
|
|
m_spgw_log->warning("Could not find TEID %d to release bearers from\n",ctrl_teid);
|
|
return;
|
|
}
|
|
spgw_tunnel_ctx_t *tunnel_ctx = tunnel_it->second;
|
|
in_addr_t ue_ipv4 = tunnel_ctx->ue_ipv4;
|
|
|
|
//Delete data tunnel
|
|
pthread_mutex_lock(&m_mutex);
|
|
std::map<in_addr_t,srslte::gtpc_f_teid_ie>::iterator data_it = m_ip_to_teid.find(tunnel_ctx->ue_ipv4);
|
|
if(data_it != m_ip_to_teid.end())
|
|
{
|
|
m_ip_to_teid.erase(data_it);
|
|
}
|
|
pthread_mutex_unlock(&m_mutex);
|
|
|
|
//Do NOT delete control tunnel
|
|
return;
|
|
}
|
|
|
|
} //namespace srsepc
|