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 
rocker_tlv_next(const struct rocker_tlv * tlv,int * remaining)29 static 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 
rocker_tlv_ok(const struct rocker_tlv * tlv,int remaining)38 static 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 
rocker_tlv_attr_size(int payload)54 static inline int rocker_tlv_attr_size(int payload)
55 {
56 	return ROCKER_TLV_HDRLEN + payload;
57 }
58 
rocker_tlv_total_size(int payload)59 static inline int rocker_tlv_total_size(int payload)
60 {
61 	return ROCKER_TLV_ALIGN(rocker_tlv_attr_size(payload));
62 }
63 
rocker_tlv_padlen(int payload)64 static inline int rocker_tlv_padlen(int payload)
65 {
66 	return rocker_tlv_total_size(payload) - rocker_tlv_attr_size(payload);
67 }
68 
rocker_tlv_type(const struct rocker_tlv * tlv)69 static inline int rocker_tlv_type(const struct rocker_tlv *tlv)
70 {
71 	return tlv->type;
72 }
73 
rocker_tlv_data(const struct rocker_tlv * tlv)74 static inline void *rocker_tlv_data(const struct rocker_tlv *tlv)
75 {
76 	return (char *) tlv + ROCKER_TLV_HDRLEN;
77 }
78 
rocker_tlv_len(const struct rocker_tlv * tlv)79 static inline int rocker_tlv_len(const struct rocker_tlv *tlv)
80 {
81 	return tlv->len - ROCKER_TLV_HDRLEN;
82 }
83 
rocker_tlv_get_u8(const struct rocker_tlv * tlv)84 static inline u8 rocker_tlv_get_u8(const struct rocker_tlv *tlv)
85 {
86 	return *(u8 *) rocker_tlv_data(tlv);
87 }
88 
rocker_tlv_get_u16(const struct rocker_tlv * tlv)89 static inline u16 rocker_tlv_get_u16(const struct rocker_tlv *tlv)
90 {
91 	return *(u16 *) rocker_tlv_data(tlv);
92 }
93 
rocker_tlv_get_be16(const struct rocker_tlv * tlv)94 static inline __be16 rocker_tlv_get_be16(const struct rocker_tlv *tlv)
95 {
96 	return *(__be16 *) rocker_tlv_data(tlv);
97 }
98 
rocker_tlv_get_u32(const struct rocker_tlv * tlv)99 static inline u32 rocker_tlv_get_u32(const struct rocker_tlv *tlv)
100 {
101 	return *(u32 *) rocker_tlv_data(tlv);
102 }
103 
rocker_tlv_get_u64(const struct rocker_tlv * tlv)104 static inline u64 rocker_tlv_get_u64(const struct rocker_tlv *tlv)
105 {
106 	return *(u64 *) rocker_tlv_data(tlv);
107 }
108 
109 void rocker_tlv_parse(const struct rocker_tlv **tb, int maxtype,
110 		      const char *buf, int buf_len);
111 
rocker_tlv_parse_nested(const struct rocker_tlv ** tb,int maxtype,const struct rocker_tlv * tlv)112 static 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 
120 static inline void
rocker_tlv_parse_desc(const struct rocker_tlv ** tb,int maxtype,const struct rocker_desc_info * desc_info)121 rocker_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 
128 static inline struct rocker_tlv *
rocker_tlv_start(struct rocker_desc_info * desc_info)129 rocker_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 
135 int rocker_tlv_put(struct rocker_desc_info *desc_info,
136 		   int attrtype, int attrlen, const void *data);
137 
138 static inline int
rocker_tlv_put_u8(struct rocker_desc_info * desc_info,int attrtype,u8 value)139 rocker_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 
146 static inline int
rocker_tlv_put_u16(struct rocker_desc_info * desc_info,int attrtype,u16 value)147 rocker_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 
154 static inline int
rocker_tlv_put_be16(struct rocker_desc_info * desc_info,int attrtype,__be16 value)155 rocker_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 
162 static inline int
rocker_tlv_put_u32(struct rocker_desc_info * desc_info,int attrtype,u32 value)163 rocker_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 
170 static inline int
rocker_tlv_put_be32(struct rocker_desc_info * desc_info,int attrtype,__be32 value)171 rocker_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 
178 static inline int
rocker_tlv_put_u64(struct rocker_desc_info * desc_info,int attrtype,u64 value)179 rocker_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 
186 static inline struct rocker_tlv *
rocker_tlv_nest_start(struct rocker_desc_info * desc_info,int attrtype)187 rocker_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 
rocker_tlv_nest_end(struct rocker_desc_info * desc_info,struct rocker_tlv * start)197 static 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 
rocker_tlv_nest_cancel(struct rocker_desc_info * desc_info,const struct rocker_tlv * start)203 static 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
210