main.cpp 2.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081
  1. #include "address.h"
  2. #include "hardware_address.h"
  3. #include "link.h"
  4. #include "vector.h"
  5. #include <cassert>
  6. #include <cstdlib>
  7. #include <iostream>
  8. #include <libmnl/libmnl.h>
  9. #include <linux/netlink.h>
  10. #include <linux/rtnetlink.h>
  11. // https://netfilter.org/projects/libmnl/doxygen/html/modules.html
  12. void mnl_recv_run_cb_all(const mnl_socket *nl, void *buf, size_t bufsiz,
  13. mnl_cb_t cb_data, void *data) {
  14. unsigned int nlpid = mnl_socket_get_portid(nl);
  15. ssize_t numbytes = mnl_socket_recvfrom(nl, buf, bufsiz);
  16. while (numbytes > 0) {
  17. if (mnl_cb_run(buf, numbytes, 0, nlpid, cb_data, data) <= MNL_CB_STOP) {
  18. break;
  19. }
  20. numbytes = mnl_socket_recvfrom(nl, buf, bufsiz);
  21. }
  22. assert(numbytes != -1);
  23. }
  24. int link_cb(const nlmsghdr *nlh, void *data) {
  25. vector<Link> *links = (vector<Link> *)data;
  26. links->emplace_back();
  27. mnl_attr_parse(nlh, sizeof(ifinfomsg), Link::mnl_attr_cb, &links->back());
  28. return MNL_CB_OK;
  29. }
  30. void mnl_read_links(const mnl_socket *nl, vector<Link> *links) {
  31. uint8_t msgbuf[MNL_SOCKET_BUFFER_SIZE];
  32. nlmsghdr *nlh = mnl_nlmsg_put_header(msgbuf);
  33. nlh->nlmsg_type = RTM_GETLINK;
  34. nlh->nlmsg_flags = NLM_F_REQUEST | NLM_F_DUMP;
  35. mnl_nlmsg_put_extra_header(nlh, sizeof(rtgenmsg));
  36. assert(mnl_socket_sendto(nl, nlh, nlh->nlmsg_len) > 0);
  37. mnl_recv_run_cb_all(nl, msgbuf, sizeof(msgbuf), link_cb, links);
  38. }
  39. static int address_cb(const struct nlmsghdr *nlh, void *data) {
  40. vector<Address> *addrs = (vector<Address> *)data;
  41. addrs->emplace_back();
  42. mnl_attr_parse(nlh, sizeof(ifaddrmsg), Address::mnl_attr_cb, &addrs->back());
  43. return MNL_CB_OK;
  44. }
  45. void mnl_read_addresses(const mnl_socket *nl, vector<Address> *addrs) {
  46. char msgbuf[MNL_SOCKET_BUFFER_SIZE];
  47. nlmsghdr *nlh = mnl_nlmsg_put_header(msgbuf);
  48. nlh->nlmsg_type = RTM_GETADDR;
  49. nlh->nlmsg_flags = NLM_F_REQUEST | NLM_F_DUMP;
  50. rtgenmsg *rt = (rtgenmsg *)mnl_nlmsg_put_extra_header(nlh, sizeof(rtgenmsg));
  51. rt->rtgen_family = AF_INET;
  52. assert(mnl_socket_sendto(nl, nlh, nlh->nlmsg_len) > 0);
  53. mnl_recv_run_cb_all(nl, msgbuf, sizeof(msgbuf), address_cb, addrs);
  54. }
  55. int main(int argc, char *argv[]) {
  56. mnl_socket *nl = mnl_socket_open(NETLINK_ROUTE);
  57. assert(nl);
  58. assert(mnl_socket_bind(nl, 0, MNL_SOCKET_AUTOPID) == 0);
  59. vector<Link> links;
  60. mnl_read_links(nl, &links);
  61. std::cout << "links: ";
  62. links.write_yaml(std::cout);
  63. vector<Address> addrs;
  64. mnl_read_addresses(nl, &addrs);
  65. std::cout << "addresses: ";
  66. addrs.write_yaml(std::cout);
  67. std::cout << std::endl;
  68. mnl_socket_close(nl);
  69. return EXIT_SUCCESS;
  70. }