diag.c 14 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537
  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 <linux-sctp@vger.kernel.org>
  12. *
  13. * Written or modified by:
  14. * Xin Long <lucien.xin@gmail.com>
  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_tsp_dump_one(struct sctp_transport *tsp, void *p)
  208. {
  209. struct sctp_association *assoc = tsp->asoc;
  210. struct sock *sk = tsp->asoc->base.sk;
  211. struct sctp_comm_param *commp = p;
  212. struct sk_buff *in_skb = commp->skb;
  213. const struct inet_diag_req_v2 *req = commp->r;
  214. const struct nlmsghdr *nlh = commp->nlh;
  215. struct net *net = sock_net(in_skb->sk);
  216. struct sk_buff *rep;
  217. int err;
  218. err = sock_diag_check_cookie(sk, req->id.idiag_cookie);
  219. if (err)
  220. goto out;
  221. err = -ENOMEM;
  222. rep = nlmsg_new(inet_assoc_attr_size(assoc), GFP_KERNEL);
  223. if (!rep)
  224. goto out;
  225. lock_sock(sk);
  226. if (sk != assoc->base.sk) {
  227. release_sock(sk);
  228. sk = assoc->base.sk;
  229. lock_sock(sk);
  230. }
  231. err = inet_sctp_diag_fill(sk, assoc, rep, req,
  232. sk_user_ns(NETLINK_CB(in_skb).sk),
  233. NETLINK_CB(in_skb).portid,
  234. nlh->nlmsg_seq, 0, nlh,
  235. commp->net_admin);
  236. release_sock(sk);
  237. if (err < 0) {
  238. WARN_ON(err == -EMSGSIZE);
  239. kfree_skb(rep);
  240. goto out;
  241. }
  242. err = netlink_unicast(net->diag_nlsk, rep, NETLINK_CB(in_skb).portid,
  243. MSG_DONTWAIT);
  244. if (err > 0)
  245. err = 0;
  246. out:
  247. return err;
  248. }
  249. static int sctp_sock_dump(struct sctp_endpoint *ep, struct sctp_transport *tsp, void *p)
  250. {
  251. struct sctp_comm_param *commp = p;
  252. struct sock *sk = ep->base.sk;
  253. struct sk_buff *skb = commp->skb;
  254. struct netlink_callback *cb = commp->cb;
  255. const struct inet_diag_req_v2 *r = commp->r;
  256. struct sctp_association *assoc;
  257. int err = 0;
  258. lock_sock(sk);
  259. if (ep != tsp->asoc->ep)
  260. goto release;
  261. list_for_each_entry(assoc, &ep->asocs, asocs) {
  262. if (cb->args[4] < cb->args[1])
  263. goto next;
  264. if (r->id.idiag_sport != htons(assoc->base.bind_addr.port) &&
  265. r->id.idiag_sport)
  266. goto next;
  267. if (r->id.idiag_dport != htons(assoc->peer.port) &&
  268. r->id.idiag_dport)
  269. goto next;
  270. if (!cb->args[3] &&
  271. inet_sctp_diag_fill(sk, NULL, skb, r,
  272. sk_user_ns(NETLINK_CB(cb->skb).sk),
  273. NETLINK_CB(cb->skb).portid,
  274. cb->nlh->nlmsg_seq,
  275. NLM_F_MULTI, cb->nlh,
  276. commp->net_admin) < 0) {
  277. err = 1;
  278. goto release;
  279. }
  280. cb->args[3] = 1;
  281. if (inet_sctp_diag_fill(sk, assoc, skb, r,
  282. sk_user_ns(NETLINK_CB(cb->skb).sk),
  283. NETLINK_CB(cb->skb).portid,
  284. cb->nlh->nlmsg_seq, 0, cb->nlh,
  285. commp->net_admin) < 0) {
  286. err = 1;
  287. goto release;
  288. }
  289. next:
  290. cb->args[4]++;
  291. }
  292. cb->args[1] = 0;
  293. cb->args[3] = 0;
  294. cb->args[4] = 0;
  295. release:
  296. release_sock(sk);
  297. return err;
  298. }
  299. static int sctp_sock_filter(struct sctp_endpoint *ep, struct sctp_transport *tsp, void *p)
  300. {
  301. struct sctp_comm_param *commp = p;
  302. struct sock *sk = ep->base.sk;
  303. const struct inet_diag_req_v2 *r = commp->r;
  304. struct sctp_association *assoc =
  305. list_entry(ep->asocs.next, struct sctp_association, asocs);
  306. /* find the ep only once through the transports by this condition */
  307. if (tsp->asoc != assoc)
  308. return 0;
  309. if (r->sdiag_family != AF_UNSPEC && sk->sk_family != r->sdiag_family)
  310. return 0;
  311. return 1;
  312. }
  313. static int sctp_ep_dump(struct sctp_endpoint *ep, void *p)
  314. {
  315. struct sctp_comm_param *commp = p;
  316. struct sock *sk = ep->base.sk;
  317. struct sk_buff *skb = commp->skb;
  318. struct netlink_callback *cb = commp->cb;
  319. const struct inet_diag_req_v2 *r = commp->r;
  320. struct net *net = sock_net(skb->sk);
  321. struct inet_sock *inet = inet_sk(sk);
  322. int err = 0;
  323. if (!net_eq(sock_net(sk), net))
  324. goto out;
  325. if (cb->args[4] < cb->args[1])
  326. goto next;
  327. if (!(r->idiag_states & TCPF_LISTEN) && !list_empty(&ep->asocs))
  328. goto next;
  329. if (r->sdiag_family != AF_UNSPEC &&
  330. sk->sk_family != r->sdiag_family)
  331. goto next;
  332. if (r->id.idiag_sport != inet->inet_sport &&
  333. r->id.idiag_sport)
  334. goto next;
  335. if (r->id.idiag_dport != inet->inet_dport &&
  336. r->id.idiag_dport)
  337. goto next;
  338. if (inet_sctp_diag_fill(sk, NULL, skb, r,
  339. sk_user_ns(NETLINK_CB(cb->skb).sk),
  340. NETLINK_CB(cb->skb).portid,
  341. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  342. cb->nlh, commp->net_admin) < 0) {
  343. err = 2;
  344. goto out;
  345. }
  346. next:
  347. cb->args[4]++;
  348. out:
  349. return err;
  350. }
  351. /* define the functions for sctp_diag_handler*/
  352. static void sctp_diag_get_info(struct sock *sk, struct inet_diag_msg *r,
  353. void *info)
  354. {
  355. struct sctp_infox *infox = (struct sctp_infox *)info;
  356. if (infox->asoc) {
  357. r->idiag_rqueue = atomic_read(&infox->asoc->rmem_alloc);
  358. r->idiag_wqueue = infox->asoc->sndbuf_used;
  359. } else {
  360. r->idiag_rqueue = READ_ONCE(sk->sk_ack_backlog);
  361. r->idiag_wqueue = READ_ONCE(sk->sk_max_ack_backlog);
  362. }
  363. if (infox->sctpinfo)
  364. sctp_get_sctp_info(sk, infox->asoc, infox->sctpinfo);
  365. }
  366. static int sctp_diag_dump_one(struct netlink_callback *cb,
  367. const struct inet_diag_req_v2 *req)
  368. {
  369. struct sk_buff *in_skb = cb->skb;
  370. struct net *net = sock_net(in_skb->sk);
  371. const struct nlmsghdr *nlh = cb->nlh;
  372. union sctp_addr laddr, paddr;
  373. struct sctp_comm_param commp = {
  374. .skb = in_skb,
  375. .r = req,
  376. .nlh = nlh,
  377. .net_admin = netlink_net_capable(in_skb, CAP_NET_ADMIN),
  378. };
  379. if (req->sdiag_family == AF_INET) {
  380. laddr.v4.sin_port = req->id.idiag_sport;
  381. laddr.v4.sin_addr.s_addr = req->id.idiag_src[0];
  382. laddr.v4.sin_family = AF_INET;
  383. paddr.v4.sin_port = req->id.idiag_dport;
  384. paddr.v4.sin_addr.s_addr = req->id.idiag_dst[0];
  385. paddr.v4.sin_family = AF_INET;
  386. } else {
  387. laddr.v6.sin6_port = req->id.idiag_sport;
  388. memcpy(&laddr.v6.sin6_addr, req->id.idiag_src,
  389. sizeof(laddr.v6.sin6_addr));
  390. laddr.v6.sin6_family = AF_INET6;
  391. paddr.v6.sin6_port = req->id.idiag_dport;
  392. memcpy(&paddr.v6.sin6_addr, req->id.idiag_dst,
  393. sizeof(paddr.v6.sin6_addr));
  394. paddr.v6.sin6_family = AF_INET6;
  395. }
  396. return sctp_transport_lookup_process(sctp_tsp_dump_one,
  397. net, &laddr, &paddr, &commp);
  398. }
  399. static void sctp_diag_dump(struct sk_buff *skb, struct netlink_callback *cb,
  400. const struct inet_diag_req_v2 *r)
  401. {
  402. u32 idiag_states = r->idiag_states;
  403. struct net *net = sock_net(skb->sk);
  404. struct sctp_comm_param commp = {
  405. .skb = skb,
  406. .cb = cb,
  407. .r = r,
  408. .net_admin = netlink_net_capable(cb->skb, CAP_NET_ADMIN),
  409. };
  410. int pos = cb->args[2];
  411. /* eps hashtable dumps
  412. * args:
  413. * 0 : if it will traversal listen sock
  414. * 1 : to record the sock pos of this time's traversal
  415. * 4 : to work as a temporary variable to traversal list
  416. */
  417. if (cb->args[0] == 0) {
  418. if (!(idiag_states & TCPF_LISTEN))
  419. goto skip;
  420. if (sctp_for_each_endpoint(sctp_ep_dump, &commp))
  421. goto done;
  422. skip:
  423. cb->args[0] = 1;
  424. cb->args[1] = 0;
  425. cb->args[4] = 0;
  426. }
  427. /* asocs by transport hashtable dump
  428. * args:
  429. * 1 : to record the assoc pos of this time's traversal
  430. * 2 : to record the transport pos of this time's traversal
  431. * 3 : to mark if we have dumped the ep info of the current asoc
  432. * 4 : to work as a temporary variable to traversal list
  433. * 5 : to save the sk we get from travelsing the tsp list.
  434. */
  435. if (!(idiag_states & ~(TCPF_LISTEN | TCPF_CLOSE)))
  436. goto done;
  437. sctp_transport_traverse_process(sctp_sock_filter, sctp_sock_dump,
  438. net, &pos, &commp);
  439. cb->args[2] = pos;
  440. done:
  441. cb->args[1] = cb->args[4];
  442. cb->args[4] = 0;
  443. }
  444. static const struct inet_diag_handler sctp_diag_handler = {
  445. .dump = sctp_diag_dump,
  446. .dump_one = sctp_diag_dump_one,
  447. .idiag_get_info = sctp_diag_get_info,
  448. .idiag_type = IPPROTO_SCTP,
  449. .idiag_info_size = sizeof(struct sctp_info),
  450. };
  451. static int __init sctp_diag_init(void)
  452. {
  453. return inet_diag_register(&sctp_diag_handler);
  454. }
  455. static void __exit sctp_diag_exit(void)
  456. {
  457. inet_diag_unregister(&sctp_diag_handler);
  458. }
  459. module_init(sctp_diag_init);
  460. module_exit(sctp_diag_exit);
  461. MODULE_LICENSE("GPL");
  462. MODULE_ALIAS_NET_PF_PROTO_TYPE(PF_NETLINK, NETLINK_SOCK_DIAG, 2-132);