/*

# SPDX-License-Identifier: LGPL-2.1+

# ~~~

#   Description: RTNL Tests libmnl

#

#   Author: Susant Sahani <susant@redhat.com>

#   Copyright (c) 2018 Red Hat, Inc.

# ~~~

*/

#include <stdio.h>

#include <stdlib.h>

#include <string.h>

#include <arpa/inet.h>

#include <sys/stat.h>

#include <linux/rtnetlink.h>

#include <net/if.h>

#include <linux/if.h>

#include <linux/ip.h>

#include <linux/if_link.h>

#include <linux/if_tunnel.h>

#include <libmnl/libmnl.h>

#include <netinet/in.h>

#include <setjmp.h>

#include <inttypes.h>

#include <cmocka.h>

#define RTNL_BUF_SIZE 8192

void test_link_exists(const char *link) {

        char p[1024] = {};

        struct stat s;

        strcpy(p, "/sys/class/net/");

        strcat(p, link);

        assert_int_equal(stat(p, &s), 0);

}

void delete_link(const char *name) {

        uint8_t buf[RTNL_BUF_SIZE] = {};

        struct nlattr *linkinfo, *dummyinfo;

        struct mnl_socket *nl_sock;

        struct nlmsghdr *nlh;

        struct ifinfomsg *ifinfo;

        nl_sock = mnl_socket_open(NETLINK_ROUTE);

        assert_non_null(nl_sock);

        nlh = mnl_nlmsg_put_header(buf);

        nlh->nlmsg_flags = NLM_F_REQUEST | RTM_DELLINK | NLM_F_ACK;

        nlh->nlmsg_type = RTM_DELLINK;

        ifinfo = mnl_nlmsg_put_extra_header(nlh, sizeof(struct ifinfomsg));

        ifinfo->ifi_family = AF_UNSPEC;

        mnl_attr_put_strz(nlh, IFLA_IFNAME, name);

        mnl_socket_sendto(nl_sock, nlh, nlh->nlmsg_len);

        mnl_socket_recvfrom(nl_sock, buf, sizeof(buf));

        nlh = (struct nlmsghdr*) buf;

        assert_return_code(nlh->nlmsg_type, 0);

}

void create_dummy(char *ifname) {

        uint8_t buf[RTNL_BUF_SIZE] = {};

        struct nlattr *linkinfo, *dummyinfo;

        struct mnl_socket *nl_sock;

        struct nlmsghdr *nlh;

        struct ifinfomsg *ifinfo;

        nl_sock = mnl_socket_open(NETLINK_ROUTE);

        assert_non_null(nl_sock);

        nlh = mnl_nlmsg_put_header(buf);

        nlh->nlmsg_flags = NLM_F_REQUEST | NLM_F_CREATE | NLM_F_EXCL | NLM_F_ACK;

        nlh->nlmsg_type = RTM_NEWLINK;

        ifinfo = mnl_nlmsg_put_extra_header(nlh, sizeof(struct ifinfomsg));

        ifinfo->ifi_family = AF_UNSPEC;

        mnl_attr_put_str(nlh, IFLA_IFNAME, "ci-dummy");

        linkinfo = mnl_attr_nest_start(nlh, IFLA_LINKINFO);

        assert_non_null(linkinfo);

        mnl_attr_put_str(nlh, IFLA_INFO_KIND, "dummy");

        dummyinfo = mnl_attr_nest_start(nlh, IFLA_INFO_DATA);

        mnl_attr_nest_end(nlh, dummyinfo);

        mnl_attr_nest_end(nlh, linkinfo);

        mnl_socket_sendto(nl_sock, nlh, nlh->nlmsg_len);

        mnl_socket_recvfrom(nl_sock, buf, sizeof(buf));

        nlh = (struct nlmsghdr *) buf;

        assert_return_code(nlh->nlmsg_type, 0);

}

void test_create_dummy(void **state) {

        create_dummy("ci-dummy");

        test_link_exists("ci-dummy");

        delete_link("ci-dummy");

}

void test_delete_link(void **state) {

        test_create_dummy(NULL);

        delete_link("ci-dummy");

}

void test_create_ipip(void **state) {

        struct nlattr *linkinfo = NULL, *tunnelinfo = NULL;

        uint8_t buf[RTNL_BUF_SIZE] = {};

        struct mnl_socket *nl_sock = NULL;

        struct ifinfomsg *ifinfo = NULL;

        struct nlmsghdr *nlh = NULL;

        struct in_addr addr;

        nl_sock = mnl_socket_open(NETLINK_ROUTE);

        assert_non_null(nl_sock);

        nlh = mnl_nlmsg_put_header(buf);

        nlh->nlmsg_flags = NLM_F_REQUEST | NLM_F_CREATE | NLM_F_EXCL | NLM_F_ACK;

        nlh->nlmsg_type = RTM_NEWLINK;

        ifinfo = mnl_nlmsg_put_extra_header(nlh, sizeof(struct ifinfomsg));

        ifinfo->ifi_family = AF_UNSPEC;

        mnl_attr_put_str(nlh, IFLA_IFNAME, "ci-ipip");

        linkinfo = mnl_attr_nest_start(nlh, IFLA_LINKINFO);

        assert_non_null(linkinfo);

        mnl_attr_put_str(nlh, IFLA_INFO_KIND, "ipip");

        tunnelinfo = mnl_attr_nest_start(nlh, IFLA_INFO_DATA);

        assert_non_null(tunnelinfo);

        inet_pton(AF_INET, "192.168.203.19", &addr);

        mnl_attr_put_u32(nlh, IFLA_IPTUN_LOCAL, addr.s_addr);

        inet_pton(AF_INET, "10.0.0.2", &addr);

        mnl_attr_put_u32(nlh, IFLA_IPTUN_REMOTE, addr.s_addr);

        mnl_attr_nest_end(nlh, tunnelinfo);

        mnl_attr_nest_end(nlh, linkinfo);

        assert_return_code(mnl_socket_sendto(nl_sock, nlh, nlh->nlmsg_len), 0);

        assert_return_code(mnl_socket_recvfrom(nl_sock, buf, sizeof(buf)), 0);

        nlh = (struct nlmsghdr *) buf;

        assert_return_code(nlh->nlmsg_type, 0);

        test_link_exists("ci-ipip");

        delete_link("ci-ipip");

}

void test_create_sit(void **state) {

        struct nlattr *linkinfo, *tunnelinfo;

        uint8_t buf[RTNL_BUF_SIZE] = {};

        struct mnl_socket *nl_sock;

        struct ifinfomsg *ifinfo;

        struct nlmsghdr *nlh;

        struct in_addr addr;

        nl_sock = mnl_socket_open(NETLINK_ROUTE);

        assert_non_null(nl_sock);

        nlh = mnl_nlmsg_put_header(buf);

        nlh->nlmsg_flags = NLM_F_REQUEST | NLM_F_CREATE | NLM_F_EXCL | NLM_F_ACK;

        nlh->nlmsg_type = RTM_NEWLINK;

        ifinfo = mnl_nlmsg_put_extra_header(nlh, sizeof(struct ifinfomsg));

        ifinfo->ifi_family = AF_UNSPEC;

        mnl_attr_put_str(nlh, IFLA_IFNAME, "ci-sit-tun");

        linkinfo = mnl_attr_nest_start(nlh, IFLA_LINKINFO);

        assert_non_null(linkinfo);

        mnl_attr_put_str(nlh, IFLA_INFO_KIND, "sit");

        tunnelinfo = mnl_attr_nest_start(nlh, IFLA_INFO_DATA);

        assert_non_null(tunnelinfo);

        inet_pton(AF_INET, "192.168.203.19", &addr);

        mnl_attr_put_u32(nlh, IFLA_IPTUN_LOCAL, addr.s_addr);

        inet_pton(AF_INET, "10.0.0.2", &addr);

        mnl_attr_put_u32(nlh, IFLA_IPTUN_REMOTE, addr.s_addr);

        mnl_attr_nest_end(nlh, tunnelinfo);

        mnl_attr_nest_end(nlh, linkinfo);

        assert_return_code(mnl_socket_sendto(nl_sock, nlh, nlh->nlmsg_len), 0);

        assert_return_code(mnl_socket_recvfrom(nl_sock, buf, sizeof(buf)), 0);

        nlh = (struct nlmsghdr*) buf;

        assert_return_code(nlh->nlmsg_type, 0);

        test_link_exists("ci-sit-tun");

        delete_link("ci-sit-tun");

}

void test_create_bonding(void **state) {

        uint8_t buf[RTNL_BUF_SIZE] = {};

        struct nlattr *linkinfo;

        struct mnl_socket *nl_sock;

        struct ifinfomsg *ifinfo;

        struct nlmsghdr *nlh;

        struct in_addr addr;

        int r;

        nl_sock = mnl_socket_open(NETLINK_ROUTE);

        assert_non_null(nl_sock);

        nlh = mnl_nlmsg_put_header(buf);

        nlh->nlmsg_flags = NLM_F_REQUEST | NLM_F_CREATE | NLM_F_EXCL | NLM_F_ACK;

        nlh->nlmsg_type = RTM_NEWLINK;

        ifinfo = mnl_nlmsg_put_extra_header(nlh, sizeof(struct ifinfomsg));

        ifinfo->ifi_family = AF_UNSPEC;

        mnl_attr_put_str(nlh, IFLA_IFNAME, "ci-bond");

        linkinfo = mnl_attr_nest_start(nlh, IFLA_LINKINFO);

        assert_non_null(linkinfo);

        mnl_attr_put_str(nlh, IFLA_INFO_KIND, "bond");

        mnl_attr_nest_end(nlh, linkinfo);

        assert_return_code(mnl_socket_sendto(nl_sock, nlh, nlh->nlmsg_len), 0);

        assert_return_code(mnl_socket_recvfrom(nl_sock, buf, sizeof(buf)), 0);

        nlh = (struct nlmsghdr*) buf;

        assert_return_code(nlh->nlmsg_type, 0);

        test_link_exists("ci-bond");

        delete_link("ci-bond");

}

void test_create_bridge(void **state) {

        uint8_t buf[RTNL_BUF_SIZE] = {};

        struct nlattr *linkinfo;

        struct mnl_socket *nl_sock;

        struct ifinfomsg *ifinfo;

        struct nlmsghdr *nlh;

        struct in_addr addr;

        nl_sock = mnl_socket_open(NETLINK_ROUTE);

        assert_non_null(nl_sock);

        nlh = mnl_nlmsg_put_header(buf);

        nlh->nlmsg_flags = NLM_F_REQUEST | NLM_F_CREATE | NLM_F_EXCL | NLM_F_ACK;

        nlh->nlmsg_type = RTM_NEWLINK;

        ifinfo = mnl_nlmsg_put_extra_header(nlh, sizeof(struct ifinfomsg));

        ifinfo->ifi_family = AF_UNSPEC;

        mnl_attr_put_str(nlh, IFLA_IFNAME, "ci-bridge");

        linkinfo = mnl_attr_nest_start(nlh, IFLA_LINKINFO);

        assert_non_null(linkinfo);

        mnl_attr_put_str(nlh, IFLA_INFO_KIND, "bridge");

        mnl_attr_nest_end(nlh, linkinfo);

        assert_return_code(mnl_socket_sendto(nl_sock, nlh, nlh->nlmsg_len), 0);

        assert_return_code(mnl_socket_recvfrom(nl_sock, buf, sizeof(buf)), 0);

        nlh = (struct nlmsghdr*) buf;

        assert_return_code(nlh->nlmsg_type, 0);

        test_link_exists("ci-bridge");

        delete_link("ci-bridge");

}

static int link_status_data_attr_cb(const struct nlattr *attr, void *data) {

        const struct nlattr **tb = data;

        int type = mnl_attr_get_type(attr);

        /* skip unsupported attribute in user-space */

        if (mnl_attr_type_valid(attr, IFLA_MAX) < 0)

                return MNL_CB_OK;

        switch(type) {

        case IFLA_ADDRESS:

                if (mnl_attr_validate(attr, MNL_TYPE_BINARY) < 0) {

                        perror("mnl_attr_validate");

                        return MNL_CB_ERROR;

                }

                break;

        case IFLA_MTU:

                if (mnl_attr_validate(attr, MNL_TYPE_U32) < 0) {

                        perror("mnl_attr_validate");

                        return MNL_CB_ERROR;

                }

                break;

        case IFLA_IFNAME:

                if (mnl_attr_validate(attr, MNL_TYPE_STRING) < 0) {

                        perror("mnl_attr_validate");

                        return MNL_CB_ERROR;

                }

                break;

        }

        tb[type] = attr;

        return MNL_CB_OK;

}

static int link_status_data_cb(const struct nlmsghdr *nlh, void *data) {

        struct ifinfomsg *ifm = mnl_nlmsg_get_payload(nlh);

        struct nlattr *tb[IFLA_MAX+1] = {};

        mnl_attr_parse(nlh, sizeof(*ifm), link_status_data_attr_cb, tb);

        if (!strcmp("ci-dummy", mnl_attr_get_str(tb[IFLA_IFNAME]))) {

                int status = 0;

                if (ifm->ifi_flags & IFF_UP)

                        status = 1;

                assert_int_equal(status, 1);

                assert_int_equal(1234, mnl_attr_get_u32(tb[IFLA_MTU]));

        }

        return MNL_CB_OK;

}

static int link_dump(char *ifname) {

        struct mnl_socket *nl;

        char buf[MNL_SOCKET_BUFFER_SIZE];

        struct nlmsghdr *nlh;

        struct ifinfomsg *ifinfo;

        unsigned int seq, portid;

        int ret;

        nlh = mnl_nlmsg_put_header(buf);

        nlh->nlmsg_type = RTM_GETLINK;

        nlh->nlmsg_flags = NLM_F_REQUEST | NLM_F_DUMP;

        ifinfo = mnl_nlmsg_put_extra_header(nlh, sizeof(struct ifinfomsg));

        ifinfo->ifi_family = AF_UNSPEC;

        nl = mnl_socket_open(NETLINK_ROUTE);

        if (nl == NULL) {

                perror("mnl_socket_open");

                exit(EXIT_FAILURE);

        }

        if (mnl_socket_bind(nl, 0, MNL_SOCKET_AUTOPID) < 0) {

                perror("mnl_socket_bind");

                exit(EXIT_FAILURE);

        }

        portid = mnl_socket_get_portid(nl);

        if (mnl_socket_sendto(nl, nlh, nlh->nlmsg_len) < 0) {

                perror("mnl_socket_sendto");

                exit(EXIT_FAILURE);

        }

        assert_return_code(mnl_socket_recvfrom(nl, buf, sizeof(buf)), 0);

        mnl_cb_run(buf, ret, seq, portid, link_status_data_cb, NULL);

        assert_return_code(mnl_socket_recvfrom(nl, buf, sizeof(buf)), 0);

        mnl_socket_close(nl);

        return 0;

}

void test_rtnl_set_link(void **state) {

        struct nlattr *linkinfo;

        uint8_t buf[RTNL_BUF_SIZE] = {};

        struct mnl_socket *nl_sock;

        struct ifinfomsg *ifinfo;

        struct nlmsghdr *nlh;

        struct in_addr addr;

        create_dummy("ci-dummy");

        test_link_exists("ci-dummy");

        nl_sock = mnl_socket_open(NETLINK_ROUTE);

        nlh = mnl_nlmsg_put_header(buf);

        nlh->nlmsg_flags = NLM_F_REQUEST | NLM_F_ACK;

        nlh->nlmsg_type = RTM_SETLINK;

        ifinfo = mnl_nlmsg_put_extra_header(nlh, sizeof(struct ifinfomsg));

        ifinfo->ifi_family = AF_UNSPEC;

        ifinfo->ifi_change |= IFF_UP;

        ifinfo->ifi_flags |= IFF_UP;

        mnl_attr_put_str(nlh, IFLA_IFNAME, "ci-dummy");

        mnl_attr_put_u32(nlh, IFLA_MTU, 1234);

        assert_return_code(mnl_socket_sendto(nl_sock, nlh, nlh->nlmsg_len), 0);

        assert_return_code(mnl_socket_recvfrom(nl_sock, buf, sizeof(buf)), 0);

        nlh = (struct nlmsghdr *) buf;

        assert_return_code(nlh->nlmsg_type, 0);

        link_dump("ci-dummy");

        delete_link("ci-dummy");

}

int main(int argc, char *argv[]) {

        const struct CMUnitTest rtnl_tests[] = {

                                                cmocka_unit_test(test_create_dummy),

                                                cmocka_unit_test(test_create_ipip),

                                                cmocka_unit_test(test_create_sit),

                                                cmocka_unit_test(test_create_bonding),

                                                cmocka_unit_test(test_create_bridge),

                                                cmocka_unit_test(test_delete_link),

                                                cmocka_unit_test(test_rtnl_set_link),

        };

        return cmocka_run_group_tests(rtnl_tests, NULL, NULL);

}