main.cpp 3.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131
  1. #include "yaml.h"
  2. #include <assert.h>
  3. #include <cstring>
  4. #include <iomanip>
  5. #include <iostream>
  6. #include <libmnl/libmnl.h>
  7. #include <linux/if.h>
  8. #include <linux/rtnetlink.h>
  9. #include <sstream>
  10. #include <string>
  11. #include <vector>
  12. // https://netfilter.org/projects/libmnl/doxygen/html/modules.html
  13. struct HardwareAddress : public YamlObject {
  14. uint8_t bytes[IFHWADDRLEN];
  15. HardwareAddress &operator=(const nlattr *attr) {
  16. assert(mnl_attr_get_payload_len(attr) == IFHWADDRLEN);
  17. memcpy(this->bytes, mnl_attr_get_payload(attr), IFHWADDRLEN);
  18. return *this;
  19. }
  20. std::string format() const {
  21. std::stringstream ss;
  22. ss << std::hex << std::setfill('0');
  23. for (int i = 0; i < IFHWADDRLEN; i++) {
  24. if (i != 0) {
  25. ss << ':';
  26. }
  27. ss << std::setw(2) << (int)bytes[i];
  28. }
  29. return ss.str();
  30. }
  31. void write_yaml(std::ostream &stream,
  32. const yaml_indent_level_t indent_level = 0) const {
  33. stream << format();
  34. }
  35. };
  36. struct Link : public YamlObject {
  37. std::string ifname;
  38. HardwareAddress hwaddr, broadcast;
  39. void write_yaml(std::ostream &stream,
  40. const yaml_indent_level_t indent_level = 0) const {
  41. const std::string indent(indent_level, ' ');
  42. stream << "ifname: " + ifname + "\n";
  43. stream << indent + "hwaddr: ";
  44. hwaddr.write_yaml(stream);
  45. stream << "\n";
  46. stream << indent + "broadcast: ";
  47. broadcast.write_yaml(stream);
  48. stream << "\n";
  49. }
  50. };
  51. template <class T> class vector : public std::vector<T>, YamlObject {
  52. public:
  53. void write_yaml(std::ostream &stream,
  54. const yaml_indent_level_t indent_level = 0) const {
  55. if (this->empty()) {
  56. stream << "[]";
  57. } else {
  58. const std::string indent(indent_level, ' ');
  59. stream << "\n";
  60. for (auto it = this->begin(); it != this->end(); it++) {
  61. stream << indent << "- ";
  62. it->write_yaml(stream, indent_level + 2);
  63. }
  64. }
  65. }
  66. };
  67. static int link_attr_cb(const nlattr *attr, void *data) {
  68. Link *link = (Link *)data;
  69. // /usr/include/linux/if_link.h
  70. switch (mnl_attr_get_type(attr)) {
  71. case IFLA_ADDRESS:
  72. link->hwaddr = attr;
  73. break;
  74. case IFLA_BROADCAST:
  75. link->broadcast = attr;
  76. break;
  77. case IFLA_IFNAME:
  78. link->ifname = mnl_attr_get_str(attr);
  79. break;
  80. }
  81. return MNL_CB_OK;
  82. }
  83. static int link_cb(const nlmsghdr *nlh, void *data) {
  84. vector<Link> *links = (vector<Link> *)data;
  85. links->emplace_back();
  86. mnl_attr_parse(nlh, sizeof(ifinfomsg), link_attr_cb, &links->back());
  87. return MNL_CB_OK;
  88. }
  89. int main(int argc, char *argv[]) {
  90. mnl_socket *nl = mnl_socket_open(NETLINK_ROUTE);
  91. assert(nl);
  92. assert(mnl_socket_bind(nl, 0, MNL_SOCKET_AUTOPID) == 0);
  93. unsigned int nlpid = mnl_socket_get_portid(nl);
  94. uint8_t msgbuf[MNL_SOCKET_BUFFER_SIZE];
  95. nlmsghdr *nlh = mnl_nlmsg_put_header(msgbuf);
  96. nlh->nlmsg_type = RTM_GETLINK;
  97. nlh->nlmsg_flags = NLM_F_REQUEST | NLM_F_DUMP;
  98. nlh->nlmsg_seq = 0;
  99. mnl_nlmsg_put_extra_header(nlh, sizeof(rtgenmsg));
  100. assert(mnl_socket_sendto(nl, nlh, nlh->nlmsg_len) > 0);
  101. vector<Link> links;
  102. size_t numbytes = mnl_socket_recvfrom(nl, msgbuf, sizeof(msgbuf));
  103. while (numbytes > 0) {
  104. if (mnl_cb_run(msgbuf, numbytes, nlh->nlmsg_seq, nlpid, link_cb, &links) <=
  105. MNL_CB_STOP) {
  106. break;
  107. } else {
  108. numbytes = mnl_socket_recvfrom(nl, msgbuf, sizeof(msgbuf));
  109. }
  110. }
  111. assert(numbytes != -1);
  112. links.write_yaml(std::cout);
  113. std::cout << std::endl;
  114. mnl_socket_close(nl);
  115. return EXIT_SUCCESS;
  116. }