Newer
Older

Ezekiel Dohmen
committed
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
#include <stdlib.h>
#include <stdio.h>
#include <string.h>
#include <unistd.h>
#include <errno.h>
#include <sys/socket.h>
#include <linux/netlink.h>
#define MYGRP 17
#define MAX_PAYLOAD 1024 /* maximum payload size*/
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("Listen for message...\n");
ret = recvmsg(sock, &msg, 0);
if (ret < 0)
return;
char *payload = NLMSG_DATA((struct nlmsghdr *) &buffer);
printf("Received from kernel: %s\n", payload);
}
int main(int argc, char **argv)
{
struct sockaddr_nl src_addr;
//struct sockaddr_nl dest_addr;
//struct nlmsghdr *nlh;
//struct msghdr msg;
//struct iovec iov;
int sock_fd;
//int rc;
sock_fd = socket(PF_NETLINK, SOCK_RAW, NETLINK_USERSOCK);
if (sock_fd < 0) {
printf("socket(): %s\n", strerror(errno));
return 1;
}
memset(&src_addr, 0, sizeof(src_addr));
src_addr.nl_family = AF_NETLINK;
//src_addr.nl_pid = getpid(); /* self pid */
src_addr.nl_pid = 0; //from kernel?
//src_addr.nl_groups = 0; /* not in mcast groups */
bind(sock_fd, (struct sockaddr*)&src_addr, sizeof(src_addr));
int group = MYGRP;
if (setsockopt(sock_fd, SOL_NETLINK, NETLINK_ADD_MEMBERSHIP, &group, sizeof(group)) < 0) {
printf("setsockopt(NETLINK_ADD_MEMBERSHIP): %s\n", strerror(errno));
close(sock_fd);
return 1;
}
while (1) {
read_event(sock_fd);
}
close(sock_fd);
return 0;
}