2 * Copyright (c) 2015 Samsung Electronics Co., Ltd All Rights Reserved
4 * Licensed under the Apache License, Version 2.0 (the "License");
5 * you may not use this file except in compliance with the License.
6 * You may obtain a copy of the License at
8 * http://www.apache.org/licenses/LICENSE-2.0
10 * Unless required by applicable law or agreed to in writing, software
11 * distributed under the License is distributed on an "AS IS" BASIS,
12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13 * See the License for the specific language governing permissions and
14 * limitations under the License.
27 #include "bluetooth-api.h"
28 #include <net_connection.h>
29 #include <sys/socket.h>
31 #include <netinet/in.h>
32 #include <arpa/inet.h>
33 #include <sys/ioctl.h>
34 #include <bluetooth_type.h>
37 #define LOG_TAG "BLUETOOTH_IPSP"
39 #define BT_INFO(fmt, arg...) SLOGI(fmt, ##arg)
40 #define BT_ERR(fmt, arg...) SLOGE(fmt, ##arg)
41 #define BT_DBG(fmt, arg...) SLOGD(fmt, ##arg)
43 static GDBusConnection *service_gconn;
44 static connection_h net_connection = NULL;
45 static connection_profile_h tethered_prof = NULL;
46 static pid_t dnsmasq_pid = 0;
47 static char dns_addr[INET_ADDRSTRLEN] = "0.0.0.0";
50 struct in6_addr ifr6_addr;
52 unsigned int ifr6_ifindex;
55 static const gchar bt_ipsp_introspection_xml[] =
57 " <interface name='org.projectx.bt_ipsp'>"
58 " <method name='EnableIpsp'>"
60 " <method name='SetIpv6Addr'>"
61 " <arg type='s' name='ifname' direction='in'/>"
62 " <arg type='s' name='address' direction='in'/>"
64 " <method name='RecoverAdapter'>"
66 " <method name='ResetAdapter'>"
68 " <method name='EnableAdapterLe'>"
70 " <method name='DisableAdapterLe'>"
72 " <method name='EnableCore'>"
74 " <method name='SetTransferValue'>"
75 " <arg type='b' name='value' direction='in'/>"
77 " <method name='FactoryTestMode'>"
78 " <arg type='s' name='type' direction='in'/>"
79 " <arg type='s' name='arg' direction='in'/>"
80 " <arg type='i' name='ret' direction='out'/>"
85 static guint obj_id, sig_id1, sig_id2, sig_id3;
88 static GMainLoop *main_loop;
90 void _bt_ipsp_gdbus_deinit_proxys(void)
95 g_object_unref(service_gconn);
102 void _bt_ipsp_terminate(void)
104 _bt_ipsp_gdbus_deinit_proxys();
106 g_main_loop_quit(main_loop);
108 BT_DBG("Terminating bt-core daemon");
113 GDBusConnection * _bt_ipsp_get_gdbus_connection(void)
117 if (service_gconn == NULL)
118 service_gconn = g_bus_get_sync(G_BUS_TYPE_SYSTEM, NULL, &err);
120 if (!service_gconn) {
122 BT_ERR("Unable to connect to dbus: %s", err->message);
128 return service_gconn;
132 void _bt_ipsp_unregister_dbus(void)
134 GDBusConnection *conn;
138 conn = _bt_ipsp_get_gdbus_connection();
143 g_dbus_connection_unregister_object(conn, obj_id);
148 g_dbus_connection_signal_unsubscribe(conn, sig_id1);
152 g_dbus_connection_signal_unsubscribe(conn, sig_id2);
156 g_dbus_connection_signal_unsubscribe(conn, sig_id3);
161 static void __bt_ipsp_sigterm_handler(int signo)
163 BT_DBG("Got the signal: %d", signo);
165 _bt_ipsp_terminate();
168 static void __bt_ipsp_get_network_interface_name(char **if_name)
170 if (if_name == NULL) {
171 BT_ERR("if_name is NULL\n");
175 if (tethered_prof == NULL) {
176 BT_ERR("tethered prof is NULL");
182 connection_profile_refresh(tethered_prof);
184 ret = connection_profile_get_network_interface_name(tethered_prof, if_name);
185 if (ret != CONNECTION_ERROR_NONE) {
186 BT_ERR("connection_profile_get_network_interface_name is failed : 0x%X\n", ret);
190 BT_DBG("network if name : %s", *if_name);
192 if (strlen(*if_name) == 0) {
193 BT_ERR("if_name is zero length\n");
202 gboolean __bt_ipsp_get_network_ipv6_address(const char *if_name, mobile_ap_ipv6_scope_e ip_scope, gchar **ip)
206 char name[MH_MAX_INTERFACE_NAME_LEN] = {0,};
207 char copied[MH_MAX_IPV6_ADDRESS_STR_LEN] = {0,};
208 int if_idx, prefix_len, scope, if_flag;
210 fd = fopen(MH_IF_INET6_PATH, "r");
212 BT_ERR("Failed to open file!!");
216 while (fscanf(fd, "%4s%4s%4s%4s%4s%4s%4s%4s %2x %d %d %2x %19s",
217 addr[0], addr[1], addr[2], addr[3],
218 addr[4], addr[5], addr[6], addr[7],
219 &if_idx, &prefix_len, &scope, &if_flag, name) != EOF) {
221 if (strncmp(name, if_name, strlen(if_name)) != 0)
224 if (scope != ip_scope)
227 snprintf(copied, sizeof(copied), "%s:%s:%s:%s:%s:%s:%s:%s",
228 addr[0], addr[1], addr[2], addr[3],
229 addr[4], addr[5], addr[6], addr[7]);
231 *ip = g_strdup(copied);
233 BT_DBG("IP (%s)", *ip);
243 int __bt_ipsp_create_ipv6_address(char *ifname, char **ipv6_address)
246 gchar *network_if_name = NULL;
247 gchar *link_addr = NULL;
248 gchar *network_addr = NULL;
249 gchar *prefix = NULL;
251 char copied[MH_MAX_IPV6_ADDRESS_STR_LEN] = {0, };
252 gchar *link_addr_cpy = NULL;
255 __bt_ipsp_get_network_interface_name(&network_if_name);
256 __bt_ipsp_get_network_ipv6_address(ifname, MOBILE_AP_IPV6_SCOPE_LINK, &link_addr);
258 if (network_if_name) {
259 __bt_ipsp_get_network_ipv6_address(network_if_name, MOBILE_AP_IPV6_SCOPE_GLOBAL, &network_addr);
260 g_free(network_if_name);
263 if (link_addr == NULL || network_addr == NULL) {
264 BT_DBG("address is NULL");
266 g_free(network_addr);
267 return BT_ERROR_OPERATION_FAILED;
270 prefix = g_strndup(network_addr, 19);
271 g_free(network_addr);
273 link_addr_cpy = link_addr;
275 for (i = 0; i < 4; i++) {
276 strtok_r(link_addr_cpy, ":", &if_id);
277 link_addr_cpy = if_id;
279 snprintf(copied, sizeof(copied), "%s:%s", prefix, if_id);
281 *ipv6_address = g_strdup(copied);
283 BT_DBG("Created IPv6 address [%s]", *ipv6_address);
287 return BT_ERROR_NONE;
290 int __bt_ipsp_set_ipv6_address(const char *if_name, char *ipv6_addr)
294 struct sockaddr_in6 addr;
296 struct in6_ifreq ifr6;
298 sock_fd = socket(AF_INET6, SOCK_DGRAM, IPPROTO_IP);
300 BT_ERR("failed to open socket for ipv6");
301 return BT_ERROR_OPERATION_FAILED;
304 g_strlcpy(ifr.ifr_name, if_name, IFNAMSIZ);
306 memset(&addr, 0, sizeof(struct sockaddr_in6));
307 addr.sin6_family = AF_INET6;
310 if (inet_pton(AF_INET6, ipv6_addr, (void *)&addr.sin6_addr) <= 0) {
311 BT_ERR("Bad address!!");
313 return BT_ERROR_OPERATION_FAILED;
316 memcpy((char *)&ifr6.ifr6_addr, (char *)&addr.sin6_addr, sizeof(struct in6_addr));
318 if (ioctl(sock_fd, SIOGIFINDEX, &ifr) < 0) {
319 BT_ERR("ioctl failed...!!!\n");
321 return BT_ERROR_OPERATION_FAILED;
324 ifr6.ifr6_ifindex = ifr.ifr_ifindex;
325 ifr6.ifr6_prefixlen = 64;
327 if (ioctl(sock_fd, SIOCSIFADDR, &ifr6) < 0) {
328 BT_ERR("ioctl failed...!!!\n");
330 return BT_ERROR_OPERATION_FAILED;
333 ifr.ifr_flags |= IFF_UP | IFF_RUNNING;
335 if (ioctl(sock_fd, SIOCSIFFLAGS, &ifr) < 0) {
336 BT_ERR("ioctl failed...!!!\n");
338 return BT_ERROR_OPERATION_FAILED;
344 return BT_ERROR_NONE;
350 void __bt_ipsp_connection_state_changed_cb(int result, bool connected, const char *remote_address,
351 const char *iface_name, void *user_data)
353 BT_DBG("result: %d", result);
354 BT_DBG("Connected : %d", connected);
355 BT_DBG("Remote BT address : %s", remote_address);
356 BT_DBG("Interface name : %s", remote_address);
359 static int __enable_ipv6_forwarding(void)
364 fd = open(IPV6_FORWARDING, O_WRONLY);
366 BT_ERR("open failed\n");
367 return BT_ERROR_OPERATION_FAILED;
370 if (write(fd, "1", 1) != 1) {
371 BT_ERR("write failed\n");
373 return BT_ERROR_OPERATION_FAILED;
378 return BT_ERROR_NONE;
381 static int __enable_ipv6_proxy_ndp(void)
386 fd = open(IPV6_PROXY_NDP, O_WRONLY);
388 BT_ERR("open failed\n");
389 return BT_ERROR_OPERATION_FAILED;
392 if (write(fd, "1", 1) != 1) {
393 BT_ERR("write failed\n");
395 return BT_ERROR_OPERATION_FAILED;
400 return BT_ERROR_NONE;
403 int __bt_ipsp_execute_dhcp6_server(void)
406 char buf[DNSMASQ_CONF_LEN] = "";
409 gchar *network_if_name = NULL;
410 gchar *network_addr = NULL;
411 gchar *address = NULL;
413 if (remove(DNSMASQ_LEASES_FILE) < 0)
414 BT_ERR("Failed to remove %s", DNSMASQ_LEASES_FILE);
416 if (dnsmasq_pid == 0) {
417 fp = fopen(DNSMASQ_CONF_FILE, "w");
419 BT_ERR("Could not create the file.\n");
420 return BT_ERROR_OPERATION_FAILED;
423 __bt_ipsp_get_network_interface_name(&network_if_name);
424 if (network_if_name == NULL) {
425 BT_ERR("Failed to get network interface");
427 return BT_ERROR_OPERATION_FAILED;
430 __bt_ipsp_get_network_ipv6_address(network_if_name, MOBILE_AP_IPV6_SCOPE_GLOBAL, &network_addr);
432 address = g_strndup(network_addr, 19);
433 snprintf(buf, DNSMASQ_CONF_LEN, DNSMASQ_CONF6, dns_addr, address);
435 g_free(network_if_name);
436 g_free(network_addr);
442 BT_ERR("fork failed\n");
443 return BT_ERROR_OPERATION_FAILED;
449 * -C file : Configuration file path
451 if (execl("/usr/bin/dnsmasq", "/usr/bin/dnsmasq", "-d",
452 "-p", "0", "-C", DNSMASQ_CONF_FILE,
454 BT_ERR("execl failed\n");
457 BT_ERR("Should not get here!");
458 return BT_ERROR_OPERATION_FAILED;
463 BT_DBG("DNS-SERVER is already running.\n");
467 return BT_ERROR_NONE;
471 static void __generate_eui64_address(char *hw_addr, char **eui64_addr)
474 char addr64[20] = {0,};
475 char *copied = g_strdup(hw_addr);
476 char *copied_origin = NULL;
478 unsigned int hex = 0;
482 copied_origin = copied;
484 for (i = 0; i < 6; i++) {
485 strtok_r(copied, ":", &ptr);
486 if (sizeof(addr[i]) <= strlen(copied)) {
487 strncpy(addr[i], copied, sizeof(addr[i]) - 1);
488 addr[i][(int)(sizeof(addr[i]) - 1)] = '\0';
490 strncpy(addr[i], copied, strlen(copied));
491 addr[i][(int)strlen(copied)] = '\0';
494 BT_DBG("copied/ptr (%s/%s)", copied, ptr);
495 BT_DBG("addr(%s)", addr[i]);
499 BT_DBG("----------");
500 sscanf(addr[0], "%x", &hex);
504 BT_DBG("Inverted bit(%x)", hex);
505 snprintf(addr64, sizeof(addr64), "%x%s:%sff:fe%s:%s%s",
506 hex, addr[1], addr[2], addr[3], addr[4], addr[5]);
508 BT_DBG("addr64(%s)", addr64);
509 *eui64_addr = g_strdup(addr64);
511 BT_DBG("Generated EUI-64 address (%s)", *eui64_addr);
512 g_free(copied_origin);
517 int __bt_ipsp_create_ipv6_remote_address(char *remote_address, char **ipv6_address)
520 gchar *eui64_addr = NULL;
521 gchar *network_addr = NULL;
522 gchar *network_if_name = NULL;
523 gchar *prefix = NULL;
524 char copied[MH_MAX_IPV6_ADDRESS_STR_LEN] = {0, };
526 __generate_eui64_address(remote_address, &eui64_addr);
527 if (eui64_addr == NULL) {
528 BT_ERR("Failed to generate EUI-64 ID!!");
529 return BT_ERROR_OPERATION_FAILED;
532 __bt_ipsp_get_network_interface_name(&network_if_name);
533 if (network_if_name == NULL) {
534 BT_ERR("Failed to get network interface");
536 return BT_ERROR_OPERATION_FAILED;
539 __bt_ipsp_get_network_ipv6_address(network_if_name, MOBILE_AP_IPV6_SCOPE_GLOBAL, &network_addr);
540 g_free(network_if_name);
541 if (network_addr == NULL) {
542 BT_ERR("Failed to get network address!!");
544 return BT_ERROR_OPERATION_FAILED;
547 prefix = g_strndup(network_addr, 19);
548 snprintf(copied, sizeof(copied), "%s:%s", prefix, eui64_addr);
549 *ipv6_address = g_strdup(copied);
550 BT_DBG("remote device ipv6 addr : %s", *ipv6_address);
554 g_free(network_addr);
556 return BT_ERROR_NONE;
559 static int _execute_ip_command(const char *ip_args)
561 if (ip_args == NULL) {
562 BT_ERR("Invalid param\n");
570 char ip_cmd[MAX_BUF_SIZE] = {0, };
572 BT_DBG("Args : %s\n", ip_args);
574 snprintf(ip_cmd, sizeof(ip_cmd), "%s -6 neigh add %s",
577 BT_DBG("IP_CMD : %s\n", ip_cmd);
579 args = g_strsplit_set(ip_cmd, " ", -1);
581 BT_ERR("g_strsplit_set failed\n");
585 if ((pid = fork()) < 0) {
586 BT_ERR("fork failed\n");
592 if (execv(args[0], args))
593 BT_ERR("execl failed\n");
595 BT_ERR("Should never get here!\n");
599 /* Need to add timeout */
600 waitpid(pid, &status, 0);
603 if (WIFEXITED(status)) {
604 exit_status = WEXITSTATUS(status);
606 BT_ERR("child return : %d\n", exit_status);
611 BT_ERR("child is terminated without exit\n");
617 gboolean __bt_ipsp_add_ipv6_neigh_proxy(char *if_name, char *ip)
620 if (tethered_prof == NULL) {
621 BT_DBG("There is no network\n");
625 char args[MAX_BUF_SIZE] = {0, };
627 snprintf(args, sizeof(args), IPV6_NEIGH_PROXY,
630 if (_execute_ip_command(args)) {
631 BT_ERR("%s is failed\n", args);
639 gboolean __bt_ipsp_add_ipv6_route(char *if_name, char *ip, int prefix)
642 if (tethered_prof == NULL) {
643 BT_DBG("There is no network\n");
647 char args[MAX_BUF_SIZE] = {0, };
648 char routing_ip[MH_MAX_IPV6_ADDRESS_STR_LEN] = {0, };
649 char *copied_ip = NULL;
650 int len = (prefix % 4) + 4;
653 copied_ip = g_strndup(ip, len);
654 g_snprintf(routing_ip, sizeof(routing_ip), "%s:", copied_ip);
657 snprintf(args, sizeof(args), IPV6_INTERFACE_ROUTING,
658 ip, prefix, if_name);
660 snprintf(args, sizeof(args), IPV6_INTERFACE_ROUTING,
661 ip, prefix, if_name);
664 if (_execute_ip_command(args)) {
665 BT_ERR("%s is failed\n", args);
673 static void __bt_ipsp_dbus_method(GDBusConnection *connection,
675 const gchar *object_path,
676 const gchar *interface_name,
677 const gchar *method_name,
678 GVariant *parameters,
679 GDBusMethodInvocation *invocation,
684 BT_DBG("method %s", method_name);
685 if (g_strcmp0(method_name, "EnableIpsp") == 0) {
687 // ret = _bt_core_enable_adapter();
688 // ret = bt_ipsp_set_connection_state_changed_cb(
689 // __bt_ipsp_connection_state_changed_cb, NULL);
691 // if (ret != BT_ERROR_NONE)
692 // BT_ERR("failed to set ipsp changed cb");
695 ret = connection_create(&net_connection);
696 if (ret != CONNECTION_ERROR_NONE)
697 BT_ERR("connection create is failed");
699 ret = connection_get_current_profile(net_connection, &tethered_prof);
700 if (ret != CONNECTION_ERROR_NONE)
701 BT_ERR("connection_get_current_profile is failed [0x%X]", ret);
703 __enable_ipv6_forwarding();
704 __enable_ipv6_proxy_ndp();
706 __bt_ipsp_execute_dhcp6_server();
708 } else if (g_strcmp0(method_name, "SetIpv6Addr") == 0) {
712 char *address = NULL;
714 gchar *network_ipv6_address = NULL;
716 char *remote_ipv6_address = NULL;
717 //char *network_ipv6_address = NULL;
718 char *network_interface = NULL;
720 g_variant_get(parameters, "(ss)", &ifname, &address);
721 BT_DBG("Ipsp interface name : %s", ifname);
722 BT_DBG("remote device address : %s", address);
724 ret = __bt_ipsp_create_ipv6_address(ifname, &ip6);
725 if (ret != BT_ERROR_NONE)
726 BT_DBG("failed to create ipv6 address");
728 ret = __bt_ipsp_set_ipv6_address(ifname, ip6);
729 if (ret != BT_ERROR_NONE)
730 BT_DBG("failed to set ipv6 address");
732 ret = __bt_ipsp_create_ipv6_remote_address(address, &remote_ipv6_address);
733 if (ret != BT_ERROR_NONE)
734 BT_DBG("failed to create remote device ipv6 address");
736 __bt_ipsp_get_network_interface_name(&network_interface);
738 if (network_interface)
739 __bt_ipsp_get_network_ipv6_address(network_interface, MOBILE_AP_IPV6_SCOPE_GLOBAL, &network_ipv6_address);
741 /* Add the Routing Rule */
742 __bt_ipsp_add_ipv6_neigh_proxy(network_interface, remote_ipv6_address);
743 __bt_ipsp_add_ipv6_neigh_proxy(ifname, network_ipv6_address);
746 __bt_ipsp_add_ipv6_route(ifname, remote_ipv6_address, 128);
747 __bt_ipsp_add_ipv6_route(network_interface, network_ipv6_address, 64);
749 g_free(network_ipv6_address);
750 g_free(remote_ipv6_address);
751 g_free(network_interface);
757 static const GDBusInterfaceVTable method_table = {
758 __bt_ipsp_dbus_method,
764 gboolean __is_interface_and_signal_valid(const gchar *interface_name,
765 const gchar *signal_name)
767 if (g_strcmp0(interface_name, "org.freedesktop.DBus") &&
768 g_strcmp0(interface_name, "org.freedesktop.DBus.ObjectManager"))
771 if (g_strcmp0(signal_name, "NameOwnerChanged") &&
772 g_strcmp0(signal_name, "InterfacesAdded") &&
773 g_strcmp0(signal_name, "InterfacesRemoved"))
779 static void __bt_ipsp_event_filter(GDBusConnection *connection,
780 const gchar *sender_name,
781 const gchar *object_path,
782 const gchar *interface_name,
783 const gchar *signal_name,
784 GVariant *parameters,
787 if (!__is_interface_and_signal_valid(interface_name, signal_name))
790 if (!g_strcmp0(signal_name, "InterfacesAdded")) {
791 char *obj_path = NULL;
792 GVariant *optional_param;
794 g_variant_get(parameters, "(&o@a{sa{sv}})",
795 &obj_path, &optional_param);
797 // if (g_strcmp0(obj_path, "/org/bluez/hci0") == 0)
798 // _bt_core_adapter_added_cb();
800 } else if (!g_strcmp0(signal_name, "InterfacesRemoved")) {
801 char *obj_path = NULL;
802 GVariant *optional_param;
804 g_variant_get(parameters, "(&o@as)", &obj_path,
807 // if (g_strcmp0(obj_path, "/org/bluez/hci0") == 0)
808 // _bt_core_adapter_removed_cb();
810 } else { /* NameOwnerChanged */
811 // const char *name = NULL;
812 // const char *old_owner = NULL;
813 // const char *new_owner = NULL;
815 // g_variant_get(parameters, "(&s&s&s)", &name, &old_owner,
818 // if (new_owner != NULL && *new_owner == '\0')
819 // __handle_name_owner_changed(name);
823 static GDBusNodeInfo *__bt_ipsp_create_node_info(
824 const gchar *introspection_data)
827 GDBusNodeInfo *node_info = NULL;
829 if (introspection_data == NULL)
832 node_info = g_dbus_node_info_new_for_xml(introspection_data, &err);
835 BT_ERR("Unable to create node: %s", err->message);
841 gboolean _bt_ipsp_register_dbus(void)
843 GError *error = NULL;
845 GDBusNodeInfo *node_info;
847 GDBusConnection *conn;
849 conn = _bt_ipsp_get_gdbus_connection();
853 owner_id = g_bus_own_name(G_BUS_TYPE_SYSTEM,
855 G_BUS_NAME_OWNER_FLAGS_NONE,
859 BT_DBG("owner_id is [%d]", owner_id);
861 node_info = __bt_ipsp_create_node_info(bt_ipsp_introspection_xml);
862 if (node_info == NULL)
865 path = g_strdup(BT_IPSP_PATH);
866 BT_DBG("path is [%s]", path);
868 obj_id = g_dbus_connection_register_object(conn, path,
869 node_info->interfaces[0],
873 BT_ERR("Failed to register: %s", error->message);
881 sig_id1 = g_dbus_connection_signal_subscribe(conn,
882 NULL, "org.freedesktop.DBus",
883 "NameOwnerChanged", NULL, NULL, 0,
884 __bt_ipsp_event_filter, NULL, NULL);
885 sig_id2 = g_dbus_connection_signal_subscribe(conn,
886 NULL, "org.freedesktop.DBus.ObjectManager",
887 "InterfacesAdded", NULL, NULL,
888 0, __bt_ipsp_event_filter, NULL, NULL);
889 sig_id3 = g_dbus_connection_signal_subscribe(conn,
890 NULL, "org.freedesktop.DBus.ObjectManager",
891 "InterfacesRemoved", NULL,
892 NULL, 0, __bt_ipsp_event_filter, NULL, NULL);
902 BT_INFO_C("Starting bt-ipsp daemeon");
904 ret = _bt_ipsp_register_dbus();
906 BT_ERR("_bt_core_register_dbus failed");
911 memset(&sa, 0, sizeof(sa));
912 sa.sa_handler = __bt_ipsp_sigterm_handler;
913 sigaction(SIGINT, &sa, NULL);
914 sigaction(SIGTERM, &sa, NULL);
916 // g_timeout_add(500, (GSourceFunc)__bt_check_bt_core, NULL);
918 main_loop = g_main_loop_new(NULL, FALSE);
920 BT_ERR("creating main loop failed");
924 g_main_loop_run(main_loop);
927 _bt_ipsp_unregister_dbus();
930 g_main_loop_unref(main_loop);
932 BT_INFO_C("Terminating bt-ipsp daemon");