Network.cpp 67 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636
  1. /*
  2. * ZeroTier One - Network Virtualization Everywhere
  3. * Copyright (C) 2011-2017 ZeroTier, Inc. https://www.zerotier.com/
  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. * You can be released from the requirements of the license by purchasing
  21. * a commercial license. Buying such a license is mandatory as soon as you
  22. * develop commercial closed-source software that incorporates or links
  23. * directly against ZeroTier software without disclosing the source code
  24. * of your own application.
  25. */
  26. #include <stdio.h>
  27. #include <string.h>
  28. #include <stdlib.h>
  29. #include <math.h>
  30. #include "Constants.hpp"
  31. #include "../version.h"
  32. #include "Network.hpp"
  33. #include "RuntimeEnvironment.hpp"
  34. #include "MAC.hpp"
  35. #include "Address.hpp"
  36. #include "InetAddress.hpp"
  37. #include "Switch.hpp"
  38. #include "Buffer.hpp"
  39. #include "Packet.hpp"
  40. #include "NetworkController.hpp"
  41. #include "Node.hpp"
  42. #include "Peer.hpp"
  43. // Uncomment to make the rules engine dump trace info to stdout
  44. //#define ZT_RULES_ENGINE_DEBUGGING 1
  45. namespace ZeroTier {
  46. namespace {
  47. #ifdef ZT_RULES_ENGINE_DEBUGGING
  48. #define FILTER_TRACE(f,...) { Utils::snprintf(dpbuf,sizeof(dpbuf),f,##__VA_ARGS__); dlog.push_back(std::string(dpbuf)); }
  49. static const char *_rtn(const ZT_VirtualNetworkRuleType rt)
  50. {
  51. switch(rt) {
  52. case ZT_NETWORK_RULE_ACTION_DROP: return "ACTION_DROP";
  53. case ZT_NETWORK_RULE_ACTION_ACCEPT: return "ACTION_ACCEPT";
  54. case ZT_NETWORK_RULE_ACTION_TEE: return "ACTION_TEE";
  55. case ZT_NETWORK_RULE_ACTION_WATCH: return "ACTION_WATCH";
  56. case ZT_NETWORK_RULE_ACTION_REDIRECT: return "ACTION_REDIRECT";
  57. case ZT_NETWORK_RULE_ACTION_BREAK: return "ACTION_BREAK";
  58. case ZT_NETWORK_RULE_MATCH_SOURCE_ZEROTIER_ADDRESS: return "MATCH_SOURCE_ZEROTIER_ADDRESS";
  59. case ZT_NETWORK_RULE_MATCH_DEST_ZEROTIER_ADDRESS: return "MATCH_DEST_ZEROTIER_ADDRESS";
  60. case ZT_NETWORK_RULE_MATCH_VLAN_ID: return "MATCH_VLAN_ID";
  61. case ZT_NETWORK_RULE_MATCH_VLAN_PCP: return "MATCH_VLAN_PCP";
  62. case ZT_NETWORK_RULE_MATCH_VLAN_DEI: return "MATCH_VLAN_DEI";
  63. case ZT_NETWORK_RULE_MATCH_MAC_SOURCE: return "MATCH_MAC_SOURCE";
  64. case ZT_NETWORK_RULE_MATCH_MAC_DEST: return "MATCH_MAC_DEST";
  65. case ZT_NETWORK_RULE_MATCH_IPV4_SOURCE: return "MATCH_IPV4_SOURCE";
  66. case ZT_NETWORK_RULE_MATCH_IPV4_DEST: return "MATCH_IPV4_DEST";
  67. case ZT_NETWORK_RULE_MATCH_IPV6_SOURCE: return "MATCH_IPV6_SOURCE";
  68. case ZT_NETWORK_RULE_MATCH_IPV6_DEST: return "MATCH_IPV6_DEST";
  69. case ZT_NETWORK_RULE_MATCH_IP_TOS: return "MATCH_IP_TOS";
  70. case ZT_NETWORK_RULE_MATCH_IP_PROTOCOL: return "MATCH_IP_PROTOCOL";
  71. case ZT_NETWORK_RULE_MATCH_ETHERTYPE: return "MATCH_ETHERTYPE";
  72. case ZT_NETWORK_RULE_MATCH_ICMP: return "MATCH_ICMP";
  73. case ZT_NETWORK_RULE_MATCH_IP_SOURCE_PORT_RANGE: return "MATCH_IP_SOURCE_PORT_RANGE";
  74. case ZT_NETWORK_RULE_MATCH_IP_DEST_PORT_RANGE: return "MATCH_IP_DEST_PORT_RANGE";
  75. case ZT_NETWORK_RULE_MATCH_CHARACTERISTICS: return "MATCH_CHARACTERISTICS";
  76. case ZT_NETWORK_RULE_MATCH_FRAME_SIZE_RANGE: return "MATCH_FRAME_SIZE_RANGE";
  77. case ZT_NETWORK_RULE_MATCH_TAGS_DIFFERENCE: return "MATCH_TAGS_DIFFERENCE";
  78. case ZT_NETWORK_RULE_MATCH_TAGS_BITWISE_AND: return "MATCH_TAGS_BITWISE_AND";
  79. case ZT_NETWORK_RULE_MATCH_TAGS_BITWISE_OR: return "MATCH_TAGS_BITWISE_OR";
  80. case ZT_NETWORK_RULE_MATCH_TAGS_BITWISE_XOR: return "MATCH_TAGS_BITWISE_XOR";
  81. default: return "???";
  82. }
  83. }
  84. static const void _dumpFilterTrace(const char *ruleName,uint8_t thisSetMatches,bool inbound,const Address &ztSource,const Address &ztDest,const MAC &macSource,const MAC &macDest,const std::vector<std::string> &dlog,unsigned int frameLen,unsigned int etherType,const char *msg)
  85. {
  86. static volatile unsigned long cnt = 0;
  87. printf("%.6lu %c %s %s frameLen=%u etherType=%u" ZT_EOL_S,
  88. cnt++,
  89. ((thisSetMatches) ? 'Y' : '.'),
  90. ruleName,
  91. ((inbound) ? "INBOUND" : "OUTBOUND"),
  92. frameLen,
  93. etherType
  94. );
  95. for(std::vector<std::string>::const_iterator m(dlog.begin());m!=dlog.end();++m)
  96. printf(" | %s" ZT_EOL_S,m->c_str());
  97. printf(" + %c %s->%s %.2x:%.2x:%.2x:%.2x:%.2x:%.2x->%.2x:%.2x:%.2x:%.2x:%.2x:%.2x" ZT_EOL_S,
  98. ((thisSetMatches) ? 'Y' : '.'),
  99. ztSource.toString().c_str(),
  100. ztDest.toString().c_str(),
  101. (unsigned int)macSource[0],
  102. (unsigned int)macSource[1],
  103. (unsigned int)macSource[2],
  104. (unsigned int)macSource[3],
  105. (unsigned int)macSource[4],
  106. (unsigned int)macSource[5],
  107. (unsigned int)macDest[0],
  108. (unsigned int)macDest[1],
  109. (unsigned int)macDest[2],
  110. (unsigned int)macDest[3],
  111. (unsigned int)macDest[4],
  112. (unsigned int)macDest[5]
  113. );
  114. if (msg)
  115. printf(" + (%s)" ZT_EOL_S,msg);
  116. fflush(stdout);
  117. }
  118. #else
  119. #define FILTER_TRACE(f,...) {}
  120. #endif // ZT_RULES_ENGINE_DEBUGGING
  121. // Returns true if packet appears valid; pos and proto will be set
  122. static bool _ipv6GetPayload(const uint8_t *frameData,unsigned int frameLen,unsigned int &pos,unsigned int &proto)
  123. {
  124. if (frameLen < 40)
  125. return false;
  126. pos = 40;
  127. proto = frameData[6];
  128. while (pos <= frameLen) {
  129. switch(proto) {
  130. case 0: // hop-by-hop options
  131. case 43: // routing
  132. case 60: // destination options
  133. case 135: // mobility options
  134. if ((pos + 8) > frameLen)
  135. return false; // invalid!
  136. proto = frameData[pos];
  137. pos += ((unsigned int)frameData[pos + 1] * 8) + 8;
  138. break;
  139. //case 44: // fragment -- we currently can't parse these and they are deprecated in IPv6 anyway
  140. //case 50:
  141. //case 51: // IPSec ESP and AH -- we have to stop here since this is encrypted stuff
  142. default:
  143. return true;
  144. }
  145. }
  146. return false; // overflow == invalid
  147. }
  148. enum _doZtFilterResult
  149. {
  150. DOZTFILTER_NO_MATCH,
  151. DOZTFILTER_DROP,
  152. DOZTFILTER_REDIRECT,
  153. DOZTFILTER_ACCEPT,
  154. DOZTFILTER_SUPER_ACCEPT
  155. };
  156. static _doZtFilterResult _doZtFilter(
  157. const RuntimeEnvironment *RR,
  158. const NetworkConfig &nconf,
  159. const Membership *membership, // can be NULL
  160. const bool inbound,
  161. const Address &ztSource,
  162. Address &ztDest, // MUTABLE -- is changed on REDIRECT actions
  163. const MAC &macSource,
  164. const MAC &macDest,
  165. const uint8_t *const frameData,
  166. const unsigned int frameLen,
  167. const unsigned int etherType,
  168. const unsigned int vlanId,
  169. const ZT_VirtualNetworkRule *rules, // cannot be NULL
  170. const unsigned int ruleCount,
  171. Address &cc, // MUTABLE -- set to TEE destination if TEE action is taken or left alone otherwise
  172. unsigned int &ccLength, // MUTABLE -- set to length of packet payload to TEE
  173. bool &ccWatch) // MUTABLE -- set to true for WATCH target as opposed to normal TEE
  174. {
  175. #ifdef ZT_RULES_ENGINE_DEBUGGING
  176. char dpbuf[1024]; // used by FILTER_TRACE macro
  177. std::vector<std::string> dlog;
  178. #endif // ZT_RULES_ENGINE_DEBUGGING
  179. // Set to true if we are a TEE/REDIRECT/WATCH target
  180. bool superAccept = false;
  181. // The default match state for each set of entries starts as 'true' since an
  182. // ACTION with no MATCH entries preceding it is always taken.
  183. uint8_t thisSetMatches = 1;
  184. for(unsigned int rn=0;rn<ruleCount;++rn) {
  185. const ZT_VirtualNetworkRuleType rt = (ZT_VirtualNetworkRuleType)(rules[rn].t & 0x3f);
  186. // First check if this is an ACTION
  187. if ((unsigned int)rt <= (unsigned int)ZT_NETWORK_RULE_ACTION__MAX_ID) {
  188. if (thisSetMatches) {
  189. switch(rt) {
  190. case ZT_NETWORK_RULE_ACTION_DROP:
  191. #ifdef ZT_RULES_ENGINE_DEBUGGING
  192. _dumpFilterTrace("ACTION_DROP",thisSetMatches,inbound,ztSource,ztDest,macSource,macDest,dlog,frameLen,etherType,(const char *)0);
  193. #endif // ZT_RULES_ENGINE_DEBUGGING
  194. return DOZTFILTER_DROP;
  195. case ZT_NETWORK_RULE_ACTION_ACCEPT:
  196. #ifdef ZT_RULES_ENGINE_DEBUGGING
  197. _dumpFilterTrace("ACTION_ACCEPT",thisSetMatches,inbound,ztSource,ztDest,macSource,macDest,dlog,frameLen,etherType,(const char *)0);
  198. #endif // ZT_RULES_ENGINE_DEBUGGING
  199. return (superAccept ? DOZTFILTER_SUPER_ACCEPT : DOZTFILTER_ACCEPT); // match, accept packet
  200. // These are initially handled together since preliminary logic is common
  201. case ZT_NETWORK_RULE_ACTION_TEE:
  202. case ZT_NETWORK_RULE_ACTION_WATCH:
  203. case ZT_NETWORK_RULE_ACTION_REDIRECT: {
  204. const Address fwdAddr(rules[rn].v.fwd.address);
  205. if (fwdAddr == ztSource) {
  206. #ifdef ZT_RULES_ENGINE_DEBUGGING
  207. _dumpFilterTrace(_rtn(rt),thisSetMatches,inbound,ztSource,ztDest,macSource,macDest,dlog,frameLen,etherType,"skipped as no-op since source is target");
  208. dlog.clear();
  209. #endif // ZT_RULES_ENGINE_DEBUGGING
  210. } else if (fwdAddr == RR->identity.address()) {
  211. if (inbound) {
  212. #ifdef ZT_RULES_ENGINE_DEBUGGING
  213. _dumpFilterTrace(_rtn(rt),thisSetMatches,inbound,ztSource,ztDest,macSource,macDest,dlog,frameLen,etherType,"interpreted as super-ACCEPT on inbound since we are target");
  214. #endif // ZT_RULES_ENGINE_DEBUGGING
  215. return DOZTFILTER_SUPER_ACCEPT;
  216. } else {
  217. #ifdef ZT_RULES_ENGINE_DEBUGGING
  218. _dumpFilterTrace(_rtn(rt),thisSetMatches,inbound,ztSource,ztDest,macSource,macDest,dlog,frameLen,etherType,"skipped as no-op on outbound since we are target");
  219. dlog.clear();
  220. #endif // ZT_RULES_ENGINE_DEBUGGING
  221. }
  222. } else if (fwdAddr == ztDest) {
  223. #ifdef ZT_RULES_ENGINE_DEBUGGING
  224. _dumpFilterTrace(_rtn(rt),thisSetMatches,inbound,ztSource,ztDest,macSource,macDest,dlog,frameLen,etherType,"skipped as no-op because destination is already target");
  225. dlog.clear();
  226. #endif // ZT_RULES_ENGINE_DEBUGGING
  227. } else {
  228. if (rt == ZT_NETWORK_RULE_ACTION_REDIRECT) {
  229. #ifdef ZT_RULES_ENGINE_DEBUGGING
  230. _dumpFilterTrace("ACTION_REDIRECT",thisSetMatches,inbound,ztSource,ztDest,macSource,macDest,dlog,frameLen,etherType,(const char *)0);
  231. #endif // ZT_RULES_ENGINE_DEBUGGING
  232. ztDest = fwdAddr;
  233. return DOZTFILTER_REDIRECT;
  234. } else {
  235. #ifdef ZT_RULES_ENGINE_DEBUGGING
  236. _dumpFilterTrace(_rtn(rt),thisSetMatches,inbound,ztSource,ztDest,macSource,macDest,dlog,frameLen,etherType,(const char *)0);
  237. dlog.clear();
  238. #endif // ZT_RULES_ENGINE_DEBUGGING
  239. cc = fwdAddr;
  240. ccLength = (rules[rn].v.fwd.length != 0) ? ((frameLen < (unsigned int)rules[rn].v.fwd.length) ? frameLen : (unsigned int)rules[rn].v.fwd.length) : frameLen;
  241. ccWatch = (rt == ZT_NETWORK_RULE_ACTION_WATCH);
  242. }
  243. }
  244. } continue;
  245. case ZT_NETWORK_RULE_ACTION_BREAK:
  246. #ifdef ZT_RULES_ENGINE_DEBUGGING
  247. _dumpFilterTrace("ACTION_BREAK",thisSetMatches,inbound,ztSource,ztDest,macSource,macDest,dlog,frameLen,etherType,(const char *)0);
  248. dlog.clear();
  249. #endif // ZT_RULES_ENGINE_DEBUGGING
  250. return DOZTFILTER_NO_MATCH;
  251. // Unrecognized ACTIONs are ignored as no-ops
  252. default:
  253. #ifdef ZT_RULES_ENGINE_DEBUGGING
  254. _dumpFilterTrace(_rtn(rt),thisSetMatches,inbound,ztSource,ztDest,macSource,macDest,dlog,frameLen,etherType,(const char *)0);
  255. dlog.clear();
  256. #endif // ZT_RULES_ENGINE_DEBUGGING
  257. continue;
  258. }
  259. } else {
  260. // If this is an incoming packet and we are a TEE or REDIRECT target, we should
  261. // super-accept if we accept at all. This will cause us to accept redirected or
  262. // tee'd packets in spite of MAC and ZT addressing checks.
  263. if (inbound) {
  264. switch(rt) {
  265. case ZT_NETWORK_RULE_ACTION_TEE:
  266. case ZT_NETWORK_RULE_ACTION_WATCH:
  267. case ZT_NETWORK_RULE_ACTION_REDIRECT:
  268. if (RR->identity.address() == rules[rn].v.fwd.address)
  269. superAccept = true;
  270. break;
  271. default:
  272. break;
  273. }
  274. }
  275. #ifdef ZT_RULES_ENGINE_DEBUGGING
  276. _dumpFilterTrace(_rtn(rt),thisSetMatches,inbound,ztSource,ztDest,macSource,macDest,dlog,frameLen,etherType,(const char *)0);
  277. dlog.clear();
  278. #endif // ZT_RULES_ENGINE_DEBUGGING
  279. thisSetMatches = 1; // reset to default true for next batch of entries
  280. continue;
  281. }
  282. }
  283. // Circuit breaker: no need to evaluate an AND if the set's match state
  284. // is currently false since anything AND false is false.
  285. if ((!thisSetMatches)&&(!(rules[rn].t & 0x40)))
  286. continue;
  287. // If this was not an ACTION evaluate next MATCH and update thisSetMatches with (AND [result])
  288. uint8_t thisRuleMatches = 0;
  289. uint64_t ownershipVerificationMask = 1; // this magic value means it hasn't been computed yet -- this is done lazily the first time it's needed
  290. switch(rt) {
  291. case ZT_NETWORK_RULE_MATCH_SOURCE_ZEROTIER_ADDRESS:
  292. thisRuleMatches = (uint8_t)(rules[rn].v.zt == ztSource.toInt());
  293. FILTER_TRACE("%u %s %c %.10llx==%.10llx -> %u",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),rules[rn].v.zt,ztSource.toInt(),(unsigned int)thisRuleMatches);
  294. break;
  295. case ZT_NETWORK_RULE_MATCH_DEST_ZEROTIER_ADDRESS:
  296. thisRuleMatches = (uint8_t)(rules[rn].v.zt == ztDest.toInt());
  297. FILTER_TRACE("%u %s %c %.10llx==%.10llx -> %u",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),rules[rn].v.zt,ztDest.toInt(),(unsigned int)thisRuleMatches);
  298. break;
  299. case ZT_NETWORK_RULE_MATCH_VLAN_ID:
  300. thisRuleMatches = (uint8_t)(rules[rn].v.vlanId == (uint16_t)vlanId);
  301. FILTER_TRACE("%u %s %c %u==%u -> %u",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),(unsigned int)rules[rn].v.vlanId,(unsigned int)vlanId,(unsigned int)thisRuleMatches);
  302. break;
  303. case ZT_NETWORK_RULE_MATCH_VLAN_PCP:
  304. // NOT SUPPORTED YET
  305. thisRuleMatches = (uint8_t)(rules[rn].v.vlanPcp == 0);
  306. FILTER_TRACE("%u %s %c %u==%u -> %u",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),(unsigned int)rules[rn].v.vlanPcp,0,(unsigned int)thisRuleMatches);
  307. break;
  308. case ZT_NETWORK_RULE_MATCH_VLAN_DEI:
  309. // NOT SUPPORTED YET
  310. thisRuleMatches = (uint8_t)(rules[rn].v.vlanDei == 0);
  311. FILTER_TRACE("%u %s %c %u==%u -> %u",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),(unsigned int)rules[rn].v.vlanDei,0,(unsigned int)thisRuleMatches);
  312. break;
  313. case ZT_NETWORK_RULE_MATCH_MAC_SOURCE:
  314. thisRuleMatches = (uint8_t)(MAC(rules[rn].v.mac,6) == macSource);
  315. FILTER_TRACE("%u %s %c %.12llx=%.12llx -> %u",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),rules[rn].v.mac,macSource.toInt(),(unsigned int)thisRuleMatches);
  316. break;
  317. case ZT_NETWORK_RULE_MATCH_MAC_DEST:
  318. thisRuleMatches = (uint8_t)(MAC(rules[rn].v.mac,6) == macDest);
  319. FILTER_TRACE("%u %s %c %.12llx=%.12llx -> %u",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),rules[rn].v.mac,macDest.toInt(),(unsigned int)thisRuleMatches);
  320. break;
  321. case ZT_NETWORK_RULE_MATCH_IPV4_SOURCE:
  322. if ((etherType == ZT_ETHERTYPE_IPV4)&&(frameLen >= 20)) {
  323. thisRuleMatches = (uint8_t)(InetAddress((const void *)&(rules[rn].v.ipv4.ip),4,rules[rn].v.ipv4.mask).containsAddress(InetAddress((const void *)(frameData + 12),4,0)));
  324. FILTER_TRACE("%u %s %c %s contains %s -> %u",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),InetAddress((const void *)&(rules[rn].v.ipv4.ip),4,rules[rn].v.ipv4.mask).toString().c_str(),InetAddress((const void *)(frameData + 12),4,0).toIpString().c_str(),(unsigned int)thisRuleMatches);
  325. } else {
  326. thisRuleMatches = 0;
  327. FILTER_TRACE("%u %s %c [frame not IPv4] -> 0",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='));
  328. }
  329. break;
  330. case ZT_NETWORK_RULE_MATCH_IPV4_DEST:
  331. if ((etherType == ZT_ETHERTYPE_IPV4)&&(frameLen >= 20)) {
  332. thisRuleMatches = (uint8_t)(InetAddress((const void *)&(rules[rn].v.ipv4.ip),4,rules[rn].v.ipv4.mask).containsAddress(InetAddress((const void *)(frameData + 16),4,0)));
  333. FILTER_TRACE("%u %s %c %s contains %s -> %u",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),InetAddress((const void *)&(rules[rn].v.ipv4.ip),4,rules[rn].v.ipv4.mask).toString().c_str(),InetAddress((const void *)(frameData + 16),4,0).toIpString().c_str(),(unsigned int)thisRuleMatches);
  334. } else {
  335. thisRuleMatches = 0;
  336. FILTER_TRACE("%u %s %c [frame not IPv4] -> 0",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='));
  337. }
  338. break;
  339. case ZT_NETWORK_RULE_MATCH_IPV6_SOURCE:
  340. if ((etherType == ZT_ETHERTYPE_IPV6)&&(frameLen >= 40)) {
  341. thisRuleMatches = (uint8_t)(InetAddress((const void *)rules[rn].v.ipv6.ip,16,rules[rn].v.ipv6.mask).containsAddress(InetAddress((const void *)(frameData + 8),16,0)));
  342. FILTER_TRACE("%u %s %c %s contains %s -> %u",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),InetAddress((const void *)rules[rn].v.ipv6.ip,16,rules[rn].v.ipv6.mask).toString().c_str(),InetAddress((const void *)(frameData + 8),16,0).toIpString().c_str(),(unsigned int)thisRuleMatches);
  343. } else {
  344. thisRuleMatches = 0;
  345. FILTER_TRACE("%u %s %c [frame not IPv6] -> 0",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='));
  346. }
  347. break;
  348. case ZT_NETWORK_RULE_MATCH_IPV6_DEST:
  349. if ((etherType == ZT_ETHERTYPE_IPV6)&&(frameLen >= 40)) {
  350. thisRuleMatches = (uint8_t)(InetAddress((const void *)rules[rn].v.ipv6.ip,16,rules[rn].v.ipv6.mask).containsAddress(InetAddress((const void *)(frameData + 24),16,0)));
  351. FILTER_TRACE("%u %s %c %s contains %s -> %u",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),InetAddress((const void *)rules[rn].v.ipv6.ip,16,rules[rn].v.ipv6.mask).toString().c_str(),InetAddress((const void *)(frameData + 24),16,0).toIpString().c_str(),(unsigned int)thisRuleMatches);
  352. } else {
  353. thisRuleMatches = 0;
  354. FILTER_TRACE("%u %s %c [frame not IPv6] -> 0",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='));
  355. }
  356. break;
  357. case ZT_NETWORK_RULE_MATCH_IP_TOS:
  358. if ((etherType == ZT_ETHERTYPE_IPV4)&&(frameLen >= 20)) {
  359. //thisRuleMatches = (uint8_t)(rules[rn].v.ipTos == ((frameData[1] & 0xfc) >> 2));
  360. const uint8_t tosMasked = frameData[1] & rules[rn].v.ipTos.mask;
  361. thisRuleMatches = (uint8_t)((tosMasked >= rules[rn].v.ipTos.value[0])&&(tosMasked <= rules[rn].v.ipTos.value[1]));
  362. FILTER_TRACE("%u %s %c (IPv4) %u&%u==%u-%u -> %u",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),(unsigned int)tosMasked,(unsigned int)rules[rn].v.ipTos.mask,(unsigned int)rules[rn].v.ipTos.value[0],(unsigned int)rules[rn].v.ipTos.value[1],(unsigned int)thisRuleMatches);
  363. } else if ((etherType == ZT_ETHERTYPE_IPV6)&&(frameLen >= 40)) {
  364. const uint8_t tosMasked = (((frameData[0] << 4) & 0xf0) | ((frameData[1] >> 4) & 0x0f)) & rules[rn].v.ipTos.mask;
  365. thisRuleMatches = (uint8_t)((tosMasked >= rules[rn].v.ipTos.value[0])&&(tosMasked <= rules[rn].v.ipTos.value[1]));
  366. FILTER_TRACE("%u %s %c (IPv4) %u&%u==%u-%u -> %u",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),(unsigned int)tosMasked,(unsigned int)rules[rn].v.ipTos.mask,(unsigned int)rules[rn].v.ipTos.value[0],(unsigned int)rules[rn].v.ipTos.value[1],(unsigned int)thisRuleMatches);
  367. } else {
  368. thisRuleMatches = 0;
  369. FILTER_TRACE("%u %s %c [frame not IP] -> 0",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='));
  370. }
  371. break;
  372. case ZT_NETWORK_RULE_MATCH_IP_PROTOCOL:
  373. if ((etherType == ZT_ETHERTYPE_IPV4)&&(frameLen >= 20)) {
  374. thisRuleMatches = (uint8_t)(rules[rn].v.ipProtocol == frameData[9]);
  375. FILTER_TRACE("%u %s %c (IPv4) %u==%u -> %u",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),(unsigned int)rules[rn].v.ipProtocol,(unsigned int)frameData[9],(unsigned int)thisRuleMatches);
  376. } else if (etherType == ZT_ETHERTYPE_IPV6) {
  377. unsigned int pos = 0,proto = 0;
  378. if (_ipv6GetPayload(frameData,frameLen,pos,proto)) {
  379. thisRuleMatches = (uint8_t)(rules[rn].v.ipProtocol == (uint8_t)proto);
  380. FILTER_TRACE("%u %s %c (IPv6) %u==%u -> %u",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),(unsigned int)rules[rn].v.ipProtocol,proto,(unsigned int)thisRuleMatches);
  381. } else {
  382. thisRuleMatches = 0;
  383. FILTER_TRACE("%u %s %c [invalid IPv6] -> 0",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='));
  384. }
  385. } else {
  386. thisRuleMatches = 0;
  387. FILTER_TRACE("%u %s %c [frame not IP] -> 0",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='));
  388. }
  389. break;
  390. case ZT_NETWORK_RULE_MATCH_ETHERTYPE:
  391. thisRuleMatches = (uint8_t)(rules[rn].v.etherType == (uint16_t)etherType);
  392. FILTER_TRACE("%u %s %c %u==%u -> %u",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),(unsigned int)rules[rn].v.etherType,etherType,(unsigned int)thisRuleMatches);
  393. break;
  394. case ZT_NETWORK_RULE_MATCH_ICMP:
  395. if ((etherType == ZT_ETHERTYPE_IPV4)&&(frameLen >= 20)) {
  396. if (frameData[9] == 0x01) { // IP protocol == ICMP
  397. const unsigned int ihl = (frameData[0] & 0xf) * 4;
  398. if (frameLen >= (ihl + 2)) {
  399. if (rules[rn].v.icmp.type == frameData[ihl]) {
  400. if ((rules[rn].v.icmp.flags & 0x01) != 0) {
  401. thisRuleMatches = (uint8_t)(frameData[ihl+1] == rules[rn].v.icmp.code);
  402. } else {
  403. thisRuleMatches = 1;
  404. }
  405. } else {
  406. thisRuleMatches = 0;
  407. }
  408. FILTER_TRACE("%u %s %c (IPv4) icmp-type:%d==%d icmp-code:%d==%d -> %u",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),(int)frameData[ihl],(int)rules[rn].v.icmp.type,(int)frameData[ihl+1],(((rules[rn].v.icmp.flags & 0x01) != 0) ? (int)rules[rn].v.icmp.code : -1),(unsigned int)thisRuleMatches);
  409. } else {
  410. thisRuleMatches = 0;
  411. FILTER_TRACE("%u %s %c [IPv4 frame invalid] -> 0",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='));
  412. }
  413. } else {
  414. thisRuleMatches = 0;
  415. FILTER_TRACE("%u %s %c [frame not ICMP] -> 0",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='));
  416. }
  417. } else if (etherType == ZT_ETHERTYPE_IPV6) {
  418. unsigned int pos = 0,proto = 0;
  419. if (_ipv6GetPayload(frameData,frameLen,pos,proto)) {
  420. if ((proto == 0x3a)&&(frameLen >= (pos+2))) {
  421. if (rules[rn].v.icmp.type == frameData[pos]) {
  422. if ((rules[rn].v.icmp.flags & 0x01) != 0) {
  423. thisRuleMatches = (uint8_t)(frameData[pos+1] == rules[rn].v.icmp.code);
  424. } else {
  425. thisRuleMatches = 1;
  426. }
  427. } else {
  428. thisRuleMatches = 0;
  429. }
  430. FILTER_TRACE("%u %s %c (IPv6) icmp-type:%d==%d icmp-code:%d==%d -> %u",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),(int)frameData[pos],(int)rules[rn].v.icmp.type,(int)frameData[pos+1],(((rules[rn].v.icmp.flags & 0x01) != 0) ? (int)rules[rn].v.icmp.code : -1),(unsigned int)thisRuleMatches);
  431. } else {
  432. thisRuleMatches = 0;
  433. FILTER_TRACE("%u %s %c [frame not ICMPv6] -> 0",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='));
  434. }
  435. } else {
  436. thisRuleMatches = 0;
  437. FILTER_TRACE("%u %s %c [invalid IPv6] -> 0",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='));
  438. }
  439. } else {
  440. thisRuleMatches = 0;
  441. FILTER_TRACE("%u %s %c [frame not IP] -> 0",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='));
  442. }
  443. break;
  444. break;
  445. case ZT_NETWORK_RULE_MATCH_IP_SOURCE_PORT_RANGE:
  446. case ZT_NETWORK_RULE_MATCH_IP_DEST_PORT_RANGE:
  447. if ((etherType == ZT_ETHERTYPE_IPV4)&&(frameLen >= 20)) {
  448. const unsigned int headerLen = 4 * (frameData[0] & 0xf);
  449. int p = -1;
  450. switch(frameData[9]) { // IP protocol number
  451. // All these start with 16-bit source and destination port in that order
  452. case 0x06: // TCP
  453. case 0x11: // UDP
  454. case 0x84: // SCTP
  455. case 0x88: // UDPLite
  456. if (frameLen > (headerLen + 4)) {
  457. unsigned int pos = headerLen + ((rt == ZT_NETWORK_RULE_MATCH_IP_DEST_PORT_RANGE) ? 2 : 0);
  458. p = (int)frameData[pos++] << 8;
  459. p |= (int)frameData[pos];
  460. }
  461. break;
  462. }
  463. thisRuleMatches = (p >= 0) ? (uint8_t)((p >= (int)rules[rn].v.port[0])&&(p <= (int)rules[rn].v.port[1])) : (uint8_t)0;
  464. FILTER_TRACE("%u %s %c (IPv4) %d in %d-%d -> %u",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),p,(int)rules[rn].v.port[0],(int)rules[rn].v.port[1],(unsigned int)thisRuleMatches);
  465. } else if (etherType == ZT_ETHERTYPE_IPV6) {
  466. unsigned int pos = 0,proto = 0;
  467. if (_ipv6GetPayload(frameData,frameLen,pos,proto)) {
  468. int p = -1;
  469. switch(proto) { // IP protocol number
  470. // All these start with 16-bit source and destination port in that order
  471. case 0x06: // TCP
  472. case 0x11: // UDP
  473. case 0x84: // SCTP
  474. case 0x88: // UDPLite
  475. if (frameLen > (pos + 4)) {
  476. if (rt == ZT_NETWORK_RULE_MATCH_IP_DEST_PORT_RANGE) pos += 2;
  477. p = (int)frameData[pos++] << 8;
  478. p |= (int)frameData[pos];
  479. }
  480. break;
  481. }
  482. thisRuleMatches = (p > 0) ? (uint8_t)((p >= (int)rules[rn].v.port[0])&&(p <= (int)rules[rn].v.port[1])) : (uint8_t)0;
  483. FILTER_TRACE("%u %s %c (IPv6) %d in %d-%d -> %u",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),p,(int)rules[rn].v.port[0],(int)rules[rn].v.port[1],(unsigned int)thisRuleMatches);
  484. } else {
  485. thisRuleMatches = 0;
  486. FILTER_TRACE("%u %s %c [invalid IPv6] -> 0",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='));
  487. }
  488. } else {
  489. thisRuleMatches = 0;
  490. FILTER_TRACE("%u %s %c [frame not IP] -> 0",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='));
  491. }
  492. break;
  493. case ZT_NETWORK_RULE_MATCH_CHARACTERISTICS: {
  494. uint64_t cf = (inbound) ? ZT_RULE_PACKET_CHARACTERISTICS_INBOUND : 0ULL;
  495. if (macDest.isMulticast()) cf |= ZT_RULE_PACKET_CHARACTERISTICS_MULTICAST;
  496. if (macDest.isBroadcast()) cf |= ZT_RULE_PACKET_CHARACTERISTICS_BROADCAST;
  497. if (ownershipVerificationMask == 1) {
  498. ownershipVerificationMask = 0;
  499. InetAddress src;
  500. if ((etherType == ZT_ETHERTYPE_IPV4)&&(frameLen >= 20)) {
  501. src.set((const void *)(frameData + 12),4,0);
  502. } else if ((etherType == ZT_ETHERTYPE_IPV6)&&(frameLen >= 40)) {
  503. // IPv6 NDP requires special handling, since the src and dest IPs in the packet are empty or link-local.
  504. if ( (frameLen >= (40 + 8 + 16)) && (frameData[6] == 0x3a) && ((frameData[40] == 0x87)||(frameData[40] == 0x88)) ) {
  505. if (frameData[40] == 0x87) {
  506. // Neighbor solicitations contain no reliable source address, so we implement a small
  507. // hack by considering them authenticated. Otherwise you would pretty much have to do
  508. // this manually in the rule set for IPv6 to work at all.
  509. ownershipVerificationMask |= ZT_RULE_PACKET_CHARACTERISTICS_SENDER_IP_AUTHENTICATED;
  510. } else {
  511. // Neighbor advertisements on the other hand can absolutely be authenticated.
  512. src.set((const void *)(frameData + 40 + 8),16,0);
  513. }
  514. } else {
  515. // Other IPv6 packets can be handled normally
  516. src.set((const void *)(frameData + 8),16,0);
  517. }
  518. } else if ((etherType == ZT_ETHERTYPE_ARP)&&(frameLen >= 28)) {
  519. src.set((const void *)(frameData + 14),4,0);
  520. }
  521. if (inbound) {
  522. if (membership) {
  523. if ((src)&&(membership->hasCertificateOfOwnershipFor<InetAddress>(nconf,src)))
  524. ownershipVerificationMask |= ZT_RULE_PACKET_CHARACTERISTICS_SENDER_IP_AUTHENTICATED;
  525. if (membership->hasCertificateOfOwnershipFor<MAC>(nconf,macSource))
  526. ownershipVerificationMask |= ZT_RULE_PACKET_CHARACTERISTICS_SENDER_MAC_AUTHENTICATED;
  527. }
  528. } else {
  529. for(unsigned int i=0;i<nconf.certificateOfOwnershipCount;++i) {
  530. if ((src)&&(nconf.certificatesOfOwnership[i].owns(src)))
  531. ownershipVerificationMask |= ZT_RULE_PACKET_CHARACTERISTICS_SENDER_IP_AUTHENTICATED;
  532. if (nconf.certificatesOfOwnership[i].owns(macSource))
  533. ownershipVerificationMask |= ZT_RULE_PACKET_CHARACTERISTICS_SENDER_MAC_AUTHENTICATED;
  534. }
  535. }
  536. }
  537. cf |= ownershipVerificationMask;
  538. if ((etherType == ZT_ETHERTYPE_IPV4)&&(frameLen >= 20)&&(frameData[9] == 0x06)) {
  539. const unsigned int headerLen = 4 * (frameData[0] & 0xf);
  540. cf |= (uint64_t)frameData[headerLen + 13];
  541. cf |= (((uint64_t)(frameData[headerLen + 12] & 0x0f)) << 8);
  542. } else if (etherType == ZT_ETHERTYPE_IPV6) {
  543. unsigned int pos = 0,proto = 0;
  544. if (_ipv6GetPayload(frameData,frameLen,pos,proto)) {
  545. if ((proto == 0x06)&&(frameLen > (pos + 14))) {
  546. cf |= (uint64_t)frameData[pos + 13];
  547. cf |= (((uint64_t)(frameData[pos + 12] & 0x0f)) << 8);
  548. }
  549. }
  550. }
  551. thisRuleMatches = (uint8_t)((cf & rules[rn].v.characteristics) != 0);
  552. FILTER_TRACE("%u %s %c (%.16llx | %.16llx)!=0 -> %u",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),cf,rules[rn].v.characteristics,(unsigned int)thisRuleMatches);
  553. } break;
  554. case ZT_NETWORK_RULE_MATCH_FRAME_SIZE_RANGE:
  555. thisRuleMatches = (uint8_t)((frameLen >= (unsigned int)rules[rn].v.frameSize[0])&&(frameLen <= (unsigned int)rules[rn].v.frameSize[1]));
  556. FILTER_TRACE("%u %s %c %u in %u-%u -> %u",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),frameLen,(unsigned int)rules[rn].v.frameSize[0],(unsigned int)rules[rn].v.frameSize[1],(unsigned int)thisRuleMatches);
  557. break;
  558. case ZT_NETWORK_RULE_MATCH_RANDOM:
  559. thisRuleMatches = (uint8_t)((uint32_t)(RR->node->prng() & 0xffffffffULL) <= rules[rn].v.randomProbability);
  560. FILTER_TRACE("%u %s %c -> %u",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),(unsigned int)thisRuleMatches);
  561. break;
  562. case ZT_NETWORK_RULE_MATCH_TAGS_DIFFERENCE:
  563. case ZT_NETWORK_RULE_MATCH_TAGS_BITWISE_AND:
  564. case ZT_NETWORK_RULE_MATCH_TAGS_BITWISE_OR:
  565. case ZT_NETWORK_RULE_MATCH_TAGS_BITWISE_XOR:
  566. case ZT_NETWORK_RULE_MATCH_TAGS_EQUAL: {
  567. const Tag *const localTag = std::lower_bound(&(nconf.tags[0]),&(nconf.tags[nconf.tagCount]),rules[rn].v.tag.id,Tag::IdComparePredicate());
  568. if ((localTag != &(nconf.tags[nconf.tagCount]))&&(localTag->id() == rules[rn].v.tag.id)) {
  569. const Tag *const remoteTag = ((membership) ? membership->getTag(nconf,rules[rn].v.tag.id) : (const Tag *)0);
  570. if (remoteTag) {
  571. const uint32_t ltv = localTag->value();
  572. const uint32_t rtv = remoteTag->value();
  573. if (rt == ZT_NETWORK_RULE_MATCH_TAGS_DIFFERENCE) {
  574. const uint32_t diff = (ltv > rtv) ? (ltv - rtv) : (rtv - ltv);
  575. thisRuleMatches = (uint8_t)(diff <= rules[rn].v.tag.value);
  576. FILTER_TRACE("%u %s %c TAG %u local:%u remote:%u difference:%u<=%u -> %u",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),(unsigned int)rules[rn].v.tag.id,ltv,rtv,diff,(unsigned int)rules[rn].v.tag.value,thisRuleMatches);
  577. } else if (rt == ZT_NETWORK_RULE_MATCH_TAGS_BITWISE_AND) {
  578. thisRuleMatches = (uint8_t)((ltv & rtv) == rules[rn].v.tag.value);
  579. FILTER_TRACE("%u %s %c TAG %u local:%.8x & remote:%.8x == %.8x -> %u",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),(unsigned int)rules[rn].v.tag.id,ltv,rtv,(unsigned int)rules[rn].v.tag.value,(unsigned int)thisRuleMatches);
  580. } else if (rt == ZT_NETWORK_RULE_MATCH_TAGS_BITWISE_OR) {
  581. thisRuleMatches = (uint8_t)((ltv | rtv) == rules[rn].v.tag.value);
  582. FILTER_TRACE("%u %s %c TAG %u local:%.8x | remote:%.8x == %.8x -> %u",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),(unsigned int)rules[rn].v.tag.id,ltv,rtv,(unsigned int)rules[rn].v.tag.value,(unsigned int)thisRuleMatches);
  583. } else if (rt == ZT_NETWORK_RULE_MATCH_TAGS_BITWISE_XOR) {
  584. thisRuleMatches = (uint8_t)((ltv ^ rtv) == rules[rn].v.tag.value);
  585. FILTER_TRACE("%u %s %c TAG %u local:%.8x ^ remote:%.8x == %.8x -> %u",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),(unsigned int)rules[rn].v.tag.id,ltv,rtv,(unsigned int)rules[rn].v.tag.value,(unsigned int)thisRuleMatches);
  586. } else if (rt == ZT_NETWORK_RULE_MATCH_TAGS_EQUAL) {
  587. thisRuleMatches = (uint8_t)((ltv == rules[rn].v.tag.value)&&(rtv == rules[rn].v.tag.value));
  588. FILTER_TRACE("%u %s %c TAG %u local:%.8x and remote:%.8x == %.8x -> %u",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),(unsigned int)rules[rn].v.tag.id,ltv,rtv,(unsigned int)rules[rn].v.tag.value,(unsigned int)thisRuleMatches);
  589. } else { // sanity check, can't really happen
  590. thisRuleMatches = 0;
  591. }
  592. } else {
  593. if ((inbound)&&(!superAccept)) {
  594. thisRuleMatches = 0;
  595. FILTER_TRACE("%u %s %c remote tag %u not found -> 0 (inbound side is strict)",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),(unsigned int)rules[rn].v.tag.id);
  596. } else {
  597. // Outbound side is not strict since if we have to match both tags and
  598. // we are sending a first packet to a recipient, we probably do not know
  599. // about their tags yet. They will filter on inbound and we will filter
  600. // once we get their tag. If we are a tee/redirect target we are also
  601. // not strict since we likely do not have these tags.
  602. thisRuleMatches = 1;
  603. FILTER_TRACE("%u %s %c remote tag %u not found -> 1 (outbound side and TEE/REDIRECT targets are not strict)",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),(unsigned int)rules[rn].v.tag.id);
  604. }
  605. }
  606. } else {
  607. thisRuleMatches = 0;
  608. FILTER_TRACE("%u %s %c local tag %u not found -> 0",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),(unsigned int)rules[rn].v.tag.id);
  609. }
  610. } break;
  611. case ZT_NETWORK_RULE_MATCH_TAG_SENDER:
  612. case ZT_NETWORK_RULE_MATCH_TAG_RECEIVER: {
  613. if (superAccept) {
  614. thisRuleMatches = 1;
  615. FILTER_TRACE("%u %s %c we are a TEE/REDIRECT target -> 1",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='));
  616. } else if ( ((rt == ZT_NETWORK_RULE_MATCH_TAG_SENDER)&&(inbound)) || ((rt == ZT_NETWORK_RULE_MATCH_TAG_RECEIVER)&&(!inbound)) ) {
  617. const Tag *const remoteTag = ((membership) ? membership->getTag(nconf,rules[rn].v.tag.id) : (const Tag *)0);
  618. if (remoteTag) {
  619. thisRuleMatches = (uint8_t)(remoteTag->value() == rules[rn].v.tag.value);
  620. FILTER_TRACE("%u %s %c TAG %u %.8x == %.8x -> %u",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),(unsigned int)rules[rn].v.tag.id,remoteTag->value(),(unsigned int)rules[rn].v.tag.value,(unsigned int)thisRuleMatches);
  621. } else {
  622. if (rt == ZT_NETWORK_RULE_MATCH_TAG_RECEIVER) {
  623. // If we are checking the receiver and this is an outbound packet, we
  624. // can't be strict since we may not yet know the receiver's tag.
  625. thisRuleMatches = 1;
  626. FILTER_TRACE("%u %s %c (inbound) remote tag %u not found -> 1 (outbound receiver match is not strict)",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),(unsigned int)rules[rn].v.tag.id);
  627. } else {
  628. thisRuleMatches = 0;
  629. FILTER_TRACE("%u %s %c (inbound) remote tag %u not found -> 0",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),(unsigned int)rules[rn].v.tag.id);
  630. }
  631. }
  632. } else { // sender and outbound or receiver and inbound
  633. const Tag *const localTag = std::lower_bound(&(nconf.tags[0]),&(nconf.tags[nconf.tagCount]),rules[rn].v.tag.id,Tag::IdComparePredicate());
  634. if ((localTag != &(nconf.tags[nconf.tagCount]))&&(localTag->id() == rules[rn].v.tag.id)) {
  635. thisRuleMatches = (uint8_t)(localTag->value() == rules[rn].v.tag.value);
  636. FILTER_TRACE("%u %s %c TAG %u %.8x == %.8x -> %u",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),(unsigned int)rules[rn].v.tag.id,localTag->value(),(unsigned int)rules[rn].v.tag.value,(unsigned int)thisRuleMatches);
  637. } else {
  638. thisRuleMatches = 0;
  639. FILTER_TRACE("%u %s %c local tag %u not found -> 0",rn,_rtn(rt),(((rules[rn].t & 0x80) != 0) ? '!' : '='),(unsigned int)rules[rn].v.tag.id);
  640. }
  641. }
  642. } break;
  643. // The result of an unsupported MATCH is configurable at the network
  644. // level via a flag.
  645. default:
  646. thisRuleMatches = (uint8_t)((nconf.flags & ZT_NETWORKCONFIG_FLAG_RULES_RESULT_OF_UNSUPPORTED_MATCH) != 0);
  647. break;
  648. }
  649. if ((rules[rn].t & 0x40))
  650. thisSetMatches |= (thisRuleMatches ^ ((rules[rn].t >> 7) & 1));
  651. else thisSetMatches &= (thisRuleMatches ^ ((rules[rn].t >> 7) & 1));
  652. }
  653. return DOZTFILTER_NO_MATCH;
  654. }
  655. } // anonymous namespace
  656. const ZeroTier::MulticastGroup Network::BROADCAST(ZeroTier::MAC(0xffffffffffffULL),0);
  657. Network::Network(const RuntimeEnvironment *renv,void *tPtr,uint64_t nwid,void *uptr,const NetworkConfig *nconf) :
  658. RR(renv),
  659. _uPtr(uptr),
  660. _id(nwid),
  661. _lastAnnouncedMulticastGroupsUpstream(0),
  662. _mac(renv->identity.address(),nwid),
  663. _portInitialized(false),
  664. _lastConfigUpdate(0),
  665. _destroyed(false),
  666. _netconfFailure(NETCONF_FAILURE_NONE),
  667. _portError(0)
  668. {
  669. for(int i=0;i<ZT_NETWORK_MAX_INCOMING_UPDATES;++i)
  670. _incomingConfigChunks[i].ts = 0;
  671. if (nconf) {
  672. this->setConfiguration(tPtr,*nconf,false);
  673. _lastConfigUpdate = 0; // still want to re-request since it's likely outdated
  674. } else {
  675. bool got = false;
  676. Dictionary<ZT_NETWORKCONFIG_DICT_CAPACITY> *dict = new Dictionary<ZT_NETWORKCONFIG_DICT_CAPACITY>();
  677. try {
  678. int n = RR->node->stateObjectGet(tPtr,ZT_STATE_OBJECT_NETWORK_CONFIG,nwid,dict->unsafeData(),ZT_NETWORKCONFIG_DICT_CAPACITY - 1);
  679. if (n > 1) {
  680. NetworkConfig *nconf = new NetworkConfig();
  681. try {
  682. if (nconf->fromDictionary(*dict)) {
  683. this->setConfiguration(tPtr,*nconf,false);
  684. _lastConfigUpdate = 0; // still want to re-request an update since it's likely outdated
  685. got = true;
  686. }
  687. } catch ( ... ) {}
  688. delete nconf;
  689. }
  690. } catch ( ... ) {}
  691. delete dict;
  692. if (!got)
  693. RR->node->stateObjectPut(tPtr,ZT_STATE_OBJECT_NETWORK_CONFIG,nwid,"\n",1);
  694. }
  695. if (!_portInitialized) {
  696. ZT_VirtualNetworkConfig ctmp;
  697. _externalConfig(&ctmp);
  698. _portError = RR->node->configureVirtualNetworkPort(tPtr,_id,&_uPtr,ZT_VIRTUAL_NETWORK_CONFIG_OPERATION_UP,&ctmp);
  699. _portInitialized = true;
  700. }
  701. }
  702. Network::~Network()
  703. {
  704. ZT_VirtualNetworkConfig ctmp;
  705. _externalConfig(&ctmp);
  706. if (_destroyed) {
  707. // This is done in Node::leave() so we can pass tPtr properly
  708. //RR->node->configureVirtualNetworkPort((void *)0,_id,&_uPtr,ZT_VIRTUAL_NETWORK_CONFIG_OPERATION_DESTROY,&ctmp);
  709. } else {
  710. RR->node->configureVirtualNetworkPort((void *)0,_id,&_uPtr,ZT_VIRTUAL_NETWORK_CONFIG_OPERATION_DOWN,&ctmp);
  711. }
  712. }
  713. bool Network::filterOutgoingPacket(
  714. void *tPtr,
  715. const bool noTee,
  716. const Address &ztSource,
  717. const Address &ztDest,
  718. const MAC &macSource,
  719. const MAC &macDest,
  720. const uint8_t *frameData,
  721. const unsigned int frameLen,
  722. const unsigned int etherType,
  723. const unsigned int vlanId)
  724. {
  725. const uint64_t now = RR->node->now();
  726. Address ztFinalDest(ztDest);
  727. int localCapabilityIndex = -1;
  728. bool accept = false;
  729. Mutex::Lock _l(_lock);
  730. Membership *const membership = (ztDest) ? _memberships.get(ztDest) : (Membership *)0;
  731. Address cc;
  732. unsigned int ccLength = 0;
  733. bool ccWatch = false;
  734. switch(_doZtFilter(RR,_config,membership,false,ztSource,ztFinalDest,macSource,macDest,frameData,frameLen,etherType,vlanId,_config.rules,_config.ruleCount,cc,ccLength,ccWatch)) {
  735. case DOZTFILTER_NO_MATCH:
  736. for(unsigned int c=0;c<_config.capabilityCount;++c) {
  737. ztFinalDest = ztDest; // sanity check, shouldn't be possible if there was no match
  738. Address cc2;
  739. unsigned int ccLength2 = 0;
  740. bool ccWatch2 = false;
  741. switch (_doZtFilter(RR,_config,membership,false,ztSource,ztFinalDest,macSource,macDest,frameData,frameLen,etherType,vlanId,_config.capabilities[c].rules(),_config.capabilities[c].ruleCount(),cc2,ccLength2,ccWatch2)) {
  742. case DOZTFILTER_NO_MATCH:
  743. case DOZTFILTER_DROP: // explicit DROP in a capability just terminates its evaluation and is an anti-pattern
  744. break;
  745. case DOZTFILTER_REDIRECT: // interpreted as ACCEPT but ztFinalDest will have been changed in _doZtFilter()
  746. case DOZTFILTER_ACCEPT:
  747. case DOZTFILTER_SUPER_ACCEPT: // no difference in behavior on outbound side
  748. localCapabilityIndex = (int)c;
  749. accept = true;
  750. if ((!noTee)&&(cc2)) {
  751. Membership &m2 = _membership(cc2);
  752. m2.pushCredentials(RR,tPtr,now,cc2,_config,localCapabilityIndex,false);
  753. Packet outp(cc2,RR->identity.address(),Packet::VERB_EXT_FRAME);
  754. outp.append(_id);
  755. outp.append((uint8_t)(ccWatch2 ? 0x16 : 0x02));
  756. macDest.appendTo(outp);
  757. macSource.appendTo(outp);
  758. outp.append((uint16_t)etherType);
  759. outp.append(frameData,ccLength2);
  760. outp.compress();
  761. RR->sw->send(tPtr,outp,true);
  762. }
  763. break;
  764. }
  765. if (accept)
  766. break;
  767. }
  768. break;
  769. case DOZTFILTER_DROP:
  770. return false;
  771. case DOZTFILTER_REDIRECT: // interpreted as ACCEPT but ztFinalDest will have been changed in _doZtFilter()
  772. case DOZTFILTER_ACCEPT:
  773. case DOZTFILTER_SUPER_ACCEPT: // no difference in behavior on outbound side
  774. accept = true;
  775. break;
  776. }
  777. if (accept) {
  778. if (membership)
  779. membership->pushCredentials(RR,tPtr,now,ztDest,_config,localCapabilityIndex,false);
  780. if ((!noTee)&&(cc)) {
  781. Membership &m2 = _membership(cc);
  782. m2.pushCredentials(RR,tPtr,now,cc,_config,localCapabilityIndex,false);
  783. Packet outp(cc,RR->identity.address(),Packet::VERB_EXT_FRAME);
  784. outp.append(_id);
  785. outp.append((uint8_t)(ccWatch ? 0x16 : 0x02));
  786. macDest.appendTo(outp);
  787. macSource.appendTo(outp);
  788. outp.append((uint16_t)etherType);
  789. outp.append(frameData,ccLength);
  790. outp.compress();
  791. RR->sw->send(tPtr,outp,true);
  792. }
  793. if ((ztDest != ztFinalDest)&&(ztFinalDest)) {
  794. Membership &m2 = _membership(ztFinalDest);
  795. m2.pushCredentials(RR,tPtr,now,ztFinalDest,_config,localCapabilityIndex,false);
  796. Packet outp(ztFinalDest,RR->identity.address(),Packet::VERB_EXT_FRAME);
  797. outp.append(_id);
  798. outp.append((uint8_t)0x04);
  799. macDest.appendTo(outp);
  800. macSource.appendTo(outp);
  801. outp.append((uint16_t)etherType);
  802. outp.append(frameData,frameLen);
  803. outp.compress();
  804. RR->sw->send(tPtr,outp,true);
  805. return false; // DROP locally, since we redirected
  806. } else {
  807. return true;
  808. }
  809. } else {
  810. return false;
  811. }
  812. }
  813. int Network::filterIncomingPacket(
  814. void *tPtr,
  815. const SharedPtr<Peer> &sourcePeer,
  816. const Address &ztDest,
  817. const MAC &macSource,
  818. const MAC &macDest,
  819. const uint8_t *frameData,
  820. const unsigned int frameLen,
  821. const unsigned int etherType,
  822. const unsigned int vlanId)
  823. {
  824. Address ztFinalDest(ztDest);
  825. int accept = 0;
  826. Mutex::Lock _l(_lock);
  827. Membership &membership = _membership(sourcePeer->address());
  828. Address cc;
  829. unsigned int ccLength = 0;
  830. bool ccWatch = false;
  831. switch (_doZtFilter(RR,_config,&membership,true,sourcePeer->address(),ztFinalDest,macSource,macDest,frameData,frameLen,etherType,vlanId,_config.rules,_config.ruleCount,cc,ccLength,ccWatch)) {
  832. case DOZTFILTER_NO_MATCH: {
  833. Membership::CapabilityIterator mci(membership,_config);
  834. const Capability *c;
  835. while ((c = mci.next())) {
  836. ztFinalDest = ztDest; // sanity check, should be unmodified if there was no match
  837. Address cc2;
  838. unsigned int ccLength2 = 0;
  839. bool ccWatch2 = false;
  840. switch(_doZtFilter(RR,_config,&membership,true,sourcePeer->address(),ztFinalDest,macSource,macDest,frameData,frameLen,etherType,vlanId,c->rules(),c->ruleCount(),cc2,ccLength2,ccWatch2)) {
  841. case DOZTFILTER_NO_MATCH:
  842. case DOZTFILTER_DROP: // explicit DROP in a capability just terminates its evaluation and is an anti-pattern
  843. break;
  844. case DOZTFILTER_REDIRECT: // interpreted as ACCEPT but ztDest will have been changed in _doZtFilter()
  845. case DOZTFILTER_ACCEPT:
  846. accept = 1; // ACCEPT
  847. break;
  848. case DOZTFILTER_SUPER_ACCEPT:
  849. accept = 2; // super-ACCEPT
  850. break;
  851. }
  852. if (accept) {
  853. if (cc2) {
  854. _membership(cc2).pushCredentials(RR,tPtr,RR->node->now(),cc2,_config,-1,false);
  855. Packet outp(cc2,RR->identity.address(),Packet::VERB_EXT_FRAME);
  856. outp.append(_id);
  857. outp.append((uint8_t)(ccWatch2 ? 0x1c : 0x08));
  858. macDest.appendTo(outp);
  859. macSource.appendTo(outp);
  860. outp.append((uint16_t)etherType);
  861. outp.append(frameData,ccLength2);
  862. outp.compress();
  863. RR->sw->send(tPtr,outp,true);
  864. }
  865. break;
  866. }
  867. }
  868. } break;
  869. case DOZTFILTER_DROP:
  870. return 0; // DROP
  871. case DOZTFILTER_REDIRECT: // interpreted as ACCEPT but ztFinalDest will have been changed in _doZtFilter()
  872. case DOZTFILTER_ACCEPT:
  873. accept = 1; // ACCEPT
  874. break;
  875. case DOZTFILTER_SUPER_ACCEPT:
  876. accept = 2; // super-ACCEPT
  877. break;
  878. }
  879. if (accept) {
  880. if (cc) {
  881. _membership(cc).pushCredentials(RR,tPtr,RR->node->now(),cc,_config,-1,false);
  882. Packet outp(cc,RR->identity.address(),Packet::VERB_EXT_FRAME);
  883. outp.append(_id);
  884. outp.append((uint8_t)(ccWatch ? 0x1c : 0x08));
  885. macDest.appendTo(outp);
  886. macSource.appendTo(outp);
  887. outp.append((uint16_t)etherType);
  888. outp.append(frameData,ccLength);
  889. outp.compress();
  890. RR->sw->send(tPtr,outp,true);
  891. }
  892. if ((ztDest != ztFinalDest)&&(ztFinalDest)) {
  893. _membership(ztFinalDest).pushCredentials(RR,tPtr,RR->node->now(),ztFinalDest,_config,-1,false);
  894. Packet outp(ztFinalDest,RR->identity.address(),Packet::VERB_EXT_FRAME);
  895. outp.append(_id);
  896. outp.append((uint8_t)0x0a);
  897. macDest.appendTo(outp);
  898. macSource.appendTo(outp);
  899. outp.append((uint16_t)etherType);
  900. outp.append(frameData,frameLen);
  901. outp.compress();
  902. RR->sw->send(tPtr,outp,true);
  903. return 0; // DROP locally, since we redirected
  904. }
  905. }
  906. return accept;
  907. }
  908. bool Network::subscribedToMulticastGroup(const MulticastGroup &mg,bool includeBridgedGroups) const
  909. {
  910. Mutex::Lock _l(_lock);
  911. if (std::binary_search(_myMulticastGroups.begin(),_myMulticastGroups.end(),mg))
  912. return true;
  913. else if (includeBridgedGroups)
  914. return _multicastGroupsBehindMe.contains(mg);
  915. return false;
  916. }
  917. void Network::multicastSubscribe(void *tPtr,const MulticastGroup &mg)
  918. {
  919. Mutex::Lock _l(_lock);
  920. if (!std::binary_search(_myMulticastGroups.begin(),_myMulticastGroups.end(),mg)) {
  921. _myMulticastGroups.insert(std::upper_bound(_myMulticastGroups.begin(),_myMulticastGroups.end(),mg),mg);
  922. _sendUpdatesToMembers(tPtr,&mg);
  923. }
  924. }
  925. void Network::multicastUnsubscribe(const MulticastGroup &mg)
  926. {
  927. Mutex::Lock _l(_lock);
  928. std::vector<MulticastGroup>::iterator i(std::lower_bound(_myMulticastGroups.begin(),_myMulticastGroups.end(),mg));
  929. if ( (i != _myMulticastGroups.end()) && (*i == mg) )
  930. _myMulticastGroups.erase(i);
  931. }
  932. uint64_t Network::handleConfigChunk(void *tPtr,const uint64_t packetId,const Address &source,const Buffer<ZT_PROTO_MAX_PACKET_LENGTH> &chunk,unsigned int ptr)
  933. {
  934. if (_destroyed)
  935. return 0;
  936. const unsigned int start = ptr;
  937. ptr += 8; // skip network ID, which is already obviously known
  938. const unsigned int chunkLen = chunk.at<uint16_t>(ptr); ptr += 2;
  939. const void *chunkData = chunk.field(ptr,chunkLen); ptr += chunkLen;
  940. NetworkConfig *nc = (NetworkConfig *)0;
  941. uint64_t configUpdateId;
  942. {
  943. Mutex::Lock _l(_lock);
  944. _IncomingConfigChunk *c = (_IncomingConfigChunk *)0;
  945. uint64_t chunkId = 0;
  946. unsigned long totalLength,chunkIndex;
  947. if (ptr < chunk.size()) {
  948. const bool fastPropagate = ((chunk[ptr++] & 0x01) != 0);
  949. configUpdateId = chunk.at<uint64_t>(ptr); ptr += 8;
  950. totalLength = chunk.at<uint32_t>(ptr); ptr += 4;
  951. chunkIndex = chunk.at<uint32_t>(ptr); ptr += 4;
  952. if (((chunkIndex + chunkLen) > totalLength)||(totalLength >= ZT_NETWORKCONFIG_DICT_CAPACITY)) { // >= since we need room for a null at the end
  953. TRACE("discarded chunk from %s: invalid length or length overflow",source.toString().c_str());
  954. return 0;
  955. }
  956. if ((chunk[ptr] != 1)||(chunk.at<uint16_t>(ptr + 1) != ZT_C25519_SIGNATURE_LEN)) {
  957. TRACE("discarded chunk from %s: unrecognized signature type",source.toString().c_str());
  958. return 0;
  959. }
  960. const uint8_t *sig = reinterpret_cast<const uint8_t *>(chunk.field(ptr + 3,ZT_C25519_SIGNATURE_LEN));
  961. // We can use the signature, which is unique per chunk, to get a per-chunk ID for local deduplication use
  962. for(unsigned int i=0;i<16;++i)
  963. reinterpret_cast<uint8_t *>(&chunkId)[i & 7] ^= sig[i];
  964. // Find existing or new slot for this update and check if this is a duplicate chunk
  965. for(int i=0;i<ZT_NETWORK_MAX_INCOMING_UPDATES;++i) {
  966. if (_incomingConfigChunks[i].updateId == configUpdateId) {
  967. c = &(_incomingConfigChunks[i]);
  968. for(unsigned long j=0;j<c->haveChunks;++j) {
  969. if (c->haveChunkIds[j] == chunkId)
  970. return 0;
  971. }
  972. break;
  973. } else if ((!c)||(_incomingConfigChunks[i].ts < c->ts)) {
  974. c = &(_incomingConfigChunks[i]);
  975. }
  976. }
  977. // If it's not a duplicate, check chunk signature
  978. const Identity controllerId(RR->topology->getIdentity(tPtr,controller()));
  979. if (!controllerId) { // we should always have the controller identity by now, otherwise how would we have queried it the first time?
  980. TRACE("unable to verify chunk from %s: don't have controller identity",source.toString().c_str());
  981. return 0;
  982. }
  983. if (!controllerId.verify(chunk.field(start,ptr - start),ptr - start,sig,ZT_C25519_SIGNATURE_LEN)) {
  984. TRACE("discarded chunk from %s: signature check failed",source.toString().c_str());
  985. return 0;
  986. }
  987. #ifdef ZT_ENABLE_CLUSTER
  988. if ((source)&&(RR->cluster))
  989. RR->cluster->broadcastNetworkConfigChunk(chunk.field(start,chunk.size() - start),chunk.size() - start);
  990. #endif
  991. // New properly verified chunks can be flooded "virally" through the network
  992. if (fastPropagate) {
  993. Address *a = (Address *)0;
  994. Membership *m = (Membership *)0;
  995. Hashtable<Address,Membership>::Iterator i(_memberships);
  996. while (i.next(a,m)) {
  997. if ((*a != source)&&(*a != controller())) {
  998. Packet outp(*a,RR->identity.address(),Packet::VERB_NETWORK_CONFIG);
  999. outp.append(reinterpret_cast<const uint8_t *>(chunk.data()) + start,chunk.size() - start);
  1000. RR->sw->send(tPtr,outp,true);
  1001. }
  1002. }
  1003. }
  1004. } else if ((source == controller())||(!source)) { // since old chunks aren't signed, only accept from controller itself (or via cluster backplane)
  1005. // Legacy support for OK(NETWORK_CONFIG_REQUEST) from older controllers
  1006. chunkId = packetId;
  1007. configUpdateId = chunkId;
  1008. totalLength = chunkLen;
  1009. chunkIndex = 0;
  1010. if (totalLength >= ZT_NETWORKCONFIG_DICT_CAPACITY)
  1011. return 0;
  1012. for(int i=0;i<ZT_NETWORK_MAX_INCOMING_UPDATES;++i) {
  1013. if ((!c)||(_incomingConfigChunks[i].ts < c->ts))
  1014. c = &(_incomingConfigChunks[i]);
  1015. }
  1016. #ifdef ZT_ENABLE_CLUSTER
  1017. if ((source)&&(RR->cluster))
  1018. RR->cluster->broadcastNetworkConfigChunk(chunk.field(start,chunk.size() - start),chunk.size() - start);
  1019. #endif
  1020. } else {
  1021. TRACE("discarded single-chunk unsigned legacy config: this is only allowed if the sender is the controller itself");
  1022. return 0;
  1023. }
  1024. ++c->ts; // newer is higher, that's all we need
  1025. if (c->updateId != configUpdateId) {
  1026. c->updateId = configUpdateId;
  1027. c->haveChunks = 0;
  1028. c->haveBytes = 0;
  1029. }
  1030. if (c->haveChunks >= ZT_NETWORK_MAX_UPDATE_CHUNKS)
  1031. return false;
  1032. c->haveChunkIds[c->haveChunks++] = chunkId;
  1033. memcpy(c->data.unsafeData() + chunkIndex,chunkData,chunkLen);
  1034. c->haveBytes += chunkLen;
  1035. if (c->haveBytes == totalLength) {
  1036. c->data.unsafeData()[c->haveBytes] = (char)0; // ensure null terminated
  1037. nc = new NetworkConfig();
  1038. try {
  1039. if (!nc->fromDictionary(c->data)) {
  1040. delete nc;
  1041. nc = (NetworkConfig *)0;
  1042. }
  1043. } catch ( ... ) {
  1044. delete nc;
  1045. nc = (NetworkConfig *)0;
  1046. }
  1047. }
  1048. }
  1049. if (nc) {
  1050. this->setConfiguration(tPtr,*nc,true);
  1051. delete nc;
  1052. return configUpdateId;
  1053. } else {
  1054. return 0;
  1055. }
  1056. return 0;
  1057. }
  1058. int Network::setConfiguration(void *tPtr,const NetworkConfig &nconf,bool saveToDisk)
  1059. {
  1060. if (_destroyed)
  1061. return 0;
  1062. // _lock is NOT locked when this is called
  1063. try {
  1064. if ((nconf.issuedTo != RR->identity.address())||(nconf.networkId != _id))
  1065. return 0; // invalid config that is not for us or not for this network
  1066. if (_config == nconf)
  1067. return 1; // OK config, but duplicate of what we already have
  1068. ZT_VirtualNetworkConfig ctmp;
  1069. bool oldPortInitialized;
  1070. { // do things that require lock here, but unlock before calling callbacks
  1071. Mutex::Lock _l(_lock);
  1072. _config = nconf;
  1073. _lastConfigUpdate = RR->node->now();
  1074. _netconfFailure = NETCONF_FAILURE_NONE;
  1075. oldPortInitialized = _portInitialized;
  1076. _portInitialized = true;
  1077. _externalConfig(&ctmp);
  1078. Address *a = (Address *)0;
  1079. Membership *m = (Membership *)0;
  1080. Hashtable<Address,Membership>::Iterator i(_memberships);
  1081. while (i.next(a,m))
  1082. m->resetPushState();
  1083. }
  1084. _portError = RR->node->configureVirtualNetworkPort(tPtr,_id,&_uPtr,(oldPortInitialized) ? ZT_VIRTUAL_NETWORK_CONFIG_OPERATION_CONFIG_UPDATE : ZT_VIRTUAL_NETWORK_CONFIG_OPERATION_UP,&ctmp);
  1085. if (saveToDisk) {
  1086. Dictionary<ZT_NETWORKCONFIG_DICT_CAPACITY> *d = new Dictionary<ZT_NETWORKCONFIG_DICT_CAPACITY>();
  1087. try {
  1088. if (nconf.toDictionary(*d,false))
  1089. RR->node->stateObjectPut(tPtr,ZT_STATE_OBJECT_NETWORK_CONFIG,_id,d->data(),d->sizeBytes());
  1090. } catch ( ... ) {}
  1091. delete d;
  1092. }
  1093. return 2; // OK and configuration has changed
  1094. } catch ( ... ) {
  1095. TRACE("ignored invalid configuration for network %.16llx",(unsigned long long)_id);
  1096. }
  1097. return 0;
  1098. }
  1099. void Network::requestConfiguration(void *tPtr)
  1100. {
  1101. if (_destroyed)
  1102. return;
  1103. /* ZeroTier addresses can't begin with 0xff, so this is used to mark controllerless
  1104. * network IDs. Controllerless network IDs only support unicast IPv6 using the 6plane
  1105. * addressing scheme and have the following format: 0xffSSSSEEEE000000 where SSSS
  1106. * is the 16-bit starting IP port range allowed and EEEE is the 16-bit ending IP port
  1107. * range allowed. Remaining digits are reserved for future use and must be zero. */
  1108. if ((_id >> 56) == 0xff) {
  1109. const uint16_t startPortRange = (uint16_t)((_id >> 40) & 0xffff);
  1110. const uint16_t endPortRange = (uint16_t)((_id >> 24) & 0xffff);
  1111. if (((_id & 0xffffff) == 0)&&(endPortRange >= startPortRange)) {
  1112. NetworkConfig *const nconf = new NetworkConfig();
  1113. nconf->networkId = _id;
  1114. nconf->timestamp = RR->node->now();
  1115. nconf->credentialTimeMaxDelta = ZT_NETWORKCONFIG_DEFAULT_CREDENTIAL_TIME_MAX_MAX_DELTA;
  1116. nconf->revision = 1;
  1117. nconf->issuedTo = RR->identity.address();
  1118. nconf->flags = ZT_NETWORKCONFIG_FLAG_ENABLE_IPV6_NDP_EMULATION;
  1119. nconf->mtu = ZT_DEFAULT_MTU;
  1120. nconf->multicastLimit = 0;
  1121. nconf->staticIpCount = 1;
  1122. nconf->ruleCount = 14;
  1123. nconf->staticIps[0] = InetAddress::makeIpv66plane(_id,RR->identity.address().toInt());
  1124. // Drop everything but IPv6
  1125. nconf->rules[0].t = (uint8_t)ZT_NETWORK_RULE_MATCH_ETHERTYPE | 0x80; // NOT
  1126. nconf->rules[0].v.etherType = 0x86dd; // IPv6
  1127. nconf->rules[1].t = (uint8_t)ZT_NETWORK_RULE_ACTION_DROP;
  1128. // Allow ICMPv6
  1129. nconf->rules[2].t = (uint8_t)ZT_NETWORK_RULE_MATCH_IP_PROTOCOL;
  1130. nconf->rules[2].v.ipProtocol = 0x3a; // ICMPv6
  1131. nconf->rules[3].t = (uint8_t)ZT_NETWORK_RULE_ACTION_ACCEPT;
  1132. // Allow destination ports within range
  1133. nconf->rules[4].t = (uint8_t)ZT_NETWORK_RULE_MATCH_IP_PROTOCOL;
  1134. nconf->rules[4].v.ipProtocol = 0x11; // UDP
  1135. nconf->rules[5].t = (uint8_t)ZT_NETWORK_RULE_MATCH_IP_PROTOCOL | 0x40; // OR
  1136. nconf->rules[5].v.ipProtocol = 0x06; // TCP
  1137. nconf->rules[6].t = (uint8_t)ZT_NETWORK_RULE_MATCH_IP_DEST_PORT_RANGE;
  1138. nconf->rules[6].v.port[0] = startPortRange;
  1139. nconf->rules[6].v.port[1] = endPortRange;
  1140. nconf->rules[7].t = (uint8_t)ZT_NETWORK_RULE_ACTION_ACCEPT;
  1141. // Allow non-SYN TCP packets to permit non-connection-initiating traffic
  1142. nconf->rules[8].t = (uint8_t)ZT_NETWORK_RULE_MATCH_CHARACTERISTICS | 0x80; // NOT
  1143. nconf->rules[8].v.characteristics = ZT_RULE_PACKET_CHARACTERISTICS_TCP_SYN;
  1144. nconf->rules[9].t = (uint8_t)ZT_NETWORK_RULE_ACTION_ACCEPT;
  1145. // Also allow SYN+ACK which are replies to SYN
  1146. nconf->rules[10].t = (uint8_t)ZT_NETWORK_RULE_MATCH_CHARACTERISTICS;
  1147. nconf->rules[10].v.characteristics = ZT_RULE_PACKET_CHARACTERISTICS_TCP_SYN;
  1148. nconf->rules[11].t = (uint8_t)ZT_NETWORK_RULE_MATCH_CHARACTERISTICS;
  1149. nconf->rules[11].v.characteristics = ZT_RULE_PACKET_CHARACTERISTICS_TCP_ACK;
  1150. nconf->rules[12].t = (uint8_t)ZT_NETWORK_RULE_ACTION_ACCEPT;
  1151. nconf->rules[13].t = (uint8_t)ZT_NETWORK_RULE_ACTION_DROP;
  1152. nconf->type = ZT_NETWORK_TYPE_PUBLIC;
  1153. Utils::snprintf(nconf->name,sizeof(nconf->name),"adhoc-%.04x-%.04x",(int)startPortRange,(int)endPortRange);
  1154. this->setConfiguration(tPtr,*nconf,false);
  1155. delete nconf;
  1156. } else {
  1157. this->setNotFound();
  1158. }
  1159. return;
  1160. }
  1161. const Address ctrl(controller());
  1162. Dictionary<ZT_NETWORKCONFIG_METADATA_DICT_CAPACITY> rmd;
  1163. rmd.add(ZT_NETWORKCONFIG_REQUEST_METADATA_KEY_VERSION,(uint64_t)ZT_NETWORKCONFIG_VERSION);
  1164. rmd.add(ZT_NETWORKCONFIG_REQUEST_METADATA_KEY_NODE_VENDOR,(uint64_t)ZT_VENDOR_ZEROTIER);
  1165. rmd.add(ZT_NETWORKCONFIG_REQUEST_METADATA_KEY_PROTOCOL_VERSION,(uint64_t)ZT_PROTO_VERSION);
  1166. rmd.add(ZT_NETWORKCONFIG_REQUEST_METADATA_KEY_NODE_MAJOR_VERSION,(uint64_t)ZEROTIER_ONE_VERSION_MAJOR);
  1167. rmd.add(ZT_NETWORKCONFIG_REQUEST_METADATA_KEY_NODE_MINOR_VERSION,(uint64_t)ZEROTIER_ONE_VERSION_MINOR);
  1168. rmd.add(ZT_NETWORKCONFIG_REQUEST_METADATA_KEY_NODE_REVISION,(uint64_t)ZEROTIER_ONE_VERSION_REVISION);
  1169. rmd.add(ZT_NETWORKCONFIG_REQUEST_METADATA_KEY_MAX_NETWORK_RULES,(uint64_t)ZT_MAX_NETWORK_RULES);
  1170. rmd.add(ZT_NETWORKCONFIG_REQUEST_METADATA_KEY_MAX_NETWORK_CAPABILITIES,(uint64_t)ZT_MAX_NETWORK_CAPABILITIES);
  1171. rmd.add(ZT_NETWORKCONFIG_REQUEST_METADATA_KEY_MAX_CAPABILITY_RULES,(uint64_t)ZT_MAX_CAPABILITY_RULES);
  1172. rmd.add(ZT_NETWORKCONFIG_REQUEST_METADATA_KEY_MAX_NETWORK_TAGS,(uint64_t)ZT_MAX_NETWORK_TAGS);
  1173. rmd.add(ZT_NETWORKCONFIG_REQUEST_METADATA_KEY_FLAGS,(uint64_t)0);
  1174. rmd.add(ZT_NETWORKCONFIG_REQUEST_METADATA_KEY_RULES_ENGINE_REV,(uint64_t)ZT_RULES_ENGINE_REVISION);
  1175. if (ctrl == RR->identity.address()) {
  1176. if (RR->localNetworkController) {
  1177. RR->localNetworkController->request(_id,InetAddress(),0xffffffffffffffffULL,RR->identity,rmd);
  1178. } else {
  1179. this->setNotFound();
  1180. }
  1181. return;
  1182. }
  1183. TRACE("requesting netconf for network %.16llx from controller %s",(unsigned long long)_id,ctrl.toString().c_str());
  1184. Packet outp(ctrl,RR->identity.address(),Packet::VERB_NETWORK_CONFIG_REQUEST);
  1185. outp.append((uint64_t)_id);
  1186. const unsigned int rmdSize = rmd.sizeBytes();
  1187. outp.append((uint16_t)rmdSize);
  1188. outp.append((const void *)rmd.data(),rmdSize);
  1189. if (_config) {
  1190. outp.append((uint64_t)_config.revision);
  1191. outp.append((uint64_t)_config.timestamp);
  1192. } else {
  1193. outp.append((unsigned char)0,16);
  1194. }
  1195. outp.compress();
  1196. RR->node->expectReplyTo(outp.packetId());
  1197. RR->sw->send(tPtr,outp,true);
  1198. }
  1199. bool Network::gate(void *tPtr,const SharedPtr<Peer> &peer)
  1200. {
  1201. const uint64_t now = RR->node->now();
  1202. Mutex::Lock _l(_lock);
  1203. try {
  1204. if (_config) {
  1205. Membership *m = _memberships.get(peer->address());
  1206. if ( (_config.isPublic()) || ((m)&&(m->isAllowedOnNetwork(_config))) ) {
  1207. if (!m)
  1208. m = &(_membership(peer->address()));
  1209. if (m->multicastLikeGate(now)) {
  1210. m->pushCredentials(RR,tPtr,now,peer->address(),_config,-1,false);
  1211. _announceMulticastGroupsTo(tPtr,peer->address(),_allMulticastGroups());
  1212. }
  1213. return true;
  1214. }
  1215. }
  1216. } catch ( ... ) {
  1217. TRACE("gate() check failed for peer %s: unexpected exception",peer->address().toString().c_str());
  1218. }
  1219. return false;
  1220. }
  1221. void Network::clean()
  1222. {
  1223. const uint64_t now = RR->node->now();
  1224. Mutex::Lock _l(_lock);
  1225. if (_destroyed)
  1226. return;
  1227. {
  1228. Hashtable< MulticastGroup,uint64_t >::Iterator i(_multicastGroupsBehindMe);
  1229. MulticastGroup *mg = (MulticastGroup *)0;
  1230. uint64_t *ts = (uint64_t *)0;
  1231. while (i.next(mg,ts)) {
  1232. if ((now - *ts) > (ZT_MULTICAST_LIKE_EXPIRE * 2))
  1233. _multicastGroupsBehindMe.erase(*mg);
  1234. }
  1235. }
  1236. {
  1237. Address *a = (Address *)0;
  1238. Membership *m = (Membership *)0;
  1239. Hashtable<Address,Membership>::Iterator i(_memberships);
  1240. while (i.next(a,m)) {
  1241. if (!RR->topology->getPeerNoCache(*a))
  1242. _memberships.erase(*a);
  1243. else m->clean(now,_config);
  1244. }
  1245. }
  1246. }
  1247. void Network::learnBridgeRoute(const MAC &mac,const Address &addr)
  1248. {
  1249. Mutex::Lock _l(_lock);
  1250. _remoteBridgeRoutes[mac] = addr;
  1251. // Anti-DOS circuit breaker to prevent nodes from spamming us with absurd numbers of bridge routes
  1252. while (_remoteBridgeRoutes.size() > ZT_MAX_BRIDGE_ROUTES) {
  1253. Hashtable< Address,unsigned long > counts;
  1254. Address maxAddr;
  1255. unsigned long maxCount = 0;
  1256. MAC *m = (MAC *)0;
  1257. Address *a = (Address *)0;
  1258. // Find the address responsible for the most entries
  1259. {
  1260. Hashtable<MAC,Address>::Iterator i(_remoteBridgeRoutes);
  1261. while (i.next(m,a)) {
  1262. const unsigned long c = ++counts[*a];
  1263. if (c > maxCount) {
  1264. maxCount = c;
  1265. maxAddr = *a;
  1266. }
  1267. }
  1268. }
  1269. // Kill this address from our table, since it's most likely spamming us
  1270. {
  1271. Hashtable<MAC,Address>::Iterator i(_remoteBridgeRoutes);
  1272. while (i.next(m,a)) {
  1273. if (*a == maxAddr)
  1274. _remoteBridgeRoutes.erase(*m);
  1275. }
  1276. }
  1277. }
  1278. }
  1279. void Network::learnBridgedMulticastGroup(void *tPtr,const MulticastGroup &mg,uint64_t now)
  1280. {
  1281. Mutex::Lock _l(_lock);
  1282. const unsigned long tmp = (unsigned long)_multicastGroupsBehindMe.size();
  1283. _multicastGroupsBehindMe.set(mg,now);
  1284. if (tmp != _multicastGroupsBehindMe.size())
  1285. _sendUpdatesToMembers(tPtr,&mg);
  1286. }
  1287. Membership::AddCredentialResult Network::addCredential(void *tPtr,const CertificateOfMembership &com)
  1288. {
  1289. if (com.networkId() != _id)
  1290. return Membership::ADD_REJECTED;
  1291. const Address a(com.issuedTo());
  1292. Mutex::Lock _l(_lock);
  1293. Membership &m = _membership(a);
  1294. const Membership::AddCredentialResult result = m.addCredential(RR,tPtr,_config,com);
  1295. if ((result == Membership::ADD_ACCEPTED_NEW)||(result == Membership::ADD_ACCEPTED_REDUNDANT)) {
  1296. m.pushCredentials(RR,tPtr,RR->node->now(),a,_config,-1,false);
  1297. RR->mc->addCredential(tPtr,com,true);
  1298. }
  1299. return result;
  1300. }
  1301. Membership::AddCredentialResult Network::addCredential(void *tPtr,const Address &sentFrom,const Revocation &rev)
  1302. {
  1303. if (rev.networkId() != _id)
  1304. return Membership::ADD_REJECTED;
  1305. Mutex::Lock _l(_lock);
  1306. Membership &m = _membership(rev.target());
  1307. const Membership::AddCredentialResult result = m.addCredential(RR,tPtr,_config,rev);
  1308. if ((result == Membership::ADD_ACCEPTED_NEW)&&(rev.fastPropagate())) {
  1309. Address *a = (Address *)0;
  1310. Membership *m = (Membership *)0;
  1311. Hashtable<Address,Membership>::Iterator i(_memberships);
  1312. while (i.next(a,m)) {
  1313. if ((*a != sentFrom)&&(*a != rev.signer())) {
  1314. Packet outp(*a,RR->identity.address(),Packet::VERB_NETWORK_CREDENTIALS);
  1315. outp.append((uint8_t)0x00); // no COM
  1316. outp.append((uint16_t)0); // no capabilities
  1317. outp.append((uint16_t)0); // no tags
  1318. outp.append((uint16_t)1); // one revocation!
  1319. rev.serialize(outp);
  1320. outp.append((uint16_t)0); // no certificates of ownership
  1321. RR->sw->send(tPtr,outp,true);
  1322. }
  1323. }
  1324. }
  1325. return result;
  1326. }
  1327. void Network::destroy()
  1328. {
  1329. Mutex::Lock _l(_lock);
  1330. _destroyed = true;
  1331. }
  1332. ZT_VirtualNetworkStatus Network::_status() const
  1333. {
  1334. // assumes _lock is locked
  1335. if (_portError)
  1336. return ZT_NETWORK_STATUS_PORT_ERROR;
  1337. switch(_netconfFailure) {
  1338. case NETCONF_FAILURE_ACCESS_DENIED:
  1339. return ZT_NETWORK_STATUS_ACCESS_DENIED;
  1340. case NETCONF_FAILURE_NOT_FOUND:
  1341. return ZT_NETWORK_STATUS_NOT_FOUND;
  1342. case NETCONF_FAILURE_NONE:
  1343. return ((_config) ? ZT_NETWORK_STATUS_OK : ZT_NETWORK_STATUS_REQUESTING_CONFIGURATION);
  1344. default:
  1345. return ZT_NETWORK_STATUS_PORT_ERROR;
  1346. }
  1347. }
  1348. void Network::_externalConfig(ZT_VirtualNetworkConfig *ec) const
  1349. {
  1350. // assumes _lock is locked
  1351. ec->nwid = _id;
  1352. ec->mac = _mac.toInt();
  1353. if (_config)
  1354. Utils::scopy(ec->name,sizeof(ec->name),_config.name);
  1355. else ec->name[0] = (char)0;
  1356. ec->status = _status();
  1357. ec->type = (_config) ? (_config.isPrivate() ? ZT_NETWORK_TYPE_PRIVATE : ZT_NETWORK_TYPE_PUBLIC) : ZT_NETWORK_TYPE_PRIVATE;
  1358. ec->mtu = (_config) ? _config.mtu : ZT_DEFAULT_MTU;
  1359. ec->physicalMtu = ZT_UDP_DEFAULT_PAYLOAD_MTU - (ZT_PACKET_IDX_PAYLOAD + 16);
  1360. ec->dhcp = 0;
  1361. std::vector<Address> ab(_config.activeBridges());
  1362. ec->bridge = ((_config.allowPassiveBridging())||(std::find(ab.begin(),ab.end(),RR->identity.address()) != ab.end())) ? 1 : 0;
  1363. ec->broadcastEnabled = (_config) ? (_config.enableBroadcast() ? 1 : 0) : 0;
  1364. ec->portError = _portError;
  1365. ec->netconfRevision = (_config) ? (unsigned long)_config.revision : 0;
  1366. ec->assignedAddressCount = 0;
  1367. for(unsigned int i=0;i<ZT_MAX_ZT_ASSIGNED_ADDRESSES;++i) {
  1368. if (i < _config.staticIpCount) {
  1369. memcpy(&(ec->assignedAddresses[i]),&(_config.staticIps[i]),sizeof(struct sockaddr_storage));
  1370. ++ec->assignedAddressCount;
  1371. } else {
  1372. memset(&(ec->assignedAddresses[i]),0,sizeof(struct sockaddr_storage));
  1373. }
  1374. }
  1375. ec->routeCount = 0;
  1376. for(unsigned int i=0;i<ZT_MAX_NETWORK_ROUTES;++i) {
  1377. if (i < _config.routeCount) {
  1378. memcpy(&(ec->routes[i]),&(_config.routes[i]),sizeof(ZT_VirtualNetworkRoute));
  1379. ++ec->routeCount;
  1380. } else {
  1381. memset(&(ec->routes[i]),0,sizeof(ZT_VirtualNetworkRoute));
  1382. }
  1383. }
  1384. }
  1385. void Network::_sendUpdatesToMembers(void *tPtr,const MulticastGroup *const newMulticastGroup)
  1386. {
  1387. // Assumes _lock is locked
  1388. const uint64_t now = RR->node->now();
  1389. std::vector<MulticastGroup> groups;
  1390. if (newMulticastGroup)
  1391. groups.push_back(*newMulticastGroup);
  1392. else groups = _allMulticastGroups();
  1393. if ((newMulticastGroup)||((now - _lastAnnouncedMulticastGroupsUpstream) >= ZT_MULTICAST_ANNOUNCE_PERIOD)) {
  1394. if (!newMulticastGroup)
  1395. _lastAnnouncedMulticastGroupsUpstream = now;
  1396. // Announce multicast groups to upstream peers (roots, etc.) and also send
  1397. // them our COM so that MULTICAST_GATHER can be authenticated properly.
  1398. const std::vector<Address> upstreams(RR->topology->upstreamAddresses());
  1399. for(std::vector<Address>::const_iterator a(upstreams.begin());a!=upstreams.end();++a) {
  1400. if (_config.com) {
  1401. Packet outp(*a,RR->identity.address(),Packet::VERB_NETWORK_CREDENTIALS);
  1402. _config.com.serialize(outp);
  1403. outp.append((uint8_t)0x00);
  1404. outp.append((uint16_t)0); // no capabilities
  1405. outp.append((uint16_t)0); // no tags
  1406. outp.append((uint16_t)0); // no revocations
  1407. outp.append((uint16_t)0); // no certificates of ownership
  1408. RR->sw->send(tPtr,outp,true);
  1409. }
  1410. _announceMulticastGroupsTo(tPtr,*a,groups);
  1411. }
  1412. // Also announce to controller, and send COM to simplify and generalize behavior even though in theory it does not need it
  1413. const Address c(controller());
  1414. if ( (std::find(upstreams.begin(),upstreams.end(),c) == upstreams.end()) && (!_memberships.contains(c)) ) {
  1415. if (_config.com) {
  1416. Packet outp(c,RR->identity.address(),Packet::VERB_NETWORK_CREDENTIALS);
  1417. _config.com.serialize(outp);
  1418. outp.append((uint8_t)0x00);
  1419. outp.append((uint16_t)0); // no capabilities
  1420. outp.append((uint16_t)0); // no tags
  1421. outp.append((uint16_t)0); // no revocations
  1422. outp.append((uint16_t)0); // no certificates of ownership
  1423. RR->sw->send(tPtr,outp,true);
  1424. }
  1425. _announceMulticastGroupsTo(tPtr,c,groups);
  1426. }
  1427. }
  1428. // Make sure that all "network anchors" have Membership records so we will
  1429. // push multicasts to them.
  1430. const std::vector<Address> anchors(_config.anchors());
  1431. for(std::vector<Address>::const_iterator a(anchors.begin());a!=anchors.end();++a)
  1432. _membership(*a);
  1433. // Send credentials and multicast LIKEs to members, upstreams, and controller
  1434. {
  1435. Address *a = (Address *)0;
  1436. Membership *m = (Membership *)0;
  1437. Hashtable<Address,Membership>::Iterator i(_memberships);
  1438. while (i.next(a,m)) {
  1439. m->pushCredentials(RR,tPtr,now,*a,_config,-1,false);
  1440. if ( ( m->multicastLikeGate(now) || (newMulticastGroup) ) && (m->isAllowedOnNetwork(_config)) )
  1441. _announceMulticastGroupsTo(tPtr,*a,groups);
  1442. }
  1443. }
  1444. }
  1445. void Network::_announceMulticastGroupsTo(void *tPtr,const Address &peer,const std::vector<MulticastGroup> &allMulticastGroups)
  1446. {
  1447. // Assumes _lock is locked
  1448. Packet outp(peer,RR->identity.address(),Packet::VERB_MULTICAST_LIKE);
  1449. for(std::vector<MulticastGroup>::const_iterator mg(allMulticastGroups.begin());mg!=allMulticastGroups.end();++mg) {
  1450. if ((outp.size() + 24) >= ZT_PROTO_MAX_PACKET_LENGTH) {
  1451. outp.compress();
  1452. RR->sw->send(tPtr,outp,true);
  1453. outp.reset(peer,RR->identity.address(),Packet::VERB_MULTICAST_LIKE);
  1454. }
  1455. // network ID, MAC, ADI
  1456. outp.append((uint64_t)_id);
  1457. mg->mac().appendTo(outp);
  1458. outp.append((uint32_t)mg->adi());
  1459. }
  1460. if (outp.size() > ZT_PROTO_MIN_PACKET_LENGTH) {
  1461. outp.compress();
  1462. RR->sw->send(tPtr,outp,true);
  1463. }
  1464. }
  1465. std::vector<MulticastGroup> Network::_allMulticastGroups() const
  1466. {
  1467. // Assumes _lock is locked
  1468. std::vector<MulticastGroup> mgs;
  1469. mgs.reserve(_myMulticastGroups.size() + _multicastGroupsBehindMe.size() + 1);
  1470. mgs.insert(mgs.end(),_myMulticastGroups.begin(),_myMulticastGroups.end());
  1471. _multicastGroupsBehindMe.appendKeys(mgs);
  1472. if ((_config)&&(_config.enableBroadcast()))
  1473. mgs.push_back(Network::BROADCAST);
  1474. std::sort(mgs.begin(),mgs.end());
  1475. mgs.erase(std::unique(mgs.begin(),mgs.end()),mgs.end());
  1476. return mgs;
  1477. }
  1478. Membership &Network::_membership(const Address &a)
  1479. {
  1480. // assumes _lock is locked
  1481. return _memberships[a];
  1482. }
  1483. } // namespace ZeroTier