171 строка
3.3 KiB
C
171 строка
3.3 KiB
C
/*
|
|
* IrDA netlink layer, for stack configuration.
|
|
*
|
|
* Copyright (c) 2007 Samuel Ortiz <samuel@sortiz.org>
|
|
*
|
|
* Partly based on the 802.11 nelink implementation
|
|
* (see net/wireless/nl80211.c) which is:
|
|
* Copyright 2006 Johannes Berg <johannes@sipsolutions.net>
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
* published by the Free Software Foundation.
|
|
*
|
|
*/
|
|
|
|
#include <linux/socket.h>
|
|
#include <linux/irda.h>
|
|
#include <net/sock.h>
|
|
#include <net/irda/irda.h>
|
|
#include <net/irda/irlap.h>
|
|
#include <net/genetlink.h>
|
|
|
|
|
|
|
|
static struct genl_family irda_nl_family = {
|
|
.id = GENL_ID_GENERATE,
|
|
.name = IRDA_NL_NAME,
|
|
.hdrsize = 0,
|
|
.version = IRDA_NL_VERSION,
|
|
.maxattr = IRDA_NL_CMD_MAX,
|
|
};
|
|
|
|
static struct net_device * ifname_to_netdev(struct genl_info *info)
|
|
{
|
|
char * ifname;
|
|
|
|
if (!info->attrs[IRDA_NL_ATTR_IFNAME])
|
|
return NULL;
|
|
|
|
ifname = nla_data(info->attrs[IRDA_NL_ATTR_IFNAME]);
|
|
|
|
IRDA_DEBUG(5, "%s(): Looking for %s\n", __FUNCTION__, ifname);
|
|
|
|
return dev_get_by_name(ifname);
|
|
}
|
|
|
|
static int irda_nl_set_mode(struct sk_buff *skb, struct genl_info *info)
|
|
{
|
|
struct net_device * dev;
|
|
struct irlap_cb * irlap;
|
|
u32 mode;
|
|
|
|
if (!info->attrs[IRDA_NL_ATTR_MODE])
|
|
return -EINVAL;
|
|
|
|
mode = nla_get_u32(info->attrs[IRDA_NL_ATTR_MODE]);
|
|
|
|
IRDA_DEBUG(5, "%s(): Switching to mode: %d\n", __FUNCTION__, mode);
|
|
|
|
dev = ifname_to_netdev(info);
|
|
if (!dev)
|
|
return -ENODEV;
|
|
|
|
irlap = (struct irlap_cb *)dev->atalk_ptr;
|
|
if (!irlap) {
|
|
dev_put(dev);
|
|
return -ENODEV;
|
|
}
|
|
|
|
irlap->mode = mode;
|
|
|
|
dev_put(dev);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int irda_nl_get_mode(struct sk_buff *skb, struct genl_info *info)
|
|
{
|
|
struct net_device * dev;
|
|
struct irlap_cb * irlap;
|
|
struct sk_buff *msg;
|
|
void *hdr;
|
|
int ret = -ENOBUFS;
|
|
|
|
dev = ifname_to_netdev(info);
|
|
if (!dev)
|
|
return -ENODEV;
|
|
|
|
msg = nlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL);
|
|
if (!msg) {
|
|
dev_put(dev);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
irlap = (struct irlap_cb *)dev->atalk_ptr;
|
|
if (!irlap) {
|
|
ret = -ENODEV;
|
|
goto err_out;
|
|
}
|
|
|
|
hdr = genlmsg_put(msg, info->snd_pid, info->snd_seq,
|
|
&irda_nl_family, 0, IRDA_NL_CMD_GET_MODE);
|
|
if (IS_ERR(hdr)) {
|
|
ret = PTR_ERR(hdr);
|
|
goto err_out;
|
|
}
|
|
|
|
if(nla_put_string(msg, IRDA_NL_ATTR_IFNAME,
|
|
dev->name))
|
|
goto err_out;
|
|
|
|
if(nla_put_u32(msg, IRDA_NL_ATTR_MODE, irlap->mode))
|
|
goto err_out;
|
|
|
|
genlmsg_end(msg, hdr);
|
|
|
|
return genlmsg_unicast(msg, info->snd_pid);
|
|
|
|
err_out:
|
|
nlmsg_free(msg);
|
|
dev_put(dev);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static struct nla_policy irda_nl_policy[IRDA_NL_ATTR_MAX + 1] = {
|
|
[IRDA_NL_ATTR_IFNAME] = { .type = NLA_NUL_STRING,
|
|
.len = IFNAMSIZ-1 },
|
|
[IRDA_NL_ATTR_MODE] = { .type = NLA_U32 },
|
|
};
|
|
|
|
static struct genl_ops irda_nl_ops[] = {
|
|
{
|
|
.cmd = IRDA_NL_CMD_SET_MODE,
|
|
.doit = irda_nl_set_mode,
|
|
.policy = irda_nl_policy,
|
|
.flags = GENL_ADMIN_PERM,
|
|
},
|
|
{
|
|
.cmd = IRDA_NL_CMD_GET_MODE,
|
|
.doit = irda_nl_get_mode,
|
|
.policy = irda_nl_policy,
|
|
/* can be retrieved by unprivileged users */
|
|
},
|
|
|
|
};
|
|
|
|
int irda_nl_register(void)
|
|
{
|
|
int err, i;
|
|
|
|
err = genl_register_family(&irda_nl_family);
|
|
if (err)
|
|
return err;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(irda_nl_ops); i++) {
|
|
err = genl_register_ops(&irda_nl_family, &irda_nl_ops[i]);
|
|
if (err)
|
|
goto err_out;
|
|
}
|
|
return 0;
|
|
err_out:
|
|
genl_unregister_family(&irda_nl_family);
|
|
return err;
|
|
}
|
|
|
|
void irda_nl_unregister(void)
|
|
{
|
|
genl_unregister_family(&irda_nl_family);
|
|
}
|