Utils.hpp 11 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393
  1. /*
  2. * ZeroTier One - Network Virtualization Everywhere
  3. * Copyright (C) 2011-2016 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. #ifndef ZT_UTILS_HPP
  19. #define ZT_UTILS_HPP
  20. #include <stdio.h>
  21. #include <stdlib.h>
  22. #include <stdint.h>
  23. #include <string.h>
  24. #include <time.h>
  25. #include <string>
  26. #include <stdexcept>
  27. #include <vector>
  28. #include <map>
  29. #include "Constants.hpp"
  30. namespace ZeroTier {
  31. /**
  32. * Miscellaneous utility functions and global constants
  33. */
  34. class Utils
  35. {
  36. public:
  37. /**
  38. * Perform a time-invariant binary comparison
  39. *
  40. * @param a First binary string
  41. * @param b Second binary string
  42. * @param len Length of strings
  43. * @return True if strings are equal
  44. */
  45. static inline bool secureEq(const void *a,const void *b,unsigned int len)
  46. throw()
  47. {
  48. char diff = 0;
  49. for(unsigned int i=0;i<len;++i)
  50. diff |= ( (reinterpret_cast<const char *>(a))[i] ^ (reinterpret_cast<const char *>(b))[i] );
  51. return (diff == 0);
  52. }
  53. /**
  54. * Securely zero memory, avoiding compiler optimizations and such
  55. */
  56. static void burn(void *ptr,unsigned int len)
  57. throw();
  58. /**
  59. * Convert binary data to hexadecimal
  60. *
  61. * @param data Data to convert to hex
  62. * @param len Length of data
  63. * @return Hexadecimal string
  64. */
  65. static std::string hex(const void *data,unsigned int len);
  66. static inline std::string hex(const std::string &data) { return hex(data.data(),(unsigned int)data.length()); }
  67. /**
  68. * Convert hexadecimal to binary data
  69. *
  70. * This ignores all non-hex characters, just stepping over them and
  71. * continuing. Upper and lower case are supported for letters a-f.
  72. *
  73. * @param hex Hexadecimal ASCII code (non-hex chars are ignored, stops at zero or maxlen)
  74. * @param maxlen Maximum length of hex string buffer
  75. * @return Binary data
  76. */
  77. static std::string unhex(const char *hex,unsigned int maxlen);
  78. static inline std::string unhex(const std::string &hex) { return unhex(hex.c_str(),(unsigned int)hex.length()); }
  79. /**
  80. * Convert hexadecimal to binary data
  81. *
  82. * This ignores all non-hex characters, just stepping over them and
  83. * continuing. Upper and lower case are supported for letters a-f.
  84. *
  85. * @param hex Hexadecimal ASCII
  86. * @param maxlen Maximum length of hex string buffer
  87. * @param buf Buffer to fill
  88. * @param len Length of buffer
  89. * @return Number of characters actually written
  90. */
  91. static unsigned int unhex(const char *hex,unsigned int maxlen,void *buf,unsigned int len);
  92. static inline unsigned int unhex(const std::string &hex,void *buf,unsigned int len) { return unhex(hex.c_str(),(unsigned int)hex.length(),buf,len); }
  93. /**
  94. * Generate secure random bytes
  95. *
  96. * This will try to use whatever OS sources of entropy are available. It's
  97. * guarded by an internal mutex so it's thread-safe.
  98. *
  99. * @param buf Buffer to fill
  100. * @param bytes Number of random bytes to generate
  101. */
  102. static void getSecureRandom(void *buf,unsigned int bytes);
  103. /**
  104. * Split a string by delimiter, with optional escape and quote characters
  105. *
  106. * @param s String to split
  107. * @param sep One or more separators
  108. * @param esc Zero or more escape characters
  109. * @param quot Zero or more quote characters
  110. * @return Vector of tokens
  111. */
  112. static std::vector<std::string> split(const char *s,const char *const sep,const char *esc,const char *quot);
  113. /**
  114. * Tokenize a string (alias for strtok_r or strtok_s depending on platform)
  115. *
  116. * @param str String to split
  117. * @param delim Delimiters
  118. * @param saveptr Pointer to a char * for temporary reentrant storage
  119. */
  120. static inline char *stok(char *str,const char *delim,char **saveptr)
  121. throw()
  122. {
  123. #ifdef __WINDOWS__
  124. return strtok_s(str,delim,saveptr);
  125. #else
  126. return strtok_r(str,delim,saveptr);
  127. #endif
  128. }
  129. // String to number converters -- defined here to permit portability
  130. // ifdefs for platforms that lack some of the strtoXX functions.
  131. static inline unsigned int strToUInt(const char *s)
  132. throw()
  133. {
  134. return (unsigned int)strtoul(s,(char **)0,10);
  135. }
  136. static inline int strToInt(const char *s)
  137. throw()
  138. {
  139. return (int)strtol(s,(char **)0,10);
  140. }
  141. static inline unsigned long strToULong(const char *s)
  142. throw()
  143. {
  144. return strtoul(s,(char **)0,10);
  145. }
  146. static inline long strToLong(const char *s)
  147. throw()
  148. {
  149. return strtol(s,(char **)0,10);
  150. }
  151. static inline unsigned long long strToU64(const char *s)
  152. throw()
  153. {
  154. #ifdef __WINDOWS__
  155. return (unsigned long long)_strtoui64(s,(char **)0,10);
  156. #else
  157. return strtoull(s,(char **)0,10);
  158. #endif
  159. }
  160. static inline long long strTo64(const char *s)
  161. throw()
  162. {
  163. #ifdef __WINDOWS__
  164. return (long long)_strtoi64(s,(char **)0,10);
  165. #else
  166. return strtoll(s,(char **)0,10);
  167. #endif
  168. }
  169. static inline unsigned int hexStrToUInt(const char *s)
  170. throw()
  171. {
  172. return (unsigned int)strtoul(s,(char **)0,16);
  173. }
  174. static inline int hexStrToInt(const char *s)
  175. throw()
  176. {
  177. return (int)strtol(s,(char **)0,16);
  178. }
  179. static inline unsigned long hexStrToULong(const char *s)
  180. throw()
  181. {
  182. return strtoul(s,(char **)0,16);
  183. }
  184. static inline long hexStrToLong(const char *s)
  185. throw()
  186. {
  187. return strtol(s,(char **)0,16);
  188. }
  189. static inline unsigned long long hexStrToU64(const char *s)
  190. throw()
  191. {
  192. #ifdef __WINDOWS__
  193. return (unsigned long long)_strtoui64(s,(char **)0,16);
  194. #else
  195. return strtoull(s,(char **)0,16);
  196. #endif
  197. }
  198. static inline long long hexStrTo64(const char *s)
  199. throw()
  200. {
  201. #ifdef __WINDOWS__
  202. return (long long)_strtoi64(s,(char **)0,16);
  203. #else
  204. return strtoll(s,(char **)0,16);
  205. #endif
  206. }
  207. static inline double strToDouble(const char *s)
  208. throw()
  209. {
  210. return strtod(s,(char **)0);
  211. }
  212. /**
  213. * Perform a safe C string copy
  214. *
  215. * @param dest Destination buffer
  216. * @param len Length of buffer
  217. * @param src Source string
  218. * @return True on success, false on overflow (buffer will still be 0-terminated)
  219. */
  220. static inline bool scopy(char *dest,unsigned int len,const char *src)
  221. throw()
  222. {
  223. if (!len)
  224. return false; // sanity check
  225. char *end = dest + len;
  226. while ((*dest++ = *src++)) {
  227. if (dest == end) {
  228. *(--dest) = (char)0;
  229. return false;
  230. }
  231. }
  232. return true;
  233. }
  234. /**
  235. * Variant of snprintf that is portable and throws an exception
  236. *
  237. * This just wraps the local implementation whatever it's called, while
  238. * performing a few other checks and adding exceptions for overflow.
  239. *
  240. * @param buf Buffer to write to
  241. * @param len Length of buffer in bytes
  242. * @param fmt Format string
  243. * @param ... Format arguments
  244. * @throws std::length_error buf[] too short (buf[] will still be left null-terminated)
  245. */
  246. static unsigned int snprintf(char *buf,unsigned int len,const char *fmt,...)
  247. throw(std::length_error);
  248. /**
  249. * Count the number of bits set in an integer
  250. *
  251. * @param v 32-bit integer
  252. * @return Number of bits set in this integer (0-32)
  253. */
  254. static inline uint32_t countBits(uint32_t v)
  255. throw()
  256. {
  257. v = v - ((v >> 1) & (uint32_t)0x55555555);
  258. v = (v & (uint32_t)0x33333333) + ((v >> 2) & (uint32_t)0x33333333);
  259. return ((((v + (v >> 4)) & (uint32_t)0xF0F0F0F) * (uint32_t)0x1010101) >> 24);
  260. }
  261. /**
  262. * Check if a memory buffer is all-zero
  263. *
  264. * @param p Memory to scan
  265. * @param len Length of memory
  266. * @return True if memory is all zero
  267. */
  268. static inline bool isZero(const void *p,unsigned int len)
  269. throw()
  270. {
  271. for(unsigned int i=0;i<len;++i) {
  272. if (((const unsigned char *)p)[i])
  273. return false;
  274. }
  275. return true;
  276. }
  277. // Byte swappers for big/little endian conversion
  278. static inline uint8_t hton(uint8_t n) throw() { return n; }
  279. static inline int8_t hton(int8_t n) throw() { return n; }
  280. static inline uint16_t hton(uint16_t n) throw() { return htons(n); }
  281. static inline int16_t hton(int16_t n) throw() { return (int16_t)htons((uint16_t)n); }
  282. static inline uint32_t hton(uint32_t n) throw() { return htonl(n); }
  283. static inline int32_t hton(int32_t n) throw() { return (int32_t)htonl((uint32_t)n); }
  284. static inline uint64_t hton(uint64_t n)
  285. throw()
  286. {
  287. #if __BYTE_ORDER == __LITTLE_ENDIAN
  288. #if defined(__GNUC__) && (!defined(__OpenBSD__))
  289. return __builtin_bswap64(n);
  290. #else
  291. return (
  292. ((n & 0x00000000000000FFULL) << 56) |
  293. ((n & 0x000000000000FF00ULL) << 40) |
  294. ((n & 0x0000000000FF0000ULL) << 24) |
  295. ((n & 0x00000000FF000000ULL) << 8) |
  296. ((n & 0x000000FF00000000ULL) >> 8) |
  297. ((n & 0x0000FF0000000000ULL) >> 24) |
  298. ((n & 0x00FF000000000000ULL) >> 40) |
  299. ((n & 0xFF00000000000000ULL) >> 56)
  300. );
  301. #endif
  302. #else
  303. return n;
  304. #endif
  305. }
  306. static inline int64_t hton(int64_t n) throw() { return (int64_t)hton((uint64_t)n); }
  307. static inline uint8_t ntoh(uint8_t n) throw() { return n; }
  308. static inline int8_t ntoh(int8_t n) throw() { return n; }
  309. static inline uint16_t ntoh(uint16_t n) throw() { return ntohs(n); }
  310. static inline int16_t ntoh(int16_t n) throw() { return (int16_t)ntohs((uint16_t)n); }
  311. static inline uint32_t ntoh(uint32_t n) throw() { return ntohl(n); }
  312. static inline int32_t ntoh(int32_t n) throw() { return (int32_t)ntohl((uint32_t)n); }
  313. static inline uint64_t ntoh(uint64_t n)
  314. throw()
  315. {
  316. #if __BYTE_ORDER == __LITTLE_ENDIAN
  317. #if defined(__GNUC__) && !defined(__OpenBSD__)
  318. return __builtin_bswap64(n);
  319. #else
  320. return (
  321. ((n & 0x00000000000000FFULL) << 56) |
  322. ((n & 0x000000000000FF00ULL) << 40) |
  323. ((n & 0x0000000000FF0000ULL) << 24) |
  324. ((n & 0x00000000FF000000ULL) << 8) |
  325. ((n & 0x000000FF00000000ULL) >> 8) |
  326. ((n & 0x0000FF0000000000ULL) >> 24) |
  327. ((n & 0x00FF000000000000ULL) >> 40) |
  328. ((n & 0xFF00000000000000ULL) >> 56)
  329. );
  330. #endif
  331. #else
  332. return n;
  333. #endif
  334. }
  335. static inline int64_t ntoh(int64_t n) throw() { return (int64_t)ntoh((uint64_t)n); }
  336. /**
  337. * Compare Peer version tuples
  338. *
  339. * @return -1, 0, or 1 based on whether first tuple is less than, equal to, or greater than second
  340. */
  341. static inline int compareVersion(unsigned int maj1,unsigned int min1,unsigned int rev1,unsigned int maj2,unsigned int min2,unsigned int rev2)
  342. throw()
  343. {
  344. if (maj1 > maj2)
  345. return 1;
  346. else if (maj1 < maj2)
  347. return -1;
  348. else {
  349. if (min1 > min2)
  350. return 1;
  351. else if (min1 < min2)
  352. return -1;
  353. else {
  354. if (rev1 > rev2)
  355. return 1;
  356. else if (rev1 < rev2)
  357. return -1;
  358. else return 0;
  359. }
  360. }
  361. }
  362. /**
  363. * Hexadecimal characters 0-f
  364. */
  365. static const char HEXCHARS[16];
  366. };
  367. } // namespace ZeroTier
  368. #endif