| /*-*- Mode: C; c-basic-offset: 8; indent-tabs-mode: nil -*-*/ |
| |
| /*** |
| This file is part of systemd. |
| |
| Copyright (C) 2014 Intel Corporation. All rights reserved. |
| |
| systemd is free software; you can redistribute it and/or modify it |
| under the terms of the GNU Lesser General Public License as published by |
| the Free Software Foundation; either version 2.1 of the License, or |
| (at your option) any later version. |
| |
| systemd is distributed in the hope that it will be useful, but |
| WITHOUT ANY WARRANTY; without even the implied warranty of |
| MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
| Lesser General Public License for more details. |
| |
| You should have received a copy of the GNU Lesser General Public License |
| along with systemd; If not, see <http://www.gnu.org/licenses/>. |
| ***/ |
| |
| #include <netinet/icmp6.h> |
| |
| #include "socket-util.h" |
| |
| #include "dhcp6-internal.h" |
| #include "sd-icmp6-nd.h" |
| |
| static struct ether_addr mac_addr = { |
| .ether_addr_octet = {'A', 'B', 'C', '1', '2', '3'} |
| }; |
| |
| static bool verbose = false; |
| static sd_event_source *test_hangcheck; |
| static int test_fd[2]; |
| |
| typedef int (*send_ra_t)(uint8_t flags); |
| static send_ra_t send_ra_function; |
| |
| static int test_rs_hangcheck(sd_event_source *s, uint64_t usec, |
| void *userdata) { |
| assert_se(false); |
| |
| return 0; |
| } |
| |
| int dhcp_network_icmp6_bind_router_solicitation(int index) { |
| assert_se(index == 42); |
| |
| if (socketpair(AF_UNIX, SOCK_DGRAM, 0, test_fd) < 0) |
| return -errno; |
| |
| return test_fd[0]; |
| } |
| |
| static int send_ra_short_prefix(uint8_t flags) { |
| uint8_t advertisement[] = { |
| 0x86, 0x00, 0xbe, 0xd7, 0x40, 0xc0, 0x00, 0xb4, |
| 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, |
| |
| 0x03, 0x04, 0x34, 0xc0, 0x00, 0x00, 0x01, 0xf4, |
| 0x00, 0x00, 0x01, 0xb8, 0x00, 0x00, 0x00, 0x00, |
| 0x20, 0x01, 0x0d, 0xb8, 0xde, 0xad, 0xbe, 0xef, |
| 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 |
| }; |
| |
| assert_se(write(test_fd[1], advertisement, sizeof(advertisement)) == |
| sizeof(advertisement)); |
| |
| return 0; |
| } |
| |
| static void test_short_prefix_cb(sd_icmp6_nd *nd, int event, void *userdata) { |
| sd_event *e = userdata; |
| struct { |
| struct in6_addr addr; |
| uint8_t prefixlen; |
| bool success; |
| } addrs[] = { |
| { { { { 0x20, 0x01, 0x0d, 0xb8, 0xde, 0xad, 0xbe, 0xef, |
| 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 } } }, |
| 52, true }, |
| { { { { 0x20, 0x01, 0x0d, 0xb8, 0xde, 0xad, 0x0d, 0xad, |
| 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 } } }, |
| 64, false }, |
| { { { { 0x20, 0x01, 0x0d, 0xb8, 0x0b, 0x16, 0xd0, 0x0d, |
| 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 } } }, |
| 60, true }, |
| { { { { 0x20, 0x01, 0x0d, 0xb8, 0x00, 0x9d, 0xab, 0xcd, |
| 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 } } }, |
| 64, true }, |
| { { { { 0x20, 0x01, 0x0d, 0xb8, 0xde, 0xad, 0xbe, 0xed, |
| 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01 } } }, |
| 52, true }, |
| }; |
| uint8_t prefixlen; |
| unsigned int i; |
| |
| for (i = 0; i < ELEMENTSOF(addrs); i++) { |
| printf(" %s prefix %02x%02x:%02x%02x:%02x%02x:%02x%02x", |
| __FUNCTION__, |
| addrs[i].addr.s6_addr[0], addrs[i].addr.s6_addr[1], |
| addrs[i].addr.s6_addr[2], addrs[i].addr.s6_addr[3], |
| addrs[i].addr.s6_addr[4], addrs[i].addr.s6_addr[5], |
| addrs[i].addr.s6_addr[6], addrs[i].addr.s6_addr[7]); |
| |
| if (addrs[i].success) { |
| assert_se(sd_icmp6_ra_get_prefixlen(nd, &addrs[i].addr, |
| &prefixlen) >= 0); |
| assert_se(addrs[i].prefixlen == prefixlen); |
| printf("/%d onlink\n", prefixlen); |
| } else { |
| assert_se(sd_icmp6_ra_get_prefixlen(nd, &addrs[i].addr, |
| &prefixlen) == -EADDRNOTAVAIL); |
| printf("/128 offlink\n"); |
| } |
| } |
| |
| sd_event_exit(e, 0); |
| } |
| |
| static int send_ra_prefixes(uint8_t flags) { |
| uint8_t advertisement[] = { |
| 0x86, 0x00, 0xbe, 0xd7, 0x40, 0xc0, 0x00, 0xb4, |
| 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 0x03, 0x04, 0x3f, 0xc0, 0x00, 0x00, 0x01, 0xf4, |
| 0x00, 0x00, 0x01, 0xb8, 0x00, 0x00, 0x00, 0x00, |
| 0x20, 0x01, 0x0d, 0xb8, 0xde, 0xad, 0xbe, 0xef, |
| 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 0x03, 0x04, 0x40, 0x00, 0x00, 0x00, 0x02, 0x58, |
| 0x00, 0x00, 0x02, 0x1c, 0x00, 0x00, 0x00, 0x00, |
| 0x20, 0x01, 0x0d, 0xb8, 0xde, 0xad, 0x0d, 0xad, |
| 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 0x03, 0x04, 0x3c, 0x80, 0x00, 0x00, 0x03, 0x84, |
| 0x00, 0x00, 0x03, 0x20, 0x00, 0x00, 0x00, 0x00, |
| 0x20, 0x01, 0x0d, 0xb8, 0x0b, 0x16, 0xd0, 0x0d, |
| 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 0x03, 0x04, 0x40, 0xc0, 0x00, 0x00, 0x03, 0x84, |
| 0x00, 0x00, 0x03, 0x20, 0x00, 0x00, 0x00, 0x00, |
| 0x20, 0x01, 0x0d, 0xb8, 0x00, 0x9d, 0xab, 0xcd, |
| 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 0x19, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3c, |
| 0x20, 0x01, 0x0d, 0xb8, 0xde, 0xad, 0xbe, 0xef, |
| 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01, |
| 0x1f, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3c, |
| 0x03, 0x6c, 0x61, 0x62, 0x05, 0x69, 0x6e, 0x74, |
| 0x72, 0x61, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 0x01, 0x01, 0x78, 0x2b, 0xcb, 0xb3, 0x6d, 0x53 |
| }; |
| |
| assert_se(write(test_fd[1], advertisement, sizeof(advertisement)) == |
| sizeof(advertisement)); |
| |
| return 0; |
| } |
| |
| static void test_prefixes_cb(sd_icmp6_nd *nd, int event, void *userdata) { |
| sd_event *e = userdata; |
| struct { |
| struct in6_addr addr; |
| uint8_t prefixlen; |
| bool success; |
| } addrs[] = { |
| { { { { 0x20, 0x01, 0x0d, 0xb8, 0xde, 0xad, 0xbe, 0xef, |
| 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 } } }, |
| 63, true }, |
| { { { { 0x20, 0x01, 0x0d, 0xb8, 0xde, 0xad, 0x0d, 0xad, |
| 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 } } }, |
| 64, false }, |
| { { { { 0x20, 0x01, 0x0d, 0xb8, 0x0b, 0x16, 0xd0, 0x0d, |
| 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 } } }, |
| 60, true }, |
| { { { { 0x20, 0x01, 0x0d, 0xb8, 0x00, 0x9d, 0xab, 0xcd, |
| 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 } } }, |
| 64, true }, |
| { { { { 0x20, 0x01, 0x0d, 0xb8, 0xde, 0xad, 0xbe, 0xed, |
| 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01 } } }, |
| 63, false }, |
| }; |
| uint8_t prefixlen; |
| unsigned int i; |
| |
| for (i = 0; i < ELEMENTSOF(addrs); i++) { |
| printf(" %s prefix %02x%02x:%02x%02x:%02x%02x:%02x%02x", |
| __FUNCTION__, |
| addrs[i].addr.s6_addr[0], addrs[i].addr.s6_addr[1], |
| addrs[i].addr.s6_addr[2], addrs[i].addr.s6_addr[3], |
| addrs[i].addr.s6_addr[4], addrs[i].addr.s6_addr[5], |
| addrs[i].addr.s6_addr[6], addrs[i].addr.s6_addr[7]); |
| |
| if (addrs[i].success) { |
| assert_se(sd_icmp6_ra_get_prefixlen(nd, &addrs[i].addr, |
| &prefixlen) >= 0); |
| assert_se(addrs[i].prefixlen == prefixlen); |
| printf("/%d onlink\n", prefixlen); |
| } else { |
| assert_se(sd_icmp6_ra_get_prefixlen(nd, &addrs[i].addr, |
| &prefixlen) == -EADDRNOTAVAIL); |
| printf("/128 offlink\n"); |
| } |
| } |
| |
| send_ra_function = send_ra_short_prefix; |
| assert_se(sd_icmp6_nd_set_callback(nd, test_short_prefix_cb, e) >= 0); |
| assert_se(sd_icmp6_nd_stop(nd) >= 0); |
| assert_se(sd_icmp6_router_solicitation_start(nd) >= 0); |
| } |
| |
| static void test_prefixes(void) { |
| sd_event *e; |
| sd_icmp6_nd *nd; |
| |
| if (verbose) |
| printf("* %s\n", __FUNCTION__); |
| |
| send_ra_function = send_ra_prefixes; |
| |
| assert_se(sd_event_new(&e) >= 0); |
| |
| assert_se(sd_icmp6_nd_new(&nd) >= 0); |
| assert_se(nd); |
| |
| assert_se(sd_icmp6_nd_attach_event(nd, e, 0) >= 0); |
| |
| assert_se(sd_icmp6_nd_set_index(nd, 42) >= 0); |
| assert_se(sd_icmp6_nd_set_mac(nd, &mac_addr) >= 0); |
| assert_se(sd_icmp6_nd_set_callback(nd, test_prefixes_cb, e) >= 0); |
| |
| assert_se(sd_icmp6_router_solicitation_start(nd) >= 0); |
| |
| sd_event_loop(e); |
| |
| nd = sd_icmp6_nd_unref(nd); |
| assert_se(!nd); |
| |
| close(test_fd[1]); |
| |
| sd_event_unref(e); |
| } |
| |
| static int send_ra(uint8_t flags) { |
| uint8_t advertisement[] = { |
| 0x86, 0x00, 0xde, 0x83, 0x40, 0xc0, 0x00, 0xb4, |
| 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 0x03, 0x04, 0x40, 0xc0, 0x00, 0x00, 0x01, 0xf4, |
| 0x00, 0x00, 0x01, 0xb8, 0x00, 0x00, 0x00, 0x00, |
| 0x20, 0x01, 0x0d, 0xb8, 0xde, 0xad, 0xbe, 0xef, |
| 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 0x19, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3c, |
| 0x20, 0x01, 0x0d, 0xb8, 0xde, 0xad, 0xbe, 0xef, |
| 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01, |
| 0x1f, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3c, |
| 0x03, 0x6c, 0x61, 0x62, 0x05, 0x69, 0x6e, 0x74, |
| 0x72, 0x61, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 0x01, 0x01, 0x78, 0x2b, 0xcb, 0xb3, 0x6d, 0x53, |
| }; |
| |
| advertisement[5] = flags; |
| |
| assert_se(write(test_fd[1], advertisement, sizeof(advertisement)) == |
| sizeof(advertisement)); |
| |
| if (verbose) |
| printf(" sent RA with flag 0x%02x\n", flags); |
| |
| return 0; |
| } |
| |
| int dhcp_network_icmp6_send_router_solicitation(int s, const struct ether_addr *ether_addr) { |
| return send_ra_function(0); |
| } |
| |
| static void test_rs_done(sd_icmp6_nd *nd, int event, void *userdata) { |
| sd_event *e = userdata; |
| static int idx = 0; |
| struct { |
| uint8_t flag; |
| int event; |
| } flag_event[] = { |
| { 0, ICMP6_EVENT_ROUTER_ADVERTISMENT_NONE }, |
| { ND_RA_FLAG_OTHER, ICMP6_EVENT_ROUTER_ADVERTISMENT_OTHER }, |
| { ND_RA_FLAG_MANAGED, ICMP6_EVENT_ROUTER_ADVERTISMENT_MANAGED } |
| }; |
| uint32_t mtu; |
| |
| assert_se(nd); |
| |
| assert_se(event == flag_event[idx].event); |
| idx++; |
| |
| if (verbose) |
| printf(" got event %d\n", event); |
| |
| if (idx < 3) { |
| send_ra(flag_event[idx].flag); |
| return; |
| } |
| |
| assert_se(sd_icmp6_ra_get_mtu(nd, &mtu) == -ENOMSG); |
| |
| sd_event_exit(e, 0); |
| } |
| |
| static void test_rs(void) { |
| sd_event *e; |
| sd_icmp6_nd *nd; |
| usec_t time_now = now(clock_boottime_or_monotonic()); |
| |
| if (verbose) |
| printf("* %s\n", __FUNCTION__); |
| |
| send_ra_function = send_ra; |
| |
| assert_se(sd_event_new(&e) >= 0); |
| |
| assert_se(sd_icmp6_nd_new(&nd) >= 0); |
| assert_se(nd); |
| |
| assert_se(sd_icmp6_nd_attach_event(nd, e, 0) >= 0); |
| |
| assert_se(sd_icmp6_nd_set_index(nd, 42) >= 0); |
| assert_se(sd_icmp6_nd_set_mac(nd, &mac_addr) >= 0); |
| assert_se(sd_icmp6_nd_set_callback(nd, test_rs_done, e) >= 0); |
| |
| assert_se(sd_event_add_time(e, &test_hangcheck, clock_boottime_or_monotonic(), |
| time_now + 2 *USEC_PER_SEC, 0, |
| test_rs_hangcheck, NULL) >= 0); |
| |
| assert_se(sd_icmp6_nd_stop(nd) >= 0); |
| assert_se(sd_icmp6_router_solicitation_start(nd) >= 0); |
| assert_se(sd_icmp6_nd_stop(nd) >= 0); |
| |
| assert_se(sd_icmp6_router_solicitation_start(nd) >= 0); |
| |
| sd_event_loop(e); |
| |
| test_hangcheck = sd_event_source_unref(test_hangcheck); |
| |
| nd = sd_icmp6_nd_unref(nd); |
| assert_se(!nd); |
| |
| close(test_fd[1]); |
| |
| sd_event_unref(e); |
| } |
| |
| int main(int argc, char *argv[]) { |
| |
| log_set_max_level(LOG_DEBUG); |
| log_parse_environment(); |
| log_open(); |
| |
| test_rs(); |
| test_prefixes(); |
| |
| return 0; |
| } |