| .. | .. |
|---|
| 1 | +/* SPDX-License-Identifier: GPL-2.0-or-later */ |
|---|
| 1 | 2 | /* |
|---|
| 2 | 3 | * PTP 1588 support |
|---|
| 3 | 4 | * |
|---|
| 4 | 5 | * This file implements a BPF that recognizes PTP event messages. |
|---|
| 5 | 6 | * |
|---|
| 6 | 7 | * Copyright (C) 2010 OMICRON electronics GmbH |
|---|
| 7 | | - * |
|---|
| 8 | | - * This program is free software; you can redistribute it and/or modify |
|---|
| 9 | | - * it under the terms of the GNU General Public License as published by |
|---|
| 10 | | - * the Free Software Foundation; either version 2 of the License, or |
|---|
| 11 | | - * (at your option) any later version. |
|---|
| 12 | | - * |
|---|
| 13 | | - * This program is distributed in the hope that it will be useful, |
|---|
| 14 | | - * but WITHOUT ANY WARRANTY; without even the implied warranty of |
|---|
| 15 | | - * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
|---|
| 16 | | - * GNU General Public License for more details. |
|---|
| 17 | | - * |
|---|
| 18 | | - * You should have received a copy of the GNU General Public License |
|---|
| 19 | | - * along with this program; if not, write to the Free Software |
|---|
| 20 | | - * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. |
|---|
| 21 | 8 | */ |
|---|
| 22 | 9 | |
|---|
| 23 | 10 | #ifndef _PTP_CLASSIFY_H_ |
|---|
| .. | .. |
|---|
| 49 | 36 | |
|---|
| 50 | 37 | #define OFF_PTP_SOURCE_UUID 22 /* PTPv1 only */ |
|---|
| 51 | 38 | #define OFF_PTP_SEQUENCE_ID 30 |
|---|
| 52 | | -#define OFF_PTP_CONTROL 32 /* PTPv1 only */ |
|---|
| 53 | 39 | |
|---|
| 54 | 40 | /* Below defines should actually be removed at some point in time. */ |
|---|
| 55 | 41 | #define IP6_HLEN 40 |
|---|
| 56 | 42 | #define UDP_HLEN 8 |
|---|
| 57 | 43 | #define OFF_IHL 14 |
|---|
| 58 | 44 | #define IPV4_HLEN(data) (((struct iphdr *)(data + OFF_IHL))->ihl << 2) |
|---|
| 45 | + |
|---|
| 46 | +struct clock_identity { |
|---|
| 47 | + u8 id[8]; |
|---|
| 48 | +} __packed; |
|---|
| 49 | + |
|---|
| 50 | +struct port_identity { |
|---|
| 51 | + struct clock_identity clock_identity; |
|---|
| 52 | + __be16 port_number; |
|---|
| 53 | +} __packed; |
|---|
| 54 | + |
|---|
| 55 | +struct ptp_header { |
|---|
| 56 | + u8 tsmt; /* transportSpecific | messageType */ |
|---|
| 57 | + u8 ver; /* reserved | versionPTP */ |
|---|
| 58 | + __be16 message_length; |
|---|
| 59 | + u8 domain_number; |
|---|
| 60 | + u8 reserved1; |
|---|
| 61 | + u8 flag_field[2]; |
|---|
| 62 | + __be64 correction; |
|---|
| 63 | + __be32 reserved2; |
|---|
| 64 | + struct port_identity source_port_identity; |
|---|
| 65 | + __be16 sequence_id; |
|---|
| 66 | + u8 control; |
|---|
| 67 | + u8 log_message_interval; |
|---|
| 68 | +} __packed; |
|---|
| 59 | 69 | |
|---|
| 60 | 70 | #if defined(CONFIG_NET_PTP_CLASSIFY) |
|---|
| 61 | 71 | /** |
|---|
| .. | .. |
|---|
| 70 | 80 | */ |
|---|
| 71 | 81 | unsigned int ptp_classify_raw(const struct sk_buff *skb); |
|---|
| 72 | 82 | |
|---|
| 83 | +/** |
|---|
| 84 | + * ptp_parse_header - Get pointer to the PTP v2 header |
|---|
| 85 | + * @skb: packet buffer |
|---|
| 86 | + * @type: type of the packet (see ptp_classify_raw()) |
|---|
| 87 | + * |
|---|
| 88 | + * This function takes care of the VLAN, UDP, IPv4 and IPv6 headers. The length |
|---|
| 89 | + * is checked. |
|---|
| 90 | + * |
|---|
| 91 | + * Note, internally skb_mac_header() is used. Make sure that the @skb is |
|---|
| 92 | + * initialized accordingly. |
|---|
| 93 | + * |
|---|
| 94 | + * Return: Pointer to the ptp v2 header or NULL if not found |
|---|
| 95 | + */ |
|---|
| 96 | +struct ptp_header *ptp_parse_header(struct sk_buff *skb, unsigned int type); |
|---|
| 97 | + |
|---|
| 98 | +/** |
|---|
| 99 | + * ptp_get_msgtype - Extract ptp message type from given header |
|---|
| 100 | + * @hdr: ptp header |
|---|
| 101 | + * @type: type of the packet (see ptp_classify_raw()) |
|---|
| 102 | + * |
|---|
| 103 | + * This function returns the message type for a given ptp header. It takes care |
|---|
| 104 | + * of the different ptp header versions (v1 or v2). |
|---|
| 105 | + * |
|---|
| 106 | + * Return: The message type |
|---|
| 107 | + */ |
|---|
| 108 | +static inline u8 ptp_get_msgtype(const struct ptp_header *hdr, |
|---|
| 109 | + unsigned int type) |
|---|
| 110 | +{ |
|---|
| 111 | + u8 msgtype; |
|---|
| 112 | + |
|---|
| 113 | + if (unlikely(type & PTP_CLASS_V1)) { |
|---|
| 114 | + /* msg type is located at the control field for ptp v1 */ |
|---|
| 115 | + msgtype = hdr->control; |
|---|
| 116 | + } else { |
|---|
| 117 | + msgtype = hdr->tsmt & 0x0f; |
|---|
| 118 | + } |
|---|
| 119 | + |
|---|
| 120 | + return msgtype; |
|---|
| 121 | +} |
|---|
| 122 | + |
|---|
| 73 | 123 | void __init ptp_classifier_init(void); |
|---|
| 74 | 124 | #else |
|---|
| 75 | 125 | static inline void ptp_classifier_init(void) |
|---|
| .. | .. |
|---|
| 79 | 129 | { |
|---|
| 80 | 130 | return PTP_CLASS_NONE; |
|---|
| 81 | 131 | } |
|---|
| 132 | +static inline struct ptp_header *ptp_parse_header(struct sk_buff *skb, |
|---|
| 133 | + unsigned int type) |
|---|
| 134 | +{ |
|---|
| 135 | + return NULL; |
|---|
| 136 | +} |
|---|
| 137 | +static inline u8 ptp_get_msgtype(const struct ptp_header *hdr, |
|---|
| 138 | + unsigned int type) |
|---|
| 139 | +{ |
|---|
| 140 | + /* The return is meaningless. The stub function would not be |
|---|
| 141 | + * executed since no available header from ptp_parse_header. |
|---|
| 142 | + */ |
|---|
| 143 | + return 0; |
|---|
| 144 | +} |
|---|
| 82 | 145 | #endif |
|---|
| 83 | 146 | #endif /* _PTP_CLASSIFY_H_ */ |
|---|