4 This file is part of avahi.
6 avahi is free software; you can redistribute it and/or modify it
7 under the terms of the GNU Lesser General Public License as
8 published by the Free Software Foundation; either version 2.1 of the
9 License, or (at your option) any later version.
11 avahi is distributed in the hope that it will be useful, but WITHOUT
12 ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
13 or FITNESS FOR A PARTICULAR PURPOSE. See the GNU Lesser General
14 Public License for more details.
16 You should have received a copy of the GNU Lesser General Public
17 License along with avahi; if not, write to the Free Software
18 Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307
29 #include <sys/ioctl.h>
34 GMainContext *context;
39 void (*callback) (AvahiNetlink *nl, struct nlmsghdr *n, gpointer userdata);
43 gboolean avahi_netlink_work(AvahiNetlink *nl, gboolean block) {
49 guint8 buffer[64*1024];
51 p = (struct nlmsghdr *) buffer;
53 if ((bytes = recv(nl->fd, buffer, sizeof(buffer), block ? 0 : MSG_DONTWAIT)) < 0) {
55 if (errno == EAGAIN || errno == EINTR)
58 g_warning("NETLINK: recv() failed: %s", strerror(errno));
63 for (; bytes > 0; p = NLMSG_NEXT(p, bytes)) {
64 if (!NLMSG_OK(p, (size_t) bytes)) {
65 g_warning("NETLINK: packet truncated");
69 nl->callback(nl, p, nl->userdata);
80 static gboolean prepare_func(GSource *source, gint *timeout) {
88 static gboolean check_func(GSource *source) {
92 nl = *((AvahiNetlink**) (((guint8*) source) + sizeof(GSource)));
95 return nl->poll_fd.revents & (G_IO_IN|G_IO_HUP|G_IO_ERR);
98 static gboolean dispatch_func(GSource *source, GSourceFunc callback, gpointer user_data) {
102 nl = *((AvahiNetlink**) (((guint8*) source) + sizeof(GSource)));
105 return avahi_netlink_work(nl, FALSE);
108 AvahiNetlink *avahi_netlink_new(GMainContext *context, gint priority, guint32 groups, void (*cb) (AvahiNetlink *nl, struct nlmsghdr *n, gpointer userdata), gpointer userdata) {
110 struct sockaddr_nl addr;
113 static GSourceFuncs source_funcs = {
125 if ((fd = socket(PF_NETLINK, SOCK_DGRAM, NETLINK_ROUTE)) < 0) {
126 g_critical("NETLINK: socket(PF_NETLINK): %s", strerror(errno));
130 memset(&addr, 0, sizeof(addr));
131 addr.nl_family = AF_NETLINK;
132 addr.nl_groups = groups;
133 addr.nl_pid = getpid();
135 if (bind(fd, (struct sockaddr *) &addr, sizeof(addr)) < 0) {
137 g_critical("bind(): %s", strerror(errno));
141 nl = g_new(AvahiNetlink, 1);
142 nl->context = context;
143 g_main_context_ref(context);
147 nl->userdata = userdata;
149 nl->source = g_source_new(&source_funcs, sizeof(GSource) + sizeof(AvahiNetlink*));
150 *((AvahiNetlink**) (((guint8*) nl->source) + sizeof(GSource))) = nl;
152 g_source_set_priority(nl->source, priority);
154 memset(&nl->poll_fd, 0, sizeof(GPollFD));
156 nl->poll_fd.events = G_IO_IN|G_IO_ERR|G_IO_HUP;
157 g_source_add_poll(nl->source, &nl->poll_fd);
159 g_source_attach(nl->source, nl->context);
164 void avahi_netlink_free(AvahiNetlink *nl) {
167 g_source_destroy(nl->source);
168 g_source_unref(nl->source);
169 g_main_context_unref(nl->context);
174 int avahi_netlink_send(AvahiNetlink *nl, struct nlmsghdr *m, guint *ret_seq) {
178 m->nlmsg_seq = nl->seq++;
179 m->nlmsg_flags |= NLM_F_ACK;
181 if (send(nl->fd, m, m->nlmsg_len, 0) < 0) {
182 g_warning("NETLINK: send(): %s\n", strerror(errno));
187 *ret_seq = m->nlmsg_seq;