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/ioctl.h>
29 #include <sys/socket.h>
31 #include <linux/netlink.h>
32 #include <linux/rtnetlink.h>
34 #include <connman/plugin.h>
35 #include <connman/driver.h>
36 #include <connman/rtnl.h>
37 #include <connman/log.h>
39 struct ethernet_data {
44 static GStaticMutex ethernet_mutex = G_STATIC_MUTEX_INIT;
45 static GSList *ethernet_list = NULL;
47 static void ethernet_newlink(unsigned short type, int index,
48 unsigned flags, unsigned change)
52 DBG("index %d flags %ld change %ld", index, flags, change);
54 g_static_mutex_lock(ðernet_mutex);
56 for (list = ethernet_list; list; list = list->next) {
57 struct connman_element *element = list->data;
58 struct connman_element *netdev;
59 struct ethernet_data *ethernet;
61 ethernet = connman_element_get_data(element);
65 if (ethernet->index != index)
68 if ((ethernet->flags & IFF_RUNNING) == (flags & IFF_RUNNING))
71 ethernet->flags = flags;
73 if (ethernet->flags & IFF_RUNNING) {
76 netdev = connman_element_create(NULL);
78 netdev->type = CONNMAN_ELEMENT_TYPE_DEVICE;
79 netdev->subtype = CONNMAN_ELEMENT_SUBTYPE_NETWORK;
80 netdev->index = element->index;
82 connman_element_register(netdev, element);
87 connman_element_unregister_children(element);
91 g_static_mutex_unlock(ðernet_mutex);
94 static struct connman_rtnl ethernet_rtnl = {
96 .newlink = ethernet_newlink,
99 static int iface_up(struct ethernet_data *ethernet)
104 DBG("index %d flags %d", ethernet->index, ethernet->flags);
106 sk = socket(PF_INET, SOCK_DGRAM, 0);
110 memset(&ifr, 0, sizeof(ifr));
111 ifr.ifr_ifindex = ethernet->index;
113 if (ioctl(sk, SIOCGIFNAME, &ifr) < 0) {
118 if (ioctl(sk, SIOCGIFFLAGS, &ifr) < 0) {
123 if (ifr.ifr_flags & IFF_UP) {
128 ifr.ifr_flags |= IFF_UP;
130 if (ioctl(sk, SIOCSIFFLAGS, &ifr) < 0) {
143 static int iface_down(struct ethernet_data *ethernet)
148 DBG("index %d flags %d", ethernet->index, ethernet->flags);
150 sk = socket(PF_INET, SOCK_DGRAM, 0);
154 memset(&ifr, 0, sizeof(ifr));
155 ifr.ifr_ifindex = ethernet->index;
157 if (ioctl(sk, SIOCGIFNAME, &ifr) < 0) {
162 if (ioctl(sk, SIOCGIFFLAGS, &ifr) < 0) {
167 if (!(ifr.ifr_flags & IFF_UP)) {
172 ifr.ifr_flags &= ~IFF_UP;
174 if (ioctl(sk, SIOCSIFFLAGS, &ifr) < 0)
185 static int ethernet_probe(struct connman_element *element)
187 struct ethernet_data *ethernet;
189 DBG("element %p name %s", element, element->name);
191 ethernet = g_try_new0(struct ethernet_data, 1);
192 if (ethernet == NULL)
195 g_static_mutex_lock(ðernet_mutex);
196 ethernet_list = g_slist_append(ethernet_list, element);
197 g_static_mutex_unlock(ðernet_mutex);
199 connman_element_set_data(element, ethernet);
201 ethernet->index = element->index;
205 connman_rtnl_send_getlink();
210 static void ethernet_remove(struct connman_element *element)
212 struct ethernet_data *ethernet = connman_element_get_data(element);
214 DBG("element %p name %s", element, element->name);
216 connman_element_set_data(element, NULL);
218 iface_down(ethernet);
220 g_static_mutex_lock(ðernet_mutex);
221 ethernet_list = g_slist_remove(ethernet_list, element);
222 g_static_mutex_unlock(ðernet_mutex);
227 static struct connman_driver ethernet_driver = {
229 .type = CONNMAN_ELEMENT_TYPE_DEVICE,
230 .subtype = CONNMAN_ELEMENT_SUBTYPE_ETHERNET,
231 .probe = ethernet_probe,
232 .remove = ethernet_remove,
235 static int ethernet_init(void)
239 err = connman_rtnl_register(ðernet_rtnl);
243 err = connman_driver_register(ðernet_driver);
245 connman_rtnl_unregister(ðernet_rtnl);
252 static void ethernet_exit(void)
254 connman_driver_unregister(ðernet_driver);
256 connman_rtnl_unregister(ðernet_rtnl);
259 CONNMAN_PLUGIN_DEFINE("ethernet", "Ethernet interface plugin", VERSION,
260 ethernet_init, ethernet_exit)