Davide Pesavento | 44deacc | 2014-02-19 10:48:07 +0100 | [diff] [blame] | 1 | /* -*- Mode:C++; c-file-style:"gnu"; indent-tabs-mode:nil; -*- */ |
Junxiao Shi | 0d82d04 | 2017-07-07 06:15:27 +0000 | [diff] [blame] | 2 | /* |
Eric Newberry | f3ee808 | 2020-01-28 13:44:18 -0800 | [diff] [blame] | 3 | * Copyright (c) 2014-2020, Regents of the University of California, |
Alexander Afanasyev | 319f2c8 | 2015-01-07 14:56:53 -0800 | [diff] [blame] | 4 | * Arizona Board of Regents, |
| 5 | * Colorado State University, |
| 6 | * University Pierre & Marie Curie, Sorbonne University, |
| 7 | * Washington University in St. Louis, |
| 8 | * Beijing Institute of Technology, |
| 9 | * The University of Memphis. |
Alexander Afanasyev | 9bcbc7c | 2014-04-06 19:37:37 -0700 | [diff] [blame] | 10 | * |
| 11 | * This file is part of NFD (Named Data Networking Forwarding Daemon). |
| 12 | * See AUTHORS.md for complete list of NFD authors and contributors. |
| 13 | * |
| 14 | * NFD is free software: you can redistribute it and/or modify it under the terms |
| 15 | * of the GNU General Public License as published by the Free Software Foundation, |
| 16 | * either version 3 of the License, or (at your option) any later version. |
| 17 | * |
| 18 | * NFD is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; |
| 19 | * without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR |
| 20 | * PURPOSE. See the GNU General Public License for more details. |
| 21 | * |
| 22 | * You should have received a copy of the GNU General Public License along with |
| 23 | * NFD, e.g., in COPYING.md file. If not, see <http://www.gnu.org/licenses/>. |
Junxiao Shi | 3ffe66d | 2014-11-06 15:37:59 -0700 | [diff] [blame] | 24 | */ |
Davide Pesavento | 44deacc | 2014-02-19 10:48:07 +0100 | [diff] [blame] | 25 | |
Davide Pesavento | 35120ea | 2015-11-17 21:13:18 +0100 | [diff] [blame] | 26 | #include "ethernet-transport.hpp" |
Davide Pesavento | 43ff2a9 | 2017-05-18 19:50:57 -0400 | [diff] [blame] | 27 | #include "ethernet-protocol.hpp" |
Davide Pesavento | 2cae8ca | 2019-04-18 20:48:05 -0400 | [diff] [blame] | 28 | #include "common/global.hpp" |
Davide Pesavento | 44deacc | 2014-02-19 10:48:07 +0100 | [diff] [blame] | 29 | |
| 30 | #include <pcap/pcap.h> |
| 31 | |
Davide Pesavento | 457f135 | 2018-07-14 17:17:38 -0400 | [diff] [blame] | 32 | #include <cstring> // for memcpy() |
| 33 | |
| 34 | #include <boost/endian/conversion.hpp> |
Alexander Afanasyev | d9479aa | 2014-06-26 13:52:02 -0700 | [diff] [blame] | 35 | |
Davide Pesavento | 44deacc | 2014-02-19 10:48:07 +0100 | [diff] [blame] | 36 | namespace nfd { |
Davide Pesavento | 35120ea | 2015-11-17 21:13:18 +0100 | [diff] [blame] | 37 | namespace face { |
Davide Pesavento | 44deacc | 2014-02-19 10:48:07 +0100 | [diff] [blame] | 38 | |
Davide Pesavento | a314808 | 2018-04-12 18:21:54 -0400 | [diff] [blame] | 39 | NFD_LOG_INIT(EthernetTransport); |
Davide Pesavento | 44deacc | 2014-02-19 10:48:07 +0100 | [diff] [blame] | 40 | |
Junxiao Shi | 0d82d04 | 2017-07-07 06:15:27 +0000 | [diff] [blame] | 41 | EthernetTransport::EthernetTransport(const ndn::net::NetworkInterface& localEndpoint, |
Davide Pesavento | 6bd6d0b | 2017-03-25 15:16:40 -0400 | [diff] [blame] | 42 | const ethernet::Address& remoteEndpoint) |
Davide Pesavento | fe0580c | 2017-05-12 02:02:10 -0400 | [diff] [blame] | 43 | : m_socket(getGlobalIoService()) |
Junxiao Shi | 0d82d04 | 2017-07-07 06:15:27 +0000 | [diff] [blame] | 44 | , m_pcap(localEndpoint.getName()) |
| 45 | , m_srcAddress(localEndpoint.getEthernetAddress()) |
Davide Pesavento | 6bd6d0b | 2017-03-25 15:16:40 -0400 | [diff] [blame] | 46 | , m_destAddress(remoteEndpoint) |
Junxiao Shi | 0d82d04 | 2017-07-07 06:15:27 +0000 | [diff] [blame] | 47 | , m_interfaceName(localEndpoint.getName()) |
Davide Pesavento | 0b0a71d | 2017-07-02 13:57:36 -0400 | [diff] [blame] | 48 | , m_hasRecentlyReceived(false) |
Davide Pesavento | 9a090a0 | 2015-01-29 18:15:26 +0100 | [diff] [blame] | 49 | #ifdef _DEBUG |
| 50 | , m_nDropped(0) |
| 51 | #endif |
Davide Pesavento | 44deacc | 2014-02-19 10:48:07 +0100 | [diff] [blame] | 52 | { |
Davide Pesavento | fe0580c | 2017-05-12 02:02:10 -0400 | [diff] [blame] | 53 | try { |
| 54 | m_pcap.activate(DLT_EN10MB); |
| 55 | m_socket.assign(m_pcap.getFd()); |
| 56 | } |
| 57 | catch (const PcapHelper::Error& e) { |
Davide Pesavento | 19779d8 | 2019-02-14 13:40:04 -0500 | [diff] [blame] | 58 | NDN_THROW_NESTED(Error(e.what())); |
Davide Pesavento | fe0580c | 2017-05-12 02:02:10 -0400 | [diff] [blame] | 59 | } |
Davide Pesavento | 44deacc | 2014-02-19 10:48:07 +0100 | [diff] [blame] | 60 | |
Eric Newberry | feeb918 | 2020-03-29 00:28:41 -0700 | [diff] [blame^] | 61 | // Set initial transport state based upon the state of the underlying NetworkInterface |
| 62 | handleNetifStateChange(localEndpoint.getState()); |
| 63 | |
Eric Newberry | f3ee808 | 2020-01-28 13:44:18 -0800 | [diff] [blame] | 64 | m_netifStateChangedConn = localEndpoint.onStateChanged.connect( |
| 65 | [this] (ndn::net::InterfaceState, ndn::net::InterfaceState newState) { |
Junxiao Shi | fbdd5ce | 2018-11-26 15:10:51 +0000 | [diff] [blame] | 66 | handleNetifStateChange(newState); |
| 67 | }); |
| 68 | |
Eric Newberry | f3ee808 | 2020-01-28 13:44:18 -0800 | [diff] [blame] | 69 | m_netifMtuChangedConn = localEndpoint.onMtuChanged.connect( |
| 70 | [this] (uint32_t, uint32_t mtu) { |
| 71 | setMtu(mtu); |
| 72 | }); |
| 73 | |
Davide Pesavento | 43ff2a9 | 2017-05-18 19:50:57 -0400 | [diff] [blame] | 74 | asyncRead(); |
Davide Pesavento | 44deacc | 2014-02-19 10:48:07 +0100 | [diff] [blame] | 75 | } |
| 76 | |
Davide Pesavento | 6bd6d0b | 2017-03-25 15:16:40 -0400 | [diff] [blame] | 77 | void |
Davide Pesavento | 6bd6d0b | 2017-03-25 15:16:40 -0400 | [diff] [blame] | 78 | EthernetTransport::doClose() |
Davide Pesavento | 44deacc | 2014-02-19 10:48:07 +0100 | [diff] [blame] | 79 | { |
Davide Pesavento | 35120ea | 2015-11-17 21:13:18 +0100 | [diff] [blame] | 80 | NFD_LOG_FACE_TRACE(__func__); |
Alexander Afanasyev | 251f3c1 | 2014-06-02 18:39:58 +0300 | [diff] [blame] | 81 | |
Davide Pesavento | 35120ea | 2015-11-17 21:13:18 +0100 | [diff] [blame] | 82 | if (m_socket.is_open()) { |
| 83 | // Cancel all outstanding operations and close the socket. |
| 84 | // Use the non-throwing variants and ignore errors, if any. |
| 85 | boost::system::error_code error; |
| 86 | m_socket.cancel(error); |
| 87 | m_socket.close(error); |
| 88 | } |
Davide Pesavento | fe0580c | 2017-05-12 02:02:10 -0400 | [diff] [blame] | 89 | m_pcap.close(); |
Davide Pesavento | 7726ae5 | 2014-11-23 21:01:05 +0100 | [diff] [blame] | 90 | |
Davide Pesavento | 35120ea | 2015-11-17 21:13:18 +0100 | [diff] [blame] | 91 | // Ensure that the Transport stays alive at least |
| 92 | // until all pending handlers are dispatched |
| 93 | getGlobalIoService().post([this] { |
| 94 | this->setState(TransportState::CLOSED); |
| 95 | }); |
Davide Pesavento | 44deacc | 2014-02-19 10:48:07 +0100 | [diff] [blame] | 96 | } |
| 97 | |
| 98 | void |
Junxiao Shi | fbdd5ce | 2018-11-26 15:10:51 +0000 | [diff] [blame] | 99 | EthernetTransport::handleNetifStateChange(ndn::net::InterfaceState netifState) |
| 100 | { |
| 101 | NFD_LOG_FACE_TRACE("netif is " << netifState); |
| 102 | if (netifState == ndn::net::InterfaceState::RUNNING) { |
| 103 | if (getState() == TransportState::DOWN) { |
| 104 | this->setState(TransportState::UP); |
| 105 | } |
| 106 | } |
| 107 | else if (getState() == TransportState::UP) { |
| 108 | this->setState(TransportState::DOWN); |
| 109 | } |
| 110 | } |
| 111 | |
| 112 | void |
Davide Pesavento | b3a23ca | 2019-05-04 20:40:21 -0400 | [diff] [blame] | 113 | EthernetTransport::doSend(const Block& packet, const EndpointId&) |
Davide Pesavento | 44deacc | 2014-02-19 10:48:07 +0100 | [diff] [blame] | 114 | { |
Davide Pesavento | fe0580c | 2017-05-12 02:02:10 -0400 | [diff] [blame] | 115 | NFD_LOG_FACE_TRACE(__func__); |
Davide Pesavento | 44deacc | 2014-02-19 10:48:07 +0100 | [diff] [blame] | 116 | |
Davide Pesavento | b3a23ca | 2019-05-04 20:40:21 -0400 | [diff] [blame] | 117 | sendPacket(packet); |
Davide Pesavento | 44deacc | 2014-02-19 10:48:07 +0100 | [diff] [blame] | 118 | } |
| 119 | |
Davide Pesavento | 10783f2 | 2014-03-15 04:40:01 +0100 | [diff] [blame] | 120 | void |
Davide Pesavento | 35120ea | 2015-11-17 21:13:18 +0100 | [diff] [blame] | 121 | EthernetTransport::sendPacket(const ndn::Block& block) |
Davide Pesavento | 44deacc | 2014-02-19 10:48:07 +0100 | [diff] [blame] | 122 | { |
Davide Pesavento | 44deacc | 2014-02-19 10:48:07 +0100 | [diff] [blame] | 123 | ndn::EncodingBuffer buffer(block); |
| 124 | |
Davide Pesavento | e463100 | 2014-03-21 20:55:36 +0100 | [diff] [blame] | 125 | // pad with zeroes if the payload is too short |
Davide Pesavento | 35120ea | 2015-11-17 21:13:18 +0100 | [diff] [blame] | 126 | if (block.size() < ethernet::MIN_DATA_LEN) { |
| 127 | static const uint8_t padding[ethernet::MIN_DATA_LEN] = {}; |
| 128 | buffer.appendByteArray(padding, ethernet::MIN_DATA_LEN - block.size()); |
| 129 | } |
Davide Pesavento | 44deacc | 2014-02-19 10:48:07 +0100 | [diff] [blame] | 130 | |
| 131 | // construct and prepend the ethernet header |
Davide Pesavento | 457f135 | 2018-07-14 17:17:38 -0400 | [diff] [blame] | 132 | uint16_t ethertype = boost::endian::native_to_big(ethernet::ETHERTYPE_NDN); |
Davide Pesavento | 44deacc | 2014-02-19 10:48:07 +0100 | [diff] [blame] | 133 | buffer.prependByteArray(reinterpret_cast<const uint8_t*>(ðertype), ethernet::TYPE_LEN); |
Davide Pesavento | b60cc12 | 2014-03-19 19:26:02 +0100 | [diff] [blame] | 134 | buffer.prependByteArray(m_srcAddress.data(), m_srcAddress.size()); |
Davide Pesavento | 44deacc | 2014-02-19 10:48:07 +0100 | [diff] [blame] | 135 | buffer.prependByteArray(m_destAddress.data(), m_destAddress.size()); |
| 136 | |
Davide Pesavento | 43ff2a9 | 2017-05-18 19:50:57 -0400 | [diff] [blame] | 137 | // send the frame |
Davide Pesavento | fe0580c | 2017-05-12 02:02:10 -0400 | [diff] [blame] | 138 | int sent = pcap_inject(m_pcap, buffer.buf(), buffer.size()); |
Davide Pesavento | 44deacc | 2014-02-19 10:48:07 +0100 | [diff] [blame] | 139 | if (sent < 0) |
Davide Pesavento | 1816d4b | 2017-07-02 12:20:48 -0400 | [diff] [blame] | 140 | handleError("Send operation failed: " + m_pcap.getLastError()); |
Davide Pesavento | 44deacc | 2014-02-19 10:48:07 +0100 | [diff] [blame] | 141 | else if (static_cast<size_t>(sent) < buffer.size()) |
Davide Pesavento | 1816d4b | 2017-07-02 12:20:48 -0400 | [diff] [blame] | 142 | handleError("Failed to send the full frame: size=" + to_string(buffer.size()) + |
| 143 | " sent=" + to_string(sent)); |
Davide Pesavento | 35120ea | 2015-11-17 21:13:18 +0100 | [diff] [blame] | 144 | else |
| 145 | // print block size because we don't want to count the padding in buffer |
| 146 | NFD_LOG_FACE_TRACE("Successfully sent: " << block.size() << " bytes"); |
Davide Pesavento | 44deacc | 2014-02-19 10:48:07 +0100 | [diff] [blame] | 147 | } |
| 148 | |
| 149 | void |
Davide Pesavento | 43ff2a9 | 2017-05-18 19:50:57 -0400 | [diff] [blame] | 150 | EthernetTransport::asyncRead() |
| 151 | { |
| 152 | m_socket.async_read_some(boost::asio::null_buffers(), |
Davide Pesavento | e4b2238 | 2018-06-10 14:37:24 -0400 | [diff] [blame] | 153 | [this] (const auto& e, auto) { this->handleRead(e); }); |
Davide Pesavento | 43ff2a9 | 2017-05-18 19:50:57 -0400 | [diff] [blame] | 154 | } |
| 155 | |
| 156 | void |
| 157 | EthernetTransport::handleRead(const boost::system::error_code& error) |
Davide Pesavento | 44deacc | 2014-02-19 10:48:07 +0100 | [diff] [blame] | 158 | { |
Davide Pesavento | 1816d4b | 2017-07-02 12:20:48 -0400 | [diff] [blame] | 159 | if (error) { |
| 160 | // boost::asio::error::operation_aborted must be checked first: in that case, the Transport |
| 161 | // may already have been destructed, therefore it's unsafe to call getState() or do logging. |
| 162 | if (error != boost::asio::error::operation_aborted && |
| 163 | getState() != TransportState::CLOSING && |
| 164 | getState() != TransportState::FAILED && |
| 165 | getState() != TransportState::CLOSED) { |
| 166 | handleError("Receive operation failed: " + error.message()); |
| 167 | } |
| 168 | return; |
| 169 | } |
Davide Pesavento | 44deacc | 2014-02-19 10:48:07 +0100 | [diff] [blame] | 170 | |
Davide Pesavento | fe0580c | 2017-05-12 02:02:10 -0400 | [diff] [blame] | 171 | const uint8_t* pkt; |
| 172 | size_t len; |
| 173 | std::string err; |
| 174 | std::tie(pkt, len, err) = m_pcap.readNextPacket(); |
Davide Pesavento | 35120ea | 2015-11-17 21:13:18 +0100 | [diff] [blame] | 175 | |
Davide Pesavento | 43ff2a9 | 2017-05-18 19:50:57 -0400 | [diff] [blame] | 176 | if (pkt == nullptr) { |
Davide Pesavento | 1816d4b | 2017-07-02 12:20:48 -0400 | [diff] [blame] | 177 | NFD_LOG_FACE_WARN("Read error: " << err); |
Davide Pesavento | 43ff2a9 | 2017-05-18 19:50:57 -0400 | [diff] [blame] | 178 | } |
| 179 | else { |
| 180 | const ether_header* eh; |
| 181 | std::tie(eh, err) = ethernet::checkFrameHeader(pkt, len, m_srcAddress, |
| 182 | m_destAddress.isMulticast() ? m_destAddress : m_srcAddress); |
| 183 | if (eh == nullptr) { |
Davide Pesavento | 1816d4b | 2017-07-02 12:20:48 -0400 | [diff] [blame] | 184 | NFD_LOG_FACE_WARN(err); |
Davide Pesavento | 43ff2a9 | 2017-05-18 19:50:57 -0400 | [diff] [blame] | 185 | } |
| 186 | else { |
| 187 | ethernet::Address sender(eh->ether_shost); |
| 188 | pkt += ethernet::HDR_LEN; |
| 189 | len -= ethernet::HDR_LEN; |
| 190 | receivePayload(pkt, len, sender); |
| 191 | } |
| 192 | } |
Davide Pesavento | 44deacc | 2014-02-19 10:48:07 +0100 | [diff] [blame] | 193 | |
Davide Pesavento | 9a090a0 | 2015-01-29 18:15:26 +0100 | [diff] [blame] | 194 | #ifdef _DEBUG |
Davide Pesavento | fe0580c | 2017-05-12 02:02:10 -0400 | [diff] [blame] | 195 | size_t nDropped = m_pcap.getNDropped(); |
| 196 | if (nDropped - m_nDropped > 0) |
Davide Pesavento | 43ff2a9 | 2017-05-18 19:50:57 -0400 | [diff] [blame] | 197 | NFD_LOG_FACE_DEBUG("Detected " << nDropped - m_nDropped << " dropped frame(s)"); |
Davide Pesavento | fe0580c | 2017-05-12 02:02:10 -0400 | [diff] [blame] | 198 | m_nDropped = nDropped; |
Davide Pesavento | 9a090a0 | 2015-01-29 18:15:26 +0100 | [diff] [blame] | 199 | #endif |
| 200 | |
Davide Pesavento | 43ff2a9 | 2017-05-18 19:50:57 -0400 | [diff] [blame] | 201 | asyncRead(); |
Davide Pesavento | 44deacc | 2014-02-19 10:48:07 +0100 | [diff] [blame] | 202 | } |
| 203 | |
| 204 | void |
Davide Pesavento | 43ff2a9 | 2017-05-18 19:50:57 -0400 | [diff] [blame] | 205 | EthernetTransport::receivePayload(const uint8_t* payload, size_t length, |
| 206 | const ethernet::Address& sender) |
Davide Pesavento | 44deacc | 2014-02-19 10:48:07 +0100 | [diff] [blame] | 207 | { |
Davide Pesavento | 1816d4b | 2017-07-02 12:20:48 -0400 | [diff] [blame] | 208 | NFD_LOG_FACE_TRACE("Received: " << length << " bytes from " << sender); |
| 209 | |
Junxiao Shi | 78926c9 | 2015-02-28 22:56:06 -0700 | [diff] [blame] | 210 | bool isOk = false; |
Davide Pesavento | 35120ea | 2015-11-17 21:13:18 +0100 | [diff] [blame] | 211 | Block element; |
Davide Pesavento | 43ff2a9 | 2017-05-18 19:50:57 -0400 | [diff] [blame] | 212 | std::tie(isOk, element) = Block::fromBuffer(payload, length); |
Junxiao Shi | 083f778 | 2015-02-21 12:06:26 -0700 | [diff] [blame] | 213 | if (!isOk) { |
Davide Pesavento | 1816d4b | 2017-07-02 12:20:48 -0400 | [diff] [blame] | 214 | NFD_LOG_FACE_WARN("Failed to parse incoming packet from " << sender); |
| 215 | // This packet won't extend the face lifetime |
Junxiao Shi | 083f778 | 2015-02-21 12:06:26 -0700 | [diff] [blame] | 216 | return; |
| 217 | } |
Davide Pesavento | 0b0a71d | 2017-07-02 13:57:36 -0400 | [diff] [blame] | 218 | m_hasRecentlyReceived = true; |
Matteo Sammarco | 66df974 | 2014-11-21 18:31:26 +0100 | [diff] [blame] | 219 | |
Davide Pesavento | b3a23ca | 2019-05-04 20:40:21 -0400 | [diff] [blame] | 220 | static_assert(sizeof(EndpointId) >= ethernet::ADDR_LEN, "EndpointId is too small"); |
| 221 | EndpointId endpoint = 0; |
Davide Pesavento | 43ff2a9 | 2017-05-18 19:50:57 -0400 | [diff] [blame] | 222 | if (m_destAddress.isMulticast()) { |
Davide Pesavento | b3a23ca | 2019-05-04 20:40:21 -0400 | [diff] [blame] | 223 | std::memcpy(&endpoint, sender.data(), sender.size()); |
Davide Pesavento | 43ff2a9 | 2017-05-18 19:50:57 -0400 | [diff] [blame] | 224 | } |
Davide Pesavento | b3a23ca | 2019-05-04 20:40:21 -0400 | [diff] [blame] | 225 | |
| 226 | this->receive(element, endpoint); |
Davide Pesavento | 7726ae5 | 2014-11-23 21:01:05 +0100 | [diff] [blame] | 227 | } |
| 228 | |
| 229 | void |
Davide Pesavento | 1816d4b | 2017-07-02 12:20:48 -0400 | [diff] [blame] | 230 | EthernetTransport::handleError(const std::string& errorMessage) |
Davide Pesavento | 7726ae5 | 2014-11-23 21:01:05 +0100 | [diff] [blame] | 231 | { |
Davide Pesavento | 1816d4b | 2017-07-02 12:20:48 -0400 | [diff] [blame] | 232 | if (getPersistency() == ndn::nfd::FACE_PERSISTENCY_PERMANENT) { |
| 233 | NFD_LOG_FACE_DEBUG("Permanent face ignores error: " << errorMessage); |
Davide Pesavento | 7726ae5 | 2014-11-23 21:01:05 +0100 | [diff] [blame] | 234 | return; |
Junxiao Shi | 7003c60 | 2017-01-10 13:35:28 +0000 | [diff] [blame] | 235 | } |
Davide Pesavento | 7726ae5 | 2014-11-23 21:01:05 +0100 | [diff] [blame] | 236 | |
Davide Pesavento | 1816d4b | 2017-07-02 12:20:48 -0400 | [diff] [blame] | 237 | NFD_LOG_FACE_ERROR(errorMessage); |
| 238 | this->setState(TransportState::FAILED); |
| 239 | doClose(); |
Davide Pesavento | 44deacc | 2014-02-19 10:48:07 +0100 | [diff] [blame] | 240 | } |
| 241 | |
Davide Pesavento | 35120ea | 2015-11-17 21:13:18 +0100 | [diff] [blame] | 242 | } // namespace face |
Davide Pesavento | 44deacc | 2014-02-19 10:48:07 +0100 | [diff] [blame] | 243 | } // namespace nfd |