5 * Copyright (C) 2007-2010 Intel Corporation. All rights reserved.
6 * Copyright (C) 2011 ProFUSION embedded systems
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License version 2 as
10 * published by the Free Software Foundation.
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
17 * You should have received a copy of the GNU General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
27 #include <sys/types.h>
31 #include <sys/ioctl.h>
33 #include <linux/sockios.h>
36 #include <linux/if_tun.h>
40 #include <gdhcp/gdhcp.h>
44 #define BRIDGE_PROC_DIR "/proc/sys/net/bridge"
46 #define BRIDGE_NAME "tether"
47 #define BRIDGE_IP "192.168.218.1"
48 #define BRIDGE_BCAST "192.168.218.255"
49 #define BRIDGE_SUBNET "255.255.255.0"
50 #define BRIDGE_IP_START "192.168.218.100"
51 #define BRIDGE_IP_END "192.168.218.200"
52 #define BRIDGE_DNS "8.8.8.8"
54 #define DEFAULT_MTU 1500
56 #define PRIVATE_NETWORK_IP "192.168.219.1"
57 #define PRIVATE_NETWORK_PEER_IP "192.168.219.2"
58 #define PRIVATE_NETWORK_NETMASK "255.255.255.0"
59 #define PRIVATE_NETWORK_PRIMARY_DNS BRIDGE_DNS
60 #define PRIVATE_NETWORK_SECONDARY_DNS "8.8.4.4"
62 static char *default_interface = NULL;
63 static volatile gint tethering_enabled;
64 static GDHCPServer *tethering_dhcp_server = NULL;
65 static DBusConnection *connection;
66 static GHashTable *pn_hash;
68 struct connman_private_network {
77 const char *server_ip;
79 const char *primary_dns;
80 const char *secondary_dns;
83 const char *__connman_tethering_get_bridge(void)
87 if (stat(BRIDGE_PROC_DIR, &st) < 0) {
88 connman_error("Missing support for 802.1d ethernet bridging");
95 static void dhcp_server_debug(const char *str, void *data)
97 connman_info("%s: %s\n", (const char *) data, str);
100 static void dhcp_server_error(GDHCPServerError error)
103 case G_DHCP_SERVER_ERROR_NONE:
106 case G_DHCP_SERVER_ERROR_INTERFACE_UNAVAILABLE:
107 connman_error("Interface unavailable");
109 case G_DHCP_SERVER_ERROR_INTERFACE_IN_USE:
110 connman_error("Interface in use");
112 case G_DHCP_SERVER_ERROR_INTERFACE_DOWN:
113 connman_error("Interface down");
115 case G_DHCP_SERVER_ERROR_NOMEM:
116 connman_error("No memory");
118 case G_DHCP_SERVER_ERROR_INVALID_INDEX:
119 connman_error("Invalid index");
121 case G_DHCP_SERVER_ERROR_INVALID_OPTION:
122 connman_error("Invalid option");
124 case G_DHCP_SERVER_ERROR_IP_ADDRESS_INVALID:
125 connman_error("Invalid address");
130 static GDHCPServer *dhcp_server_start(const char *bridge,
131 const char *router, const char* subnet,
132 const char *start_ip, const char *end_ip,
133 unsigned int lease_time, const char *dns)
135 GDHCPServerError error;
136 GDHCPServer *dhcp_server;
141 index = connman_inet_ifindex(bridge);
145 dhcp_server = g_dhcp_server_new(G_DHCP_IPV4, index, &error);
146 if (dhcp_server == NULL) {
147 dhcp_server_error(error);
151 g_dhcp_server_set_debug(dhcp_server, dhcp_server_debug, "DHCP server");
153 g_dhcp_server_set_lease_time(dhcp_server, lease_time);
154 g_dhcp_server_set_option(dhcp_server, G_DHCP_SUBNET, subnet);
155 g_dhcp_server_set_option(dhcp_server, G_DHCP_ROUTER, router);
156 g_dhcp_server_set_option(dhcp_server, G_DHCP_DNS_SERVER, dns);
157 g_dhcp_server_set_ip_range(dhcp_server, start_ip, end_ip);
159 g_dhcp_server_start(dhcp_server);
164 static void dhcp_server_stop(GDHCPServer *server)
169 g_dhcp_server_unref(server);
172 static int set_forward_delay(const char *name, unsigned int delay)
175 char *forward_delay_path;
178 g_strdup_printf("/sys/class/net/%s/bridge/forward_delay", name);
180 if (forward_delay_path == NULL)
183 f = fopen(forward_delay_path, "r+");
185 g_free(forward_delay_path);
190 fprintf(f, "%d", delay);
197 static int create_bridge(const char *name)
201 DBG("name %s", name);
203 sk = socket(AF_INET, SOCK_STREAM, 0);
207 err = ioctl(sk, SIOCBRADDBR, name);
212 err = set_forward_delay(name, 0);
215 ioctl(sk, SIOCBRDELBR, name);
222 static int remove_bridge(const char *name)
226 DBG("name %s", name);
228 sk = socket(AF_INET, SOCK_STREAM, 0);
232 err = ioctl(sk, SIOCBRDELBR, name);
242 static int enable_bridge(const char *name)
246 index = connman_inet_ifindex(name);
250 err = __connman_inet_modify_address(RTM_NEWADDR,
251 NLM_F_REPLACE | NLM_F_ACK, index, AF_INET,
252 BRIDGE_IP, NULL, 24, BRIDGE_BCAST);
256 return connman_inet_ifup(index);
259 static int disable_bridge(const char *name)
263 index = connman_inet_ifindex(name);
267 return connman_inet_ifdown(index);
270 static int enable_ip_forward(connman_bool_t enable)
275 f = fopen("/proc/sys/net/ipv4/ip_forward", "r+");
289 static int enable_nat(const char *interface)
293 if (interface == NULL)
296 /* Enable IPv4 forwarding */
297 err = enable_ip_forward(TRUE);
301 /* POSTROUTING flush */
302 err = __connman_iptables_command("-t nat -F POSTROUTING");
306 /* Enable masquerading */
307 err = __connman_iptables_command("-t nat -A POSTROUTING "
308 "-o %s -j MASQUERADE", interface);
312 return __connman_iptables_commit("nat");
315 static void disable_nat(const char *interface)
319 /* Disable IPv4 forwarding */
320 enable_ip_forward(FALSE);
322 /* POSTROUTING flush */
323 err = __connman_iptables_command("-t nat -F POSTROUTING");
327 __connman_iptables_commit("nat");
330 void __connman_tethering_set_enabled(void)
334 DBG("enabled %d", tethering_enabled + 1);
336 if (g_atomic_int_exchange_and_add(&tethering_enabled, 1) == 0) {
337 err = create_bridge(BRIDGE_NAME);
341 err = enable_bridge(BRIDGE_NAME);
343 remove_bridge(BRIDGE_NAME);
347 tethering_dhcp_server =
348 dhcp_server_start(BRIDGE_NAME,
349 BRIDGE_IP, BRIDGE_SUBNET,
350 BRIDGE_IP_START, BRIDGE_IP_END,
351 24 * 3600, BRIDGE_DNS);
352 if (tethering_dhcp_server == NULL) {
353 disable_bridge(BRIDGE_NAME);
354 remove_bridge(BRIDGE_NAME);
358 enable_nat(default_interface);
360 DBG("tethering started");
364 void __connman_tethering_set_disabled(void)
366 DBG("enabled %d", tethering_enabled - 1);
368 if (g_atomic_int_dec_and_test(&tethering_enabled) == TRUE) {
369 disable_nat(default_interface);
371 dhcp_server_stop(tethering_dhcp_server);
373 disable_bridge(BRIDGE_NAME);
375 remove_bridge(BRIDGE_NAME);
377 DBG("tethering stopped");
381 void __connman_tethering_update_interface(const char *interface)
383 DBG("interface %s", interface);
385 g_free(default_interface);
387 if (interface == NULL) {
388 disable_nat(interface);
389 default_interface = NULL;
394 default_interface = g_strdup(interface);
396 if (!g_atomic_int_get(&tethering_enabled))
399 enable_nat(interface);
402 static void setup_tun_interface(unsigned int flags, unsigned change,
405 struct connman_private_network *pn = data;
406 unsigned char prefixlen;
408 DBusMessageIter array, dict;
411 DBG("index %d flags %d change %d", pn->index, flags, change);
417 __connman_ipconfig_netmask_prefix_len(PRIVATE_NETWORK_NETMASK);
419 if ((__connman_inet_modify_address(RTM_NEWADDR,
420 NLM_F_REPLACE | NLM_F_ACK, pn->index, AF_INET,
421 pn->server_ip, pn->peer_ip,
422 prefixlen, NULL)) < 0) {
423 DBG("address setting failed");
427 connman_inet_ifup(pn->index);
429 err = enable_nat(default_interface);
431 connman_error("failed to enable NAT on %s", default_interface);
435 reply = dbus_message_new_method_return(pn->msg);
440 dbus_message_iter_init_append(reply, &array);
442 dbus_message_iter_append_basic(&array, DBUS_TYPE_UNIX_FD, &pn->fd);
444 connman_dbus_dict_open(&array, &dict);
446 connman_dbus_dict_append_basic(&dict, "ServerIPv4",
447 DBUS_TYPE_STRING, &pn->server_ip);
448 connman_dbus_dict_append_basic(&dict, "PeerIPv4",
449 DBUS_TYPE_STRING, &pn->peer_ip);
450 connman_dbus_dict_append_basic(&dict, "PrimaryDNS",
451 DBUS_TYPE_STRING, &pn->primary_dns);
452 connman_dbus_dict_append_basic(&dict, "SecondaryDNS",
453 DBUS_TYPE_STRING, &pn->secondary_dns);
455 connman_dbus_dict_close(&array, &dict);
457 g_dbus_send_message(connection, reply);
462 reply = __connman_error_failed(pn->msg, -err);
463 g_dbus_send_message(connection, reply);
465 g_hash_table_remove(pn_hash, pn->owner);
468 static void remove_private_network(gpointer user_data)
470 struct connman_private_network *pn = user_data;
474 connman_rtnl_remove_watch(pn->iface_watch);
476 disable_nat(default_interface);
479 g_dbus_remove_watch(connection, pn->watch);
483 g_free(pn->interface);
488 static void owner_disconnect(DBusConnection *connection, void *user_data)
490 struct connman_private_network *pn = user_data;
492 DBG("%s died", pn->owner);
496 g_hash_table_remove(pn_hash, pn->owner);
499 int __connman_private_network_request(DBusMessage *msg, const char *owner)
501 struct connman_private_network *pn;
505 pn = g_hash_table_lookup(pn_hash, owner);
509 fd = connman_inet_create_tunnel(&iface);
513 index = connman_inet_ifindex(iface);
518 DBG("inteface %s", iface);
520 err = connman_inet_set_mtu(index, DEFAULT_MTU);
522 pn = g_try_new0(struct connman_private_network, 1);
528 pn->owner = g_strdup(owner);
529 pn->watch = g_dbus_add_disconnect_watch(connection, pn->owner,
530 owner_disconnect, pn, NULL);
533 pn->interface = iface;
535 pn->server_ip = PRIVATE_NETWORK_IP;
536 pn->peer_ip = PRIVATE_NETWORK_PEER_IP;
537 pn->primary_dns = PRIVATE_NETWORK_PRIMARY_DNS;
538 pn->secondary_dns = PRIVATE_NETWORK_SECONDARY_DNS;
540 pn->iface_watch = connman_rtnl_add_newlink_watch(index,
541 setup_tun_interface, pn);
543 g_hash_table_insert(pn_hash, pn->owner, pn);
553 int __connman_private_network_release(const char *owner)
555 struct connman_private_network *pn;
557 pn = g_hash_table_lookup(pn_hash, owner);
561 g_hash_table_remove(pn_hash, owner);
565 int __connman_tethering_init(void)
569 tethering_enabled = 0;
571 connection = connman_dbus_get_connection();
572 if (connection == NULL)
575 pn_hash = g_hash_table_new_full(g_str_hash, g_str_equal,
576 NULL, remove_private_network);
581 void __connman_tethering_cleanup(void)
585 if (g_atomic_int_get(&tethering_enabled)) {
586 if (tethering_dhcp_server)
587 dhcp_server_stop(tethering_dhcp_server);
588 disable_bridge(BRIDGE_NAME);
589 remove_bridge(BRIDGE_NAME);
592 if (connection == NULL)
595 g_hash_table_destroy(pn_hash);
596 dbus_connection_unref(connection);