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)
94 // if (service_gproxy) {
95 // g_object_unref(service_gproxy);
96 // service_gproxy = NULL;
100 g_object_unref(service_gconn);
101 service_gconn = NULL;
105 void _bt_ipsp_terminate(void)
107 // if (_bt_check_terminating_condition() == FALSE)
110 _bt_ipsp_gdbus_deinit_proxys();
112 g_main_loop_quit(main_loop);
114 BT_DBG("Terminating bt-core daemon");
119 GDBusConnection * _bt_ipsp_get_gdbus_connection(void)
123 if (service_gconn == NULL)
124 service_gconn = g_bus_get_sync(G_BUS_TYPE_SYSTEM, NULL, &err);
126 if (!service_gconn) {
128 BT_ERR("Unable to connect to dbus: %s", err->message);
134 return service_gconn;
138 void _bt_ipsp_unregister_dbus(void)
140 GDBusConnection *conn;
144 conn = _bt_ipsp_get_gdbus_connection();
149 g_dbus_connection_unregister_object(conn, obj_id);
154 g_dbus_connection_signal_unsubscribe(conn, sig_id1);
158 g_dbus_connection_signal_unsubscribe(conn, sig_id2);
162 g_dbus_connection_signal_unsubscribe(conn, sig_id3);
167 static void __bt_ipsp_sigterm_handler(int signo)
169 BT_DBG("Got the signal: %d", signo);
171 _bt_ipsp_terminate();
174 static void __bt_ipsp_get_network_interface_name(char **if_name)
176 if (if_name == NULL) {
177 BT_ERR("if_name is NULL\n");
181 if (tethered_prof == NULL) {
182 BT_ERR("tethered prof is NULL");
188 connection_profile_refresh(tethered_prof);
190 ret = connection_profile_get_network_interface_name(tethered_prof, if_name);
191 if (ret != CONNECTION_ERROR_NONE) {
192 BT_ERR("connection_profile_get_network_interface_name is failed : 0x%X\n", ret);
196 BT_DBG("network if name : %s", *if_name);
198 if (strlen(*if_name) == 0) {
199 BT_ERR("if_name is zero length\n");
208 gboolean __bt_ipsp_get_network_ipv6_address(const char *if_name, mobile_ap_ipv6_scope_e ip_scope, char **ip)
212 char name[MH_MAX_INTERFACE_NAME_LEN] = {0,};
213 char copied[MH_MAX_IPV6_ADDRESS_STR_LEN] = {0,};
214 int if_idx, prefix_len, scope, if_flag;
216 fd = fopen(MH_IF_INET6_PATH, "r");
218 BT_ERR("Failed to open file!!");
222 while (fscanf(fd, "%4s%4s%4s%4s%4s%4s%4s%4s %2x %d %d %2x %20s",
223 addr[0], addr[1], addr[2], addr[3],
224 addr[4], addr[5], addr[6], addr[7],
225 &if_idx, &prefix_len, &scope, &if_flag, name) != EOF) {
227 if (strncmp(name, if_name, strlen(if_name)) != 0)
230 if (scope != ip_scope)
233 sprintf(copied, "%s:%s:%s:%s:%s:%s:%s:%s",
234 addr[0], addr[1], addr[2], addr[3],
235 addr[4], addr[5], addr[6], addr[7]);
237 *ip = g_strdup(copied);
239 BT_DBG("IP (%s)", *ip);
250 int __bt_ipsp_create_ipv6_address(char *ifname, char **ipv6_address)
252 char *network_if_name = NULL;
253 char *link_addr = NULL;
254 char *network_addr = NULL;
257 char copied[MH_MAX_IPV6_ADDRESS_STR_LEN] = {0, };
260 __bt_ipsp_get_network_interface_name(&network_if_name);
261 __bt_ipsp_get_network_ipv6_address(ifname, MOBILE_AP_IPV6_SCOPE_LINK, &link_addr);
262 __bt_ipsp_get_network_ipv6_address(network_if_name, MOBILE_AP_IPV6_SCOPE_GLOBAL, &network_addr);
264 if (link_addr == NULL || network_addr == NULL) {
265 BT_DBG("address is NULL");
266 return BT_ERROR_OPERATION_FAILED;
269 prefix = g_strndup(network_addr, 19);
271 for (i = 0; i < 4; i++) {
272 strtok_r(link_addr, ":", &if_id);
275 sprintf(copied, "%s:%s", prefix, if_id);
277 *ipv6_address = g_strdup(copied);
281 g_free(network_if_name);
283 g_free(network_addr);
287 BT_DBG("Created IPv6 address [%s]", *ipv6_address);
289 return BT_ERROR_NONE;
293 int __bt_ipsp_set_ipv6_address(const char *if_name, char *ipv6_addr)
297 struct sockaddr_in6 addr;
299 struct in6_ifreq ifr6;
301 sock_fd = socket(AF_INET6, SOCK_DGRAM, IPPROTO_IP);
303 BT_ERR("failed to open socket for ipv6");
304 return BT_ERROR_OPERATION_FAILED;
307 g_strlcpy(ifr.ifr_name, if_name, IFNAMSIZ);
309 memset(&addr, 0, sizeof(struct sockaddr));
310 addr.sin6_family = AF_INET6;
313 if (inet_pton(AF_INET6, ipv6_addr, (void *)&addr.sin6_addr) <= 0) {
314 BT_ERR("Bad address!!");
315 return BT_ERROR_OPERATION_FAILED;
318 memcpy((char *)&ifr6.ifr6_addr, (char *)&addr.sin6_addr, sizeof(struct in6_addr));
320 if (ioctl(sock_fd, SIOGIFINDEX, &ifr) < 0) {
321 BT_ERR("ioctl failed...!!!\n");
323 return BT_ERROR_OPERATION_FAILED;
326 ifr6.ifr6_ifindex = ifr.ifr_ifindex;
327 ifr6.ifr6_prefixlen = 64;
329 if (ioctl(sock_fd, SIOCSIFADDR, &ifr6) < 0) {
330 BT_ERR("ioctl failed...!!!\n");
332 return BT_ERROR_OPERATION_FAILED;
335 ifr.ifr_flags |= IFF_UP | IFF_RUNNING;
337 if (ioctl(sock_fd, SIOCSIFFLAGS, &ifr) < 0) {
338 BT_ERR("ioctl failed...!!!\n");
340 return BT_ERROR_OPERATION_FAILED;
346 return BT_ERROR_NONE;
352 void __bt_ipsp_connection_state_changed_cb(int result, bool connected, const char *remote_address,
353 const char *iface_name, void *user_data)
357 BT_DBG("result: %d", result);
358 BT_DBG("Connected : %d", connected);
359 BT_DBG("Remote BT address : %s", remote_address);
360 BT_DBG("Interface name : %s", remote_address);
362 /* create ipv6 address */
365 static int __enable_ipv6_forwarding(void)
370 fd = open(IPV6_FORWARDING, O_WRONLY);
372 BT_ERR("open failed\n");
373 return BT_ERROR_OPERATION_FAILED;
376 if (write(fd, "1", 1) != 1) {
377 BT_ERR("write failed\n");
379 return BT_ERROR_OPERATION_FAILED;
384 return BT_ERROR_NONE;
387 static int __enable_ipv6_proxy_ndp(void)
392 fd = open(IPV6_PROXY_NDP, O_WRONLY);
394 BT_ERR("open failed\n");
395 return BT_ERROR_OPERATION_FAILED;
398 if (write(fd, "1", 1) != 1) {
399 BT_ERR("write failed\n");
401 return BT_ERROR_OPERATION_FAILED;
406 return BT_ERROR_NONE;
409 int __bt_ipsp_execute_dhcp6_server(void)
412 char buf[DNSMASQ_CONF_LEN] = "";
415 char *network_if_name = NULL;
416 char *network_addr = NULL;
418 if (remove(DNSMASQ_LEASES_FILE) < 0)
419 BT_ERR("Failed to remove %s", DNSMASQ_LEASES_FILE);
421 if (dnsmasq_pid == 0) {
422 fp = fopen(DNSMASQ_CONF_FILE, "w");
424 BT_ERR("Could not create the file.\n");
425 return BT_ERROR_OPERATION_FAILED;
428 __bt_ipsp_get_network_interface_name(&network_if_name);
430 __bt_ipsp_get_network_ipv6_address(network_if_name, MOBILE_AP_IPV6_SCOPE_GLOBAL, &network_addr);
431 if (network_addr == NULL) {
432 BT_ERR("Failed to get global IP");
433 return BT_ERROR_OPERATION_FAILED;
436 snprintf(buf, DNSMASQ_CONF_LEN, DNSMASQ_CONF6, dns_addr, g_strndup(network_addr, 19));
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);
477 unsigned int hex = 0;
482 for (i = 0; i < 6; i++) {
483 strtok_r(copied, ":", &ptr);
484 sscanf(copied, "%s", addr[i]);
485 BT_DBG("copied/ptr (%s/%s)", copied, ptr);
486 BT_DBG("addr(%s)", addr[i]);
490 BT_DBG("----------");
491 sscanf(addr[0], "%x", &hex);
495 BT_DBG("Inverted bit(%x)", hex);
496 sprintf(addr64, "%x%s:%sff:fe%s:%s%s",
497 hex, addr[1], addr[2], addr[3], addr[4], addr[5]);
499 BT_DBG("addr64(%s)", addr64);
500 *eui64_addr = g_strdup(addr64);
502 BT_DBG("Generated EUI-64 address (%s)", *eui64_addr);
509 int __bt_ipsp_create_ipv6_remote_address(char *remote_address, char **ipv6_address)
512 char *eui64_addr = NULL;
513 char *network_addr = NULL;
514 char *network_if_name = NULL;
516 char copied[MH_MAX_IPV6_ADDRESS_STR_LEN] = {0, };
518 __generate_eui64_address(remote_address, &eui64_addr);
519 if (eui64_addr == NULL) {
520 BT_ERR("Failed to generate EUI-64 ID!!");
521 return BT_ERROR_OPERATION_FAILED;
524 __bt_ipsp_get_network_interface_name(&network_if_name);
525 __bt_ipsp_get_network_ipv6_address(network_if_name, MOBILE_AP_IPV6_SCOPE_GLOBAL, &network_addr);
526 if (network_addr == NULL) {
527 BT_ERR("Failed to get network address!!");
528 return BT_ERROR_OPERATION_FAILED;
531 prefix = g_strndup(network_addr, 19);
532 sprintf(copied, "%s:%s", prefix, eui64_addr);
533 *ipv6_address = g_strdup(copied);
535 BT_DBG("remote device ipv6 addr : %s", *ipv6_address);
537 return BT_ERROR_NONE;
542 int _execute_command(const char *cmd)
545 BT_ERR("Invalid param\n");
554 BT_DBG("CMD : %s\n", cmd);
556 args = g_strsplit_set(cmd, " ", -1);
558 BT_ERR("g_strsplit_set failed\n");
562 if ((pid = fork()) < 0) {
563 BT_ERR("fork failed\n");
569 if (execv(args[0], args))
570 BT_ERR("execl failed\n");
572 BT_ERR("Should never get here!\n");
576 /* Need to add timeout */
577 waitpid(pid, &status, 0);
580 if (WIFEXITED(status)) {
581 exit_status = WEXITSTATUS(status);
583 BT_ERR("child return : %d\n", exit_status);
588 BT_ERR("child is terminated without exit\n");
594 gboolean __bt_ipsp_add_ipv6_neigh_proxy(char *if_name, char *ip)
597 if (tethered_prof == NULL) {
598 BT_DBG("There is no network\n");
602 char cmd[MAX_BUF_SIZE] = {0, };
604 snprintf(cmd, sizeof(cmd), "%s -6 neigh add "IPV6_NEIGH_PROXY,
605 IP_CMD, ip, if_name);
607 if (_execute_command(cmd)) {
608 BT_ERR("%s is failed\n", cmd);
617 gboolean __bt_ipsp_add_ipv6_route(char *if_name, char *ip, int prefix)
620 if (tethered_prof == NULL) {
621 BT_DBG("There is no network\n");
625 char cmd[MAX_BUF_SIZE] = {0, };
626 char routing_ip[MH_MAX_IPV6_ADDRESS_STR_LEN] = {0, };
627 char *copied_ip = NULL;
628 int len = (prefix % 4) + 4;
631 copied_ip = g_strndup(ip, len);
632 g_snprintf(routing_ip, sizeof(routing_ip), "%s:", copied_ip);
635 snprintf(cmd, sizeof(cmd), "%s -6 route add "IPV6_INTERFACE_ROUTING,
636 IP_CMD, ip, prefix, if_name);
638 snprintf(cmd, sizeof(cmd), "%s -6 route add "IPV6_INTERFACE_ROUTING,
639 IP_CMD, ip, prefix, if_name);
642 if (_execute_command(cmd)) {
643 BT_ERR("%s is failed\n", cmd);
653 static void __bt_ipsp_dbus_method(GDBusConnection *connection,
655 const gchar *object_path,
656 const gchar *interface_name,
657 const gchar *method_name,
658 GVariant *parameters,
659 GDBusMethodInvocation *invocation,
664 BT_DBG("method %s", method_name);
665 if (g_strcmp0(method_name, "EnableIpsp") == 0) {
667 // ret = _bt_core_enable_adapter();
668 // ret = bt_ipsp_set_connection_state_changed_cb(
669 // __bt_ipsp_connection_state_changed_cb, NULL);
671 // if (ret != BT_ERROR_NONE)
672 // BT_ERR("failed to set ipsp changed cb");
675 ret = connection_create(&net_connection);
676 if (ret != CONNECTION_ERROR_NONE)
677 BT_ERR("connection create is failed");
679 ret = connection_get_current_profile(net_connection, &tethered_prof);
680 if (ret != CONNECTION_ERROR_NONE)
681 BT_ERR("connection_get_current_profile is failed [0x%X]", ret);
683 __enable_ipv6_forwarding();
684 __enable_ipv6_proxy_ndp();
686 __bt_ipsp_execute_dhcp6_server();
688 } else if (g_strcmp0(method_name, "SetIpv6Addr") == 0) {
689 // ret = _bt_core_disable_adapter();
693 char *address = NULL;
696 char *remote_ipv6_address = NULL;
697 //char *network_ipv6_address = NULL;
698 char *network_interface = NULL;
700 g_variant_get(parameters, "(ss)", &ifname, &address);
701 BT_DBG("Ipsp interface name : %s", ifname);
702 BT_DBG("remote device address : %s", address);
704 ret = __bt_ipsp_create_ipv6_address(ifname, &ip6);
705 if (ret != BT_ERROR_NONE)
706 BT_DBG("failed to create ipv6 address");
708 ret = __bt_ipsp_set_ipv6_address(ifname, ip6);
709 if (ret != BT_ERROR_NONE)
710 BT_DBG("failed to set ipv6 address");
712 ret = __bt_ipsp_create_ipv6_remote_address(address, &remote_ipv6_address);
713 if (ret != BT_ERROR_NONE)
714 BT_DBG("failed to create remote device ipv6 address");
716 __bt_ipsp_get_network_interface_name(&network_interface);
718 /* Add the Routing Rule */
719 __bt_ipsp_add_ipv6_neigh_proxy(network_interface, remote_ipv6_address);
720 __bt_ipsp_add_ipv6_neigh_proxy(ifname, "fd23:8172:c17a:1:7a54:2eff:fe4d:c88");
725 __bt_ipsp_add_ipv6_route(ifname, remote_ipv6_address, 128);
726 __bt_ipsp_add_ipv6_route(network_interface, "fd23:8172:c17a:1:7a54:2eff:fe4d:c88", 64);
730 else if (g_strcmp0(method_name, "RecoverAdapter") == 0) {
731 ret = _bt_core_recover_adapter();
732 } else if (g_strcmp0(method_name, "ResetAdapter") == 0) {
733 ret = __bt_core_reset_adapter();
734 } else if (g_strcmp0(method_name, "EnableAdapterLe") == 0) {
735 ret = _bt_core_enable_adapter_le();
736 } else if (g_strcmp0(method_name, "DisableAdapterLe") == 0) {
737 ret = _bt_core_disable_adapter_le();
738 } else if (g_strcmp0(method_name, "EnableCore") == 0) {
739 ret = _bt_core_enable_core();
740 } else if (g_strcmp0(method_name, "SetTransferValue") == 0) {
741 gboolean value = FALSE;
743 g_variant_get(parameters, "(b)", &value);
744 BT_DBG("Transfer value: %d", value);
746 ret = _bt_core_set_transfer_value(value);
747 } else if (g_strcmp0(method_name, "FactoryTestMode") == 0) {
748 const char *type = NULL;
749 const char *arg = NULL;
751 g_variant_get(parameters, "(&s&s)", &type, &arg);
752 ret = _bt_core_factory_test_mode(type, arg);
753 g_dbus_method_invocation_return_value(invocation,
754 g_variant_new("(i)", ret));
763 static const GDBusInterfaceVTable method_table = {
764 __bt_ipsp_dbus_method,
770 gboolean __is_interface_and_signal_valid(const gchar *interface_name,
771 const gchar *signal_name)
773 if (g_strcmp0(interface_name, "org.freedesktop.DBus") &&
774 g_strcmp0(interface_name, "org.freedesktop.DBus.ObjectManager"))
777 if (g_strcmp0(signal_name, "NameOwnerChanged") &&
778 g_strcmp0(signal_name, "InterfacesAdded") &&
779 g_strcmp0(signal_name, "InterfacesRemoved"))
785 static void __bt_ipsp_event_filter(GDBusConnection *connection,
786 const gchar *sender_name,
787 const gchar *object_path,
788 const gchar *interface_name,
789 const gchar *signal_name,
790 GVariant *parameters,
793 if (!__is_interface_and_signal_valid(interface_name, signal_name))
796 if (!g_strcmp0(signal_name, "InterfacesAdded")) {
797 char *obj_path = NULL;
798 GVariant *optional_param;
800 g_variant_get(parameters, "(&o@a{sa{sv}})",
801 &obj_path, &optional_param);
803 // if (g_strcmp0(obj_path, "/org/bluez/hci0") == 0)
804 // _bt_core_adapter_added_cb();
806 } else if (!g_strcmp0(signal_name, "InterfacesRemoved")) {
807 char *obj_path = NULL;
808 GVariant *optional_param;
810 g_variant_get(parameters, "(&o@as)", &obj_path,
813 // if (g_strcmp0(obj_path, "/org/bluez/hci0") == 0)
814 // _bt_core_adapter_removed_cb();
816 } else { /* NameOwnerChanged */
817 // const char *name = NULL;
818 // const char *old_owner = NULL;
819 // const char *new_owner = NULL;
821 // g_variant_get(parameters, "(&s&s&s)", &name, &old_owner,
824 // if (new_owner != NULL && *new_owner == '\0')
825 // __handle_name_owner_changed(name);
829 static GDBusNodeInfo *__bt_ipsp_create_node_info(
830 const gchar *introspection_data)
833 GDBusNodeInfo *node_info = NULL;
835 if (introspection_data == NULL)
838 node_info = g_dbus_node_info_new_for_xml(introspection_data, &err);
841 BT_ERR("Unable to create node: %s", err->message);
847 gboolean _bt_ipsp_register_dbus(void)
849 GError *error = NULL;
851 GDBusNodeInfo *node_info;
853 GDBusConnection *conn;
855 conn = _bt_ipsp_get_gdbus_connection();
859 owner_id = g_bus_own_name(G_BUS_TYPE_SYSTEM,
861 G_BUS_NAME_OWNER_FLAGS_NONE,
865 BT_DBG("owner_id is [%d]", owner_id);
867 node_info = __bt_ipsp_create_node_info(bt_ipsp_introspection_xml);
868 if (node_info == NULL)
871 path = g_strdup(BT_IPSP_PATH);
872 BT_DBG("path is [%s]", path);
874 obj_id = g_dbus_connection_register_object(conn, path,
875 node_info->interfaces[0],
879 BT_ERR("Failed to register: %s", error->message);
887 sig_id1 = g_dbus_connection_signal_subscribe(conn,
888 NULL, "org.freedesktop.DBus",
889 "NameOwnerChanged", NULL, NULL, 0,
890 __bt_ipsp_event_filter, NULL, NULL);
891 sig_id2 = g_dbus_connection_signal_subscribe(conn,
892 NULL, "org.freedesktop.DBus.ObjectManager",
893 "InterfacesAdded", NULL, NULL,
894 0, __bt_ipsp_event_filter, NULL, NULL);
895 sig_id3 = g_dbus_connection_signal_subscribe(conn,
896 NULL, "org.freedesktop.DBus.ObjectManager",
897 "InterfacesRemoved", NULL,
898 NULL, 0, __bt_ipsp_event_filter, NULL, NULL);
908 BT_INFO_C("Starting bt-ipsp daemeon");
910 ret = _bt_ipsp_register_dbus();
912 BT_ERR("_bt_core_register_dbus failed");
917 memset(&sa, 0, sizeof(sa));
918 sa.sa_handler = __bt_ipsp_sigterm_handler;
919 sigaction(SIGINT, &sa, NULL);
920 sigaction(SIGTERM, &sa, NULL);
922 // g_timeout_add(500, (GSourceFunc)__bt_check_bt_core, NULL);
924 main_loop = g_main_loop_new(NULL, FALSE);
926 BT_ERR("creating main loop failed");
930 g_main_loop_run(main_loop);
933 _bt_ipsp_unregister_dbus();
936 g_main_loop_unref(main_loop);
938 BT_INFO_C("Terminating bt-ipsp daemon");