Move {LITE,MESH} NETWORK DRIVERS FROM openair2/NAS/DRIVER to openair2/NETWORK_DRIVER

git-svn-id: http://svn.eurecom.fr/openair4G/trunk@7150 818b1a75-f10b-46b9-bf7c-635c3b92a50f
2015-04-14 08:07:52 +00:00
parent ebc6ff983d
commit 0fc45b0cf1
39 changed files with 46 additions and 46 deletions
@@ -0,0 +1,207 @@
+/*******************************************************************************
+    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, and Raymond knopp
+* \company Eurecom
+* \email:navid.nikaein@eurecom.fr, lionel.gauthier@eurecom.fr, knopp@eurecom.fr
+*/
+
+#include <linux/version.h>
+
+//#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 NETLINK_DEBUG 1
+
+
+#define OAI_IP_DRIVER_NETLINK_ID 31
+#define NL_DEST_PID 1
+
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,6,0)
+struct netlink_kernel_cfg oai_netlink_cfg;
+#endif
+
+static struct sock *nas_nl_sk = NULL;
+static int exit_netlink_thread=0;
+static int nas_netlink_rx_thread(void *);
+
+
+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);
+}
+
+// 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("[OAI_IP_DRV][NETLINK] Received socket from PDCP\n");
+#endif //NETLINK_DEBUG
+    nlh = (struct nlmsghdr *)skb->data;
+    oai_nw_drv_common_wireless2ip(nlh);
+    //kfree_skb(skb); // not required,
+  }
+}
+
+
+int oai_nw_drv_netlink_init(void)
+{
+
+  printk("[OAI_IP_DRV][NETLINK] Running init ...\n");
+
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,6,0)
+  oai_netlink_cfg.groups   = 0;
+  oai_netlink_cfg.input    = nas_nl_data_ready;
+  oai_netlink_cfg.cb_mutex = &nasmesh_mutex;
+  oai_netlink_cfg.bind     = NULL;
+
+  nas_nl_sk = netlink_kernel_create(
+                &init_net,
+                OAI_IP_DRIVER_NETLINK_ID,
+# if LINUX_VERSION_CODE < KERNEL_VERSION(3,8,0)
+                THIS_MODULE,
+# endif
+                &oai_netlink_cfg);
+#else /* LINUX_VERSION_CODE >= KERNEL_VERSION(3,6,0) */
+  nas_nl_sk = netlink_kernel_create(
+                &init_net,
+                OAI_IP_DRIVER_NETLINK_ID,
+                0,
+                nas_nl_data_ready,
+                &nasmesh_mutex, // NULL
+                THIS_MODULE);
+#endif /* LINUX_VERSION_CODE >= KERNEL_VERSION(3,6,0) */
+
+  if (nas_nl_sk == NULL) {
+
+    printk("[OAI_IP_DRV][NETLINK] netlink_kernel_create failed \n");
+    return(-1);
+  }
+
+
+
+  return(0);
+
+}
+
+
+void oai_nw_drv_netlink_release(void)
+{
+
+  exit_netlink_thread=1;
+  printk("[OAI_IP_DRV][NETLINK] Releasing netlink socket\n");
+
+  if(nas_nl_sk) {
+    netlink_kernel_release(nas_nl_sk); //or skb->sk
+
+  }
+
+  //  printk("[OAI_IP_DRV][NETLINK] Removing netlink_rx_thread\n");
+  //kthread_stop(netlink_rx_thread);
+
+}
+
+
+
+
+int oai_nw_drv_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("[OAI_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 LINUX_VERSION_CODE >= KERNEL_VERSION(3,7,0)
+  NETLINK_CB(nl_skb).portid = 0;
+#else
+  NETLINK_CB(nl_skb).pid = 0;
+#endif
+
+#ifdef NETLINK_DEBUG
+  printk("[OAI_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("[OAI_IP_DRV][NETLINK] SEND status is %d\n",status);
+      return(0);
+    } else {
+#ifdef NETLINK_DEBUG
+      printk("[OAI_IP_DRV][NETLINK] SEND status is %d\n",status);
+#endif
+      return len;
+    }
+  } else {
+    printk("[OAI_IP_DRV][SEND] socket is NULL\n");
+    return(0);
+  }
+}