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
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
|
/*
* Copyright (C) 2011 The Android Open Source Project
*
* Licensed under the Apache License, Version 2.0 (the "License");
* you may not use this file except in compliance with the License.
* You may obtain a copy of the License at
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS,
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
* See the License for the specific language governing permissions and
* limitations under the License.
*/
/* NOTICE: This is a clean room re-implementation of libnl */
#include <errno.h>
#include <unistd.h>
#include <malloc.h>
#include <sys/time.h>
#include <sys/socket.h>
#include "netlink-types.h"
/* Join group */
int nl_socket_add_membership(struct nl_sock *sk, int group)
{
return setsockopt(sk->s_fd, SOL_NETLINK,
NETLINK_ADD_MEMBERSHIP, &group, sizeof(group));
}
/* Allocate new netlink socket. */
struct nl_sock *nl_socket_alloc(void)
{
struct nl_sock *sk;
struct timeval tv;
struct nl_cb *cb;
sk = (struct nl_sock *) malloc(sizeof(struct nl_sock));
if (!sk)
goto fail;
memset(sk, 0, sizeof(*sk));
/* Get current time */
if (gettimeofday(&tv, NULL))
return NULL;
else
sk->s_seq_next = (int) tv.tv_sec;
/* Create local socket */
sk->s_local.nl_family = AF_NETLINK;
sk->s_local.nl_pid = 0; /* Kernel fills in pid */
sk->s_local.nl_groups = 0; /* No groups */
/* Create peer socket */
sk->s_peer.nl_family = AF_NETLINK;
sk->s_peer.nl_pid = 0; /* Kernel */
sk->s_peer.nl_groups = 0; /* No groups */
cb = (struct nl_cb *) malloc(sizeof(struct nl_cb));
if (!cb)
goto cb_fail;
memset(cb, 0, sizeof(*cb));
sk->s_cb = nl_cb_alloc(NL_CB_DEFAULT);
return sk;
cb_fail:
free(sk);
fail:
return NULL;
}
/* Allocate new socket with custom callbacks. */
struct nl_sock *nl_socket_alloc_cb(struct nl_cb *cb)
{
struct nl_sock *sk = nl_socket_alloc();
if (!sk)
return NULL;
sk->s_cb = cb;
nl_cb_get(cb);
return sk;
}
/* Free a netlink socket. */
void nl_socket_free(struct nl_sock *sk)
{
nl_cb_put(sk->s_cb);
close(sk->s_fd);
free(sk);
}
/* Sets socket buffer size of netlink socket */
int nl_socket_set_buffer_size(struct nl_sock *sk, int rxbuf, int txbuf)
{
if (setsockopt(sk->s_fd, SOL_SOCKET, SO_SNDBUF, \
&rxbuf, (socklen_t) sizeof(rxbuf)))
goto error;
if (setsockopt(sk->s_fd, SOL_SOCKET, SO_RCVBUF, \
&txbuf, (socklen_t) sizeof(txbuf)))
goto error;
return 0;
error:
return -errno;
}
int nl_socket_get_fd(struct nl_sock *sk)
{
return sk->s_fd;
}
|
