blob: 2de59cd3f0ba608c7069589cda2cdfe30722efaa [file] [log] [blame]
Dmitry V. Levin2f6510c2014-08-21 03:17:48 +00001#include "defs.h"
2#include <netinet/in.h>
3#include <sys/socket.h>
4#include <arpa/inet.h>
5#include <linux/netlink.h>
6#include <linux/sock_diag.h>
7#include <linux/inet_diag.h>
Masatake YAMATO120e5db2014-12-24 20:59:31 +09008#include <linux/unix_diag.h>
9#include <linux/rtnetlink.h>
10
Dmitry V. Levind9f7e7a2015-01-09 03:03:39 +000011#if !defined NETLINK_SOCK_DIAG && defined NETLINK_INET_DIAG
12# define NETLINK_SOCK_DIAG NETLINK_INET_DIAG
13#endif
14
Masatake YAMATO120e5db2014-12-24 20:59:31 +090015#include <sys/un.h>
16#ifndef UNIX_PATH_MAX
17# define UNIX_PATH_MAX sizeof(((struct sockaddr_un *) 0)->sun_path)
18#endif
Dmitry V. Levin2f6510c2014-08-21 03:17:48 +000019
20static bool
Masatake YAMATO120e5db2014-12-24 20:59:31 +090021inet_send_query(const int fd, const int family, const int proto)
Dmitry V. Levin2f6510c2014-08-21 03:17:48 +000022{
Dmitry V. Levinaf534b82014-11-21 19:59:16 +000023 struct sockaddr_nl nladdr = {
24 .nl_family = AF_NETLINK
25 };
Dmitry V. Levin2f6510c2014-08-21 03:17:48 +000026 struct {
27 struct nlmsghdr nlh;
28 struct inet_diag_req_v2 idr;
Dmitry V. Levinaf534b82014-11-21 19:59:16 +000029 } req = {
30 .nlh = {
31 .nlmsg_len = sizeof(req),
32 .nlmsg_type = SOCK_DIAG_BY_FAMILY,
33 .nlmsg_flags = NLM_F_DUMP | NLM_F_REQUEST
34 },
35 .idr = {
36 .sdiag_family = family,
37 .sdiag_protocol = proto,
38 .idiag_states = -1
39 }
40 };
Dmitry V. Levin2f6510c2014-08-21 03:17:48 +000041 struct iovec iov = {
42 .iov_base = &req,
43 .iov_len = sizeof(req)
44 };
45 struct msghdr msg = {
46 .msg_name = (void*)&nladdr,
47 .msg_namelen = sizeof(nladdr),
48 .msg_iov = &iov,
49 .msg_iovlen = 1
50 };
51
Dmitry V. Levin2f6510c2014-08-21 03:17:48 +000052 for (;;) {
53 if (sendmsg(fd, &msg, 0) < 0) {
54 if (errno == EINTR)
55 continue;
56 return false;
57 }
58 return true;
59 }
60}
61
62static bool
Dmitry V. Levin959205c2014-12-26 23:29:26 +000063inet_parse_response(const char *proto_name, const void *data, int data_len,
64 const unsigned long inode)
Dmitry V. Levin2f6510c2014-08-21 03:17:48 +000065{
Masatake YAMATO120e5db2014-12-24 20:59:31 +090066 const struct inet_diag_msg *diag_msg = data;
Dmitry V. Levin2f6510c2014-08-21 03:17:48 +000067 static const char zero_addr[sizeof(struct in6_addr)];
68 socklen_t addr_size, text_size;
69
70 if (diag_msg->idiag_inode != inode)
71 return false;
72
73 switch(diag_msg->idiag_family) {
74 case AF_INET:
75 addr_size = sizeof(struct in_addr);
76 text_size = INET_ADDRSTRLEN;
77 break;
78 case AF_INET6:
79 addr_size = sizeof(struct in6_addr);
80 text_size = INET6_ADDRSTRLEN;
81 break;
82 default:
83 return false;
84 }
85
86 char src_buf[text_size];
87
88 if (!inet_ntop(diag_msg->idiag_family, diag_msg->id.idiag_src,
89 src_buf, text_size))
90 return false;
91
92 if (diag_msg->id.idiag_dport ||
93 memcmp(zero_addr, diag_msg->id.idiag_dst, addr_size)) {
94 char dst_buf[text_size];
95
96 if (!inet_ntop(diag_msg->idiag_family, diag_msg->id.idiag_dst,
97 dst_buf, text_size))
98 return false;
99
Dmitry V. Levin959205c2014-12-26 23:29:26 +0000100 tprintf("%s:[%s:%u->%s:%u]",
101 proto_name,
Dmitry V. Levin2f6510c2014-08-21 03:17:48 +0000102 src_buf, ntohs(diag_msg->id.idiag_sport),
103 dst_buf, ntohs(diag_msg->id.idiag_dport));
104 } else {
Dmitry V. Levin959205c2014-12-26 23:29:26 +0000105 tprintf("%s:[%s:%u]", proto_name, src_buf,
106 ntohs(diag_msg->id.idiag_sport));
Dmitry V. Levin2f6510c2014-08-21 03:17:48 +0000107 }
108
109 return true;
110}
111
112static bool
Masatake YAMATO120e5db2014-12-24 20:59:31 +0900113receive_responses(const int fd, const unsigned long inode,
Dmitry V. Levin959205c2014-12-26 23:29:26 +0000114 const char *proto_name,
115 bool (* parser) (const char *, const void *, int, const unsigned long))
Dmitry V. Levin2f6510c2014-08-21 03:17:48 +0000116{
117 static char buf[8192];
Dmitry V. Levinaf534b82014-11-21 19:59:16 +0000118 struct sockaddr_nl nladdr = {
119 .nl_family = AF_NETLINK
120 };
Dmitry V. Levin2f6510c2014-08-21 03:17:48 +0000121 struct iovec iov = {
122 .iov_base = buf,
123 .iov_len = sizeof(buf)
124 };
125
Dmitry V. Levin2f6510c2014-08-21 03:17:48 +0000126 for (;;) {
127 ssize_t ret;
128 struct nlmsghdr *h;
129 struct msghdr msg = {
130 .msg_name = (void*)&nladdr,
131 .msg_namelen = sizeof(nladdr),
132 .msg_iov = &iov,
Dmitry V. Levinaf534b82014-11-21 19:59:16 +0000133 .msg_iovlen = 1
Dmitry V. Levin2f6510c2014-08-21 03:17:48 +0000134 };
135
136 ret = recvmsg(fd, &msg, 0);
137 if (ret < 0) {
138 if (errno == EINTR)
139 continue;
140 return false;
141 }
142 if (!ret)
143 return false;
144 for (h = (struct nlmsghdr*)buf;
145 NLMSG_OK(h, ret);
146 h = NLMSG_NEXT(h, ret)) {
147 switch (h->nlmsg_type) {
148 case NLMSG_DONE:
149 case NLMSG_ERROR:
150 return false;
151 }
Dmitry V. Levin959205c2014-12-26 23:29:26 +0000152 if (parser(proto_name, NLMSG_DATA(h), h->nlmsg_len, inode))
Dmitry V. Levin2f6510c2014-08-21 03:17:48 +0000153 return true;
154 }
155 }
156}
157
Masatake YAMATOf605e922014-12-10 12:55:06 +0900158static bool
Dmitry V. Levin959205c2014-12-26 23:29:26 +0000159inet_print(const int fd, const int family, const int protocol,
160 const unsigned long inode, const char *proto_name)
Masatake YAMATOf605e922014-12-10 12:55:06 +0900161{
Masatake YAMATO120e5db2014-12-24 20:59:31 +0900162 return inet_send_query(fd, family, protocol)
Dmitry V. Levin959205c2014-12-26 23:29:26 +0000163 && receive_responses(fd, inode, proto_name, inet_parse_response);
Masatake YAMATO120e5db2014-12-24 20:59:31 +0900164}
165
166static bool
167unix_send_query(const int fd, const unsigned long inode)
168{
169 struct sockaddr_nl nladdr = {
170 .nl_family = AF_NETLINK
171 };
172 struct {
173 struct nlmsghdr nlh;
174 struct unix_diag_req udr;
175 } req = {
176 .nlh = {
177 .nlmsg_len = sizeof(req),
178 .nlmsg_type = SOCK_DIAG_BY_FAMILY,
179 .nlmsg_flags = NLM_F_DUMP | NLM_F_REQUEST
180 },
181 .udr = {
182 .sdiag_family = AF_UNIX,
183 .udiag_ino = inode,
184 .udiag_states = -1,
185 .udiag_show = UDIAG_SHOW_NAME | UDIAG_SHOW_PEER
186 }
187 };
188 struct iovec iov = {
189 .iov_base = &req,
190 .iov_len = sizeof(req)
191 };
192 struct msghdr msg = {
193 .msg_name = (void*)&nladdr,
194 .msg_namelen = sizeof(nladdr),
195 .msg_iov = &iov,
196 .msg_iovlen = 1
197 };
198
199 for (;;) {
200 if (sendmsg(fd, &msg, 0) < 0) {
201 if (errno == EINTR)
202 continue;
203 return false;
204 }
205 return true;
206 }
207}
208
209static bool
Dmitry V. Levin959205c2014-12-26 23:29:26 +0000210unix_parse_response(const char *proto_name, const void *data, int data_len,
211 const unsigned long inode)
Masatake YAMATO120e5db2014-12-24 20:59:31 +0900212{
213 const struct unix_diag_msg *diag_msg = data;
214 struct rtattr *attr;
215 int rta_len = data_len - NLMSG_LENGTH(sizeof(*diag_msg));
216 uint32_t peer = 0;
217 size_t path_len = 0;
218 char path[UNIX_PATH_MAX + 1];
219
220 if (diag_msg->udiag_ino != inode)
221 return false;
222 if (diag_msg->udiag_family != AF_UNIX)
223 return false;
224
225 for (attr = (struct rtattr *) (diag_msg + 1);
226 RTA_OK(attr, rta_len);
227 attr = RTA_NEXT(attr, rta_len)) {
228 switch (attr->rta_type) {
229 case UNIX_DIAG_NAME:
230 if (!path_len) {
231 path_len = RTA_PAYLOAD(attr);
232 if (path_len > UNIX_PATH_MAX)
233 path_len = UNIX_PATH_MAX;
234 memcpy(path, RTA_DATA(attr), path_len);
235 path[path_len] = '\0';
236 }
237 break;
238 case UNIX_DIAG_PEER:
239 if (RTA_PAYLOAD(attr) >= 4)
240 peer = *(uint32_t *)RTA_DATA(attr);
241 break;
242 }
243 }
244
245 /*
246 * print obtained information in the following format:
247 * "UNIX:[" SELF_INODE [ "->" PEER_INODE ][ "," SOCKET_FILE ] "]"
248 */
249 if (peer || path_len) {
Dmitry V. Levin959205c2014-12-26 23:29:26 +0000250 tprintf("%s:[%lu", proto_name, inode);
Masatake YAMATO120e5db2014-12-24 20:59:31 +0900251 if (peer)
252 tprintf("->%u", peer);
253 if (path_len) {
254 if (path[0] == '\0') {
Dmitry V. Levin513e96e2015-01-26 01:17:08 +0000255 tprints(",@");
256 print_quoted_string(path + 1, path_len,
257 QUOTE_0_TERMINATED);
Masatake YAMATO120e5db2014-12-24 20:59:31 +0900258 } else {
Dmitry V. Levin513e96e2015-01-26 01:17:08 +0000259 tprints(",");
260 print_quoted_string(path, path_len + 1,
261 QUOTE_0_TERMINATED);
Masatake YAMATO120e5db2014-12-24 20:59:31 +0900262 }
263 }
264 tprints("]");
265 return true;
266 }
267 else
268 return false;
269}
270
271static bool
272unix_print(int fd, const unsigned long inode)
273{
274 return unix_send_query(fd, inode)
Dmitry V. Levin959205c2014-12-26 23:29:26 +0000275 && receive_responses(fd, inode, "UNIX", unix_parse_response);
Masatake YAMATOf605e922014-12-10 12:55:06 +0900276}
277
Dmitry V. Levin2f6510c2014-08-21 03:17:48 +0000278/* Given an inode number of a socket, print out the details
279 * of the ip address and port. */
280bool
Masatake YAMATOf605e922014-12-10 12:55:06 +0900281print_sockaddr_by_inode(const unsigned long inode, const char *proto_name)
Dmitry V. Levin2f6510c2014-08-21 03:17:48 +0000282{
Dmitry V. Levin2f6510c2014-08-21 03:17:48 +0000283 int fd;
Masatake YAMATOf605e922014-12-10 12:55:06 +0900284 bool r = false;
Dmitry V. Levin2f6510c2014-08-21 03:17:48 +0000285
Masatake YAMATO120e5db2014-12-24 20:59:31 +0900286 fd = socket(AF_NETLINK, SOCK_RAW, NETLINK_SOCK_DIAG);
Dmitry V. Levin2f6510c2014-08-21 03:17:48 +0000287 if (fd < 0)
288 return false;
289
Masatake YAMATOf605e922014-12-10 12:55:06 +0900290 if (proto_name) {
291 if (strcmp(proto_name, "TCP") == 0)
Dmitry V. Levin959205c2014-12-26 23:29:26 +0000292 r = inet_print(fd, AF_INET, IPPROTO_TCP, inode, "TCP");
Masatake YAMATOf605e922014-12-10 12:55:06 +0900293 else if (strcmp(proto_name, "UDP") == 0)
Dmitry V. Levin959205c2014-12-26 23:29:26 +0000294 r = inet_print(fd, AF_INET, IPPROTO_UDP, inode, "UDP");
Masatake YAMATOf605e922014-12-10 12:55:06 +0900295 else if (strcmp(proto_name, "TCPv6") == 0)
Dmitry V. Levin959205c2014-12-26 23:29:26 +0000296 r = inet_print(fd, AF_INET6, IPPROTO_TCP, inode, "TCPv6");
Masatake YAMATOf605e922014-12-10 12:55:06 +0900297 else if (strcmp(proto_name, "UDPv6") == 0)
Dmitry V. Levin959205c2014-12-26 23:29:26 +0000298 r = inet_print(fd, AF_INET6, IPPROTO_UDP, inode, "UDPv6");
Masatake YAMATO120e5db2014-12-24 20:59:31 +0900299 else if (strcmp(proto_name, "UNIX") == 0)
300 r = unix_print(fd, inode);
Masatake YAMATOf605e922014-12-10 12:55:06 +0900301 } else {
Dmitry V. Levin959205c2014-12-26 23:29:26 +0000302 const struct {
303 const int family;
304 const int protocol;
305 const char *name;
306 } protocols[] = {
307 { AF_INET, IPPROTO_TCP, "TCP" },
308 { AF_INET, IPPROTO_UDP, "UDP" },
309 { AF_INET6, IPPROTO_TCP, "TCPv6" },
310 { AF_INET6, IPPROTO_UDP, "UDPv6" }
311 };
312 size_t i;
Masatake YAMATOf605e922014-12-10 12:55:06 +0900313
Dmitry V. Levin959205c2014-12-26 23:29:26 +0000314 for (i = 0; i < ARRAY_SIZE(protocols); ++i) {
315 if ((r = inet_print(fd, protocols[i].family,
316 protocols[i].protocol, inode,
317 protocols[i].name)))
318 break;
Dmitry V. Levin2f6510c2014-08-21 03:17:48 +0000319 }
320 }
Dmitry V. Levin959205c2014-12-26 23:29:26 +0000321
Dmitry V. Levin2f6510c2014-08-21 03:17:48 +0000322 close(fd);
Masatake YAMATOf605e922014-12-10 12:55:06 +0900323 return r;
Dmitry V. Levin2f6510c2014-08-21 03:17:48 +0000324}