Line data Source code
1 : #include "fd_netdev_netlink.h"
2 : #include "../../util/fd_util.h"
3 : #include "../../util/net/fd_ip4.h"
4 : #include "fd_netdev_tbl.h"
5 : #include <linux/if_link.h>
6 :
7 : #if !defined(__linux__)
8 : #error "fd_netdev_netlink.c requires a Linux system with kernel headers"
9 : #endif
10 :
11 : #include <errno.h>
12 : #include <linux/if.h> /* IFNAMSIZ */
13 : #include <linux/if_arp.h> /* ARPHRD_NETROM */
14 : #include <linux/rtnetlink.h> /* RTM_{...}, NLM_{...} */
15 : #include <linux/ip.h>
16 : #include <linux/ipv6.h>
17 : #include <linux/if_tunnel.h>
18 :
19 : static fd_netdev_t *
20 0 : fd_netdev_init( fd_netdev_t * netdev ) {
21 0 : *netdev = (fd_netdev_t) {
22 0 : .mtu = 1500,
23 0 : .if_idx = 0,
24 0 : .slave_tbl_idx = -1,
25 0 : .master_idx = -1,
26 0 : .oper_status = FD_OPER_STATUS_INVALID,
27 0 : .dev_type = ARPHRD_NONE,
28 0 : .gre_dst_ip = 0,
29 0 : .gre_src_ip = 0
30 0 : };
31 0 : return netdev;
32 0 : }
33 :
34 : FD_FN_CONST static uchar
35 0 : ifoper_to_oper_status( uint if_oper ) {
36 : /* Linux uses different enum values than RFC 2863 */
37 0 : switch( if_oper ) {
38 0 : case IF_OPER_UNKNOWN:
39 0 : return FD_OPER_STATUS_UNKNOWN;
40 0 : case IF_OPER_NOTPRESENT:
41 0 : return FD_OPER_STATUS_NOT_PRESENT;
42 0 : case IF_OPER_DOWN:
43 0 : return FD_OPER_STATUS_DOWN;
44 0 : case IF_OPER_LOWERLAYERDOWN:
45 0 : return FD_OPER_STATUS_LOWER_LAYER_DOWN;
46 0 : case IF_OPER_TESTING:
47 0 : return FD_OPER_STATUS_TESTING;
48 0 : case IF_OPER_DORMANT:
49 0 : return FD_OPER_STATUS_DORMANT;
50 0 : case IF_OPER_UP:
51 0 : return FD_OPER_STATUS_UP;
52 0 : default:
53 0 : return FD_OPER_STATUS_INVALID;
54 0 : }
55 0 : }
56 :
57 : int
58 : fd_netdev_netlink_load_table( fd_netdev_tbl_join_t * tbl,
59 0 : fd_netlink_t * netlink ) {
60 0 : fd_netdev_tbl_reset( tbl );
61 :
62 0 : uint seq = netlink->seq++;
63 :
64 0 : struct {
65 0 : struct nlmsghdr nlh;
66 0 : struct ifinfomsg ifi;
67 0 : } request;
68 0 : request.nlh = (struct nlmsghdr) {
69 0 : .nlmsg_type = RTM_GETLINK,
70 0 : .nlmsg_flags = NLM_F_REQUEST | NLM_F_DUMP,
71 0 : .nlmsg_len = sizeof(request),
72 0 : .nlmsg_seq = seq
73 0 : };
74 0 : request.ifi = (struct ifinfomsg) {
75 0 : .ifi_family = AF_PACKET,
76 0 : .ifi_type = ARPHRD_NETROM,
77 0 : };
78 :
79 0 : long send_res = sendto( netlink->fd, &request, sizeof(request), 0, NULL, 0 );
80 0 : if( FD_UNLIKELY( send_res<0 ) ) {
81 0 : FD_LOG_WARNING(( "netlink send(%d,RTM_GETLINK,NLM_F_REQUEST|NLM_F_DUMP) failed (%i-%s)", netlink->fd, errno, fd_io_strerror( errno ) ));
82 0 : return errno;
83 0 : }
84 0 : if( FD_UNLIKELY( send_res!=sizeof(request) ) ) {
85 0 : FD_LOG_WARNING(( "netlink send(%d,RTM_GETLINK,NLM_F_REQUEST|NLM_F_DUMP) failed (short write)", netlink->fd ));
86 0 : return EPIPE;
87 0 : }
88 :
89 0 : int err = 0;
90 :
91 0 : uchar buf[ 4096 ];
92 0 : fd_netlink_iter_t iter[1];
93 0 : for( fd_netlink_iter_init( iter, netlink, buf, sizeof(buf) );
94 0 : !fd_netlink_iter_done( iter );
95 0 : fd_netlink_iter_next( iter, netlink ) ) {
96 0 : struct nlmsghdr const * nlh = fd_netlink_iter_msg( iter );
97 0 : if( FD_UNLIKELY( nlh->nlmsg_type==NLMSG_ERROR ) ) {
98 0 : struct nlmsgerr * err = NLMSG_DATA( nlh );
99 0 : int nl_err = -err->error;
100 0 : FD_LOG_WARNING(( "netlink RTM_GETLINK,NLM_F_REQUEST|NLM_F_DUMP failed (%d-%s)", nl_err, fd_io_strerror( nl_err ) ));
101 0 : return nl_err;
102 0 : }
103 0 : if( FD_UNLIKELY( nlh->nlmsg_type!=RTM_NEWLINK ) ) {
104 0 : FD_LOG_DEBUG(( "unexpected nlmsg_type %u", nlh->nlmsg_type ));
105 0 : continue;
106 0 : }
107 0 : struct ifinfomsg const * ifi = NLMSG_DATA( nlh );
108 :
109 0 : if( FD_UNLIKELY( ifi->ifi_index<0 ) ) {
110 0 : FD_LOG_WARNING(( "Error reading interface table: interface %d has invalid index", ifi->ifi_index ));
111 0 : err = EPROTO;
112 0 : break;
113 0 : }
114 :
115 0 : ushort ifi_type = ifi->ifi_type;
116 0 : if( ifi_type!=ARPHRD_ETHER && ifi_type!=ARPHRD_LOOPBACK && ifi_type!=ARPHRD_IPGRE ) continue;
117 :
118 0 : struct ifinfomsg * msg = NLMSG_DATA( nlh );
119 0 : struct rtattr * rat = (void *)( (ulong)msg + NLMSG_ALIGN( sizeof(struct ifinfomsg) ) );
120 0 : long rat_sz = (long)NLMSG_PAYLOAD( nlh, sizeof(struct ifinfomsg) );
121 :
122 0 : fd_netdev_t netdev[1];
123 0 : fd_netdev_init( netdev );
124 :
125 0 : for( ; RTA_OK( rat, rat_sz ); rat=RTA_NEXT( rat, rat_sz ) ) {
126 0 : void * rta = RTA_DATA( rat );
127 0 : ulong rta_sz = RTA_PAYLOAD( rat );
128 :
129 0 : switch( rat->rta_type ) {
130 :
131 0 : case IFLA_IFNAME:
132 : /* Includes trailing zero */
133 0 : if( FD_UNLIKELY( rta_sz==0 || rta_sz>IFNAMSIZ ) ) {
134 0 : FD_LOG_WARNING(( "Error reading interface table: IFLA_IFNAME has unsupported size %lu", rta_sz ));
135 0 : err = EPROTO;
136 0 : goto fail;
137 0 : }
138 0 : memcpy( netdev->name, rta, rta_sz );
139 0 : netdev->name[ rta_sz-1 ] = '\0';
140 0 : break;
141 :
142 0 : case IFLA_ADDRESS:
143 0 : if( FD_UNLIKELY( rta_sz==6UL ) ) {
144 0 : memcpy( netdev->mac_addr, rta, 6 );
145 0 : }
146 0 : break;
147 :
148 0 : case IFLA_OPERSTATE:
149 0 : if( FD_UNLIKELY( rta_sz!=1UL ) ) {
150 0 : FD_LOG_WARNING(( "Error reading interface table: IFLA_OPERSTATE has unexpected size %lu", rta_sz ));
151 0 : err = EPROTO;
152 0 : goto fail;
153 0 : }
154 0 : netdev->oper_status = (uchar)ifoper_to_oper_status( FD_LOAD( uchar, rta ) );
155 0 : break;
156 :
157 0 : case IFLA_MTU:
158 0 : if( FD_UNLIKELY( rta_sz!=4UL ) ) {
159 0 : FD_LOG_WARNING(( "Error reading interface table: IFLA_MTU has unexpected size %lu", rta_sz ));
160 0 : err = EPROTO;
161 0 : goto fail;
162 0 : }
163 0 : netdev->mtu = (ushort)fd_uint_min( FD_LOAD( uint, rta ), USHORT_MAX );
164 0 : break;
165 :
166 0 : case IFLA_MASTER: {
167 0 : if( FD_UNLIKELY( rta_sz!=4UL ) ) {
168 0 : FD_LOG_WARNING(( "Error reading interface table: IFLA_MASTER has unexpected size %lu", rta_sz ));
169 0 : err = EPROTO;
170 0 : goto fail;
171 0 : }
172 0 : int master_idx = FD_LOAD( int, rta );
173 0 : if( FD_UNLIKELY( master_idx<0 ) ) {
174 0 : FD_LOG_WARNING(( "Error reading interface table: IFLA_MASTER has invalid ifindex %d", master_idx ));
175 0 : err = EPROTO;
176 0 : goto fail;
177 0 : }
178 0 : netdev->master_idx = master_idx;
179 0 : break;
180 0 : } /* IFLA_MASTER */
181 :
182 0 : case IFLA_LINKINFO : {
183 0 : if( ifi->ifi_type!=ARPHRD_IPGRE ) continue;
184 :
185 0 : struct rtattr * info_rat = rta;
186 0 : long info_rat_sz = (long)rta_sz;
187 :
188 0 : for( ; RTA_OK( info_rat, info_rat_sz ); info_rat = RTA_NEXT( info_rat, info_rat_sz ) ) {
189 0 : void * info_rta = RTA_DATA( info_rat );
190 0 : ulong info_rta_sz = RTA_PAYLOAD( info_rat );
191 :
192 0 : switch( info_rat->rta_type ) {
193 0 : case IFLA_INFO_DATA: {
194 0 : struct rtattr * gre_rat = (struct rtattr *)info_rta;
195 0 : long gre_rat_sz = (long)info_rta_sz;
196 :
197 0 : for( ; RTA_OK( gre_rat, gre_rat_sz ); gre_rat = RTA_NEXT( gre_rat, gre_rat_sz ) ) {
198 0 : void * gre_rta = RTA_DATA( gre_rat );
199 0 : uint gre_dst_ip;
200 0 : uint gre_src_ip;
201 :
202 0 : switch( gre_rat->rta_type ) {
203 0 : case IFLA_GRE_REMOTE: {
204 0 : gre_dst_ip = FD_LOAD( uint, gre_rta );
205 0 : if( gre_dst_ip != 0 ) netdev->gre_dst_ip = gre_dst_ip;
206 0 : break;
207 0 : } /* IFLA_GRE_REMOTE */
208 0 : case IFLA_GRE_LOCAL: {
209 0 : gre_src_ip = FD_LOAD( uint, gre_rta );
210 0 : if( gre_src_ip != 0 ) netdev->gre_src_ip = gre_src_ip;
211 0 : break;
212 0 : } /* IFLA_GRE_LOCAL */
213 0 : }
214 0 : }
215 0 : break;
216 0 : } /* IFLA_INFO_DATA */
217 0 : } /* info_rat->rta_type */
218 0 : } /* for each info_rta */
219 0 : } /* IFLA_LINKINFO */
220 :
221 0 : } /* switch( rat->rta_type ) */
222 0 : } /* for each RTA */
223 :
224 0 : if( ifi->ifi_type==ARPHRD_LOOPBACK ) {
225 0 : netdev->oper_status = FD_OPER_STATUS_UP;
226 0 : }
227 :
228 0 : netdev->dev_type = ifi_type;
229 0 : netdev->if_idx = (uint)ifi->ifi_index;
230 0 : fd_netdev_t * dst = fd_netdev_tbl_query( tbl, (uint)ifi->ifi_index );
231 0 : if( FD_UNLIKELY( !dst ) ) {
232 0 : if( FD_UNLIKELY( tbl->hdr->dev_cnt >= tbl->hdr->dev_max ) ) {
233 0 : FD_LOG_WARNING(( "Error reading interface table: tracked interface limit %u reached (dropping ifindex %i)",
234 0 : tbl->hdr->dev_max, ifi->ifi_index ));
235 0 : err = ENOSPC;
236 0 : break;
237 0 : }
238 0 : dst = &tbl->dev_tbl[ tbl->hdr->dev_cnt ]; // alloc new entry
239 0 : tbl->hdr->dev_cnt = (ushort)(tbl->hdr->dev_cnt + 1);
240 0 : }
241 0 : *dst = *netdev;
242 0 : }
243 :
244 : /* Walk the table again to index the bond master => slave mapping */
245 :
246 0 : for( ulong j=0UL; j<(tbl->hdr->dev_cnt); j++ ) {
247 : /* Only consider UP slaves */
248 0 : if( tbl->dev_tbl[ j ].oper_status!=FD_OPER_STATUS_UP ) continue;
249 :
250 : /* Find master */
251 0 : int master_idx = tbl->dev_tbl[ j ].master_idx;
252 0 : if( master_idx<0 ) continue;
253 0 : fd_netdev_t * master = fd_netdev_tbl_query( tbl, (uint)master_idx );
254 0 : if( FD_UNLIKELY( !master ) ) {
255 0 : FD_LOG_WARNING(( "Error reading interface table: Bond device references missing master %d", master_idx ));
256 0 : continue;
257 0 : }
258 :
259 : /* Allocate a new bond slave table if needed */
260 0 : if( master->slave_tbl_idx<0 ) {
261 0 : if( FD_UNLIKELY( tbl->hdr->bond_cnt>=tbl->hdr->bond_max ) ) {
262 0 : FD_LOG_WARNING(( "Error reading interface table: Found %u bond devices but max is %u", tbl->hdr->bond_cnt, tbl->hdr->bond_max ));
263 0 : continue;
264 0 : }
265 :
266 0 : master->slave_tbl_idx = (short)tbl->hdr->bond_cnt;
267 0 : tbl->hdr->bond_cnt = (ushort)( tbl->hdr->bond_cnt+1U );
268 : /* Assume that this table is empty */
269 0 : }
270 :
271 0 : fd_netdev_bond_t * bond = &tbl->bond_tbl[ master->slave_tbl_idx ];
272 0 : if( FD_UNLIKELY( bond->slave_cnt>=FD_NETDEV_BOND_SLAVE_MAX ) ) {
273 0 : FD_LOG_WARNING(( "Error reading interface table: Bond device %d has %u slaves but max is %d", master_idx, bond->slave_cnt, FD_NETDEV_BOND_SLAVE_MAX ));
274 0 : continue;
275 0 : }
276 0 : bond->slave_idx[ bond->slave_cnt ] = (ushort)j;
277 0 : bond->slave_cnt = (uchar)( bond->slave_cnt+1U );
278 0 : }
279 :
280 0 : return 0;
281 :
282 0 : fail:
283 0 : fd_netlink_iter_drain( iter, netlink );
284 0 : return err;
285 0 : }
|
