Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 | /* * Copyright (c) 2015 Intel Corporation * Copyright (c) 2017 Linaro Limited * * SPDX-License-Identifier: Apache-2.0 */ /** * @file * * Network loopback interface implementation. */ #define LOG_MODULE_NAME netlo #define LOG_LEVEL CONFIG_NET_LOOPBACK_LOG_LEVEL #include <logging/log.h> LOG_MODULE_REGISTER(LOG_MODULE_NAME); #include <net/net_pkt.h> #include <net/buf.h> #include <net/net_ip.h> #include <net/net_if.h> #include <net/dummy.h> int loopback_dev_init(struct device *dev) { ARG_UNUSED(dev); return 0; } static void loopback_init(struct net_if *iface) { /* RFC 7042, s.2.1.1. address to use in documentation */ net_if_set_link_addr(iface, "\x00\x00\x5e\x00\x53\xff", 6, NET_LINK_DUMMY); } static int loopback_send(struct device *dev, struct net_pkt *pkt) { struct net_pkt *cloned; int res; ARG_UNUSED(dev); if (!pkt->frags) { LOG_ERR("No data to send"); return -ENODATA; } /* We need to swap the IP addresses because otherwise * the packet will be dropped. */ if (net_pkt_family(pkt) == AF_INET6) { struct in6_addr addr; net_ipaddr_copy(&addr, &NET_IPV6_HDR(pkt)->src); net_ipaddr_copy(&NET_IPV6_HDR(pkt)->src, &NET_IPV6_HDR(pkt)->dst); net_ipaddr_copy(&NET_IPV6_HDR(pkt)->dst, &addr); } else { struct in_addr addr; net_ipaddr_copy(&addr, &NET_IPV4_HDR(pkt)->src); net_ipaddr_copy(&NET_IPV4_HDR(pkt)->src, &NET_IPV4_HDR(pkt)->dst); net_ipaddr_copy(&NET_IPV4_HDR(pkt)->dst, &addr); } /* We should simulate normal driver meaning that if the packet is * properly sent (which is always in this driver), then the packet * must be dropped. This is very much needed for TCP packets where * the packet is reference counted in various stages of sending. */ cloned = net_pkt_clone(pkt, K_MSEC(100)); if (!cloned) { res = -ENOMEM; goto out; } res = net_recv_data(net_pkt_iface(cloned), cloned); if (res < 0) { LOG_ERR("Data receive failed."); } out: /* Let the receiving thread run now */ k_yield(); return res; } static struct dummy_api loopback_api = { .iface_api.init = loopback_init, .send = loopback_send, }; NET_DEVICE_INIT(loopback, "lo", loopback_dev_init, NULL, NULL, CONFIG_KERNEL_INIT_PRIORITY_DEFAULT, &loopback_api, DUMMY_L2, NET_L2_GET_CTX_TYPE(DUMMY_L2), 536); |