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");
201 gboolean __bt_ipsp_get_network_ipv6_address(const char *if_name, mobile_ap_ipv6_scope_e ip_scope, gchar **ip)
205 char name[MH_MAX_INTERFACE_NAME_LEN] = {0,};
206 char copied[MH_MAX_IPV6_ADDRESS_STR_LEN] = {0,};
207 int if_idx, prefix_len, scope, if_flag;
209 fd = fopen(MH_IF_INET6_PATH, "r");
211 BT_ERR("Failed to open file!!");
215 while (fscanf(fd, "%4s%4s%4s%4s%4s%4s%4s%4s %2x %d %d %2x %19s",
216 addr[0], addr[1], addr[2], addr[3],
217 addr[4], addr[5], addr[6], addr[7],
218 &if_idx, &prefix_len, &scope, &if_flag, name) != EOF) {
220 if (strncmp(name, if_name, strlen(if_name)) != 0)
223 if (scope != ip_scope)
226 snprintf(copied, sizeof(copied), "%s:%s:%s:%s:%s:%s:%s:%s",
227 addr[0], addr[1], addr[2], addr[3],
228 addr[4], addr[5], addr[6], addr[7]);
230 *ip = g_strdup(copied);
232 BT_DBG("IP (%s)", *ip);
242 int __bt_ipsp_create_ipv6_address(char *ifname, char **ipv6_address)
245 gchar *network_if_name = NULL;
246 gchar *link_addr = NULL;
247 gchar *network_addr = NULL;
248 gchar *prefix = NULL;
250 char copied[MH_MAX_IPV6_ADDRESS_STR_LEN] = {0, };
251 gchar *link_addr_cpy = NULL;
254 __bt_ipsp_get_network_interface_name(&network_if_name);
255 __bt_ipsp_get_network_ipv6_address(ifname, MOBILE_AP_IPV6_SCOPE_LINK, &link_addr);
257 if (network_if_name) {
258 __bt_ipsp_get_network_ipv6_address(network_if_name, MOBILE_AP_IPV6_SCOPE_GLOBAL, &network_addr);
259 g_free(network_if_name);
262 if (link_addr == NULL || network_addr == NULL) {
263 BT_DBG("address is NULL");
265 g_free(network_addr);
266 return BT_ERROR_OPERATION_FAILED;
269 prefix = g_strndup(network_addr, 19);
270 g_free(network_addr);
272 link_addr_cpy = link_addr;
274 for (i = 0; i < 4; i++) {
275 strtok_r(link_addr_cpy, ":", &if_id);
276 link_addr_cpy = if_id;
278 snprintf(copied, sizeof(copied), "%s:%s", prefix, if_id);
280 *ipv6_address = g_strdup(copied);
282 BT_DBG("Created IPv6 address [%s]", *ipv6_address);
286 return BT_ERROR_NONE;
289 int __bt_ipsp_set_ipv6_address(const char *if_name, char *ipv6_addr)
293 struct sockaddr_in6 addr;
295 struct in6_ifreq ifr6;
297 sock_fd = socket(AF_INET6, SOCK_DGRAM, IPPROTO_IP);
299 BT_ERR("failed to open socket for ipv6");
300 return BT_ERROR_OPERATION_FAILED;
303 g_strlcpy(ifr.ifr_name, if_name, IFNAMSIZ);
305 memset(&addr, 0, sizeof(struct sockaddr_in6));
306 addr.sin6_family = AF_INET6;
309 if (inet_pton(AF_INET6, ipv6_addr, (void *)&addr.sin6_addr) <= 0) {
310 BT_ERR("Bad address!!");
312 return BT_ERROR_OPERATION_FAILED;
315 memcpy((char *)&ifr6.ifr6_addr, (char *)&addr.sin6_addr, sizeof(struct in6_addr));
317 if (ioctl(sock_fd, SIOGIFINDEX, &ifr) < 0) {
318 BT_ERR("ioctl failed...!!!\n");
320 return BT_ERROR_OPERATION_FAILED;
323 ifr6.ifr6_ifindex = ifr.ifr_ifindex;
324 ifr6.ifr6_prefixlen = 64;
326 if (ioctl(sock_fd, SIOCSIFADDR, &ifr6) < 0) {
327 BT_ERR("ioctl failed...!!!\n");
329 return BT_ERROR_OPERATION_FAILED;
332 ifr.ifr_flags |= IFF_UP | IFF_RUNNING;
334 if (ioctl(sock_fd, SIOCSIFFLAGS, &ifr) < 0) {
335 BT_ERR("ioctl failed...!!!\n");
337 return BT_ERROR_OPERATION_FAILED;
343 return BT_ERROR_NONE;
349 void __bt_ipsp_connection_state_changed_cb(int result, bool connected, const char *remote_address,
350 const char *iface_name, void *user_data)
352 BT_DBG("result: %d", result);
353 BT_DBG("Connected : %d", connected);
354 BT_DBG("Remote BT address : %s", remote_address);
355 BT_DBG("Interface name : %s", remote_address);
358 static int __enable_ipv6_forwarding(void)
363 fd = open(IPV6_FORWARDING, O_WRONLY);
365 BT_ERR("open failed\n");
366 return BT_ERROR_OPERATION_FAILED;
369 if (write(fd, "1", 1) != 1) {
370 BT_ERR("write failed\n");
372 return BT_ERROR_OPERATION_FAILED;
377 return BT_ERROR_NONE;
380 static int __enable_ipv6_proxy_ndp(void)
385 fd = open(IPV6_PROXY_NDP, O_WRONLY);
387 BT_ERR("open failed\n");
388 return BT_ERROR_OPERATION_FAILED;
391 if (write(fd, "1", 1) != 1) {
392 BT_ERR("write failed\n");
394 return BT_ERROR_OPERATION_FAILED;
399 return BT_ERROR_NONE;
402 int __bt_ipsp_execute_dhcp6_server(void)
405 char buf[DNSMASQ_CONF_LEN] = "";
408 gchar *network_if_name = NULL;
409 gchar *network_addr = NULL;
410 gchar *address = NULL;
412 if (remove(DNSMASQ_LEASES_FILE) < 0)
413 BT_ERR("Failed to remove %s", DNSMASQ_LEASES_FILE);
415 if (dnsmasq_pid == 0) {
416 fp = fopen(DNSMASQ_CONF_FILE, "w");
418 BT_ERR("Could not create the file.\n");
419 return BT_ERROR_OPERATION_FAILED;
422 __bt_ipsp_get_network_interface_name(&network_if_name);
423 if (network_if_name == NULL) {
424 BT_ERR("Failed to get network interface");
426 return BT_ERROR_OPERATION_FAILED;
429 __bt_ipsp_get_network_ipv6_address(network_if_name, MOBILE_AP_IPV6_SCOPE_GLOBAL, &network_addr);
431 address = g_strndup(network_addr, 19);
432 snprintf(buf, DNSMASQ_CONF_LEN, DNSMASQ_CONF6, dns_addr, address);
434 g_free(network_if_name);
435 g_free(network_addr);
441 BT_ERR("fork failed\n");
442 return BT_ERROR_OPERATION_FAILED;
448 * -C file : Configuration file path
450 if (execl("/usr/bin/dnsmasq", "/usr/bin/dnsmasq", "-d",
451 "-p", "0", "-C", DNSMASQ_CONF_FILE,
453 BT_ERR("execl failed\n");
456 BT_ERR("Should not get here!");
457 return BT_ERROR_OPERATION_FAILED;
462 BT_DBG("DNS-SERVER is already running.\n");
466 return BT_ERROR_NONE;
470 static void __generate_eui64_address(char *hw_addr, char **eui64_addr)
473 char addr64[20] = {0,};
474 char *copied = g_strdup(hw_addr);
475 char *copied_origin = NULL;
477 unsigned int hex = 0;
481 copied_origin = copied;
483 for (i = 0; i < 6; i++) {
484 strtok_r(copied, ":", &ptr);
485 if (sizeof(addr[i]) <= strlen(copied)) {
486 strncpy(addr[i], copied, sizeof(addr[i]) - 1);
487 addr[i][(int)(sizeof(addr[i]) - 1)] = '\0';
489 strncpy(addr[i], copied, strlen(copied));
490 addr[i][(int)strlen(copied)] = '\0';
493 BT_DBG("copied/ptr (%s/%s)", copied, ptr);
494 BT_DBG("addr(%s)", addr[i]);
498 BT_DBG("----------");
499 sscanf(addr[0], "%x", &hex);
503 BT_DBG("Inverted bit(%x)", hex);
504 snprintf(addr64, sizeof(addr64), "%x%s:%sff:fe%s:%s%s",
505 hex, addr[1], addr[2], addr[3], addr[4], addr[5]);
507 BT_DBG("addr64(%s)", addr64);
508 *eui64_addr = g_strdup(addr64);
510 BT_DBG("Generated EUI-64 address (%s)", *eui64_addr);
511 g_free(copied_origin);
516 int __bt_ipsp_create_ipv6_remote_address(char *remote_address, char **ipv6_address)
519 gchar *eui64_addr = NULL;
520 gchar *network_addr = NULL;
521 gchar *network_if_name = NULL;
522 gchar *prefix = NULL;
523 char copied[MH_MAX_IPV6_ADDRESS_STR_LEN] = {0, };
525 __generate_eui64_address(remote_address, &eui64_addr);
526 if (eui64_addr == NULL) {
527 BT_ERR("Failed to generate EUI-64 ID!!");
528 return BT_ERROR_OPERATION_FAILED;
531 __bt_ipsp_get_network_interface_name(&network_if_name);
532 if (network_if_name == NULL) {
533 BT_ERR("Failed to get network interface");
535 return BT_ERROR_OPERATION_FAILED;
538 __bt_ipsp_get_network_ipv6_address(network_if_name, MOBILE_AP_IPV6_SCOPE_GLOBAL, &network_addr);
539 g_free(network_if_name);
540 if (network_addr == NULL) {
541 BT_ERR("Failed to get network address!!");
543 return BT_ERROR_OPERATION_FAILED;
546 prefix = g_strndup(network_addr, 19);
547 snprintf(copied, sizeof(copied), "%s:%s", prefix, eui64_addr);
548 *ipv6_address = g_strdup(copied);
549 BT_DBG("remote device ipv6 addr : %s", *ipv6_address);
553 g_free(network_addr);
555 return BT_ERROR_NONE;
558 static int _execute_ip_command(const char *ip_args)
560 if (ip_args == NULL) {
561 BT_ERR("Invalid param\n");
569 char ip_cmd[MAX_BUF_SIZE] = {0, };
571 BT_DBG("Args : %s\n", ip_args);
573 snprintf(ip_cmd, sizeof(ip_cmd), "%s -6 neigh add %s",
576 BT_DBG("IP_CMD : %s\n", ip_cmd);
578 args = g_strsplit_set(ip_cmd, " ", -1);
580 BT_ERR("g_strsplit_set failed\n");
584 if ((pid = fork()) < 0) {
585 BT_ERR("fork failed\n");
591 if (execv(args[0], args))
592 BT_ERR("execl failed\n");
594 BT_ERR("Should never get here!\n");
598 /* Need to add timeout */
599 waitpid(pid, &status, 0);
602 if (WIFEXITED(status)) {
603 exit_status = WEXITSTATUS(status);
605 BT_ERR("child return : %d\n", exit_status);
610 BT_ERR("child is terminated without exit\n");
616 gboolean __bt_ipsp_add_ipv6_neigh_proxy(char *if_name, char *ip)
619 if (tethered_prof == NULL) {
620 BT_DBG("There is no network\n");
624 char args[MAX_BUF_SIZE] = {0, };
626 snprintf(args, sizeof(args), IPV6_NEIGH_PROXY,
629 if (_execute_ip_command(args)) {
630 BT_ERR("%s is failed\n", args);
638 gboolean __bt_ipsp_add_ipv6_route(char *if_name, char *ip, int prefix)
641 if (tethered_prof == NULL) {
642 BT_DBG("There is no network\n");
646 char args[MAX_BUF_SIZE] = {0, };
647 char routing_ip[MH_MAX_IPV6_ADDRESS_STR_LEN] = {0, };
648 char *copied_ip = NULL;
649 int len = (prefix % 4) + 4;
652 copied_ip = g_strndup(ip, len);
653 g_snprintf(routing_ip, sizeof(routing_ip), "%s:", copied_ip);
656 snprintf(args, sizeof(args), IPV6_INTERFACE_ROUTING,
657 ip, prefix, if_name);
659 snprintf(args, sizeof(args), IPV6_INTERFACE_ROUTING,
660 ip, prefix, if_name);
663 if (_execute_ip_command(args)) {
664 BT_ERR("%s is failed\n", args);
672 static void __bt_ipsp_dbus_method(GDBusConnection *connection,
674 const gchar *object_path,
675 const gchar *interface_name,
676 const gchar *method_name,
677 GVariant *parameters,
678 GDBusMethodInvocation *invocation,
683 BT_DBG("method %s", method_name);
684 if (g_strcmp0(method_name, "EnableIpsp") == 0) {
686 // ret = _bt_core_enable_adapter();
687 // ret = bt_ipsp_set_connection_state_changed_cb(
688 // __bt_ipsp_connection_state_changed_cb, NULL);
690 // if (ret != BT_ERROR_NONE)
691 // BT_ERR("failed to set ipsp changed cb");
694 ret = connection_create(&net_connection);
695 if (ret != CONNECTION_ERROR_NONE)
696 BT_ERR("connection create is failed");
698 ret = connection_get_current_profile(net_connection, &tethered_prof);
699 if (ret != CONNECTION_ERROR_NONE)
700 BT_ERR("connection_get_current_profile is failed [0x%X]", ret);
702 __enable_ipv6_forwarding();
703 __enable_ipv6_proxy_ndp();
705 __bt_ipsp_execute_dhcp6_server();
707 } else if (g_strcmp0(method_name, "SetIpv6Addr") == 0) {
711 char *address = NULL;
713 gchar *network_ipv6_address = NULL;
715 char *remote_ipv6_address = NULL;
716 //char *network_ipv6_address = NULL;
717 char *network_interface = NULL;
719 g_variant_get(parameters, "(ss)", &ifname, &address);
720 BT_DBG("Ipsp interface name : %s", ifname);
721 BT_DBG("remote device address : %s", address);
723 ret = __bt_ipsp_create_ipv6_address(ifname, &ip6);
724 if (ret != BT_ERROR_NONE)
725 BT_DBG("failed to create ipv6 address");
727 ret = __bt_ipsp_set_ipv6_address(ifname, ip6);
728 if (ret != BT_ERROR_NONE)
729 BT_DBG("failed to set ipv6 address");
731 ret = __bt_ipsp_create_ipv6_remote_address(address, &remote_ipv6_address);
732 if (ret != BT_ERROR_NONE)
733 BT_DBG("failed to create remote device ipv6 address");
735 __bt_ipsp_get_network_interface_name(&network_interface);
737 if (network_interface)
738 __bt_ipsp_get_network_ipv6_address(network_interface, MOBILE_AP_IPV6_SCOPE_GLOBAL, &network_ipv6_address);
740 /* Add the Routing Rule */
741 __bt_ipsp_add_ipv6_neigh_proxy(network_interface, remote_ipv6_address);
742 __bt_ipsp_add_ipv6_neigh_proxy(ifname, network_ipv6_address);
745 __bt_ipsp_add_ipv6_route(ifname, remote_ipv6_address, 128);
746 __bt_ipsp_add_ipv6_route(network_interface, network_ipv6_address, 64);
748 g_free(network_ipv6_address);
749 g_free(remote_ipv6_address);
750 g_free(network_interface);
756 static const GDBusInterfaceVTable method_table = {
757 __bt_ipsp_dbus_method,
763 gboolean __is_interface_and_signal_valid(const gchar *interface_name,
764 const gchar *signal_name)
766 if (g_strcmp0(interface_name, "org.freedesktop.DBus") &&
767 g_strcmp0(interface_name, "org.freedesktop.DBus.ObjectManager"))
770 if (g_strcmp0(signal_name, "NameOwnerChanged") &&
771 g_strcmp0(signal_name, "InterfacesAdded") &&
772 g_strcmp0(signal_name, "InterfacesRemoved"))
778 static void __bt_ipsp_event_filter(GDBusConnection *connection,
779 const gchar *sender_name,
780 const gchar *object_path,
781 const gchar *interface_name,
782 const gchar *signal_name,
783 GVariant *parameters,
786 if (!__is_interface_and_signal_valid(interface_name, signal_name))
789 if (!g_strcmp0(signal_name, "InterfacesAdded")) {
790 char *obj_path = NULL;
791 GVariant *optional_param;
793 g_variant_get(parameters, "(&o@a{sa{sv}})",
794 &obj_path, &optional_param);
796 // if (g_strcmp0(obj_path, "/org/bluez/hci0") == 0)
797 // _bt_core_adapter_added_cb();
799 } else if (!g_strcmp0(signal_name, "InterfacesRemoved")) {
800 char *obj_path = NULL;
801 GVariant *optional_param;
803 g_variant_get(parameters, "(&o@as)", &obj_path,
806 // if (g_strcmp0(obj_path, "/org/bluez/hci0") == 0)
807 // _bt_core_adapter_removed_cb();
809 } else { /* NameOwnerChanged */
810 // const char *name = NULL;
811 // const char *old_owner = NULL;
812 // const char *new_owner = NULL;
814 // g_variant_get(parameters, "(&s&s&s)", &name, &old_owner,
817 // if (new_owner != NULL && *new_owner == '\0')
818 // __handle_name_owner_changed(name);
822 static GDBusNodeInfo *__bt_ipsp_create_node_info(
823 const gchar *introspection_data)
826 GDBusNodeInfo *node_info = NULL;
828 if (introspection_data == NULL)
831 node_info = g_dbus_node_info_new_for_xml(introspection_data, &err);
834 BT_ERR("Unable to create node: %s", err->message);
840 gboolean _bt_ipsp_register_dbus(void)
842 GError *error = NULL;
844 GDBusNodeInfo *node_info;
846 GDBusConnection *conn;
848 conn = _bt_ipsp_get_gdbus_connection();
852 owner_id = g_bus_own_name(G_BUS_TYPE_SYSTEM,
854 G_BUS_NAME_OWNER_FLAGS_NONE,
858 BT_DBG("owner_id is [%d]", owner_id);
860 node_info = __bt_ipsp_create_node_info(bt_ipsp_introspection_xml);
861 if (node_info == NULL)
864 path = g_strdup(BT_IPSP_PATH);
865 BT_DBG("path is [%s]", path);
867 obj_id = g_dbus_connection_register_object(conn, path,
868 node_info->interfaces[0],
872 BT_ERR("Failed to register: %s", error->message);
880 sig_id1 = g_dbus_connection_signal_subscribe(conn,
881 NULL, "org.freedesktop.DBus",
882 "NameOwnerChanged", NULL, NULL, 0,
883 __bt_ipsp_event_filter, NULL, NULL);
884 sig_id2 = g_dbus_connection_signal_subscribe(conn,
885 NULL, "org.freedesktop.DBus.ObjectManager",
886 "InterfacesAdded", NULL, NULL,
887 0, __bt_ipsp_event_filter, NULL, NULL);
888 sig_id3 = g_dbus_connection_signal_subscribe(conn,
889 NULL, "org.freedesktop.DBus.ObjectManager",
890 "InterfacesRemoved", NULL,
891 NULL, 0, __bt_ipsp_event_filter, NULL, NULL);
901 BT_INFO_C("Starting bt-ipsp daemeon");
903 ret = _bt_ipsp_register_dbus();
905 BT_ERR("_bt_core_register_dbus failed");
910 memset(&sa, 0, sizeof(sa));
911 sa.sa_handler = __bt_ipsp_sigterm_handler;
912 sigaction(SIGINT, &sa, NULL);
913 sigaction(SIGTERM, &sa, NULL);
915 // g_timeout_add(500, (GSourceFunc)__bt_check_bt_core, NULL);
917 main_loop = g_main_loop_new(NULL, FALSE);
919 BT_ERR("creating main loop failed");
923 g_main_loop_run(main_loop);
926 _bt_ipsp_unregister_dbus();
929 g_main_loop_unref(main_loop);
931 BT_INFO_C("Terminating bt-ipsp daemon");