PacketDecoder.cpp 27 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611
  1. /*
  2. * ZeroTier One - Global Peer to Peer Ethernet
  3. * Copyright (C) 2012-2013 ZeroTier Networks LLC
  4. *
  5. * This program is free software: you can redistribute it and/or modify
  6. * it under the terms of the GNU General Public License as published by
  7. * the Free Software Foundation, either version 3 of the License, or
  8. * (at your option) any later version.
  9. *
  10. * This program is distributed in the hope that it will be useful,
  11. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  13. * GNU General Public License for more details.
  14. *
  15. * You should have received a copy of the GNU General Public License
  16. * along with this program. If not, see <http://www.gnu.org/licenses/>.
  17. *
  18. * --
  19. *
  20. * ZeroTier may be used and distributed under the terms of the GPLv3, which
  21. * are available at: http://www.gnu.org/licenses/gpl-3.0.html
  22. *
  23. * If you would like to embed ZeroTier into a commercial application or
  24. * redistribute it in a modified binary form, please contact ZeroTier Networks
  25. * LLC. Start here: http://www.zerotier.com/
  26. */
  27. #include "Constants.hpp"
  28. #include "RuntimeEnvironment.hpp"
  29. #include "Topology.hpp"
  30. #include "PacketDecoder.hpp"
  31. #include "Switch.hpp"
  32. #include "Peer.hpp"
  33. #include "NodeConfig.hpp"
  34. #include "Filter.hpp"
  35. #include "Service.hpp"
  36. namespace ZeroTier {
  37. bool PacketDecoder::tryDecode(const RuntimeEnvironment *_r)
  38. throw(std::out_of_range,std::runtime_error)
  39. {
  40. if ((!encrypted())&&(verb() == Packet::VERB_HELLO)) {
  41. // Unencrypted HELLOs are handled here since they are used to
  42. // populate our identity cache in the first place. Thus we might get
  43. // a HELLO for someone for whom we don't have a Peer record.
  44. TRACE("HELLO from %s(%s)",source().toString().c_str(),_remoteAddress.toString().c_str());
  45. return _doHELLO(_r);
  46. }
  47. SharedPtr<Peer> peer = _r->topology->getPeer(source());
  48. if (peer) {
  49. if (_step == DECODE_STEP_WAITING_FOR_ORIGINAL_SUBMITTER_LOOKUP) {
  50. // This means we've already decoded, decrypted, decompressed, and
  51. // validated, and we're processing a MULTICAST_FRAME. We're waiting
  52. // for a lookup on the frame's original submitter. So try again and
  53. // see if we have it.
  54. return _doMULTICAST_FRAME(_r,peer);
  55. }
  56. if (!hmacVerify(peer->macKey())) {
  57. TRACE("dropped packet from %s(%s), HMAC authentication failed (size: %u)",source().toString().c_str(),_remoteAddress.toString().c_str(),size());
  58. return true;
  59. }
  60. if (encrypted()) {
  61. decrypt(peer->cryptKey());
  62. } else {
  63. // Unencrypted is tolerated in case we want to run this on
  64. // devices where squeezing out cycles matters. HMAC is
  65. // what's really important. But log it in debug to catch any
  66. // packets being mistakenly sent in the clear.
  67. TRACE("ODD: %s from %s(%s) wasn't encrypted",Packet::verbString(verb()),source().toString().c_str(),_remoteAddress.toString().c_str());
  68. }
  69. if (!uncompress()) {
  70. TRACE("dropped packet from %s(%s), compressed data invalid",source().toString().c_str(),_remoteAddress.toString().c_str());
  71. return true;
  72. }
  73. Packet::Verb v = verb();
  74. // Validated packets that have passed HMAC can result in us learning a new
  75. // path to this peer.
  76. peer->onReceive(_r,_localPort,_remoteAddress,hops(),v,Utils::now());
  77. switch(v) {
  78. case Packet::VERB_NOP:
  79. TRACE("NOP from %s(%s)",source().toString().c_str(),_remoteAddress.toString().c_str());
  80. return true;
  81. case Packet::VERB_HELLO:
  82. return _doHELLO(_r);
  83. case Packet::VERB_ERROR:
  84. return _doERROR(_r,peer);
  85. case Packet::VERB_OK:
  86. return _doOK(_r,peer);
  87. case Packet::VERB_WHOIS:
  88. return _doWHOIS(_r,peer);
  89. case Packet::VERB_RENDEZVOUS:
  90. return _doRENDEZVOUS(_r,peer);
  91. case Packet::VERB_FRAME:
  92. return _doFRAME(_r,peer);
  93. case Packet::VERB_MULTICAST_LIKE:
  94. return _doMULTICAST_LIKE(_r,peer);
  95. case Packet::VERB_MULTICAST_FRAME:
  96. return _doMULTICAST_FRAME(_r,peer);
  97. case Packet::VERB_NETWORK_MEMBERSHIP_CERTIFICATE:
  98. return _doNETWORK_MEMBERSHIP_CERTIFICATE(_r,peer);
  99. case Packet::VERB_NETWORK_CONFIG_REQUEST:
  100. return _doNETWORK_CONFIG_REQUEST(_r,peer);
  101. case Packet::VERB_NETWORK_CONFIG_REFRESH:
  102. return _doNETWORK_CONFIG_REFRESH(_r,peer);
  103. default:
  104. // This might be something from a new or old version of the protocol.
  105. // Technically it passed HMAC so the packet is still valid, but we
  106. // ignore it.
  107. TRACE("ignored unrecognized verb %.2x from %s(%s)",(unsigned int)v,source().toString().c_str(),_remoteAddress.toString().c_str());
  108. return true;
  109. }
  110. } else {
  111. _step = DECODE_STEP_WAITING_FOR_SENDER_LOOKUP;
  112. _r->sw->requestWhois(source());
  113. return false;
  114. }
  115. }
  116. void PacketDecoder::_CBaddPeerFromHello(void *arg,const SharedPtr<Peer> &p,Topology::PeerVerifyResult result)
  117. {
  118. _CBaddPeerFromHello_Data *req = (_CBaddPeerFromHello_Data *)arg;
  119. const RuntimeEnvironment *_r = req->renv;
  120. switch(result) {
  121. case Topology::PEER_VERIFY_ACCEPTED_NEW:
  122. case Topology::PEER_VERIFY_ACCEPTED_ALREADY_HAVE:
  123. case Topology::PEER_VERIFY_ACCEPTED_DISPLACED_INVALID_ADDRESS: {
  124. _r->sw->doAnythingWaitingForPeer(p);
  125. Packet outp(req->source,_r->identity.address(),Packet::VERB_OK);
  126. outp.append((unsigned char)Packet::VERB_HELLO);
  127. outp.append(req->helloPacketId);
  128. outp.append(req->helloTimestamp);
  129. outp.encrypt(p->cryptKey());
  130. outp.hmacSet(p->macKey());
  131. _r->demarc->send(req->localPort,req->remoteAddress,outp.data(),outp.size(),-1);
  132. } break;
  133. case Topology::PEER_VERIFY_REJECTED_INVALID_IDENTITY: {
  134. Packet outp(req->source,_r->identity.address(),Packet::VERB_ERROR);
  135. outp.append((unsigned char)Packet::VERB_HELLO);
  136. outp.append(req->helloPacketId);
  137. outp.append((unsigned char)Packet::ERROR_IDENTITY_INVALID);
  138. outp.encrypt(p->cryptKey());
  139. outp.hmacSet(p->macKey());
  140. _r->demarc->send(req->localPort,req->remoteAddress,outp.data(),outp.size(),-1);
  141. } break;
  142. case Topology::PEER_VERIFY_REJECTED_DUPLICATE:
  143. case Topology::PEER_VERIFY_REJECTED_DUPLICATE_TRIAGED: {
  144. Packet outp(req->source,_r->identity.address(),Packet::VERB_ERROR);
  145. outp.append((unsigned char)Packet::VERB_HELLO);
  146. outp.append(req->helloPacketId);
  147. outp.append((unsigned char)Packet::ERROR_IDENTITY_COLLISION);
  148. outp.encrypt(p->cryptKey());
  149. outp.hmacSet(p->macKey());
  150. _r->demarc->send(req->localPort,req->remoteAddress,outp.data(),outp.size(),-1);
  151. } break;
  152. }
  153. delete req;
  154. }
  155. void PacketDecoder::_CBaddPeerFromWhois(void *arg,const SharedPtr<Peer> &p,Topology::PeerVerifyResult result)
  156. {
  157. switch(result) {
  158. case Topology::PEER_VERIFY_ACCEPTED_NEW:
  159. case Topology::PEER_VERIFY_ACCEPTED_ALREADY_HAVE:
  160. case Topology::PEER_VERIFY_ACCEPTED_DISPLACED_INVALID_ADDRESS:
  161. ((const RuntimeEnvironment *)arg)->sw->doAnythingWaitingForPeer(p);
  162. break;
  163. default:
  164. break;
  165. }
  166. }
  167. bool PacketDecoder::_doERROR(const RuntimeEnvironment *_r,const SharedPtr<Peer> &peer)
  168. {
  169. try {
  170. #ifdef ZT_TRACE
  171. Packet::Verb inReVerb = (Packet::Verb)(*this)[ZT_PROTO_VERB_ERROR_IDX_IN_RE_VERB];
  172. Packet::ErrorCode errorCode = (Packet::ErrorCode)(*this)[ZT_PROTO_VERB_ERROR_IDX_ERROR_CODE];
  173. TRACE("ERROR %s from %s(%s) in-re %s",Packet::errorString(errorCode),source().toString().c_str(),_remoteAddress.toString().c_str(),Packet::verbString(inReVerb));
  174. #endif
  175. // TODO (sorta):
  176. // The fact is that the protocol works fine without error handling.
  177. // The only error that really needs to be handled here is duplicate
  178. // identity collision, which if it comes from a supernode should cause
  179. // us to restart and regenerate a new identity.
  180. } catch (std::exception &ex) {
  181. TRACE("dropped ERROR from %s(%s): unexpected exception: %s",source().toString().c_str(),_remoteAddress.toString().c_str(),ex.what());
  182. } catch ( ... ) {
  183. TRACE("dropped ERROR from %s(%s): unexpected exception: (unknown)",source().toString().c_str(),_remoteAddress.toString().c_str());
  184. }
  185. return true;
  186. }
  187. bool PacketDecoder::_doHELLO(const RuntimeEnvironment *_r)
  188. {
  189. try {
  190. //unsigned int protoVersion = (*this)[ZT_PROTO_VERB_HELLO_IDX_PROTOCOL_VERSION];
  191. unsigned int vMajor = (*this)[ZT_PROTO_VERB_HELLO_IDX_MAJOR_VERSION];
  192. unsigned int vMinor = (*this)[ZT_PROTO_VERB_HELLO_IDX_MINOR_VERSION];
  193. unsigned int vRevision = at<uint16_t>(ZT_PROTO_VERB_HELLO_IDX_REVISION);
  194. uint64_t timestamp = at<uint64_t>(ZT_PROTO_VERB_HELLO_IDX_TIMESTAMP);
  195. Identity id(*this,ZT_PROTO_VERB_HELLO_IDX_IDENTITY);
  196. SharedPtr<Peer> candidate(new Peer(_r->identity,id));
  197. candidate->setPathAddress(_remoteAddress,false);
  198. // Initial sniff test
  199. if (id.address().isReserved()) {
  200. TRACE("rejected HELLO from %s(%s): identity has reserved address",source().toString().c_str(),_remoteAddress.toString().c_str());
  201. Packet outp(source(),_r->identity.address(),Packet::VERB_ERROR);
  202. outp.append((unsigned char)Packet::VERB_HELLO);
  203. outp.append(packetId());
  204. outp.append((unsigned char)Packet::ERROR_IDENTITY_INVALID);
  205. outp.encrypt(candidate->cryptKey());
  206. outp.hmacSet(candidate->macKey());
  207. _r->demarc->send(_localPort,_remoteAddress,outp.data(),outp.size(),-1);
  208. return true;
  209. }
  210. if (id.address() != source()) {
  211. TRACE("rejected HELLO from %s(%s): identity is not for sender of packet (HELLO is a self-announcement)",source().toString().c_str(),_remoteAddress.toString().c_str());
  212. Packet outp(source(),_r->identity.address(),Packet::VERB_ERROR);
  213. outp.append((unsigned char)Packet::VERB_HELLO);
  214. outp.append(packetId());
  215. outp.append((unsigned char)Packet::ERROR_INVALID_REQUEST);
  216. outp.encrypt(candidate->cryptKey());
  217. outp.hmacSet(candidate->macKey());
  218. _r->demarc->send(_localPort,_remoteAddress,outp.data(),outp.size(),-1);
  219. return true;
  220. }
  221. // Is this a HELLO for a peer we already know? If so just update its
  222. // packet receive stats and send an OK.
  223. SharedPtr<Peer> existingPeer(_r->topology->getPeer(id.address()));
  224. if ((existingPeer)&&(existingPeer->identity() == id)) {
  225. existingPeer->onReceive(_r,_localPort,_remoteAddress,hops(),Packet::VERB_HELLO,Utils::now());
  226. existingPeer->setRemoteVersion(vMajor,vMinor,vRevision);
  227. Packet outp(source(),_r->identity.address(),Packet::VERB_OK);
  228. outp.append((unsigned char)Packet::VERB_HELLO);
  229. outp.append(packetId());
  230. outp.append(timestamp);
  231. outp.encrypt(existingPeer->cryptKey());
  232. outp.hmacSet(existingPeer->macKey());
  233. _r->demarc->send(_localPort,_remoteAddress,outp.data(),outp.size(),-1);
  234. return true;
  235. }
  236. // Otherwise we call addPeer() and set up a callback to handle the verdict
  237. _CBaddPeerFromHello_Data *arg = new _CBaddPeerFromHello_Data;
  238. arg->renv = _r;
  239. arg->source = source();
  240. arg->remoteAddress = _remoteAddress;
  241. arg->localPort = _localPort;
  242. arg->vMajor = vMajor;
  243. arg->vMinor = vMinor;
  244. arg->vRevision = vRevision;
  245. arg->helloPacketId = packetId();
  246. arg->helloTimestamp = timestamp;
  247. _r->topology->addPeer(candidate,&PacketDecoder::_CBaddPeerFromHello,arg);
  248. } catch (std::exception &ex) {
  249. TRACE("dropped HELLO from %s(%s): %s",source().toString().c_str(),_remoteAddress.toString().c_str(),ex.what());
  250. } catch ( ... ) {
  251. TRACE("dropped HELLO from %s(%s): unexpected exception",source().toString().c_str(),_remoteAddress.toString().c_str());
  252. }
  253. return true;
  254. }
  255. bool PacketDecoder::_doOK(const RuntimeEnvironment *_r,const SharedPtr<Peer> &peer)
  256. {
  257. try {
  258. Packet::Verb inReVerb = (Packet::Verb)(*this)[ZT_PROTO_VERB_OK_IDX_IN_RE_VERB];
  259. switch(inReVerb) {
  260. case Packet::VERB_HELLO: {
  261. // OK from HELLO permits computation of latency.
  262. unsigned int latency = std::min((unsigned int)(Utils::now() - at<uint64_t>(ZT_PROTO_VERB_HELLO__OK__IDX_TIMESTAMP)),(unsigned int)0xffff);
  263. TRACE("%s(%s): OK(HELLO), latency: %u",source().toString().c_str(),_remoteAddress.toString().c_str(),latency);
  264. peer->setLatency(_remoteAddress,latency);
  265. } break;
  266. case Packet::VERB_WHOIS:
  267. // Right now we only query supernodes for WHOIS and only accept
  268. // OK back from them. If we query other nodes, we'll have to
  269. // do something to prevent WHOIS cache poisoning such as
  270. // using the packet ID field in the OK packet to match with the
  271. // original query. Technically we should be doing this anyway.
  272. TRACE("%s(%s): OK(%s)",source().toString().c_str(),_remoteAddress.toString().c_str(),Packet::verbString(inReVerb));
  273. if (_r->topology->isSupernode(source()))
  274. _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));
  275. break;
  276. default:
  277. //TRACE("%s(%s): OK(%s)",source().toString().c_str(),_remoteAddress.toString().c_str(),Packet::verbString(inReVerb));
  278. break;
  279. }
  280. } catch (std::exception &ex) {
  281. TRACE("dropped OK from %s(%s): unexpected exception: %s",source().toString().c_str(),_remoteAddress.toString().c_str(),ex.what());
  282. } catch ( ... ) {
  283. TRACE("dropped OK from %s(%s): unexpected exception: (unknown)",source().toString().c_str(),_remoteAddress.toString().c_str());
  284. }
  285. return true;
  286. }
  287. bool PacketDecoder::_doWHOIS(const RuntimeEnvironment *_r,const SharedPtr<Peer> &peer)
  288. {
  289. if (payloadLength() == ZT_ADDRESS_LENGTH) {
  290. SharedPtr<Peer> p(_r->topology->getPeer(Address(payload(),ZT_ADDRESS_LENGTH)));
  291. if (p) {
  292. Packet outp(source(),_r->identity.address(),Packet::VERB_OK);
  293. outp.append((unsigned char)Packet::VERB_WHOIS);
  294. outp.append(packetId());
  295. p->identity().serialize(outp,false);
  296. outp.encrypt(peer->cryptKey());
  297. outp.hmacSet(peer->macKey());
  298. _r->demarc->send(_localPort,_remoteAddress,outp.data(),outp.size(),-1);
  299. TRACE("sent WHOIS response to %s for %s",source().toString().c_str(),Address(payload(),ZT_ADDRESS_LENGTH).toString().c_str());
  300. } else {
  301. Packet outp(source(),_r->identity.address(),Packet::VERB_ERROR);
  302. outp.append((unsigned char)Packet::VERB_WHOIS);
  303. outp.append(packetId());
  304. outp.append((unsigned char)Packet::ERROR_NOT_FOUND);
  305. outp.append(payload(),ZT_ADDRESS_LENGTH);
  306. outp.encrypt(peer->cryptKey());
  307. outp.hmacSet(peer->macKey());
  308. _r->demarc->send(_localPort,_remoteAddress,outp.data(),outp.size(),-1);
  309. TRACE("sent WHOIS ERROR to %s for %s (not found)",source().toString().c_str(),Address(payload(),ZT_ADDRESS_LENGTH).toString().c_str());
  310. }
  311. } else {
  312. TRACE("dropped WHOIS from %s(%s): missing or invalid address",source().toString().c_str(),_remoteAddress.toString().c_str());
  313. }
  314. return true;
  315. }
  316. bool PacketDecoder::_doRENDEZVOUS(const RuntimeEnvironment *_r,const SharedPtr<Peer> &peer)
  317. {
  318. try {
  319. Address with(field(ZT_PROTO_VERB_RENDEZVOUS_IDX_ZTADDRESS,ZT_ADDRESS_LENGTH),ZT_ADDRESS_LENGTH);
  320. SharedPtr<Peer> withPeer(_r->topology->getPeer(with));
  321. if (withPeer) {
  322. unsigned int port = at<uint16_t>(ZT_PROTO_VERB_RENDEZVOUS_IDX_PORT);
  323. unsigned int addrlen = (*this)[ZT_PROTO_VERB_RENDEZVOUS_IDX_ADDRLEN];
  324. if ((port > 0)&&((addrlen == 4)||(addrlen == 16))) {
  325. InetAddress atAddr(field(ZT_PROTO_VERB_RENDEZVOUS_IDX_ADDRESS,addrlen),addrlen,port);
  326. 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());
  327. _r->sw->contact(withPeer,atAddr);
  328. } else {
  329. TRACE("dropped corrupt RENDEZVOUS from %s(%s) (bad address or port)",source().toString().c_str(),_remoteAddress.toString().c_str());
  330. }
  331. } else {
  332. TRACE("ignored RENDEZVOUS from %s(%s) to meet unknown peer %s",source().toString().c_str(),_remoteAddress.toString().c_str(),with.toString().c_str());
  333. }
  334. } catch (std::exception &ex) {
  335. TRACE("dropped RENDEZVOUS from %s(%s): %s",source().toString().c_str(),_remoteAddress.toString().c_str(),ex.what());
  336. } catch ( ... ) {
  337. TRACE("dropped RENDEZVOUS from %s(%s): unexpected exception",source().toString().c_str(),_remoteAddress.toString().c_str());
  338. }
  339. return true;
  340. }
  341. bool PacketDecoder::_doFRAME(const RuntimeEnvironment *_r,const SharedPtr<Peer> &peer)
  342. {
  343. try {
  344. SharedPtr<Network> network(_r->nc->network(at<uint64_t>(ZT_PROTO_VERB_FRAME_IDX_NETWORK_ID)));
  345. if (network) {
  346. if (network->isAllowed(source())) {
  347. unsigned int etherType = at<uint16_t>(ZT_PROTO_VERB_FRAME_IDX_ETHERTYPE);
  348. if ((etherType != ZT_ETHERTYPE_ARP)&&(etherType != ZT_ETHERTYPE_IPV4)&&(etherType != ZT_ETHERTYPE_IPV6)) {
  349. TRACE("dropped FRAME from %s: unsupported ethertype",source().toString().c_str());
  350. } else if (size() > ZT_PROTO_VERB_FRAME_IDX_PAYLOAD) {
  351. network->tap().put(source().toMAC(),network->tap().mac(),etherType,data() + ZT_PROTO_VERB_FRAME_IDX_PAYLOAD,size() - ZT_PROTO_VERB_FRAME_IDX_PAYLOAD);
  352. }
  353. } else {
  354. TRACE("dropped FRAME from %s(%s): not a member of closed network %llu",source().toString().c_str(),_remoteAddress.toString().c_str(),network->id());
  355. }
  356. } else {
  357. 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));
  358. }
  359. } catch (std::exception &ex) {
  360. TRACE("dropped FRAME from %s(%s): unexpected exception: %s",source().toString().c_str(),_remoteAddress.toString().c_str(),ex.what());
  361. } catch ( ... ) {
  362. TRACE("dropped FRAME from %s(%s): unexpected exception: (unknown)",source().toString().c_str(),_remoteAddress.toString().c_str());
  363. }
  364. return true;
  365. }
  366. bool PacketDecoder::_doMULTICAST_LIKE(const RuntimeEnvironment *_r,const SharedPtr<Peer> &peer)
  367. {
  368. try {
  369. unsigned int ptr = ZT_PACKET_IDX_PAYLOAD;
  370. unsigned int numAccepted = 0;
  371. uint64_t now = Utils::now();
  372. // Iterate through 18-byte network,MAC,ADI tuples:
  373. while ((ptr + 18) <= size()) {
  374. uint64_t nwid = at<uint64_t>(ptr); ptr += 8;
  375. SharedPtr<Network> network(_r->nc->network(nwid));
  376. if (network) {
  377. if (network->isAllowed(source())) {
  378. MAC mac(field(ptr,6)); ptr += 6;
  379. uint32_t adi = at<uint32_t>(ptr); ptr += 4;
  380. //TRACE("peer %s likes multicast group %s:%.8lx on network %llu",source().toString().c_str(),mac.toString().c_str(),(unsigned long)adi,nwid);
  381. _r->multicaster->likesMulticastGroup(nwid,MulticastGroup(mac,adi),source(),now);
  382. ++numAccepted;
  383. } else {
  384. TRACE("ignored MULTICAST_LIKE from %s(%s): not a member of closed network %llu",source().toString().c_str(),_remoteAddress.toString().c_str(),nwid);
  385. }
  386. } else {
  387. TRACE("ignored MULTICAST_LIKE from %s(%s): network %llu unknown or we are not a member",source().toString().c_str(),_remoteAddress.toString().c_str(),nwid);
  388. }
  389. }
  390. Packet outp(source(),_r->identity.address(),Packet::VERB_OK);
  391. outp.append((unsigned char)Packet::VERB_MULTICAST_LIKE);
  392. outp.append(packetId());
  393. outp.append((uint16_t)numAccepted);
  394. outp.encrypt(peer->cryptKey());
  395. outp.hmacSet(peer->macKey());
  396. _r->demarc->send(_localPort,_remoteAddress,outp.data(),outp.size(),-1);
  397. } catch (std::exception &ex) {
  398. TRACE("dropped MULTICAST_LIKE from %s(%s): unexpected exception: %s",source().toString().c_str(),_remoteAddress.toString().c_str(),ex.what());
  399. } catch ( ... ) {
  400. TRACE("dropped MULTICAST_LIKE from %s(%s): unexpected exception: (unknown)",source().toString().c_str(),_remoteAddress.toString().c_str());
  401. }
  402. return true;
  403. }
  404. bool PacketDecoder::_doMULTICAST_FRAME(const RuntimeEnvironment *_r,const SharedPtr<Peer> &peer)
  405. {
  406. try {
  407. SharedPtr<Network> network(_r->nc->network(at<uint64_t>(ZT_PROTO_VERB_MULTICAST_FRAME_IDX_NETWORK_ID)));
  408. if (network) {
  409. if (network->isAllowed(source())) {
  410. if (size() > ZT_PROTO_VERB_MULTICAST_FRAME_IDX_PAYLOAD) {
  411. Address originalSubmitterAddress(field(ZT_PROTO_VERB_MULTICAST_FRAME_IDX_SUBMITTER_ADDRESS,ZT_ADDRESS_LENGTH),ZT_ADDRESS_LENGTH);
  412. MAC fromMac(field(ZT_PROTO_VERB_MULTICAST_FRAME_IDX_SOURCE_MAC,6));
  413. MulticastGroup mg(MAC(field(ZT_PROTO_VERB_MULTICAST_FRAME_IDX_DESTINATION_MAC,6)),at<uint32_t>(ZT_PROTO_VERB_MULTICAST_FRAME_IDX_ADI));
  414. unsigned int hops = (*this)[ZT_PROTO_VERB_MULTICAST_FRAME_IDX_HOP_COUNT];
  415. unsigned int etherType = at<uint16_t>(ZT_PROTO_VERB_MULTICAST_FRAME_IDX_ETHERTYPE);
  416. unsigned int datalen = at<uint16_t>(ZT_PROTO_VERB_MULTICAST_FRAME_IDX_PAYLOAD_LENGTH);
  417. unsigned int signaturelen = at<uint16_t>(ZT_PROTO_VERB_MULTICAST_FRAME_IDX_SIGNATURE_LENGTH);
  418. unsigned char *dataAndSignature = field(ZT_PROTO_VERB_MULTICAST_FRAME_IDX_PAYLOAD,datalen + signaturelen);
  419. uint64_t mccrc = Multicaster::computeMulticastDedupCrc(network->id(),fromMac,mg,etherType,dataAndSignature,datalen);
  420. uint64_t now = Utils::now();
  421. bool isDuplicate = _r->multicaster->checkDuplicate(mccrc,now);
  422. if (originalSubmitterAddress == _r->identity.address()) {
  423. // Technically should not happen, since the original submitter is
  424. // excluded from consideration as a propagation recipient.
  425. TRACE("dropped boomerang MULTICAST_FRAME received from %s(%s)",source().toString().c_str(),_remoteAddress.toString().c_str());
  426. } else if ((!isDuplicate)||(_r->topology->amSupernode())) {
  427. //
  428. // If I am a supernode, I will repeatedly propagate duplicates. That's
  429. // because supernodes are used to bridge sparse multicast groups. Non-
  430. // supernodes will ignore duplicates completely.
  431. //
  432. // TODO: supernodes should keep a local bloom filter too and OR it with
  433. // the bloom from the packet in order to pick different recipients each
  434. // time a multicast returns to them for repropagation.
  435. //
  436. SharedPtr<Peer> originalSubmitter(_r->topology->getPeer(originalSubmitterAddress));
  437. if (!originalSubmitter) {
  438. TRACE("requesting WHOIS on original multicast frame submitter %s",originalSubmitterAddress.toString().c_str());
  439. _r->sw->requestWhois(originalSubmitterAddress);
  440. _step = DECODE_STEP_WAITING_FOR_ORIGINAL_SUBMITTER_LOOKUP;
  441. return false; // try again if/when we get OK(WHOIS)
  442. } else if (Multicaster::verifyMulticastPacket(originalSubmitter->identity(),network->id(),fromMac,mg,etherType,dataAndSignature,datalen,dataAndSignature + datalen,signaturelen)) {
  443. _r->multicaster->addToDedupHistory(mccrc,now);
  444. // Even if we are a supernode, we still don't repeatedly inject
  445. // duplicates into our own tap.
  446. if (!isDuplicate)
  447. network->tap().put(fromMac,mg.mac(),etherType,dataAndSignature,datalen);
  448. if (++hops < ZT_MULTICAST_PROPAGATION_DEPTH) {
  449. Address upstream(source()); // save this since we mangle it
  450. Multicaster::MulticastBloomFilter bloom(field(ZT_PROTO_VERB_MULTICAST_FRAME_IDX_BLOOM_FILTER,ZT_PROTO_VERB_MULTICAST_FRAME_BLOOM_FILTER_SIZE_BYTES));
  451. SharedPtr<Peer> propPeers[ZT_MULTICAST_PROPAGATION_BREADTH];
  452. unsigned int np = _r->multicaster->pickNextPropagationPeers(
  453. *(_r->prng),
  454. *(_r->topology),
  455. network->id(),
  456. mg,
  457. originalSubmitterAddress,
  458. upstream,
  459. bloom,
  460. ZT_MULTICAST_PROPAGATION_BREADTH,
  461. propPeers,
  462. now);
  463. // In a bit of a hack, we re-use this packet to repeat it
  464. // to our multicast propagation recipients. Afterwords we
  465. // return true just to be sure this is the end of this
  466. // packet's life cycle, since it is now mangled.
  467. setSource(_r->identity.address());
  468. (*this)[ZT_PROTO_VERB_MULTICAST_FRAME_IDX_HOP_COUNT] = hops;
  469. memcpy(field(ZT_PROTO_VERB_MULTICAST_FRAME_IDX_BLOOM_FILTER,ZT_PROTO_VERB_MULTICAST_FRAME_BLOOM_FILTER_SIZE_BYTES),bloom.data(),ZT_PROTO_VERB_MULTICAST_FRAME_BLOOM_FILTER_SIZE_BYTES);
  470. compress();
  471. for(unsigned int i=0;i<np;++i) {
  472. //TRACE("propagating multicast from original node %s: %s -> %s",originalSubmitterAddress.toString().c_str(),upstream.toString().c_str(),propPeers[i]->address().toString().c_str());
  473. // Re-use this packet to re-send multicast frame to everyone
  474. // downstream from us.
  475. newInitializationVector();
  476. setDestination(propPeers[i]->address());
  477. _r->sw->send(*this,true);
  478. }
  479. return true;
  480. } else {
  481. //TRACE("terminating MULTICAST_FRAME propagation from %s(%s): max depth reached",source().toString().c_str(),_remoteAddress.toString().c_str());
  482. }
  483. } else {
  484. LOG("rejected MULTICAST_FRAME from %s(%s) due to failed signature check (claims original sender %s)",source().toString().c_str(),_remoteAddress.toString().c_str(),originalSubmitterAddress.toString().c_str());
  485. }
  486. } else {
  487. TRACE("dropped redundant MULTICAST_FRAME from %s(%s)",source().toString().c_str(),_remoteAddress.toString().c_str());
  488. }
  489. } else {
  490. TRACE("dropped MULTICAST_FRAME from %s(%s): invalid short packet",source().toString().c_str(),_remoteAddress.toString().c_str());
  491. }
  492. } else {
  493. TRACE("dropped MULTICAST_FRAME from %s(%s): not a member of closed network %llu",source().toString().c_str(),_remoteAddress.toString().c_str(),network->id());
  494. }
  495. } else {
  496. TRACE("dropped MULTICAST_FRAME from %s(%s): network %llu unknown or we are not a member",source().toString().c_str(),_remoteAddress.toString().c_str(),at<uint64_t>(ZT_PROTO_VERB_MULTICAST_FRAME_IDX_NETWORK_ID));
  497. }
  498. } catch (std::exception &ex) {
  499. TRACE("dropped MULTICAST_FRAME from %s(%s): unexpected exception: %s",source().toString().c_str(),_remoteAddress.toString().c_str(),ex.what());
  500. } catch ( ... ) {
  501. TRACE("dropped MULTICAST_FRAME from %s(%s): unexpected exception: (unknown)",source().toString().c_str(),_remoteAddress.toString().c_str());
  502. }
  503. return true;
  504. }
  505. bool PacketDecoder::_doNETWORK_MEMBERSHIP_CERTIFICATE(const RuntimeEnvironment *_r,const SharedPtr<Peer> &peer)
  506. {
  507. // TODO: not implemented yet, will be needed for private networks.
  508. return true;
  509. }
  510. bool PacketDecoder::_doNETWORK_CONFIG_REQUEST(const RuntimeEnvironment *_r,const SharedPtr<Peer> &peer)
  511. {
  512. char tmp[128];
  513. try {
  514. uint64_t nwid = at<uint64_t>(ZT_PROTO_VERB_NETWORK_CONFIG_REQUEST_IDX_NETWORK_ID);
  515. #ifndef __WINDOWS__
  516. if (_r->netconfService) {
  517. unsigned int dictLen = at<uint16_t>(ZT_PROTO_VERB_NETWORK_CONFIG_REQUEST_IDX_DICT_LEN);
  518. std::string dict((const char *)field(ZT_PROTO_VERB_NETWORK_CONFIG_REQUEST_IDX_DICT,dictLen),dictLen);
  519. Dictionary request;
  520. request["type"] = "netconf-request";
  521. request["peerId"] = peer->identity().toString(false);
  522. sprintf(tmp,"%llx",(unsigned long long)nwid);
  523. request["nwid"] = tmp;
  524. sprintf(tmp,"%llx",(unsigned long long)packetId());
  525. request["requestId"] = tmp;
  526. _r->netconfService->send(request);
  527. } else {
  528. #endif // !__WINDOWS__
  529. Packet outp(source(),_r->identity.address(),Packet::VERB_ERROR);
  530. outp.append((unsigned char)Packet::VERB_NETWORK_CONFIG_REQUEST);
  531. outp.append(packetId());
  532. outp.append((unsigned char)Packet::ERROR_UNSUPPORTED_OPERATION);
  533. outp.append(nwid);
  534. outp.encrypt(peer->cryptKey());
  535. outp.hmacSet(peer->macKey());
  536. _r->demarc->send(_localPort,_remoteAddress,outp.data(),outp.size(),-1);
  537. TRACE("sent ERROR(NETWORK_CONFIG_REQUEST,UNSUPPORTED_OPERATION) to %s(%s)",peer->address().toString().c_str(),_remoteAddress.toString().c_str());
  538. #ifndef __WINDOWS__
  539. }
  540. #endif // !__WINDOWS__
  541. } catch (std::exception &exc) {
  542. TRACE("dropped NETWORK_CONFIG_REQUEST from %s(%s): unexpected exception: %s",source().toString().c_str(),_remoteAddress.toString().c_str(),exc.what());
  543. } catch ( ... ) {
  544. TRACE("dropped NETWORK_CONFIG_REQUEST from %s(%s): unexpected exception: (unknown)",source().toString().c_str(),_remoteAddress.toString().c_str());
  545. }
  546. return true;
  547. }
  548. bool PacketDecoder::_doNETWORK_CONFIG_REFRESH(const RuntimeEnvironment *_r,const SharedPtr<Peer> &peer)
  549. {
  550. try {
  551. uint64_t nwid = at<uint64_t>(ZT_PROTO_VERB_NETWORK_CONFIG_REFRESH_IDX_NETWORK_ID);
  552. SharedPtr<Network> nw(_r->nc->network(nwid));
  553. if ((nw)&&(source() == nw->controller())) // only respond to requests from controller
  554. nw->requestConfiguration();
  555. } catch (std::exception &exc) {
  556. TRACE("dropped NETWORK_CONFIG_REFRESH from %s(%s): unexpected exception: %s",source().toString().c_str(),_remoteAddress.toString().c_str(),exc.what());
  557. } catch ( ... ) {
  558. TRACE("dropped NETWORK_CONFIG_REFRESH from %s(%s): unexpected exception: (unknown)",source().toString().c_str(),_remoteAddress.toString().c_str());
  559. }
  560. return true;
  561. }
  562. } // namespace ZeroTier