ghaddab
c23783c702
git-svn-id: http://svn.eurecom.fr/openair4G/trunk@5714 818b1a75-f10b-46b9-bf7c-635c3b92a50f
273 lines
6.5 KiB
C
Executable File
273 lines
6.5 KiB
C
Executable File
/*******************************************************************************
|
|
OpenAirInterface
|
|
Copyright(c) 1999 - 2014 Eurecom
|
|
|
|
OpenAirInterface is free software: you can redistribute it and/or modify
|
|
it under the terms of the GNU General Public License as published by
|
|
the Free Software Foundation, either version 3 of the License, or
|
|
(at your option) any later version.
|
|
|
|
|
|
OpenAirInterface 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 OpenAirInterface.The full GNU General Public License is
|
|
included in this distribution in the file called "COPYING". If not,
|
|
see <http://www.gnu.org/licenses/>.
|
|
|
|
Contact Information
|
|
OpenAirInterface Admin: openair_admin@eurecom.fr
|
|
OpenAirInterface Tech : openair_tech@eurecom.fr
|
|
OpenAirInterface Dev : openair4g-devel@eurecom.fr
|
|
|
|
Address : Eurecom, Campus SophiaTech, 450 Route des Chappes, CS 50193 - 06904 Biot Sophia Antipolis cedex, FRANCE
|
|
|
|
*******************************************************************************/
|
|
/*! \file netlink.c
|
|
* \brief establish a netlink
|
|
* \author Navid Nikaein, Lionel Gauthier, Raymond knopp
|
|
* \company Eurecom
|
|
* \email: navid.nikaein@eurecom.fr, lionel.gauthier@eurecom.fr, knopp@eurecom.fr
|
|
*/
|
|
|
|
//#include <linux/config.h>
|
|
#include <linux/socket.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/netlink.h>
|
|
#include <net/sock.h>
|
|
#include <linux/kthread.h>
|
|
#include <linux/mutex.h>
|
|
|
|
#include "local.h"
|
|
#include "proto_extern.h"
|
|
|
|
|
|
#define NAS_NETLINK_ID 31
|
|
#define NL_DEST_PID 1
|
|
|
|
/*******************************************************************************
|
|
Prototypes
|
|
*******************************************************************************/
|
|
static inline void nasmesh_lock(void);
|
|
static inline void nasmesh_unlock(void);
|
|
#ifdef KERNEL_VERSION_GREATER_THAN_2629
|
|
static void nas_nl_data_ready (struct sk_buff *skb);
|
|
#else
|
|
static int nas_netlink_rx_thread(void *data);
|
|
static void nas_nl_data_ready (struct sock *sk,int len);
|
|
#endif
|
|
int ue_ip_netlink_init(void);
|
|
|
|
static struct sock *nas_nl_sk = NULL;
|
|
static int exit_netlink_thread=0;
|
|
|
|
#ifdef KERNEL_VERSION_GREATER_THAN_3800
|
|
struct netlink_kernel_cfg cfg = {
|
|
.input = nas_nl_data_ready,
|
|
};
|
|
#endif
|
|
|
|
static DEFINE_MUTEX(nasmesh_mutex);
|
|
|
|
|
|
static inline void nasmesh_lock(void)
|
|
{
|
|
mutex_lock(&nasmesh_mutex);
|
|
}
|
|
|
|
static inline void nasmesh_unlock(void)
|
|
{
|
|
mutex_unlock(&nasmesh_mutex);
|
|
}
|
|
|
|
#ifdef KERNEL_VERSION_GREATER_THAN_2629
|
|
// This can also be implemented using thread to get the data from PDCP without blocking.
|
|
static void nas_nl_data_ready (struct sk_buff *skb)
|
|
{
|
|
// wake_up_interruptible(skb->sk->sk_sleep);
|
|
//nasmesh_lock();
|
|
//netlink_rcv_skb(skb, &my_rcv_msg);// my_rcv_msg is the call back func>
|
|
//nasmesh_unlock();
|
|
|
|
struct nlmsghdr *nlh = NULL;
|
|
if (skb) {
|
|
#ifdef NETLINK_DEBUG
|
|
printk("[UE_IP_DRV][NETLINK] Received socket from PDCP\n");
|
|
#endif //NETLINK_DEBUG
|
|
nlh = (struct nlmsghdr *)skb->data;
|
|
ue_ip_common_wireless2ip(nlh);
|
|
//kfree_skb(skb); // not required,
|
|
}
|
|
}
|
|
#else
|
|
|
|
static struct task_struct *netlink_rx_thread;
|
|
|
|
// this thread is used to avoid blocking other system calls from entering the kernel
|
|
static int nas_netlink_rx_thread(void *data) {
|
|
|
|
int err;
|
|
struct sk_buff *skb = NULL;
|
|
struct nlmsghdr *nlh = NULL;
|
|
|
|
printk("[UE_IP_DRV][NETLINK] Starting RX Thread \n");
|
|
|
|
while (!kthread_should_stop()) {
|
|
|
|
if (nas_nl_sk) {
|
|
skb = skb_recv_datagram(nas_nl_sk, 0, 0, &err);
|
|
|
|
if (skb) {
|
|
|
|
#ifdef NETLINK_DEBUG
|
|
printk("[UE_IP_DRV][NETLINK] Received socket from PDCP\n");
|
|
#endif //NETLINK_DEBUG
|
|
nlh = (struct nlmsghdr *)skb->data;
|
|
|
|
nas_COMMON_QOS_receive(nlh);
|
|
|
|
skb_free_datagram(nas_nl_sk,skb);
|
|
}
|
|
|
|
}
|
|
else {
|
|
if (exit_netlink_thread == 1) {
|
|
printk("[UE_IP_DRV][NETLINK] exit_netlink_thread\n");
|
|
break;
|
|
}
|
|
}
|
|
} // while
|
|
|
|
printk("[UE_IP_DRV][NETLINK] Exiting RX thread\n");
|
|
|
|
return(0);
|
|
|
|
}
|
|
|
|
static
|
|
void nas_nl_data_ready (
|
|
struct sock *sk,
|
|
int len)
|
|
|
|
{
|
|
wake_up_interruptible(sk->sk_sleep);
|
|
}
|
|
#endif
|
|
|
|
|
|
int ue_ip_netlink_init(void)
|
|
{
|
|
|
|
printk("[UE_IP_DRV][NETLINK] Running init ...\n");
|
|
|
|
nas_nl_sk = netlink_kernel_create(
|
|
#ifdef KERNEL_VERSION_GREATER_THAN_2622
|
|
&init_net,
|
|
#endif
|
|
#ifdef KERNEL_VERSION_GREATER_THAN_3800
|
|
NAS_NETLINK_ID,
|
|
&cfg
|
|
#else
|
|
NAS_NETLINK_ID,
|
|
0,
|
|
nas_nl_data_ready,
|
|
#ifdef KERNEL_VERSION_GREATER_THAN_2622
|
|
&nasmesh_mutex, // NULL
|
|
#endif
|
|
THIS_MODULE
|
|
#endif
|
|
);
|
|
|
|
|
|
if (nas_nl_sk == NULL) {
|
|
|
|
printk("[UE_IP_DRV][NETLINK] netlink_kernel_create failed \n");
|
|
return(-1);
|
|
}
|
|
|
|
#ifdef KERNEL_VERSION_GREATER_THAN_2629
|
|
|
|
#else
|
|
// Create receive thread
|
|
netlink_rx_thread = kthread_run(nas_netlink_rx_thread, NULL, "NAS_NETLINK_RX_THREAD");
|
|
#endif
|
|
|
|
return(0);
|
|
|
|
}
|
|
|
|
|
|
void ue_ip_netlink_release(void) {
|
|
|
|
exit_netlink_thread=1;
|
|
printk("[UE_IP_DRV][NETLINK] Releasing netlink socket\n");
|
|
|
|
if(nas_nl_sk){
|
|
#ifdef KERNEL_VERSION_GREATER_THAN_2629
|
|
netlink_kernel_release(nas_nl_sk); //or skb->sk
|
|
#else
|
|
sock_release(nas_nl_sk->sk_socket);
|
|
#endif
|
|
|
|
}
|
|
|
|
// printk("[UE_IP_DRV][NETLINK] Removing netlink_rx_thread\n");
|
|
//kthread_stop(netlink_rx_thread);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
int ue_ip_netlink_send(unsigned char *data,unsigned int len) {
|
|
|
|
|
|
struct sk_buff *nl_skb = alloc_skb(NLMSG_SPACE(len),GFP_ATOMIC);
|
|
struct nlmsghdr *nlh = (struct nlmsghdr *)nl_skb->data;
|
|
int status;
|
|
|
|
|
|
// printk("[UE_IP_DRV][NETLINK] Sending %d bytes (%d)\n",len,NLMSG_SPACE(len));
|
|
skb_put(nl_skb, NLMSG_SPACE(len));
|
|
memcpy(NLMSG_DATA(nlh),data,len);
|
|
|
|
nlh->nlmsg_len = NLMSG_SPACE(len);
|
|
|
|
|
|
nlh->nlmsg_pid = 0; /* from kernel */
|
|
|
|
#if !defined(KERNEL_VERSION_GREATER_THAN_3800)
|
|
NETLINK_CB(nl_skb).pid = 0;
|
|
#endif
|
|
|
|
#ifdef NETLINK_DEBUG
|
|
printk("[UE_IP_DRV][NETLINK] In nas_netlink_send, nl_skb %p, nl_sk %x, nlh %p, nlh->nlmsg_len %d\n",nl_skb,nas_nl_sk,nlh,nlh->nlmsg_len);
|
|
#endif //DEBUG_NETLINK
|
|
|
|
if (nas_nl_sk) {
|
|
|
|
// nasmesh_lock();
|
|
status = netlink_unicast(nas_nl_sk, nl_skb, NL_DEST_PID, MSG_DONTWAIT);
|
|
// mutex_unlock(&nasmesh_mutex);
|
|
|
|
if (status < 0) {
|
|
printk("[UE_IP_DRV][NETLINK] SEND status is %d\n",status);
|
|
return(0);
|
|
}
|
|
else {
|
|
#ifdef NETLINK_DEBUG
|
|
printk("[UE_IP_DRV][NETLINK] SEND status is %d\n",status);
|
|
#endif
|
|
return len;
|
|
}
|
|
}
|
|
else {
|
|
printk("[UE_IP_DRV][SEND] socket is NULL\n");
|
|
return(0);
|
|
}
|
|
}
|