2014-09-10 21:58:23 +02:00
|
|
|
#include "config.h"
|
2014-06-01 16:32:30 +02:00
|
|
|
#include <linux/module.h>
|
|
|
|
#include <linux/rtnetlink.h>
|
2014-09-10 21:58:23 +02:00
|
|
|
#include <linux/netdevice.h>
|
2014-06-01 16:32:30 +02:00
|
|
|
#include <linux/netlink.h>
|
|
|
|
#include <net/genetlink.h>
|
|
|
|
#include <linux/rcupdate.h>
|
2014-06-04 22:58:34 +02:00
|
|
|
#include <linux/err.h>
|
|
|
|
#include <net/mac80211.h>
|
2014-06-09 22:30:04 +02:00
|
|
|
#include <linux/ieee80211.h>
|
2014-06-01 16:32:30 +02:00
|
|
|
#include "nlsmartcapwap.h"
|
|
|
|
#include "netlinkapp.h"
|
2014-09-10 21:58:23 +02:00
|
|
|
#include "capwap.h"
|
2014-06-01 16:32:30 +02:00
|
|
|
|
|
|
|
/* */
|
2014-09-10 21:58:23 +02:00
|
|
|
struct sc_netlink_device {
|
2014-06-04 22:58:34 +02:00
|
|
|
struct list_head list;
|
|
|
|
struct ieee80211_pcktunnel pcktunnel_handler;
|
|
|
|
|
2014-09-10 21:58:23 +02:00
|
|
|
uint32_t ifindex;
|
|
|
|
uint8_t radioid;
|
|
|
|
uint8_t wlanid;
|
|
|
|
uint8_t binding;
|
|
|
|
struct net_device* dev;
|
|
|
|
uint32_t flags;
|
2014-06-04 22:58:34 +02:00
|
|
|
};
|
2014-06-01 16:32:30 +02:00
|
|
|
|
|
|
|
/* */
|
2014-09-10 21:58:23 +02:00
|
|
|
static uint32_t sc_netlink_usermodeid;
|
|
|
|
static LIST_HEAD(sc_netlink_dev_list);
|
2014-06-01 16:32:30 +02:00
|
|
|
|
|
|
|
/* */
|
2014-09-10 21:58:23 +02:00
|
|
|
static int sc_netlink_pre_doit(__genl_const struct genl_ops* ops, struct sk_buff* skb, struct genl_info* info) {
|
|
|
|
TRACEKMOD("### sc_netlink_pre_doit\n");
|
|
|
|
|
2014-06-07 22:37:19 +02:00
|
|
|
rtnl_lock();
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* */
|
2014-09-10 21:58:23 +02:00
|
|
|
static void sc_netlink_post_doit(__genl_const struct genl_ops* ops, struct sk_buff* skb, struct genl_info* info) {
|
|
|
|
TRACEKMOD("### sc_netlink_post_doit\n");
|
|
|
|
|
2014-06-07 22:37:19 +02:00
|
|
|
rtnl_unlock();
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Netlink Family */
|
2014-09-10 21:58:23 +02:00
|
|
|
static struct genl_family sc_netlink_family = {
|
2014-06-07 22:37:19 +02:00
|
|
|
.id = GENL_ID_GENERATE,
|
2014-09-10 21:58:23 +02:00
|
|
|
.name = NLSMARTCAPWAP_GENL_NAME,
|
2014-06-07 22:37:19 +02:00
|
|
|
.hdrsize = 0,
|
|
|
|
.version = 1,
|
|
|
|
.maxattr = NLSMARTCAPWAP_ATTR_MAX,
|
|
|
|
.netnsok = true,
|
2014-09-10 21:58:23 +02:00
|
|
|
.pre_doit = sc_netlink_pre_doit,
|
|
|
|
.post_doit = sc_netlink_post_doit,
|
2014-06-07 22:37:19 +02:00
|
|
|
};
|
|
|
|
|
|
|
|
/* */
|
2014-09-10 21:58:23 +02:00
|
|
|
static int sc_netlink_handler(uint32_t ifindex, struct sk_buff* skb, int sig_dbm, unsigned char rate, void* data) {
|
|
|
|
int ret = 0;
|
|
|
|
struct sc_netlink_device* nldev = (struct sc_netlink_device*)data;
|
2014-06-07 22:37:19 +02:00
|
|
|
struct ieee80211_hdr* hdr = (struct ieee80211_hdr*)skb->data;
|
|
|
|
|
2014-09-10 21:58:23 +02:00
|
|
|
TRACEKMOD("### sc_netlink_handler\n");
|
|
|
|
|
2014-06-09 22:30:04 +02:00
|
|
|
/* IEEE802.11 Data Packet */
|
|
|
|
if (ieee80211_is_data(hdr->frame_control)) {
|
2014-09-10 21:58:23 +02:00
|
|
|
int err;
|
|
|
|
struct sc_capwap_session* session;
|
|
|
|
unsigned char radioaddrbuffer[CAPWAP_RADIO_EUI48_LENGTH_PADDED];
|
|
|
|
unsigned char winfobuffer[CAPWAP_WINFO_FRAMEINFO_LENGTH_PADDED];
|
|
|
|
struct sc_capwap_radio_addr* radioaddr = NULL;
|
|
|
|
struct sc_capwap_wireless_information* winfo = NULL;
|
|
|
|
|
|
|
|
printk("*** receive packet\n");
|
|
|
|
|
|
|
|
/* Drop packet */
|
|
|
|
ret = -1;
|
|
|
|
|
|
|
|
/* */
|
|
|
|
session = sc_capwap_getsession(NULL);
|
|
|
|
if (!session) {
|
|
|
|
goto error;
|
2014-06-09 22:30:04 +02:00
|
|
|
}
|
|
|
|
|
2014-09-10 21:58:23 +02:00
|
|
|
/* IEEE 802.11 into IEEE 802.3 */
|
|
|
|
if (nldev->flags & NLSMARTCAPWAP_FLAGS_TUNNEL_8023) {
|
|
|
|
if (ieee80211_data_to_8023(skb, nldev->dev->dev_addr, NL80211_IFTYPE_AP)) {
|
|
|
|
printk("*** convertion error\n");
|
|
|
|
goto error;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Create Radio Mac Address */
|
|
|
|
radioaddr = sc_capwap_setradiomacaddress(radioaddrbuffer, CAPWAP_RADIO_EUI48_LENGTH_PADDED, nldev->dev->dev_addr);
|
2014-06-09 22:30:04 +02:00
|
|
|
}
|
|
|
|
|
2014-09-10 21:58:23 +02:00
|
|
|
/* Create Wireless Information */
|
|
|
|
if (sig_dbm || rate) {
|
|
|
|
winfo = sc_capwap_setwirelessinformation(winfobuffer, CAPWAP_WINFO_FRAMEINFO_LENGTH_PADDED, (uint8_t)sig_dbm, 0, ((uint16_t)rate) * 5);
|
2014-06-07 22:37:19 +02:00
|
|
|
}
|
2014-09-10 21:58:23 +02:00
|
|
|
|
|
|
|
/* */
|
|
|
|
CAPWAP_SKB_CB(skb)->flags = SKB_CAPWAP_FLAG_FROM_IEEE80211;
|
|
|
|
|
|
|
|
/* Forward to AC */
|
|
|
|
err = sc_capwap_forwarddata(session, nldev->radioid, nldev->binding, skb, nldev->flags, radioaddr, (radioaddr ? CAPWAP_RADIO_EUI48_LENGTH_PADDED : 0), winfo, (winfo ? CAPWAP_WINFO_FRAMEINFO_LENGTH_PADDED : 0));
|
|
|
|
printk("*** send: %d\n", err);
|
2014-06-07 22:37:19 +02:00
|
|
|
}
|
|
|
|
|
2014-09-10 21:58:23 +02:00
|
|
|
error:
|
|
|
|
return ret;
|
2014-06-04 22:58:34 +02:00
|
|
|
}
|
2014-06-01 16:32:30 +02:00
|
|
|
|
2014-06-04 22:58:34 +02:00
|
|
|
/* */
|
2014-09-10 21:58:23 +02:00
|
|
|
static struct sc_netlink_device* sc_netlink_new_device(uint32_t ifindex, uint8_t radioid, u8 wlanid, uint8_t binding) {
|
|
|
|
struct net_device* dev;
|
|
|
|
struct sc_netlink_device* nldev;
|
|
|
|
|
|
|
|
TRACEKMOD("### sc_netlink_new_device\n");
|
|
|
|
|
|
|
|
/* Retrieve device from ifindex */
|
|
|
|
dev = dev_get_by_index(&init_net, ifindex);
|
|
|
|
if (!dev) {
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Check if wireless device */
|
|
|
|
if (!dev->ieee80211_ptr || !dev->ieee80211_ptr->wiphy) {
|
|
|
|
dev_put(dev);
|
|
|
|
return NULL;
|
|
|
|
}
|
2014-06-04 22:58:34 +02:00
|
|
|
|
|
|
|
/* Create device */
|
2014-09-10 21:58:23 +02:00
|
|
|
nldev = (struct sc_netlink_device*)kzalloc(sizeof(struct sc_netlink_device), GFP_KERNEL);
|
|
|
|
if (!nldev) {
|
|
|
|
dev_put(dev);
|
|
|
|
return NULL;
|
2014-06-04 22:58:34 +02:00
|
|
|
}
|
|
|
|
|
2014-09-10 21:58:23 +02:00
|
|
|
/* Initialize device */
|
|
|
|
nldev->pcktunnel_handler.handler = sc_netlink_handler;
|
|
|
|
nldev->pcktunnel_handler.data = (void*)nldev;
|
|
|
|
nldev->ifindex = ifindex;
|
|
|
|
nldev->radioid = radioid;
|
|
|
|
nldev->wlanid = wlanid;
|
|
|
|
nldev->binding = binding;
|
|
|
|
nldev->dev = dev;
|
|
|
|
|
2014-06-04 22:58:34 +02:00
|
|
|
return nldev;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* */
|
2014-09-10 21:58:23 +02:00
|
|
|
static void sc_netlink_free_device(struct sc_netlink_device* nldev) {
|
|
|
|
TRACEKMOD("### sc_netlink_free_device\n");
|
|
|
|
|
2014-06-04 22:58:34 +02:00
|
|
|
/* Disconnect device from mac80211 */
|
2014-09-10 21:58:23 +02:00
|
|
|
ieee80211_pcktunnel_deregister(nldev->dev, &nldev->pcktunnel_handler);
|
|
|
|
|
|
|
|
/* */
|
|
|
|
dev_put(nldev->dev);
|
2014-06-04 22:58:34 +02:00
|
|
|
|
|
|
|
/* Free memory */
|
|
|
|
kfree(nldev);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* */
|
2014-09-10 21:58:23 +02:00
|
|
|
static struct sc_netlink_device* sc_netlink_register_device(uint32_t ifindex, uint8_t radioid, uint16_t wlanid, uint8_t binding) {
|
|
|
|
struct sc_netlink_device* nldev;
|
|
|
|
|
|
|
|
TRACEKMOD("### sc_netlink_register_device\n");
|
2014-06-04 22:58:34 +02:00
|
|
|
|
|
|
|
ASSERT_RTNL();
|
|
|
|
|
2014-09-10 21:58:23 +02:00
|
|
|
/* */
|
|
|
|
if (!IS_VALID_RADIOID(radioid) || !IS_VALID_WLANID(wlanid)) {
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
|
2014-06-04 22:58:34 +02:00
|
|
|
/* Search device */
|
2014-09-10 21:58:23 +02:00
|
|
|
list_for_each_entry(nldev, &sc_netlink_dev_list, list) {
|
2014-06-04 22:58:34 +02:00
|
|
|
if (nldev->ifindex == ifindex) {
|
2014-09-10 21:58:23 +02:00
|
|
|
return NULL;
|
2014-06-04 22:58:34 +02:00
|
|
|
}
|
2014-06-01 16:32:30 +02:00
|
|
|
}
|
|
|
|
|
2014-06-04 22:58:34 +02:00
|
|
|
/* Create device */
|
2014-09-10 21:58:23 +02:00
|
|
|
nldev = sc_netlink_new_device(ifindex, radioid, wlanid, binding);
|
2014-06-04 22:58:34 +02:00
|
|
|
if (nldev) {
|
2014-09-10 21:58:23 +02:00
|
|
|
list_add_rcu(&nldev->list, &sc_netlink_dev_list);
|
2014-06-04 22:58:34 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
return nldev;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* */
|
2014-09-10 21:58:23 +02:00
|
|
|
static int sc_netlink_unregister_device(uint32_t ifindex) {
|
2014-06-04 22:58:34 +02:00
|
|
|
int ret = -ENODEV;
|
2014-09-10 21:58:23 +02:00
|
|
|
struct sc_netlink_device* nldev;
|
|
|
|
|
|
|
|
TRACEKMOD("### sc_netlink_unregister_device\n");
|
2014-06-04 22:58:34 +02:00
|
|
|
|
|
|
|
ASSERT_RTNL();
|
|
|
|
|
|
|
|
/* Search device */
|
2014-09-10 21:58:23 +02:00
|
|
|
list_for_each_entry(nldev, &sc_netlink_dev_list, list) {
|
2014-06-04 22:58:34 +02:00
|
|
|
if (nldev->ifindex == ifindex) {
|
|
|
|
/* Remove from list */
|
|
|
|
list_del_rcu(&nldev->list);
|
|
|
|
synchronize_net();
|
|
|
|
|
|
|
|
/* Free device */
|
|
|
|
ret = 0;
|
2014-09-10 21:58:23 +02:00
|
|
|
sc_netlink_free_device(nldev);
|
2014-06-04 22:58:34 +02:00
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* */
|
2014-09-10 21:58:23 +02:00
|
|
|
static void sc_netlink_unregister_alldevice(void) {
|
|
|
|
struct sc_netlink_device* tmp;
|
|
|
|
struct sc_netlink_device* nldev;
|
|
|
|
|
|
|
|
TRACEKMOD("### sc_netlink_unregister_alldevice\n");
|
|
|
|
|
|
|
|
ASSERT_RTNL();
|
2014-06-04 22:58:34 +02:00
|
|
|
|
2014-09-10 21:58:23 +02:00
|
|
|
/* Close all devices */
|
|
|
|
list_for_each_entry_safe(nldev, tmp, &sc_netlink_dev_list, list) {
|
|
|
|
/* Remove from list */
|
|
|
|
list_del_rcu(&nldev->list);
|
|
|
|
synchronize_net();
|
2014-06-04 22:58:34 +02:00
|
|
|
|
|
|
|
/* Free device */
|
2014-09-10 21:58:23 +02:00
|
|
|
sc_netlink_free_device(nldev);
|
2014-06-04 22:58:34 +02:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2014-06-01 16:32:30 +02:00
|
|
|
|
|
|
|
/* */
|
2014-09-10 21:58:23 +02:00
|
|
|
static int sc_netlink_link(struct sk_buff* skb, struct genl_info* info) {
|
|
|
|
int ret;
|
|
|
|
uint32_t portid = genl_info_snd_portid(info);
|
|
|
|
|
|
|
|
TRACEKMOD("### sc_netlink_link\n");
|
2014-06-01 16:32:30 +02:00
|
|
|
|
2014-09-10 21:58:23 +02:00
|
|
|
if (!sc_netlink_usermodeid) {
|
|
|
|
/* Initialize library */
|
|
|
|
ret = sc_capwap_init(1);
|
|
|
|
if (!ret) {
|
|
|
|
sc_netlink_usermodeid = portid;
|
|
|
|
|
|
|
|
/* Deny unload module */
|
|
|
|
try_module_get(THIS_MODULE);
|
|
|
|
}
|
|
|
|
} else if (sc_netlink_usermodeid == portid) {
|
2014-06-04 22:58:34 +02:00
|
|
|
ret = -EALREADY;
|
2014-06-01 16:32:30 +02:00
|
|
|
} else {
|
2014-06-04 22:58:34 +02:00
|
|
|
ret = -EBUSY;
|
2014-06-01 16:32:30 +02:00
|
|
|
}
|
|
|
|
|
2014-06-04 22:58:34 +02:00
|
|
|
return ret;
|
2014-06-01 16:32:30 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
/* */
|
2014-09-10 21:58:23 +02:00
|
|
|
static int sc_netlink_reset(struct sk_buff* skb, struct genl_info* info) {
|
|
|
|
/* Check Link */
|
|
|
|
if (sc_netlink_usermodeid != genl_info_snd_portid(info)) {
|
|
|
|
return -ENOLINK;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Close all devices */
|
|
|
|
sc_netlink_unregister_alldevice();
|
|
|
|
|
|
|
|
/* Reset session */
|
|
|
|
sc_capwap_resetsession();
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* */
|
|
|
|
static int sc_netlink_notify(struct notifier_block* nb, unsigned long state, void* _notify) {
|
2014-06-01 16:32:30 +02:00
|
|
|
struct netlink_notify* notify = (struct netlink_notify*)_notify;
|
|
|
|
|
2014-06-04 22:58:34 +02:00
|
|
|
if (state == NETLINK_URELEASE) {
|
2014-06-01 16:32:30 +02:00
|
|
|
rtnl_lock();
|
|
|
|
|
2014-09-10 21:58:23 +02:00
|
|
|
if (sc_netlink_usermodeid == netlink_notify_portid(notify)) {
|
|
|
|
sc_netlink_usermodeid = 0;
|
2014-06-04 22:58:34 +02:00
|
|
|
|
|
|
|
/* Close all devices */
|
2014-09-10 21:58:23 +02:00
|
|
|
sc_netlink_unregister_alldevice();
|
|
|
|
|
|
|
|
/* Close capwap engine */
|
|
|
|
sc_capwap_close();
|
|
|
|
|
|
|
|
/* Allow unload module */
|
|
|
|
module_put(THIS_MODULE);
|
2014-06-01 16:32:30 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
rtnl_unlock();
|
|
|
|
}
|
|
|
|
|
|
|
|
return NOTIFY_DONE;
|
|
|
|
}
|
|
|
|
|
2014-06-04 22:58:34 +02:00
|
|
|
/* */
|
2014-09-10 21:58:23 +02:00
|
|
|
static int sc_netlink_bind(struct sk_buff* skb, struct genl_info* info) {
|
|
|
|
union capwap_addr sockaddr;
|
|
|
|
|
|
|
|
TRACEKMOD("### sc_netlink_bind\n");
|
|
|
|
|
|
|
|
/* Check Link */
|
|
|
|
if (sc_netlink_usermodeid != genl_info_snd_portid(info)) {
|
|
|
|
return -ENOLINK;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Get bind address */
|
|
|
|
if (!info->attrs[NLSMARTCAPWAP_ATTR_ADDRESS] || (nla_len(info->attrs[NLSMARTCAPWAP_ATTR_ADDRESS]) != sizeof(struct sockaddr_storage))) {
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
memcpy(&sockaddr.ss, nla_data(info->attrs[NLSMARTCAPWAP_ATTR_ADDRESS]), sizeof(struct sockaddr_storage));
|
|
|
|
if ((sockaddr.ss.ss_family != AF_INET) && (sockaddr.ss.ss_family != AF_INET6)) {
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Bind socket */
|
|
|
|
return sc_capwap_bind(&sockaddr);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* */
|
|
|
|
static int sc_netlink_connect(struct sk_buff* skb, struct genl_info* info) {
|
|
|
|
int ret;
|
|
|
|
union capwap_addr sockaddr;
|
|
|
|
struct sc_capwap_sessionid_element sessionid;
|
|
|
|
uint16_t mtu = DEFAULT_MTU;
|
|
|
|
|
|
|
|
TRACEKMOD("### sc_netlink_connect\n");
|
|
|
|
|
|
|
|
/* Check Link */
|
|
|
|
if (sc_netlink_usermodeid != genl_info_snd_portid(info)) {
|
|
|
|
return -ENOLINK;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Get AC address */
|
|
|
|
if (!info->attrs[NLSMARTCAPWAP_ATTR_ADDRESS] || (nla_len(info->attrs[NLSMARTCAPWAP_ATTR_ADDRESS]) != sizeof(struct sockaddr_storage))) {
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
memcpy(&sockaddr.ss, nla_data(info->attrs[NLSMARTCAPWAP_ATTR_ADDRESS]), sizeof(struct sockaddr_storage));
|
|
|
|
if ((sockaddr.ss.ss_family != AF_INET) && (sockaddr.ss.ss_family != AF_INET6)) {
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Get MTU */
|
|
|
|
if (info->attrs[NLSMARTCAPWAP_ATTR_MTU]) {
|
|
|
|
mtu = nla_get_u16(info->attrs[NLSMARTCAPWAP_ATTR_MTU]);
|
|
|
|
if ((mtu < MIN_MTU) || (mtu > MAX_MTU)) {
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Get Session ID */
|
|
|
|
if (info->attrs[NLSMARTCAPWAP_ATTR_SESSION_ID] && (nla_len(info->attrs[NLSMARTCAPWAP_ATTR_SESSION_ID]) == sizeof(struct sc_capwap_sessionid_element))) {
|
|
|
|
memcpy(sessionid.id, nla_data(info->attrs[NLSMARTCAPWAP_ATTR_SESSION_ID]), sizeof(struct sc_capwap_sessionid_element));
|
|
|
|
} else {
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Send packet */
|
|
|
|
ret = sc_capwap_connect(&sockaddr, &sessionid, mtu);
|
|
|
|
if (ret < 0) {
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* */
|
|
|
|
static int sc_netlink_send_keepalive(struct sk_buff* skb, struct genl_info* info) {
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
TRACEKMOD("### sc_netlink_send_keepalive\n");
|
|
|
|
|
|
|
|
/* Check Link */
|
|
|
|
if (sc_netlink_usermodeid != genl_info_snd_portid(info)) {
|
|
|
|
return -ENOLINK;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Send packet */
|
|
|
|
ret = sc_capwap_sendkeepalive();
|
|
|
|
if (ret < 0) {
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* */
|
|
|
|
static int sc_netlink_send_data(struct sk_buff* skb, struct genl_info* info) {
|
|
|
|
int ret;
|
|
|
|
uint8_t radioid;
|
|
|
|
uint8_t binding;
|
|
|
|
uint8_t rssi = 0;
|
|
|
|
uint8_t snr = 0;
|
|
|
|
uint16_t rate = 0;
|
|
|
|
int length;
|
|
|
|
struct sk_buff* skbdata;
|
|
|
|
struct sc_capwap_session* session;
|
|
|
|
unsigned char winfobuffer[CAPWAP_WINFO_FRAMEINFO_LENGTH_PADDED];
|
|
|
|
struct sc_capwap_wireless_information* winfo = NULL;
|
|
|
|
|
|
|
|
TRACEKMOD("### sc_netlink_send_data\n");
|
|
|
|
|
|
|
|
/* Check Link */
|
|
|
|
if (sc_netlink_usermodeid != genl_info_snd_portid(info)) {
|
|
|
|
return -ENOLINK;
|
|
|
|
} else if (!info->attrs[NLSMARTCAPWAP_ATTR_RADIOID] || !info->attrs[NLSMARTCAPWAP_ATTR_DATA_FRAME]) {
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* */
|
|
|
|
session = sc_capwap_getsession(NULL);
|
|
|
|
if (!session) {
|
|
|
|
return -ENOLINK;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Get radioid */
|
|
|
|
radioid = nla_get_u8(info->attrs[NLSMARTCAPWAP_ATTR_RADIOID]);
|
|
|
|
if (!IS_VALID_RADIOID(radioid) || !info->attrs[NLSMARTCAPWAP_ATTR_BINDING]) {
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Get binding */
|
|
|
|
binding = nla_get_u8(info->attrs[NLSMARTCAPWAP_ATTR_BINDING]);
|
|
|
|
|
|
|
|
/* Get RSSI */
|
|
|
|
if (info->attrs[NLSMARTCAPWAP_ATTR_RSSI]) {
|
|
|
|
rssi = nla_get_u8(info->attrs[NLSMARTCAPWAP_ATTR_RSSI]);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Get SNR */
|
|
|
|
if (info->attrs[NLSMARTCAPWAP_ATTR_SNR]) {
|
|
|
|
snr = nla_get_u8(info->attrs[NLSMARTCAPWAP_ATTR_SNR]);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Get RATE */
|
|
|
|
if (info->attrs[NLSMARTCAPWAP_ATTR_RATE]) {
|
|
|
|
rate = nla_get_u8(info->attrs[NLSMARTCAPWAP_ATTR_RATE]);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Create Wireless Information */
|
|
|
|
if (rssi || snr || rate) {
|
|
|
|
winfo = sc_capwap_setwirelessinformation(winfobuffer, CAPWAP_WINFO_FRAMEINFO_LENGTH_PADDED, rssi, snr, rate);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Create socket buffer */
|
|
|
|
length = nla_len(info->attrs[NLSMARTCAPWAP_ATTR_DATA_FRAME]);
|
|
|
|
skbdata = alloc_skb(length + CAPWAP_HEADER_MAX_LENGTH, GFP_KERNEL);
|
|
|
|
if (!skbdata) {
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Reserve space for Capwap Header */
|
|
|
|
skb_reserve(skbdata, CAPWAP_HEADER_MAX_LENGTH);
|
|
|
|
|
|
|
|
/* Copy data into socket buffer */
|
|
|
|
memcpy(skb_put(skbdata, length), nla_data(info->attrs[NLSMARTCAPWAP_ATTR_DATA_FRAME]), length);
|
|
|
|
|
|
|
|
/* */
|
|
|
|
CAPWAP_SKB_CB(skb)->flags = SKB_CAPWAP_FLAG_FROM_USER_SPACE;
|
|
|
|
|
|
|
|
/* Send packet */
|
|
|
|
ret = sc_capwap_forwarddata(session, radioid, binding, skbdata, 0, NULL, 0, winfo, (winfo ? CAPWAP_WINFO_FRAMEINFO_LENGTH_PADDED : 0));
|
|
|
|
if (ret) {
|
|
|
|
TRACEKMOD("*** Unable send packet from sc_netlink_send_data function\n");
|
|
|
|
}
|
|
|
|
|
|
|
|
kfree_skb(skbdata);
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* */
|
|
|
|
static int sc_netlink_join_mac80211_device(struct sk_buff* skb, struct genl_info* info) {
|
|
|
|
int ret;
|
|
|
|
uint32_t ifindex;
|
|
|
|
struct sc_netlink_device* nldev;
|
|
|
|
|
|
|
|
TRACEKMOD("### sc_netlink_join_mac80211_device\n");
|
|
|
|
|
|
|
|
/* Check Link */
|
|
|
|
if (sc_netlink_usermodeid != genl_info_snd_portid(info)) {
|
|
|
|
return -ENOLINK;
|
|
|
|
}
|
2014-06-04 22:58:34 +02:00
|
|
|
|
|
|
|
/* Get interface index */
|
|
|
|
if (!info->attrs[NLSMARTCAPWAP_ATTR_IFINDEX]) {
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
ifindex = nla_get_u32(info->attrs[NLSMARTCAPWAP_ATTR_IFINDEX]);
|
|
|
|
if (!ifindex) {
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
2014-09-10 21:58:23 +02:00
|
|
|
/* Check */
|
|
|
|
if (!info->attrs[NLSMARTCAPWAP_ATTR_RADIOID] || !info->attrs[NLSMARTCAPWAP_ATTR_WLANID] || !info->attrs[NLSMARTCAPWAP_ATTR_BINDING]) {
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
2014-06-04 22:58:34 +02:00
|
|
|
/* Register device */
|
2014-09-10 21:58:23 +02:00
|
|
|
nldev = sc_netlink_register_device(ifindex, nla_get_u8(info->attrs[NLSMARTCAPWAP_ATTR_RADIOID]), nla_get_u8(info->attrs[NLSMARTCAPWAP_ATTR_WLANID]), nla_get_u8(info->attrs[NLSMARTCAPWAP_ATTR_BINDING]));
|
2014-06-04 22:58:34 +02:00
|
|
|
if (!nldev) {
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
2014-06-07 22:37:19 +02:00
|
|
|
/* */
|
|
|
|
if (info->attrs[NLSMARTCAPWAP_ATTR_FLAGS]) {
|
|
|
|
nldev->flags = nla_get_u32(info->attrs[NLSMARTCAPWAP_ATTR_FLAGS]);
|
|
|
|
}
|
|
|
|
|
2014-06-04 22:58:34 +02:00
|
|
|
/* Set subtype masking */
|
|
|
|
if (info->attrs[NLSMARTCAPWAP_ATTR_MGMT_SUBTYPE_MASK]) {
|
|
|
|
nldev->pcktunnel_handler.subtype_mask[0] = nla_get_u16(info->attrs[NLSMARTCAPWAP_ATTR_MGMT_SUBTYPE_MASK]);
|
|
|
|
}
|
|
|
|
|
|
|
|
if (info->attrs[NLSMARTCAPWAP_ATTR_CTRL_SUBTYPE_MASK]) {
|
|
|
|
nldev->pcktunnel_handler.subtype_mask[1] = nla_get_u16(info->attrs[NLSMARTCAPWAP_ATTR_CTRL_SUBTYPE_MASK]);
|
|
|
|
}
|
|
|
|
|
|
|
|
if (info->attrs[NLSMARTCAPWAP_ATTR_DATA_SUBTYPE_MASK]) {
|
|
|
|
nldev->pcktunnel_handler.subtype_mask[2] = nla_get_u16(info->attrs[NLSMARTCAPWAP_ATTR_DATA_SUBTYPE_MASK]);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Connect device to mac80211 */
|
2014-09-10 21:58:23 +02:00
|
|
|
ret = ieee80211_pcktunnel_register(nldev->dev, &nldev->pcktunnel_handler);
|
2014-06-04 22:58:34 +02:00
|
|
|
if (ret) {
|
2014-09-10 21:58:23 +02:00
|
|
|
sc_netlink_unregister_device(ifindex);
|
2014-06-04 22:58:34 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* */
|
2014-09-10 21:58:23 +02:00
|
|
|
static int sc_netlink_leave_mac80211_device(struct sk_buff* skb, struct genl_info* info) {
|
|
|
|
TRACEKMOD("### sc_netlink_leave_mac80211_device\n");
|
|
|
|
|
|
|
|
/* Check Link */
|
|
|
|
if (sc_netlink_usermodeid != genl_info_snd_portid(info)) {
|
|
|
|
return -ENOLINK;
|
|
|
|
}
|
2014-06-04 22:58:34 +02:00
|
|
|
|
|
|
|
/* Get interface index */
|
|
|
|
if (!info->attrs[NLSMARTCAPWAP_ATTR_IFINDEX]) {
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
2014-09-10 21:58:23 +02:00
|
|
|
/* Unregister device */
|
|
|
|
return sc_netlink_unregister_device(nla_get_u32(info->attrs[NLSMARTCAPWAP_ATTR_IFINDEX]));
|
|
|
|
}
|
|
|
|
|
|
|
|
/* */
|
|
|
|
static int sc_device_event(struct notifier_block* unused, unsigned long event, void* ptr) {
|
|
|
|
struct net_device* dev = netdev_notifier_info_to_dev(ptr);
|
|
|
|
|
|
|
|
/* Check event only if connect with WTP userspace */
|
|
|
|
if (!sc_netlink_usermodeid) {
|
|
|
|
return NOTIFY_DONE;
|
2014-06-04 22:58:34 +02:00
|
|
|
}
|
|
|
|
|
2014-09-10 21:58:23 +02:00
|
|
|
/* */
|
|
|
|
switch (event) {
|
|
|
|
case NETDEV_UNREGISTER: {
|
|
|
|
/* Try to unregister device */
|
|
|
|
sc_netlink_unregister_device(dev->ifindex);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
return NOTIFY_DONE;
|
2014-06-04 22:58:34 +02:00
|
|
|
}
|
|
|
|
|
2014-06-07 22:37:19 +02:00
|
|
|
/* */
|
2014-09-10 21:58:23 +02:00
|
|
|
static const struct nla_policy sc_netlink_policy[NLSMARTCAPWAP_ATTR_MAX + 1] = {
|
2014-06-01 16:32:30 +02:00
|
|
|
[NLSMARTCAPWAP_ATTR_IFINDEX] = { .type = NLA_U32 },
|
2014-09-10 21:58:23 +02:00
|
|
|
[NLSMARTCAPWAP_ATTR_RADIOID] = { .type = NLA_U8 },
|
|
|
|
[NLSMARTCAPWAP_ATTR_WLANID] = { .type = NLA_U8 },
|
|
|
|
[NLSMARTCAPWAP_ATTR_BINDING] = { .type = NLA_U8 },
|
2014-06-07 22:37:19 +02:00
|
|
|
[NLSMARTCAPWAP_ATTR_FLAGS] = { .type = NLA_U32 },
|
2014-06-04 22:58:34 +02:00
|
|
|
[NLSMARTCAPWAP_ATTR_MGMT_SUBTYPE_MASK] = { .type = NLA_U16 },
|
|
|
|
[NLSMARTCAPWAP_ATTR_CTRL_SUBTYPE_MASK] = { .type = NLA_U16 },
|
|
|
|
[NLSMARTCAPWAP_ATTR_DATA_SUBTYPE_MASK] = { .type = NLA_U16 },
|
2014-09-10 21:58:23 +02:00
|
|
|
[NLSMARTCAPWAP_ATTR_ADDRESS] = { .type = NLA_BINARY, .len = sizeof(struct sockaddr_storage) },
|
|
|
|
[NLSMARTCAPWAP_ATTR_MTU] = { .type = NLA_U16 },
|
|
|
|
[NLSMARTCAPWAP_ATTR_SESSION_ID] = { .type = NLA_BINARY, .len = sizeof(struct sc_capwap_sessionid_element) },
|
|
|
|
[NLSMARTCAPWAP_ATTR_DTLS] = { .type = NLA_U16 },
|
|
|
|
[NLSMARTCAPWAP_ATTR_DATA_FRAME] = { .type = NLA_BINARY, .len = IEEE80211_MTU },
|
|
|
|
[NLSMARTCAPWAP_ATTR_RSSI] = { .type = NLA_U8 },
|
|
|
|
[NLSMARTCAPWAP_ATTR_SNR] = { .type = NLA_U8 },
|
|
|
|
[NLSMARTCAPWAP_ATTR_RATE] = { .type = NLA_U16 },
|
|
|
|
|
2014-06-01 16:32:30 +02:00
|
|
|
};
|
|
|
|
|
|
|
|
/* Netlink Ops */
|
2014-09-10 21:58:23 +02:00
|
|
|
static __genl_const struct genl_ops sc_netlink_ops[] = {
|
2014-06-01 16:32:30 +02:00
|
|
|
{
|
2014-06-04 22:58:34 +02:00
|
|
|
.cmd = NLSMARTCAPWAP_CMD_LINK,
|
2014-09-10 21:58:23 +02:00
|
|
|
.doit = sc_netlink_link,
|
|
|
|
.policy = sc_netlink_policy,
|
|
|
|
.flags = GENL_ADMIN_PERM,
|
|
|
|
},
|
|
|
|
{
|
|
|
|
.cmd = NLSMARTCAPWAP_CMD_BIND,
|
|
|
|
.doit = sc_netlink_bind,
|
|
|
|
.policy = sc_netlink_policy,
|
|
|
|
.flags = GENL_ADMIN_PERM,
|
|
|
|
},
|
|
|
|
{
|
|
|
|
.cmd = NLSMARTCAPWAP_CMD_CONNECT,
|
|
|
|
.doit = sc_netlink_connect,
|
|
|
|
.policy = sc_netlink_policy,
|
|
|
|
.flags = GENL_ADMIN_PERM,
|
|
|
|
},
|
|
|
|
{
|
|
|
|
.cmd = NLSMARTCAPWAP_CMD_RESET,
|
|
|
|
.doit = sc_netlink_reset,
|
|
|
|
.policy = sc_netlink_policy,
|
|
|
|
.flags = GENL_ADMIN_PERM,
|
|
|
|
},
|
|
|
|
{
|
|
|
|
.cmd = NLSMARTCAPWAP_CMD_SEND_KEEPALIVE,
|
|
|
|
.doit = sc_netlink_send_keepalive,
|
|
|
|
.policy = sc_netlink_policy,
|
|
|
|
.flags = GENL_ADMIN_PERM,
|
|
|
|
},
|
|
|
|
{
|
|
|
|
.cmd = NLSMARTCAPWAP_CMD_SEND_DATA,
|
|
|
|
.doit = sc_netlink_send_data,
|
|
|
|
.policy = sc_netlink_policy,
|
2014-06-04 22:58:34 +02:00
|
|
|
.flags = GENL_ADMIN_PERM,
|
|
|
|
},
|
|
|
|
{
|
|
|
|
.cmd = NLSMARTCAPWAP_CMD_JOIN_MAC80211_DEVICE,
|
2014-09-10 21:58:23 +02:00
|
|
|
.doit = sc_netlink_join_mac80211_device,
|
|
|
|
.policy = sc_netlink_policy,
|
2014-06-04 22:58:34 +02:00
|
|
|
.flags = GENL_ADMIN_PERM,
|
|
|
|
},
|
|
|
|
{
|
|
|
|
.cmd = NLSMARTCAPWAP_CMD_LEAVE_MAC80211_DEVICE,
|
2014-09-10 21:58:23 +02:00
|
|
|
.doit = sc_netlink_leave_mac80211_device,
|
|
|
|
.policy = sc_netlink_policy,
|
2014-06-01 16:32:30 +02:00
|
|
|
.flags = GENL_ADMIN_PERM,
|
|
|
|
},
|
|
|
|
};
|
|
|
|
|
|
|
|
/* Netlink notify */
|
2014-09-10 21:58:23 +02:00
|
|
|
static struct notifier_block sc_netlink_notifier = {
|
|
|
|
.notifier_call = sc_netlink_notify,
|
2014-06-01 16:32:30 +02:00
|
|
|
};
|
|
|
|
|
2014-09-10 21:58:23 +02:00
|
|
|
/* Interface notify */
|
|
|
|
struct notifier_block sc_device_notifier = {
|
|
|
|
.notifier_call = sc_device_event
|
|
|
|
};
|
|
|
|
|
|
|
|
/* */
|
|
|
|
int sc_netlink_notify_recv_keepalive(const union capwap_addr* sockaddr, struct sc_capwap_sessionid_element* sessionid) {
|
|
|
|
void* msg;
|
|
|
|
struct sk_buff* sk_msg;
|
|
|
|
|
|
|
|
TRACEKMOD("### sc_netlink_notify_recv_keepalive\n");
|
|
|
|
|
|
|
|
/* Alloc message */
|
|
|
|
sk_msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
|
|
|
|
if (!sk_msg) {
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Set command */
|
|
|
|
msg = genlmsg_put(sk_msg, 0, 0, &sc_netlink_family, 0, NLSMARTCAPWAP_CMD_RECV_KEEPALIVE);
|
|
|
|
if (!msg) {
|
|
|
|
nlmsg_free(sk_msg);
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Send message */
|
|
|
|
genlmsg_end(sk_msg, msg);
|
|
|
|
return genlmsg_unicast(&init_net, sk_msg, sc_netlink_usermodeid);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* */
|
|
|
|
int sc_netlink_notify_recv_data(uint8_t* packet, int length) {
|
|
|
|
void* msg;
|
|
|
|
struct sk_buff* sk_msg;
|
|
|
|
|
|
|
|
TRACEKMOD("### sc_netlink_notify_recv_data\n");
|
|
|
|
|
|
|
|
/* Alloc message */
|
|
|
|
sk_msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
|
|
|
|
if (!sk_msg) {
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Set command */
|
|
|
|
msg = genlmsg_put(sk_msg, 0, 0, &sc_netlink_family, 0, NLSMARTCAPWAP_CMD_RECV_DATA);
|
|
|
|
if (!msg) {
|
|
|
|
goto error;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* */
|
|
|
|
if (nla_put(sk_msg, NLSMARTCAPWAP_ATTR_DATA_FRAME, length, packet)) {
|
|
|
|
goto error2;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Send message */
|
|
|
|
genlmsg_end(sk_msg, msg);
|
|
|
|
return genlmsg_unicast(&init_net, sk_msg, sc_netlink_usermodeid);
|
|
|
|
|
|
|
|
error2:
|
|
|
|
genlmsg_cancel(sk_msg, msg);
|
|
|
|
|
|
|
|
error:
|
|
|
|
nlmsg_free(sk_msg);
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
2014-06-01 16:32:30 +02:00
|
|
|
/* */
|
2014-09-10 21:58:23 +02:00
|
|
|
int sc_netlink_init(void) {
|
2014-06-04 22:58:34 +02:00
|
|
|
int ret;
|
2014-06-01 16:32:30 +02:00
|
|
|
|
2014-09-10 21:58:23 +02:00
|
|
|
TRACEKMOD("### sc_netlink_init\n");
|
|
|
|
|
|
|
|
/* */
|
|
|
|
sc_netlink_usermodeid = 0;
|
|
|
|
|
|
|
|
/* Register interface event */
|
|
|
|
ret = register_netdevice_notifier(&sc_device_notifier);
|
|
|
|
if (ret) {
|
|
|
|
goto error;
|
|
|
|
}
|
|
|
|
|
2014-06-01 16:32:30 +02:00
|
|
|
/* Register netlink family */
|
2014-09-10 21:58:23 +02:00
|
|
|
ret = genl_register_family_with_ops(&sc_netlink_family, sc_netlink_ops);
|
2014-06-04 22:58:34 +02:00
|
|
|
if (ret) {
|
2014-09-10 21:58:23 +02:00
|
|
|
goto error2;
|
2014-06-01 16:32:30 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
/* Register netlink notifier */
|
2014-09-10 21:58:23 +02:00
|
|
|
ret = netlink_register_notifier(&sc_netlink_notifier);
|
2014-06-04 22:58:34 +02:00
|
|
|
if (ret) {
|
2014-09-10 21:58:23 +02:00
|
|
|
goto error3;
|
2014-06-01 16:32:30 +02:00
|
|
|
}
|
|
|
|
|
2014-09-10 21:58:23 +02:00
|
|
|
return 0;
|
|
|
|
|
|
|
|
error3:
|
|
|
|
genl_unregister_family(&sc_netlink_family);
|
|
|
|
error2:
|
|
|
|
unregister_netdevice_notifier(&sc_device_notifier);
|
|
|
|
error:
|
2014-06-04 22:58:34 +02:00
|
|
|
return ret;
|
2014-06-01 16:32:30 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
/* */
|
2014-09-10 21:58:23 +02:00
|
|
|
void sc_netlink_exit(void) {
|
|
|
|
TRACEKMOD("### sc_netlink_exit\n");
|
2014-06-04 22:58:34 +02:00
|
|
|
|
2014-09-10 21:58:23 +02:00
|
|
|
netlink_unregister_notifier(&sc_netlink_notifier);
|
|
|
|
genl_unregister_family(&sc_netlink_family);
|
|
|
|
unregister_netdevice_notifier(&sc_device_notifier);
|
2014-06-01 16:32:30 +02:00
|
|
|
}
|