]>
git.ipfire.org Git - thirdparty/systemd.git/blob - src/libsystemd-network/lldp-network.c
1 /* SPDX-License-Identifier: LGPL-2.1+ */
3 This file is part of systemd.
5 Copyright (C) 2014 Tom Gundersen
6 Copyright (C) 2014 Susant Sahani
9 #include <linux/filter.h>
10 #include <netinet/if_ether.h>
13 #include "lldp-network.h"
14 #include "socket-util.h"
16 int lldp_network_bind_raw_socket(int ifindex
) {
18 static const struct sock_filter filter
[] = {
19 BPF_STMT(BPF_LD
+ BPF_W
+ BPF_ABS
, offsetof(struct ethhdr
, h_dest
)), /* A <- 4 bytes of destination MAC */
20 BPF_JUMP(BPF_JMP
+ BPF_JEQ
+ BPF_K
, 0x0180c200, 1, 0), /* A != 01:80:c2:00 */
21 BPF_STMT(BPF_RET
+ BPF_K
, 0), /* drop packet */
22 BPF_STMT(BPF_LD
+ BPF_H
+ BPF_ABS
, offsetof(struct ethhdr
, h_dest
) + 4), /* A <- remaining 2 bytes of destination MAC */
23 BPF_JUMP(BPF_JMP
+ BPF_JEQ
+ BPF_K
, 0x0000, 3, 0), /* A != 00:00 */
24 BPF_JUMP(BPF_JMP
+ BPF_JEQ
+ BPF_K
, 0x0003, 2, 0), /* A != 00:03 */
25 BPF_JUMP(BPF_JMP
+ BPF_JEQ
+ BPF_K
, 0x000e, 1, 0), /* A != 00:0e */
26 BPF_STMT(BPF_RET
+ BPF_K
, 0), /* drop packet */
27 BPF_STMT(BPF_LD
+ BPF_H
+ BPF_ABS
, offsetof(struct ethhdr
, h_proto
)), /* A <- protocol */
28 BPF_JUMP(BPF_JMP
+ BPF_JEQ
+ BPF_K
, ETHERTYPE_LLDP
, 1, 0), /* A != ETHERTYPE_LLDP */
29 BPF_STMT(BPF_RET
+ BPF_K
, 0), /* drop packet */
30 BPF_STMT(BPF_RET
+ BPF_K
, (uint32_t) -1), /* accept packet */
33 static const struct sock_fprog fprog
= {
34 .len
= ELEMENTSOF(filter
),
35 .filter
= (struct sock_filter
*) filter
,
38 struct packet_mreq mreq
= {
39 .mr_ifindex
= ifindex
,
40 .mr_type
= PACKET_MR_MULTICAST
,
42 .mr_address
= { 0x01, 0x80, 0xC2, 0x00, 0x00, 0x00 }
45 union sockaddr_union saddrll
= {
46 .ll
.sll_family
= AF_PACKET
,
47 .ll
.sll_ifindex
= ifindex
,
50 _cleanup_close_
int fd
= -1;
55 fd
= socket(PF_PACKET
, SOCK_RAW
|SOCK_CLOEXEC
|SOCK_NONBLOCK
,
56 htobe16(ETHERTYPE_LLDP
));
60 r
= setsockopt(fd
, SOL_SOCKET
, SO_ATTACH_FILTER
, &fprog
, sizeof(fprog
));
64 r
= setsockopt(fd
, SOL_PACKET
, PACKET_ADD_MEMBERSHIP
, &mreq
, sizeof(mreq
));
68 mreq
.mr_address
[ETH_ALEN
- 1] = 0x03;
69 r
= setsockopt(fd
, SOL_PACKET
, PACKET_ADD_MEMBERSHIP
, &mreq
, sizeof(mreq
));
73 mreq
.mr_address
[ETH_ALEN
- 1] = 0x0E;
74 r
= setsockopt(fd
, SOL_PACKET
, PACKET_ADD_MEMBERSHIP
, &mreq
, sizeof(mreq
));
78 r
= bind(fd
, &saddrll
.sa
, sizeof(saddrll
.ll
));