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>
38 #define BRIDGE_SYSFS_DIR "/sys/module/bridge"
40 #define BRIDGE_NAME "tether"
41 #define BRIDGE_IP "192.168.218.1"
42 #define BRIDGE_BCAST "192.168.218.255"
43 #define BRIDGE_SUBNET "255.255.255.0"
44 #define BRIDGE_IP_START "192.168.218.100"
45 #define BRIDGE_IP_END "192.168.218.200"
46 #define BRIDGE_DNS "8.8.8.8"
48 static char *default_interface = NULL;
49 static volatile gint tethering_enabled;
50 static GDHCPServer *tethering_dhcp_server = NULL;
52 const char *__connman_tethering_get_bridge(void)
56 if (stat(BRIDGE_SYSFS_DIR, &st) < 0) {
57 connman_error("Missing support for 802.1d ethernet bridging");
64 static void dhcp_server_debug(const char *str, void *data)
66 connman_info("%s: %s\n", (const char *) data, str);
69 static void dhcp_server_error(GDHCPServerError error)
72 case G_DHCP_SERVER_ERROR_NONE:
75 case G_DHCP_SERVER_ERROR_INTERFACE_UNAVAILABLE:
76 connman_error("Interface unavailable");
78 case G_DHCP_SERVER_ERROR_INTERFACE_IN_USE:
79 connman_error("Interface in use");
81 case G_DHCP_SERVER_ERROR_INTERFACE_DOWN:
82 connman_error("Interface down");
84 case G_DHCP_SERVER_ERROR_NOMEM:
85 connman_error("No memory");
87 case G_DHCP_SERVER_ERROR_INVALID_INDEX:
88 connman_error("Invalid index");
90 case G_DHCP_SERVER_ERROR_INVALID_OPTION:
91 connman_error("Invalid option");
93 case G_DHCP_SERVER_ERROR_IP_ADDRESS_INVALID:
94 connman_error("Invalid address");
99 static GDHCPServer *dhcp_server_start(const char *bridge,
100 const char *router, const char* subnet,
101 const char *start_ip, const char *end_ip,
102 unsigned int lease_time, const char *dns)
104 GDHCPServerError error;
105 GDHCPServer *dhcp_server;
110 index = connman_inet_ifindex(bridge);
114 dhcp_server = g_dhcp_server_new(G_DHCP_IPV4, index, &error);
115 if (dhcp_server == NULL) {
116 dhcp_server_error(error);
120 g_dhcp_server_set_debug(dhcp_server, dhcp_server_debug, "DHCP server");
122 g_dhcp_server_set_lease_time(dhcp_server, lease_time);
123 g_dhcp_server_set_option(dhcp_server, G_DHCP_SUBNET, subnet);
124 g_dhcp_server_set_option(dhcp_server, G_DHCP_ROUTER, router);
125 g_dhcp_server_set_option(dhcp_server, G_DHCP_DNS_SERVER, dns);
126 g_dhcp_server_set_ip_range(dhcp_server, start_ip, end_ip);
128 g_dhcp_server_start(dhcp_server);
133 static void dhcp_server_stop(GDHCPServer *server)
138 g_dhcp_server_unref(server);
141 static int set_forward_delay(const char *name, unsigned int delay)
144 char *forward_delay_path;
147 g_strdup_printf("/sys/class/net/%s/bridge/forward_delay", name);
149 if (forward_delay_path == NULL)
152 f = fopen(forward_delay_path, "r+");
154 g_free(forward_delay_path);
159 fprintf(f, "%d", delay);
166 static int create_bridge(const char *name)
170 DBG("name %s", name);
172 sk = socket(AF_INET, SOCK_STREAM, 0);
176 err = ioctl(sk, SIOCBRADDBR, name);
181 err = set_forward_delay(name, 0);
184 ioctl(sk, SIOCBRDELBR, name);
191 static int remove_bridge(const char *name)
195 DBG("name %s", name);
197 sk = socket(AF_INET, SOCK_STREAM, 0);
201 err = ioctl(sk, SIOCBRDELBR, name);
211 static int enable_bridge(const char *name)
215 index = connman_inet_ifindex(name);
219 err = __connman_inet_modify_address(RTM_NEWADDR,
220 NLM_F_REPLACE | NLM_F_ACK, index, AF_INET,
221 BRIDGE_IP, NULL, 24, BRIDGE_BCAST);
225 return connman_inet_ifup(index);
228 static int disable_bridge(const char *name)
232 index = connman_inet_ifindex(name);
236 return connman_inet_ifdown(index);
239 static int enable_ip_forward(connman_bool_t enable)
244 f = fopen("/proc/sys/net/ipv4/ip_forward", "r+");
258 static int enable_nat(const char *interface)
262 if (interface == NULL)
265 /* Enable IPv4 forwarding */
266 err = enable_ip_forward(TRUE);
270 /* POSTROUTING flush */
271 err = __connman_iptables_command("-t nat -F POSTROUTING");
275 /* Enable masquerading */
276 err = __connman_iptables_command("-t nat -A POSTROUTING "
277 "-o %s -j MASQUERADE", interface);
281 return __connman_iptables_commit("nat");
284 static void disable_nat(const char *interface)
288 /* Disable IPv4 forwarding */
289 enable_ip_forward(FALSE);
291 /* POSTROUTING flush */
292 err = __connman_iptables_command("-t nat -F POSTROUTING");
296 __connman_iptables_commit("nat");
299 void __connman_tethering_set_enabled(void)
303 DBG("enabled %d", tethering_enabled + 1);
305 if (g_atomic_int_exchange_and_add(&tethering_enabled, 1) == 0) {
306 err = create_bridge(BRIDGE_NAME);
310 err = enable_bridge(BRIDGE_NAME);
312 remove_bridge(BRIDGE_NAME);
316 tethering_dhcp_server =
317 dhcp_server_start(BRIDGE_NAME,
318 BRIDGE_IP, BRIDGE_SUBNET,
319 BRIDGE_IP_START, BRIDGE_IP_END,
320 24 * 3600, BRIDGE_DNS);
321 if (tethering_dhcp_server == NULL) {
322 disable_bridge(BRIDGE_NAME);
323 remove_bridge(BRIDGE_NAME);
327 enable_nat(default_interface);
329 DBG("tethering started");
333 void __connman_tethering_set_disabled(void)
335 DBG("enabled %d", tethering_enabled - 1);
337 if (g_atomic_int_dec_and_test(&tethering_enabled) == TRUE) {
338 disable_nat(default_interface);
340 dhcp_server_stop(tethering_dhcp_server);
342 disable_bridge(BRIDGE_NAME);
344 remove_bridge(BRIDGE_NAME);
346 DBG("tethering stopped");
350 void __connman_tethering_update_interface(const char *interface)
352 DBG("interface %s", interface);
354 g_free(default_interface);
356 if (interface == NULL) {
357 disable_nat(interface);
358 default_interface = NULL;
363 default_interface = g_strdup(interface);
365 if (!g_atomic_int_get(&tethering_enabled))
368 enable_nat(interface);
371 int __connman_tethering_init(void)
375 tethering_enabled = 0;
380 void __connman_tethering_cleanup(void)
384 if (g_atomic_int_get(&tethering_enabled)) {
385 if (tethering_dhcp_server)
386 dhcp_server_stop(tethering_dhcp_server);
387 disable_bridge(BRIDGE_NAME);
388 remove_bridge(BRIDGE_NAME);