diag.c 14 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. /* SCTP kernel implementation
  3. * (C) Copyright Red Hat Inc. 2017
  4. *
  5. * This file is part of the SCTP kernel implementation
  6. *
  7. * These functions implement sctp diag support.
  8. *
  9. * Please send any bug reports or fixes you make to the
  10. * email addresched(es):
  11. * lksctp developers <[email protected]>
  12. *
  13. * Written or modified by:
  14. * Xin Long <[email protected]>
  15. */
  16. #include <linux/module.h>
  17. #include <linux/inet_diag.h>
  18. #include <linux/sock_diag.h>
  19. #include <net/sctp/sctp.h>
  20. static void sctp_diag_get_info(struct sock *sk, struct inet_diag_msg *r,
  21. void *info);
  22. /* define some functions to make asoc/ep fill look clean */
  23. static void inet_diag_msg_sctpasoc_fill(struct inet_diag_msg *r,
  24. struct sock *sk,
  25. struct sctp_association *asoc)
  26. {
  27. union sctp_addr laddr, paddr;
  28. struct dst_entry *dst;
  29. struct timer_list *t3_rtx = &asoc->peer.primary_path->T3_rtx_timer;
  30. laddr = list_entry(asoc->base.bind_addr.address_list.next,
  31. struct sctp_sockaddr_entry, list)->a;
  32. paddr = asoc->peer.primary_path->ipaddr;
  33. dst = asoc->peer.primary_path->dst;
  34. r->idiag_family = sk->sk_family;
  35. r->id.idiag_sport = htons(asoc->base.bind_addr.port);
  36. r->id.idiag_dport = htons(asoc->peer.port);
  37. r->id.idiag_if = dst ? dst->dev->ifindex : 0;
  38. sock_diag_save_cookie(sk, r->id.idiag_cookie);
  39. #if IS_ENABLED(CONFIG_IPV6)
  40. if (sk->sk_family == AF_INET6) {
  41. *(struct in6_addr *)r->id.idiag_src = laddr.v6.sin6_addr;
  42. *(struct in6_addr *)r->id.idiag_dst = paddr.v6.sin6_addr;
  43. } else
  44. #endif
  45. {
  46. memset(&r->id.idiag_src, 0, sizeof(r->id.idiag_src));
  47. memset(&r->id.idiag_dst, 0, sizeof(r->id.idiag_dst));
  48. r->id.idiag_src[0] = laddr.v4.sin_addr.s_addr;
  49. r->id.idiag_dst[0] = paddr.v4.sin_addr.s_addr;
  50. }
  51. r->idiag_state = asoc->state;
  52. if (timer_pending(t3_rtx)) {
  53. r->idiag_timer = SCTP_EVENT_TIMEOUT_T3_RTX;
  54. r->idiag_retrans = asoc->rtx_data_chunks;
  55. r->idiag_expires = jiffies_to_msecs(t3_rtx->expires - jiffies);
  56. }
  57. }
  58. static int inet_diag_msg_sctpladdrs_fill(struct sk_buff *skb,
  59. struct list_head *address_list)
  60. {
  61. struct sctp_sockaddr_entry *laddr;
  62. int addrlen = sizeof(struct sockaddr_storage);
  63. int addrcnt = 0;
  64. struct nlattr *attr;
  65. void *info = NULL;
  66. list_for_each_entry_rcu(laddr, address_list, list)
  67. addrcnt++;
  68. attr = nla_reserve(skb, INET_DIAG_LOCALS, addrlen * addrcnt);
  69. if (!attr)
  70. return -EMSGSIZE;
  71. info = nla_data(attr);
  72. list_for_each_entry_rcu(laddr, address_list, list) {
  73. memcpy(info, &laddr->a, sizeof(laddr->a));
  74. memset(info + sizeof(laddr->a), 0, addrlen - sizeof(laddr->a));
  75. info += addrlen;
  76. }
  77. return 0;
  78. }
  79. static int inet_diag_msg_sctpaddrs_fill(struct sk_buff *skb,
  80. struct sctp_association *asoc)
  81. {
  82. int addrlen = sizeof(struct sockaddr_storage);
  83. struct sctp_transport *from;
  84. struct nlattr *attr;
  85. void *info = NULL;
  86. attr = nla_reserve(skb, INET_DIAG_PEERS,
  87. addrlen * asoc->peer.transport_count);
  88. if (!attr)
  89. return -EMSGSIZE;
  90. info = nla_data(attr);
  91. list_for_each_entry(from, &asoc->peer.transport_addr_list,
  92. transports) {
  93. memcpy(info, &from->ipaddr, sizeof(from->ipaddr));
  94. memset(info + sizeof(from->ipaddr), 0,
  95. addrlen - sizeof(from->ipaddr));
  96. info += addrlen;
  97. }
  98. return 0;
  99. }
  100. /* sctp asoc/ep fill*/
  101. static int inet_sctp_diag_fill(struct sock *sk, struct sctp_association *asoc,
  102. struct sk_buff *skb,
  103. const struct inet_diag_req_v2 *req,
  104. struct user_namespace *user_ns,
  105. int portid, u32 seq, u16 nlmsg_flags,
  106. const struct nlmsghdr *unlh,
  107. bool net_admin)
  108. {
  109. struct sctp_endpoint *ep = sctp_sk(sk)->ep;
  110. struct list_head *addr_list;
  111. struct inet_diag_msg *r;
  112. struct nlmsghdr *nlh;
  113. int ext = req->idiag_ext;
  114. struct sctp_infox infox;
  115. void *info = NULL;
  116. nlh = nlmsg_put(skb, portid, seq, unlh->nlmsg_type, sizeof(*r),
  117. nlmsg_flags);
  118. if (!nlh)
  119. return -EMSGSIZE;
  120. r = nlmsg_data(nlh);
  121. BUG_ON(!sk_fullsock(sk));
  122. r->idiag_timer = 0;
  123. r->idiag_retrans = 0;
  124. r->idiag_expires = 0;
  125. if (asoc) {
  126. inet_diag_msg_sctpasoc_fill(r, sk, asoc);
  127. } else {
  128. inet_diag_msg_common_fill(r, sk);
  129. r->idiag_state = sk->sk_state;
  130. }
  131. if (inet_diag_msg_attrs_fill(sk, skb, r, ext, user_ns, net_admin))
  132. goto errout;
  133. if (ext & (1 << (INET_DIAG_SKMEMINFO - 1))) {
  134. u32 mem[SK_MEMINFO_VARS];
  135. int amt;
  136. if (asoc && asoc->ep->sndbuf_policy)
  137. amt = asoc->sndbuf_used;
  138. else
  139. amt = sk_wmem_alloc_get(sk);
  140. mem[SK_MEMINFO_WMEM_ALLOC] = amt;
  141. if (asoc && asoc->ep->rcvbuf_policy)
  142. amt = atomic_read(&asoc->rmem_alloc);
  143. else
  144. amt = sk_rmem_alloc_get(sk);
  145. mem[SK_MEMINFO_RMEM_ALLOC] = amt;
  146. mem[SK_MEMINFO_RCVBUF] = sk->sk_rcvbuf;
  147. mem[SK_MEMINFO_SNDBUF] = sk->sk_sndbuf;
  148. mem[SK_MEMINFO_FWD_ALLOC] = sk->sk_forward_alloc;
  149. mem[SK_MEMINFO_WMEM_QUEUED] = sk->sk_wmem_queued;
  150. mem[SK_MEMINFO_OPTMEM] = atomic_read(&sk->sk_omem_alloc);
  151. mem[SK_MEMINFO_BACKLOG] = READ_ONCE(sk->sk_backlog.len);
  152. mem[SK_MEMINFO_DROPS] = atomic_read(&sk->sk_drops);
  153. if (nla_put(skb, INET_DIAG_SKMEMINFO, sizeof(mem), &mem) < 0)
  154. goto errout;
  155. }
  156. if (ext & (1 << (INET_DIAG_INFO - 1))) {
  157. struct nlattr *attr;
  158. attr = nla_reserve_64bit(skb, INET_DIAG_INFO,
  159. sizeof(struct sctp_info),
  160. INET_DIAG_PAD);
  161. if (!attr)
  162. goto errout;
  163. info = nla_data(attr);
  164. }
  165. infox.sctpinfo = (struct sctp_info *)info;
  166. infox.asoc = asoc;
  167. sctp_diag_get_info(sk, r, &infox);
  168. addr_list = asoc ? &asoc->base.bind_addr.address_list
  169. : &ep->base.bind_addr.address_list;
  170. if (inet_diag_msg_sctpladdrs_fill(skb, addr_list))
  171. goto errout;
  172. if (asoc && (ext & (1 << (INET_DIAG_CONG - 1))))
  173. if (nla_put_string(skb, INET_DIAG_CONG, "reno") < 0)
  174. goto errout;
  175. if (asoc && inet_diag_msg_sctpaddrs_fill(skb, asoc))
  176. goto errout;
  177. nlmsg_end(skb, nlh);
  178. return 0;
  179. errout:
  180. nlmsg_cancel(skb, nlh);
  181. return -EMSGSIZE;
  182. }
  183. /* callback and param */
  184. struct sctp_comm_param {
  185. struct sk_buff *skb;
  186. struct netlink_callback *cb;
  187. const struct inet_diag_req_v2 *r;
  188. const struct nlmsghdr *nlh;
  189. bool net_admin;
  190. };
  191. static size_t inet_assoc_attr_size(struct sctp_association *asoc)
  192. {
  193. int addrlen = sizeof(struct sockaddr_storage);
  194. int addrcnt = 0;
  195. struct sctp_sockaddr_entry *laddr;
  196. list_for_each_entry_rcu(laddr, &asoc->base.bind_addr.address_list,
  197. list)
  198. addrcnt++;
  199. return nla_total_size(sizeof(struct sctp_info))
  200. + nla_total_size(addrlen * asoc->peer.transport_count)
  201. + nla_total_size(addrlen * addrcnt)
  202. + nla_total_size(sizeof(struct inet_diag_msg))
  203. + inet_diag_msg_attrs_size()
  204. + nla_total_size(sizeof(struct inet_diag_meminfo))
  205. + 64;
  206. }
  207. static int sctp_sock_dump_one(struct sctp_endpoint *ep, struct sctp_transport *tsp, void *p)
  208. {
  209. struct sctp_association *assoc = tsp->asoc;
  210. struct sctp_comm_param *commp = p;
  211. struct sock *sk = ep->base.sk;
  212. const struct inet_diag_req_v2 *req = commp->r;
  213. struct sk_buff *skb = commp->skb;
  214. struct sk_buff *rep;
  215. int err;
  216. err = sock_diag_check_cookie(sk, req->id.idiag_cookie);
  217. if (err)
  218. return err;
  219. rep = nlmsg_new(inet_assoc_attr_size(assoc), GFP_KERNEL);
  220. if (!rep)
  221. return -ENOMEM;
  222. lock_sock(sk);
  223. if (ep != assoc->ep) {
  224. err = -EAGAIN;
  225. goto out;
  226. }
  227. err = inet_sctp_diag_fill(sk, assoc, rep, req, sk_user_ns(NETLINK_CB(skb).sk),
  228. NETLINK_CB(skb).portid, commp->nlh->nlmsg_seq, 0,
  229. commp->nlh, commp->net_admin);
  230. if (err < 0) {
  231. WARN_ON(err == -EMSGSIZE);
  232. goto out;
  233. }
  234. release_sock(sk);
  235. return nlmsg_unicast(sock_net(skb->sk)->diag_nlsk, rep, NETLINK_CB(skb).portid);
  236. out:
  237. release_sock(sk);
  238. kfree_skb(rep);
  239. return err;
  240. }
  241. static int sctp_sock_dump(struct sctp_endpoint *ep, struct sctp_transport *tsp, void *p)
  242. {
  243. struct sctp_comm_param *commp = p;
  244. struct sock *sk = ep->base.sk;
  245. struct sk_buff *skb = commp->skb;
  246. struct netlink_callback *cb = commp->cb;
  247. const struct inet_diag_req_v2 *r = commp->r;
  248. struct sctp_association *assoc;
  249. int err = 0;
  250. lock_sock(sk);
  251. if (ep != tsp->asoc->ep)
  252. goto release;
  253. list_for_each_entry(assoc, &ep->asocs, asocs) {
  254. if (cb->args[4] < cb->args[1])
  255. goto next;
  256. if (r->id.idiag_sport != htons(assoc->base.bind_addr.port) &&
  257. r->id.idiag_sport)
  258. goto next;
  259. if (r->id.idiag_dport != htons(assoc->peer.port) &&
  260. r->id.idiag_dport)
  261. goto next;
  262. if (!cb->args[3] &&
  263. inet_sctp_diag_fill(sk, NULL, skb, r,
  264. sk_user_ns(NETLINK_CB(cb->skb).sk),
  265. NETLINK_CB(cb->skb).portid,
  266. cb->nlh->nlmsg_seq,
  267. NLM_F_MULTI, cb->nlh,
  268. commp->net_admin) < 0) {
  269. err = 1;
  270. goto release;
  271. }
  272. cb->args[3] = 1;
  273. if (inet_sctp_diag_fill(sk, assoc, skb, r,
  274. sk_user_ns(NETLINK_CB(cb->skb).sk),
  275. NETLINK_CB(cb->skb).portid,
  276. cb->nlh->nlmsg_seq, 0, cb->nlh,
  277. commp->net_admin) < 0) {
  278. err = 1;
  279. goto release;
  280. }
  281. next:
  282. cb->args[4]++;
  283. }
  284. cb->args[1] = 0;
  285. cb->args[3] = 0;
  286. cb->args[4] = 0;
  287. release:
  288. release_sock(sk);
  289. return err;
  290. }
  291. static int sctp_sock_filter(struct sctp_endpoint *ep, struct sctp_transport *tsp, void *p)
  292. {
  293. struct sctp_comm_param *commp = p;
  294. struct sock *sk = ep->base.sk;
  295. const struct inet_diag_req_v2 *r = commp->r;
  296. /* find the ep only once through the transports by this condition */
  297. if (!list_is_first(&tsp->asoc->asocs, &ep->asocs))
  298. return 0;
  299. if (r->sdiag_family != AF_UNSPEC && sk->sk_family != r->sdiag_family)
  300. return 0;
  301. return 1;
  302. }
  303. static int sctp_ep_dump(struct sctp_endpoint *ep, void *p)
  304. {
  305. struct sctp_comm_param *commp = p;
  306. struct sock *sk = ep->base.sk;
  307. struct sk_buff *skb = commp->skb;
  308. struct netlink_callback *cb = commp->cb;
  309. const struct inet_diag_req_v2 *r = commp->r;
  310. struct net *net = sock_net(skb->sk);
  311. struct inet_sock *inet = inet_sk(sk);
  312. int err = 0;
  313. if (!net_eq(sock_net(sk), net))
  314. goto out;
  315. if (cb->args[4] < cb->args[1])
  316. goto next;
  317. if (!(r->idiag_states & TCPF_LISTEN) && !list_empty(&ep->asocs))
  318. goto next;
  319. if (r->sdiag_family != AF_UNSPEC &&
  320. sk->sk_family != r->sdiag_family)
  321. goto next;
  322. if (r->id.idiag_sport != inet->inet_sport &&
  323. r->id.idiag_sport)
  324. goto next;
  325. if (r->id.idiag_dport != inet->inet_dport &&
  326. r->id.idiag_dport)
  327. goto next;
  328. if (inet_sctp_diag_fill(sk, NULL, skb, r,
  329. sk_user_ns(NETLINK_CB(cb->skb).sk),
  330. NETLINK_CB(cb->skb).portid,
  331. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  332. cb->nlh, commp->net_admin) < 0) {
  333. err = 2;
  334. goto out;
  335. }
  336. next:
  337. cb->args[4]++;
  338. out:
  339. return err;
  340. }
  341. /* define the functions for sctp_diag_handler*/
  342. static void sctp_diag_get_info(struct sock *sk, struct inet_diag_msg *r,
  343. void *info)
  344. {
  345. struct sctp_infox *infox = (struct sctp_infox *)info;
  346. if (infox->asoc) {
  347. r->idiag_rqueue = atomic_read(&infox->asoc->rmem_alloc);
  348. r->idiag_wqueue = infox->asoc->sndbuf_used;
  349. } else {
  350. r->idiag_rqueue = READ_ONCE(sk->sk_ack_backlog);
  351. r->idiag_wqueue = READ_ONCE(sk->sk_max_ack_backlog);
  352. }
  353. if (infox->sctpinfo)
  354. sctp_get_sctp_info(sk, infox->asoc, infox->sctpinfo);
  355. }
  356. static int sctp_diag_dump_one(struct netlink_callback *cb,
  357. const struct inet_diag_req_v2 *req)
  358. {
  359. struct sk_buff *skb = cb->skb;
  360. struct net *net = sock_net(skb->sk);
  361. const struct nlmsghdr *nlh = cb->nlh;
  362. union sctp_addr laddr, paddr;
  363. struct sctp_comm_param commp = {
  364. .skb = skb,
  365. .r = req,
  366. .nlh = nlh,
  367. .net_admin = netlink_net_capable(skb, CAP_NET_ADMIN),
  368. };
  369. if (req->sdiag_family == AF_INET) {
  370. laddr.v4.sin_port = req->id.idiag_sport;
  371. laddr.v4.sin_addr.s_addr = req->id.idiag_src[0];
  372. laddr.v4.sin_family = AF_INET;
  373. paddr.v4.sin_port = req->id.idiag_dport;
  374. paddr.v4.sin_addr.s_addr = req->id.idiag_dst[0];
  375. paddr.v4.sin_family = AF_INET;
  376. } else {
  377. laddr.v6.sin6_port = req->id.idiag_sport;
  378. memcpy(&laddr.v6.sin6_addr, req->id.idiag_src,
  379. sizeof(laddr.v6.sin6_addr));
  380. laddr.v6.sin6_family = AF_INET6;
  381. paddr.v6.sin6_port = req->id.idiag_dport;
  382. memcpy(&paddr.v6.sin6_addr, req->id.idiag_dst,
  383. sizeof(paddr.v6.sin6_addr));
  384. paddr.v6.sin6_family = AF_INET6;
  385. }
  386. return sctp_transport_lookup_process(sctp_sock_dump_one,
  387. net, &laddr, &paddr, &commp);
  388. }
  389. static void sctp_diag_dump(struct sk_buff *skb, struct netlink_callback *cb,
  390. const struct inet_diag_req_v2 *r)
  391. {
  392. u32 idiag_states = r->idiag_states;
  393. struct net *net = sock_net(skb->sk);
  394. struct sctp_comm_param commp = {
  395. .skb = skb,
  396. .cb = cb,
  397. .r = r,
  398. .net_admin = netlink_net_capable(cb->skb, CAP_NET_ADMIN),
  399. };
  400. int pos = cb->args[2];
  401. /* eps hashtable dumps
  402. * args:
  403. * 0 : if it will traversal listen sock
  404. * 1 : to record the sock pos of this time's traversal
  405. * 4 : to work as a temporary variable to traversal list
  406. */
  407. if (cb->args[0] == 0) {
  408. if (!(idiag_states & TCPF_LISTEN))
  409. goto skip;
  410. if (sctp_for_each_endpoint(sctp_ep_dump, &commp))
  411. goto done;
  412. skip:
  413. cb->args[0] = 1;
  414. cb->args[1] = 0;
  415. cb->args[4] = 0;
  416. }
  417. /* asocs by transport hashtable dump
  418. * args:
  419. * 1 : to record the assoc pos of this time's traversal
  420. * 2 : to record the transport pos of this time's traversal
  421. * 3 : to mark if we have dumped the ep info of the current asoc
  422. * 4 : to work as a temporary variable to traversal list
  423. * 5 : to save the sk we get from travelsing the tsp list.
  424. */
  425. if (!(idiag_states & ~(TCPF_LISTEN | TCPF_CLOSE)))
  426. goto done;
  427. sctp_transport_traverse_process(sctp_sock_filter, sctp_sock_dump,
  428. net, &pos, &commp);
  429. cb->args[2] = pos;
  430. done:
  431. cb->args[1] = cb->args[4];
  432. cb->args[4] = 0;
  433. }
  434. static const struct inet_diag_handler sctp_diag_handler = {
  435. .dump = sctp_diag_dump,
  436. .dump_one = sctp_diag_dump_one,
  437. .idiag_get_info = sctp_diag_get_info,
  438. .idiag_type = IPPROTO_SCTP,
  439. .idiag_info_size = sizeof(struct sctp_info),
  440. };
  441. static int __init sctp_diag_init(void)
  442. {
  443. return inet_diag_register(&sctp_diag_handler);
  444. }
  445. static void __exit sctp_diag_exit(void)
  446. {
  447. inet_diag_unregister(&sctp_diag_handler);
  448. }
  449. module_init(sctp_diag_init);
  450. module_exit(sctp_diag_exit);
  451. MODULE_LICENSE("GPL");
  452. MODULE_ALIAS_NET_PF_PROTO_TYPE(PF_NETLINK, NETLINK_SOCK_DIAG, 2-132);