1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * vsock sock_diag(7) module 4 * 5 * Copyright (C) 2017 Red Hat, Inc. 6 * Author: Stefan Hajnoczi <stefanha@redhat.com> 7 */ 8 9 #include <linux/module.h> 10 #include <linux/sock_diag.h> 11 #include <linux/vm_sockets_diag.h> 12 #include <net/af_vsock.h> 13 14 static int sk_diag_fill(struct sock *sk, struct sk_buff *skb, 15 u32 portid, u32 seq, u32 flags) 16 { 17 struct vsock_sock *vsk = vsock_sk(sk); 18 struct vsock_diag_msg *rep; 19 struct nlmsghdr *nlh; 20 21 nlh = nlmsg_put(skb, portid, seq, SOCK_DIAG_BY_FAMILY, sizeof(*rep), 22 flags); 23 if (!nlh) 24 return -EMSGSIZE; 25 26 rep = nlmsg_data(nlh); 27 rep->vdiag_family = AF_VSOCK; 28 29 /* Lock order dictates that sk_lock is acquired before 30 * vsock_table_lock, so we cannot lock here. Simply don't take 31 * sk_lock; sk is guaranteed to stay alive since vsock_table_lock is 32 * held. 33 */ 34 rep->vdiag_type = sk->sk_type; 35 rep->vdiag_state = sk->sk_state; 36 rep->vdiag_shutdown = sk->sk_shutdown; 37 rep->vdiag_src_cid = vsk->local_addr.svm_cid; 38 rep->vdiag_src_port = vsk->local_addr.svm_port; 39 rep->vdiag_dst_cid = vsk->remote_addr.svm_cid; 40 rep->vdiag_dst_port = vsk->remote_addr.svm_port; 41 rep->vdiag_ino = sock_i_ino(sk); 42 43 sock_diag_save_cookie(sk, rep->vdiag_cookie); 44 45 return 0; 46 } 47 48 static int vsock_diag_dump(struct sk_buff *skb, struct netlink_callback *cb) 49 { 50 struct vsock_diag_req *req; 51 struct vsock_sock *vsk; 52 unsigned int bucket; 53 unsigned int last_i; 54 unsigned int table; 55 struct net *net; 56 unsigned int i; 57 58 req = nlmsg_data(cb->nlh); 59 net = sock_net(skb->sk); 60 61 /* State saved between calls: */ 62 table = cb->args[0]; 63 bucket = cb->args[1]; 64 i = last_i = cb->args[2]; 65 66 /* TODO VMCI pending sockets? */ 67 68 spin_lock_bh(&vsock_table_lock); 69 70 /* Bind table (locally created sockets) */ 71 if (table == 0) { 72 while (bucket < ARRAY_SIZE(vsock_bind_table)) { 73 struct list_head *head = &vsock_bind_table[bucket]; 74 75 i = 0; 76 list_for_each_entry(vsk, head, bound_table) { 77 struct sock *sk = sk_vsock(vsk); 78 79 if (!net_eq(sock_net(sk), net)) 80 continue; 81 if (i < last_i) 82 goto next_bind; 83 if (!(req->vdiag_states & (1 << sk->sk_state))) 84 goto next_bind; 85 if (sk_diag_fill(sk, skb, 86 NETLINK_CB(cb->skb).portid, 87 cb->nlh->nlmsg_seq, 88 NLM_F_MULTI) < 0) 89 goto done; 90 next_bind: 91 i++; 92 } 93 last_i = 0; 94 bucket++; 95 } 96 97 table++; 98 bucket = 0; 99 } 100 101 /* Connected table (accepted connections) */ 102 while (bucket < ARRAY_SIZE(vsock_connected_table)) { 103 struct list_head *head = &vsock_connected_table[bucket]; 104 105 i = 0; 106 list_for_each_entry(vsk, head, connected_table) { 107 struct sock *sk = sk_vsock(vsk); 108 109 /* Skip sockets we've already seen above */ 110 if (__vsock_in_bound_table(vsk)) 111 continue; 112 113 if (!net_eq(sock_net(sk), net)) 114 continue; 115 if (i < last_i) 116 goto next_connected; 117 if (!(req->vdiag_states & (1 << sk->sk_state))) 118 goto next_connected; 119 if (sk_diag_fill(sk, skb, 120 NETLINK_CB(cb->skb).portid, 121 cb->nlh->nlmsg_seq, 122 NLM_F_MULTI) < 0) 123 goto done; 124 next_connected: 125 i++; 126 } 127 last_i = 0; 128 bucket++; 129 } 130 131 done: 132 spin_unlock_bh(&vsock_table_lock); 133 134 cb->args[0] = table; 135 cb->args[1] = bucket; 136 cb->args[2] = i; 137 138 return skb->len; 139 } 140 141 static int vsock_diag_handler_dump(struct sk_buff *skb, struct nlmsghdr *h) 142 { 143 int hdrlen = sizeof(struct vsock_diag_req); 144 struct net *net = sock_net(skb->sk); 145 146 if (nlmsg_len(h) < hdrlen) 147 return -EINVAL; 148 149 if (h->nlmsg_flags & NLM_F_DUMP) { 150 struct netlink_dump_control c = { 151 .dump = vsock_diag_dump, 152 }; 153 return netlink_dump_start(net->diag_nlsk, skb, h, &c); 154 } 155 156 return -EOPNOTSUPP; 157 } 158 159 static const struct sock_diag_handler vsock_diag_handler = { 160 .family = AF_VSOCK, 161 .dump = vsock_diag_handler_dump, 162 }; 163 164 static int __init vsock_diag_init(void) 165 { 166 return sock_diag_register(&vsock_diag_handler); 167 } 168 169 static void __exit vsock_diag_exit(void) 170 { 171 sock_diag_unregister(&vsock_diag_handler); 172 } 173 174 module_init(vsock_diag_init); 175 module_exit(vsock_diag_exit); 176 MODULE_LICENSE("GPL"); 177 MODULE_ALIAS_NET_PF_PROTO_TYPE(PF_NETLINK, NETLINK_SOCK_DIAG, 178 40 /* AF_VSOCK */); 179