5 * Copyright (C) 2007-2008 Intel Corporation. All rights reserved.
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License version 2 as
9 * published by the Free Software Foundation.
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
28 #include <sys/socket.h>
30 #include <linux/netlink.h>
31 #include <linux/rtnetlink.h>
33 #include <connman/plugin.h>
34 #include <connman/driver.h>
35 #include <connman/log.h>
37 static GStaticMutex ethernet_mutex = G_STATIC_MUTEX_INIT;
38 static GSList *ethernet_list = NULL;
40 static GStaticMutex element_mutex = G_STATIC_MUTEX_INIT;
41 static GSList *element_list = NULL;
43 static void create_element(struct connman_element *parent,
44 enum connman_element_type type)
46 struct connman_element *element;
48 DBG("parent %p name %s", parent, parent->name);
50 element = connman_element_create();
53 element->netdev.index = parent->netdev.index;
54 element->netdev.name = g_strdup(parent->netdev.name);
56 g_static_mutex_lock(&element_mutex);
57 element_list = g_slist_append(element_list, element);
58 g_static_mutex_unlock(&element_mutex);
60 connman_element_register(element, parent);
63 static void remove_elements(struct connman_element *parent)
67 DBG("parent %p name %s", parent, parent->name);
69 g_static_mutex_lock(&element_mutex);
71 for (list = element_list; list; list = list->next) {
72 struct connman_element *element = list->data;
74 if (element->netdev.index != parent->netdev.index)
77 element_list = g_slist_remove(element_list, element);
79 connman_element_unregister(element);
81 connman_element_unref(element);
84 g_static_mutex_unlock(&element_mutex);
87 static void rtnl_link(struct nlmsghdr *hdr, const char *type)
90 struct ifinfomsg *msg;
93 msg = (struct ifinfomsg *) NLMSG_DATA(hdr);
94 bytes = IFLA_PAYLOAD(hdr);
96 DBG("%s ifi_index %d ifi_flags 0x%04x",
97 type, msg->ifi_index, msg->ifi_flags);
99 g_static_mutex_lock(ðernet_mutex);
101 for (list = ethernet_list; list; list = list->next) {
102 struct connman_element *element = list->data;
104 if (element->type != CONNMAN_ELEMENT_TYPE_DEVICE)
107 if (element->netdev.index != msg->ifi_index)
110 if ((element->netdev.flags & IFF_RUNNING) ==
111 (msg->ifi_flags & IFF_RUNNING))
114 element->netdev.flags = msg->ifi_flags;
116 if (msg->ifi_flags & IFF_RUNNING) {
119 create_element(element, CONNMAN_ELEMENT_TYPE_DHCP);
120 create_element(element, CONNMAN_ELEMENT_TYPE_ZEROCONF);
124 remove_elements(element);
128 g_static_mutex_unlock(ðernet_mutex);
131 static gboolean rtnl_event(GIOChannel *chan, GIOCondition cond, gpointer data)
133 unsigned char buf[1024];
138 if (cond & (G_IO_NVAL | G_IO_HUP | G_IO_ERR))
141 memset(buf, 0, sizeof(buf));
143 err = g_io_channel_read(chan, (gchar *) buf, sizeof(buf), &len);
145 if (err == G_IO_ERROR_AGAIN)
150 DBG("buf %p len %zd", buf, len);
153 struct nlmsghdr *hdr = ptr;
154 struct nlmsgerr *err;
156 if (!NLMSG_OK(hdr, len))
159 DBG("len %d type %d flags 0x%04x seq %d",
160 hdr->nlmsg_len, hdr->nlmsg_type,
161 hdr->nlmsg_flags, hdr->nlmsg_seq);
163 switch (hdr->nlmsg_type) {
165 err = NLMSG_DATA(hdr);
166 DBG("ERROR %d (%s)", -err->error,
167 strerror(-err->error));
171 rtnl_link(hdr, "NEWLINK");
175 rtnl_link(hdr, "DELLINK");
179 len -= hdr->nlmsg_len;
180 ptr += hdr->nlmsg_len;
186 static GIOChannel *channel = NULL;
188 static int rtnl_request(void)
195 struct sockaddr_nl addr;
200 memset(&req, 0, sizeof(req));
201 req.hdr.nlmsg_len = sizeof(req.hdr) + sizeof(req.msg);
202 req.hdr.nlmsg_type = RTM_GETLINK;
203 req.hdr.nlmsg_flags = NLM_F_REQUEST | NLM_F_DUMP;
204 req.hdr.nlmsg_pid = 0;
205 req.hdr.nlmsg_seq = 42;
206 req.msg.rtgen_family = AF_INET;
208 sk = g_io_channel_unix_get_fd(channel);
210 memset(&addr, 0, sizeof(addr));
211 addr.nl_family = AF_NETLINK;
213 return sendto(sk, &req, sizeof(req), 0,
214 (struct sockaddr *) &addr, sizeof(addr));
217 static int ethernet_probe(struct connman_element *element)
219 DBG("element %p name %s", element, element->name);
221 g_static_mutex_lock(ðernet_mutex);
222 ethernet_list = g_slist_append(ethernet_list, element);
223 g_static_mutex_unlock(ðernet_mutex);
230 static void ethernet_remove(struct connman_element *element)
232 DBG("element %p name %s", element, element->name);
234 g_static_mutex_lock(ðernet_mutex);
235 ethernet_list = g_slist_remove(ethernet_list, element);
236 g_static_mutex_unlock(ðernet_mutex);
239 static struct connman_driver ethernet_driver = {
241 .type = CONNMAN_ELEMENT_TYPE_DEVICE,
242 .subtype = CONNMAN_ELEMENT_SUBTYPE_ETHERNET,
243 .probe = ethernet_probe,
244 .remove = ethernet_remove,
247 static int rtnl_init(void)
249 struct sockaddr_nl addr;
254 sk = socket(PF_NETLINK, SOCK_DGRAM, NETLINK_ROUTE);
258 memset(&addr, 0, sizeof(addr));
259 addr.nl_family = AF_NETLINK;
260 addr.nl_groups = RTMGRP_LINK;
262 if (bind(sk, (struct sockaddr *) &addr, sizeof(addr)) < 0) {
268 channel = g_io_channel_unix_new(sk);
269 g_io_channel_set_close_on_unref(channel, TRUE);
271 g_io_add_watch(channel, G_IO_IN | G_IO_NVAL | G_IO_HUP | G_IO_ERR,
277 static void rtnl_cleanup(void)
281 g_io_channel_shutdown(channel, TRUE, NULL);
282 g_io_channel_unref(channel);
287 static int ethernet_init(void)
295 err = connman_driver_register(ðernet_driver);
304 static void ethernet_exit(void)
306 connman_driver_unregister(ðernet_driver);
311 CONNMAN_PLUGIN_DEFINE("ethernet", "Ethernet interface plugin", VERSION,
312 ethernet_init, ethernet_exit)