5 * Copyright (C) 2007-2012 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
32 #define IFF_LOWER_UP 0x10000
37 #define CONNMAN_API_SUBJECT_TO_CHANGE
38 #include <connman/technology.h>
39 #include <connman/plugin.h>
40 #include <connman/device.h>
41 #include <connman/rtnl.h>
42 #include <connman/inet.h>
43 #include <connman/log.h>
45 static bool gadget_tethering = false;
51 struct connman_network *network;
54 static int gadget_network_probe(struct connman_network *network)
56 DBG("network %p", network);
61 static void gadget_network_remove(struct connman_network *network)
63 DBG("network %p", network);
66 static int gadget_network_connect(struct connman_network *network)
68 DBG("network %p", network);
70 connman_network_set_connected(network, true);
75 static int gadget_network_disconnect(struct connman_network *network)
77 DBG("network %p", network);
79 connman_network_set_connected(network, false);
84 static struct connman_network_driver gadget_network_driver = {
86 .type = CONNMAN_NETWORK_TYPE_GADGET,
87 .probe = gadget_network_probe,
88 .remove = gadget_network_remove,
89 .connect = gadget_network_connect,
90 .disconnect = gadget_network_disconnect,
93 static void add_network(struct connman_device *device,
94 struct gadget_data *gadget)
96 struct connman_network *network;
99 network = connman_network_create("gadget",
100 CONNMAN_NETWORK_TYPE_GADGET);
104 index = connman_device_get_index(device);
105 connman_network_set_index(network, index);
107 connman_network_set_name(network, "Wired");
109 if (connman_device_add_network(device, network) < 0) {
110 connman_network_unref(network);
114 if (!gadget_tethering)
116 * Prevent service from starting the reconnect
117 * procedure as we do not want the DHCP client
118 * to run when tethering.
120 connman_network_set_group(network, "usb");
122 gadget->network = network;
125 static void remove_network(struct connman_device *device,
126 struct gadget_data *gadget)
128 if (!gadget->network)
131 connman_device_remove_network(device, gadget->network);
132 connman_network_unref(gadget->network);
134 gadget->network = NULL;
137 static void gadget_newlink(unsigned flags, unsigned change, void *user_data)
139 struct connman_device *device = user_data;
140 struct gadget_data *gadget = connman_device_get_data(device);
142 DBG("index %d flags %d change %d", gadget->index, flags, change);
144 if ((gadget->flags & IFF_UP) != (flags & IFF_UP)) {
145 if (flags & IFF_UP) {
147 connman_device_set_powered(device, true);
150 connman_device_set_powered(device, false);
154 if ((gadget->flags & IFF_LOWER_UP) != (flags & IFF_LOWER_UP)) {
155 if (flags & IFF_LOWER_UP) {
157 add_network(device, gadget);
160 remove_network(device, gadget);
164 gadget->flags = flags;
167 static int gadget_dev_probe(struct connman_device *device)
169 struct gadget_data *gadget;
171 DBG("device %p", device);
173 gadget = g_try_new0(struct gadget_data, 1);
177 connman_device_set_data(device, gadget);
179 gadget->index = connman_device_get_index(device);
182 gadget->watch = connman_rtnl_add_newlink_watch(gadget->index,
183 gadget_newlink, device);
188 static void gadget_dev_remove(struct connman_device *device)
190 struct gadget_data *gadget = connman_device_get_data(device);
192 DBG("device %p", device);
194 connman_device_set_data(device, NULL);
196 connman_rtnl_remove_watch(gadget->watch);
198 remove_network(device, gadget);
203 static int gadget_dev_enable(struct connman_device *device)
205 struct gadget_data *gadget = connman_device_get_data(device);
207 DBG("device %p", device);
209 return connman_inet_ifup(gadget->index);
212 static int gadget_dev_disable(struct connman_device *device)
214 struct gadget_data *gadget = connman_device_get_data(device);
216 DBG("device %p", device);
218 return connman_inet_ifdown(gadget->index);
221 static struct connman_device_driver gadget_dev_driver = {
223 .type = CONNMAN_DEVICE_TYPE_GADGET,
224 .probe = gadget_dev_probe,
225 .remove = gadget_dev_remove,
226 .enable = gadget_dev_enable,
227 .disable = gadget_dev_disable,
230 static GList *cdc_interface_list = NULL;
231 static GHashTable *cdc_mac_hash = NULL;
233 static void add_station(int index)
235 char *path, line[128] = {'\0'};
236 char *ifname = connman_inet_ifname(index);
243 path = g_strdup_printf("/sys/class/usb_mode/%s/f_rndis/ethaddr",
246 f = fopen(path, "re");
254 if (fgets(line, sizeof(line), f) == NULL) {
261 mac = g_ascii_strdown(line, strlen(line) - 1);
262 DBG("Add station %s in Technology %d", mac,
263 CONNMAN_SERVICE_TYPE_GADGET);
265 g_hash_table_insert(cdc_mac_hash, GINT_TO_POINTER(index),
268 connman_technology_tethering_add_station(CONNMAN_SERVICE_TYPE_GADGET,
272 static void remove_station(int index)
275 mac = g_hash_table_lookup(cdc_mac_hash, GINT_TO_POINTER(index));
279 connman_technology_tethering_remove_station(mac);
281 g_hash_table_remove(cdc_mac_hash, GINT_TO_POINTER(index));
284 static gboolean remove_all_station(gpointer key, gpointer value, gpointer user_data)
291 connman_technology_tethering_remove_station(mac);
297 static void gadget_tech_add_interface(struct connman_technology *technology,
298 int index, const char *name, const char *ident)
300 DBG("index %d name %s ident %s", index, name, ident);
302 if (g_list_find(cdc_interface_list, GINT_TO_POINTER((int)index)))
305 cdc_interface_list = g_list_prepend(cdc_interface_list,
306 (GINT_TO_POINTER((int) index)));
309 static void gadget_tech_remove_interface(struct connman_technology *technology,
312 DBG("index %d", index);
314 cdc_interface_list = g_list_remove(cdc_interface_list,
315 GINT_TO_POINTER((int) index));
317 remove_station(index);
320 static void gadget_tech_enable_tethering(struct connman_technology *technology,
325 for (list = cdc_interface_list; list; list = list->next) {
326 int index = GPOINTER_TO_INT(list->data);
327 struct connman_device *device =
328 connman_device_find_by_index(index);
329 struct gadget_data *gadget;
332 gadget = connman_device_get_data(device);
334 remove_network(device, gadget);
337 connman_technology_tethering_notify(technology, true);
339 connman_inet_ifup(index);
341 connman_inet_add_to_bridge(index, bridge);
347 static void gadget_tech_disable_tethering(struct connman_technology *technology,
352 for (list = cdc_interface_list; list; list = list->next) {
353 int index = GPOINTER_TO_INT(list->data);
355 connman_inet_remove_from_bridge(index, bridge);
357 remove_station(index);
359 connman_inet_ifdown(index);
361 connman_technology_tethering_notify(technology, false);
365 static int gadget_tech_set_tethering(struct connman_technology *technology,
366 const char *identifier, const char *passphrase,
367 const char *bridge, bool enabled)
369 DBG("bridge %s enabled %d", bridge, enabled);
372 gadget_tech_enable_tethering(technology, bridge);
374 gadget_tech_disable_tethering(technology, bridge);
379 static int gadget_tech_probe(struct connman_technology *technology)
381 DBG("tech probe %p", technology);
383 cdc_mac_hash = g_hash_table_new_full(g_direct_hash,
384 g_direct_equal, NULL, g_free);
389 static void gadget_tech_remove(struct connman_technology *technology)
391 DBG("tech remove %p", technology);
393 g_list_free(cdc_interface_list);
395 cdc_interface_list = NULL;
398 g_hash_table_foreach_remove(cdc_mac_hash, remove_all_station,
400 g_hash_table_destroy(cdc_mac_hash);
405 static struct connman_technology_driver gadget_tech_driver = {
406 .name = "cdc_ethernet",
407 .type = CONNMAN_SERVICE_TYPE_GADGET,
408 .probe = gadget_tech_probe,
409 .remove = gadget_tech_remove,
410 .add_interface = gadget_tech_add_interface,
411 .remove_interface = gadget_tech_remove_interface,
412 .set_tethering = gadget_tech_set_tethering,
415 static int gadget_init(void)
419 err = connman_technology_driver_register(&gadget_tech_driver);
424 err = connman_network_driver_register(&gadget_network_driver);
428 err = connman_device_driver_register(&gadget_dev_driver);
430 connman_technology_driver_unregister(&gadget_tech_driver);
437 static void gadget_exit(void)
439 connman_technology_driver_unregister(&gadget_tech_driver);
440 connman_network_driver_unregister(&gadget_network_driver);
441 connman_device_driver_unregister(&gadget_dev_driver);
444 CONNMAN_PLUGIN_DEFINE(gadget, "Gadget interface plugin", VERSION,
445 CONNMAN_PLUGIN_PRIORITY_DEFAULT, gadget_init, gadget_exit)