Peer.cpp 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596
  1. /*
  2. * Copyright (c)2013-2020 ZeroTier, Inc.
  3. *
  4. * Use of this software is governed by the Business Source License included
  5. * in the LICENSE.TXT file in the project's root directory.
  6. *
  7. * Change Date: 2025-01-01
  8. *
  9. * On the date above, in accordance with the Business Source License, use
  10. * of this software will be governed by version 2.0 of the Apache License.
  11. */
  12. /****/
  13. #include "../version.h"
  14. #include "Constants.hpp"
  15. #include "Peer.hpp"
  16. #include "Switch.hpp"
  17. #include "Network.hpp"
  18. #include "SelfAwareness.hpp"
  19. #include "Packet.hpp"
  20. #include "Trace.hpp"
  21. #include "InetAddress.hpp"
  22. #include "RingBuffer.hpp"
  23. #include "Utils.hpp"
  24. namespace ZeroTier {
  25. static unsigned char s_freeRandomByteCounter = 0;
  26. Peer::Peer(const RuntimeEnvironment *renv,const Identity &myIdentity,const Identity &peerIdentity) :
  27. RR(renv),
  28. _lastReceive(0),
  29. _lastNontrivialReceive(0),
  30. _lastTriedMemorizedPath(0),
  31. _lastDirectPathPushSent(0),
  32. _lastDirectPathPushReceive(0),
  33. _lastEchoRequestReceived(0),
  34. _lastCredentialRequestSent(0),
  35. _lastWhoisRequestReceived(0),
  36. _lastCredentialsReceived(0),
  37. _lastTrustEstablishedPacketReceived(0),
  38. _lastSentFullHello(0),
  39. _lastEchoCheck(0),
  40. _freeRandomByte((unsigned char)((uintptr_t)this >> 4) ^ ++s_freeRandomByteCounter),
  41. _vProto(0),
  42. _vMajor(0),
  43. _vMinor(0),
  44. _vRevision(0),
  45. _id(peerIdentity),
  46. _directPathPushCutoffCount(0),
  47. _credentialsCutoffCount(0),
  48. _echoRequestCutoffCount(0),
  49. _localMultipathSupported(false),
  50. _lastComputedAggregateMeanLatency(0)
  51. {
  52. if (!myIdentity.agree(peerIdentity,_key))
  53. throw ZT_EXCEPTION_INVALID_ARGUMENT;
  54. uint8_t ktmp[ZT_SYMMETRIC_KEY_SIZE];
  55. KBKDFHMACSHA384(_key,ZT_KBKDF_LABEL_AES_GMAC_SIV_K0,0,0,ktmp);
  56. _aesKeys[0].init(ktmp);
  57. KBKDFHMACSHA384(_key,ZT_KBKDF_LABEL_AES_GMAC_SIV_K1,0,0,ktmp);
  58. _aesKeys[1].init(ktmp);
  59. Utils::burn(ktmp,ZT_SYMMETRIC_KEY_SIZE);
  60. }
  61. void Peer::received(
  62. void *tPtr,
  63. const SharedPtr<Path> &path,
  64. const unsigned int hops,
  65. const uint64_t packetId,
  66. const unsigned int payloadLength,
  67. const Packet::Verb verb,
  68. const uint64_t inRePacketId,
  69. const Packet::Verb inReVerb,
  70. const bool trustEstablished,
  71. const uint64_t networkId,
  72. const int32_t flowId)
  73. {
  74. const int64_t now = RR->node->now();
  75. _lastReceive = now;
  76. switch (verb) {
  77. case Packet::VERB_FRAME:
  78. case Packet::VERB_EXT_FRAME:
  79. case Packet::VERB_NETWORK_CONFIG_REQUEST:
  80. case Packet::VERB_NETWORK_CONFIG:
  81. case Packet::VERB_MULTICAST_FRAME:
  82. _lastNontrivialReceive = now;
  83. break;
  84. default:
  85. break;
  86. }
  87. recordIncomingPacket(path, packetId, payloadLength, verb, flowId, now);
  88. if (trustEstablished) {
  89. _lastTrustEstablishedPacketReceived = now;
  90. path->trustedPacketReceived(now);
  91. }
  92. if (hops == 0) {
  93. // If this is a direct packet (no hops), update existing paths or learn new ones
  94. bool havePath = false;
  95. {
  96. Mutex::Lock _l(_paths_m);
  97. for(unsigned int i=0;i<ZT_MAX_PEER_NETWORK_PATHS;++i) {
  98. if (_paths[i].p) {
  99. if (_paths[i].p == path) {
  100. _paths[i].lr = now;
  101. havePath = true;
  102. break;
  103. }
  104. } else {
  105. break;
  106. }
  107. }
  108. }
  109. if ( (!havePath) && RR->node->shouldUsePathForZeroTierTraffic(tPtr,_id.address(),path->localSocket(),path->address()) ) {
  110. if (verb == Packet::VERB_OK) {
  111. Mutex::Lock _l(_paths_m);
  112. unsigned int replacePath = ZT_MAX_PEER_NETWORK_PATHS;
  113. long replacePathQuality = 0;
  114. for(unsigned int i=0;i<ZT_MAX_PEER_NETWORK_PATHS;++i) {
  115. if (_paths[i].p) {
  116. if ( (!_paths[i].p->alive(now)) || _paths[i].p->address().ipsEqual(path->address()) ) {
  117. replacePath = i;
  118. break;
  119. } else {
  120. const long q = _paths[i].p->quality(now) / _paths[i].priority;
  121. if (q > replacePathQuality) {
  122. replacePathQuality = q;
  123. replacePath = i;
  124. }
  125. }
  126. } else {
  127. replacePath = i;
  128. break;
  129. }
  130. }
  131. if (replacePath != ZT_MAX_PEER_NETWORK_PATHS) {
  132. RR->t->peerLearnedNewPath(tPtr, networkId, *this, path, packetId);
  133. _paths[replacePath].lr = now;
  134. _paths[replacePath].p = path;
  135. _paths[replacePath].priority = 1;
  136. Mutex::Lock _l(_bond_m);
  137. if(_bond) {
  138. _bond->nominatePathToBond(_paths[replacePath].p, now);
  139. }
  140. }
  141. } else {
  142. Mutex::Lock ltl(_lastTriedPath_m);
  143. bool triedTooRecently = false;
  144. for(std::list< std::pair< Path *, int64_t > >::iterator i(_lastTriedPath.begin());i!=_lastTriedPath.end();) {
  145. if ((now - i->second) > 1000) {
  146. _lastTriedPath.erase(i++);
  147. } else if (i->first == path.ptr()) {
  148. ++i;
  149. triedTooRecently = true;
  150. } else {
  151. ++i;
  152. }
  153. }
  154. if (!triedTooRecently) {
  155. _lastTriedPath.push_back(std::pair< Path *, int64_t >(path.ptr(), now));
  156. attemptToContactAt(tPtr,path->localSocket(),path->address(),now,true);
  157. path->sent(now);
  158. RR->t->peerConfirmingUnknownPath(tPtr,networkId,*this,path,packetId,verb);
  159. }
  160. }
  161. }
  162. }
  163. // If we have a trust relationship periodically push a message enumerating
  164. // all known external addresses for ourselves. If we already have a path this
  165. // is done less frequently.
  166. if (this->trustEstablished(now)) {
  167. const int64_t sinceLastPush = now - _lastDirectPathPushSent;
  168. if (sinceLastPush >= ((hops == 0) ? ZT_DIRECT_PATH_PUSH_INTERVAL_HAVEPATH : ZT_DIRECT_PATH_PUSH_INTERVAL)) {
  169. _lastDirectPathPushSent = now;
  170. std::vector<InetAddress> pathsToPush(RR->node->directPaths());
  171. if (!pathsToPush.empty()) {
  172. std::vector<InetAddress>::const_iterator p(pathsToPush.begin());
  173. while (p != pathsToPush.end()) {
  174. Packet *const outp = new Packet(_id.address(),RR->identity.address(),Packet::VERB_PUSH_DIRECT_PATHS);
  175. outp->addSize(2); // leave room for count
  176. unsigned int count = 0;
  177. while ((p != pathsToPush.end())&&((outp->size() + 24) < 1200)) {
  178. uint8_t addressType = 4;
  179. switch(p->ss_family) {
  180. case AF_INET:
  181. break;
  182. case AF_INET6:
  183. addressType = 6;
  184. break;
  185. default: // we currently only push IP addresses
  186. ++p;
  187. continue;
  188. }
  189. outp->append((uint8_t)0); // no flags
  190. outp->append((uint16_t)0); // no extensions
  191. outp->append(addressType);
  192. outp->append((uint8_t)((addressType == 4) ? 6 : 18));
  193. outp->append(p->rawIpData(),((addressType == 4) ? 4 : 16));
  194. outp->append((uint16_t)p->port());
  195. ++count;
  196. ++p;
  197. }
  198. if (count) {
  199. outp->setAt(ZT_PACKET_IDX_PAYLOAD,(uint16_t)count);
  200. outp->compress();
  201. outp->armor(_key,true,aesKeysIfSupported());
  202. path->send(RR,tPtr,outp->data(),outp->size(),now);
  203. }
  204. delete outp;
  205. }
  206. }
  207. }
  208. }
  209. }
  210. SharedPtr<Path> Peer::getAppropriatePath(int64_t now, bool includeExpired, int32_t flowId)
  211. {
  212. Mutex::Lock _l(_bond_m);
  213. if (!_bond) {
  214. Mutex::Lock _l(_paths_m);
  215. unsigned int bestPath = ZT_MAX_PEER_NETWORK_PATHS;
  216. /**
  217. * Send traffic across the highest quality path only. This algorithm will still
  218. * use the old path quality metric from protocol version 9.
  219. */
  220. long bestPathQuality = 2147483647;
  221. for(unsigned int i=0;i<ZT_MAX_PEER_NETWORK_PATHS;++i) {
  222. if (_paths[i].p) {
  223. if ((includeExpired)||((now - _paths[i].lr) < ZT_PEER_PATH_EXPIRATION)) {
  224. const long q = _paths[i].p->quality(now) / _paths[i].priority;
  225. if (q <= bestPathQuality) {
  226. bestPathQuality = q;
  227. bestPath = i;
  228. }
  229. }
  230. } else break;
  231. }
  232. if (bestPath != ZT_MAX_PEER_NETWORK_PATHS) {
  233. return _paths[bestPath].p;
  234. }
  235. return SharedPtr<Path>();
  236. }
  237. return _bond->getAppropriatePath(now, flowId);
  238. }
  239. void Peer::introduce(void *const tPtr,const int64_t now,const SharedPtr<Peer> &other) const
  240. {
  241. unsigned int myBestV4ByScope[ZT_INETADDRESS_MAX_SCOPE+1];
  242. unsigned int myBestV6ByScope[ZT_INETADDRESS_MAX_SCOPE+1];
  243. long myBestV4QualityByScope[ZT_INETADDRESS_MAX_SCOPE+1];
  244. long myBestV6QualityByScope[ZT_INETADDRESS_MAX_SCOPE+1];
  245. unsigned int theirBestV4ByScope[ZT_INETADDRESS_MAX_SCOPE+1];
  246. unsigned int theirBestV6ByScope[ZT_INETADDRESS_MAX_SCOPE+1];
  247. long theirBestV4QualityByScope[ZT_INETADDRESS_MAX_SCOPE+1];
  248. long theirBestV6QualityByScope[ZT_INETADDRESS_MAX_SCOPE+1];
  249. for(int i=0;i<=ZT_INETADDRESS_MAX_SCOPE;++i) {
  250. myBestV4ByScope[i] = ZT_MAX_PEER_NETWORK_PATHS;
  251. myBestV6ByScope[i] = ZT_MAX_PEER_NETWORK_PATHS;
  252. myBestV4QualityByScope[i] = 2147483647;
  253. myBestV6QualityByScope[i] = 2147483647;
  254. theirBestV4ByScope[i] = ZT_MAX_PEER_NETWORK_PATHS;
  255. theirBestV6ByScope[i] = ZT_MAX_PEER_NETWORK_PATHS;
  256. theirBestV4QualityByScope[i] = 2147483647;
  257. theirBestV6QualityByScope[i] = 2147483647;
  258. }
  259. Mutex::Lock _l1(_paths_m);
  260. for(unsigned int i=0;i<ZT_MAX_PEER_NETWORK_PATHS;++i) {
  261. if (_paths[i].p) {
  262. const long q = _paths[i].p->quality(now) / _paths[i].priority;
  263. const unsigned int s = (unsigned int)_paths[i].p->ipScope();
  264. switch(_paths[i].p->address().ss_family) {
  265. case AF_INET:
  266. if (q <= myBestV4QualityByScope[s]) {
  267. myBestV4QualityByScope[s] = q;
  268. myBestV4ByScope[s] = i;
  269. }
  270. break;
  271. case AF_INET6:
  272. if (q <= myBestV6QualityByScope[s]) {
  273. myBestV6QualityByScope[s] = q;
  274. myBestV6ByScope[s] = i;
  275. }
  276. break;
  277. }
  278. } else break;
  279. }
  280. Mutex::Lock _l2(other->_paths_m);
  281. for(unsigned int i=0;i<ZT_MAX_PEER_NETWORK_PATHS;++i) {
  282. if (other->_paths[i].p) {
  283. const long q = other->_paths[i].p->quality(now) / other->_paths[i].priority;
  284. const unsigned int s = (unsigned int)other->_paths[i].p->ipScope();
  285. switch(other->_paths[i].p->address().ss_family) {
  286. case AF_INET:
  287. if (q <= theirBestV4QualityByScope[s]) {
  288. theirBestV4QualityByScope[s] = q;
  289. theirBestV4ByScope[s] = i;
  290. }
  291. break;
  292. case AF_INET6:
  293. if (q <= theirBestV6QualityByScope[s]) {
  294. theirBestV6QualityByScope[s] = q;
  295. theirBestV6ByScope[s] = i;
  296. }
  297. break;
  298. }
  299. } else break;
  300. }
  301. unsigned int mine = ZT_MAX_PEER_NETWORK_PATHS;
  302. unsigned int theirs = ZT_MAX_PEER_NETWORK_PATHS;
  303. for(int s=ZT_INETADDRESS_MAX_SCOPE;s>=0;--s) {
  304. if ((myBestV6ByScope[s] != ZT_MAX_PEER_NETWORK_PATHS)&&(theirBestV6ByScope[s] != ZT_MAX_PEER_NETWORK_PATHS)) {
  305. mine = myBestV6ByScope[s];
  306. theirs = theirBestV6ByScope[s];
  307. break;
  308. }
  309. if ((myBestV4ByScope[s] != ZT_MAX_PEER_NETWORK_PATHS)&&(theirBestV4ByScope[s] != ZT_MAX_PEER_NETWORK_PATHS)) {
  310. mine = myBestV4ByScope[s];
  311. theirs = theirBestV4ByScope[s];
  312. break;
  313. }
  314. }
  315. if (mine != ZT_MAX_PEER_NETWORK_PATHS) {
  316. unsigned int alt = (unsigned int)RR->node->prng() & 1; // randomize which hint we send first for black magickal NAT-t reasons
  317. const unsigned int completed = alt + 2;
  318. while (alt != completed) {
  319. if ((alt & 1) == 0) {
  320. Packet outp(_id.address(),RR->identity.address(),Packet::VERB_RENDEZVOUS);
  321. outp.append((uint8_t)0);
  322. other->_id.address().appendTo(outp);
  323. outp.append((uint16_t)other->_paths[theirs].p->address().port());
  324. if (other->_paths[theirs].p->address().ss_family == AF_INET6) {
  325. outp.append((uint8_t)16);
  326. outp.append(other->_paths[theirs].p->address().rawIpData(),16);
  327. } else {
  328. outp.append((uint8_t)4);
  329. outp.append(other->_paths[theirs].p->address().rawIpData(),4);
  330. }
  331. outp.armor(_key,true,aesKeysIfSupported());
  332. _paths[mine].p->send(RR,tPtr,outp.data(),outp.size(),now);
  333. } else {
  334. Packet outp(other->_id.address(),RR->identity.address(),Packet::VERB_RENDEZVOUS);
  335. outp.append((uint8_t)0);
  336. _id.address().appendTo(outp);
  337. outp.append((uint16_t)_paths[mine].p->address().port());
  338. if (_paths[mine].p->address().ss_family == AF_INET6) {
  339. outp.append((uint8_t)16);
  340. outp.append(_paths[mine].p->address().rawIpData(),16);
  341. } else {
  342. outp.append((uint8_t)4);
  343. outp.append(_paths[mine].p->address().rawIpData(),4);
  344. }
  345. outp.armor(other->_key,true,aesKeysIfSupported());
  346. other->_paths[theirs].p->send(RR,tPtr,outp.data(),outp.size(),now);
  347. }
  348. ++alt;
  349. }
  350. }
  351. }
  352. void Peer::sendHELLO(void *tPtr,const int64_t localSocket,const InetAddress &atAddress,int64_t now)
  353. {
  354. Packet outp(_id.address(),RR->identity.address(),Packet::VERB_HELLO);
  355. outp.append((unsigned char)ZT_PROTO_VERSION);
  356. outp.append((unsigned char)ZEROTIER_ONE_VERSION_MAJOR);
  357. outp.append((unsigned char)ZEROTIER_ONE_VERSION_MINOR);
  358. outp.append((uint16_t)ZEROTIER_ONE_VERSION_REVISION);
  359. outp.append(now);
  360. RR->identity.serialize(outp,false);
  361. atAddress.serialize(outp);
  362. outp.append((uint64_t)RR->topology->planetWorldId());
  363. outp.append((uint64_t)RR->topology->planetWorldTimestamp());
  364. const unsigned int startCryptedPortionAt = outp.size();
  365. std::vector<World> moons(RR->topology->moons());
  366. std::vector<uint64_t> moonsWanted(RR->topology->moonsWanted());
  367. outp.append((uint16_t)(moons.size() + moonsWanted.size()));
  368. for(std::vector<World>::const_iterator m(moons.begin());m!=moons.end();++m) {
  369. outp.append((uint8_t)m->type());
  370. outp.append((uint64_t)m->id());
  371. outp.append((uint64_t)m->timestamp());
  372. }
  373. for(std::vector<uint64_t>::const_iterator m(moonsWanted.begin());m!=moonsWanted.end();++m) {
  374. outp.append((uint8_t)World::TYPE_MOON);
  375. outp.append(*m);
  376. outp.append((uint64_t)0);
  377. }
  378. outp.cryptField(_key,startCryptedPortionAt,outp.size() - startCryptedPortionAt);
  379. if (atAddress) {
  380. outp.armor(_key,false,nullptr); // false == don't encrypt full payload, but add MAC
  381. RR->node->expectReplyTo(outp.packetId());
  382. RR->node->putPacket(tPtr,localSocket,atAddress,outp.data(),outp.size());
  383. } else {
  384. RR->node->expectReplyTo(outp.packetId());
  385. RR->sw->send(tPtr,outp,false); // false == don't encrypt full payload, but add MAC
  386. }
  387. }
  388. void Peer::attemptToContactAt(void *tPtr,const int64_t localSocket,const InetAddress &atAddress,int64_t now,bool sendFullHello)
  389. {
  390. if ( (!sendFullHello) && (_vProto >= 5) && (!((_vMajor == 1)&&(_vMinor == 1)&&(_vRevision == 0))) ) {
  391. Packet outp(_id.address(),RR->identity.address(),Packet::VERB_ECHO);
  392. outp.armor(_key,true,aesKeysIfSupported());
  393. RR->node->expectReplyTo(outp.packetId());
  394. RR->node->putPacket(tPtr,localSocket,atAddress,outp.data(),outp.size());
  395. } else {
  396. sendHELLO(tPtr,localSocket,atAddress,now);
  397. }
  398. }
  399. void Peer::tryMemorizedPath(void *tPtr,int64_t now)
  400. {
  401. if ((now - _lastTriedMemorizedPath) >= ZT_TRY_MEMORIZED_PATH_INTERVAL) {
  402. _lastTriedMemorizedPath = now;
  403. InetAddress mp;
  404. if (RR->node->externalPathLookup(tPtr,_id.address(),-1,mp))
  405. attemptToContactAt(tPtr,-1,mp,now,true);
  406. }
  407. }
  408. void Peer::performMultipathStateCheck(void *tPtr, int64_t now)
  409. {
  410. Mutex::Lock _l(_bond_m);
  411. /**
  412. * Check for conditions required for multipath bonding and create a bond
  413. * if allowed.
  414. */
  415. _localMultipathSupported = ((RR->bc->inUse()) && (ZT_PROTO_VERSION > 9));
  416. if (_localMultipathSupported && !_bond) {
  417. if (RR->bc) {
  418. _bond = RR->bc->createTransportTriggeredBond(RR, this);
  419. /**
  420. * Allow new bond to retroactively learn all paths known to this peer
  421. */
  422. if (_bond) {
  423. for (unsigned int i=0;i<ZT_MAX_PEER_NETWORK_PATHS;++i) {
  424. if (_paths[i].p) {
  425. _bond->nominatePathToBond(_paths[i].p, now);
  426. }
  427. }
  428. }
  429. }
  430. }
  431. }
  432. unsigned int Peer::doPingAndKeepalive(void *tPtr,int64_t now)
  433. {
  434. unsigned int sent = 0;
  435. Mutex::Lock _l(_paths_m);
  436. performMultipathStateCheck(tPtr, now);
  437. const bool sendFullHello = ((now - _lastSentFullHello) >= ZT_PEER_PING_PERIOD);
  438. _lastSentFullHello = now;
  439. // Right now we only keep pinging links that have the maximum priority. The
  440. // priority is used to track cluster redirections, meaning that when a cluster
  441. // redirects us its redirect target links override all other links and we
  442. // let those old links expire.
  443. long maxPriority = 0;
  444. for(unsigned int i=0;i<ZT_MAX_PEER_NETWORK_PATHS;++i) {
  445. if (_paths[i].p)
  446. maxPriority = std::max(_paths[i].priority,maxPriority);
  447. else break;
  448. }
  449. unsigned int j = 0;
  450. for(unsigned int i=0;i<ZT_MAX_PEER_NETWORK_PATHS;++i) {
  451. if (_paths[i].p) {
  452. // Clean expired and reduced priority paths
  453. if ( ((now - _paths[i].lr) < ZT_PEER_PATH_EXPIRATION) && (_paths[i].priority == maxPriority) ) {
  454. if ((sendFullHello)||(_paths[i].p->needsHeartbeat(now))) {
  455. attemptToContactAt(tPtr,_paths[i].p->localSocket(),_paths[i].p->address(),now,sendFullHello);
  456. _paths[i].p->sent(now);
  457. sent |= (_paths[i].p->address().ss_family == AF_INET) ? 0x1 : 0x2;
  458. }
  459. if (i != j)
  460. _paths[j] = _paths[i];
  461. ++j;
  462. }
  463. } else break;
  464. }
  465. return sent;
  466. }
  467. void Peer::clusterRedirect(void *tPtr,const SharedPtr<Path> &originatingPath,const InetAddress &remoteAddress,const int64_t now)
  468. {
  469. SharedPtr<Path> np(RR->topology->getPath(originatingPath->localSocket(),remoteAddress));
  470. RR->t->peerRedirected(tPtr,0,*this,np);
  471. attemptToContactAt(tPtr,originatingPath->localSocket(),remoteAddress,now,true);
  472. {
  473. Mutex::Lock _l(_paths_m);
  474. // New priority is higher than the priority of the originating path (if known)
  475. long newPriority = 1;
  476. for(unsigned int i=0;i<ZT_MAX_PEER_NETWORK_PATHS;++i) {
  477. if (_paths[i].p) {
  478. if (_paths[i].p == originatingPath) {
  479. newPriority = _paths[i].priority;
  480. break;
  481. }
  482. } else break;
  483. }
  484. newPriority += 2;
  485. // Erase any paths with lower priority than this one or that are duplicate
  486. // IPs and add this path.
  487. unsigned int j = 0;
  488. for(unsigned int i=0;i<ZT_MAX_PEER_NETWORK_PATHS;++i) {
  489. if (_paths[i].p) {
  490. if ((_paths[i].priority >= newPriority)&&(!_paths[i].p->address().ipsEqual2(remoteAddress))) {
  491. if (i != j)
  492. _paths[j] = _paths[i];
  493. ++j;
  494. }
  495. }
  496. }
  497. if (j < ZT_MAX_PEER_NETWORK_PATHS) {
  498. _paths[j].lr = now;
  499. _paths[j].p = np;
  500. _paths[j].priority = newPriority;
  501. ++j;
  502. while (j < ZT_MAX_PEER_NETWORK_PATHS) {
  503. _paths[j].lr = 0;
  504. _paths[j].p.zero();
  505. _paths[j].priority = 1;
  506. ++j;
  507. }
  508. }
  509. }
  510. }
  511. void Peer::resetWithinScope(void *tPtr,InetAddress::IpScope scope,int inetAddressFamily,int64_t now)
  512. {
  513. Mutex::Lock _l(_paths_m);
  514. for(unsigned int i=0;i<ZT_MAX_PEER_NETWORK_PATHS;++i) {
  515. if (_paths[i].p) {
  516. if ((_paths[i].p->address().ss_family == inetAddressFamily)&&(_paths[i].p->ipScope() == scope)) {
  517. attemptToContactAt(tPtr,_paths[i].p->localSocket(),_paths[i].p->address(),now,false);
  518. _paths[i].p->sent(now);
  519. _paths[i].lr = 0; // path will not be used unless it speaks again
  520. }
  521. } else break;
  522. }
  523. }
  524. void Peer::recordOutgoingPacket(const SharedPtr<Path> &path, const uint64_t packetId,
  525. uint16_t payloadLength, const Packet::Verb verb, const int32_t flowId, int64_t now)
  526. {
  527. if (_localMultipathSupported && _bond) {
  528. _bond->recordOutgoingPacket(path, packetId, payloadLength, verb, flowId, now);
  529. }
  530. }
  531. void Peer::recordIncomingInvalidPacket(const SharedPtr<Path>& path)
  532. {
  533. if (_localMultipathSupported && _bond) {
  534. _bond->recordIncomingInvalidPacket(path);
  535. }
  536. }
  537. void Peer::recordIncomingPacket(const SharedPtr<Path> &path, const uint64_t packetId,
  538. uint16_t payloadLength, const Packet::Verb verb, const int32_t flowId, int64_t now)
  539. {
  540. if (_localMultipathSupported && _bond) {
  541. _bond->recordIncomingPacket(path, packetId, payloadLength, verb, flowId, now);
  542. }
  543. }
  544. } // namespace ZeroTier