Многоадресная передача из ядра в пространство пользователя через Netlink в C
Я пытался написать простую программу, взаимодействующую между ядром и пользовательским пространством, используя Netlink. В основном вот чего я хотел добиться:
- Программа пространства пользователя начинает привязку к определенной пользователем многоадресной группе.
- Вставить модуль ядра
- Модуль ядра отправляет сообщение этой многоадресной группе
- Пользовательская космическая программа получает сообщение
Вот мой код:
====== Пользовательская космическая программа ======
#include<stdio.h>
#include<string.h>
#include<stdlib.h>
#include<sys/socket.h>
#include<linux/netlink.h>
#include<sys/types.h>
#include<unistd.h>
#define MYPROTO NETLINK_USERSOCK
#define MYMGRP 0x21 //User defined group, consistent in both kernel prog and user prog
int open_netlink()
{
int sock = socket(AF_NETLINK,SOCK_RAW,MYPROTO);
struct sockaddr_nl addr;
memset((void *)&addr, 0, sizeof(addr));
if (sock<0)
return sock;
addr.nl_family = AF_NETLINK;
addr.nl_pid = getpid();
addr.nl_groups = MYMGRP;
if (bind(sock,(struct sockaddr *)&addr,sizeof(addr))<0)
return -1;
return sock;
}
int read_event(int sock)
{
struct sockaddr_nl nladdr;
struct msghdr msg;
struct iovec iov[2];
struct nlmsghdr nlh;
char buffer[65536];
int ret;
iov[0].iov_base = (void *)&nlh;
iov[0].iov_len = sizeof(nlh);
iov[1].iov_base = (void *)buffer;
iov[1].iov_len = sizeof(buffer);
msg.msg_name = (void *)&(nladdr);
msg.msg_namelen = sizeof(nladdr);
msg.msg_iov = iov;
msg.msg_iovlen = sizeof(iov)/sizeof(iov[0]);
ret=recvmsg(sock, &msg, 0);
if (ret<0) {
return ret;
}
printf("Received message payload: %s\n", NLMSG_DATA(&nlh));
}
int main(int argc, char *argv[])
{
int nls = open_netlink();
if (nls<0) {
err(1,"netlink");
}
while (1)
read_event(nls);
return 0;
}
====== Модуль ядра ======
#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/init.h>
#include <net/sock.h>
#include <linux/socket.h>
#include <linux/net.h>
#include <asm/types.h>
#include <linux/netlink.h>
#include <linux/rtnetlink.h>
#include <linux/skbuff.h>
#include <linux/delay.h>
#define NETLINK_USER 31
#define MYGRP 0x21 //User defined group, consistent in both kernel prog and user prog
struct sock *nl_sk = NULL;
static void send_to_user() {
struct sk_buff *skb_out;
struct nlmsghdr *nlh;
int msg_size;
char *msg = "Hello from kernel";
int res;
printk(KERN_INFO "Entering: %s\n", __FUNCTION__);
msg_size = strlen(msg);
skb_out = nlmsg_new(msg_size, 0);
if (!skb_out) {
printk(KERN_ERR "Failed to allocate new skb\n");
return;
}
nlh = nlmsg_put(skb_out, 0, 1, NLMSG_DONE, msg_size, 0);
//NETLINK_CB(skb_out).dst_group = 1; /* Multicast to group 1, 1<<0 */
strncpy(nlmsg_data(nlh), msg, msg_size);
res = nlmsg_multicast(nl_sk, skb_out, 0, MYGRP, 0);
if (res < 0) {
printk(KERN_INFO "Error while sending bak to user, err id: %d\n", res);
}
}
static int __init
hello_init(void) {
struct netlink_kernel_cfg cfg = {
.groups = MYGRP,
};
printk("Entering: %s\n", __FUNCTION__);
nl_sk = netlink_kernel_create(&init_net, NETLINK_USER, &cfg);
if (!nl_sk) {
printk(KERN_ALERT "Error creating socket.\n");
return -10;
}
send_to_user();
return 0;
}
static void __exit
hello_exit(void) {
printk(KERN_INFO "exiting hello module\n");
netlink_kernel_release(nl_sk);
}
module_init(hello_init);
module_exit(hello_exit);
Так как модуль ядра отправит сообщение только один раз во время инициализации, таким образом, я сначала запускаю прослушивающую программу, а затем вставляю модуль, хотя у меня всегда была эта ошибка:
Error while sending bak to user, err id: -3
Когда отслеживается идентификатор ошибки, это отражается в этом фрагменте кода в netlink / af_netlink.c:
if (info.delivery_failure) {
kfree_skb(info.skb2);
return -ENOBUFS;
}
consume_skb(info.skb2);
if (info.delivered) {
if (info.congested && (allocation & __GFP_WAIT))
yield();
return 0;
}
return -ESRCH;
Я предполагаю, что это не delivery_failure, но все еще не доставлено по некоторым причинам.
Я имел в виду этот пример, в котором авторская программа продолжает изменять маршруты прослушивания. Хотя я хотел бы использовать определенную пользователем многоадресную группу.
Есть идеи? Заранее спасибо!
2 ответа
Вот две ключевые проблемы, которые я обнаружил в вашем коде:
- И семейство протоколов, и группа многоадресной рассылки должны быть согласованы как в проге ядра, так и в проге пользователя. Ваше семейство протоколов
NETLINK_USERSOCK
(2) в пространстве пользователя иNETLINK_USER
(31) в пространстве ядра. addr.nl_groups = MYMGRP;
не работает по какой-то причине. Это делает, однако:setsockopt(sock, 270, NETLINK_ADD_MEMBERSHIP, &group, sizeof(group))
,
Не смертельно:
- В этом случае модуль не прослушивает групповые сообщения, поэтому вам не нужно включать многоадресную группу в
netlink_kernel_create()
Титулы.
Кроме того, на самом деле не связано с netlink, но полезно в любом случае:
strlen()
не включает нулевую чару. Во время распределения сообщений вам, вероятно, следует добавить байт, чтобы восполнить это.- В этом случае,
NLMSG_DATA(&nlh)
является неопределенным поведением. Это потому, что ваш заголовок и данные находятся в отдельных блоках памяти, которые не гарантированно будут склеены, и все, что делает макрос, - это доступ к блокам памяти послеnlh
:
#define NLMSG_DATA(nlh) ((void*)(((char*)nlh) + NLMSG_LENGTH(0)))
Это моя версия вашего кода:
Пользовательская программа:
#include <stdio.h>
#include <string.h>
#include <stdlib.h>
#include <sys/socket.h>
#include <linux/netlink.h>
#include <unistd.h>
/* Protocol family, consistent in both kernel prog and user prog. */
#define MYPROTO NETLINK_USERSOCK
/* Multicast group, consistent in both kernel prog and user prog. */
#define MYMGRP 21
int open_netlink(void)
{
int sock;
struct sockaddr_nl addr;
int group = MYMGRP;
sock = socket(AF_NETLINK, SOCK_RAW, MYPROTO);
if (sock < 0) {
printf("sock < 0.\n");
return sock;
}
memset((void *) &addr, 0, sizeof(addr));
addr.nl_family = AF_NETLINK;
addr.nl_pid = getpid();
/* This doesn't work for some reason. See the setsockopt() below. */
/* addr.nl_groups = MYMGRP; */
if (bind(sock, (struct sockaddr *) &addr, sizeof(addr)) < 0) {
printf("bind < 0.\n");
return -1;
}
/*
* 270 is SOL_NETLINK. See
* http://lxr.free-electrons.com/source/include/linux/socket.h?v=4.1#L314
* and
* http://stackru.com/questions/17732044/
*/
if (setsockopt(sock, 270, NETLINK_ADD_MEMBERSHIP, &group, sizeof(group)) < 0) {
printf("setsockopt < 0\n");
return -1;
}
return sock;
}
void read_event(int sock)
{
struct sockaddr_nl nladdr;
struct msghdr msg;
struct iovec iov;
char buffer[65536];
int ret;
iov.iov_base = (void *) buffer;
iov.iov_len = sizeof(buffer);
msg.msg_name = (void *) &(nladdr);
msg.msg_namelen = sizeof(nladdr);
msg.msg_iov = &iov;
msg.msg_iovlen = 1;
printf("Ok, listening.\n");
ret = recvmsg(sock, &msg, 0);
if (ret < 0)
printf("ret < 0.\n");
else
printf("Received message payload: %s\n", NLMSG_DATA((struct nlmsghdr *) &buffer));
}
int main(int argc, char *argv[])
{
int nls;
nls = open_netlink();
if (nls < 0)
return nls;
while (1)
read_event(nls);
return 0;
}
И это модуль ядра:
#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/netlink.h>
#include <net/netlink.h>
#include <net/net_namespace.h>
/* Protocol family, consistent in both kernel prog and user prog. */
#define MYPROTO NETLINK_USERSOCK
/* Multicast group, consistent in both kernel prog and user prog. */
#define MYGRP 21
static struct sock *nl_sk = NULL;
static void send_to_user(void)
{
struct sk_buff *skb;
struct nlmsghdr *nlh;
char *msg = "Hello from kernel";
int msg_size = strlen(msg) + 1;
int res;
pr_info("Creating skb.\n");
skb = nlmsg_new(NLMSG_ALIGN(msg_size + 1), GFP_KERNEL);
if (!skb) {
pr_err("Allocation failure.\n");
return;
}
nlh = nlmsg_put(skb, 0, 1, NLMSG_DONE, msg_size + 1, 0);
strcpy(nlmsg_data(nlh), msg);
pr_info("Sending skb.\n");
res = nlmsg_multicast(nl_sk, skb, 0, MYGRP, GFP_KERNEL);
if (res < 0)
pr_info("nlmsg_multicast() error: %d\n", res);
else
pr_info("Success.\n");
}
static int __init hello_init(void)
{
pr_info("Inserting hello module.\n");
nl_sk = netlink_kernel_create(&init_net, MYPROTO, NULL);
if (!nl_sk) {
pr_err("Error creating socket.\n");
return -10;
}
send_to_user();
netlink_kernel_release(nl_sk);
return 0;
}
static void __exit hello_exit(void)
{
pr_info("Exiting hello module.\n");
}
module_init(hello_init);
module_exit(hello_exit);
MODULE_LICENSE("GPL");
Протестировано в ядре 3.13.
(Могу ли я предположить, что люди используют libnl-3 вместо сырых сокетов для программы пространства пользователя. Ее многоадресная документация по Netlink действительно достойна.)
Согласно драйверу коннектора:
Если нет прослушивателей для данной группы, можно вернуть ESRCH.
Таким образом, ваша программа пользовательского пространства работала неправильно, когда ваше ядро отправило сообщение.