IncomingPacket.cpp 56 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224
  1. /*
  2. * ZeroTier One - Network Virtualization Everywhere
  3. * Copyright (C) 2011-2015 ZeroTier, Inc.
  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 <stdio.h>
  28. #include <string.h>
  29. #include <stdlib.h>
  30. #include "../version.h"
  31. #include "../include/ZeroTierOne.h"
  32. #include "Constants.hpp"
  33. #include "Defaults.hpp"
  34. #include "RuntimeEnvironment.hpp"
  35. #include "IncomingPacket.hpp"
  36. #include "Topology.hpp"
  37. #include "Switch.hpp"
  38. #include "Peer.hpp"
  39. #include "NetworkController.hpp"
  40. #include "SelfAwareness.hpp"
  41. #include "Salsa20.hpp"
  42. #include "SHA512.hpp"
  43. namespace ZeroTier {
  44. bool IncomingPacket::tryDecode(const RuntimeEnvironment *RR)
  45. {
  46. const Address sourceAddress(source());
  47. try {
  48. if ((cipher() == ZT_PROTO_CIPHER_SUITE__C25519_POLY1305_NONE)&&(verb() == Packet::VERB_HELLO)) {
  49. // Unencrypted HELLOs are handled here since they are used to
  50. // populate our identity cache in the first place. _doHELLO() is special
  51. // in that it contains its own authentication logic.
  52. return _doHELLO(RR);
  53. }
  54. SharedPtr<Peer> peer = RR->topology->getPeer(sourceAddress);
  55. if (peer) {
  56. if (!dearmor(peer->key())) {
  57. TRACE("dropped packet from %s(%s), MAC authentication failed (size: %u)",peer->address().toString().c_str(),_remoteAddress.toString().c_str(),size());
  58. return true;
  59. }
  60. if (!uncompress()) {
  61. TRACE("dropped packet from %s(%s), compressed data invalid",peer->address().toString().c_str(),_remoteAddress.toString().c_str());
  62. return true;
  63. }
  64. //TRACE("<< %s from %s(%s)",Packet::verbString(v),sourceAddress.toString().c_str(),_remoteAddress.toString().c_str());
  65. const Packet::Verb v = verb();
  66. switch(v) {
  67. //case Packet::VERB_NOP:
  68. default: // ignore unknown verbs, but if they pass auth check they are "received"
  69. peer->received(RR,_localAddress,_remoteAddress,hops(),packetId(),v,0,Packet::VERB_NOP);
  70. return true;
  71. case Packet::VERB_HELLO: return _doHELLO(RR);
  72. case Packet::VERB_ERROR: return _doERROR(RR,peer);
  73. case Packet::VERB_OK: return _doOK(RR,peer);
  74. case Packet::VERB_WHOIS: return _doWHOIS(RR,peer);
  75. case Packet::VERB_RENDEZVOUS: return _doRENDEZVOUS(RR,peer);
  76. case Packet::VERB_FRAME: return _doFRAME(RR,peer);
  77. case Packet::VERB_EXT_FRAME: return _doEXT_FRAME(RR,peer);
  78. case Packet::VERB_ECHO: return _doECHO(RR,peer);
  79. case Packet::VERB_MULTICAST_LIKE: return _doMULTICAST_LIKE(RR,peer);
  80. case Packet::VERB_NETWORK_MEMBERSHIP_CERTIFICATE: return _doNETWORK_MEMBERSHIP_CERTIFICATE(RR,peer);
  81. case Packet::VERB_NETWORK_CONFIG_REQUEST: return _doNETWORK_CONFIG_REQUEST(RR,peer);
  82. case Packet::VERB_NETWORK_CONFIG_REFRESH: return _doNETWORK_CONFIG_REFRESH(RR,peer);
  83. case Packet::VERB_MULTICAST_GATHER: return _doMULTICAST_GATHER(RR,peer);
  84. case Packet::VERB_MULTICAST_FRAME: return _doMULTICAST_FRAME(RR,peer);
  85. case Packet::VERB_PUSH_DIRECT_PATHS: return _doPUSH_DIRECT_PATHS(RR,peer);
  86. case Packet::VERB_CIRCUIT_TEST: return _doCIRCUIT_TEST(RR,peer);
  87. case Packet::VERB_CIRCUIT_TEST_REPORT: return _doCIRCUIT_TEST_REPORT(RR,peer);
  88. case Packet::VERB_REQUEST_PROOF_OF_WORK: return _doREQUEST_PROOF_OF_WORK(RR,peer);
  89. }
  90. } else {
  91. RR->sw->requestWhois(sourceAddress);
  92. return false;
  93. }
  94. } catch ( ... ) {
  95. // Exceptions are more informatively caught in _do...() handlers but
  96. // this outer try/catch will catch anything else odd.
  97. TRACE("dropped ??? from %s(%s): unexpected exception in tryDecode()",sourceAddress.toString().c_str(),_remoteAddress.toString().c_str());
  98. return true;
  99. }
  100. }
  101. bool IncomingPacket::_doERROR(const RuntimeEnvironment *RR,const SharedPtr<Peer> &peer)
  102. {
  103. try {
  104. const Packet::Verb inReVerb = (Packet::Verb)(*this)[ZT_PROTO_VERB_ERROR_IDX_IN_RE_VERB];
  105. const uint64_t inRePacketId = at<uint64_t>(ZT_PROTO_VERB_ERROR_IDX_IN_RE_PACKET_ID);
  106. const Packet::ErrorCode errorCode = (Packet::ErrorCode)(*this)[ZT_PROTO_VERB_ERROR_IDX_ERROR_CODE];
  107. //TRACE("ERROR %s from %s(%s) in-re %s",Packet::errorString(errorCode),peer->address().toString().c_str(),_remoteAddress.toString().c_str(),Packet::verbString(inReVerb));
  108. switch(errorCode) {
  109. case Packet::ERROR_OBJ_NOT_FOUND:
  110. if (inReVerb == Packet::VERB_WHOIS) {
  111. if (RR->topology->isRoot(peer->identity()))
  112. RR->sw->cancelWhoisRequest(Address(field(ZT_PROTO_VERB_ERROR_IDX_PAYLOAD,ZT_ADDRESS_LENGTH),ZT_ADDRESS_LENGTH));
  113. } else if (inReVerb == Packet::VERB_NETWORK_CONFIG_REQUEST) {
  114. SharedPtr<Network> network(RR->node->network(at<uint64_t>(ZT_PROTO_VERB_ERROR_IDX_PAYLOAD)));
  115. if ((network)&&(network->controller() == peer->address()))
  116. network->setNotFound();
  117. }
  118. break;
  119. case Packet::ERROR_UNSUPPORTED_OPERATION:
  120. if (inReVerb == Packet::VERB_NETWORK_CONFIG_REQUEST) {
  121. SharedPtr<Network> network(RR->node->network(at<uint64_t>(ZT_PROTO_VERB_ERROR_IDX_PAYLOAD)));
  122. if ((network)&&(network->controller() == peer->address()))
  123. network->setNotFound();
  124. }
  125. break;
  126. case Packet::ERROR_IDENTITY_COLLISION:
  127. if (RR->topology->isRoot(peer->identity()))
  128. RR->node->postEvent(ZT_EVENT_FATAL_ERROR_IDENTITY_COLLISION);
  129. break;
  130. case Packet::ERROR_NEED_MEMBERSHIP_CERTIFICATE: {
  131. /* Note: certificates are public so it's safe to push them to anyone
  132. * who asks. We won't communicate unless we also get a certificate
  133. * from the remote that agrees. */
  134. SharedPtr<Network> network(RR->node->network(at<uint64_t>(ZT_PROTO_VERB_ERROR_IDX_PAYLOAD)));
  135. if (network) {
  136. SharedPtr<NetworkConfig> nconf(network->config2());
  137. if (nconf) {
  138. Packet outp(peer->address(),RR->identity.address(),Packet::VERB_NETWORK_MEMBERSHIP_CERTIFICATE);
  139. nconf->com().serialize(outp);
  140. outp.armor(peer->key(),true);
  141. RR->node->putPacket(_localAddress,_remoteAddress,outp.data(),outp.size());
  142. }
  143. }
  144. } break;
  145. case Packet::ERROR_NETWORK_ACCESS_DENIED_: {
  146. SharedPtr<Network> network(RR->node->network(at<uint64_t>(ZT_PROTO_VERB_ERROR_IDX_PAYLOAD)));
  147. if ((network)&&(network->controller() == peer->address()))
  148. network->setAccessDenied();
  149. } break;
  150. case Packet::ERROR_UNWANTED_MULTICAST: {
  151. uint64_t nwid = at<uint64_t>(ZT_PROTO_VERB_ERROR_IDX_PAYLOAD);
  152. MulticastGroup mg(MAC(field(ZT_PROTO_VERB_ERROR_IDX_PAYLOAD + 8,6),6),at<uint32_t>(ZT_PROTO_VERB_ERROR_IDX_PAYLOAD + 14));
  153. TRACE("%.16llx: peer %s unsubscrubed from multicast group %s",nwid,peer->address().toString().c_str(),mg.toString().c_str());
  154. RR->mc->remove(nwid,mg,peer->address());
  155. } break;
  156. default: break;
  157. }
  158. peer->received(RR,_localAddress,_remoteAddress,hops(),packetId(),Packet::VERB_ERROR,inRePacketId,inReVerb);
  159. } catch ( ... ) {
  160. TRACE("dropped ERROR from %s(%s): unexpected exception",peer->address().toString().c_str(),_remoteAddress.toString().c_str());
  161. }
  162. return true;
  163. }
  164. bool IncomingPacket::_doHELLO(const RuntimeEnvironment *RR)
  165. {
  166. /* Note: this is the only packet ever sent in the clear, and it's also
  167. * the only packet that we authenticate via a different path. Authentication
  168. * occurs here and is based on the validity of the identity and the
  169. * integrity of the packet's MAC, but it must be done after we check
  170. * the identity since HELLO is a mechanism for learning new identities
  171. * in the first place. */
  172. try {
  173. const uint64_t pid = packetId();
  174. const Address fromAddress(source());
  175. const unsigned int protoVersion = (*this)[ZT_PROTO_VERB_HELLO_IDX_PROTOCOL_VERSION];
  176. const unsigned int vMajor = (*this)[ZT_PROTO_VERB_HELLO_IDX_MAJOR_VERSION];
  177. const unsigned int vMinor = (*this)[ZT_PROTO_VERB_HELLO_IDX_MINOR_VERSION];
  178. const unsigned int vRevision = at<uint16_t>(ZT_PROTO_VERB_HELLO_IDX_REVISION);
  179. const uint64_t timestamp = at<uint64_t>(ZT_PROTO_VERB_HELLO_IDX_TIMESTAMP);
  180. Identity id;
  181. const unsigned int destAddrPtr = ZT_PROTO_VERB_HELLO_IDX_IDENTITY + id.deserialize(*this,ZT_PROTO_VERB_HELLO_IDX_IDENTITY);
  182. InetAddress destAddr;
  183. if (destAddrPtr < size()) // ZeroTier One < 1.0.3 did not include this field
  184. destAddr.deserialize(*this,destAddrPtr);
  185. if (protoVersion < ZT_PROTO_VERSION_MIN) {
  186. TRACE("dropped HELLO from %s(%s): protocol version too old",id.address().toString().c_str(),_remoteAddress.toString().c_str());
  187. return true;
  188. }
  189. if (fromAddress != id.address()) {
  190. TRACE("dropped HELLO from %s(%s): identity not for sending address",fromAddress.toString().c_str(),_remoteAddress.toString().c_str());
  191. return true;
  192. }
  193. SharedPtr<Peer> peer(RR->topology->getPeer(id.address()));
  194. if (peer) {
  195. // We already have an identity with this address -- check for collisions
  196. if (peer->identity() != id) {
  197. // Identity is different from the one we already have -- address collision
  198. unsigned char key[ZT_PEER_SECRET_KEY_LENGTH];
  199. if (RR->identity.agree(id,key,ZT_PEER_SECRET_KEY_LENGTH)) {
  200. if (dearmor(key)) { // ensure packet is authentic, otherwise drop
  201. TRACE("rejected HELLO from %s(%s): address already claimed",id.address().toString().c_str(),_remoteAddress.toString().c_str());
  202. Packet outp(id.address(),RR->identity.address(),Packet::VERB_ERROR);
  203. outp.append((unsigned char)Packet::VERB_HELLO);
  204. outp.append((uint64_t)pid);
  205. outp.append((unsigned char)Packet::ERROR_IDENTITY_COLLISION);
  206. outp.armor(key,true);
  207. RR->node->putPacket(_localAddress,_remoteAddress,outp.data(),outp.size());
  208. } else {
  209. TRACE("rejected HELLO from %s(%s): packet failed authentication",id.address().toString().c_str(),_remoteAddress.toString().c_str());
  210. }
  211. } else {
  212. TRACE("rejected HELLO from %s(%s): key agreement failed",id.address().toString().c_str(),_remoteAddress.toString().c_str());
  213. }
  214. return true;
  215. } else {
  216. // Identity is the same as the one we already have -- check packet integrity
  217. if (!dearmor(peer->key())) {
  218. TRACE("rejected HELLO from %s(%s): packet failed authentication",id.address().toString().c_str(),_remoteAddress.toString().c_str());
  219. return true;
  220. }
  221. // Continue at // VALID
  222. }
  223. } else {
  224. // We don't already have an identity with this address -- validate and learn it
  225. // Check identity proof of work
  226. if (!id.locallyValidate()) {
  227. TRACE("dropped HELLO from %s(%s): identity invalid",id.address().toString().c_str(),_remoteAddress.toString().c_str());
  228. return true;
  229. }
  230. // Check packet integrity and authentication
  231. SharedPtr<Peer> newPeer(new Peer(RR->identity,id));
  232. if (!dearmor(newPeer->key())) {
  233. TRACE("rejected HELLO from %s(%s): packet failed authentication",id.address().toString().c_str(),_remoteAddress.toString().c_str());
  234. return true;
  235. }
  236. peer = RR->topology->addPeer(newPeer);
  237. // Continue at // VALID
  238. }
  239. // VALID -- if we made it here, packet passed identity and authenticity checks!
  240. peer->received(RR,_localAddress,_remoteAddress,hops(),pid,Packet::VERB_HELLO,0,Packet::VERB_NOP);
  241. peer->setRemoteVersion(protoVersion,vMajor,vMinor,vRevision);
  242. if (destAddr)
  243. RR->sa->iam(id.address(),_remoteAddress,destAddr,RR->topology->isRoot(id),RR->node->now());
  244. Packet outp(id.address(),RR->identity.address(),Packet::VERB_OK);
  245. outp.append((unsigned char)Packet::VERB_HELLO);
  246. outp.append((uint64_t)pid);
  247. outp.append((uint64_t)timestamp);
  248. outp.append((unsigned char)ZT_PROTO_VERSION);
  249. outp.append((unsigned char)ZEROTIER_ONE_VERSION_MAJOR);
  250. outp.append((unsigned char)ZEROTIER_ONE_VERSION_MINOR);
  251. outp.append((uint16_t)ZEROTIER_ONE_VERSION_REVISION);
  252. _remoteAddress.serialize(outp);
  253. outp.armor(peer->key(),true);
  254. RR->node->putPacket(_localAddress,_remoteAddress,outp.data(),outp.size());
  255. } catch ( ... ) {
  256. TRACE("dropped HELLO from %s(%s): unexpected exception",source().toString().c_str(),_remoteAddress.toString().c_str());
  257. }
  258. return true;
  259. }
  260. bool IncomingPacket::_doOK(const RuntimeEnvironment *RR,const SharedPtr<Peer> &peer)
  261. {
  262. try {
  263. const Packet::Verb inReVerb = (Packet::Verb)(*this)[ZT_PROTO_VERB_OK_IDX_IN_RE_VERB];
  264. const uint64_t inRePacketId = at<uint64_t>(ZT_PROTO_VERB_OK_IDX_IN_RE_PACKET_ID);
  265. //TRACE("%s(%s): OK(%s)",source().toString().c_str(),_remoteAddress.toString().c_str(),Packet::verbString(inReVerb));
  266. switch(inReVerb) {
  267. case Packet::VERB_HELLO: {
  268. const unsigned int latency = std::min((unsigned int)(RR->node->now() - at<uint64_t>(ZT_PROTO_VERB_HELLO__OK__IDX_TIMESTAMP)),(unsigned int)0xffff);
  269. const unsigned int vProto = (*this)[ZT_PROTO_VERB_HELLO__OK__IDX_PROTOCOL_VERSION];
  270. const unsigned int vMajor = (*this)[ZT_PROTO_VERB_HELLO__OK__IDX_MAJOR_VERSION];
  271. const unsigned int vMinor = (*this)[ZT_PROTO_VERB_HELLO__OK__IDX_MINOR_VERSION];
  272. const unsigned int vRevision = at<uint16_t>(ZT_PROTO_VERB_HELLO__OK__IDX_REVISION);
  273. InetAddress destAddr;
  274. if ((ZT_PROTO_VERB_HELLO__OK__IDX_REVISION + 2) < size()) // ZeroTier One < 1.0.3 did not include this field
  275. destAddr.deserialize(*this,ZT_PROTO_VERB_HELLO__OK__IDX_REVISION + 2);
  276. if (vProto < ZT_PROTO_VERSION_MIN) {
  277. TRACE("%s(%s): OK(HELLO) dropped, protocol version too old",source().toString().c_str(),_remoteAddress.toString().c_str());
  278. return true;
  279. }
  280. TRACE("%s(%s): OK(HELLO), version %u.%u.%u, latency %u, reported external address %s",source().toString().c_str(),_remoteAddress.toString().c_str(),vMajor,vMinor,vRevision,latency,((destAddr) ? destAddr.toString().c_str() : "(none)"));
  281. peer->addDirectLatencyMeasurment(latency);
  282. peer->setRemoteVersion(vProto,vMajor,vMinor,vRevision);
  283. bool trusted = RR->topology->isRoot(peer->identity());
  284. if (destAddr)
  285. RR->sa->iam(peer->address(),_remoteAddress,destAddr,trusted,RR->node->now());
  286. } break;
  287. case Packet::VERB_WHOIS: {
  288. /* Right now only root servers are allowed to send OK(WHOIS) to prevent
  289. * poisoning attacks. Further decentralization will require some other
  290. * kind of trust mechanism. */
  291. if (RR->topology->isRoot(peer->identity())) {
  292. const Identity id(*this,ZT_PROTO_VERB_WHOIS__OK__IDX_IDENTITY);
  293. if (id.locallyValidate())
  294. RR->sw->doAnythingWaitingForPeer(RR->topology->addPeer(SharedPtr<Peer>(new Peer(RR->identity,id))));
  295. }
  296. } break;
  297. case Packet::VERB_NETWORK_CONFIG_REQUEST: {
  298. const SharedPtr<Network> nw(RR->node->network(at<uint64_t>(ZT_PROTO_VERB_NETWORK_CONFIG_REQUEST__OK__IDX_NETWORK_ID)));
  299. if ((nw)&&(nw->controller() == peer->address())) {
  300. const unsigned int dictlen = at<uint16_t>(ZT_PROTO_VERB_NETWORK_CONFIG_REQUEST__OK__IDX_DICT_LEN);
  301. const std::string dict((const char *)field(ZT_PROTO_VERB_NETWORK_CONFIG_REQUEST__OK__IDX_DICT,dictlen),dictlen);
  302. if (dict.length()) {
  303. nw->setConfiguration(Dictionary(dict));
  304. TRACE("got network configuration for network %.16llx from %s",(unsigned long long)nw->id(),source().toString().c_str());
  305. }
  306. }
  307. } break;
  308. case Packet::VERB_MULTICAST_GATHER: {
  309. const uint64_t nwid = at<uint64_t>(ZT_PROTO_VERB_MULTICAST_GATHER__OK__IDX_NETWORK_ID);
  310. const MulticastGroup mg(MAC(field(ZT_PROTO_VERB_MULTICAST_GATHER__OK__IDX_MAC,6),6),at<uint32_t>(ZT_PROTO_VERB_MULTICAST_GATHER__OK__IDX_ADI));
  311. TRACE("%s(%s): OK(MULTICAST_GATHER) %.16llx/%s length %u",source().toString().c_str(),_remoteAddress.toString().c_str(),nwid,mg.toString().c_str(),size());
  312. const unsigned int count = at<uint16_t>(ZT_PROTO_VERB_MULTICAST_GATHER__OK__IDX_GATHER_RESULTS + 4);
  313. RR->mc->addMultiple(RR->node->now(),nwid,mg,field(ZT_PROTO_VERB_MULTICAST_GATHER__OK__IDX_GATHER_RESULTS + 6,count * 5),count,at<uint32_t>(ZT_PROTO_VERB_MULTICAST_GATHER__OK__IDX_GATHER_RESULTS));
  314. } break;
  315. case Packet::VERB_MULTICAST_FRAME: {
  316. const unsigned int flags = (*this)[ZT_PROTO_VERB_MULTICAST_FRAME__OK__IDX_FLAGS];
  317. const uint64_t nwid = at<uint64_t>(ZT_PROTO_VERB_MULTICAST_FRAME__OK__IDX_NETWORK_ID);
  318. const MulticastGroup mg(MAC(field(ZT_PROTO_VERB_MULTICAST_FRAME__OK__IDX_MAC,6),6),at<uint32_t>(ZT_PROTO_VERB_MULTICAST_FRAME__OK__IDX_ADI));
  319. //TRACE("%s(%s): OK(MULTICAST_FRAME) %.16llx/%s flags %.2x",peer->address().toString().c_str(),_remoteAddress.toString().c_str(),nwid,mg.toString().c_str(),flags);
  320. unsigned int offset = 0;
  321. if ((flags & 0x01) != 0) {
  322. // OK(MULTICAST_FRAME) includes certificate of membership update
  323. CertificateOfMembership com;
  324. offset += com.deserialize(*this,ZT_PROTO_VERB_MULTICAST_FRAME__OK__IDX_COM_AND_GATHER_RESULTS);
  325. peer->validateAndSetNetworkMembershipCertificate(RR,nwid,com);
  326. }
  327. if ((flags & 0x02) != 0) {
  328. // OK(MULTICAST_FRAME) includes implicit gather results
  329. offset += ZT_PROTO_VERB_MULTICAST_FRAME__OK__IDX_COM_AND_GATHER_RESULTS;
  330. unsigned int totalKnown = at<uint32_t>(offset); offset += 4;
  331. unsigned int count = at<uint16_t>(offset); offset += 2;
  332. RR->mc->addMultiple(RR->node->now(),nwid,mg,field(offset,count * 5),count,totalKnown);
  333. }
  334. } break;
  335. default: break;
  336. }
  337. peer->received(RR,_localAddress,_remoteAddress,hops(),packetId(),Packet::VERB_OK,inRePacketId,inReVerb);
  338. } catch ( ... ) {
  339. TRACE("dropped OK from %s(%s): unexpected exception",source().toString().c_str(),_remoteAddress.toString().c_str());
  340. }
  341. return true;
  342. }
  343. bool IncomingPacket::_doWHOIS(const RuntimeEnvironment *RR,const SharedPtr<Peer> &peer)
  344. {
  345. try {
  346. if (payloadLength() == ZT_ADDRESS_LENGTH) {
  347. const SharedPtr<Peer> queried(RR->topology->getPeer(Address(payload(),ZT_ADDRESS_LENGTH)));
  348. if (queried) {
  349. Packet outp(peer->address(),RR->identity.address(),Packet::VERB_OK);
  350. outp.append((unsigned char)Packet::VERB_WHOIS);
  351. outp.append(packetId());
  352. queried->identity().serialize(outp,false);
  353. outp.armor(peer->key(),true);
  354. RR->node->putPacket(_localAddress,_remoteAddress,outp.data(),outp.size());
  355. } else {
  356. Packet outp(peer->address(),RR->identity.address(),Packet::VERB_ERROR);
  357. outp.append((unsigned char)Packet::VERB_WHOIS);
  358. outp.append(packetId());
  359. outp.append((unsigned char)Packet::ERROR_OBJ_NOT_FOUND);
  360. outp.append(payload(),ZT_ADDRESS_LENGTH);
  361. outp.armor(peer->key(),true);
  362. RR->node->putPacket(_localAddress,_remoteAddress,outp.data(),outp.size());
  363. }
  364. } else {
  365. TRACE("dropped WHOIS from %s(%s): missing or invalid address",source().toString().c_str(),_remoteAddress.toString().c_str());
  366. }
  367. peer->received(RR,_localAddress,_remoteAddress,hops(),packetId(),Packet::VERB_WHOIS,0,Packet::VERB_NOP);
  368. } catch ( ... ) {
  369. TRACE("dropped WHOIS from %s(%s): unexpected exception",source().toString().c_str(),_remoteAddress.toString().c_str());
  370. }
  371. return true;
  372. }
  373. bool IncomingPacket::_doRENDEZVOUS(const RuntimeEnvironment *RR,const SharedPtr<Peer> &peer)
  374. {
  375. try {
  376. const Address with(field(ZT_PROTO_VERB_RENDEZVOUS_IDX_ZTADDRESS,ZT_ADDRESS_LENGTH),ZT_ADDRESS_LENGTH);
  377. const SharedPtr<Peer> withPeer(RR->topology->getPeer(with));
  378. if (withPeer) {
  379. const unsigned int port = at<uint16_t>(ZT_PROTO_VERB_RENDEZVOUS_IDX_PORT);
  380. const unsigned int addrlen = (*this)[ZT_PROTO_VERB_RENDEZVOUS_IDX_ADDRLEN];
  381. if ((port > 0)&&((addrlen == 4)||(addrlen == 16))) {
  382. InetAddress atAddr(field(ZT_PROTO_VERB_RENDEZVOUS_IDX_ADDRESS,addrlen),addrlen,port);
  383. TRACE("RENDEZVOUS from %s says %s might be at %s, starting NAT-t",peer->address().toString().c_str(),with.toString().c_str(),atAddr.toString().c_str());
  384. peer->received(RR,_localAddress,_remoteAddress,hops(),packetId(),Packet::VERB_RENDEZVOUS,0,Packet::VERB_NOP);
  385. RR->sw->rendezvous(withPeer,_localAddress,atAddr);
  386. } else {
  387. TRACE("dropped corrupt RENDEZVOUS from %s(%s) (bad address or port)",peer->address().toString().c_str(),_remoteAddress.toString().c_str());
  388. }
  389. } else {
  390. TRACE("ignored RENDEZVOUS from %s(%s) to meet unknown peer %s",peer->address().toString().c_str(),_remoteAddress.toString().c_str(),with.toString().c_str());
  391. }
  392. } catch ( ... ) {
  393. TRACE("dropped RENDEZVOUS from %s(%s): unexpected exception",peer->address().toString().c_str(),_remoteAddress.toString().c_str());
  394. }
  395. return true;
  396. }
  397. bool IncomingPacket::_doFRAME(const RuntimeEnvironment *RR,const SharedPtr<Peer> &peer)
  398. {
  399. try {
  400. const SharedPtr<Network> network(RR->node->network(at<uint64_t>(ZT_PROTO_VERB_FRAME_IDX_NETWORK_ID)));
  401. if (network) {
  402. if (size() > ZT_PROTO_VERB_FRAME_IDX_PAYLOAD) {
  403. if (!network->isAllowed(peer)) {
  404. TRACE("dropped FRAME from %s(%s): not a member of private network %.16llx",peer->address().toString().c_str(),_remoteAddress.toString().c_str(),(unsigned long long)network->id());
  405. _sendErrorNeedCertificate(RR,peer,network->id());
  406. return true;
  407. }
  408. const unsigned int etherType = at<uint16_t>(ZT_PROTO_VERB_FRAME_IDX_ETHERTYPE);
  409. if (!network->config()->permitsEtherType(etherType)) {
  410. TRACE("dropped FRAME from %s(%s): ethertype %.4x not allowed on %.16llx",peer->address().toString().c_str(),_remoteAddress.toString().c_str(),(unsigned int)etherType,(unsigned long long)network->id());
  411. return true;
  412. }
  413. const unsigned int payloadLen = size() - ZT_PROTO_VERB_FRAME_IDX_PAYLOAD;
  414. RR->node->putFrame(network->id(),MAC(peer->address(),network->id()),network->mac(),etherType,0,field(ZT_PROTO_VERB_FRAME_IDX_PAYLOAD,payloadLen),payloadLen);
  415. }
  416. peer->received(RR,_localAddress,_remoteAddress,hops(),packetId(),Packet::VERB_FRAME,0,Packet::VERB_NOP);
  417. } else {
  418. TRACE("dropped FRAME from %s(%s): we are not connected to network %.16llx",source().toString().c_str(),_remoteAddress.toString().c_str(),at<uint64_t>(ZT_PROTO_VERB_FRAME_IDX_NETWORK_ID));
  419. }
  420. } catch ( ... ) {
  421. TRACE("dropped FRAME from %s(%s): unexpected exception",source().toString().c_str(),_remoteAddress.toString().c_str());
  422. }
  423. return true;
  424. }
  425. bool IncomingPacket::_doEXT_FRAME(const RuntimeEnvironment *RR,const SharedPtr<Peer> &peer)
  426. {
  427. try {
  428. SharedPtr<Network> network(RR->node->network(at<uint64_t>(ZT_PROTO_VERB_EXT_FRAME_IDX_NETWORK_ID)));
  429. if (network) {
  430. if (size() > ZT_PROTO_VERB_EXT_FRAME_IDX_PAYLOAD) {
  431. const unsigned int flags = (*this)[ZT_PROTO_VERB_EXT_FRAME_IDX_FLAGS];
  432. unsigned int comLen = 0;
  433. bool comFailed = false;
  434. if ((flags & 0x01) != 0) {
  435. CertificateOfMembership com;
  436. comLen = com.deserialize(*this,ZT_PROTO_VERB_EXT_FRAME_IDX_COM);
  437. if (!peer->validateAndSetNetworkMembershipCertificate(RR,network->id(),com))
  438. comFailed = true;
  439. }
  440. if ((comFailed)||(!network->isAllowed(peer))) {
  441. TRACE("dropped EXT_FRAME from %s(%s): not a member of private network %.16llx",peer->address().toString().c_str(),_remoteAddress.toString().c_str(),network->id());
  442. _sendErrorNeedCertificate(RR,peer,network->id());
  443. return true;
  444. }
  445. // Everything after flags must be adjusted based on the length
  446. // of the certificate, if there was one...
  447. const unsigned int etherType = at<uint16_t>(comLen + ZT_PROTO_VERB_EXT_FRAME_IDX_ETHERTYPE);
  448. if (!network->config()->permitsEtherType(etherType)) {
  449. TRACE("dropped EXT_FRAME from %s(%s): ethertype %.4x not allowed on network %.16llx",peer->address().toString().c_str(),_remoteAddress.toString().c_str(),(unsigned int)etherType,(unsigned long long)network->id());
  450. return true;
  451. }
  452. const MAC to(field(comLen + ZT_PROTO_VERB_EXT_FRAME_IDX_TO,ZT_PROTO_VERB_EXT_FRAME_LEN_TO),ZT_PROTO_VERB_EXT_FRAME_LEN_TO);
  453. const MAC from(field(comLen + ZT_PROTO_VERB_EXT_FRAME_IDX_FROM,ZT_PROTO_VERB_EXT_FRAME_LEN_FROM),ZT_PROTO_VERB_EXT_FRAME_LEN_FROM);
  454. if (to.isMulticast()) {
  455. TRACE("dropped EXT_FRAME from %s@%s(%s) to %s: destination is multicast, must use MULTICAST_FRAME",from.toString().c_str(),peer->address().toString().c_str(),_remoteAddress.toString().c_str(),to.toString().c_str());
  456. return true;
  457. }
  458. if ((!from)||(from.isMulticast())||(from == network->mac())) {
  459. TRACE("dropped EXT_FRAME from %s@%s(%s) to %s: invalid source MAC",from.toString().c_str(),peer->address().toString().c_str(),_remoteAddress.toString().c_str(),to.toString().c_str());
  460. return true;
  461. }
  462. if (from != MAC(peer->address(),network->id())) {
  463. if (network->permitsBridging(peer->address())) {
  464. network->learnBridgeRoute(from,peer->address());
  465. } else {
  466. TRACE("dropped EXT_FRAME from %s@%s(%s) to %s: sender not allowed to bridge into %.16llx",from.toString().c_str(),peer->address().toString().c_str(),_remoteAddress.toString().c_str(),to.toString().c_str(),network->id());
  467. return true;
  468. }
  469. } else if (to != network->mac()) {
  470. if (!network->permitsBridging(RR->identity.address())) {
  471. TRACE("dropped EXT_FRAME from %s@%s(%s) to %s: I cannot bridge to %.16llx or bridging disabled on network",from.toString().c_str(),peer->address().toString().c_str(),_remoteAddress.toString().c_str(),to.toString().c_str(),network->id());
  472. return true;
  473. }
  474. }
  475. const unsigned int payloadLen = size() - (comLen + ZT_PROTO_VERB_EXT_FRAME_IDX_PAYLOAD);
  476. RR->node->putFrame(network->id(),from,to,etherType,0,field(comLen + ZT_PROTO_VERB_EXT_FRAME_IDX_PAYLOAD,payloadLen),payloadLen);
  477. }
  478. peer->received(RR,_localAddress,_remoteAddress,hops(),packetId(),Packet::VERB_EXT_FRAME,0,Packet::VERB_NOP);
  479. } else {
  480. TRACE("dropped EXT_FRAME from %s(%s): we are not connected to network %.16llx",source().toString().c_str(),_remoteAddress.toString().c_str(),at<uint64_t>(ZT_PROTO_VERB_FRAME_IDX_NETWORK_ID));
  481. }
  482. } catch ( ... ) {
  483. TRACE("dropped EXT_FRAME from %s(%s): unexpected exception",source().toString().c_str(),_remoteAddress.toString().c_str());
  484. }
  485. return true;
  486. }
  487. bool IncomingPacket::_doECHO(const RuntimeEnvironment *RR,const SharedPtr<Peer> &peer)
  488. {
  489. try {
  490. const uint64_t pid = packetId();
  491. Packet outp(peer->address(),RR->identity.address(),Packet::VERB_OK);
  492. outp.append((unsigned char)Packet::VERB_ECHO);
  493. outp.append((uint64_t)pid);
  494. outp.append(field(ZT_PACKET_IDX_PAYLOAD,size() - ZT_PACKET_IDX_PAYLOAD),size() - ZT_PACKET_IDX_PAYLOAD);
  495. RR->node->putPacket(_localAddress,_remoteAddress,outp.data(),outp.size());
  496. peer->received(RR,_localAddress,_remoteAddress,hops(),pid,Packet::VERB_ECHO,0,Packet::VERB_NOP);
  497. } catch ( ... ) {
  498. TRACE("dropped ECHO from %s(%s): unexpected exception",source().toString().c_str(),_remoteAddress.toString().c_str());
  499. }
  500. return true;
  501. }
  502. bool IncomingPacket::_doMULTICAST_LIKE(const RuntimeEnvironment *RR,const SharedPtr<Peer> &peer)
  503. {
  504. try {
  505. const uint64_t now = RR->node->now();
  506. // Iterate through 18-byte network,MAC,ADI tuples
  507. for(unsigned int ptr=ZT_PACKET_IDX_PAYLOAD;ptr<size();ptr+=18)
  508. RR->mc->add(now,at<uint64_t>(ptr),MulticastGroup(MAC(field(ptr + 8,6),6),at<uint32_t>(ptr + 14)),peer->address());
  509. peer->received(RR,_localAddress,_remoteAddress,hops(),packetId(),Packet::VERB_MULTICAST_LIKE,0,Packet::VERB_NOP);
  510. } catch ( ... ) {
  511. TRACE("dropped MULTICAST_LIKE from %s(%s): unexpected exception",source().toString().c_str(),_remoteAddress.toString().c_str());
  512. }
  513. return true;
  514. }
  515. bool IncomingPacket::_doNETWORK_MEMBERSHIP_CERTIFICATE(const RuntimeEnvironment *RR,const SharedPtr<Peer> &peer)
  516. {
  517. try {
  518. CertificateOfMembership com;
  519. unsigned int ptr = ZT_PACKET_IDX_PAYLOAD;
  520. while (ptr < size()) {
  521. ptr += com.deserialize(*this,ptr);
  522. peer->validateAndSetNetworkMembershipCertificate(RR,com.networkId(),com);
  523. }
  524. peer->received(RR,_localAddress,_remoteAddress,hops(),packetId(),Packet::VERB_NETWORK_MEMBERSHIP_CERTIFICATE,0,Packet::VERB_NOP);
  525. } catch ( ... ) {
  526. TRACE("dropped NETWORK_MEMBERSHIP_CERTIFICATE from %s(%s): unexpected exception",source().toString().c_str(),_remoteAddress.toString().c_str());
  527. }
  528. return true;
  529. }
  530. bool IncomingPacket::_doNETWORK_CONFIG_REQUEST(const RuntimeEnvironment *RR,const SharedPtr<Peer> &peer)
  531. {
  532. try {
  533. const uint64_t nwid = at<uint64_t>(ZT_PROTO_VERB_NETWORK_CONFIG_REQUEST_IDX_NETWORK_ID);
  534. const unsigned int metaDataLength = at<uint16_t>(ZT_PROTO_VERB_NETWORK_CONFIG_REQUEST_IDX_DICT_LEN);
  535. const Dictionary metaData((const char *)field(ZT_PROTO_VERB_NETWORK_CONFIG_REQUEST_IDX_DICT,metaDataLength),metaDataLength);
  536. //const uint64_t haveRevision = ((ZT_PROTO_VERB_NETWORK_CONFIG_REQUEST_IDX_DICT + metaDataLength + 8) <= size()) ? at<uint64_t>(ZT_PROTO_VERB_NETWORK_CONFIG_REQUEST_IDX_DICT + metaDataLength) : 0ULL;
  537. const unsigned int h = hops();
  538. const uint64_t pid = packetId();
  539. peer->received(RR,_localAddress,_remoteAddress,h,pid,Packet::VERB_NETWORK_CONFIG_REQUEST,0,Packet::VERB_NOP);
  540. if (RR->localNetworkController) {
  541. Dictionary netconf;
  542. switch(RR->localNetworkController->doNetworkConfigRequest((h > 0) ? InetAddress() : _remoteAddress,RR->identity,peer->identity(),nwid,metaData,netconf)) {
  543. case NetworkController::NETCONF_QUERY_OK: {
  544. const std::string netconfStr(netconf.toString());
  545. if (netconfStr.length() > 0xffff) { // sanity check since field ix 16-bit
  546. TRACE("NETWORK_CONFIG_REQUEST failed: internal error: netconf size %u is too large",(unsigned int)netconfStr.length());
  547. } else {
  548. Packet outp(peer->address(),RR->identity.address(),Packet::VERB_OK);
  549. outp.append((unsigned char)Packet::VERB_NETWORK_CONFIG_REQUEST);
  550. outp.append(pid);
  551. outp.append(nwid);
  552. outp.append((uint16_t)netconfStr.length());
  553. outp.append(netconfStr.data(),(unsigned int)netconfStr.length());
  554. outp.compress();
  555. outp.armor(peer->key(),true);
  556. if (outp.size() > ZT_PROTO_MAX_PACKET_LENGTH) { // sanity check
  557. TRACE("NETWORK_CONFIG_REQUEST failed: internal error: netconf size %u is too large",(unsigned int)netconfStr.length());
  558. } else {
  559. RR->node->putPacket(_localAddress,_remoteAddress,outp.data(),outp.size());
  560. }
  561. }
  562. } break;
  563. case NetworkController::NETCONF_QUERY_OBJECT_NOT_FOUND: {
  564. Packet outp(peer->address(),RR->identity.address(),Packet::VERB_ERROR);
  565. outp.append((unsigned char)Packet::VERB_NETWORK_CONFIG_REQUEST);
  566. outp.append(pid);
  567. outp.append((unsigned char)Packet::ERROR_OBJ_NOT_FOUND);
  568. outp.append(nwid);
  569. outp.armor(peer->key(),true);
  570. RR->node->putPacket(_localAddress,_remoteAddress,outp.data(),outp.size());
  571. } break;
  572. case NetworkController::NETCONF_QUERY_ACCESS_DENIED: {
  573. Packet outp(peer->address(),RR->identity.address(),Packet::VERB_ERROR);
  574. outp.append((unsigned char)Packet::VERB_NETWORK_CONFIG_REQUEST);
  575. outp.append(pid);
  576. outp.append((unsigned char)Packet::ERROR_NETWORK_ACCESS_DENIED_);
  577. outp.append(nwid);
  578. outp.armor(peer->key(),true);
  579. RR->node->putPacket(_localAddress,_remoteAddress,outp.data(),outp.size());
  580. } break;
  581. case NetworkController::NETCONF_QUERY_INTERNAL_SERVER_ERROR:
  582. TRACE("NETWORK_CONFIG_REQUEST failed: internal error: %s",netconf.get("error","(unknown)").c_str());
  583. break;
  584. case NetworkController::NETCONF_QUERY_IGNORE:
  585. break;
  586. default:
  587. TRACE("NETWORK_CONFIG_REQUEST failed: invalid return value from NetworkController::doNetworkConfigRequest()");
  588. break;
  589. }
  590. } else {
  591. Packet outp(peer->address(),RR->identity.address(),Packet::VERB_ERROR);
  592. outp.append((unsigned char)Packet::VERB_NETWORK_CONFIG_REQUEST);
  593. outp.append(pid);
  594. outp.append((unsigned char)Packet::ERROR_UNSUPPORTED_OPERATION);
  595. outp.append(nwid);
  596. outp.armor(peer->key(),true);
  597. RR->node->putPacket(_localAddress,_remoteAddress,outp.data(),outp.size());
  598. }
  599. } catch ( ... ) {
  600. TRACE("dropped NETWORK_CONFIG_REQUEST from %s(%s): unexpected exception",source().toString().c_str(),_remoteAddress.toString().c_str());
  601. }
  602. return true;
  603. }
  604. bool IncomingPacket::_doNETWORK_CONFIG_REFRESH(const RuntimeEnvironment *RR,const SharedPtr<Peer> &peer)
  605. {
  606. try {
  607. unsigned int ptr = ZT_PACKET_IDX_PAYLOAD;
  608. while ((ptr + 8) <= size()) {
  609. uint64_t nwid = at<uint64_t>(ptr);
  610. SharedPtr<Network> nw(RR->node->network(nwid));
  611. if ((nw)&&(peer->address() == nw->controller()))
  612. nw->requestConfiguration();
  613. ptr += 8;
  614. }
  615. peer->received(RR,_localAddress,_remoteAddress,hops(),packetId(),Packet::VERB_NETWORK_CONFIG_REFRESH,0,Packet::VERB_NOP);
  616. } catch ( ... ) {
  617. TRACE("dropped NETWORK_CONFIG_REFRESH from %s(%s): unexpected exception",source().toString().c_str(),_remoteAddress.toString().c_str());
  618. }
  619. return true;
  620. }
  621. bool IncomingPacket::_doMULTICAST_GATHER(const RuntimeEnvironment *RR,const SharedPtr<Peer> &peer)
  622. {
  623. try {
  624. const uint64_t nwid = at<uint64_t>(ZT_PROTO_VERB_MULTICAST_GATHER_IDX_NETWORK_ID);
  625. const MulticastGroup mg(MAC(field(ZT_PROTO_VERB_MULTICAST_GATHER_IDX_MAC,6),6),at<uint32_t>(ZT_PROTO_VERB_MULTICAST_GATHER_IDX_ADI));
  626. const unsigned int gatherLimit = at<uint32_t>(ZT_PROTO_VERB_MULTICAST_GATHER_IDX_GATHER_LIMIT);
  627. //TRACE("<<MC %s(%s) GATHER up to %u in %.16llx/%s",source().toString().c_str(),_remoteAddress.toString().c_str(),gatherLimit,nwid,mg.toString().c_str());
  628. if (gatherLimit) {
  629. Packet outp(peer->address(),RR->identity.address(),Packet::VERB_OK);
  630. outp.append((unsigned char)Packet::VERB_MULTICAST_GATHER);
  631. outp.append(packetId());
  632. outp.append(nwid);
  633. mg.mac().appendTo(outp);
  634. outp.append((uint32_t)mg.adi());
  635. if (RR->mc->gather(peer->address(),nwid,mg,outp,gatherLimit)) {
  636. outp.armor(peer->key(),true);
  637. RR->node->putPacket(_localAddress,_remoteAddress,outp.data(),outp.size());
  638. }
  639. }
  640. peer->received(RR,_localAddress,_remoteAddress,hops(),packetId(),Packet::VERB_MULTICAST_GATHER,0,Packet::VERB_NOP);
  641. } catch ( ... ) {
  642. TRACE("dropped MULTICAST_GATHER from %s(%s): unexpected exception",source().toString().c_str(),_remoteAddress.toString().c_str());
  643. }
  644. return true;
  645. }
  646. bool IncomingPacket::_doMULTICAST_FRAME(const RuntimeEnvironment *RR,const SharedPtr<Peer> &peer)
  647. {
  648. try {
  649. const uint64_t nwid = at<uint64_t>(ZT_PROTO_VERB_MULTICAST_FRAME_IDX_NETWORK_ID);
  650. const unsigned int flags = (*this)[ZT_PROTO_VERB_MULTICAST_FRAME_IDX_FLAGS];
  651. const SharedPtr<Network> network(RR->node->network(nwid));
  652. if (network) {
  653. // Offset -- size of optional fields added to position of later fields
  654. unsigned int offset = 0;
  655. if ((flags & 0x01) != 0) {
  656. CertificateOfMembership com;
  657. offset += com.deserialize(*this,ZT_PROTO_VERB_MULTICAST_FRAME_IDX_COM);
  658. peer->validateAndSetNetworkMembershipCertificate(RR,nwid,com);
  659. }
  660. // Check membership after we've read any included COM, since
  661. // that cert might be what we needed.
  662. if (!network->isAllowed(peer)) {
  663. TRACE("dropped MULTICAST_FRAME from %s(%s): not a member of private network %.16llx",peer->address().toString().c_str(),_remoteAddress.toString().c_str(),(unsigned long long)network->id());
  664. _sendErrorNeedCertificate(RR,peer,network->id());
  665. return true;
  666. }
  667. unsigned int gatherLimit = 0;
  668. if ((flags & 0x02) != 0) {
  669. gatherLimit = at<uint32_t>(offset + ZT_PROTO_VERB_MULTICAST_FRAME_IDX_GATHER_LIMIT);
  670. offset += 4;
  671. }
  672. MAC from;
  673. if ((flags & 0x04) != 0) {
  674. from.setTo(field(offset + ZT_PROTO_VERB_MULTICAST_FRAME_IDX_SOURCE_MAC,6),6);
  675. offset += 6;
  676. } else {
  677. from.fromAddress(peer->address(),nwid);
  678. }
  679. const MulticastGroup to(MAC(field(offset + ZT_PROTO_VERB_MULTICAST_FRAME_IDX_DEST_MAC,6),6),at<uint32_t>(offset + ZT_PROTO_VERB_MULTICAST_FRAME_IDX_DEST_ADI));
  680. const unsigned int etherType = at<uint16_t>(offset + ZT_PROTO_VERB_MULTICAST_FRAME_IDX_ETHERTYPE);
  681. const unsigned int payloadLen = size() - (offset + ZT_PROTO_VERB_MULTICAST_FRAME_IDX_FRAME);
  682. //TRACE("<<MC FRAME %.16llx/%s from %s@%s flags %.2x length %u",nwid,to.toString().c_str(),from.toString().c_str(),peer->address().toString().c_str(),flags,payloadLen);
  683. if ((payloadLen > 0)&&(payloadLen <= ZT_IF_MTU)) {
  684. if (!to.mac().isMulticast()) {
  685. TRACE("dropped MULTICAST_FRAME from %s@%s(%s) to %s: destination is unicast, must use FRAME or EXT_FRAME",from.toString().c_str(),peer->address().toString().c_str(),_remoteAddress.toString().c_str(),to.toString().c_str());
  686. return true;
  687. }
  688. if ((!from)||(from.isMulticast())||(from == network->mac())) {
  689. TRACE("dropped MULTICAST_FRAME from %s@%s(%s) to %s: invalid source MAC",from.toString().c_str(),peer->address().toString().c_str(),_remoteAddress.toString().c_str(),to.toString().c_str());
  690. return true;
  691. }
  692. if (from != MAC(peer->address(),network->id())) {
  693. if (network->permitsBridging(peer->address())) {
  694. network->learnBridgeRoute(from,peer->address());
  695. } else {
  696. TRACE("dropped MULTICAST_FRAME from %s@%s(%s) to %s: sender not allowed to bridge into %.16llx",from.toString().c_str(),peer->address().toString().c_str(),_remoteAddress.toString().c_str(),to.toString().c_str(),network->id());
  697. return true;
  698. }
  699. }
  700. RR->node->putFrame(network->id(),from,to.mac(),etherType,0,field(offset + ZT_PROTO_VERB_MULTICAST_FRAME_IDX_FRAME,payloadLen),payloadLen);
  701. }
  702. if (gatherLimit) {
  703. Packet outp(source(),RR->identity.address(),Packet::VERB_OK);
  704. outp.append((unsigned char)Packet::VERB_MULTICAST_FRAME);
  705. outp.append(packetId());
  706. outp.append(nwid);
  707. to.mac().appendTo(outp);
  708. outp.append((uint32_t)to.adi());
  709. outp.append((unsigned char)0x02); // flag 0x02 = contains gather results
  710. if (RR->mc->gather(peer->address(),nwid,to,outp,gatherLimit)) {
  711. outp.armor(peer->key(),true);
  712. RR->node->putPacket(_localAddress,_remoteAddress,outp.data(),outp.size());
  713. }
  714. }
  715. } // else ignore -- not a member of this network
  716. peer->received(RR,_localAddress,_remoteAddress,hops(),packetId(),Packet::VERB_MULTICAST_FRAME,0,Packet::VERB_NOP);
  717. } catch ( ... ) {
  718. TRACE("dropped MULTICAST_FRAME from %s(%s): unexpected exception",source().toString().c_str(),_remoteAddress.toString().c_str());
  719. }
  720. return true;
  721. }
  722. bool IncomingPacket::_doPUSH_DIRECT_PATHS(const RuntimeEnvironment *RR,const SharedPtr<Peer> &peer)
  723. {
  724. try {
  725. unsigned int count = at<uint16_t>(ZT_PACKET_IDX_PAYLOAD);
  726. unsigned int ptr = ZT_PACKET_IDX_PAYLOAD + 2;
  727. while (count--) { // if ptr overflows Buffer will throw
  728. // TODO: some flags are not yet implemented
  729. unsigned int flags = (*this)[ptr++];
  730. unsigned int extLen = at<uint16_t>(ptr); ptr += 2;
  731. ptr += extLen; // unused right now
  732. unsigned int addrType = (*this)[ptr++];
  733. unsigned int addrLen = (*this)[ptr++];
  734. switch(addrType) {
  735. case 4: {
  736. InetAddress a(field(ptr,4),4,at<uint16_t>(ptr + 4));
  737. if ( ((flags & 0x01) == 0) && (Path::isAddressValidForPath(a)) ) {
  738. TRACE("attempting to contact %s at pushed direct path %s",peer->address().toString().c_str(),a.toString().c_str());
  739. peer->attemptToContactAt(RR,_localAddress,a,RR->node->now());
  740. }
  741. } break;
  742. case 6: {
  743. InetAddress a(field(ptr,16),16,at<uint16_t>(ptr + 16));
  744. if ( ((flags & 0x01) == 0) && (Path::isAddressValidForPath(a)) ) {
  745. TRACE("attempting to contact %s at pushed direct path %s",peer->address().toString().c_str(),a.toString().c_str());
  746. peer->attemptToContactAt(RR,_localAddress,a,RR->node->now());
  747. }
  748. } break;
  749. }
  750. ptr += addrLen;
  751. }
  752. peer->received(RR,_localAddress,_remoteAddress,hops(),packetId(),Packet::VERB_PUSH_DIRECT_PATHS,0,Packet::VERB_NOP);
  753. } catch ( ... ) {
  754. TRACE("dropped PUSH_DIRECT_PATHS from %s(%s): unexpected exception",source().toString().c_str(),_remoteAddress.toString().c_str());
  755. }
  756. return true;
  757. }
  758. bool IncomingPacket::_doCIRCUIT_TEST(const RuntimeEnvironment *RR,const SharedPtr<Peer> &peer)
  759. {
  760. try {
  761. const Address originatorAddress(field(ZT_PACKET_IDX_PAYLOAD,ZT_ADDRESS_LENGTH),ZT_ADDRESS_LENGTH);
  762. SharedPtr<Peer> originator(RR->topology->getPeer(originatorAddress));
  763. if (!originator) {
  764. RR->sw->requestWhois(originatorAddress);
  765. return false;
  766. }
  767. const unsigned int flags = at<uint16_t>(ZT_PACKET_IDX_PAYLOAD + 5);
  768. const uint64_t timestamp = at<uint64_t>(ZT_PACKET_IDX_PAYLOAD + 7);
  769. const uint64_t testId = at<uint64_t>(ZT_PACKET_IDX_PAYLOAD + 15);
  770. // Tracks total length of variable length fields, initialized to originator credential length below
  771. unsigned int vlf;
  772. // Originator credentials
  773. const unsigned int originatorCredentialLength = vlf = at<uint16_t>(ZT_PACKET_IDX_PAYLOAD + 23);
  774. uint64_t originatorCredentialNetworkId = 0;
  775. if (originatorCredentialLength >= 1) {
  776. switch((*this)[ZT_PACKET_IDX_PAYLOAD + 25]) {
  777. case 0x01: { // 64-bit network ID, originator must be controller
  778. if (originatorCredentialLength >= 9)
  779. originatorCredentialNetworkId = at<uint64_t>(ZT_PACKET_IDX_PAYLOAD + 26);
  780. } break;
  781. default: break;
  782. }
  783. }
  784. // Add length of "additional fields," which are currently unused
  785. vlf += at<uint16_t>(ZT_PACKET_IDX_PAYLOAD + 25 + vlf);
  786. // Verify signature -- only tests signed by their originators are allowed
  787. const unsigned int signatureLength = at<uint16_t>(ZT_PACKET_IDX_PAYLOAD + 27 + vlf);
  788. if (!originator->identity().verify(field(ZT_PACKET_IDX_PAYLOAD,27 + vlf),27 + vlf,field(ZT_PACKET_IDX_PAYLOAD + 29 + vlf,signatureLength),signatureLength)) {
  789. TRACE("dropped CIRCUIT_TEST from %s(%s): signature by originator %s invalid",source().toString().c_str(),_remoteAddress.toString().c_str(),originatorAddress.toString().c_str());
  790. return true;
  791. }
  792. vlf += signatureLength;
  793. // Save this length so we can copy the immutable parts of this test
  794. // into the one we send along to next hops.
  795. const unsigned int lengthOfSignedPortionAndSignature = 29 + vlf;
  796. // Get previous hop's credential, if any
  797. const unsigned int previousHopCredentialLength = at<uint16_t>(ZT_PACKET_IDX_PAYLOAD + 29 + vlf);
  798. CertificateOfMembership previousHopCom;
  799. if (previousHopCredentialLength >= 1) {
  800. switch((*this)[ZT_PACKET_IDX_PAYLOAD + 31 + vlf]) {
  801. case 0x01: { // network certificate of membership for previous hop
  802. if (previousHopCom.deserialize(*this,ZT_PACKET_IDX_PAYLOAD + 32 + vlf) != (previousHopCredentialLength - 1)) {
  803. TRACE("dropped CIRCUIT_TEST from %s(%s): previous hop COM invalid",source().toString().c_str(),_remoteAddress.toString().c_str());
  804. return true;
  805. }
  806. } break;
  807. default: break;
  808. }
  809. }
  810. vlf += previousHopCredentialLength;
  811. // Check credentials (signature already verified)
  812. SharedPtr<NetworkConfig> originatorCredentialNetworkConfig;
  813. if (originatorCredentialNetworkId) {
  814. if (Network::controllerFor(originatorCredentialNetworkId) == originatorAddress) {
  815. SharedPtr<Network> nw(RR->node->network(originatorCredentialNetworkId));
  816. if (nw) {
  817. originatorCredentialNetworkConfig = nw->config2();
  818. if ( (originatorCredentialNetworkConfig) && ((originatorCredentialNetworkConfig->isPublic())||(peer->address() == originatorAddress)||((originatorCredentialNetworkConfig->com())&&(previousHopCom)&&(originatorCredentialNetworkConfig->com().agreesWith(previousHopCom)))) ) {
  819. TRACE("CIRCUIT_TEST %.16llx received from hop %s(%s) and originator %s with valid network ID credential %.16llx (verified from originator and next hop)",testId,source().toString().c_str(),_remoteAddress.toString().c_str(),originatorAddress.toString().c_str(),originatorCredentialNetworkId);
  820. } else {
  821. TRACE("dropped CIRCUIT_TEST from %s(%s): originator %s specified network ID %.16llx as credential, and previous hop %s did not supply a valid COM",source().toString().c_str(),_remoteAddress.toString().c_str(),originatorAddress.toString().c_str(),originatorCredentialNetworkId,peer->address().toString().c_str());
  822. return true;
  823. }
  824. } else {
  825. TRACE("dropped CIRCUIT_TEST from %s(%s): originator %s specified network ID %.16llx as credential, and we are not a member",source().toString().c_str(),_remoteAddress.toString().c_str(),originatorAddress.toString().c_str(),originatorCredentialNetworkId);
  826. return true;
  827. }
  828. } else {
  829. TRACE("dropped CIRCUIT_TEST from %s(%s): originator %s specified network ID as credential, is not controller for %.16llx",source().toString().c_str(),_remoteAddress.toString().c_str(),originatorAddress.toString().c_str(),originatorCredentialNetworkId);
  830. return true;
  831. }
  832. } else {
  833. TRACE("dropped CIRCUIT_TEST from %s(%s): originator %s did not specify a credential or credential type",source().toString().c_str(),_remoteAddress.toString().c_str(),originatorAddress.toString().c_str());
  834. return true;
  835. }
  836. const uint64_t now = RR->node->now();
  837. unsigned int breadth = 0;
  838. Address nextHop[256]; // breadth is a uin8_t, so this is the max
  839. InetAddress nextHopBestPathAddress[256];
  840. unsigned int remainingHopsPtr = ZT_PACKET_IDX_PAYLOAD + 33 + vlf;
  841. if ((ZT_PACKET_IDX_PAYLOAD + 31 + vlf) < size()) {
  842. // unsigned int nextHopFlags = (*this)[ZT_PACKET_IDX_PAYLOAD + 31 + vlf]
  843. breadth = (*this)[ZT_PACKET_IDX_PAYLOAD + 32 + vlf];
  844. for(unsigned int h=0;h<breadth;++h) {
  845. nextHop[h].setTo(field(remainingHopsPtr,ZT_ADDRESS_LENGTH),ZT_ADDRESS_LENGTH);
  846. remainingHopsPtr += ZT_ADDRESS_LENGTH;
  847. SharedPtr<Peer> nhp(RR->topology->getPeer(nextHop[h]));
  848. if (nhp) {
  849. RemotePath *const rp = nhp->getBestPath(now);
  850. if (rp)
  851. nextHopBestPathAddress[h] = rp->address();
  852. }
  853. }
  854. }
  855. // Report back to originator, depending on flags and whether we are last hop
  856. if ( ((flags & 0x01) != 0) || ((breadth == 0)&&((flags & 0x02) != 0)) ) {
  857. Packet outp(originatorAddress,RR->identity.address(),Packet::VERB_CIRCUIT_TEST_REPORT);
  858. outp.append((uint64_t)timestamp);
  859. outp.append((uint64_t)testId);
  860. outp.append((uint64_t)now);
  861. outp.append((uint8_t)ZT_VENDOR_ZEROTIER);
  862. outp.append((uint8_t)ZT_PROTO_VERSION);
  863. outp.append((uint8_t)ZEROTIER_ONE_VERSION_MAJOR);
  864. outp.append((uint8_t)ZEROTIER_ONE_VERSION_MINOR);
  865. outp.append((uint16_t)ZEROTIER_ONE_VERSION_REVISION);
  866. outp.append((uint16_t)ZT_PLATFORM_UNSPECIFIED);
  867. outp.append((uint16_t)ZT_ARCHITECTURE_UNSPECIFIED);
  868. outp.append((uint16_t)0); // error code, currently unused
  869. outp.append((uint64_t)0); // flags, currently unused
  870. outp.append((uint64_t)packetId());
  871. peer->address().appendTo(outp);
  872. outp.append((uint8_t)hops());
  873. _localAddress.serialize(outp);
  874. _remoteAddress.serialize(outp);
  875. outp.append((uint16_t)0); // no additional fields
  876. outp.append((uint8_t)breadth);
  877. for(unsigned int h=0;h<breadth;++h) {
  878. nextHop[h].appendTo(outp);
  879. nextHopBestPathAddress[h].serialize(outp); // appends 0 if null InetAddress
  880. }
  881. RR->sw->send(outp,true,0);
  882. }
  883. // If there are next hops, forward the test along through the graph
  884. if (breadth > 0) {
  885. Packet outp(Address(),RR->identity.address(),Packet::VERB_CIRCUIT_TEST);
  886. outp.append(field(ZT_PACKET_IDX_PAYLOAD,lengthOfSignedPortionAndSignature),lengthOfSignedPortionAndSignature);
  887. const unsigned int previousHopCredentialPos = outp.size();
  888. outp.append((uint16_t)0); // no previous hop credentials: default
  889. if ((originatorCredentialNetworkConfig)&&(!originatorCredentialNetworkConfig->isPublic())&&(originatorCredentialNetworkConfig->com())) {
  890. outp.append((uint8_t)0x01); // COM
  891. originatorCredentialNetworkConfig->com().serialize(outp);
  892. outp.setAt<uint16_t>(previousHopCredentialPos,(uint16_t)(size() - previousHopCredentialPos));
  893. }
  894. if (remainingHopsPtr < size())
  895. outp.append(field(remainingHopsPtr,size() - remainingHopsPtr),size() - remainingHopsPtr);
  896. for(unsigned int h=0;h<breadth;++h) {
  897. if (RR->identity.address() != nextHop[h]) { // next hops that loop back to the current hop are not valid
  898. outp.newInitializationVector();
  899. outp.setDestination(nextHop[h]);
  900. RR->sw->send(outp,true,originatorCredentialNetworkId);
  901. }
  902. }
  903. }
  904. peer->received(RR,_localAddress,_remoteAddress,hops(),packetId(),Packet::VERB_CIRCUIT_TEST,0,Packet::VERB_NOP);
  905. } catch ( ... ) {
  906. TRACE("dropped CIRCUIT_TEST from %s(%s): unexpected exception",source().toString().c_str(),_remoteAddress.toString().c_str());
  907. }
  908. return true;
  909. }
  910. bool IncomingPacket::_doCIRCUIT_TEST_REPORT(const RuntimeEnvironment *RR,const SharedPtr<Peer> &peer)
  911. {
  912. try {
  913. ZT_CircuitTestReport report;
  914. memset(&report,0,sizeof(report));
  915. report.current = peer->address().toInt();
  916. report.upstream = Address(field(ZT_PACKET_IDX_PAYLOAD + 52,ZT_ADDRESS_LENGTH),ZT_ADDRESS_LENGTH).toInt();
  917. report.testId = at<uint64_t>(ZT_PACKET_IDX_PAYLOAD + 8);
  918. report.timestamp = at<uint64_t>(ZT_PACKET_IDX_PAYLOAD);
  919. report.remoteTimestamp = at<uint64_t>(ZT_PACKET_IDX_PAYLOAD + 16);
  920. report.sourcePacketId = at<uint64_t>(ZT_PACKET_IDX_PAYLOAD + 44);
  921. report.flags = at<uint64_t>(ZT_PACKET_IDX_PAYLOAD + 36);
  922. report.sourcePacketHopCount = (*this)[ZT_PACKET_IDX_PAYLOAD + 57]; // end of fixed length headers: 58
  923. report.errorCode = at<uint16_t>(ZT_PACKET_IDX_PAYLOAD + 34);
  924. report.vendor = (enum ZT_Vendor)((*this)[ZT_PACKET_IDX_PAYLOAD + 24]);
  925. report.protocolVersion = (*this)[ZT_PACKET_IDX_PAYLOAD + 25];
  926. report.majorVersion = (*this)[ZT_PACKET_IDX_PAYLOAD + 26];
  927. report.minorVersion = (*this)[ZT_PACKET_IDX_PAYLOAD + 27];
  928. report.revision = at<uint16_t>(ZT_PACKET_IDX_PAYLOAD + 28);
  929. report.platform = (enum ZT_Platform)at<uint16_t>(ZT_PACKET_IDX_PAYLOAD + 30);
  930. report.architecture = (enum ZT_Architecture)at<uint16_t>(ZT_PACKET_IDX_PAYLOAD + 32);
  931. const unsigned int receivedOnLocalAddressLen = reinterpret_cast<InetAddress *>(&(report.receivedOnLocalAddress))->deserialize(*this,ZT_PACKET_IDX_PAYLOAD + 58);
  932. const unsigned int receivedFromRemoteAddressLen = reinterpret_cast<InetAddress *>(&(report.receivedFromRemoteAddress))->deserialize(*this,ZT_PACKET_IDX_PAYLOAD + 58 + receivedOnLocalAddressLen);
  933. unsigned int nhptr = ZT_PACKET_IDX_PAYLOAD + 58 + receivedOnLocalAddressLen + receivedFromRemoteAddressLen;
  934. nhptr += at<uint16_t>(nhptr) + 2; // add "additional field" length, which right now will be zero
  935. report.nextHopCount = (*this)[nhptr++];
  936. if (report.nextHopCount > ZT_CIRCUIT_TEST_MAX_HOP_BREADTH) // sanity check, shouldn't be possible
  937. report.nextHopCount = ZT_CIRCUIT_TEST_MAX_HOP_BREADTH;
  938. for(unsigned int h=0;h<report.nextHopCount;++h) {
  939. report.nextHops[h].address = Address(field(nhptr,ZT_ADDRESS_LENGTH),ZT_ADDRESS_LENGTH).toInt(); nhptr += ZT_ADDRESS_LENGTH;
  940. nhptr += reinterpret_cast<InetAddress *>(&(report.nextHops[h].physicalAddress))->deserialize(*this,nhptr);
  941. }
  942. RR->node->postCircuitTestReport(&report);
  943. } catch ( ... ) {
  944. TRACE("dropped CIRCUIT_TEST_REPORT from %s(%s): unexpected exception",source().toString().c_str(),_remoteAddress.toString().c_str());
  945. }
  946. return true;
  947. }
  948. bool IncomingPacket::_doREQUEST_PROOF_OF_WORK(const RuntimeEnvironment *RR,const SharedPtr<Peer> &peer)
  949. {
  950. try {
  951. // Right now this is only allowed from root servers -- may be allowed from controllers and relays later.
  952. if (RR->topology->isRoot(peer->identity())) {
  953. const uint64_t pid = packetId();
  954. const unsigned int difficulty = (*this)[ZT_PACKET_IDX_PAYLOAD + 1];
  955. const unsigned int challengeLength = at<uint16_t>(ZT_PACKET_IDX_PAYLOAD + 2);
  956. if (challengeLength > ZT_PROTO_MAX_PACKET_LENGTH)
  957. return true; // sanity check, drop invalid size
  958. const unsigned char *challenge = field(ZT_PACKET_IDX_PAYLOAD + 4,challengeLength);
  959. switch((*this)[ZT_PACKET_IDX_PAYLOAD]) {
  960. // Salsa20/12+SHA512 hashcash
  961. case 0x01: {
  962. if (difficulty <= 14) {
  963. unsigned char result[16];
  964. computeSalsa2012Sha512ProofOfWork(difficulty,challenge,challengeLength,result);
  965. TRACE("PROOF_OF_WORK computed for %s: difficulty==%u, challengeLength==%u, result: %.16llx%.16llx",peer->address().toString().c_str(),difficulty,challengeLength,Utils::ntoh(*(reinterpret_cast<const uint64_t *>(result))),Utils::ntoh(*(reinterpret_cast<const uint64_t *>(result + 8))));
  966. Packet outp(peer->address(),RR->identity.address(),Packet::VERB_OK);
  967. outp.append((unsigned char)Packet::VERB_REQUEST_PROOF_OF_WORK);
  968. outp.append(pid);
  969. outp.append((uint16_t)sizeof(result));
  970. outp.append(result,sizeof(result));
  971. outp.armor(peer->key(),true);
  972. RR->node->putPacket(_localAddress,_remoteAddress,outp.data(),outp.size());
  973. } else {
  974. Packet outp(peer->address(),RR->identity.address(),Packet::VERB_ERROR);
  975. outp.append((unsigned char)Packet::VERB_REQUEST_PROOF_OF_WORK);
  976. outp.append(pid);
  977. outp.append((unsigned char)Packet::ERROR_INVALID_REQUEST);
  978. outp.armor(peer->key(),true);
  979. RR->node->putPacket(_localAddress,_remoteAddress,outp.data(),outp.size());
  980. }
  981. } break;
  982. default:
  983. TRACE("dropped REQUEST_PROOF_OF_WORK from %s(%s): unrecognized proof of work type",peer->address().toString().c_str(),_remoteAddress.toString().c_str());
  984. break;
  985. }
  986. peer->received(RR,_localAddress,_remoteAddress,hops(),pid,Packet::VERB_REQUEST_PROOF_OF_WORK,0,Packet::VERB_NOP);
  987. } else {
  988. TRACE("dropped REQUEST_PROOF_OF_WORK from %s(%s): not trusted enough",peer->address().toString().c_str(),_remoteAddress.toString().c_str());
  989. }
  990. } catch ( ... ) {
  991. TRACE("dropped REQUEST_PROOF_OF_WORK from %s(%s): unexpected exception",peer->address().toString().c_str(),_remoteAddress.toString().c_str());
  992. }
  993. return true;
  994. }
  995. void IncomingPacket::computeSalsa2012Sha512ProofOfWork(unsigned int difficulty,const void *challenge,unsigned int challengeLength,unsigned char result[16])
  996. {
  997. unsigned char salsabuf[131072]; // 131072 == protocol constant, size of memory buffer for this proof of work function
  998. char candidatebuf[ZT_PROTO_MAX_PACKET_LENGTH + 256];
  999. unsigned char shabuf[ZT_SHA512_DIGEST_LEN];
  1000. const uint64_t s20iv = 0; // zero IV for Salsa20
  1001. char *const candidate = (char *)(( ((uintptr_t)&(candidatebuf[0])) | 0xf ) + 1); // align to 16-byte boundary to ensure that uint64_t type punning of initial nonce is okay
  1002. Salsa20 s20;
  1003. unsigned int d;
  1004. unsigned char *p;
  1005. Utils::getSecureRandom(candidate,16);
  1006. memcpy(candidate + 16,challenge,challengeLength);
  1007. if (difficulty > 512)
  1008. difficulty = 512; // sanity check
  1009. try_salsa2012sha512_again:
  1010. ++*(reinterpret_cast<volatile uint64_t *>(candidate));
  1011. SHA512::hash(shabuf,candidate,16 + challengeLength);
  1012. s20.init(shabuf,256,&s20iv);
  1013. memset(salsabuf,0,sizeof(salsabuf));
  1014. s20.encrypt12(salsabuf,salsabuf,sizeof(salsabuf));
  1015. SHA512::hash(shabuf,salsabuf,sizeof(salsabuf));
  1016. d = difficulty;
  1017. p = shabuf;
  1018. while (d >= 8) {
  1019. if (*(p++))
  1020. goto try_salsa2012sha512_again;
  1021. d -= 8;
  1022. }
  1023. if (d > 0) {
  1024. if ( ((((unsigned int)*p) << d) & 0xff00) != 0 )
  1025. goto try_salsa2012sha512_again;
  1026. }
  1027. memcpy(result,candidate,16);
  1028. }
  1029. bool IncomingPacket::testSalsa2012Sha512ProofOfWorkResult(unsigned int difficulty,const void *challenge,unsigned int challengeLength,const unsigned char proposedResult[16])
  1030. {
  1031. unsigned char salsabuf[131072]; // 131072 == protocol constant, size of memory buffer for this proof of work function
  1032. char candidate[ZT_PROTO_MAX_PACKET_LENGTH + 256];
  1033. unsigned char shabuf[ZT_SHA512_DIGEST_LEN];
  1034. const uint64_t s20iv = 0; // zero IV for Salsa20
  1035. Salsa20 s20;
  1036. unsigned int d;
  1037. unsigned char *p;
  1038. if (difficulty > 512)
  1039. difficulty = 512; // sanity check
  1040. memcpy(candidate,proposedResult,16);
  1041. memcpy(candidate + 16,challenge,challengeLength);
  1042. SHA512::hash(shabuf,candidate,16 + challengeLength);
  1043. s20.init(shabuf,256,&s20iv);
  1044. memset(salsabuf,0,sizeof(salsabuf));
  1045. s20.encrypt12(salsabuf,salsabuf,sizeof(salsabuf));
  1046. SHA512::hash(shabuf,salsabuf,sizeof(salsabuf));
  1047. d = difficulty;
  1048. p = shabuf;
  1049. while (d >= 8) {
  1050. if (*(p++))
  1051. return false;
  1052. d -= 8;
  1053. }
  1054. if (d > 0) {
  1055. if ( ((((unsigned int)*p) << d) & 0xff00) != 0 )
  1056. return false;
  1057. }
  1058. return true;
  1059. }
  1060. void IncomingPacket::_sendErrorNeedCertificate(const RuntimeEnvironment *RR,const SharedPtr<Peer> &peer,uint64_t nwid)
  1061. {
  1062. Packet outp(source(),RR->identity.address(),Packet::VERB_ERROR);
  1063. outp.append((unsigned char)verb());
  1064. outp.append(packetId());
  1065. outp.append((unsigned char)Packet::ERROR_NEED_MEMBERSHIP_CERTIFICATE);
  1066. outp.append(nwid);
  1067. outp.armor(peer->key(),true);
  1068. RR->node->putPacket(_localAddress,_remoteAddress,outp.data(),outp.size());
  1069. }
  1070. } // namespace ZeroTier