Blame view
net/packet/diag.c
6.29 KB
09c434b8a treewide: Add SPD... |
1 |
// SPDX-License-Identifier: GPL-2.0-only |
96ec63271 packet: Diag core... |
2 3 4 |
#include <linux/module.h> #include <linux/sock_diag.h> #include <linux/net.h> |
eea68e2f1 packet: Report so... |
5 |
#include <linux/netdevice.h> |
96ec63271 packet: Diag core... |
6 |
#include <linux/packet_diag.h> |
b01384081 packet: use percp... |
7 |
#include <linux/percpu.h> |
96ec63271 packet: Diag core... |
8 9 10 11 |
#include <net/net_namespace.h> #include <net/sock.h> #include "internal.h" |
8a360be0c packet: Report mo... |
12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 |
static int pdiag_put_info(const struct packet_sock *po, struct sk_buff *nlskb) { struct packet_diag_info pinfo; pinfo.pdi_index = po->ifindex; pinfo.pdi_version = po->tp_version; pinfo.pdi_reserve = po->tp_reserve; pinfo.pdi_copy_thresh = po->copy_thresh; pinfo.pdi_tstamp = po->tp_tstamp; pinfo.pdi_flags = 0; if (po->running) pinfo.pdi_flags |= PDI_RUNNING; if (po->auxdata) pinfo.pdi_flags |= PDI_AUXDATA; if (po->origdev) pinfo.pdi_flags |= PDI_ORIGDEV; if (po->has_vnet_hdr) pinfo.pdi_flags |= PDI_VNETHDR; if (po->tp_loss) pinfo.pdi_flags |= PDI_LOSS; return nla_put(nlskb, PACKET_DIAG_INFO, sizeof(pinfo), &pinfo); } |
eea68e2f1 packet: Report so... |
36 37 38 39 |
static int pdiag_put_mclist(const struct packet_sock *po, struct sk_buff *nlskb) { struct nlattr *mca; struct packet_mclist *ml; |
ae0be8de9 netlink: make nla... |
40 |
mca = nla_nest_start_noflag(nlskb, PACKET_DIAG_MCLIST); |
eea68e2f1 packet: Report so... |
41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 |
if (!mca) return -EMSGSIZE; rtnl_lock(); for (ml = po->mclist; ml; ml = ml->next) { struct packet_diag_mclist *dml; dml = nla_reserve_nohdr(nlskb, sizeof(*dml)); if (!dml) { rtnl_unlock(); nla_nest_cancel(nlskb, mca); return -EMSGSIZE; } dml->pdmc_index = ml->ifindex; dml->pdmc_type = ml->type; dml->pdmc_alen = ml->alen; dml->pdmc_count = ml->count; BUILD_BUG_ON(sizeof(dml->pdmc_addr) != sizeof(ml->addr)); memcpy(dml->pdmc_addr, ml->addr, sizeof(ml->addr)); } rtnl_unlock(); nla_nest_end(nlskb, mca); return 0; } |
16f01365f packet: Report ri... |
68 69 70 71 |
static int pdiag_put_ring(struct packet_ring_buffer *ring, int ver, int nl_type, struct sk_buff *nlskb) { struct packet_diag_ring pdr; |
a505e5825 packet: pdiag_put... |
72 |
if (!ring->pg_vec) |
16f01365f packet: Report ri... |
73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 |
return 0; pdr.pdr_block_size = ring->pg_vec_pages << PAGE_SHIFT; pdr.pdr_block_nr = ring->pg_vec_len; pdr.pdr_frame_size = ring->frame_size; pdr.pdr_frame_nr = ring->frame_max + 1; if (ver > TPACKET_V2) { pdr.pdr_retire_tmo = ring->prb_bdqc.retire_blk_tov; pdr.pdr_sizeof_priv = ring->prb_bdqc.blk_sizeof_priv; pdr.pdr_features = ring->prb_bdqc.feature_req_word; } else { pdr.pdr_retire_tmo = 0; pdr.pdr_sizeof_priv = 0; pdr.pdr_features = 0; } return nla_put(nlskb, nl_type, sizeof(pdr), &pdr); } static int pdiag_put_rings_cfg(struct packet_sock *po, struct sk_buff *skb) { int ret; mutex_lock(&po->pg_vec_lock); ret = pdiag_put_ring(&po->rx_ring, po->tp_version, PACKET_DIAG_RX_RING, skb); if (!ret) ret = pdiag_put_ring(&po->tx_ring, po->tp_version, PACKET_DIAG_TX_RING, skb); mutex_unlock(&po->pg_vec_lock); return ret; } |
fff3321d7 packet: Report fa... |
107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 |
static int pdiag_put_fanout(struct packet_sock *po, struct sk_buff *nlskb) { int ret = 0; mutex_lock(&fanout_mutex); if (po->fanout) { u32 val; val = (u32)po->fanout->id | ((u32)po->fanout->type << 16); ret = nla_put_u32(nlskb, PACKET_DIAG_FANOUT, val); } mutex_unlock(&fanout_mutex); return ret; } |
626419038 packet_diag: disc... |
122 123 |
static int sk_diag_fill(struct sock *sk, struct sk_buff *skb, struct packet_diag_req *req, |
a53b72c83 net: Move the per... |
124 |
bool may_report_filterinfo, |
626419038 packet_diag: disc... |
125 126 |
struct user_namespace *user_ns, u32 portid, u32 seq, u32 flags, int sk_ino) |
96ec63271 packet: Diag core... |
127 128 129 |
{ struct nlmsghdr *nlh; struct packet_diag_msg *rp; |
16f01365f packet: Report ri... |
130 |
struct packet_sock *po = pkt_sk(sk); |
96ec63271 packet: Diag core... |
131 |
|
15e473046 netlink: Rename p... |
132 |
nlh = nlmsg_put(skb, portid, seq, SOCK_DIAG_BY_FAMILY, sizeof(*rp), flags); |
96ec63271 packet: Diag core... |
133 134 135 136 137 138 139 140 141 |
if (!nlh) return -EMSGSIZE; rp = nlmsg_data(nlh); rp->pdiag_family = AF_PACKET; rp->pdiag_type = sk->sk_type; rp->pdiag_num = ntohs(po->num); rp->pdiag_ino = sk_ino; sock_diag_save_cookie(sk, rp->pdiag_cookie); |
8a360be0c packet: Report mo... |
142 143 144 |
if ((req->pdiag_show & PACKET_SHOW_INFO) && pdiag_put_info(po, skb)) goto out_nlmsg_trim; |
626419038 packet_diag: disc... |
145 146 147 148 |
if ((req->pdiag_show & PACKET_SHOW_INFO) && nla_put_u32(skb, PACKET_DIAG_UID, from_kuid_munged(user_ns, sock_i_uid(sk)))) goto out_nlmsg_trim; |
eea68e2f1 packet: Report so... |
149 150 151 |
if ((req->pdiag_show & PACKET_SHOW_MCLIST) && pdiag_put_mclist(po, skb)) goto out_nlmsg_trim; |
16f01365f packet: Report ri... |
152 153 154 |
if ((req->pdiag_show & PACKET_SHOW_RING_CFG) && pdiag_put_rings_cfg(po, skb)) goto out_nlmsg_trim; |
fff3321d7 packet: Report fa... |
155 156 157 |
if ((req->pdiag_show & PACKET_SHOW_FANOUT) && pdiag_put_fanout(po, skb)) goto out_nlmsg_trim; |
76d0eeb1a packet_diag: disc... |
158 159 160 |
if ((req->pdiag_show & PACKET_SHOW_MEMINFO) && sock_diag_put_meminfo(sk, skb, PACKET_DIAG_MEMINFO)) goto out_nlmsg_trim; |
e8d9612c1 sock_diag: allow ... |
161 |
if ((req->pdiag_show & PACKET_SHOW_FILTER) && |
a53b72c83 net: Move the per... |
162 163 |
sock_diag_put_filterinfo(may_report_filterinfo, sk, skb, PACKET_DIAG_FILTER)) |
e8d9612c1 sock_diag: allow ... |
164 |
goto out_nlmsg_trim; |
053c095a8 netlink: make nlm... |
165 166 |
nlmsg_end(skb, nlh); return 0; |
8a360be0c packet: Report mo... |
167 168 169 170 |
out_nlmsg_trim: nlmsg_cancel(skb, nlh); return -EMSGSIZE; |
96ec63271 packet: Diag core... |
171 172 173 174 175 176 177 178 |
} static int packet_diag_dump(struct sk_buff *skb, struct netlink_callback *cb) { int num = 0, s_num = cb->args[0]; struct packet_diag_req *req; struct net *net; struct sock *sk; |
a53b72c83 net: Move the per... |
179 |
bool may_report_filterinfo; |
96ec63271 packet: Diag core... |
180 181 182 |
net = sock_net(skb->sk); req = nlmsg_data(cb->nlh); |
90f62cf30 net: Use netlink_... |
183 |
may_report_filterinfo = netlink_net_capable(cb->skb, CAP_NET_ADMIN); |
96ec63271 packet: Diag core... |
184 |
|
0fa7fa98d packet: Protect p... |
185 |
mutex_lock(&net->packet.sklist_lock); |
b67bfe0d4 hlist: drop the n... |
186 |
sk_for_each(sk, &net->packet.sklist) { |
96ec63271 packet: Diag core... |
187 188 189 190 |
if (!net_eq(sock_net(sk), net)) continue; if (num < s_num) goto next; |
626419038 packet_diag: disc... |
191 |
if (sk_diag_fill(sk, skb, req, |
a53b72c83 net: Move the per... |
192 |
may_report_filterinfo, |
626419038 packet_diag: disc... |
193 194 195 196 |
sk_user_ns(NETLINK_CB(cb->skb).sk), NETLINK_CB(cb->skb).portid, cb->nlh->nlmsg_seq, NLM_F_MULTI, sock_i_ino(sk)) < 0) |
96ec63271 packet: Diag core... |
197 198 199 200 201 |
goto done; next: num++; } done: |
0fa7fa98d packet: Protect p... |
202 |
mutex_unlock(&net->packet.sklist_lock); |
96ec63271 packet: Diag core... |
203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 |
cb->args[0] = num; return skb->len; } static int packet_diag_handler_dump(struct sk_buff *skb, struct nlmsghdr *h) { int hdrlen = sizeof(struct packet_diag_req); struct net *net = sock_net(skb->sk); struct packet_diag_req *req; if (nlmsg_len(h) < hdrlen) return -EINVAL; req = nlmsg_data(h); /* Make it possible to support protocol filtering later */ if (req->sdiag_protocol) return -EINVAL; if (h->nlmsg_flags & NLM_F_DUMP) { struct netlink_dump_control c = { .dump = packet_diag_dump, }; return netlink_dump_start(net->diag_nlsk, skb, h, &c); } else return -EOPNOTSUPP; } static const struct sock_diag_handler packet_diag_handler = { .family = AF_PACKET, .dump = packet_diag_handler_dump, }; static int __init packet_diag_init(void) { return sock_diag_register(&packet_diag_handler); } static void __exit packet_diag_exit(void) { sock_diag_unregister(&packet_diag_handler); } module_init(packet_diag_init); module_exit(packet_diag_exit); MODULE_LICENSE("GPL"); MODULE_ALIAS_NET_PF_PROTO_TYPE(PF_NETLINK, NETLINK_SOCK_DIAG, 17 /* AF_PACKET */); |