1 #include "system_queries.hpp"
2 
3 #include "netlink.hpp"
4 
5 #include <linux/ethtool.h>
6 #include <linux/rtnetlink.h>
7 #include <linux/sockios.h>
8 #include <net/if.h>
9 
10 #include <phosphor-logging/lg2.hpp>
11 #include <stdplus/fd/create.hpp>
12 #include <stdplus/hash/tuple.hpp>
13 #include <stdplus/util/cexec.hpp>
14 
15 #include <algorithm>
16 #include <format>
17 #include <optional>
18 #include <stdexcept>
19 #include <string_view>
20 #include <unordered_set>
21 
22 namespace phosphor::network::system
23 {
24 
25 using std::literals::string_view_literals::operator""sv;
26 
getIFSock()27 static stdplus::Fd& getIFSock()
28 {
29     using namespace stdplus::fd;
30     static auto fd =
31         socket(SocketDomain::INet, SocketType::Datagram, SocketProto::IP);
32     return fd;
33 }
34 
makeIFReq(std::string_view ifname)35 static ifreq makeIFReq(std::string_view ifname)
36 {
37     ifreq ifr = {};
38     const auto copied = std::min<std::size_t>(ifname.size(), IFNAMSIZ - 1);
39     std::copy_n(ifname.begin(), copied, ifr.ifr_name);
40     return ifr;
41 }
42 
executeIFReq(std::string_view ifname,unsigned long cmd,void * data=nullptr)43 static ifreq executeIFReq(std::string_view ifname, unsigned long cmd,
44                           void* data = nullptr)
45 {
46     ifreq ifr = makeIFReq(ifname);
47     ifr.ifr_data = reinterpret_cast<char*>(data);
48     getIFSock().ioctl(cmd, &ifr);
49     return ifr;
50 }
51 
optionalIFReq(stdplus::zstring_view ifname,unsigned long long cmd,std::string_view cmdname,auto && complete,void * data=nullptr)52 inline auto optionalIFReq(stdplus::zstring_view ifname, unsigned long long cmd,
53                           std::string_view cmdname, auto&& complete,
54                           void* data = nullptr)
55 {
56     ifreq ifr;
57     std::optional<decltype(complete(ifr))> ret;
58     auto ukey = std::make_tuple(std::string(ifname), cmd);
59     static std::unordered_set<std::tuple<std::string, unsigned long long>>
60         unsupported;
61     try
62     {
63         ifr = executeIFReq(ifname, cmd, data);
64     }
65     catch (const std::system_error& e)
66     {
67         if (e.code() == std::errc::operation_not_supported)
68         {
69             if (unsupported.find(ukey) == unsupported.end())
70             {
71                 unsupported.emplace(std::move(ukey));
72                 lg2::info("{NET_IFREQ} not supported on {NET_INTF}",
73                           "NET_IFREQ", cmdname, "NET_INTF", ifname);
74             }
75             return ret;
76         }
77         throw;
78     }
79     unsupported.erase(ukey);
80     ret.emplace(complete(ifr));
81     return ret;
82 }
83 
getEthInfo(stdplus::zstring_view ifname)84 EthInfo getEthInfo(stdplus::zstring_view ifname)
85 {
86     ethtool_cmd edata = {};
87     edata.cmd = ETHTOOL_GSET;
88     return optionalIFReq(
89                ifname, SIOCETHTOOL, "ETHTOOL"sv,
90                [&](const ifreq&) {
91                    return EthInfo{.autoneg = edata.autoneg != 0,
92                                   .speed = edata.speed};
93                },
94                &edata)
95         .value_or(EthInfo{});
96 }
97 
setMTU(std::string_view ifname,unsigned mtu)98 void setMTU(std::string_view ifname, unsigned mtu)
99 {
100     auto ifr = makeIFReq(ifname);
101     ifr.ifr_mtu = mtu;
102     getIFSock().ioctl(SIOCSIFMTU, &ifr);
103 }
104 
setNICUp(std::string_view ifname,bool up)105 void setNICUp(std::string_view ifname, bool up)
106 {
107     ifreq ifr = executeIFReq(ifname, SIOCGIFFLAGS);
108     ifr.ifr_flags &= ~IFF_UP;
109     ifr.ifr_flags |= up ? IFF_UP : 0;
110     lg2::info("Setting NIC {UPDOWN} on {NET_INTF}", "UPDOWN",
111               up ? "up"sv : "down"sv, "NET_INTF", ifname);
112     getIFSock().ioctl(SIOCSIFFLAGS, &ifr);
113 }
114 
deleteIntf(unsigned idx)115 void deleteIntf(unsigned idx)
116 {
117     if (idx == 0)
118     {
119         return;
120     }
121     ifinfomsg msg = {};
122     msg.ifi_family = AF_UNSPEC;
123     msg.ifi_index = idx;
124     netlink::performRequest(
125         NETLINK_ROUTE, RTM_DELLINK, NLM_F_REPLACE, msg,
126         [&](const nlmsghdr& hdr, std::string_view data) {
127             int err = 0;
128             if (hdr.nlmsg_type == NLMSG_ERROR)
129             {
130                 err = netlink::extractRtData<nlmsgerr>(data).error;
131             }
132             throw std::runtime_error(
133                 std::format("Failed to delete `{}`: {}", idx, strerror(err)));
134         });
135 }
136 
137 } // namespace phosphor::network::system
138