65
65
#define GRA_MASK 0x0006
66
66
#define O_MASK 0x0001
67
67
68
+ #define HWID_OFFSET 4
69
+ #define DIR_OFFSET 3
70
+
68
71
/* ERSPAN version 2 metadata header */
69
72
struct erspan_md2 {
70
73
__be32 timestamp;
71
74
__be16 sgt; /* security group tag */
72
- __be16 flags;
73
- #define P_OFFSET 15
74
- #define FT_OFFSET 10
75
- #define HWID_OFFSET 4
76
- #define DIR_OFFSET 3
77
- #define GRA_OFFSET 1
75
+ #if defined(__LITTLE_ENDIAN_BITFIELD)
76
+ __u8 hwid_upper:2,
77
+ ft:5,
78
+ p:1;
79
+ __u8 o:1,
80
+ gra:2,
81
+ dir:1,
82
+ hwid:4;
83
+ #elif defined(__BIG_ENDIAN_BITFIELD)
84
+ __u8 p:1,
85
+ ft:5,
86
+ hwid_upper:2;
87
+ __u8 hwid:4,
88
+ dir:1,
89
+ gra:2,
90
+ o:1;
91
+ #endif
78
92
};
79
93
80
94
enum erspan_encap_type {
@@ -95,15 +109,62 @@ struct erspan_metadata {
95
109
};
96
110
97
111
struct erspan_base_hdr {
98
- __be16 ver_vlan;
99
- #define VER_OFFSET 12
100
- __be16 session_id;
101
- #define COS_OFFSET 13
102
- #define EN_OFFSET 11
103
- #define BSO_OFFSET EN_OFFSET
104
- #define T_OFFSET 10
112
+ #if defined(__LITTLE_ENDIAN_BITFIELD)
113
+ __u8 vlan_upper:4,
114
+ ver:4;
115
+ __u8 vlan:8;
116
+ __u8 session_id_upper:2,
117
+ t:1,
118
+ en:2,
119
+ cos:3;
120
+ __u8 session_id:8;
121
+ #elif defined(__BIG_ENDIAN_BITFIELD)
122
+ __u8 ver: 4,
123
+ vlan_upper:4;
124
+ __u8 vlan:8;
125
+ __u8 cos:3,
126
+ en:2,
127
+ t:1,
128
+ session_id_upper:2;
129
+ __u8 session_id:8;
130
+ #else
131
+ #error "Please fix <asm/byteorder.h>"
132
+ #endif
105
133
};
106
134
135
+ static inline void set_session_id(struct erspan_base_hdr *ershdr, u16 id)
136
+ {
137
+ ershdr->session_id = id & 0xff;
138
+ ershdr->session_id_upper = (id >> 8) & 0x3;
139
+ }
140
+
141
+ static inline u16 get_session_id(const struct erspan_base_hdr *ershdr)
142
+ {
143
+ return (ershdr->session_id_upper << 8) + ershdr->session_id;
144
+ }
145
+
146
+ static inline void set_vlan(struct erspan_base_hdr *ershdr, u16 vlan)
147
+ {
148
+ ershdr->vlan = vlan & 0xff;
149
+ ershdr->vlan_upper = (vlan >> 8) & 0xf;
150
+ }
151
+
152
+ static inline u16 get_vlan(const struct erspan_base_hdr *ershdr)
153
+ {
154
+ return (ershdr->vlan_upper << 8) + ershdr->vlan;
155
+ }
156
+
157
+ static inline void set_hwid(struct erspan_md2 *md2, u8 hwid)
158
+ {
159
+ md2->hwid = hwid & 0xf;
160
+ md2->hwid_upper = (hwid >> 4) & 0x3;
161
+ }
162
+
163
+ static inline u8 get_hwid(const struct erspan_md2 *md2)
164
+ {
165
+ return (md2->hwid_upper << 4) + md2->hwid;
166
+ }
167
+
107
168
static inline int erspan_hdr_len(int version)
108
169
{
109
170
return sizeof(struct erspan_base_hdr) +
@@ -120,7 +181,7 @@ static inline u8 tos_to_cos(u8 tos)
120
181
}
121
182
122
183
static inline void erspan_build_header(struct sk_buff *skb,
123
- __be32 id, u32 index,
184
+ u32 id, u32 index,
124
185
bool truncate, bool is_ipv4)
125
186
{
126
187
struct ethhdr *eth = (struct ethhdr *)skb->data;
@@ -154,12 +215,12 @@ static inline void erspan_build_header(struct sk_buff *skb,
154
215
memset(ershdr, 0, sizeof(*ershdr) + ERSPAN_V1_MDSIZE);
155
216
156
217
/* Build base header */
157
- ershdr->ver_vlan = htons((vlan_tci & VLAN_MASK) |
158
- (ERSPAN_VERSION << VER_OFFSET) );
159
- ershdr->session_id = htons((u16)(ntohl(id) & ID_MASK) |
160
- ((tos_to_cos(tos) << COS_OFFSET) & COS_MASK) |
161
- (enc_type << EN_OFFSET & EN_MASK) |
162
- ((truncate << T_OFFSET) & T_MASK) );
218
+ ershdr->ver = ERSPAN_VERSION;
219
+ ershdr->cos = tos_to_cos(tos );
220
+ ershdr->en = enc_type;
221
+ ershdr->t = truncate;
222
+ set_vlan(ershdr, vlan_tci);
223
+ set_session_id(ershdr, id );
163
224
164
225
/* Build metadata */
165
226
ersmd = (struct erspan_metadata *)(ershdr + 1);
@@ -187,7 +248,7 @@ static inline __be32 erspan_get_timestamp(void)
187
248
}
188
249
189
250
static inline void erspan_build_header_v2(struct sk_buff *skb,
190
- __be32 id, u8 direction, u16 hwid,
251
+ u32 id, u8 direction, u16 hwid,
191
252
bool truncate, bool is_ipv4)
192
253
{
193
254
struct ethhdr *eth = (struct ethhdr *)skb->data;
@@ -198,7 +259,6 @@ static inline void erspan_build_header_v2(struct sk_buff *skb,
198
259
__be16 tci;
199
260
} *qp;
200
261
u16 vlan_tci = 0;
201
- u16 session_id;
202
262
u8 gra = 0; /* 100 usec */
203
263
u8 bso = 0; /* Bad/Short/Oversized */
204
264
u8 sgt = 0;
@@ -221,22 +281,23 @@ static inline void erspan_build_header_v2(struct sk_buff *skb,
221
281
memset(ershdr, 0, sizeof(*ershdr) + ERSPAN_V2_MDSIZE);
222
282
223
283
/* Build base header */
224
- ershdr->ver_vlan = htons((vlan_tci & VLAN_MASK) |
225
- (ERSPAN_VERSION2 << VER_OFFSET));
226
- session_id = (u16)(ntohl(id) & ID_MASK) |
227
- ((tos_to_cos(tos) << COS_OFFSET) & COS_MASK) |
228
- (bso << BSO_OFFSET & BSO_MASK) |
229
- ((truncate << T_OFFSET) & T_MASK);
230
- ershdr->session_id = htons(session_id);
284
+ ershdr->ver = ERSPAN_VERSION2;
285
+ ershdr->cos = tos_to_cos(tos);
286
+ ershdr->en = bso;
287
+ ershdr->t = truncate;
288
+ set_vlan(ershdr, vlan_tci);
289
+ set_session_id(ershdr, id);
231
290
232
291
/* Build metadata */
233
292
md = (struct erspan_metadata *)(ershdr + 1);
234
293
md->u.md2.timestamp = erspan_get_timestamp();
235
294
md->u.md2.sgt = htons(sgt);
236
- md->u.md2.flags = htons(((1 << P_OFFSET) & P_MASK) |
237
- ((hwid << HWID_OFFSET) & HWID_MASK) |
238
- ((direction << DIR_OFFSET) & DIR_MASK) |
239
- ((gra << GRA_OFFSET) & GRA_MASK));
295
+ md->u.md2.p = 1;
296
+ md->u.md2.ft = 0;
297
+ md->u.md2.dir = direction;
298
+ md->u.md2.gra = gra;
299
+ md->u.md2.o = 0;
300
+ set_hwid(&md->u.md2, hwid);
240
301
}
241
302
242
303
#endif
0 commit comments