Loading...
1/* SPDX-License-Identifier: GPL-2.0-or-later */
2/*
3 * drivers/net/ethernet/rocker/rocker_tlv.h - Rocker switch device driver
4 * Copyright (c) 2014-2016 Jiri Pirko <jiri@mellanox.com>
5 * Copyright (c) 2014 Scott Feldman <sfeldma@gmail.com>
6 */
7
8#ifndef _ROCKER_TLV_H
9#define _ROCKER_TLV_H
10
11#include <linux/types.h>
12
13#include "rocker_hw.h"
14#include "rocker.h"
15
16#define ROCKER_TLV_ALIGNTO 8U
17#define ROCKER_TLV_ALIGN(len) \
18 (((len) + ROCKER_TLV_ALIGNTO - 1) & ~(ROCKER_TLV_ALIGNTO - 1))
19#define ROCKER_TLV_HDRLEN ROCKER_TLV_ALIGN(sizeof(struct rocker_tlv))
20
21/* <------- ROCKER_TLV_HDRLEN -------> <--- ROCKER_TLV_ALIGN(payload) --->
22 * +-----------------------------+- - -+- - - - - - - - - - - - - - -+- - -+
23 * | Header | Pad | Payload | Pad |
24 * | (struct rocker_tlv) | ing | | ing |
25 * +-----------------------------+- - -+- - - - - - - - - - - - - - -+- - -+
26 * <--------------------------- tlv->len -------------------------->
27 */
28
29static inline struct rocker_tlv *rocker_tlv_next(const struct rocker_tlv *tlv,
30 int *remaining)
31{
32 int totlen = ROCKER_TLV_ALIGN(tlv->len);
33
34 *remaining -= totlen;
35 return (struct rocker_tlv *) ((char *) tlv + totlen);
36}
37
38static inline int rocker_tlv_ok(const struct rocker_tlv *tlv, int remaining)
39{
40 return remaining >= (int) ROCKER_TLV_HDRLEN &&
41 tlv->len >= ROCKER_TLV_HDRLEN &&
42 tlv->len <= remaining;
43}
44
45#define rocker_tlv_for_each(pos, head, len, rem) \
46 for (pos = head, rem = len; \
47 rocker_tlv_ok(pos, rem); \
48 pos = rocker_tlv_next(pos, &(rem)))
49
50#define rocker_tlv_for_each_nested(pos, tlv, rem) \
51 rocker_tlv_for_each(pos, rocker_tlv_data(tlv), \
52 rocker_tlv_len(tlv), rem)
53
54static inline int rocker_tlv_attr_size(int payload)
55{
56 return ROCKER_TLV_HDRLEN + payload;
57}
58
59static inline int rocker_tlv_total_size(int payload)
60{
61 return ROCKER_TLV_ALIGN(rocker_tlv_attr_size(payload));
62}
63
64static inline int rocker_tlv_padlen(int payload)
65{
66 return rocker_tlv_total_size(payload) - rocker_tlv_attr_size(payload);
67}
68
69static inline int rocker_tlv_type(const struct rocker_tlv *tlv)
70{
71 return tlv->type;
72}
73
74static inline void *rocker_tlv_data(const struct rocker_tlv *tlv)
75{
76 return (char *) tlv + ROCKER_TLV_HDRLEN;
77}
78
79static inline int rocker_tlv_len(const struct rocker_tlv *tlv)
80{
81 return tlv->len - ROCKER_TLV_HDRLEN;
82}
83
84static inline u8 rocker_tlv_get_u8(const struct rocker_tlv *tlv)
85{
86 return *(u8 *) rocker_tlv_data(tlv);
87}
88
89static inline u16 rocker_tlv_get_u16(const struct rocker_tlv *tlv)
90{
91 return *(u16 *) rocker_tlv_data(tlv);
92}
93
94static inline __be16 rocker_tlv_get_be16(const struct rocker_tlv *tlv)
95{
96 return *(__be16 *) rocker_tlv_data(tlv);
97}
98
99static inline u32 rocker_tlv_get_u32(const struct rocker_tlv *tlv)
100{
101 return *(u32 *) rocker_tlv_data(tlv);
102}
103
104static inline u64 rocker_tlv_get_u64(const struct rocker_tlv *tlv)
105{
106 return *(u64 *) rocker_tlv_data(tlv);
107}
108
109void rocker_tlv_parse(const struct rocker_tlv **tb, int maxtype,
110 const char *buf, int buf_len);
111
112static inline void rocker_tlv_parse_nested(const struct rocker_tlv **tb,
113 int maxtype,
114 const struct rocker_tlv *tlv)
115{
116 rocker_tlv_parse(tb, maxtype, rocker_tlv_data(tlv),
117 rocker_tlv_len(tlv));
118}
119
120static inline void
121rocker_tlv_parse_desc(const struct rocker_tlv **tb, int maxtype,
122 const struct rocker_desc_info *desc_info)
123{
124 rocker_tlv_parse(tb, maxtype, desc_info->data,
125 desc_info->desc->tlv_size);
126}
127
128static inline struct rocker_tlv *
129rocker_tlv_start(struct rocker_desc_info *desc_info)
130{
131 return (struct rocker_tlv *) ((char *) desc_info->data +
132 desc_info->tlv_size);
133}
134
135int rocker_tlv_put(struct rocker_desc_info *desc_info,
136 int attrtype, int attrlen, const void *data);
137
138static inline int
139rocker_tlv_put_u8(struct rocker_desc_info *desc_info, int attrtype, u8 value)
140{
141 u8 tmp = value; /* work around GCC PR81715 */
142
143 return rocker_tlv_put(desc_info, attrtype, sizeof(u8), &tmp);
144}
145
146static inline int
147rocker_tlv_put_u16(struct rocker_desc_info *desc_info, int attrtype, u16 value)
148{
149 u16 tmp = value;
150
151 return rocker_tlv_put(desc_info, attrtype, sizeof(u16), &tmp);
152}
153
154static inline int
155rocker_tlv_put_be16(struct rocker_desc_info *desc_info, int attrtype, __be16 value)
156{
157 __be16 tmp = value;
158
159 return rocker_tlv_put(desc_info, attrtype, sizeof(__be16), &tmp);
160}
161
162static inline int
163rocker_tlv_put_u32(struct rocker_desc_info *desc_info, int attrtype, u32 value)
164{
165 u32 tmp = value;
166
167 return rocker_tlv_put(desc_info, attrtype, sizeof(u32), &tmp);
168}
169
170static inline int
171rocker_tlv_put_be32(struct rocker_desc_info *desc_info, int attrtype, __be32 value)
172{
173 __be32 tmp = value;
174
175 return rocker_tlv_put(desc_info, attrtype, sizeof(__be32), &tmp);
176}
177
178static inline int
179rocker_tlv_put_u64(struct rocker_desc_info *desc_info, int attrtype, u64 value)
180{
181 u64 tmp = value;
182
183 return rocker_tlv_put(desc_info, attrtype, sizeof(u64), &tmp);
184}
185
186static inline struct rocker_tlv *
187rocker_tlv_nest_start(struct rocker_desc_info *desc_info, int attrtype)
188{
189 struct rocker_tlv *start = rocker_tlv_start(desc_info);
190
191 if (rocker_tlv_put(desc_info, attrtype, 0, NULL) < 0)
192 return NULL;
193
194 return start;
195}
196
197static inline void rocker_tlv_nest_end(struct rocker_desc_info *desc_info,
198 struct rocker_tlv *start)
199{
200 start->len = (char *) rocker_tlv_start(desc_info) - (char *) start;
201}
202
203static inline void rocker_tlv_nest_cancel(struct rocker_desc_info *desc_info,
204 const struct rocker_tlv *start)
205{
206 desc_info->tlv_size = (const char *) start - desc_info->data;
207}
208
209#endif
1/*
2 * drivers/net/ethernet/rocker/rocker_tlv.h - Rocker switch device driver
3 * Copyright (c) 2014-2016 Jiri Pirko <jiri@mellanox.com>
4 * Copyright (c) 2014 Scott Feldman <sfeldma@gmail.com>
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
10 */
11
12#ifndef _ROCKER_TLV_H
13#define _ROCKER_TLV_H
14
15#include <linux/types.h>
16
17#include "rocker_hw.h"
18#include "rocker.h"
19
20#define ROCKER_TLV_ALIGNTO 8U
21#define ROCKER_TLV_ALIGN(len) \
22 (((len) + ROCKER_TLV_ALIGNTO - 1) & ~(ROCKER_TLV_ALIGNTO - 1))
23#define ROCKER_TLV_HDRLEN ROCKER_TLV_ALIGN(sizeof(struct rocker_tlv))
24
25/* <------- ROCKER_TLV_HDRLEN -------> <--- ROCKER_TLV_ALIGN(payload) --->
26 * +-----------------------------+- - -+- - - - - - - - - - - - - - -+- - -+
27 * | Header | Pad | Payload | Pad |
28 * | (struct rocker_tlv) | ing | | ing |
29 * +-----------------------------+- - -+- - - - - - - - - - - - - - -+- - -+
30 * <--------------------------- tlv->len -------------------------->
31 */
32
33static inline struct rocker_tlv *rocker_tlv_next(const struct rocker_tlv *tlv,
34 int *remaining)
35{
36 int totlen = ROCKER_TLV_ALIGN(tlv->len);
37
38 *remaining -= totlen;
39 return (struct rocker_tlv *) ((char *) tlv + totlen);
40}
41
42static inline int rocker_tlv_ok(const struct rocker_tlv *tlv, int remaining)
43{
44 return remaining >= (int) ROCKER_TLV_HDRLEN &&
45 tlv->len >= ROCKER_TLV_HDRLEN &&
46 tlv->len <= remaining;
47}
48
49#define rocker_tlv_for_each(pos, head, len, rem) \
50 for (pos = head, rem = len; \
51 rocker_tlv_ok(pos, rem); \
52 pos = rocker_tlv_next(pos, &(rem)))
53
54#define rocker_tlv_for_each_nested(pos, tlv, rem) \
55 rocker_tlv_for_each(pos, rocker_tlv_data(tlv), \
56 rocker_tlv_len(tlv), rem)
57
58static inline int rocker_tlv_attr_size(int payload)
59{
60 return ROCKER_TLV_HDRLEN + payload;
61}
62
63static inline int rocker_tlv_total_size(int payload)
64{
65 return ROCKER_TLV_ALIGN(rocker_tlv_attr_size(payload));
66}
67
68static inline int rocker_tlv_padlen(int payload)
69{
70 return rocker_tlv_total_size(payload) - rocker_tlv_attr_size(payload);
71}
72
73static inline int rocker_tlv_type(const struct rocker_tlv *tlv)
74{
75 return tlv->type;
76}
77
78static inline void *rocker_tlv_data(const struct rocker_tlv *tlv)
79{
80 return (char *) tlv + ROCKER_TLV_HDRLEN;
81}
82
83static inline int rocker_tlv_len(const struct rocker_tlv *tlv)
84{
85 return tlv->len - ROCKER_TLV_HDRLEN;
86}
87
88static inline u8 rocker_tlv_get_u8(const struct rocker_tlv *tlv)
89{
90 return *(u8 *) rocker_tlv_data(tlv);
91}
92
93static inline u16 rocker_tlv_get_u16(const struct rocker_tlv *tlv)
94{
95 return *(u16 *) rocker_tlv_data(tlv);
96}
97
98static inline __be16 rocker_tlv_get_be16(const struct rocker_tlv *tlv)
99{
100 return *(__be16 *) rocker_tlv_data(tlv);
101}
102
103static inline u32 rocker_tlv_get_u32(const struct rocker_tlv *tlv)
104{
105 return *(u32 *) rocker_tlv_data(tlv);
106}
107
108static inline u64 rocker_tlv_get_u64(const struct rocker_tlv *tlv)
109{
110 return *(u64 *) rocker_tlv_data(tlv);
111}
112
113void rocker_tlv_parse(const struct rocker_tlv **tb, int maxtype,
114 const char *buf, int buf_len);
115
116static inline void rocker_tlv_parse_nested(const struct rocker_tlv **tb,
117 int maxtype,
118 const struct rocker_tlv *tlv)
119{
120 rocker_tlv_parse(tb, maxtype, rocker_tlv_data(tlv),
121 rocker_tlv_len(tlv));
122}
123
124static inline void
125rocker_tlv_parse_desc(const struct rocker_tlv **tb, int maxtype,
126 const struct rocker_desc_info *desc_info)
127{
128 rocker_tlv_parse(tb, maxtype, desc_info->data,
129 desc_info->desc->tlv_size);
130}
131
132static inline struct rocker_tlv *
133rocker_tlv_start(struct rocker_desc_info *desc_info)
134{
135 return (struct rocker_tlv *) ((char *) desc_info->data +
136 desc_info->tlv_size);
137}
138
139int rocker_tlv_put(struct rocker_desc_info *desc_info,
140 int attrtype, int attrlen, const void *data);
141
142static inline int
143rocker_tlv_put_u8(struct rocker_desc_info *desc_info, int attrtype, u8 value)
144{
145 u8 tmp = value; /* work around GCC PR81715 */
146
147 return rocker_tlv_put(desc_info, attrtype, sizeof(u8), &tmp);
148}
149
150static inline int
151rocker_tlv_put_u16(struct rocker_desc_info *desc_info, int attrtype, u16 value)
152{
153 u16 tmp = value;
154
155 return rocker_tlv_put(desc_info, attrtype, sizeof(u16), &tmp);
156}
157
158static inline int
159rocker_tlv_put_be16(struct rocker_desc_info *desc_info, int attrtype, __be16 value)
160{
161 __be16 tmp = value;
162
163 return rocker_tlv_put(desc_info, attrtype, sizeof(__be16), &tmp);
164}
165
166static inline int
167rocker_tlv_put_u32(struct rocker_desc_info *desc_info, int attrtype, u32 value)
168{
169 u32 tmp = value;
170
171 return rocker_tlv_put(desc_info, attrtype, sizeof(u32), &tmp);
172}
173
174static inline int
175rocker_tlv_put_be32(struct rocker_desc_info *desc_info, int attrtype, __be32 value)
176{
177 __be32 tmp = value;
178
179 return rocker_tlv_put(desc_info, attrtype, sizeof(__be32), &tmp);
180}
181
182static inline int
183rocker_tlv_put_u64(struct rocker_desc_info *desc_info, int attrtype, u64 value)
184{
185 u64 tmp = value;
186
187 return rocker_tlv_put(desc_info, attrtype, sizeof(u64), &tmp);
188}
189
190static inline struct rocker_tlv *
191rocker_tlv_nest_start(struct rocker_desc_info *desc_info, int attrtype)
192{
193 struct rocker_tlv *start = rocker_tlv_start(desc_info);
194
195 if (rocker_tlv_put(desc_info, attrtype, 0, NULL) < 0)
196 return NULL;
197
198 return start;
199}
200
201static inline void rocker_tlv_nest_end(struct rocker_desc_info *desc_info,
202 struct rocker_tlv *start)
203{
204 start->len = (char *) rocker_tlv_start(desc_info) - (char *) start;
205}
206
207static inline void rocker_tlv_nest_cancel(struct rocker_desc_info *desc_info,
208 const struct rocker_tlv *start)
209{
210 desc_info->tlv_size = (const char *) start - desc_info->data;
211}
212
213#endif