5 * Copyright (C) 2007-2010 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
26 #include <sys/types.h>
30 #include <sys/ioctl.h>
32 #include <linux/sockios.h>
36 #include <gdhcp/gdhcp.h>
40 #define BRIDGE_PROC_DIR "/proc/sys/net/bridge"
42 #define BRIDGE_NAME "tether"
43 #define BRIDGE_IP "192.168.218.1"
44 #define BRIDGE_BCAST "192.168.218.255"
45 #define BRIDGE_SUBNET "255.255.255.0"
46 #define BRIDGE_IP_START "192.168.218.100"
47 #define BRIDGE_IP_END "192.168.218.200"
48 #define BRIDGE_DNS "8.8.8.8"
50 static char *default_interface = NULL;
51 static volatile gint tethering_enabled;
52 static GDHCPServer *tethering_dhcp_server = NULL;
53 static DBusConnection *connection;
54 static GHashTable *pn_hash;
56 struct connman_private_network {
61 const char *__connman_tethering_get_bridge(void)
65 if (stat(BRIDGE_PROC_DIR, &st) < 0) {
66 connman_error("Missing support for 802.1d ethernet bridging");
73 static void dhcp_server_debug(const char *str, void *data)
75 connman_info("%s: %s\n", (const char *) data, str);
78 static void dhcp_server_error(GDHCPServerError error)
81 case G_DHCP_SERVER_ERROR_NONE:
84 case G_DHCP_SERVER_ERROR_INTERFACE_UNAVAILABLE:
85 connman_error("Interface unavailable");
87 case G_DHCP_SERVER_ERROR_INTERFACE_IN_USE:
88 connman_error("Interface in use");
90 case G_DHCP_SERVER_ERROR_INTERFACE_DOWN:
91 connman_error("Interface down");
93 case G_DHCP_SERVER_ERROR_NOMEM:
94 connman_error("No memory");
96 case G_DHCP_SERVER_ERROR_INVALID_INDEX:
97 connman_error("Invalid index");
99 case G_DHCP_SERVER_ERROR_INVALID_OPTION:
100 connman_error("Invalid option");
102 case G_DHCP_SERVER_ERROR_IP_ADDRESS_INVALID:
103 connman_error("Invalid address");
108 static GDHCPServer *dhcp_server_start(const char *bridge,
109 const char *router, const char* subnet,
110 const char *start_ip, const char *end_ip,
111 unsigned int lease_time, const char *dns)
113 GDHCPServerError error;
114 GDHCPServer *dhcp_server;
119 index = connman_inet_ifindex(bridge);
123 dhcp_server = g_dhcp_server_new(G_DHCP_IPV4, index, &error);
124 if (dhcp_server == NULL) {
125 dhcp_server_error(error);
129 g_dhcp_server_set_debug(dhcp_server, dhcp_server_debug, "DHCP server");
131 g_dhcp_server_set_lease_time(dhcp_server, lease_time);
132 g_dhcp_server_set_option(dhcp_server, G_DHCP_SUBNET, subnet);
133 g_dhcp_server_set_option(dhcp_server, G_DHCP_ROUTER, router);
134 g_dhcp_server_set_option(dhcp_server, G_DHCP_DNS_SERVER, dns);
135 g_dhcp_server_set_ip_range(dhcp_server, start_ip, end_ip);
137 g_dhcp_server_start(dhcp_server);
142 static void dhcp_server_stop(GDHCPServer *server)
147 g_dhcp_server_unref(server);
150 static int set_forward_delay(const char *name, unsigned int delay)
153 char *forward_delay_path;
156 g_strdup_printf("/sys/class/net/%s/bridge/forward_delay", name);
158 if (forward_delay_path == NULL)
161 f = fopen(forward_delay_path, "r+");
163 g_free(forward_delay_path);
168 fprintf(f, "%d", delay);
175 static int create_bridge(const char *name)
179 DBG("name %s", name);
181 sk = socket(AF_INET, SOCK_STREAM, 0);
185 err = ioctl(sk, SIOCBRADDBR, name);
190 err = set_forward_delay(name, 0);
193 ioctl(sk, SIOCBRDELBR, name);
200 static int remove_bridge(const char *name)
204 DBG("name %s", name);
206 sk = socket(AF_INET, SOCK_STREAM, 0);
210 err = ioctl(sk, SIOCBRDELBR, name);
220 static int enable_bridge(const char *name)
224 index = connman_inet_ifindex(name);
228 err = __connman_inet_modify_address(RTM_NEWADDR,
229 NLM_F_REPLACE | NLM_F_ACK, index, AF_INET,
230 BRIDGE_IP, NULL, 24, BRIDGE_BCAST);
234 return connman_inet_ifup(index);
237 static int disable_bridge(const char *name)
241 index = connman_inet_ifindex(name);
245 return connman_inet_ifdown(index);
248 static int enable_ip_forward(connman_bool_t enable)
253 f = fopen("/proc/sys/net/ipv4/ip_forward", "r+");
267 static int enable_nat(const char *interface)
271 if (interface == NULL)
274 /* Enable IPv4 forwarding */
275 err = enable_ip_forward(TRUE);
279 /* POSTROUTING flush */
280 err = __connman_iptables_command("-t nat -F POSTROUTING");
284 /* Enable masquerading */
285 err = __connman_iptables_command("-t nat -A POSTROUTING "
286 "-o %s -j MASQUERADE", interface);
290 return __connman_iptables_commit("nat");
293 static void disable_nat(const char *interface)
297 /* Disable IPv4 forwarding */
298 enable_ip_forward(FALSE);
300 /* POSTROUTING flush */
301 err = __connman_iptables_command("-t nat -F POSTROUTING");
305 __connman_iptables_commit("nat");
308 void __connman_tethering_set_enabled(void)
312 DBG("enabled %d", tethering_enabled + 1);
314 if (g_atomic_int_exchange_and_add(&tethering_enabled, 1) == 0) {
315 err = create_bridge(BRIDGE_NAME);
319 err = enable_bridge(BRIDGE_NAME);
321 remove_bridge(BRIDGE_NAME);
325 tethering_dhcp_server =
326 dhcp_server_start(BRIDGE_NAME,
327 BRIDGE_IP, BRIDGE_SUBNET,
328 BRIDGE_IP_START, BRIDGE_IP_END,
329 24 * 3600, BRIDGE_DNS);
330 if (tethering_dhcp_server == NULL) {
331 disable_bridge(BRIDGE_NAME);
332 remove_bridge(BRIDGE_NAME);
336 enable_nat(default_interface);
338 DBG("tethering started");
342 void __connman_tethering_set_disabled(void)
344 DBG("enabled %d", tethering_enabled - 1);
346 if (g_atomic_int_dec_and_test(&tethering_enabled) == TRUE) {
347 disable_nat(default_interface);
349 dhcp_server_stop(tethering_dhcp_server);
351 disable_bridge(BRIDGE_NAME);
353 remove_bridge(BRIDGE_NAME);
355 DBG("tethering stopped");
359 void __connman_tethering_update_interface(const char *interface)
361 DBG("interface %s", interface);
363 g_free(default_interface);
365 if (interface == NULL) {
366 disable_nat(interface);
367 default_interface = NULL;
372 default_interface = g_strdup(interface);
374 if (!g_atomic_int_get(&tethering_enabled))
377 enable_nat(interface);
380 static void remove_private_network(gpointer user_data)
382 struct connman_private_network *pn = user_data;
385 g_dbus_remove_watch(connection, pn->watch);
393 static void owner_disconnect(DBusConnection *connection, void *user_data)
395 struct connman_private_network *pn = user_data;
397 DBG("%s died", pn->owner);
401 g_hash_table_remove(pn_hash, pn->owner);
404 int __connman_private_network_request(const char *owner)
406 struct connman_private_network *pn;
408 pn = g_hash_table_lookup(pn_hash, owner);
412 pn = g_try_new0(struct connman_private_network, 1);
416 pn->owner = g_strdup(owner);
417 pn->watch = g_dbus_add_disconnect_watch(connection, pn->owner,
418 owner_disconnect, pn, NULL);
420 g_hash_table_insert(pn_hash, pn->owner, pn);
425 int __connman_private_network_release(const char *owner)
427 struct connman_private_network *pn;
429 pn = g_hash_table_lookup(pn_hash, owner);
433 g_hash_table_remove(pn_hash, owner);
437 int __connman_tethering_init(void)
441 tethering_enabled = 0;
443 connection = connman_dbus_get_connection();
444 if (connection == NULL)
447 pn_hash = g_hash_table_new_full(g_str_hash, g_str_equal,
448 NULL, remove_private_network);
453 void __connman_tethering_cleanup(void)
457 if (g_atomic_int_get(&tethering_enabled)) {
458 if (tethering_dhcp_server)
459 dhcp_server_stop(tethering_dhcp_server);
460 disable_bridge(BRIDGE_NAME);
461 remove_bridge(BRIDGE_NAME);
464 if (connection == NULL)
467 g_hash_table_destroy(pn_hash);
468 dbus_connection_unref(connection);