MAC.hpp 7.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273
  1. /*
  2. * ZeroTier One - Network Virtualization Everywhere
  3. * Copyright (C) 2011-2015 ZeroTier, Inc.
  4. *
  5. * This program is free software: you can redistribute it and/or modify
  6. * it under the terms of the GNU General Public License as published by
  7. * the Free Software Foundation, either version 3 of the License, or
  8. * (at your option) any later version.
  9. *
  10. * This program is distributed in the hope that it will be useful,
  11. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  13. * GNU General Public License for more details.
  14. *
  15. * You should have received a copy of the GNU General Public License
  16. * along with this program. If not, see <http://www.gnu.org/licenses/>.
  17. *
  18. * --
  19. *
  20. * ZeroTier may be used and distributed under the terms of the GPLv3, which
  21. * are available at: http://www.gnu.org/licenses/gpl-3.0.html
  22. *
  23. * If you would like to embed ZeroTier into a commercial application or
  24. * redistribute it in a modified binary form, please contact ZeroTier Networks
  25. * LLC. Start here: http://www.zerotier.com/
  26. */
  27. #ifndef ZT_MAC_HPP
  28. #define ZT_MAC_HPP
  29. #include <stdio.h>
  30. #include <stdlib.h>
  31. #include <stdint.h>
  32. #include "Constants.hpp"
  33. #include "Utils.hpp"
  34. #include "Address.hpp"
  35. #include "Buffer.hpp"
  36. namespace ZeroTier {
  37. /**
  38. * 48-byte Ethernet MAC address
  39. */
  40. class MAC
  41. {
  42. public:
  43. MAC() throw() : _m(0ULL) {}
  44. MAC(const MAC &m) throw() : _m(m._m) {}
  45. MAC(const unsigned char a,const unsigned char b,const unsigned char c,const unsigned char d,const unsigned char e,const unsigned char f) throw() :
  46. _m( ((((uint64_t)a) & 0xffULL) << 40) |
  47. ((((uint64_t)b) & 0xffULL) << 32) |
  48. ((((uint64_t)c) & 0xffULL) << 24) |
  49. ((((uint64_t)d) & 0xffULL) << 16) |
  50. ((((uint64_t)e) & 0xffULL) << 8) |
  51. (((uint64_t)f) & 0xffULL) ) {}
  52. MAC(const char *s) throw() { fromString(s); }
  53. MAC(const std::string &s) throw() { fromString(s.c_str()); }
  54. MAC(const void *bits,unsigned int len) throw() { setTo(bits,len); }
  55. MAC(const Address &ztaddr,uint64_t nwid) throw() { fromAddress(ztaddr,nwid); }
  56. MAC(const uint64_t m) throw() : _m(m & 0xffffffffffffULL) {}
  57. /**
  58. * @return MAC in 64-bit integer
  59. */
  60. inline uint64_t toInt() const throw() { return _m; }
  61. /**
  62. * Set MAC to zero
  63. */
  64. inline void zero() { _m = 0ULL; }
  65. /**
  66. * @return True if MAC is non-zero
  67. */
  68. inline operator bool() const throw() { return (_m != 0ULL); }
  69. /**
  70. * @param bits Raw MAC in big-endian byte order
  71. * @param len Length, must be >= 6 or result is zero
  72. */
  73. inline void setTo(const void *bits,unsigned int len)
  74. throw()
  75. {
  76. if (len < 6) {
  77. _m = 0ULL;
  78. return;
  79. }
  80. const unsigned char *b = (const unsigned char *)bits;
  81. _m = ((((uint64_t)*b) & 0xff) << 40); ++b;
  82. _m |= ((((uint64_t)*b) & 0xff) << 32); ++b;
  83. _m |= ((((uint64_t)*b) & 0xff) << 24); ++b;
  84. _m |= ((((uint64_t)*b) & 0xff) << 16); ++b;
  85. _m |= ((((uint64_t)*b) & 0xff) << 8); ++b;
  86. _m |= (((uint64_t)*b) & 0xff);
  87. }
  88. /**
  89. * @param buf Destination buffer for MAC in big-endian byte order
  90. * @param len Length of buffer, must be >= 6 or nothing is copied
  91. */
  92. inline void copyTo(void *buf,unsigned int len) const
  93. throw()
  94. {
  95. if (len < 6)
  96. return;
  97. unsigned char *b = (unsigned char *)buf;
  98. *(b++) = (unsigned char)((_m >> 40) & 0xff);
  99. *(b++) = (unsigned char)((_m >> 32) & 0xff);
  100. *(b++) = (unsigned char)((_m >> 24) & 0xff);
  101. *(b++) = (unsigned char)((_m >> 16) & 0xff);
  102. *(b++) = (unsigned char)((_m >> 8) & 0xff);
  103. *b = (unsigned char)(_m & 0xff);
  104. }
  105. /**
  106. * Append to a buffer in big-endian byte order
  107. *
  108. * @param b Buffer to append to
  109. */
  110. template<unsigned int C>
  111. inline void appendTo(Buffer<C> &b) const
  112. throw(std::out_of_range)
  113. {
  114. unsigned char *p = (unsigned char *)b.appendField(6);
  115. *(p++) = (unsigned char)((_m >> 40) & 0xff);
  116. *(p++) = (unsigned char)((_m >> 32) & 0xff);
  117. *(p++) = (unsigned char)((_m >> 24) & 0xff);
  118. *(p++) = (unsigned char)((_m >> 16) & 0xff);
  119. *(p++) = (unsigned char)((_m >> 8) & 0xff);
  120. *p = (unsigned char)(_m & 0xff);
  121. }
  122. /**
  123. * @return True if this is broadcast (all 0xff)
  124. */
  125. inline bool isBroadcast() const throw() { return (_m == 0xffffffffffffULL); }
  126. /**
  127. * @return True if this is a multicast MAC
  128. */
  129. inline bool isMulticast() const throw() { return ((_m & 0x010000000000ULL) != 0ULL); }
  130. /**
  131. * @param True if this is a locally-administered MAC
  132. */
  133. inline bool isLocallyAdministered() const throw() { return ((_m & 0x020000000000ULL) != 0ULL); }
  134. /**
  135. * @param s Hex MAC, with or without : delimiters
  136. */
  137. inline void fromString(const char *s)
  138. {
  139. char tmp[8];
  140. for(int i=0;i<6;++i)
  141. tmp[i] = (char)0;
  142. Utils::unhex(s,tmp,6);
  143. setTo(tmp,6);
  144. }
  145. /**
  146. * @return MAC address in standard :-delimited hex format
  147. */
  148. inline std::string toString() const
  149. {
  150. char tmp[24];
  151. toString(tmp,sizeof(tmp));
  152. return std::string(tmp);
  153. }
  154. /**
  155. * @param buf Buffer to contain human-readable MAC
  156. * @param len Length of buffer
  157. */
  158. inline void toString(char *buf,unsigned int len) const
  159. {
  160. Utils::snprintf(buf,len,"%.2x:%.2x:%.2x:%.2x:%.2x:%.2x",(int)(*this)[0],(int)(*this)[1],(int)(*this)[2],(int)(*this)[3],(int)(*this)[4],(int)(*this)[5]);
  161. }
  162. /**
  163. * Set this MAC to a MAC derived from an address and a network ID
  164. *
  165. * @param ztaddr ZeroTier address
  166. * @param nwid 64-bit network ID
  167. */
  168. inline void fromAddress(const Address &ztaddr,uint64_t nwid)
  169. throw()
  170. {
  171. uint64_t m = ((uint64_t)firstOctetForNetwork(nwid)) << 40;
  172. m |= ztaddr.toInt(); // a is 40 bits
  173. m ^= ((nwid >> 8) & 0xff) << 32;
  174. m ^= ((nwid >> 16) & 0xff) << 24;
  175. m ^= ((nwid >> 24) & 0xff) << 16;
  176. m ^= ((nwid >> 32) & 0xff) << 8;
  177. m ^= (nwid >> 40) & 0xff;
  178. _m = m;
  179. }
  180. /**
  181. * Get the ZeroTier address for this MAC on this network (assuming no bridging of course, basic unicast)
  182. *
  183. * This just XORs the next-lest-significant 5 bytes of the network ID again to unmask.
  184. *
  185. * @param nwid Network ID
  186. */
  187. inline Address toAddress(uint64_t nwid) const
  188. throw()
  189. {
  190. uint64_t a = _m & 0xffffffffffULL; // least significant 40 bits of MAC are formed from address
  191. a ^= ((nwid >> 8) & 0xff) << 32; // ... XORed with bits 8-48 of the nwid in little-endian byte order, so unmask it
  192. a ^= ((nwid >> 16) & 0xff) << 24;
  193. a ^= ((nwid >> 24) & 0xff) << 16;
  194. a ^= ((nwid >> 32) & 0xff) << 8;
  195. a ^= (nwid >> 40) & 0xff;
  196. return Address(a);
  197. }
  198. /**
  199. * @param nwid Network ID
  200. * @return First octet of MAC for this network
  201. */
  202. static inline unsigned char firstOctetForNetwork(uint64_t nwid)
  203. throw()
  204. {
  205. unsigned char a = ((unsigned char)(nwid & 0xfe) | 0x02); // locally administered, not multicast, from LSB of network ID
  206. return ((a == 0x52) ? 0x32 : a); // blacklist 0x52 since it's used by KVM, libvirt, and other popular virtualization engines... seems de-facto standard on Linux
  207. }
  208. /**
  209. * @param i Value from 0 to 5 (inclusive)
  210. * @return Byte at said position (address interpreted in big-endian order)
  211. */
  212. inline unsigned char operator[](unsigned int i) const throw() { return (unsigned char)((_m >> (40 - (i * 8))) & 0xff); }
  213. /**
  214. * @return 6, which is the number of bytes in a MAC, for container compliance
  215. */
  216. inline unsigned int size() const throw() { return 6; }
  217. inline unsigned long hashCode() const throw() { return (unsigned long)_m; }
  218. inline MAC &operator=(const MAC &m)
  219. throw()
  220. {
  221. _m = m._m;
  222. return *this;
  223. }
  224. inline MAC &operator=(const uint64_t m)
  225. throw()
  226. {
  227. _m = m;
  228. return *this;
  229. }
  230. inline bool operator==(const MAC &m) const throw() { return (_m == m._m); }
  231. inline bool operator!=(const MAC &m) const throw() { return (_m != m._m); }
  232. inline bool operator<(const MAC &m) const throw() { return (_m < m._m); }
  233. inline bool operator<=(const MAC &m) const throw() { return (_m <= m._m); }
  234. inline bool operator>(const MAC &m) const throw() { return (_m > m._m); }
  235. inline bool operator>=(const MAC &m) const throw() { return (_m >= m._m); }
  236. private:
  237. uint64_t _m;
  238. };
  239. } // namespace ZeroTier
  240. #endif