1/* SPDX-License-Identifier: GPL-2.0
2 * Copyright 2019-2021 NXP
3 */
4
5#ifndef _NET_DSA_TAG_OCELOT_H
6#define _NET_DSA_TAG_OCELOT_H
7
8#include <linux/kthread.h>
9#include <linux/packing.h>
10#include <linux/skbuff.h>
11#include <net/dsa.h>
12
13struct ocelot_skb_cb {
14 struct sk_buff *clone;
15 unsigned int ptp_class; /* valid only for clones */
16 u32 tstamp_lo;
17 u8 ptp_cmd;
18 u8 ts_id;
19};
20
21#define OCELOT_SKB_CB(skb) \
22 ((struct ocelot_skb_cb *)((skb)->cb))
23
24#define IFH_TAG_TYPE_C 0
25#define IFH_TAG_TYPE_S 1
26
27#define IFH_REW_OP_NOOP 0x0
28#define IFH_REW_OP_DSCP 0x1
29#define IFH_REW_OP_ONE_STEP_PTP 0x2
30#define IFH_REW_OP_TWO_STEP_PTP 0x3
31#define IFH_REW_OP_ORIGIN_PTP 0x5
32
33#define OCELOT_TAG_LEN 16
34#define OCELOT_SHORT_PREFIX_LEN 4
35#define OCELOT_LONG_PREFIX_LEN 16
36#define OCELOT_TOTAL_TAG_LEN (OCELOT_SHORT_PREFIX_LEN + OCELOT_TAG_LEN)
37
38/* The CPU injection header and the CPU extraction header can have 3 types of
39 * prefixes: long, short and no prefix. The format of the header itself is the
40 * same in all 3 cases.
41 *
42 * Extraction with long prefix:
43 *
44 * +-------------------+-------------------+------+------+------------+-------+
45 * | ff:ff:ff:ff:ff:ff | fe:ff:ff:ff:ff:ff | 8880 | 000a | extraction | frame |
46 * | | | | | header | |
47 * +-------------------+-------------------+------+------+------------+-------+
48 * 48 bits 48 bits 16 bits 16 bits 128 bits
49 *
50 * Extraction with short prefix:
51 *
52 * +------+------+------------+-------+
53 * | 8880 | 000a | extraction | frame |
54 * | | | header | |
55 * +------+------+------------+-------+
56 * 16 bits 16 bits 128 bits
57 *
58 * Extraction with no prefix:
59 *
60 * +------------+-------+
61 * | extraction | frame |
62 * | header | |
63 * +------------+-------+
64 * 128 bits
65 *
66 *
67 * Injection with long prefix:
68 *
69 * +-------------------+-------------------+------+------+------------+-------+
70 * | any dmac | any smac | 8880 | 000a | injection | frame |
71 * | | | | | header | |
72 * +-------------------+-------------------+------+------+------------+-------+
73 * 48 bits 48 bits 16 bits 16 bits 128 bits
74 *
75 * Injection with short prefix:
76 *
77 * +------+------+------------+-------+
78 * | 8880 | 000a | injection | frame |
79 * | | | header | |
80 * +------+------+------------+-------+
81 * 16 bits 16 bits 128 bits
82 *
83 * Injection with no prefix:
84 *
85 * +------------+-------+
86 * | injection | frame |
87 * | header | |
88 * +------------+-------+
89 * 128 bits
90 *
91 * The injection header looks like this (network byte order, bit 127
92 * is part of lowest address byte in memory, bit 0 is part of highest
93 * address byte):
94 *
95 * +------+------+------+------+------+------+------+------+
96 * 127:120 |BYPASS| MASQ | MASQ_PORT |REW_OP|REW_OP|
97 * +------+------+------+------+------+------+------+------+
98 * 119:112 | REW_OP |
99 * +------+------+------+------+------+------+------+------+
100 * 111:104 | REW_VAL |
101 * +------+------+------+------+------+------+------+------+
102 * 103: 96 | REW_VAL |
103 * +------+------+------+------+------+------+------+------+
104 * 95: 88 | REW_VAL |
105 * +------+------+------+------+------+------+------+------+
106 * 87: 80 | REW_VAL |
107 * +------+------+------+------+------+------+------+------+
108 * 79: 72 | RSV |
109 * +------+------+------+------+------+------+------+------+
110 * 71: 64 | RSV | DEST |
111 * +------+------+------+------+------+------+------+------+
112 * 63: 56 | DEST |
113 * +------+------+------+------+------+------+------+------+
114 * 55: 48 | RSV |
115 * +------+------+------+------+------+------+------+------+
116 * 47: 40 | RSV | SRC_PORT | RSV |TFRM_TIMER|
117 * +------+------+------+------+------+------+------+------+
118 * 39: 32 | TFRM_TIMER | RSV |
119 * +------+------+------+------+------+------+------+------+
120 * 31: 24 | RSV | DP | POP_CNT | CPUQ |
121 * +------+------+------+------+------+------+------+------+
122 * 23: 16 | CPUQ | QOS_CLASS |TAG_TYPE|
123 * +------+------+------+------+------+------+------+------+
124 * 15: 8 | PCP | DEI | VID |
125 * +------+------+------+------+------+------+------+------+
126 * 7: 0 | VID |
127 * +------+------+------+------+------+------+------+------+
128 *
129 * And the extraction header looks like this:
130 *
131 * +------+------+------+------+------+------+------+------+
132 * 127:120 | RSV | REW_OP |
133 * +------+------+------+------+------+------+------+------+
134 * 119:112 | REW_OP | REW_VAL |
135 * +------+------+------+------+------+------+------+------+
136 * 111:104 | REW_VAL |
137 * +------+------+------+------+------+------+------+------+
138 * 103: 96 | REW_VAL |
139 * +------+------+------+------+------+------+------+------+
140 * 95: 88 | REW_VAL |
141 * +------+------+------+------+------+------+------+------+
142 * 87: 80 | REW_VAL | LLEN |
143 * +------+------+------+------+------+------+------+------+
144 * 79: 72 | LLEN | WLEN |
145 * +------+------+------+------+------+------+------+------+
146 * 71: 64 | WLEN | RSV |
147 * +------+------+------+------+------+------+------+------+
148 * 63: 56 | RSV |
149 * +------+------+------+------+------+------+------+------+
150 * 55: 48 | RSV |
151 * +------+------+------+------+------+------+------+------+
152 * 47: 40 | RSV | SRC_PORT | ACL_ID |
153 * +------+------+------+------+------+------+------+------+
154 * 39: 32 | ACL_ID | RSV | SFLOW_ID |
155 * +------+------+------+------+------+------+------+------+
156 * 31: 24 |ACL_HIT| DP | LRN_FLAGS | CPUQ |
157 * +------+------+------+------+------+------+------+------+
158 * 23: 16 | CPUQ | QOS_CLASS |TAG_TYPE|
159 * +------+------+------+------+------+------+------+------+
160 * 15: 8 | PCP | DEI | VID |
161 * +------+------+------+------+------+------+------+------+
162 * 7: 0 | VID |
163 * +------+------+------+------+------+------+------+------+
164 */
165
166struct felix_deferred_xmit_work {
167 struct dsa_port *dp;
168 struct sk_buff *skb;
169 struct kthread_work work;
170};
171
172struct ocelot_8021q_tagger_data {
173 void (*xmit_work_fn)(struct kthread_work *work);
174};
175
176static inline struct ocelot_8021q_tagger_data *
177ocelot_8021q_tagger_data(struct dsa_switch *ds)
178{
179 BUG_ON(ds->dst->tag_ops->proto != DSA_TAG_PROTO_OCELOT_8021Q);
180
181 return ds->tagger_data;
182}
183
184static inline void ocelot_xfh_get_rew_val(void *extraction, u64 *rew_val)
185{
186 packing(pbuf: extraction, uval: rew_val, startbit: 116, endbit: 85, OCELOT_TAG_LEN, op: UNPACK, quirks: 0);
187}
188
189static inline void ocelot_xfh_get_len(void *extraction, u64 *len)
190{
191 u64 llen, wlen;
192
193 packing(pbuf: extraction, uval: &llen, startbit: 84, endbit: 79, OCELOT_TAG_LEN, op: UNPACK, quirks: 0);
194 packing(pbuf: extraction, uval: &wlen, startbit: 78, endbit: 71, OCELOT_TAG_LEN, op: UNPACK, quirks: 0);
195
196 *len = 60 * wlen + llen - 80;
197}
198
199static inline void ocelot_xfh_get_src_port(void *extraction, u64 *src_port)
200{
201 packing(pbuf: extraction, uval: src_port, startbit: 46, endbit: 43, OCELOT_TAG_LEN, op: UNPACK, quirks: 0);
202}
203
204static inline void ocelot_xfh_get_qos_class(void *extraction, u64 *qos_class)
205{
206 packing(pbuf: extraction, uval: qos_class, startbit: 19, endbit: 17, OCELOT_TAG_LEN, op: UNPACK, quirks: 0);
207}
208
209static inline void ocelot_xfh_get_tag_type(void *extraction, u64 *tag_type)
210{
211 packing(pbuf: extraction, uval: tag_type, startbit: 16, endbit: 16, OCELOT_TAG_LEN, op: UNPACK, quirks: 0);
212}
213
214static inline void ocelot_xfh_get_vlan_tci(void *extraction, u64 *vlan_tci)
215{
216 packing(pbuf: extraction, uval: vlan_tci, startbit: 15, endbit: 0, OCELOT_TAG_LEN, op: UNPACK, quirks: 0);
217}
218
219static inline void ocelot_ifh_set_bypass(void *injection, u64 bypass)
220{
221 packing(pbuf: injection, uval: &bypass, startbit: 127, endbit: 127, OCELOT_TAG_LEN, op: PACK, quirks: 0);
222}
223
224static inline void ocelot_ifh_set_rew_op(void *injection, u64 rew_op)
225{
226 packing(pbuf: injection, uval: &rew_op, startbit: 125, endbit: 117, OCELOT_TAG_LEN, op: PACK, quirks: 0);
227}
228
229static inline void ocelot_ifh_set_dest(void *injection, u64 dest)
230{
231 packing(pbuf: injection, uval: &dest, startbit: 67, endbit: 56, OCELOT_TAG_LEN, op: PACK, quirks: 0);
232}
233
234static inline void ocelot_ifh_set_qos_class(void *injection, u64 qos_class)
235{
236 packing(pbuf: injection, uval: &qos_class, startbit: 19, endbit: 17, OCELOT_TAG_LEN, op: PACK, quirks: 0);
237}
238
239static inline void seville_ifh_set_dest(void *injection, u64 dest)
240{
241 packing(pbuf: injection, uval: &dest, startbit: 67, endbit: 57, OCELOT_TAG_LEN, op: PACK, quirks: 0);
242}
243
244static inline void ocelot_ifh_set_src(void *injection, u64 src)
245{
246 packing(pbuf: injection, uval: &src, startbit: 46, endbit: 43, OCELOT_TAG_LEN, op: PACK, quirks: 0);
247}
248
249static inline void ocelot_ifh_set_tag_type(void *injection, u64 tag_type)
250{
251 packing(pbuf: injection, uval: &tag_type, startbit: 16, endbit: 16, OCELOT_TAG_LEN, op: PACK, quirks: 0);
252}
253
254static inline void ocelot_ifh_set_vlan_tci(void *injection, u64 vlan_tci)
255{
256 packing(pbuf: injection, uval: &vlan_tci, startbit: 15, endbit: 0, OCELOT_TAG_LEN, op: PACK, quirks: 0);
257}
258
259/* Determine the PTP REW_OP to use for injecting the given skb */
260static inline u32 ocelot_ptp_rew_op(struct sk_buff *skb)
261{
262 struct sk_buff *clone = OCELOT_SKB_CB(skb)->clone;
263 u8 ptp_cmd = OCELOT_SKB_CB(skb)->ptp_cmd;
264 u32 rew_op = 0;
265
266 if (ptp_cmd == IFH_REW_OP_TWO_STEP_PTP && clone) {
267 rew_op = ptp_cmd;
268 rew_op |= OCELOT_SKB_CB(clone)->ts_id << 3;
269 } else if (ptp_cmd == IFH_REW_OP_ORIGIN_PTP) {
270 rew_op = ptp_cmd;
271 }
272
273 return rew_op;
274}
275
276#endif
277

source code of linux/include/linux/dsa/ocelot.h