xref: /OK3568_Linux_fs/kernel/samples/bpf/xdp_router_ipv4_user.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-only
2*4882a593Smuzhiyun /* Copyright (C) 2017 Cavium, Inc.
3*4882a593Smuzhiyun  */
4*4882a593Smuzhiyun #include <linux/bpf.h>
5*4882a593Smuzhiyun #include <linux/netlink.h>
6*4882a593Smuzhiyun #include <linux/rtnetlink.h>
7*4882a593Smuzhiyun #include <assert.h>
8*4882a593Smuzhiyun #include <errno.h>
9*4882a593Smuzhiyun #include <signal.h>
10*4882a593Smuzhiyun #include <stdio.h>
11*4882a593Smuzhiyun #include <stdlib.h>
12*4882a593Smuzhiyun #include <string.h>
13*4882a593Smuzhiyun #include <sys/socket.h>
14*4882a593Smuzhiyun #include <unistd.h>
15*4882a593Smuzhiyun #include <bpf/bpf.h>
16*4882a593Smuzhiyun #include <arpa/inet.h>
17*4882a593Smuzhiyun #include <fcntl.h>
18*4882a593Smuzhiyun #include <poll.h>
19*4882a593Smuzhiyun #include <net/if.h>
20*4882a593Smuzhiyun #include <netdb.h>
21*4882a593Smuzhiyun #include <sys/ioctl.h>
22*4882a593Smuzhiyun #include <sys/syscall.h>
23*4882a593Smuzhiyun #include "bpf_util.h"
24*4882a593Smuzhiyun #include <bpf/libbpf.h>
25*4882a593Smuzhiyun #include <sys/resource.h>
26*4882a593Smuzhiyun #include <libgen.h>
27*4882a593Smuzhiyun 
28*4882a593Smuzhiyun int sock, sock_arp, flags = XDP_FLAGS_UPDATE_IF_NOEXIST;
29*4882a593Smuzhiyun static int total_ifindex;
30*4882a593Smuzhiyun static int *ifindex_list;
31*4882a593Smuzhiyun static __u32 *prog_id_list;
32*4882a593Smuzhiyun char buf[8192];
33*4882a593Smuzhiyun static int lpm_map_fd;
34*4882a593Smuzhiyun static int rxcnt_map_fd;
35*4882a593Smuzhiyun static int arp_table_map_fd;
36*4882a593Smuzhiyun static int exact_match_map_fd;
37*4882a593Smuzhiyun static int tx_port_map_fd;
38*4882a593Smuzhiyun 
39*4882a593Smuzhiyun static int get_route_table(int rtm_family);
int_exit(int sig)40*4882a593Smuzhiyun static void int_exit(int sig)
41*4882a593Smuzhiyun {
42*4882a593Smuzhiyun 	__u32 prog_id = 0;
43*4882a593Smuzhiyun 	int i = 0;
44*4882a593Smuzhiyun 
45*4882a593Smuzhiyun 	for (i = 0; i < total_ifindex; i++) {
46*4882a593Smuzhiyun 		if (bpf_get_link_xdp_id(ifindex_list[i], &prog_id, flags)) {
47*4882a593Smuzhiyun 			printf("bpf_get_link_xdp_id on iface %d failed\n",
48*4882a593Smuzhiyun 			       ifindex_list[i]);
49*4882a593Smuzhiyun 			exit(1);
50*4882a593Smuzhiyun 		}
51*4882a593Smuzhiyun 		if (prog_id_list[i] == prog_id)
52*4882a593Smuzhiyun 			bpf_set_link_xdp_fd(ifindex_list[i], -1, flags);
53*4882a593Smuzhiyun 		else if (!prog_id)
54*4882a593Smuzhiyun 			printf("couldn't find a prog id on iface %d\n",
55*4882a593Smuzhiyun 			       ifindex_list[i]);
56*4882a593Smuzhiyun 		else
57*4882a593Smuzhiyun 			printf("program on iface %d changed, not removing\n",
58*4882a593Smuzhiyun 			       ifindex_list[i]);
59*4882a593Smuzhiyun 		prog_id = 0;
60*4882a593Smuzhiyun 	}
61*4882a593Smuzhiyun 	exit(0);
62*4882a593Smuzhiyun }
63*4882a593Smuzhiyun 
close_and_exit(int sig)64*4882a593Smuzhiyun static void close_and_exit(int sig)
65*4882a593Smuzhiyun {
66*4882a593Smuzhiyun 	close(sock);
67*4882a593Smuzhiyun 	close(sock_arp);
68*4882a593Smuzhiyun 
69*4882a593Smuzhiyun 	int_exit(0);
70*4882a593Smuzhiyun }
71*4882a593Smuzhiyun 
72*4882a593Smuzhiyun /* Get the mac address of the interface given interface name */
getmac(char * iface)73*4882a593Smuzhiyun static __be64 getmac(char *iface)
74*4882a593Smuzhiyun {
75*4882a593Smuzhiyun 	struct ifreq ifr;
76*4882a593Smuzhiyun 	__be64 mac = 0;
77*4882a593Smuzhiyun 	int fd, i;
78*4882a593Smuzhiyun 
79*4882a593Smuzhiyun 	fd = socket(AF_INET, SOCK_DGRAM, 0);
80*4882a593Smuzhiyun 	ifr.ifr_addr.sa_family = AF_INET;
81*4882a593Smuzhiyun 	strncpy(ifr.ifr_name, iface, IFNAMSIZ - 1);
82*4882a593Smuzhiyun 	if (ioctl(fd, SIOCGIFHWADDR, &ifr) < 0) {
83*4882a593Smuzhiyun 		printf("ioctl failed leaving....\n");
84*4882a593Smuzhiyun 		return -1;
85*4882a593Smuzhiyun 	}
86*4882a593Smuzhiyun 	for (i = 0; i < 6 ; i++)
87*4882a593Smuzhiyun 		*((__u8 *)&mac + i) = (__u8)ifr.ifr_hwaddr.sa_data[i];
88*4882a593Smuzhiyun 	close(fd);
89*4882a593Smuzhiyun 	return mac;
90*4882a593Smuzhiyun }
91*4882a593Smuzhiyun 
recv_msg(struct sockaddr_nl sock_addr,int sock)92*4882a593Smuzhiyun static int recv_msg(struct sockaddr_nl sock_addr, int sock)
93*4882a593Smuzhiyun {
94*4882a593Smuzhiyun 	struct nlmsghdr *nh;
95*4882a593Smuzhiyun 	int len, nll = 0;
96*4882a593Smuzhiyun 	char *buf_ptr;
97*4882a593Smuzhiyun 
98*4882a593Smuzhiyun 	buf_ptr = buf;
99*4882a593Smuzhiyun 	while (1) {
100*4882a593Smuzhiyun 		len = recv(sock, buf_ptr, sizeof(buf) - nll, 0);
101*4882a593Smuzhiyun 		if (len < 0)
102*4882a593Smuzhiyun 			return len;
103*4882a593Smuzhiyun 
104*4882a593Smuzhiyun 		nh = (struct nlmsghdr *)buf_ptr;
105*4882a593Smuzhiyun 
106*4882a593Smuzhiyun 		if (nh->nlmsg_type == NLMSG_DONE)
107*4882a593Smuzhiyun 			break;
108*4882a593Smuzhiyun 		buf_ptr += len;
109*4882a593Smuzhiyun 		nll += len;
110*4882a593Smuzhiyun 		if ((sock_addr.nl_groups & RTMGRP_NEIGH) == RTMGRP_NEIGH)
111*4882a593Smuzhiyun 			break;
112*4882a593Smuzhiyun 
113*4882a593Smuzhiyun 		if ((sock_addr.nl_groups & RTMGRP_IPV4_ROUTE) == RTMGRP_IPV4_ROUTE)
114*4882a593Smuzhiyun 			break;
115*4882a593Smuzhiyun 	}
116*4882a593Smuzhiyun 	return nll;
117*4882a593Smuzhiyun }
118*4882a593Smuzhiyun 
119*4882a593Smuzhiyun /* Function to parse the route entry returned by netlink
120*4882a593Smuzhiyun  * Updates the route entry related map entries
121*4882a593Smuzhiyun  */
read_route(struct nlmsghdr * nh,int nll)122*4882a593Smuzhiyun static void read_route(struct nlmsghdr *nh, int nll)
123*4882a593Smuzhiyun {
124*4882a593Smuzhiyun 	char dsts[24], gws[24], ifs[16], dsts_len[24], metrics[24];
125*4882a593Smuzhiyun 	struct bpf_lpm_trie_key *prefix_key;
126*4882a593Smuzhiyun 	struct rtattr *rt_attr;
127*4882a593Smuzhiyun 	struct rtmsg *rt_msg;
128*4882a593Smuzhiyun 	int rtm_family;
129*4882a593Smuzhiyun 	int rtl;
130*4882a593Smuzhiyun 	int i;
131*4882a593Smuzhiyun 	struct route_table {
132*4882a593Smuzhiyun 		int  dst_len, iface, metric;
133*4882a593Smuzhiyun 		char *iface_name;
134*4882a593Smuzhiyun 		__be32 dst, gw;
135*4882a593Smuzhiyun 		__be64 mac;
136*4882a593Smuzhiyun 	} route;
137*4882a593Smuzhiyun 	struct arp_table {
138*4882a593Smuzhiyun 		__be64 mac;
139*4882a593Smuzhiyun 		__be32 dst;
140*4882a593Smuzhiyun 	};
141*4882a593Smuzhiyun 
142*4882a593Smuzhiyun 	struct direct_map {
143*4882a593Smuzhiyun 		struct arp_table arp;
144*4882a593Smuzhiyun 		int ifindex;
145*4882a593Smuzhiyun 		__be64 mac;
146*4882a593Smuzhiyun 	} direct_entry;
147*4882a593Smuzhiyun 
148*4882a593Smuzhiyun 	if (nh->nlmsg_type == RTM_DELROUTE)
149*4882a593Smuzhiyun 		printf("DELETING Route entry\n");
150*4882a593Smuzhiyun 	else if (nh->nlmsg_type == RTM_GETROUTE)
151*4882a593Smuzhiyun 		printf("READING Route entry\n");
152*4882a593Smuzhiyun 	else if (nh->nlmsg_type == RTM_NEWROUTE)
153*4882a593Smuzhiyun 		printf("NEW Route entry\n");
154*4882a593Smuzhiyun 	else
155*4882a593Smuzhiyun 		printf("%d\n", nh->nlmsg_type);
156*4882a593Smuzhiyun 
157*4882a593Smuzhiyun 	memset(&route, 0, sizeof(route));
158*4882a593Smuzhiyun 	printf("Destination\t\tGateway\t\tGenmask\t\tMetric\t\tIface\n");
159*4882a593Smuzhiyun 	for (; NLMSG_OK(nh, nll); nh = NLMSG_NEXT(nh, nll)) {
160*4882a593Smuzhiyun 		rt_msg = (struct rtmsg *)NLMSG_DATA(nh);
161*4882a593Smuzhiyun 		rtm_family = rt_msg->rtm_family;
162*4882a593Smuzhiyun 		if (rtm_family == AF_INET)
163*4882a593Smuzhiyun 			if (rt_msg->rtm_table != RT_TABLE_MAIN)
164*4882a593Smuzhiyun 				continue;
165*4882a593Smuzhiyun 		rt_attr = (struct rtattr *)RTM_RTA(rt_msg);
166*4882a593Smuzhiyun 		rtl = RTM_PAYLOAD(nh);
167*4882a593Smuzhiyun 
168*4882a593Smuzhiyun 		for (; RTA_OK(rt_attr, rtl); rt_attr = RTA_NEXT(rt_attr, rtl)) {
169*4882a593Smuzhiyun 			switch (rt_attr->rta_type) {
170*4882a593Smuzhiyun 			case NDA_DST:
171*4882a593Smuzhiyun 				sprintf(dsts, "%u",
172*4882a593Smuzhiyun 					(*((__be32 *)RTA_DATA(rt_attr))));
173*4882a593Smuzhiyun 				break;
174*4882a593Smuzhiyun 			case RTA_GATEWAY:
175*4882a593Smuzhiyun 				sprintf(gws, "%u",
176*4882a593Smuzhiyun 					*((__be32 *)RTA_DATA(rt_attr)));
177*4882a593Smuzhiyun 				break;
178*4882a593Smuzhiyun 			case RTA_OIF:
179*4882a593Smuzhiyun 				sprintf(ifs, "%u",
180*4882a593Smuzhiyun 					*((int *)RTA_DATA(rt_attr)));
181*4882a593Smuzhiyun 				break;
182*4882a593Smuzhiyun 			case RTA_METRICS:
183*4882a593Smuzhiyun 				sprintf(metrics, "%u",
184*4882a593Smuzhiyun 					*((int *)RTA_DATA(rt_attr)));
185*4882a593Smuzhiyun 			default:
186*4882a593Smuzhiyun 				break;
187*4882a593Smuzhiyun 			}
188*4882a593Smuzhiyun 		}
189*4882a593Smuzhiyun 		sprintf(dsts_len, "%d", rt_msg->rtm_dst_len);
190*4882a593Smuzhiyun 		route.dst = atoi(dsts);
191*4882a593Smuzhiyun 		route.dst_len = atoi(dsts_len);
192*4882a593Smuzhiyun 		route.gw = atoi(gws);
193*4882a593Smuzhiyun 		route.iface = atoi(ifs);
194*4882a593Smuzhiyun 		route.metric = atoi(metrics);
195*4882a593Smuzhiyun 		route.iface_name = alloca(sizeof(char *) * IFNAMSIZ);
196*4882a593Smuzhiyun 		route.iface_name = if_indextoname(route.iface, route.iface_name);
197*4882a593Smuzhiyun 		route.mac = getmac(route.iface_name);
198*4882a593Smuzhiyun 		if (route.mac == -1)
199*4882a593Smuzhiyun 			int_exit(0);
200*4882a593Smuzhiyun 		assert(bpf_map_update_elem(tx_port_map_fd,
201*4882a593Smuzhiyun 					   &route.iface, &route.iface, 0) == 0);
202*4882a593Smuzhiyun 		if (rtm_family == AF_INET) {
203*4882a593Smuzhiyun 			struct trie_value {
204*4882a593Smuzhiyun 				__u8 prefix[4];
205*4882a593Smuzhiyun 				__be64 value;
206*4882a593Smuzhiyun 				int ifindex;
207*4882a593Smuzhiyun 				int metric;
208*4882a593Smuzhiyun 				__be32 gw;
209*4882a593Smuzhiyun 			} *prefix_value;
210*4882a593Smuzhiyun 
211*4882a593Smuzhiyun 			prefix_key = alloca(sizeof(*prefix_key) + 3);
212*4882a593Smuzhiyun 			prefix_value = alloca(sizeof(*prefix_value));
213*4882a593Smuzhiyun 
214*4882a593Smuzhiyun 			prefix_key->prefixlen = 32;
215*4882a593Smuzhiyun 			prefix_key->prefixlen = route.dst_len;
216*4882a593Smuzhiyun 			direct_entry.mac = route.mac & 0xffffffffffff;
217*4882a593Smuzhiyun 			direct_entry.ifindex = route.iface;
218*4882a593Smuzhiyun 			direct_entry.arp.mac = 0;
219*4882a593Smuzhiyun 			direct_entry.arp.dst = 0;
220*4882a593Smuzhiyun 			if (route.dst_len == 32) {
221*4882a593Smuzhiyun 				if (nh->nlmsg_type == RTM_DELROUTE) {
222*4882a593Smuzhiyun 					assert(bpf_map_delete_elem(exact_match_map_fd,
223*4882a593Smuzhiyun 								   &route.dst) == 0);
224*4882a593Smuzhiyun 				} else {
225*4882a593Smuzhiyun 					if (bpf_map_lookup_elem(arp_table_map_fd,
226*4882a593Smuzhiyun 								&route.dst,
227*4882a593Smuzhiyun 								&direct_entry.arp.mac) == 0)
228*4882a593Smuzhiyun 						direct_entry.arp.dst = route.dst;
229*4882a593Smuzhiyun 					assert(bpf_map_update_elem(exact_match_map_fd,
230*4882a593Smuzhiyun 								   &route.dst,
231*4882a593Smuzhiyun 								   &direct_entry, 0) == 0);
232*4882a593Smuzhiyun 				}
233*4882a593Smuzhiyun 			}
234*4882a593Smuzhiyun 			for (i = 0; i < 4; i++)
235*4882a593Smuzhiyun 				prefix_key->data[i] = (route.dst >> i * 8) & 0xff;
236*4882a593Smuzhiyun 
237*4882a593Smuzhiyun 			printf("%3d.%d.%d.%d\t\t%3x\t\t%d\t\t%d\t\t%s\n",
238*4882a593Smuzhiyun 			       (int)prefix_key->data[0],
239*4882a593Smuzhiyun 			       (int)prefix_key->data[1],
240*4882a593Smuzhiyun 			       (int)prefix_key->data[2],
241*4882a593Smuzhiyun 			       (int)prefix_key->data[3],
242*4882a593Smuzhiyun 			       route.gw, route.dst_len,
243*4882a593Smuzhiyun 			       route.metric,
244*4882a593Smuzhiyun 			       route.iface_name);
245*4882a593Smuzhiyun 			if (bpf_map_lookup_elem(lpm_map_fd, prefix_key,
246*4882a593Smuzhiyun 						prefix_value) < 0) {
247*4882a593Smuzhiyun 				for (i = 0; i < 4; i++)
248*4882a593Smuzhiyun 					prefix_value->prefix[i] = prefix_key->data[i];
249*4882a593Smuzhiyun 				prefix_value->value = route.mac & 0xffffffffffff;
250*4882a593Smuzhiyun 				prefix_value->ifindex = route.iface;
251*4882a593Smuzhiyun 				prefix_value->gw = route.gw;
252*4882a593Smuzhiyun 				prefix_value->metric = route.metric;
253*4882a593Smuzhiyun 
254*4882a593Smuzhiyun 				assert(bpf_map_update_elem(lpm_map_fd,
255*4882a593Smuzhiyun 							   prefix_key,
256*4882a593Smuzhiyun 							   prefix_value, 0
257*4882a593Smuzhiyun 							   ) == 0);
258*4882a593Smuzhiyun 			} else {
259*4882a593Smuzhiyun 				if (nh->nlmsg_type == RTM_DELROUTE) {
260*4882a593Smuzhiyun 					printf("deleting entry\n");
261*4882a593Smuzhiyun 					printf("prefix key=%d.%d.%d.%d/%d",
262*4882a593Smuzhiyun 					       prefix_key->data[0],
263*4882a593Smuzhiyun 					       prefix_key->data[1],
264*4882a593Smuzhiyun 					       prefix_key->data[2],
265*4882a593Smuzhiyun 					       prefix_key->data[3],
266*4882a593Smuzhiyun 					       prefix_key->prefixlen);
267*4882a593Smuzhiyun 					assert(bpf_map_delete_elem(lpm_map_fd,
268*4882a593Smuzhiyun 								   prefix_key
269*4882a593Smuzhiyun 								   ) == 0);
270*4882a593Smuzhiyun 					/* Rereading the route table to check if
271*4882a593Smuzhiyun 					 * there is an entry with the same
272*4882a593Smuzhiyun 					 * prefix but a different metric as the
273*4882a593Smuzhiyun 					 * deleted enty.
274*4882a593Smuzhiyun 					 */
275*4882a593Smuzhiyun 					get_route_table(AF_INET);
276*4882a593Smuzhiyun 				} else if (prefix_key->data[0] ==
277*4882a593Smuzhiyun 					   prefix_value->prefix[0] &&
278*4882a593Smuzhiyun 					   prefix_key->data[1] ==
279*4882a593Smuzhiyun 					   prefix_value->prefix[1] &&
280*4882a593Smuzhiyun 					   prefix_key->data[2] ==
281*4882a593Smuzhiyun 					   prefix_value->prefix[2] &&
282*4882a593Smuzhiyun 					   prefix_key->data[3] ==
283*4882a593Smuzhiyun 					   prefix_value->prefix[3] &&
284*4882a593Smuzhiyun 					   route.metric >= prefix_value->metric) {
285*4882a593Smuzhiyun 					continue;
286*4882a593Smuzhiyun 				} else {
287*4882a593Smuzhiyun 					for (i = 0; i < 4; i++)
288*4882a593Smuzhiyun 						prefix_value->prefix[i] =
289*4882a593Smuzhiyun 							prefix_key->data[i];
290*4882a593Smuzhiyun 					prefix_value->value =
291*4882a593Smuzhiyun 						route.mac & 0xffffffffffff;
292*4882a593Smuzhiyun 					prefix_value->ifindex = route.iface;
293*4882a593Smuzhiyun 					prefix_value->gw = route.gw;
294*4882a593Smuzhiyun 					prefix_value->metric = route.metric;
295*4882a593Smuzhiyun 					assert(bpf_map_update_elem(lpm_map_fd,
296*4882a593Smuzhiyun 								   prefix_key,
297*4882a593Smuzhiyun 								   prefix_value,
298*4882a593Smuzhiyun 								   0) == 0);
299*4882a593Smuzhiyun 				}
300*4882a593Smuzhiyun 			}
301*4882a593Smuzhiyun 		}
302*4882a593Smuzhiyun 		memset(&route, 0, sizeof(route));
303*4882a593Smuzhiyun 		memset(dsts, 0, sizeof(dsts));
304*4882a593Smuzhiyun 		memset(dsts_len, 0, sizeof(dsts_len));
305*4882a593Smuzhiyun 		memset(gws, 0, sizeof(gws));
306*4882a593Smuzhiyun 		memset(ifs, 0, sizeof(ifs));
307*4882a593Smuzhiyun 		memset(&route, 0, sizeof(route));
308*4882a593Smuzhiyun 	}
309*4882a593Smuzhiyun }
310*4882a593Smuzhiyun 
311*4882a593Smuzhiyun /* Function to read the existing route table  when the process is launched*/
get_route_table(int rtm_family)312*4882a593Smuzhiyun static int get_route_table(int rtm_family)
313*4882a593Smuzhiyun {
314*4882a593Smuzhiyun 	struct sockaddr_nl sa;
315*4882a593Smuzhiyun 	struct nlmsghdr *nh;
316*4882a593Smuzhiyun 	int sock, seq = 0;
317*4882a593Smuzhiyun 	struct msghdr msg;
318*4882a593Smuzhiyun 	struct iovec iov;
319*4882a593Smuzhiyun 	int ret = 0;
320*4882a593Smuzhiyun 	int nll;
321*4882a593Smuzhiyun 
322*4882a593Smuzhiyun 	struct {
323*4882a593Smuzhiyun 		struct nlmsghdr nl;
324*4882a593Smuzhiyun 		struct rtmsg rt;
325*4882a593Smuzhiyun 		char buf[8192];
326*4882a593Smuzhiyun 	} req;
327*4882a593Smuzhiyun 
328*4882a593Smuzhiyun 	sock = socket(AF_NETLINK, SOCK_RAW, NETLINK_ROUTE);
329*4882a593Smuzhiyun 	if (sock < 0) {
330*4882a593Smuzhiyun 		printf("open netlink socket: %s\n", strerror(errno));
331*4882a593Smuzhiyun 		return -1;
332*4882a593Smuzhiyun 	}
333*4882a593Smuzhiyun 	memset(&sa, 0, sizeof(sa));
334*4882a593Smuzhiyun 	sa.nl_family = AF_NETLINK;
335*4882a593Smuzhiyun 	if (bind(sock, (struct sockaddr *)&sa, sizeof(sa)) < 0) {
336*4882a593Smuzhiyun 		printf("bind to netlink: %s\n", strerror(errno));
337*4882a593Smuzhiyun 		ret = -1;
338*4882a593Smuzhiyun 		goto cleanup;
339*4882a593Smuzhiyun 	}
340*4882a593Smuzhiyun 	memset(&req, 0, sizeof(req));
341*4882a593Smuzhiyun 	req.nl.nlmsg_len = NLMSG_LENGTH(sizeof(struct rtmsg));
342*4882a593Smuzhiyun 	req.nl.nlmsg_flags = NLM_F_REQUEST | NLM_F_DUMP;
343*4882a593Smuzhiyun 	req.nl.nlmsg_type = RTM_GETROUTE;
344*4882a593Smuzhiyun 
345*4882a593Smuzhiyun 	req.rt.rtm_family = rtm_family;
346*4882a593Smuzhiyun 	req.rt.rtm_table = RT_TABLE_MAIN;
347*4882a593Smuzhiyun 	req.nl.nlmsg_pid = 0;
348*4882a593Smuzhiyun 	req.nl.nlmsg_seq = ++seq;
349*4882a593Smuzhiyun 	memset(&msg, 0, sizeof(msg));
350*4882a593Smuzhiyun 	iov.iov_base = (void *)&req.nl;
351*4882a593Smuzhiyun 	iov.iov_len = req.nl.nlmsg_len;
352*4882a593Smuzhiyun 	msg.msg_iov = &iov;
353*4882a593Smuzhiyun 	msg.msg_iovlen = 1;
354*4882a593Smuzhiyun 	ret = sendmsg(sock, &msg, 0);
355*4882a593Smuzhiyun 	if (ret < 0) {
356*4882a593Smuzhiyun 		printf("send to netlink: %s\n", strerror(errno));
357*4882a593Smuzhiyun 		ret = -1;
358*4882a593Smuzhiyun 		goto cleanup;
359*4882a593Smuzhiyun 	}
360*4882a593Smuzhiyun 	memset(buf, 0, sizeof(buf));
361*4882a593Smuzhiyun 	nll = recv_msg(sa, sock);
362*4882a593Smuzhiyun 	if (nll < 0) {
363*4882a593Smuzhiyun 		printf("recv from netlink: %s\n", strerror(nll));
364*4882a593Smuzhiyun 		ret = -1;
365*4882a593Smuzhiyun 		goto cleanup;
366*4882a593Smuzhiyun 	}
367*4882a593Smuzhiyun 	nh = (struct nlmsghdr *)buf;
368*4882a593Smuzhiyun 	read_route(nh, nll);
369*4882a593Smuzhiyun cleanup:
370*4882a593Smuzhiyun 	close(sock);
371*4882a593Smuzhiyun 	return ret;
372*4882a593Smuzhiyun }
373*4882a593Smuzhiyun 
374*4882a593Smuzhiyun /* Function to parse the arp entry returned by netlink
375*4882a593Smuzhiyun  * Updates the arp entry related map entries
376*4882a593Smuzhiyun  */
read_arp(struct nlmsghdr * nh,int nll)377*4882a593Smuzhiyun static void read_arp(struct nlmsghdr *nh, int nll)
378*4882a593Smuzhiyun {
379*4882a593Smuzhiyun 	struct rtattr *rt_attr;
380*4882a593Smuzhiyun 	char dsts[24], mac[24];
381*4882a593Smuzhiyun 	struct ndmsg *rt_msg;
382*4882a593Smuzhiyun 	int rtl, ndm_family;
383*4882a593Smuzhiyun 
384*4882a593Smuzhiyun 	struct arp_table {
385*4882a593Smuzhiyun 		__be64 mac;
386*4882a593Smuzhiyun 		__be32 dst;
387*4882a593Smuzhiyun 	} arp_entry;
388*4882a593Smuzhiyun 	struct direct_map {
389*4882a593Smuzhiyun 		struct arp_table arp;
390*4882a593Smuzhiyun 		int ifindex;
391*4882a593Smuzhiyun 		__be64 mac;
392*4882a593Smuzhiyun 	} direct_entry;
393*4882a593Smuzhiyun 
394*4882a593Smuzhiyun 	if (nh->nlmsg_type == RTM_GETNEIGH)
395*4882a593Smuzhiyun 		printf("READING arp entry\n");
396*4882a593Smuzhiyun 	printf("Address\tHwAddress\n");
397*4882a593Smuzhiyun 	for (; NLMSG_OK(nh, nll); nh = NLMSG_NEXT(nh, nll)) {
398*4882a593Smuzhiyun 		rt_msg = (struct ndmsg *)NLMSG_DATA(nh);
399*4882a593Smuzhiyun 		rt_attr = (struct rtattr *)RTM_RTA(rt_msg);
400*4882a593Smuzhiyun 		ndm_family = rt_msg->ndm_family;
401*4882a593Smuzhiyun 		rtl = RTM_PAYLOAD(nh);
402*4882a593Smuzhiyun 		for (; RTA_OK(rt_attr, rtl); rt_attr = RTA_NEXT(rt_attr, rtl)) {
403*4882a593Smuzhiyun 			switch (rt_attr->rta_type) {
404*4882a593Smuzhiyun 			case NDA_DST:
405*4882a593Smuzhiyun 				sprintf(dsts, "%u",
406*4882a593Smuzhiyun 					*((__be32 *)RTA_DATA(rt_attr)));
407*4882a593Smuzhiyun 				break;
408*4882a593Smuzhiyun 			case NDA_LLADDR:
409*4882a593Smuzhiyun 				sprintf(mac, "%lld",
410*4882a593Smuzhiyun 					*((__be64 *)RTA_DATA(rt_attr)));
411*4882a593Smuzhiyun 				break;
412*4882a593Smuzhiyun 			default:
413*4882a593Smuzhiyun 				break;
414*4882a593Smuzhiyun 			}
415*4882a593Smuzhiyun 		}
416*4882a593Smuzhiyun 		arp_entry.dst = atoi(dsts);
417*4882a593Smuzhiyun 		arp_entry.mac = atol(mac);
418*4882a593Smuzhiyun 		printf("%x\t\t%llx\n", arp_entry.dst, arp_entry.mac);
419*4882a593Smuzhiyun 		if (ndm_family == AF_INET) {
420*4882a593Smuzhiyun 			if (bpf_map_lookup_elem(exact_match_map_fd,
421*4882a593Smuzhiyun 						&arp_entry.dst,
422*4882a593Smuzhiyun 						&direct_entry) == 0) {
423*4882a593Smuzhiyun 				if (nh->nlmsg_type == RTM_DELNEIGH) {
424*4882a593Smuzhiyun 					direct_entry.arp.dst = 0;
425*4882a593Smuzhiyun 					direct_entry.arp.mac = 0;
426*4882a593Smuzhiyun 				} else if (nh->nlmsg_type == RTM_NEWNEIGH) {
427*4882a593Smuzhiyun 					direct_entry.arp.dst = arp_entry.dst;
428*4882a593Smuzhiyun 					direct_entry.arp.mac = arp_entry.mac;
429*4882a593Smuzhiyun 				}
430*4882a593Smuzhiyun 				assert(bpf_map_update_elem(exact_match_map_fd,
431*4882a593Smuzhiyun 							   &arp_entry.dst,
432*4882a593Smuzhiyun 							   &direct_entry, 0
433*4882a593Smuzhiyun 							   ) == 0);
434*4882a593Smuzhiyun 				memset(&direct_entry, 0, sizeof(direct_entry));
435*4882a593Smuzhiyun 			}
436*4882a593Smuzhiyun 			if (nh->nlmsg_type == RTM_DELNEIGH) {
437*4882a593Smuzhiyun 				assert(bpf_map_delete_elem(arp_table_map_fd,
438*4882a593Smuzhiyun 							   &arp_entry.dst) == 0);
439*4882a593Smuzhiyun 			} else if (nh->nlmsg_type == RTM_NEWNEIGH) {
440*4882a593Smuzhiyun 				assert(bpf_map_update_elem(arp_table_map_fd,
441*4882a593Smuzhiyun 							   &arp_entry.dst,
442*4882a593Smuzhiyun 							   &arp_entry.mac, 0
443*4882a593Smuzhiyun 							   ) == 0);
444*4882a593Smuzhiyun 			}
445*4882a593Smuzhiyun 		}
446*4882a593Smuzhiyun 		memset(&arp_entry, 0, sizeof(arp_entry));
447*4882a593Smuzhiyun 		memset(dsts, 0, sizeof(dsts));
448*4882a593Smuzhiyun 	}
449*4882a593Smuzhiyun }
450*4882a593Smuzhiyun 
451*4882a593Smuzhiyun /* Function to read the existing arp table  when the process is launched*/
get_arp_table(int rtm_family)452*4882a593Smuzhiyun static int get_arp_table(int rtm_family)
453*4882a593Smuzhiyun {
454*4882a593Smuzhiyun 	struct sockaddr_nl sa;
455*4882a593Smuzhiyun 	struct nlmsghdr *nh;
456*4882a593Smuzhiyun 	int sock, seq = 0;
457*4882a593Smuzhiyun 	struct msghdr msg;
458*4882a593Smuzhiyun 	struct iovec iov;
459*4882a593Smuzhiyun 	int ret = 0;
460*4882a593Smuzhiyun 	int nll;
461*4882a593Smuzhiyun 	struct {
462*4882a593Smuzhiyun 		struct nlmsghdr nl;
463*4882a593Smuzhiyun 		struct ndmsg rt;
464*4882a593Smuzhiyun 		char buf[8192];
465*4882a593Smuzhiyun 	} req;
466*4882a593Smuzhiyun 
467*4882a593Smuzhiyun 	sock = socket(AF_NETLINK, SOCK_RAW, NETLINK_ROUTE);
468*4882a593Smuzhiyun 	if (sock < 0) {
469*4882a593Smuzhiyun 		printf("open netlink socket: %s\n", strerror(errno));
470*4882a593Smuzhiyun 		return -1;
471*4882a593Smuzhiyun 	}
472*4882a593Smuzhiyun 	memset(&sa, 0, sizeof(sa));
473*4882a593Smuzhiyun 	sa.nl_family = AF_NETLINK;
474*4882a593Smuzhiyun 	if (bind(sock, (struct sockaddr *)&sa, sizeof(sa)) < 0) {
475*4882a593Smuzhiyun 		printf("bind to netlink: %s\n", strerror(errno));
476*4882a593Smuzhiyun 		ret = -1;
477*4882a593Smuzhiyun 		goto cleanup;
478*4882a593Smuzhiyun 	}
479*4882a593Smuzhiyun 	memset(&req, 0, sizeof(req));
480*4882a593Smuzhiyun 	req.nl.nlmsg_len = NLMSG_LENGTH(sizeof(struct rtmsg));
481*4882a593Smuzhiyun 	req.nl.nlmsg_flags = NLM_F_REQUEST | NLM_F_DUMP;
482*4882a593Smuzhiyun 	req.nl.nlmsg_type = RTM_GETNEIGH;
483*4882a593Smuzhiyun 	req.rt.ndm_state = NUD_REACHABLE;
484*4882a593Smuzhiyun 	req.rt.ndm_family = rtm_family;
485*4882a593Smuzhiyun 	req.nl.nlmsg_pid = 0;
486*4882a593Smuzhiyun 	req.nl.nlmsg_seq = ++seq;
487*4882a593Smuzhiyun 	memset(&msg, 0, sizeof(msg));
488*4882a593Smuzhiyun 	iov.iov_base = (void *)&req.nl;
489*4882a593Smuzhiyun 	iov.iov_len = req.nl.nlmsg_len;
490*4882a593Smuzhiyun 	msg.msg_iov = &iov;
491*4882a593Smuzhiyun 	msg.msg_iovlen = 1;
492*4882a593Smuzhiyun 	ret = sendmsg(sock, &msg, 0);
493*4882a593Smuzhiyun 	if (ret < 0) {
494*4882a593Smuzhiyun 		printf("send to netlink: %s\n", strerror(errno));
495*4882a593Smuzhiyun 		ret = -1;
496*4882a593Smuzhiyun 		goto cleanup;
497*4882a593Smuzhiyun 	}
498*4882a593Smuzhiyun 	memset(buf, 0, sizeof(buf));
499*4882a593Smuzhiyun 	nll = recv_msg(sa, sock);
500*4882a593Smuzhiyun 	if (nll < 0) {
501*4882a593Smuzhiyun 		printf("recv from netlink: %s\n", strerror(nll));
502*4882a593Smuzhiyun 		ret = -1;
503*4882a593Smuzhiyun 		goto cleanup;
504*4882a593Smuzhiyun 	}
505*4882a593Smuzhiyun 	nh = (struct nlmsghdr *)buf;
506*4882a593Smuzhiyun 	read_arp(nh, nll);
507*4882a593Smuzhiyun cleanup:
508*4882a593Smuzhiyun 	close(sock);
509*4882a593Smuzhiyun 	return ret;
510*4882a593Smuzhiyun }
511*4882a593Smuzhiyun 
512*4882a593Smuzhiyun /* Function to keep track and update changes in route and arp table
513*4882a593Smuzhiyun  * Give regular statistics of packets forwarded
514*4882a593Smuzhiyun  */
monitor_route(void)515*4882a593Smuzhiyun static int monitor_route(void)
516*4882a593Smuzhiyun {
517*4882a593Smuzhiyun 	unsigned int nr_cpus = bpf_num_possible_cpus();
518*4882a593Smuzhiyun 	const unsigned int nr_keys = 256;
519*4882a593Smuzhiyun 	struct pollfd fds_route, fds_arp;
520*4882a593Smuzhiyun 	__u64 prev[nr_keys][nr_cpus];
521*4882a593Smuzhiyun 	struct sockaddr_nl la, lr;
522*4882a593Smuzhiyun 	__u64 values[nr_cpus];
523*4882a593Smuzhiyun 	struct nlmsghdr *nh;
524*4882a593Smuzhiyun 	int nll, ret = 0;
525*4882a593Smuzhiyun 	int interval = 5;
526*4882a593Smuzhiyun 	__u32 key;
527*4882a593Smuzhiyun 	int i;
528*4882a593Smuzhiyun 
529*4882a593Smuzhiyun 	sock = socket(AF_NETLINK, SOCK_RAW, NETLINK_ROUTE);
530*4882a593Smuzhiyun 	if (sock < 0) {
531*4882a593Smuzhiyun 		printf("open netlink socket: %s\n", strerror(errno));
532*4882a593Smuzhiyun 		return -1;
533*4882a593Smuzhiyun 	}
534*4882a593Smuzhiyun 
535*4882a593Smuzhiyun 	fcntl(sock, F_SETFL, O_NONBLOCK);
536*4882a593Smuzhiyun 	memset(&lr, 0, sizeof(lr));
537*4882a593Smuzhiyun 	lr.nl_family = AF_NETLINK;
538*4882a593Smuzhiyun 	lr.nl_groups = RTMGRP_IPV6_ROUTE | RTMGRP_IPV4_ROUTE | RTMGRP_NOTIFY;
539*4882a593Smuzhiyun 	if (bind(sock, (struct sockaddr *)&lr, sizeof(lr)) < 0) {
540*4882a593Smuzhiyun 		printf("bind to netlink: %s\n", strerror(errno));
541*4882a593Smuzhiyun 		ret = -1;
542*4882a593Smuzhiyun 		goto cleanup;
543*4882a593Smuzhiyun 	}
544*4882a593Smuzhiyun 	fds_route.fd = sock;
545*4882a593Smuzhiyun 	fds_route.events = POLL_IN;
546*4882a593Smuzhiyun 
547*4882a593Smuzhiyun 	sock_arp = socket(AF_NETLINK, SOCK_RAW, NETLINK_ROUTE);
548*4882a593Smuzhiyun 	if (sock_arp < 0) {
549*4882a593Smuzhiyun 		printf("open netlink socket: %s\n", strerror(errno));
550*4882a593Smuzhiyun 		return -1;
551*4882a593Smuzhiyun 	}
552*4882a593Smuzhiyun 
553*4882a593Smuzhiyun 	fcntl(sock_arp, F_SETFL, O_NONBLOCK);
554*4882a593Smuzhiyun 	memset(&la, 0, sizeof(la));
555*4882a593Smuzhiyun 	la.nl_family = AF_NETLINK;
556*4882a593Smuzhiyun 	la.nl_groups = RTMGRP_NEIGH | RTMGRP_NOTIFY;
557*4882a593Smuzhiyun 	if (bind(sock_arp, (struct sockaddr *)&la, sizeof(la)) < 0) {
558*4882a593Smuzhiyun 		printf("bind to netlink: %s\n", strerror(errno));
559*4882a593Smuzhiyun 		ret = -1;
560*4882a593Smuzhiyun 		goto cleanup;
561*4882a593Smuzhiyun 	}
562*4882a593Smuzhiyun 	fds_arp.fd = sock_arp;
563*4882a593Smuzhiyun 	fds_arp.events = POLL_IN;
564*4882a593Smuzhiyun 
565*4882a593Smuzhiyun 	memset(prev, 0, sizeof(prev));
566*4882a593Smuzhiyun 	do {
567*4882a593Smuzhiyun 		signal(SIGINT, close_and_exit);
568*4882a593Smuzhiyun 		signal(SIGTERM, close_and_exit);
569*4882a593Smuzhiyun 
570*4882a593Smuzhiyun 		sleep(interval);
571*4882a593Smuzhiyun 		for (key = 0; key < nr_keys; key++) {
572*4882a593Smuzhiyun 			__u64 sum = 0;
573*4882a593Smuzhiyun 
574*4882a593Smuzhiyun 			assert(bpf_map_lookup_elem(rxcnt_map_fd,
575*4882a593Smuzhiyun 						   &key, values) == 0);
576*4882a593Smuzhiyun 			for (i = 0; i < nr_cpus; i++)
577*4882a593Smuzhiyun 				sum += (values[i] - prev[key][i]);
578*4882a593Smuzhiyun 			if (sum)
579*4882a593Smuzhiyun 				printf("proto %u: %10llu pkt/s\n",
580*4882a593Smuzhiyun 				       key, sum / interval);
581*4882a593Smuzhiyun 			memcpy(prev[key], values, sizeof(values));
582*4882a593Smuzhiyun 		}
583*4882a593Smuzhiyun 
584*4882a593Smuzhiyun 		memset(buf, 0, sizeof(buf));
585*4882a593Smuzhiyun 		if (poll(&fds_route, 1, 3) == POLL_IN) {
586*4882a593Smuzhiyun 			nll = recv_msg(lr, sock);
587*4882a593Smuzhiyun 			if (nll < 0) {
588*4882a593Smuzhiyun 				printf("recv from netlink: %s\n", strerror(nll));
589*4882a593Smuzhiyun 				ret = -1;
590*4882a593Smuzhiyun 				goto cleanup;
591*4882a593Smuzhiyun 			}
592*4882a593Smuzhiyun 
593*4882a593Smuzhiyun 			nh = (struct nlmsghdr *)buf;
594*4882a593Smuzhiyun 			printf("Routing table updated.\n");
595*4882a593Smuzhiyun 			read_route(nh, nll);
596*4882a593Smuzhiyun 		}
597*4882a593Smuzhiyun 		memset(buf, 0, sizeof(buf));
598*4882a593Smuzhiyun 		if (poll(&fds_arp, 1, 3) == POLL_IN) {
599*4882a593Smuzhiyun 			nll = recv_msg(la, sock_arp);
600*4882a593Smuzhiyun 			if (nll < 0) {
601*4882a593Smuzhiyun 				printf("recv from netlink: %s\n", strerror(nll));
602*4882a593Smuzhiyun 				ret = -1;
603*4882a593Smuzhiyun 				goto cleanup;
604*4882a593Smuzhiyun 			}
605*4882a593Smuzhiyun 
606*4882a593Smuzhiyun 			nh = (struct nlmsghdr *)buf;
607*4882a593Smuzhiyun 			read_arp(nh, nll);
608*4882a593Smuzhiyun 		}
609*4882a593Smuzhiyun 
610*4882a593Smuzhiyun 	} while (1);
611*4882a593Smuzhiyun cleanup:
612*4882a593Smuzhiyun 	close(sock);
613*4882a593Smuzhiyun 	return ret;
614*4882a593Smuzhiyun }
615*4882a593Smuzhiyun 
usage(const char * prog)616*4882a593Smuzhiyun static void usage(const char *prog)
617*4882a593Smuzhiyun {
618*4882a593Smuzhiyun 	fprintf(stderr,
619*4882a593Smuzhiyun 		"%s: %s [OPTS] interface name list\n\n"
620*4882a593Smuzhiyun 		"OPTS:\n"
621*4882a593Smuzhiyun 		"    -S    use skb-mode\n"
622*4882a593Smuzhiyun 		"    -F    force loading prog\n",
623*4882a593Smuzhiyun 		__func__, prog);
624*4882a593Smuzhiyun }
625*4882a593Smuzhiyun 
main(int ac,char ** argv)626*4882a593Smuzhiyun int main(int ac, char **argv)
627*4882a593Smuzhiyun {
628*4882a593Smuzhiyun 	struct rlimit r = {RLIM_INFINITY, RLIM_INFINITY};
629*4882a593Smuzhiyun 	struct bpf_prog_load_attr prog_load_attr = {
630*4882a593Smuzhiyun 		.prog_type	= BPF_PROG_TYPE_XDP,
631*4882a593Smuzhiyun 	};
632*4882a593Smuzhiyun 	struct bpf_prog_info info = {};
633*4882a593Smuzhiyun 	__u32 info_len = sizeof(info);
634*4882a593Smuzhiyun 	const char *optstr = "SF";
635*4882a593Smuzhiyun 	struct bpf_object *obj;
636*4882a593Smuzhiyun 	char filename[256];
637*4882a593Smuzhiyun 	char **ifname_list;
638*4882a593Smuzhiyun 	int prog_fd, opt;
639*4882a593Smuzhiyun 	int err, i = 1;
640*4882a593Smuzhiyun 
641*4882a593Smuzhiyun 	snprintf(filename, sizeof(filename), "%s_kern.o", argv[0]);
642*4882a593Smuzhiyun 	prog_load_attr.file = filename;
643*4882a593Smuzhiyun 
644*4882a593Smuzhiyun 	total_ifindex = ac - 1;
645*4882a593Smuzhiyun 	ifname_list = (argv + 1);
646*4882a593Smuzhiyun 
647*4882a593Smuzhiyun 	while ((opt = getopt(ac, argv, optstr)) != -1) {
648*4882a593Smuzhiyun 		switch (opt) {
649*4882a593Smuzhiyun 		case 'S':
650*4882a593Smuzhiyun 			flags |= XDP_FLAGS_SKB_MODE;
651*4882a593Smuzhiyun 			total_ifindex--;
652*4882a593Smuzhiyun 			ifname_list++;
653*4882a593Smuzhiyun 			break;
654*4882a593Smuzhiyun 		case 'F':
655*4882a593Smuzhiyun 			flags &= ~XDP_FLAGS_UPDATE_IF_NOEXIST;
656*4882a593Smuzhiyun 			total_ifindex--;
657*4882a593Smuzhiyun 			ifname_list++;
658*4882a593Smuzhiyun 			break;
659*4882a593Smuzhiyun 		default:
660*4882a593Smuzhiyun 			usage(basename(argv[0]));
661*4882a593Smuzhiyun 			return 1;
662*4882a593Smuzhiyun 		}
663*4882a593Smuzhiyun 	}
664*4882a593Smuzhiyun 
665*4882a593Smuzhiyun 	if (!(flags & XDP_FLAGS_SKB_MODE))
666*4882a593Smuzhiyun 		flags |= XDP_FLAGS_DRV_MODE;
667*4882a593Smuzhiyun 
668*4882a593Smuzhiyun 	if (optind == ac) {
669*4882a593Smuzhiyun 		usage(basename(argv[0]));
670*4882a593Smuzhiyun 		return 1;
671*4882a593Smuzhiyun 	}
672*4882a593Smuzhiyun 
673*4882a593Smuzhiyun 	if (setrlimit(RLIMIT_MEMLOCK, &r)) {
674*4882a593Smuzhiyun 		perror("setrlimit(RLIMIT_MEMLOCK)");
675*4882a593Smuzhiyun 		return 1;
676*4882a593Smuzhiyun 	}
677*4882a593Smuzhiyun 
678*4882a593Smuzhiyun 	if (bpf_prog_load_xattr(&prog_load_attr, &obj, &prog_fd))
679*4882a593Smuzhiyun 		return 1;
680*4882a593Smuzhiyun 
681*4882a593Smuzhiyun 	printf("\n**************loading bpf file*********************\n\n\n");
682*4882a593Smuzhiyun 	if (!prog_fd) {
683*4882a593Smuzhiyun 		printf("bpf_prog_load_xattr: %s\n", strerror(errno));
684*4882a593Smuzhiyun 		return 1;
685*4882a593Smuzhiyun 	}
686*4882a593Smuzhiyun 
687*4882a593Smuzhiyun 	lpm_map_fd = bpf_object__find_map_fd_by_name(obj, "lpm_map");
688*4882a593Smuzhiyun 	rxcnt_map_fd = bpf_object__find_map_fd_by_name(obj, "rxcnt");
689*4882a593Smuzhiyun 	arp_table_map_fd = bpf_object__find_map_fd_by_name(obj, "arp_table");
690*4882a593Smuzhiyun 	exact_match_map_fd = bpf_object__find_map_fd_by_name(obj,
691*4882a593Smuzhiyun 							     "exact_match");
692*4882a593Smuzhiyun 	tx_port_map_fd = bpf_object__find_map_fd_by_name(obj, "tx_port");
693*4882a593Smuzhiyun 	if (lpm_map_fd < 0 || rxcnt_map_fd < 0 || arp_table_map_fd < 0 ||
694*4882a593Smuzhiyun 	    exact_match_map_fd < 0 || tx_port_map_fd < 0) {
695*4882a593Smuzhiyun 		printf("bpf_object__find_map_fd_by_name failed\n");
696*4882a593Smuzhiyun 		return 1;
697*4882a593Smuzhiyun 	}
698*4882a593Smuzhiyun 
699*4882a593Smuzhiyun 	ifindex_list = (int *)calloc(total_ifindex, sizeof(int *));
700*4882a593Smuzhiyun 	for (i = 0; i < total_ifindex; i++) {
701*4882a593Smuzhiyun 		ifindex_list[i] = if_nametoindex(ifname_list[i]);
702*4882a593Smuzhiyun 		if (!ifindex_list[i]) {
703*4882a593Smuzhiyun 			printf("Couldn't translate interface name: %s",
704*4882a593Smuzhiyun 			       strerror(errno));
705*4882a593Smuzhiyun 			return 1;
706*4882a593Smuzhiyun 		}
707*4882a593Smuzhiyun 	}
708*4882a593Smuzhiyun 	prog_id_list = (__u32 *)calloc(total_ifindex, sizeof(__u32 *));
709*4882a593Smuzhiyun 	for (i = 0; i < total_ifindex; i++) {
710*4882a593Smuzhiyun 		if (bpf_set_link_xdp_fd(ifindex_list[i], prog_fd, flags) < 0) {
711*4882a593Smuzhiyun 			printf("link set xdp fd failed\n");
712*4882a593Smuzhiyun 			int recovery_index = i;
713*4882a593Smuzhiyun 
714*4882a593Smuzhiyun 			for (i = 0; i < recovery_index; i++)
715*4882a593Smuzhiyun 				bpf_set_link_xdp_fd(ifindex_list[i], -1, flags);
716*4882a593Smuzhiyun 
717*4882a593Smuzhiyun 			return 1;
718*4882a593Smuzhiyun 		}
719*4882a593Smuzhiyun 		err = bpf_obj_get_info_by_fd(prog_fd, &info, &info_len);
720*4882a593Smuzhiyun 		if (err) {
721*4882a593Smuzhiyun 			printf("can't get prog info - %s\n", strerror(errno));
722*4882a593Smuzhiyun 			return err;
723*4882a593Smuzhiyun 		}
724*4882a593Smuzhiyun 		prog_id_list[i] = info.id;
725*4882a593Smuzhiyun 		memset(&info, 0, sizeof(info));
726*4882a593Smuzhiyun 		printf("Attached to %d\n", ifindex_list[i]);
727*4882a593Smuzhiyun 	}
728*4882a593Smuzhiyun 	signal(SIGINT, int_exit);
729*4882a593Smuzhiyun 	signal(SIGTERM, int_exit);
730*4882a593Smuzhiyun 
731*4882a593Smuzhiyun 	printf("*******************ROUTE TABLE*************************\n\n\n");
732*4882a593Smuzhiyun 	get_route_table(AF_INET);
733*4882a593Smuzhiyun 	printf("*******************ARP TABLE***************************\n\n\n");
734*4882a593Smuzhiyun 	get_arp_table(AF_INET);
735*4882a593Smuzhiyun 	if (monitor_route() < 0) {
736*4882a593Smuzhiyun 		printf("Error in receiving route update");
737*4882a593Smuzhiyun 		return 1;
738*4882a593Smuzhiyun 	}
739*4882a593Smuzhiyun 
740*4882a593Smuzhiyun 	return 0;
741*4882a593Smuzhiyun }
742