/* main.c - Application main entry point */
/*
* Copyright (c) 2018 Intel Corporation
*
* SPDX-License-Identifier: Apache-2.0
*/
#define NET_LOG_LEVEL CONFIG_NET_L2_ETHERNET_LOG_LEVEL
#include <logging/log.h>
LOG_MODULE_REGISTER(net_test, NET_LOG_LEVEL);
#include <zephyr/types.h>
#include <stdbool.h>
#include <stddef.h>
#include <string.h>
#include <errno.h>
#include <sys/printk.h>
#include <linker/sections.h>
#include <ztest.h>
#include <net/ethernet.h>
#include <net/dummy.h>
#include <net/buf.h>
#include <net/net_ip.h>
#include <net/ethernet_vlan.h>
#include <net/net_l2.h>
#include "ipv6.h"
#define NET_LOG_ENABLED 1
#include "net_private.h"
#if NET_LOG_LEVEL >= LOG_LEVEL_DBG
#define DBG(fmt, ...) printk(fmt, ##__VA_ARGS__)
#else
#define DBG(fmt, ...)
#endif
#define PORT 9999
#define VLAN_TAG_1 100
#define VLAN_TAG_2 200
#define VLAN_TAG_3 300
#define VLAN_TAG_4 400
#define VLAN_TAG_5 500
static char *test_data = "Test data to be sent";
/* Interface 1 addresses */
static struct in6_addr my_addr1 = { { { 0x20, 0x01, 0x0d, 0xb8, 1, 0, 0, 0,
0, 0, 0, 0, 0, 0, 0, 0x1 } } };
/* Interface 2 addresses */
static struct in6_addr my_addr2 = { { { 0x20, 0x01, 0x0d, 0xb8, 0, 0, 0, 0,
0, 0, 0, 0, 0, 0, 0, 0x1 } } };
/* Interface 3 addresses */
static struct in6_addr my_addr3 = { { { 0x20, 0x01, 0x0d, 0xb8, 2, 0, 0, 0,
0, 0, 0, 0, 0, 0, 0, 0x1 } } };
/* Destination address for test packets */
static struct in6_addr dst_addr = { { { 0x20, 0x01, 0x0d, 0xb8, 9, 0, 0, 0,
0, 0, 0, 0, 0, 0, 0, 0x1 } } };
/* Extra address is assigned to ll_addr */
static struct in6_addr ll_addr = { { { 0xfe, 0x80, 0x43, 0xb8, 0, 0, 0, 0,
0, 0, 0, 0xf2, 0xaa, 0x29, 0x02,
0x04 } } };
/* Keep track of all ethernet interfaces */
static struct net_if *eth_interfaces[NET_VLAN_MAX_COUNT + 1];
static struct net_if *dummy_interfaces[2];
static struct net_if *extra_eth;
static struct net_context *udp_v6_ctx;
static bool test_failed;
static bool test_started;
static K_SEM_DEFINE(wait_data, 0, UINT_MAX);
#define WAIT_TIME K_SECONDS(1)
struct eth_context {
struct net_if *iface;
u8_t mac_addr[6];
u16_t expecting_tag;
};
static struct eth_context eth_vlan_context;
static void eth_vlan_iface_init(struct net_if *iface)
{
struct device *dev = net_if_get_device(iface);
struct eth_context *context = dev->driver_data;
net_if_set_link_addr(iface, context->mac_addr,
sizeof(context->mac_addr),
NET_LINK_ETHERNET);
ethernet_init(iface);
}
static int eth_tx(struct device *dev, struct net_pkt *pkt)
{
struct eth_context *context = dev->driver_data;
zassert_equal_ptr(ð_vlan_context, context,
"Context pointers do not match (%p vs %p)",
eth_vlan_context, context);
if (!pkt->buffer) {
DBG("No data to send!\n");
return -ENODATA;
}
if (test_started) {
struct net_eth_vlan_hdr *hdr =
(struct net_eth_vlan_hdr *)NET_ETH_HDR(pkt);
zassert_equal(context->expecting_tag,
net_pkt_vlan_tag(pkt),
"Invalid VLAN tag (%d vs %d) in TX pkt\n",
net_pkt_vlan_tag(pkt),
context->expecting_tag);
zassert_equal(context->expecting_tag,
net_eth_vlan_get_vid(ntohs(hdr->vlan.tci)),
"Invalid VLAN tag in ethernet header");
k_sem_give(&wait_data);
}
return 0;
}
static enum ethernet_hw_caps eth_capabilities(struct device *dev)
{
return ETHERNET_HW_VLAN;
}
static struct ethernet_api api_funcs = {
.iface_api.init = eth_vlan_iface_init,
.get_capabilities = eth_capabilities,
.send = eth_tx,
};
static void generate_mac(u8_t *mac_addr)
{
/* 00-00-5E-00-53-xx Documentation RFC 7042 */
mac_addr[0] = 0x00;
mac_addr[1] = 0x00;
mac_addr[2] = 0x5E;
mac_addr[3] = 0x00;
mac_addr[4] = 0x53;
mac_addr[5] = sys_rand32_get();
}
static int eth_vlan_init(struct device *dev)
{
struct eth_context *context = dev->driver_data;
generate_mac(context->mac_addr);
return 0;
}
ETH_NET_DEVICE_INIT(eth_vlan_test, "eth_vlan_test", eth_vlan_init,
ð_vlan_context, NULL, CONFIG_ETH_INIT_PRIORITY,
&api_funcs, NET_ETH_MTU);
static int eth_init(struct device *dev)
{
struct eth_context *context = dev->driver_data;
generate_mac(context->mac_addr);
return 0;
}
/* Create one ethernet interface that does not have VLAN support. This
* is quite unlikely that this would be done in real life but for testing
* purposes create it here.
*/
NET_DEVICE_INIT(eth_test, "eth_test", eth_init, ð_vlan_context,
NULL, CONFIG_ETH_INIT_PRIORITY, &api_funcs,
ETHERNET_L2, NET_L2_GET_CTX_TYPE(ETHERNET_L2),
NET_ETH_MTU);
struct net_if_test {
u8_t idx; /* not used for anything, just a dummy value */
u8_t mac_addr[sizeof(struct net_eth_addr)];
struct net_linkaddr ll_addr;
};
static int net_iface_dev_init(struct device *dev)
{
return 0;
}
static u8_t *net_iface_get_mac(struct device *dev)
{
struct net_if_test *data = dev->driver_data;
if (data->mac_addr[2] == 0x00) {
/* 00-00-5E-00-53-xx Documentation RFC 7042 */
data->mac_addr[0] = 0x00;
data->mac_addr[1] = 0x00;
data->mac_addr[2] = 0x5E;
data->mac_addr[3] = 0x00;
data->mac_addr[4] = 0x53;
data->mac_addr[5] = sys_rand32_get();
}
data->ll_addr.addr = data->mac_addr;
data->ll_addr.len = 6U;
return data->mac_addr;
}
static void net_iface_init(struct net_if *iface)
{
u8_t *mac = net_iface_get_mac(net_if_get_device(iface));
net_if_set_link_addr(iface, mac, sizeof(struct net_eth_addr),
NET_LINK_ETHERNET);
}
static int sender_iface(struct device *dev, struct net_pkt *pkt)
{
return 0;
}
struct net_if_test net_iface1_data;
struct net_if_test net_iface2_data;
static struct dummy_api net_iface_api = {
.iface_api.init = net_iface_init,
.send = sender_iface,
};
/* For testing purposes, create two dummy network interfaces so we can check
* that no VLANs are created for it.
*/
NET_DEVICE_INIT_INSTANCE(net_iface1_test,
"iface1",
iface1,
net_iface_dev_init,
&net_iface1_data,
NULL,
CONFIG_KERNEL_INIT_PRIORITY_DEFAULT,
&net_iface_api,
DUMMY_L2,
NET_L2_GET_CTX_TYPE(DUMMY_L2),
127);
NET_DEVICE_INIT_INSTANCE(net_iface2_test,
"iface2",
iface2,
net_iface_dev_init,
&net_iface2_data,
NULL,
CONFIG_KERNEL_INIT_PRIORITY_DEFAULT,
&net_iface_api,
DUMMY_L2,
NET_L2_GET_CTX_TYPE(DUMMY_L2),
127);
struct user_data {
int eth_if_count;
int dummy_if_count;
int total_if_count;
};
#if NET_LOG_LEVEL >= LOG_LEVEL_DBG
static const char *iface2str(struct net_if *iface)
{
#ifdef CONFIG_NET_L2_ETHERNET
if (net_if_l2(iface) == &NET_L2_GET_NAME(ETHERNET)) {
return "Ethernet";
}
#endif
#ifdef CONFIG_NET_L2_DUMMY
if (net_if_l2(iface) == &NET_L2_GET_NAME(DUMMY)) {
return "Dummy";
}
#endif
return "<unknown type>";
}
#endif
static void iface_cb(struct net_if *iface, void *user_data)
{
struct user_data *ud = user_data;
DBG("Interface %p (%s) [%d]\n", iface, iface2str(iface),
net_if_get_by_iface(iface));
if (net_if_l2(iface) == &NET_L2_GET_NAME(ETHERNET)) {
if (PART_OF_ARRAY(NET_IF_GET_NAME(eth_test, 0), iface)) {
if (!extra_eth) {
/* Just use the first interface */
extra_eth = iface;
}
} else {
eth_interfaces[ud->eth_if_count++] = iface;
}
}
if (net_if_l2(iface) == &NET_L2_GET_NAME(DUMMY)) {
dummy_interfaces[ud->dummy_if_count++] = iface;
zassert_true(ud->dummy_if_count <= 2,
"Too many dummy interfaces");
}
/* By default all interfaces are down initially */
net_if_down(iface);
ud->total_if_count++;
}
static void test_vlan_setup(void)
{
struct user_data ud = { 0 };
/* Make sure we have enough virtual interfaces */
net_if_foreach(iface_cb, &ud);
/* One extra eth interface without vlan support */
zassert_equal(ud.eth_if_count, NET_VLAN_MAX_COUNT,
"Invalid numer of VLANs %d vs %d\n",
ud.eth_if_count, NET_VLAN_MAX_COUNT);
zassert_equal(ud.total_if_count, NET_VLAN_MAX_COUNT + 1 + 2,
"Invalid numer of interfaces");
/* Put the extra non-vlan ethernet interface to last */
eth_interfaces[4] = extra_eth;
zassert_not_null(extra_eth, "Extra interface missing");
zassert_equal_ptr(net_if_l2(extra_eth), &NET_L2_GET_NAME(ETHERNET),
"Invalid L2 type %p for iface %p (should be %p)\n",
net_if_l2(extra_eth), extra_eth,
&NET_L2_GET_NAME(ETHERNET));
}
static void test_address_setup(void)
{
struct net_if_addr *ifaddr;
struct net_if *iface1, *iface2, *iface3;
iface1 = eth_interfaces[1]; /* This has VLAN enabled */
iface2 = eth_interfaces[0]; /* and this one not */
iface3 = eth_interfaces[3]; /* and this one has VLAN enabled */
zassert_not_null(iface1, "Interface 1");
zassert_not_null(iface2, "Interface 2");
zassert_not_null(iface3, "Interface 3");
ifaddr = net_if_ipv6_addr_add(iface1, &my_addr1,
NET_ADDR_MANUAL, 0);
if (!ifaddr) {
DBG("Cannot add IPv6 address %s\n",
net_sprint_ipv6_addr(&my_addr1));
zassert_not_null(ifaddr, "addr1");
}
/* For testing purposes we need to set the adddresses preferred */
ifaddr->addr_state = NET_ADDR_PREFERRED;
ifaddr = net_if_ipv6_addr_add(iface1, &ll_addr,
NET_ADDR_MANUAL, 0);
if (!ifaddr) {
DBG("Cannot add IPv6 address %s\n",
net_sprint_ipv6_addr(&ll_addr));
zassert_not_null(ifaddr, "ll_addr");
}
ifaddr->addr_state = NET_ADDR_PREFERRED;
ifaddr = net_if_ipv6_addr_add(iface2, &my_addr2,
NET_ADDR_MANUAL, 0);
if (!ifaddr) {
DBG("Cannot add IPv6 address %s\n",
net_sprint_ipv6_addr(&my_addr2));
zassert_not_null(ifaddr, "addr2");
}
ifaddr->addr_state = NET_ADDR_PREFERRED;
ifaddr = net_if_ipv6_addr_add(iface3, &my_addr3,
NET_ADDR_MANUAL, 0);
if (!ifaddr) {
DBG("Cannot add IPv6 address %s\n",
net_sprint_ipv6_addr(&my_addr3));
zassert_not_null(ifaddr, "addr3");
}
net_if_up(iface1);
net_if_up(iface2);
net_if_up(iface3);
/* The interface might receive data which might fail the checks
* in the iface sending function, so we need to reset the failure
* flag.
*/
test_failed = false;
}
static void test_vlan_tci(void)
{
struct net_pkt *pkt;
u16_t tci;
u16_t tag;
u8_t priority;
bool dei;
pkt = net_pkt_alloc(K_FOREVER);
tag = NET_VLAN_TAG_UNSPEC;
net_pkt_set_vlan_tag(pkt, tag);
priority = 0U;
net_pkt_set_vlan_priority(pkt, priority);
zassert_equal(net_pkt_vlan_tag(pkt), NET_VLAN_TAG_UNSPEC,
"invalid VLAN tag unspec");
zassert_equal(net_pkt_vlan_priority(pkt), priority,
"invalid VLAN priority");
net_pkt_set_vlan_tag(pkt, 0);
zassert_equal(net_pkt_vlan_tag(pkt), 0, "invalid VLAN tag");
/* TCI should be zero now */
zassert_equal(net_pkt_vlan_tci(pkt), 0, "invalid VLAN TCI");
priority = 1U;
net_pkt_set_vlan_priority(pkt, priority);
zassert_equal(net_pkt_vlan_priority(pkt), priority,
"invalid VLAN priority");
net_pkt_set_vlan_tag(pkt, tag);
zassert_equal(net_pkt_vlan_tag(pkt), NET_VLAN_TAG_UNSPEC,
"invalid VLAN tag unspec");
zassert_equal(net_pkt_vlan_priority(pkt), priority,
"invalid VLAN priority");
net_pkt_set_vlan_tag(pkt, 0);
zassert_equal(net_pkt_vlan_priority(pkt), priority,
"invalid VLAN priority");
dei = true;
net_pkt_set_vlan_dei(pkt, dei);
zassert_equal(net_pkt_vlan_dei(pkt), dei, "invalid VLAN DEI");
zassert_equal(net_pkt_vlan_priority(pkt), priority,
"invalid VLAN priority");
zassert_equal(net_pkt_vlan_tag(pkt), 0, "invalid VLAN tag");
net_pkt_set_vlan_tag(pkt, tag);
zassert_equal(net_pkt_vlan_tag(pkt), tag, "invalid VLAN tag");
zassert_equal(net_pkt_vlan_dei(pkt), dei, "invalid VLAN DEI");
zassert_equal(net_pkt_vlan_priority(pkt), priority,
"invalid VLAN priority");
dei = false;
net_pkt_set_vlan_dei(pkt, dei);
zassert_equal(net_pkt_vlan_tag(pkt), tag, "invalid VLAN tag");
zassert_equal(net_pkt_vlan_dei(pkt), dei, "invalid VLAN DEI");
zassert_equal(net_pkt_vlan_priority(pkt), priority,
"invalid VLAN priority");
tag = 0U;
net_pkt_set_vlan_tag(pkt, tag);
zassert_equal(net_pkt_vlan_tag(pkt), tag, "invalid VLAN tag");
zassert_equal(net_pkt_vlan_dei(pkt), dei, "invalid VLAN DEI");
zassert_equal(net_pkt_vlan_priority(pkt), priority,
"invalid VLAN priority");
priority = 0U;
net_pkt_set_vlan_priority(pkt, priority);
zassert_equal(net_pkt_vlan_tag(pkt), tag, "invalid VLAN tag");
zassert_equal(net_pkt_vlan_dei(pkt), dei, "invalid VLAN DEI");
zassert_equal(net_pkt_vlan_priority(pkt), priority,
"invalid VLAN priority");
zassert_equal(net_pkt_vlan_tci(pkt), 0, "invalid VLAN TCI");
tci = 0U;
tag = 100U;
priority = 3U;
tci = net_eth_vlan_set_vid(tci, tag);
tci = net_eth_vlan_set_pcp(tci, priority);
zassert_equal(tag, net_eth_vlan_get_vid(tci), "Invalid VLAN tag");
zassert_equal(priority, net_eth_vlan_get_pcp(tci),
"Invalid VLAN priority");
net_pkt_unref(pkt);
}
/* Enable two VLAN tags and verity that proper interfaces are enabled.
*/
static void test_vlan_enable(void)
{
struct ethernet_context *eth_ctx;
struct net_if *iface;
int ret;
ret = net_eth_vlan_enable(eth_interfaces[1], VLAN_TAG_1);
zassert_equal(ret, 0, "Cannot enable %d (%d)\n", VLAN_TAG_1, ret);
ret = net_eth_vlan_enable(eth_interfaces[3], VLAN_TAG_2);
zassert_equal(ret, 0, "Cannot enable %d (%d)\n", VLAN_TAG_2, ret);
eth_ctx = net_if_l2_data(eth_interfaces[0]);
iface = net_eth_get_vlan_iface(eth_interfaces[0], VLAN_TAG_1);
zassert_equal_ptr(iface, eth_interfaces[1],
"Invalid interface for tag %d (%p vs %p)\n",
VLAN_TAG_1, iface, eth_interfaces[1]);
iface = net_eth_get_vlan_iface(eth_interfaces[0], VLAN_TAG_2);
zassert_equal_ptr(iface, eth_interfaces[3],
"Invalid interface for tag %d (%p vs %p)\n",
VLAN_TAG_2, iface, eth_interfaces[3]);
ret = net_eth_is_vlan_enabled(eth_ctx, eth_interfaces[0]);
zassert_equal(ret, false, "VLAN enabled for interface 0");
ret = net_eth_is_vlan_enabled(eth_ctx, eth_interfaces[1]);
zassert_equal(ret, true, "VLAN disabled for interface 1");
ret = net_eth_is_vlan_enabled(eth_ctx, eth_interfaces[2]);
zassert_equal(ret, false, "VLAN enabled for interface 2");
ret = net_eth_is_vlan_enabled(eth_ctx, eth_interfaces[3]);
zassert_equal(ret, true, "VLAN disabled for interface 3");
iface = eth_interfaces[0];
ret = net_eth_vlan_enable(iface, NET_VLAN_TAG_UNSPEC);
zassert_equal(ret, -EBADF, "Invalid VLAN tag value %d\n", ret);
iface = eth_interfaces[1];
ret = net_eth_vlan_enable(iface, VLAN_TAG_1);
zassert_equal(ret, -EALREADY, "VLAN tag %d enabled for iface 1\n",
VLAN_TAG_1);
}
static void test_vlan_disable(void)
{
struct ethernet_context *eth_ctx;
struct net_if *iface;
int ret;
ret = net_eth_vlan_disable(eth_interfaces[1], VLAN_TAG_1);
zassert_equal(ret, 0, "Cannot disable %d (%d)\n", VLAN_TAG_1, ret);
ret = net_eth_vlan_disable(eth_interfaces[3], VLAN_TAG_2);
zassert_equal(ret, 0, "Cannot disable %d (%d)\n", VLAN_TAG_2, ret);
eth_ctx = net_if_l2_data(eth_interfaces[0]);
iface = net_eth_get_vlan_iface(eth_interfaces[0], VLAN_TAG_1);
zassert_equal_ptr(iface, eth_interfaces[0],
"Invalid interface for tag %d (%p vs %p)\n",
VLAN_TAG_1, iface, eth_interfaces[0]);
iface = net_eth_get_vlan_iface(eth_interfaces[0], VLAN_TAG_2);
zassert_equal_ptr(iface, eth_interfaces[0],
"Invalid interface for tag %d (%p vs %p)\n",
VLAN_TAG_2, iface, eth_interfaces[0]);
ret = net_eth_is_vlan_enabled(eth_ctx, eth_interfaces[0]);
zassert_equal(ret, false, "VLAN enabled for interface 0");
ret = net_eth_is_vlan_enabled(eth_ctx, eth_interfaces[1]);
zassert_equal(ret, false, "VLAN enabled for interface 1");
ret = net_eth_is_vlan_enabled(eth_ctx, eth_interfaces[2]);
zassert_equal(ret, false, "VLAN enabled for interface 2");
ret = net_eth_is_vlan_enabled(eth_ctx, eth_interfaces[3]);
zassert_equal(ret, false, "VLAN enabled for interface 3");
iface = eth_interfaces[0];
ret = net_eth_vlan_disable(iface, NET_VLAN_TAG_UNSPEC);
zassert_equal(ret, -EBADF, "Invalid VLAN tag value %d\n", ret);
iface = eth_interfaces[1];
ret = net_eth_vlan_disable(iface, VLAN_TAG_1);
zassert_equal(ret, -ESRCH, "VLAN tag %d disabled for iface 1\n",
VLAN_TAG_1);
}
static void test_vlan_enable_all(void)
{
struct ethernet_context *eth_ctx;
struct net_if *iface;
int ret;
ret = net_eth_vlan_enable(eth_interfaces[0], VLAN_TAG_1);
zassert_equal(ret, 0, "Cannot enable %d\n", VLAN_TAG_1);
ret = net_eth_vlan_enable(eth_interfaces[1], VLAN_TAG_2);
zassert_equal(ret, 0, "Cannot enable %d\n", VLAN_TAG_2);
ret = net_eth_vlan_enable(eth_interfaces[2], VLAN_TAG_3);
zassert_equal(ret, 0, "Cannot enable %d\n", VLAN_TAG_3);
ret = net_eth_vlan_enable(eth_interfaces[3], VLAN_TAG_4);
zassert_equal(ret, 0, "Cannot enable %d\n", VLAN_TAG_4);
eth_ctx = net_if_l2_data(eth_interfaces[0]);
ret = net_eth_is_vlan_enabled(eth_ctx, eth_interfaces[0]);
zassert_equal(ret, true, "VLAN disabled for interface 0");
ret = net_eth_is_vlan_enabled(eth_ctx, eth_interfaces[1]);
zassert_equal(ret, true, "VLAN disabled for interface 1");
ret = net_eth_is_vlan_enabled(eth_ctx, eth_interfaces[2]);
zassert_equal(ret, true, "VLAN disabled for interface 2");
ret = net_eth_is_vlan_enabled(eth_ctx, eth_interfaces[3]);
zassert_equal(ret, true, "VLAN disabled for interface 3");
iface = net_if_get_first_by_type(&NET_L2_GET_NAME(DUMMY));
zassert_not_null(iface, "No dummy iface found");
zassert_equal(net_if_l2(iface), &NET_L2_GET_NAME(DUMMY),
"Not a dummy interface");
ret = net_eth_vlan_enable(iface, VLAN_TAG_5);
zassert_equal(ret, -EINVAL, "Wrong iface type (%d)\n", ret);
}
static void test_vlan_disable_all(void)
{
struct ethernet_context *eth_ctx;
struct net_if *iface;
int ret;
ret = net_eth_vlan_disable(eth_interfaces[0], VLAN_TAG_1);
zassert_equal(ret, 0, "Cannot disable %d\n", VLAN_TAG_1);
ret = net_eth_vlan_disable(eth_interfaces[1], VLAN_TAG_2);
zassert_equal(ret, 0, "Cannot disable %d\n", VLAN_TAG_2);
ret = net_eth_vlan_disable(eth_interfaces[2], VLAN_TAG_3);
zassert_equal(ret, 0, "Cannot disable %d\n", VLAN_TAG_3);
ret = net_eth_vlan_disable(eth_interfaces[3], VLAN_TAG_4);
zassert_equal(ret, 0, "Cannot disable %d\n", VLAN_TAG_4);
eth_ctx = net_if_l2_data(eth_interfaces[0]);
ret = net_eth_is_vlan_enabled(eth_ctx, eth_interfaces[0]);
zassert_equal(ret, false, "VLAN enabled for interface 0");
ret = net_eth_is_vlan_enabled(eth_ctx, eth_interfaces[1]);
zassert_equal(ret, false, "VLAN enabled for interface 1");
ret = net_eth_is_vlan_enabled(eth_ctx, eth_interfaces[2]);
zassert_equal(ret, false, "VLAN enabled for interface 2");
ret = net_eth_is_vlan_enabled(eth_ctx, eth_interfaces[3]);
zassert_equal(ret, false, "VLAN enabled for interface 3");
iface = net_if_get_first_by_type(&NET_L2_GET_NAME(DUMMY));
zassert_not_null(iface, "No dummy iface found");
zassert_equal(net_if_l2(iface), &NET_L2_GET_NAME(DUMMY),
"Not a dummy interface");
ret = net_eth_vlan_disable(iface, VLAN_TAG_5);
zassert_equal(ret, -EINVAL, "Wrong iface type (%d)\n", ret);
}
static bool add_neighbor(struct net_if *iface, struct in6_addr *addr)
{
struct net_linkaddr_storage llstorage;
struct net_linkaddr lladdr;
struct net_nbr *nbr;
llstorage.addr[0] = 0x01;
llstorage.addr[1] = 0x02;
llstorage.addr[2] = 0x33;
llstorage.addr[3] = 0x44;
llstorage.addr[4] = 0x05;
llstorage.addr[5] = 0x06;
lladdr.len = 6U;
lladdr.addr = llstorage.addr;
lladdr.type = NET_LINK_ETHERNET;
nbr = net_ipv6_nbr_add(iface, addr, &lladdr, false,
NET_IPV6_NBR_STATE_REACHABLE);
if (!nbr) {
DBG("Cannot add dst %s to neighbor cache\n",
net_sprint_ipv6_addr(addr));
return false;
}
return true;
}
static void test_vlan_send_data(void)
{
struct ethernet_context *eth_ctx; /* This is L2 context */
struct eth_context *ctx; /* This is interface context */
struct net_if *iface;
int ret;
struct sockaddr_in6 dst_addr6 = {
.sin6_family = AF_INET6,
.sin6_port = htons(PORT),
};
struct sockaddr_in6 src_addr6 = {
.sin6_family = AF_INET6,
.sin6_port = 0,
};
/* Setup the interfaces */
test_vlan_enable();
ret = net_context_get(AF_INET6, SOCK_DGRAM, IPPROTO_UDP,
&udp_v6_ctx);
zassert_equal(ret, 0, "Create IPv6 UDP context failed");
memcpy(&src_addr6.sin6_addr, &my_addr1, sizeof(struct in6_addr));
memcpy(&dst_addr6.sin6_addr, &dst_addr, sizeof(struct in6_addr));
ret = net_context_bind(udp_v6_ctx, (struct sockaddr *)&src_addr6,
sizeof(struct sockaddr_in6));
zassert_equal(ret, 0, "Context bind failure test failed");
iface = eth_interfaces[1]; /* This is the VLAN interface */
ctx = net_if_get_device(iface)->driver_data;
eth_ctx = net_if_l2_data(iface);
ret = net_eth_is_vlan_enabled(eth_ctx, iface);
zassert_equal(ret, true, "VLAN disabled for interface 1");
ctx->expecting_tag = VLAN_TAG_1;
iface = eth_interfaces[3]; /* This is also VLAN interface */
ctx = net_if_get_device(iface)->driver_data;
eth_ctx = net_if_l2_data(iface);
ret = net_eth_is_vlan_enabled(eth_ctx, iface);
zassert_equal(ret, true, "VLAN disabled for interface 1");
test_started = true;
ret = add_neighbor(iface, &dst_addr);
zassert_true(ret, "Cannot add neighbor");
ret = net_context_sendto(udp_v6_ctx, test_data, strlen(test_data),
(struct sockaddr *)&dst_addr6,
sizeof(struct sockaddr_in6),
NULL, K_NO_WAIT, NULL);
zassert_true(ret > 0, "Send UDP pkt failed");
if (k_sem_take(&wait_data, WAIT_TIME)) {
DBG("Timeout while waiting interface data\n");
zassert_false(true, "Timeout");
}
net_context_unref(udp_v6_ctx);
}
void test_main(void)
{
ztest_test_suite(net_vlan_test,
ztest_unit_test(test_vlan_setup),
ztest_unit_test(test_address_setup),
ztest_unit_test(test_vlan_tci),
ztest_unit_test(test_vlan_enable),
ztest_unit_test(test_vlan_disable),
ztest_unit_test(test_vlan_enable_all),
ztest_unit_test(test_vlan_disable_all),
ztest_unit_test(test_vlan_send_data)
);
ztest_run_test_suite(net_vlan_test);
}
