674 lines
28 KiB
C++
674 lines
28 KiB
C++
/*
|
|
* ZeroTier One - Global Peer to Peer Ethernet
|
|
* Copyright (C) 2012-2013 ZeroTier Networks LLC
|
|
*
|
|
* This program is free software: you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation, either version 3 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program 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 General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
*
|
|
* --
|
|
*
|
|
* ZeroTier may be used and distributed under the terms of the GPLv3, which
|
|
* are available at: http://www.gnu.org/licenses/gpl-3.0.html
|
|
*
|
|
* If you would like to embed ZeroTier into a commercial application or
|
|
* redistribute it in a modified binary form, please contact ZeroTier Networks
|
|
* LLC. Start here: http://www.zerotier.com/
|
|
*/
|
|
|
|
#include "../version.h"
|
|
|
|
#include "Constants.hpp"
|
|
#include "RuntimeEnvironment.hpp"
|
|
#include "Topology.hpp"
|
|
#include "PacketDecoder.hpp"
|
|
#include "Switch.hpp"
|
|
#include "Peer.hpp"
|
|
#include "NodeConfig.hpp"
|
|
#include "Filter.hpp"
|
|
#include "Service.hpp"
|
|
|
|
namespace ZeroTier {
|
|
|
|
bool PacketDecoder::tryDecode(const RuntimeEnvironment *_r)
|
|
throw(std::out_of_range,std::runtime_error)
|
|
{
|
|
if ((!encrypted())&&(verb() == Packet::VERB_HELLO)) {
|
|
// Unencrypted HELLOs are handled here since they are used to
|
|
// populate our identity cache in the first place. _doHELLO() is special
|
|
// in that it contains its own authentication logic.
|
|
TRACE("HELLO from %s(%s)",source().toString().c_str(),_remoteAddress.toString().c_str());
|
|
return _doHELLO(_r);
|
|
}
|
|
|
|
SharedPtr<Peer> peer = _r->topology->getPeer(source());
|
|
if (peer) {
|
|
// Resume saved intermediate decode state?
|
|
if (_step == DECODE_WAITING_FOR_MULTICAST_FRAME_ORIGINAL_SENDER_LOOKUP) {
|
|
// In this state we have already authenticated and decrypted the
|
|
// packet and are waiting for the lookup of the original sender
|
|
// for a multicast frame. So check to see if we've got it.
|
|
return _doMULTICAST_FRAME(_r,peer);
|
|
}
|
|
|
|
if (!dearmor(peer->key())) {
|
|
TRACE("dropped packet from %s(%s), MAC authentication failed (size: %u)",source().toString().c_str(),_remoteAddress.toString().c_str(),size());
|
|
return true;
|
|
}
|
|
if (!uncompress()) {
|
|
TRACE("dropped packet from %s(%s), compressed data invalid",source().toString().c_str(),_remoteAddress.toString().c_str());
|
|
return true;
|
|
}
|
|
|
|
Packet::Verb v = verb();
|
|
|
|
// Once a packet is determined to be basically valid, it can be used
|
|
// to passively learn a new network path to the sending peer. It
|
|
// also results in statistics updates.
|
|
peer->onReceive(_r,_localPort,_remoteAddress,hops(),v,Utils::now());
|
|
|
|
switch(v) {
|
|
case Packet::VERB_NOP:
|
|
TRACE("NOP from %s(%s)",source().toString().c_str(),_remoteAddress.toString().c_str());
|
|
return true;
|
|
case Packet::VERB_HELLO:
|
|
return _doHELLO(_r); // legal, but why? :)
|
|
case Packet::VERB_ERROR:
|
|
return _doERROR(_r,peer);
|
|
case Packet::VERB_OK:
|
|
return _doOK(_r,peer);
|
|
case Packet::VERB_WHOIS:
|
|
return _doWHOIS(_r,peer);
|
|
case Packet::VERB_RENDEZVOUS:
|
|
return _doRENDEZVOUS(_r,peer);
|
|
case Packet::VERB_FRAME:
|
|
return _doFRAME(_r,peer);
|
|
case Packet::VERB_MULTICAST_LIKE:
|
|
return _doMULTICAST_LIKE(_r,peer);
|
|
case Packet::VERB_MULTICAST_GOT:
|
|
return _doMULTICAST_GOT(_r,peer);
|
|
case Packet::VERB_MULTICAST_FRAME:
|
|
return _doMULTICAST_FRAME(_r,peer);
|
|
case Packet::VERB_NETWORK_MEMBERSHIP_CERTIFICATE:
|
|
return _doNETWORK_MEMBERSHIP_CERTIFICATE(_r,peer);
|
|
case Packet::VERB_NETWORK_CONFIG_REQUEST:
|
|
return _doNETWORK_CONFIG_REQUEST(_r,peer);
|
|
case Packet::VERB_NETWORK_CONFIG_REFRESH:
|
|
return _doNETWORK_CONFIG_REFRESH(_r,peer);
|
|
default:
|
|
// This might be something from a new or old version of the protocol.
|
|
// Technically it passed MAC so the packet is still valid, but we
|
|
// ignore it.
|
|
TRACE("ignored unrecognized verb %.2x from %s(%s)",(unsigned int)v,source().toString().c_str(),_remoteAddress.toString().c_str());
|
|
return true;
|
|
}
|
|
} else {
|
|
_step = DECODE_WAITING_FOR_SENDER_LOOKUP; // should already be this...
|
|
_r->sw->requestWhois(source());
|
|
return false;
|
|
}
|
|
}
|
|
|
|
void PacketDecoder::_CBaddPeerFromHello(void *arg,const SharedPtr<Peer> &p,Topology::PeerVerifyResult result)
|
|
{
|
|
_CBaddPeerFromHello_Data *req = (_CBaddPeerFromHello_Data *)arg;
|
|
const RuntimeEnvironment *_r = req->renv;
|
|
|
|
try {
|
|
switch(result) {
|
|
case Topology::PEER_VERIFY_ACCEPTED_NEW:
|
|
case Topology::PEER_VERIFY_ACCEPTED_ALREADY_HAVE:
|
|
case Topology::PEER_VERIFY_ACCEPTED_DISPLACED_INVALID_ADDRESS: {
|
|
_r->sw->doAnythingWaitingForPeer(p);
|
|
Packet outp(req->source,_r->identity.address(),Packet::VERB_OK);
|
|
outp.append((unsigned char)Packet::VERB_HELLO);
|
|
outp.append(req->helloPacketId);
|
|
outp.append(req->helloTimestamp);
|
|
outp.append((unsigned char)ZT_PROTO_VERSION);
|
|
outp.append((unsigned char)ZEROTIER_ONE_VERSION_MAJOR);
|
|
outp.append((unsigned char)ZEROTIER_ONE_VERSION_MINOR);
|
|
outp.append((uint16_t)ZEROTIER_ONE_VERSION_REVISION);
|
|
outp.encrypt(p->cryptKey());
|
|
outp.macSet(p->macKey());
|
|
_r->demarc->send(req->localPort,req->remoteAddress,outp.data(),outp.size(),-1);
|
|
} break;
|
|
|
|
case Topology::PEER_VERIFY_REJECTED_INVALID_IDENTITY: {
|
|
Packet outp(req->source,_r->identity.address(),Packet::VERB_ERROR);
|
|
outp.append((unsigned char)Packet::VERB_HELLO);
|
|
outp.append(req->helloPacketId);
|
|
outp.append((unsigned char)Packet::ERROR_IDENTITY_INVALID);
|
|
outp.encrypt(p->cryptKey());
|
|
outp.macSet(p->macKey());
|
|
_r->demarc->send(req->localPort,req->remoteAddress,outp.data(),outp.size(),-1);
|
|
} break;
|
|
|
|
case Topology::PEER_VERIFY_REJECTED_DUPLICATE:
|
|
case Topology::PEER_VERIFY_REJECTED_DUPLICATE_TRIAGED: {
|
|
Packet outp(req->source,_r->identity.address(),Packet::VERB_ERROR);
|
|
outp.append((unsigned char)Packet::VERB_HELLO);
|
|
outp.append(req->helloPacketId);
|
|
outp.append((unsigned char)Packet::ERROR_IDENTITY_COLLISION);
|
|
outp.encrypt(p->cryptKey());
|
|
outp.macSet(p->macKey());
|
|
_r->demarc->send(req->localPort,req->remoteAddress,outp.data(),outp.size(),-1);
|
|
} break;
|
|
}
|
|
} catch ( ... ) {
|
|
TRACE("unexpected exception in addPeer() result callback for peer received via HELLO");
|
|
}
|
|
|
|
delete req;
|
|
}
|
|
|
|
void PacketDecoder::_CBaddPeerFromWhois(void *arg,const SharedPtr<Peer> &p,Topology::PeerVerifyResult result)
|
|
{
|
|
const RuntimeEnvironment *_r = (const RuntimeEnvironment *)arg;
|
|
try {
|
|
switch(result) {
|
|
case Topology::PEER_VERIFY_ACCEPTED_NEW:
|
|
case Topology::PEER_VERIFY_ACCEPTED_ALREADY_HAVE:
|
|
case Topology::PEER_VERIFY_ACCEPTED_DISPLACED_INVALID_ADDRESS:
|
|
_r->sw->doAnythingWaitingForPeer(p);
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
} catch ( ... ) {
|
|
TRACE("unexpected exception in addPeer() result callback for peer received via OK(WHOIS)");
|
|
}
|
|
}
|
|
|
|
bool PacketDecoder::_doERROR(const RuntimeEnvironment *_r,const SharedPtr<Peer> &peer)
|
|
{
|
|
try {
|
|
#ifdef ZT_TRACE
|
|
Packet::Verb inReVerb = (Packet::Verb)(*this)[ZT_PROTO_VERB_ERROR_IDX_IN_RE_VERB];
|
|
Packet::ErrorCode errorCode = (Packet::ErrorCode)(*this)[ZT_PROTO_VERB_ERROR_IDX_ERROR_CODE];
|
|
TRACE("ERROR %s from %s(%s) in-re %s",Packet::errorString(errorCode),source().toString().c_str(),_remoteAddress.toString().c_str(),Packet::verbString(inReVerb));
|
|
#endif
|
|
// TODO (sorta):
|
|
// The fact is that the protocol works fine without error handling.
|
|
// The only error that really needs to be handled here is duplicate
|
|
// identity collision, which if it comes from a supernode should cause
|
|
// us to restart and regenerate a new identity.
|
|
} catch (std::exception &ex) {
|
|
TRACE("dropped ERROR from %s(%s): unexpected exception: %s",source().toString().c_str(),_remoteAddress.toString().c_str(),ex.what());
|
|
} catch ( ... ) {
|
|
TRACE("dropped ERROR from %s(%s): unexpected exception: (unknown)",source().toString().c_str(),_remoteAddress.toString().c_str());
|
|
}
|
|
return true;
|
|
}
|
|
|
|
bool PacketDecoder::_doHELLO(const RuntimeEnvironment *_r)
|
|
{
|
|
try {
|
|
//unsigned int protoVersion = (*this)[ZT_PROTO_VERB_HELLO_IDX_PROTOCOL_VERSION];
|
|
unsigned int vMajor = (*this)[ZT_PROTO_VERB_HELLO_IDX_MAJOR_VERSION];
|
|
unsigned int vMinor = (*this)[ZT_PROTO_VERB_HELLO_IDX_MINOR_VERSION];
|
|
unsigned int vRevision = at<uint16_t>(ZT_PROTO_VERB_HELLO_IDX_REVISION);
|
|
uint64_t timestamp = at<uint64_t>(ZT_PROTO_VERB_HELLO_IDX_TIMESTAMP);
|
|
Identity id(*this,ZT_PROTO_VERB_HELLO_IDX_IDENTITY);
|
|
|
|
// Initial sniff test for valid addressing and that this is indeed the
|
|
// submitter's identity.
|
|
if ((id.address().isReserved())||(id.address() != source())) {
|
|
#ifdef ZT_TRACE
|
|
if (id.address().isReserved()) {
|
|
TRACE("dropped HELLO from %s(%s): identity has reserved address",source().toString().c_str(),_remoteAddress.toString().c_str());
|
|
} else {
|
|
TRACE("dropped HELLO from %s(%s): identity is not for sender of packet (HELLO is a self-announcement)",source().toString().c_str(),_remoteAddress.toString().c_str());
|
|
}
|
|
#endif
|
|
return true;
|
|
}
|
|
|
|
// Is this a HELLO for a peer we already know? If so just update its
|
|
// packet receive stats and send an OK.
|
|
SharedPtr<Peer> existingPeer(_r->topology->getPeer(id.address()));
|
|
if ((existingPeer)&&(existingPeer->identity() == id)) {
|
|
existingPeer->onReceive(_r,_localPort,_remoteAddress,hops(),Packet::VERB_HELLO,Utils::now());
|
|
existingPeer->setRemoteVersion(vMajor,vMinor,vRevision);
|
|
|
|
Packet outp(source(),_r->identity.address(),Packet::VERB_OK);
|
|
outp.append((unsigned char)Packet::VERB_HELLO);
|
|
outp.append(packetId());
|
|
outp.append(timestamp);
|
|
outp.encrypt(existingPeer->cryptKey());
|
|
outp.macSet(existingPeer->macKey());
|
|
_r->demarc->send(_localPort,_remoteAddress,outp.data(),outp.size(),-1);
|
|
return true;
|
|
}
|
|
|
|
SharedPtr<Peer> candidate(new Peer(_r->identity,id));
|
|
candidate->setPathAddress(_remoteAddress,false);
|
|
candidate->setRemoteVersion(vMajor,vMinor,vRevision);
|
|
|
|
_CBaddPeerFromHello_Data *arg = new _CBaddPeerFromHello_Data;
|
|
arg->renv = _r;
|
|
arg->source = source();
|
|
arg->remoteAddress = _remoteAddress;
|
|
arg->localPort = _localPort;
|
|
arg->vMajor = vMajor;
|
|
arg->vMinor = vMinor;
|
|
arg->vRevision = vRevision;
|
|
arg->helloPacketId = packetId();
|
|
arg->helloTimestamp = timestamp;
|
|
_r->topology->addPeer(candidate,&PacketDecoder::_CBaddPeerFromHello,arg);
|
|
} catch (std::exception &ex) {
|
|
TRACE("dropped HELLO from %s(%s): %s",source().toString().c_str(),_remoteAddress.toString().c_str(),ex.what());
|
|
} catch ( ... ) {
|
|
TRACE("dropped HELLO from %s(%s): unexpected exception",source().toString().c_str(),_remoteAddress.toString().c_str());
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
bool PacketDecoder::_doOK(const RuntimeEnvironment *_r,const SharedPtr<Peer> &peer)
|
|
{
|
|
try {
|
|
Packet::Verb inReVerb = (Packet::Verb)(*this)[ZT_PROTO_VERB_OK_IDX_IN_RE_VERB];
|
|
switch(inReVerb) {
|
|
case Packet::VERB_HELLO: {
|
|
// OK from HELLO permits computation of latency.
|
|
unsigned int latency = std::min((unsigned int)(Utils::now() - at<uint64_t>(ZT_PROTO_VERB_HELLO__OK__IDX_TIMESTAMP)),(unsigned int)0xffff);
|
|
TRACE("%s(%s): OK(HELLO), latency: %u",source().toString().c_str(),_remoteAddress.toString().c_str(),latency);
|
|
peer->setLatency(_remoteAddress,latency);
|
|
} break;
|
|
case Packet::VERB_WHOIS: {
|
|
TRACE("%s(%s): OK(%s)",source().toString().c_str(),_remoteAddress.toString().c_str(),Packet::verbString(inReVerb));
|
|
if (_r->topology->isSupernode(source())) {
|
|
// Right now, only supernodes are queried for WHOIS so we only
|
|
// accept OK(WHOIS) from supernodes. Otherwise peers could
|
|
// potentially cache-poison.
|
|
_r->topology->addPeer(SharedPtr<Peer>(new Peer(_r->identity,Identity(*this,ZT_PROTO_VERB_WHOIS__OK__IDX_IDENTITY))),&PacketDecoder::_CBaddPeerFromWhois,const_cast<void *>((const void *)_r));
|
|
}
|
|
} break;
|
|
case Packet::VERB_NETWORK_CONFIG_REQUEST: {
|
|
SharedPtr<Network> nw(_r->nc->network(at<uint64_t>(ZT_PROTO_VERB_NETWORK_CONFIG_REQUEST__OK__IDX_NETWORK_ID)));
|
|
if ((nw)&&(nw->controller() == source())) {
|
|
// OK(NETWORK_CONFIG_REQUEST) is only accepted from a network's
|
|
// controller.
|
|
unsigned int dictlen = at<uint16_t>(ZT_PROTO_VERB_NETWORK_CONFIG_REQUEST__OK__IDX_DICT_LEN);
|
|
std::string dict((const char *)field(ZT_PROTO_VERB_NETWORK_CONFIG_REQUEST__OK__IDX_DICT,dictlen),dictlen);
|
|
if (dict.length()) {
|
|
Network::Config netconf(dict);
|
|
TRACE("got network configuration for network %.16llx from %s",(unsigned long long)nw->id(),source().toString().c_str());
|
|
nw->setConfiguration(netconf);
|
|
}
|
|
}
|
|
} break;
|
|
default:
|
|
//TRACE("%s(%s): OK(%s)",source().toString().c_str(),_remoteAddress.toString().c_str(),Packet::verbString(inReVerb));
|
|
break;
|
|
}
|
|
} catch (std::exception &ex) {
|
|
TRACE("dropped OK from %s(%s): unexpected exception: %s",source().toString().c_str(),_remoteAddress.toString().c_str(),ex.what());
|
|
} catch ( ... ) {
|
|
TRACE("dropped OK from %s(%s): unexpected exception: (unknown)",source().toString().c_str(),_remoteAddress.toString().c_str());
|
|
}
|
|
return true;
|
|
}
|
|
|
|
bool PacketDecoder::_doWHOIS(const RuntimeEnvironment *_r,const SharedPtr<Peer> &peer)
|
|
{
|
|
if (payloadLength() == ZT_ADDRESS_LENGTH) {
|
|
SharedPtr<Peer> p(_r->topology->getPeer(Address(payload(),ZT_ADDRESS_LENGTH)));
|
|
if (p) {
|
|
Packet outp(source(),_r->identity.address(),Packet::VERB_OK);
|
|
outp.append((unsigned char)Packet::VERB_WHOIS);
|
|
outp.append(packetId());
|
|
p->identity().serialize(outp,false);
|
|
outp.encrypt(peer->cryptKey());
|
|
outp.macSet(peer->macKey());
|
|
_r->demarc->send(_localPort,_remoteAddress,outp.data(),outp.size(),-1);
|
|
TRACE("sent WHOIS response to %s for %s",source().toString().c_str(),Address(payload(),ZT_ADDRESS_LENGTH).toString().c_str());
|
|
} else {
|
|
Packet outp(source(),_r->identity.address(),Packet::VERB_ERROR);
|
|
outp.append((unsigned char)Packet::VERB_WHOIS);
|
|
outp.append(packetId());
|
|
outp.append((unsigned char)Packet::ERROR_OBJ_NOT_FOUND);
|
|
outp.append(payload(),ZT_ADDRESS_LENGTH);
|
|
outp.encrypt(peer->cryptKey());
|
|
outp.macSet(peer->macKey());
|
|
_r->demarc->send(_localPort,_remoteAddress,outp.data(),outp.size(),-1);
|
|
TRACE("sent WHOIS ERROR to %s for %s (not found)",source().toString().c_str(),Address(payload(),ZT_ADDRESS_LENGTH).toString().c_str());
|
|
}
|
|
} else {
|
|
TRACE("dropped WHOIS from %s(%s): missing or invalid address",source().toString().c_str(),_remoteAddress.toString().c_str());
|
|
}
|
|
return true;
|
|
}
|
|
|
|
bool PacketDecoder::_doRENDEZVOUS(const RuntimeEnvironment *_r,const SharedPtr<Peer> &peer)
|
|
{
|
|
try {
|
|
/*
|
|
* At the moment, we only obey RENDEZVOUS if it comes from a designated
|
|
* supernode. If relay offloading is implemented to scale the net, this
|
|
* will need reconsideration.
|
|
*
|
|
* The reason is that RENDEZVOUS could technically be used to cause a
|
|
* peer to send a weird encrypted UDP packet to an arbitrary IP:port.
|
|
* The sender of RENDEZVOUS has no control over the content of this
|
|
* packet, but it's still maybe something we want to not allow just
|
|
* anyone to order due to possible DDOS or network forensic implications.
|
|
* So if we diversify relays, we'll need some way of deciding whether the
|
|
* sender is someone we should trust with a RENDEZVOUS hint.
|
|
*/
|
|
if (_r->topology->isSupernode(source())) {
|
|
Address with(field(ZT_PROTO_VERB_RENDEZVOUS_IDX_ZTADDRESS,ZT_ADDRESS_LENGTH),ZT_ADDRESS_LENGTH);
|
|
SharedPtr<Peer> withPeer(_r->topology->getPeer(with));
|
|
if (withPeer) {
|
|
unsigned int port = at<uint16_t>(ZT_PROTO_VERB_RENDEZVOUS_IDX_PORT);
|
|
unsigned int addrlen = (*this)[ZT_PROTO_VERB_RENDEZVOUS_IDX_ADDRLEN];
|
|
if ((port > 0)&&((addrlen == 4)||(addrlen == 16))) {
|
|
InetAddress atAddr(field(ZT_PROTO_VERB_RENDEZVOUS_IDX_ADDRESS,addrlen),addrlen,port);
|
|
TRACE("RENDEZVOUS from %s says %s might be at %s, starting NAT-t",source().toString().c_str(),with.toString().c_str(),atAddr.toString().c_str());
|
|
_r->sw->contact(withPeer,atAddr);
|
|
} else {
|
|
TRACE("dropped corrupt RENDEZVOUS from %s(%s) (bad address or port)",source().toString().c_str(),_remoteAddress.toString().c_str());
|
|
}
|
|
} else {
|
|
TRACE("ignored RENDEZVOUS from %s(%s) to meet unknown peer %s",source().toString().c_str(),_remoteAddress.toString().c_str(),with.toString().c_str());
|
|
}
|
|
} else {
|
|
TRACE("ignored RENDEZVOUS from %s(%s): source not supernode",source().toString().c_str(),_remoteAddress.toString().c_str());
|
|
}
|
|
} catch (std::exception &ex) {
|
|
TRACE("dropped RENDEZVOUS from %s(%s): %s",source().toString().c_str(),_remoteAddress.toString().c_str(),ex.what());
|
|
} catch ( ... ) {
|
|
TRACE("dropped RENDEZVOUS from %s(%s): unexpected exception",source().toString().c_str(),_remoteAddress.toString().c_str());
|
|
}
|
|
return true;
|
|
}
|
|
|
|
bool PacketDecoder::_doFRAME(const RuntimeEnvironment *_r,const SharedPtr<Peer> &peer)
|
|
{
|
|
try {
|
|
SharedPtr<Network> network(_r->nc->network(at<uint64_t>(ZT_PROTO_VERB_FRAME_IDX_NETWORK_ID)));
|
|
if (network) {
|
|
if (network->isAllowed(source())) {
|
|
unsigned int etherType = at<uint16_t>(ZT_PROTO_VERB_FRAME_IDX_ETHERTYPE);
|
|
if (network->permitsEtherType(etherType)) {
|
|
network->tap().put(source().toMAC(),network->tap().mac(),etherType,data() + ZT_PROTO_VERB_FRAME_IDX_PAYLOAD,size() - ZT_PROTO_VERB_FRAME_IDX_PAYLOAD);
|
|
} else if (size() > ZT_PROTO_VERB_FRAME_IDX_PAYLOAD) {
|
|
TRACE("dropped FRAME from %s: ethernet type %u not allowed on network %.16llx",source().toString().c_str(),etherType,(unsigned long long)network->id());
|
|
}
|
|
} else {
|
|
TRACE("dropped FRAME from %s(%s): not a member of closed network %llu",source().toString().c_str(),_remoteAddress.toString().c_str(),network->id());
|
|
}
|
|
} else {
|
|
TRACE("dropped FRAME from %s(%s): network %llu unknown",source().toString().c_str(),_remoteAddress.toString().c_str(),at<uint64_t>(ZT_PROTO_VERB_FRAME_IDX_NETWORK_ID));
|
|
}
|
|
} catch (std::exception &ex) {
|
|
TRACE("dropped FRAME from %s(%s): unexpected exception: %s",source().toString().c_str(),_remoteAddress.toString().c_str(),ex.what());
|
|
} catch ( ... ) {
|
|
TRACE("dropped FRAME from %s(%s): unexpected exception: (unknown)",source().toString().c_str(),_remoteAddress.toString().c_str());
|
|
}
|
|
return true;
|
|
}
|
|
|
|
bool PacketDecoder::_doMULTICAST_LIKE(const RuntimeEnvironment *_r,const SharedPtr<Peer> &peer)
|
|
{
|
|
try {
|
|
unsigned int ptr = ZT_PACKET_IDX_PAYLOAD;
|
|
if (ptr >= size())
|
|
return true;
|
|
uint64_t now = Utils::now();
|
|
Address src(source());
|
|
|
|
// Iterate through 18-byte network,MAC,ADI tuples
|
|
for(;;) {
|
|
_r->mc->likesGroup(at<uint64_t>(ptr),src,MulticastGroup(MAC(field(ptr + 8,6)),at<uint32_t>(ptr + 14)),now);
|
|
if ((ptr += 18) >= size())
|
|
break;
|
|
}
|
|
} catch (std::exception &ex) {
|
|
TRACE("dropped MULTICAST_LIKE from %s(%s): unexpected exception: %s",source().toString().c_str(),_remoteAddress.toString().c_str(),ex.what());
|
|
} catch ( ... ) {
|
|
TRACE("dropped MULTICAST_LIKE from %s(%s): unexpected exception: (unknown)",source().toString().c_str(),_remoteAddress.toString().c_str());
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
bool PacketDecoder::_doMULTICAST_GOT(const RuntimeEnvironment *_r,const SharedPtr<Peer> &peer)
|
|
{
|
|
// Right now only supernodes act as propagation hubs
|
|
if (!_r->topology->amSupernode()) {
|
|
TRACE("dropped MULTICAST_GOT from %s: I am not a supernode",source().toString().c_str());
|
|
return true;
|
|
}
|
|
|
|
try {
|
|
_r->mc->got(at<uint64_t>(ZT_PROTO_VERB_MULTICAST_GOT_IDX_NETWORK_ID),source(),at<uint64_t>(ZT_PROTO_VERB_MULTICAST_GOT_IDX_MULTICAST_GUID));
|
|
} catch (std::exception &ex) {
|
|
TRACE("dropped MULTICAST_GOT from %s(%s): unexpected exception: %s",source().toString().c_str(),_remoteAddress.toString().c_str(),ex.what());
|
|
} catch ( ... ) {
|
|
TRACE("dropped MULTICAST_GOT from %s(%s): unexpected exception: (unknown)",source().toString().c_str(),_remoteAddress.toString().c_str());
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
// Function object used in _doMULTICAST_FRAME
|
|
struct _doMULTICAST_FRAME_fillQueueWithNextHops
|
|
{
|
|
_doMULTICAST_FRAME_fillQueueWithNextHops(char *nq,unsigned int want)
|
|
ptr(nq),
|
|
need(want) {}
|
|
|
|
inline bool operator()(const Address &a) const
|
|
throw()
|
|
{
|
|
a.copyTo(ptr,ZT_ADDRESS_LENGTH);
|
|
ptr += ZT_ADDRESS_LENGTH;
|
|
return (--need != 0);
|
|
}
|
|
|
|
char *ptr;
|
|
unsigned int need;
|
|
};
|
|
|
|
bool PacketDecoder::_doMULTICAST_FRAME(const RuntimeEnvironment *_r,const SharedPtr<Peer> &peer)
|
|
{
|
|
try {
|
|
unsigned int forwardCount = at<uint32_t>(ZT_PROTO_VERB_MULTICAST_FRAME_IDX_FORWARD_COUNT);
|
|
char *queue = (char *)field(ZT_PROTO_VERB_MULTICAST_FRAME_IDX_QUEUE,ZT_PROTO_VERB_MULTICAST_FRAME_LEN_QUEUE);
|
|
Address magnet(field(ZT_PROTO_VERB_MULTICAST_FRAME_IDX_MAGNET,ZT_ADDRESS_LENGTH),ZT_ADDRESS_LENGTH);
|
|
Address submitterAddr(Address(field(ZT_PROTO_VERB_MULTICAST_FRAME_IDX_SUBMITTER,ZT_ADDRESS_LENGTH),ZT_ADDRESS_LENGTH));
|
|
SharedPtr<Peer> submitter(_r->topology->getPeer(submitterAddr));
|
|
if (!submitter) {
|
|
_r->sw->requestWhois(submitterAddr);
|
|
_step = DECODE_WAITING_FOR_MULTICAST_FRAME_ORIGINAL_SENDER_LOOKUP; // causes processing to come back here
|
|
return false;
|
|
}
|
|
uint64_t guid = at<uint64_t>(ZT_PROTO_VERB_MULTICAST_FRAME_IDX_SUBMITTER); // 40-bit sender address + 24-bit sender unique ID
|
|
uint64_t nwid = at<uint64_t>(ZT_PROTO_VERB_MULTICAST_FRAME_IDX_NETWORK_ID);
|
|
MAC sourceMac(field(ZT_PROTO_VERB_MULTICAST_FRAME_IDX_SOURCE_MAC,6));
|
|
MulticastGroup dest(MAC(field(ZT_PROTO_VERB_MULTICAST_FRAME_IDX_DESTINATION_MAC,6)),at<uint32_t>(ZT_PROTO_VERB_MULTICAST_FRAME_IDX_DESTINATION_ADI));
|
|
unsigned int etherType = at<uint16_t>(ZT_PROTO_VERB_MULTICAST_FRAME_IDX_ETHERTYPE);
|
|
unsigned int frameLen = at<uint16_t>(ZT_PROTO_VERB_MULTICAST_FRAME_IDX_PAYLOAD_LENGTH);
|
|
unsigned char *frame = field(ZT_PROTO_VERB_MULTICAST_FRAME_IDX_PAYLOAD,frameLen);
|
|
unsigned int signatureLen = at<uint16_t>(ZT_PROTO_VERB_MULTICAST_FRAME_IDX_PAYLOAD + frameLen);
|
|
unsigned char *signature = field(ZT_PROTO_VERB_MULTICAST_FRAME_IDX_PAYLOAD + frameLen + 2,signatureLen);
|
|
|
|
unsigned int signedPartLen = (ZT_PROTO_VERB_MULTICAST_FRAME_IDX_PAYLOAD - ZT_PROTO_VERB_MULTICAST_FRAME_IDX_MAGNET) + frameLen;
|
|
if (!submitter->identity().verify(field(ZT_PROTO_VERB_MULTICAST_FRAME_IDX_MAGNET,signedPartLen),signedPartLen,signature,signatureLen)) {
|
|
TRACE("dropped MULTICAST_FRAME from %s(%s): failed signature verification, claims to be from %s",source().toString().c_str(),_remoteAddress.toString().c_str(),submitterAddr.toString().c_str());
|
|
return true;
|
|
}
|
|
|
|
SharedPtr<Network> network(_r->nc->network(nwid));
|
|
if (network) {
|
|
if (!network->isAllowed(submitterAddr)) {
|
|
} else if (!dest.mac().isMulticast()) {
|
|
} else if ((!network->permitsBridging())&&(!submitterAddr.wouldHaveMac(sourceMac))) {
|
|
} else if (!network->permitsEtherType(etherType)) {
|
|
} else if (network->multicastDeduplicate(guid)) {
|
|
} else if (network->updateAndCheckMulticastBalance(submitterAddr,dest,frameLen)) {
|
|
network->tap().put(sourceMac,dest.mac(),etherType,frame,frameLen);
|
|
}
|
|
}
|
|
|
|
if (magnet != _r->identity.address()) {
|
|
Packet outp(magnet,_r->identity.address(),Packet::VERB_MULTICAST_GOT);
|
|
outp.append(nwid);
|
|
outp.append(guid);
|
|
_r->sw->send(outp,true);
|
|
}
|
|
|
|
setAt(ZT_PROTO_VERB_MULTICAST_FRAME_IDX_FORWARD_COUNT,(uint32_t)++forwardCount);
|
|
|
|
char newQueue[ZT_PROTO_VERB_MULTICAST_FRAME_LEN_QUEUE + ZT_ADDRESS_LENGTH]; // room for an extra if we need a nextHop
|
|
unsigned int newQueueLen = 0;
|
|
|
|
// Top of FIFO is next hop (if there is one)
|
|
Address nextHop(queue,ZT_ADDRESS_LENGTH);
|
|
|
|
// Deduplicate the rest of the queue[], adding them to newQueue
|
|
if (nextHop) { // there was a next hop, so there was something there
|
|
char firstByteSeen[256];
|
|
for(unsigned int j=0;j<(256 / 8);++j)
|
|
((uint64_t *)firstByteSeen)[j] = 0;
|
|
for(unsigned int i=ZT_ADDRESS_LENGTH;i<ZT_PROTO_VERB_MULTICAST_FRAME_LEN_QUEUE;i+=ZT_ADDRESS_LENGTH) {
|
|
char *qs = queue + i;
|
|
if (Utils::isZero(qs,ZT_ADDRESS_LENGTH)) // zero terminates queue
|
|
break;
|
|
bool isdup = false;
|
|
if (firstByteSeen[(unsigned int)queue[i]]) {
|
|
for(unsigned int i2=ZT_ADDRESS_LENGTH;i2<ZT_PROTO_VERB_MULTICAST_FRAME_LEN_QUEUE;i2+=ZT_ADDRESS_LENGTH) {
|
|
if ((i2 != i)&&(!memcmp(qs,queue + i2,ZT_ADDRESS_LENGTH))) {
|
|
isdup = true;
|
|
break;
|
|
}
|
|
}
|
|
} else firstByteSeen[(unsigned int)queue[i]] = 1;
|
|
if (!isdup) {
|
|
char *nq = newQueue + (newQueueLen++ * ZT_ADDRESS_LENGTH);
|
|
for(unsigned int j=0;j<ZT_ADDRESS_LENGTH;++j)
|
|
nq[j] = qs[j];
|
|
}
|
|
}
|
|
}
|
|
|
|
// Get next hops, including an extra if we don't have a next hop yet
|
|
unsigned int needQueueItems = ((ZT_PROTO_VERB_MULTICAST_FRAME_LEN_QUEUE / ZT_ADDRESS_LENGTH) - newQueueLen);
|
|
if (!nextHop)
|
|
++needQueueItems;
|
|
if (needQueueItems)
|
|
newQueueLen += _r->mc->getNextHops(nwid,dest,guid,_doMULTICAST_FRAME_fillQueueWithNextHops(newQueue,needQueueItems));
|
|
|
|
// Copy new queue over old queue, and pick off next hop if we need one
|
|
if (newQueueLen) {
|
|
char *nq = newQueue;
|
|
if (!nextHop) {
|
|
nextHop.setTo(nq,ZT_ADDRESS_LENGTH);
|
|
nq += ZT_ADDRESS_LENGTH;
|
|
--newQueueLen;
|
|
}
|
|
unsigned int i = 0;
|
|
unsigned int k = ZT_ADDRESS_LENGTH * newQueueLen;
|
|
while (i < k)
|
|
nq[i] = newQueue[i];
|
|
while (i < ZT_PROTO_VERB_MULTICAST_FRAME_LEN_QUEUE)
|
|
nq[i] = 0;
|
|
} else memset(queue,0,ZT_PROTO_VERB_MULTICAST_FRAME_LEN_QUEUE);
|
|
|
|
// If there's still no next hop, it's the magnet
|
|
if (!nextHop)
|
|
nextHop = magnet;
|
|
|
|
// Send to next hop, unless it's us of course
|
|
if (nextHop != _r->identity.address()) {
|
|
newInitializationVector();
|
|
setDestination(nextHop);
|
|
setSource(_r->identity.address());
|
|
compress();
|
|
_r->sw->send(*this,true);
|
|
}
|
|
|
|
return true;
|
|
} catch (std::exception &ex) {
|
|
TRACE("dropped MULTICAST_FRAME from %s(%s): unexpected exception: %s",source().toString().c_str(),_remoteAddress.toString().c_str(),ex.what());
|
|
} catch ( ... ) {
|
|
TRACE("dropped MULTICAST_FRAME from %s(%s): unexpected exception: (unknown)",source().toString().c_str(),_remoteAddress.toString().c_str());
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
bool PacketDecoder::_doNETWORK_MEMBERSHIP_CERTIFICATE(const RuntimeEnvironment *_r,const SharedPtr<Peer> &peer)
|
|
{
|
|
// TODO: not implemented yet, will be needed for private networks.
|
|
|
|
return true;
|
|
}
|
|
|
|
bool PacketDecoder::_doNETWORK_CONFIG_REQUEST(const RuntimeEnvironment *_r,const SharedPtr<Peer> &peer)
|
|
{
|
|
try {
|
|
uint64_t nwid = at<uint64_t>(ZT_PROTO_VERB_NETWORK_CONFIG_REQUEST_IDX_NETWORK_ID);
|
|
#ifndef __WINDOWS__
|
|
if (_r->netconfService) {
|
|
char tmp[128];
|
|
unsigned int dictLen = at<uint16_t>(ZT_PROTO_VERB_NETWORK_CONFIG_REQUEST_IDX_DICT_LEN);
|
|
|
|
Dictionary request;
|
|
if (dictLen)
|
|
request["meta"] = std::string((const char *)field(ZT_PROTO_VERB_NETWORK_CONFIG_REQUEST_IDX_DICT,dictLen),dictLen);
|
|
request["type"] = "netconf-request";
|
|
request["peerId"] = peer->identity().toString(false);
|
|
Utils::snprintf(tmp,sizeof(tmp),"%llx",(unsigned long long)nwid);
|
|
request["nwid"] = tmp;
|
|
Utils::snprintf(tmp,sizeof(tmp),"%llx",(unsigned long long)packetId());
|
|
request["requestId"] = tmp;
|
|
//TRACE("to netconf:\n%s",request.toString().c_str());
|
|
_r->netconfService->send(request);
|
|
} else {
|
|
#endif // !__WINDOWS__
|
|
Packet outp(source(),_r->identity.address(),Packet::VERB_ERROR);
|
|
outp.append((unsigned char)Packet::VERB_NETWORK_CONFIG_REQUEST);
|
|
outp.append(packetId());
|
|
outp.append((unsigned char)Packet::ERROR_UNSUPPORTED_OPERATION);
|
|
outp.append(nwid);
|
|
outp.encrypt(peer->cryptKey());
|
|
outp.macSet(peer->macKey());
|
|
_r->demarc->send(_localPort,_remoteAddress,outp.data(),outp.size(),-1);
|
|
#ifndef __WINDOWS__
|
|
}
|
|
#endif // !__WINDOWS__
|
|
} catch (std::exception &exc) {
|
|
TRACE("dropped NETWORK_CONFIG_REQUEST from %s(%s): unexpected exception: %s",source().toString().c_str(),_remoteAddress.toString().c_str(),exc.what());
|
|
} catch ( ... ) {
|
|
TRACE("dropped NETWORK_CONFIG_REQUEST from %s(%s): unexpected exception: (unknown)",source().toString().c_str(),_remoteAddress.toString().c_str());
|
|
}
|
|
return true;
|
|
}
|
|
|
|
bool PacketDecoder::_doNETWORK_CONFIG_REFRESH(const RuntimeEnvironment *_r,const SharedPtr<Peer> &peer)
|
|
{
|
|
try {
|
|
uint64_t nwid = at<uint64_t>(ZT_PROTO_VERB_NETWORK_CONFIG_REFRESH_IDX_NETWORK_ID);
|
|
SharedPtr<Network> nw(_r->nc->network(nwid));
|
|
if ((nw)&&(source() == nw->controller())) // only respond to requests from controller
|
|
nw->requestConfiguration();
|
|
} catch (std::exception &exc) {
|
|
TRACE("dropped NETWORK_CONFIG_REFRESH from %s(%s): unexpected exception: %s",source().toString().c_str(),_remoteAddress.toString().c_str(),exc.what());
|
|
} catch ( ... ) {
|
|
TRACE("dropped NETWORK_CONFIG_REFRESH from %s(%s): unexpected exception: (unknown)",source().toString().c_str(),_remoteAddress.toString().c_str());
|
|
}
|
|
return true;
|
|
}
|
|
|
|
} // namespace ZeroTier
|