Added support to add ipv6 route using netlink.
[platform/core/connectivity/net-config.git] / src / utils / util.c
index 107b86f..9127c36 100755 (executable)
 #include <sys/wait.h>
 #include <sys/stat.h>
 #include <sys/ioctl.h>
+#include <ctype.h>
 #include <vconf-keys.h>
 #include <tzplatform_config.h>
 #include <system_info.h>
+#include <stdint.h>
+#include <linux/netlink.h>
+#include <linux/rtnetlink.h>
 
 #include "log.h"
 #include "util.h"
 #define HEADED_PLUGIN_FILEPATH         "/usr/lib/net-config-plugin-headed.so"
 #define TELEPHONY_PLUGIN_FILEPATH      "/usr/lib/net-config-plugin-telephony.so"
 
+typedef struct {
+       uint8_t family;
+       uint8_t bytelen;
+       int16_t bitlen;
+       uint32_t flags;
+       uint32_t data[8];
+} netconfig_inet_prefix_s;
+
+typedef struct {
+       int                     fd;
+       struct sockaddr_nl      local;
+       struct sockaddr_nl      peer;
+       uint32_t                seq;
+       uint32_t                dump;
+} netconfig_rtnl_s;
+netconfig_rtnl_s rth = { .fd = -1 };
+
 static gboolean netconfig_device_picker_test = FALSE;
 static int mdnsd_ref_count = 0;
 typedef struct {
@@ -62,6 +83,37 @@ static void *handle_telephony;
 static struct netconfig_headed_plugin_t *headed_plugin;
 static struct netconfig_telephony_plugin_t *telephony_plugin;
 
+static bool is_feature_checked[NETCONFIG_SUPPORTED_FEATURE_MAX] = {0, };
+static bool feature_supported[NETCONFIG_SUPPORTED_FEATURE_MAX] = {0, };
+
+gboolean netconfig_check_passphrase(const gchar *service, const char *passphrase)
+{
+       gsize length;
+
+       if (!passphrase)
+               return FALSE;
+
+       length = strlen(passphrase);
+
+       if (g_str_has_suffix(service, "psk") == TRUE) {
+               if (length == 64) {
+                       for (int i = 0; i < 64; i++)
+                               if (!isxdigit((unsigned char)passphrase[i]))
+                                       return FALSE;
+               } else if (length < 8 || length > 63)
+                       return FALSE;
+       } else if (g_str_has_suffix(service, "wep") == TRUE) {
+               if (length == 10 || length == 26) {
+                       for (int i = 0; i < length; i++)
+                               if (!isxdigit((unsigned char)passphrase[i]))
+                                       return FALSE;
+               } else if (length != 5 && length != 13)
+                       return FALSE;
+       }
+
+       return TRUE;
+}
+
 GKeyFile *netconfig_keyfile_load(const char *pathname)
 {
        GKeyFile *keyfile = NULL;
@@ -288,31 +340,31 @@ void netconfig_wifi_device_picker_service_stop(void)
 
 gboolean netconfig_is_wifi_direct_on(void)
 {
-#if defined TIZEN_P2P_ENABLE
+       if (!netconfig_check_feature_supported(NETCONFIG_SUPPORTED_FEATURE_WIFI_DIRECT))
+               return FALSE;
+
        int wifi_direct_state = 0;
 
        netconfig_vconf_get_int(VCONFKEY_WIFI_DIRECT_STATE, &wifi_direct_state);
 
        DBG("Wi-Fi direct mode %d", wifi_direct_state);
        return (wifi_direct_state != 0) ? TRUE : FALSE;
-#else
-       return FALSE;
-#endif
 }
 
 gboolean netconfig_is_wifi_tethering_on(void)
 {
-#if defined TIZEN_TETHERING_ENABLE
-       int wifi_tethering_state = 0;
-
-       netconfig_vconf_get_int(VCONFKEY_MOBILE_HOTSPOT_MODE, &wifi_tethering_state);
-       DBG("Wi-Ti tethering mode %d", wifi_tethering_state);
-       if ((wifi_tethering_state & VCONFKEY_MOBILE_HOTSPOT_MODE_WIFI)
-               || (wifi_tethering_state & VCONFKEY_MOBILE_HOTSPOT_MODE_WIFI_AP)) {
-               DBG("Mobile AP is on");
-               return TRUE;
+       if (netconfig_check_feature_supported(NETCONFIG_SUPPORTED_FEATURE_TETHERING)) {
+               int wifi_tethering_state = 0;
+
+               netconfig_vconf_get_int(VCONFKEY_MOBILE_HOTSPOT_MODE, &wifi_tethering_state);
+               DBG("Wi-Ti tethering mode %d", wifi_tethering_state);
+               if ((wifi_tethering_state & VCONFKEY_MOBILE_HOTSPOT_MODE_WIFI)
+                               || (wifi_tethering_state & VCONFKEY_MOBILE_HOTSPOT_MODE_WIFI_AP)) {
+                       DBG("Mobile AP is on");
+                       return TRUE;
+               }
        }
-#endif
+
        DBG("Mobile AP is off");
        return FALSE;
 }
@@ -531,6 +583,62 @@ int netconfig_execute_clatd(const char *file_path, char *const args[])
        return -EIO;
 }
 
+static void no_wait_signal_handler()
+{
+       pid_t child_pid = 0;
+       int state = 0;
+
+       child_pid = waitpid(-1, &state, WNOHANG);
+
+       DBG("child_id(%d) state(%d)", child_pid, WEXITSTATUS(state));
+}
+
+int netconfig_execute_file_no_wait(const char *file_path, char *const args[])
+{
+       pid_t pid = 0;
+       int rv = 0;
+       errno = 0;
+       register unsigned int index = 0;
+
+       struct sigaction act;
+       int state = 0;
+       char error_buf[MAX_SIZE_ERROR_BUFFER] = {0, };
+
+       act.sa_handler = no_wait_signal_handler;
+       sigemptyset(&act.sa_mask);
+       act.sa_flags = 0;
+
+       state = sigaction(SIGCHLD, &act, 0);
+       if (state != 0) {
+               DBG("sigaction() : %d");
+               return -1;
+       }
+
+       while (args[index] != NULL) {
+               DBG("%s", args[index]);
+               index++;
+       }
+
+       if (!(pid = fork())) {
+               DBG("pid(%d), ppid (%d)", getpid(), getppid());
+               DBG("Inside child, exec (%s) command", file_path);
+
+               errno = 0;
+               if (execvp(file_path, args) == -1) {
+                       ERR("Fail to execute command (%s)",
+                               strerror_r(errno, error_buf, MAX_SIZE_ERROR_BUFFER));
+                       return -1;
+               }
+       } else if (pid > 0) {
+               ERR("Successfully launched child process");
+               return rv;
+       }
+
+       DBG("failed to fork(%s)",
+               strerror_r(errno, error_buf, MAX_SIZE_ERROR_BUFFER));
+       return -EIO;
+}
+
 int __netconfig_get_interface_index(const char *interface_name)
 {
        struct ifreq ifr;
@@ -557,6 +665,7 @@ int __netconfig_get_interface_index(const char *interface_name)
        close(sock);
 
        if (result < 0) {
+               strerror_r(errno, error_buf, MAX_SIZE_ERROR_BUFFER);
                DBG("Failed to get ifr index: %s", error_buf);
                return -1;
        }
@@ -673,36 +782,190 @@ int netconfig_del_route_ipv4(gchar *ip_addr, gchar *subnet, gchar *interface, gi
        return 1;
 }
 
-int netconfig_add_route_ipv6(gchar *ip_addr, gchar *interface, gchar *gateway, unsigned char prefix_len)
+static int __netconfig_rtnl_talk(netconfig_rtnl_s *rtnl, struct nlmsghdr *n, pid_t peer,
+               unsigned groups, struct nlmsghdr *answer)
 {
-       struct in6_rtmsg rt;
-       int fd = 0;
-       int err = 0;
+       struct nlmsghdr *h;
+       struct sockaddr_nl nladdr;
+       struct iovec iov = {
+               .iov_base = (void*)n,
+               .iov_len = n->nlmsg_len
+       };
+       struct msghdr msg = {
+               .msg_name = &nladdr,
+               .msg_namelen = sizeof(nladdr),
+               .msg_iov = &iov,
+               .msg_iovlen = 1,
+       };
+       int status;
+       unsigned seq;
+       char buf[16384];
        char error_buf[MAX_SIZE_ERROR_BUFFER] = {0, };
 
-       memset(&rt, 0, sizeof(rt));
+       memset(&nladdr, 0, sizeof(nladdr));
+       nladdr.nl_family = AF_NETLINK;
+       nladdr.nl_pid = peer;
+       nladdr.nl_groups = groups;
 
-       rt.rtmsg_dst_len = prefix_len;
+       n->nlmsg_seq = seq = ++rtnl->seq;
 
-       rt.rtmsg_flags = RTF_UP | RTF_HOST;
+       if (answer == NULL)
+               n->nlmsg_flags |= NLM_F_ACK;
 
-       errno = 0;
-       if (inet_pton(AF_INET6, ip_addr, &rt.rtmsg_dst) < 0) {
-               strerror_r(errno, error_buf, MAX_SIZE_ERROR_BUFFER);
-               DBG("inet_pton failed : %s", error_buf);
+       status = sendmsg(rtnl->fd, &msg, 0);
+       if (status < 0) {
+               DBG("failed to send message to kernel, status: %d", status);
                return -1;
        }
 
-       if (gateway != NULL) {
-               rt.rtmsg_flags |= RTF_GATEWAY;
-               if (inet_pton(AF_INET6, gateway, &rt.rtmsg_gateway) < 0) {
+       memset(buf, 0, sizeof(buf));
+
+       iov.iov_base = buf;
+
+       while (1) {
+               iov.iov_len = sizeof(buf);
+               status = recvmsg(rtnl->fd, &msg, 0);
+               DBG("status: %d", status);
+
+               if (status < 0) {
+                       if (errno == EINTR || errno == EAGAIN)
+                               continue;
                        strerror_r(errno, error_buf, MAX_SIZE_ERROR_BUFFER);
-                       DBG("inet_pton failed : %s", error_buf);
+                       DBG("netlink receive error %s (%d)", error_buf, errno);
+                       return -1;
+               }
+               if (status == 0) {
+                       DBG("EOF on netlink");
+                       return -1;
+               }
+               if (msg.msg_namelen != sizeof(nladdr)) {
+                       DBG("sender address length == %d", msg.msg_namelen);
+                       return -1;
+               }
+               for (h = (struct nlmsghdr*)buf; status >= sizeof(*h); ) {
+                       int len = h->nlmsg_len;
+                       int l = len - sizeof(*h);
+
+                       if (l < 0 || len > status) {
+                               if (msg.msg_flags & MSG_TRUNC) {
+                                       DBG("truncated message");
+                                       return -1;
+                               }
+                               DBG("malformed message: len=%d", len);
+                               return -1;
+                       }
+
+                       if (nladdr.nl_pid != peer ||
+                                       h->nlmsg_pid != rtnl->local.nl_pid ||
+                                       h->nlmsg_seq != seq) {
+                               /** Don't forget to skip that message. */
+                               status -= NLMSG_ALIGN(len);
+                               h = (struct nlmsghdr*)((char*)h + NLMSG_ALIGN(len));
+                               continue;
+                       }
+
+                       if (h->nlmsg_type == NLMSG_ERROR) {
+                               struct nlmsgerr *err = (struct nlmsgerr*)NLMSG_DATA(h);
+                               if (l < sizeof(struct nlmsgerr)) {
+                                       DBG("Error truncated message");
+                               } else {
+                                       if (!err->error) {
+                                               if (answer)
+                                                       memcpy(answer, h, h->nlmsg_len);
+                                               return 0;
+                                       }
+
+                                       errno = -err->error;
+                                       strerror_r(errno, error_buf, MAX_SIZE_ERROR_BUFFER);
+                                       DBG("RTNETLINK answers: %s", error_buf);
+                               }
+                               return -1;
+                       }
+                       if (answer) {
+                               memcpy(answer, h, h->nlmsg_len);
+                               return 0;
+                       }
+
+                       DBG("Unexpected reply");
+
+                       status -= NLMSG_ALIGN(len);
+                       h = (struct nlmsghdr*)((char*)h + NLMSG_ALIGN(len));
+               }
+               if (msg.msg_flags & MSG_TRUNC) {
+                       DBG("Message truncated");
+                       continue;
+               }
+               if (status) {
+                       DBG("Remnant of size %d", status);
                        return -1;
                }
        }
+}
 
-       rt.rtmsg_metric = 1;
+static int __netconfig_get_prefix(netconfig_inet_prefix_s *dst, char *arg, int family)
+{
+       if (family != AF_UNSPEC && family != AF_INET6) {
+               DBG("Error: invalid address family.");
+               return -1;
+       }
+
+       memset(dst, 0, sizeof(*dst));
+
+       if (strchr(arg, ':')) {
+               dst->family = AF_INET6;
+               if (inet_pton(AF_INET6, arg, dst->data) <= 0) {
+                       DBG("Error: invalid ipv6 address.");
+                       return -1;
+               }
+               dst->bytelen = 16;
+               dst->bitlen = 128;
+       }
+
+       return 0;
+}
+
+static int addattr_l(struct nlmsghdr *n, int maxlen, int type, const void *data,
+               int alen)
+{
+       int len = RTA_LENGTH(alen);
+       struct rtattr *rta;
+
+       if (NLMSG_ALIGN(n->nlmsg_len) + RTA_ALIGN(len) > maxlen) {
+               DBG("Error message exceeded bound of %d", maxlen);
+               return -1;
+       }
+       rta = NLMSG_TAIL(n);
+       rta->rta_type = type;
+       rta->rta_len = len;
+       memcpy(RTA_DATA(rta), data, alen);
+       n->nlmsg_len = NLMSG_ALIGN(n->nlmsg_len) + RTA_ALIGN(len);
+
+       return 0;
+}
+
+static int __netconfig_iproute_modify(int cmd, unsigned flags, char *interface, char *ip_addr)
+{
+       struct {
+               struct nlmsghdr n;
+               struct rtmsg    r;
+               char            buf[1024];
+       } req;
+
+       struct ifreq ifr;
+       int fd, idx, ret;
+       char error_buf[MAX_SIZE_ERROR_BUFFER] = {0, };
+
+       memset(&req, 0, sizeof(req));
+
+       req.n.nlmsg_len = NLMSG_LENGTH(sizeof(struct rtmsg));
+       req.n.nlmsg_flags = NLM_F_REQUEST|flags;
+       req.n.nlmsg_type = cmd;
+       req.r.rtm_family = AF_INET6;
+
+       if (cmd != RTM_DELROUTE) {
+               req.r.rtm_protocol = RTPROT_BOOT;
+               req.r.rtm_type = RTN_UNICAST;
+       }
 
        fd = socket(AF_INET6, SOCK_DGRAM, 0);
        if (fd < 0) {
@@ -711,26 +974,125 @@ int netconfig_add_route_ipv6(gchar *ip_addr, gchar *interface, gchar *gateway, u
                return -1;
        }
 
-       rt.rtmsg_ifindex = 0;
+       memset(&ifr, 0, sizeof(ifr));
+       strncpy(ifr.ifr_name, interface, sizeof(ifr.ifr_name)-1);
+       ioctl(fd, SIOCGIFINDEX, &ifr);
+       idx = ifr.ifr_ifindex;
+       close(fd);
 
-       if (interface) {
-               struct ifreq ifr;
-               memset(&ifr, 0, sizeof(ifr));
-               strncpy(ifr.ifr_name, interface, sizeof(ifr.ifr_name)-1);
-               ioctl(fd, SIOCGIFINDEX, &ifr);
-               rt.rtmsg_ifindex = ifr.ifr_ifindex;
+       if (ifr.ifr_ifindex == 0) {
+               DBG("Cannot find device %s", interface);
+               return -1;
+       }
+
+       netconfig_inet_prefix_s dst;
+
+       ret = __netconfig_get_prefix(&dst, ip_addr, req.r.rtm_family);
+       if (ret < 0)
+               return -1;
+
+       req.r.rtm_dst_len = dst.bitlen;
+       if (dst.bytelen) {
+               ret = addattr_l(&req.n, sizeof(req), RTA_DST, &dst.data, dst.bytelen);
+               if (ret < 0)
+                       return -1;
+       }
+
+       ret = addattr_l(&req.n, sizeof(req), RTA_OIF, &idx, sizeof(uint32_t));
+       if (ret < 0)
+               return -1;
+
+       if (__netconfig_rtnl_talk(&rth, &req.n, 0, 0, NULL) < 0) {
+               DBG("__netconfig_rtnl_talk failed");
+               return -1;
+       }
+
+       return 0;
+}
+
+static void __netconfig_rtnl_close()
+{
+       if (rth.fd >= 0) {
+               close(rth.fd);
+               rth.fd = -1;
+       }
+}
+
+static int __netconfig_rtnl_open(netconfig_rtnl_s *rth, unsigned subscriptions,
+               int protocol)
+{
+       socklen_t addr_len;
+       int sndbuf = 32768;
+       int rcvbuf = 1024 * 1024;
+       char error_buf[MAX_SIZE_ERROR_BUFFER] = {0, };
+
+       memset(rth, 0, sizeof(*rth));
+
+       rth->fd = socket(AF_NETLINK, SOCK_RAW, protocol);
+       if (rth->fd < 0) {
+               strerror_r(errno, error_buf, MAX_SIZE_ERROR_BUFFER);
+               DBG("Failed to open netlink socket: %s", error_buf);
+               return -1;
        }
 
-       if ((err = ioctl(fd, SIOCADDRT, &rt)) < 0) {
+       if (setsockopt(rth->fd, SOL_SOCKET, SO_SNDBUF, &sndbuf, sizeof(sndbuf)) < 0) {
                strerror_r(errno, error_buf, MAX_SIZE_ERROR_BUFFER);
-               DBG("Failed to add route: %s", error_buf);
-               close(fd);
+               DBG("Failed to set option(SO_SNDBUF) on socket [Error: %s]", error_buf);
                return -1;
        }
 
-       close(fd);
+       if (setsockopt(rth->fd, SOL_SOCKET, SO_RCVBUF, &rcvbuf, sizeof(rcvbuf)) < 0) {
+               strerror_r(errno, error_buf, MAX_SIZE_ERROR_BUFFER);
+               DBG("Failed to set option(SO_RCVBUF) on socket [Error: %s]", error_buf);
+               return -1;
+       }
 
-       return 1;
+       memset(&rth->local, 0, sizeof(rth->local));
+       rth->local.nl_family = AF_NETLINK;
+       rth->local.nl_groups = subscriptions;
+
+       if (bind(rth->fd, (struct sockaddr*)&rth->local, sizeof(rth->local)) < 0) {
+               strerror_r(errno, error_buf, MAX_SIZE_ERROR_BUFFER);
+               DBG("Failed to bind netlink socket [Error: %s]", error_buf);
+               return -1;
+       }
+
+       addr_len = sizeof(rth->local);
+       if (getsockname(rth->fd, (struct sockaddr*)&rth->local, &addr_len) < 0) {
+               strerror_r(errno, error_buf, MAX_SIZE_ERROR_BUFFER);
+               DBG("Failed to getsockname [Error: %s]", error_buf);
+               return -1;
+       }
+       if (addr_len != sizeof(rth->local)) {
+               DBG("Wrong address length %d", addr_len);
+               return -1;
+       }
+       if (rth->local.nl_family != AF_NETLINK) {
+               DBG("Wrong address family %d", rth->local.nl_family);
+               return -1;
+       }
+       rth->seq = time(NULL);
+
+       return 0;
+}
+
+int netconfig_add_route_ipv6(gchar *interface, gchar *gateway)
+{
+       int ret = __netconfig_rtnl_open(&rth, 0, NETLINK_ROUTE);
+       if (ret < 0) {
+               DBG("Failed to open rtnl socket");
+               return -1;
+       }
+
+       ret = __netconfig_iproute_modify(RTM_NEWROUTE, NLM_F_CREATE|NLM_F_EXCL, interface, gateway);
+       if (ret < 0) {
+               DBG("Failed to modify ipv6 route.");
+               __netconfig_rtnl_close();
+               return -1;
+       }
+
+       __netconfig_rtnl_close();
+       return 0;
 }
 
 int netconfig_del_route_ipv6(gchar *ip_addr, gchar *interface, gchar *gateway, unsigned char prefix_len)
@@ -787,7 +1149,11 @@ int netconfig_del_route_ipv6(gchar *ip_addr, gchar *interface, gchar *gateway, u
 
 gboolean handle_launch_direct(Wifi *wifi, GDBusMethodInvocation *context)
 {
-#if defined TIZEN_P2P_ENABLE
+       if (!netconfig_check_feature_supported(NETCONFIG_SUPPORTED_FEATURE_WIFI_DIRECT)) {
+               wifi_complete_launch_direct(wifi, context);
+               return TRUE;
+       }
+
        int ret = 0;
        DBG("Launch Wi-Fi direct daemon");
 
@@ -799,15 +1165,11 @@ gboolean handle_launch_direct(Wifi *wifi, GDBusMethodInvocation *context)
        if (ret < 0) {
                ERR("Failed to launch Wi-Fi direct daemon");
                netconfig_error_wifi_direct_failed(context);
-               return FALSE;
+               return TRUE;
        }
 
        wifi_complete_launch_direct(wifi, context);
        return TRUE;
-#else
-       wifi_complete_launch_direct(wifi, context);
-       return FALSE;
-#endif
 }
 
 int execute_mdnsd_script(char* op)
@@ -1243,3 +1605,31 @@ gboolean netconfig_get_telephony_plugin_flag()
        return netconfig_plugin_telephony_enabled;
 }
 
+bool netconfig_check_feature_supported(netconfig_supported_feature_e feature)
+{
+       const char *key = NULL;
+
+       if (!is_feature_checked[feature]) {
+               switch (feature) {
+               case NETCONFIG_SUPPORTED_FEATURE_ETHERNET:
+                       key = ETHERNET_FEATURE;
+                       break;
+               case NETCONFIG_SUPPORTED_FEATURE_TETHERING:
+                       key = TETHERING_FEATURE;
+                       break;
+               case NETCONFIG_SUPPORTED_FEATURE_WIFI_DIRECT:
+                       key = WIFI_DIRECT_FEATURE;
+                       break;
+               default:
+                       ERR("Uknown feature");
+                       return false;
+               }
+
+               if (system_info_get_platform_bool(key, &feature_supported[feature]) < 0) {
+                       ERR("Get feature is failed");
+                       return false;
+               }
+               is_feature_checked[feature] = true;
+       }
+       return feature_supported[feature];
+}