fd509160c8f6cc2f1ee81ae2594feb8952e37a8e
[sfrench/cifs-2.6.git] / drivers / net / ethernet / mellanox / mlx5 / core / diag / fs_tracepoint.c
1 /*
2  * Copyright (c) 2017, Mellanox Technologies. All rights reserved.
3  *
4  * This software is available to you under a choice of one of two
5  * licenses.  You may choose to be licensed under the terms of the GNU
6  * General Public License (GPL) Version 2, available from the file
7  * COPYING in the main directory of this source tree, or the
8  * OpenIB.org BSD license below:
9  *
10  *     Redistribution and use in source and binary forms, with or
11  *     without modification, are permitted provided that the following
12  *     conditions are met:
13  *
14  *      - Redistributions of source code must retain the above
15  *        copyright notice, this list of conditions and the following
16  *        disclaimer.
17  *
18  *      - Redistributions in binary form must reproduce the above
19  *        copyright notice, this list of conditions and the following
20  *        disclaimer in the documentation and/or other materials
21  *        provided with the distribution.
22  *
23  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
24  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
25  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
26  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
27  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
28  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
29  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
30  * SOFTWARE.
31  */
32
33 #define CREATE_TRACE_POINTS
34
35 #include "fs_tracepoint.h"
36 #include <linux/stringify.h>
37
38 #define DECLARE_MASK_VAL(type, name) struct {type m; type v; } name
39 #define MASK_VAL(type, spec, name, mask, val, fld)      \
40                 DECLARE_MASK_VAL(type, name) =          \
41                         {.m = MLX5_GET(spec, mask, fld),\
42                          .v = MLX5_GET(spec, val, fld)}
43 #define MASK_VAL_BE(type, spec, name, mask, val, fld)   \
44                     DECLARE_MASK_VAL(type, name) =      \
45                         {.m = MLX5_GET_BE(type, spec, mask, fld),\
46                          .v = MLX5_GET_BE(type, spec, val, fld)}
47 #define GET_MASKED_VAL(name) (name.m & name.v)
48
49 #define GET_MASK_VAL(name, type, mask, val, fld)        \
50                 (name.m = MLX5_GET(type, mask, fld),    \
51                  name.v = MLX5_GET(type, val, fld),     \
52                  name.m & name.v)
53 #define PRINT_MASKED_VAL(name, p, format) {             \
54         if (name.m)                     \
55                 trace_seq_printf(p, __stringify(name) "=" format " ", name.v); \
56         }
57 #define PRINT_MASKED_VALP(name, cast, p, format) {      \
58         if (name.m)                     \
59                 trace_seq_printf(p, __stringify(name) "=" format " ",          \
60                                  (cast)&name.v);\
61         }
62
63 static void print_lyr_2_4_hdrs(struct trace_seq *p,
64                                const u32 *mask, const u32 *value)
65 {
66 #define MASK_VAL_L2(type, name, fld) \
67         MASK_VAL(type, fte_match_set_lyr_2_4, name, mask, value, fld)
68         DECLARE_MASK_VAL(u64, smac) = {
69                 .m = MLX5_GET(fte_match_set_lyr_2_4, mask, smac_47_16) << 16 |
70                      MLX5_GET(fte_match_set_lyr_2_4, mask, smac_15_0),
71                 .v = MLX5_GET(fte_match_set_lyr_2_4, value, smac_47_16) << 16 |
72                      MLX5_GET(fte_match_set_lyr_2_4, value, smac_15_0)};
73         DECLARE_MASK_VAL(u64, dmac) = {
74                 .m = MLX5_GET(fte_match_set_lyr_2_4, mask, dmac_47_16) << 16 |
75                      MLX5_GET(fte_match_set_lyr_2_4, mask, dmac_15_0),
76                 .v = MLX5_GET(fte_match_set_lyr_2_4, value, dmac_47_16) << 16 |
77                      MLX5_GET(fte_match_set_lyr_2_4, value, dmac_15_0)};
78         MASK_VAL_L2(u16, ethertype, ethertype);
79
80         PRINT_MASKED_VALP(smac, u8 *, p, "%pM");
81         PRINT_MASKED_VALP(dmac, u8 *, p, "%pM");
82         PRINT_MASKED_VAL(ethertype, p, "%04x");
83
84         if (ethertype.m == 0xffff) {
85                 if (ethertype.v == ETH_P_IP) {
86 #define MASK_VAL_L2_BE(type, name, fld) \
87         MASK_VAL_BE(type, fte_match_set_lyr_2_4, name, mask, value, fld)
88                         MASK_VAL_L2_BE(u32, src_ipv4,
89                                        src_ipv4_src_ipv6.ipv4_layout.ipv4);
90                         MASK_VAL_L2_BE(u32, dst_ipv4,
91                                        dst_ipv4_dst_ipv6.ipv4_layout.ipv4);
92
93                         PRINT_MASKED_VALP(src_ipv4, typeof(&src_ipv4.v), p,
94                                           "%pI4");
95                         PRINT_MASKED_VALP(dst_ipv4, typeof(&dst_ipv4.v), p,
96                                           "%pI4");
97                 } else if (ethertype.v == ETH_P_IPV6) {
98                         static const struct in6_addr full_ones = {
99                                 .in6_u.u6_addr32 = {__constant_htonl(0xffffffff),
100                                                     __constant_htonl(0xffffffff),
101                                                     __constant_htonl(0xffffffff),
102                                                     __constant_htonl(0xffffffff)},
103                         };
104                         DECLARE_MASK_VAL(struct in6_addr, src_ipv6);
105                         DECLARE_MASK_VAL(struct in6_addr, dst_ipv6);
106
107                         memcpy(src_ipv6.m.in6_u.u6_addr8,
108                                MLX5_ADDR_OF(fte_match_set_lyr_2_4, mask,
109                                             src_ipv4_src_ipv6.ipv6_layout.ipv6),
110                                sizeof(src_ipv6.m));
111                         memcpy(dst_ipv6.m.in6_u.u6_addr8,
112                                MLX5_ADDR_OF(fte_match_set_lyr_2_4, mask,
113                                             dst_ipv4_dst_ipv6.ipv6_layout.ipv6),
114                                sizeof(dst_ipv6.m));
115                         memcpy(src_ipv6.v.in6_u.u6_addr8,
116                                MLX5_ADDR_OF(fte_match_set_lyr_2_4, value,
117                                             src_ipv4_src_ipv6.ipv6_layout.ipv6),
118                                sizeof(src_ipv6.v));
119                         memcpy(dst_ipv6.v.in6_u.u6_addr8,
120                                MLX5_ADDR_OF(fte_match_set_lyr_2_4, value,
121                                             dst_ipv4_dst_ipv6.ipv6_layout.ipv6),
122                                sizeof(dst_ipv6.v));
123
124                         if (!memcmp(&src_ipv6.m, &full_ones, sizeof(full_ones)))
125                                 trace_seq_printf(p, "src_ipv6=%pI6 ",
126                                                  &src_ipv6.v);
127                         if (!memcmp(&dst_ipv6.m, &full_ones, sizeof(full_ones)))
128                                 trace_seq_printf(p, "dst_ipv6=%pI6 ",
129                                                  &dst_ipv6.v);
130                 }
131         }
132
133 #define PRINT_MASKED_VAL_L2(type, name, fld, p, format) {\
134         MASK_VAL_L2(type, name, fld);                    \
135         PRINT_MASKED_VAL(name, p, format);               \
136 }
137
138         PRINT_MASKED_VAL_L2(u8, ip_protocol, ip_protocol, p, "%02x");
139         PRINT_MASKED_VAL_L2(u16, tcp_flags, tcp_flags, p, "%x");
140         PRINT_MASKED_VAL_L2(u16, tcp_sport, tcp_sport, p, "%u");
141         PRINT_MASKED_VAL_L2(u16, tcp_dport, tcp_dport, p, "%u");
142         PRINT_MASKED_VAL_L2(u16, udp_sport, udp_sport, p, "%u");
143         PRINT_MASKED_VAL_L2(u16, udp_dport, udp_dport, p, "%u");
144         PRINT_MASKED_VAL_L2(u16, first_vid, first_vid, p, "%04x");
145         PRINT_MASKED_VAL_L2(u8, first_prio, first_prio, p, "%x");
146         PRINT_MASKED_VAL_L2(u8, first_cfi, first_cfi, p, "%d");
147         PRINT_MASKED_VAL_L2(u8, ip_dscp, ip_dscp, p, "%02x");
148         PRINT_MASKED_VAL_L2(u8, ip_ecn, ip_ecn, p, "%x");
149         PRINT_MASKED_VAL_L2(u8, cvlan_tag, cvlan_tag, p, "%d");
150         PRINT_MASKED_VAL_L2(u8, svlan_tag, svlan_tag, p, "%d");
151         PRINT_MASKED_VAL_L2(u8, frag, frag, p, "%d");
152 }
153
154 static void print_misc_parameters_hdrs(struct trace_seq *p,
155                                        const u32 *mask, const u32 *value)
156 {
157 #define MASK_VAL_MISC(type, name, fld) \
158         MASK_VAL(type, fte_match_set_misc, name, mask, value, fld)
159 #define PRINT_MASKED_VAL_MISC(type, name, fld, p, format) {\
160         MASK_VAL_MISC(type, name, fld);                    \
161         PRINT_MASKED_VAL(name, p, format);                 \
162 }
163         DECLARE_MASK_VAL(u64, gre_key) = {
164                 .m = MLX5_GET(fte_match_set_misc, mask, gre_key_h) << 8 |
165                      MLX5_GET(fte_match_set_misc, mask, gre_key_l),
166                 .v = MLX5_GET(fte_match_set_misc, value, gre_key_h) << 8 |
167                      MLX5_GET(fte_match_set_misc, value, gre_key_l)};
168
169         PRINT_MASKED_VAL(gre_key, p, "%llu");
170         PRINT_MASKED_VAL_MISC(u32, source_sqn, source_sqn, p, "%u");
171         PRINT_MASKED_VAL_MISC(u16, source_port, source_port, p, "%u");
172         PRINT_MASKED_VAL_MISC(u8, outer_second_prio, outer_second_prio,
173                               p, "%u");
174         PRINT_MASKED_VAL_MISC(u8, outer_second_cfi, outer_second_cfi, p, "%u");
175         PRINT_MASKED_VAL_MISC(u16, outer_second_vid, outer_second_vid, p, "%u");
176         PRINT_MASKED_VAL_MISC(u8, inner_second_prio, inner_second_prio,
177                               p, "%u");
178         PRINT_MASKED_VAL_MISC(u8, inner_second_cfi, inner_second_cfi, p, "%u");
179         PRINT_MASKED_VAL_MISC(u16, inner_second_vid, inner_second_vid, p, "%u");
180
181         PRINT_MASKED_VAL_MISC(u8, outer_second_cvlan_tag,
182                               outer_second_cvlan_tag, p, "%u");
183         PRINT_MASKED_VAL_MISC(u8, inner_second_cvlan_tag,
184                               inner_second_cvlan_tag, p, "%u");
185         PRINT_MASKED_VAL_MISC(u8, outer_second_svlan_tag,
186                               outer_second_svlan_tag, p, "%u");
187         PRINT_MASKED_VAL_MISC(u8, inner_second_svlan_tag,
188                               inner_second_svlan_tag, p, "%u");
189
190         PRINT_MASKED_VAL_MISC(u8, gre_protocol, gre_protocol, p, "%u");
191
192         PRINT_MASKED_VAL_MISC(u32, vxlan_vni, vxlan_vni, p, "%u");
193         PRINT_MASKED_VAL_MISC(u32, outer_ipv6_flow_label, outer_ipv6_flow_label,
194                               p, "%x");
195         PRINT_MASKED_VAL_MISC(u32, inner_ipv6_flow_label, inner_ipv6_flow_label,
196                               p, "%x");
197 }
198
199 const char *parse_fs_hdrs(struct trace_seq *p,
200                           u8 match_criteria_enable,
201                           const u32 *mask_outer,
202                           const u32 *mask_misc,
203                           const u32 *mask_inner,
204                           const u32 *value_outer,
205                           const u32 *value_misc,
206                           const u32 *value_inner)
207 {
208         const char *ret = trace_seq_buffer_ptr(p);
209
210         if (match_criteria_enable &
211             1 << MLX5_CREATE_FLOW_GROUP_IN_MATCH_CRITERIA_ENABLE_OUTER_HEADERS) {
212                 trace_seq_printf(p, "[outer] ");
213                 print_lyr_2_4_hdrs(p, mask_outer, value_outer);
214         }
215
216         if (match_criteria_enable &
217             1 << MLX5_CREATE_FLOW_GROUP_IN_MATCH_CRITERIA_ENABLE_MISC_PARAMETERS) {
218                 trace_seq_printf(p, "[misc] ");
219                 print_misc_parameters_hdrs(p, mask_misc, value_misc);
220         }
221         if (match_criteria_enable &
222             1 << MLX5_CREATE_FLOW_GROUP_IN_MATCH_CRITERIA_ENABLE_INNER_HEADERS) {
223                 trace_seq_printf(p, "[inner] ");
224                 print_lyr_2_4_hdrs(p, mask_inner, value_inner);
225         }
226         trace_seq_putc(p, 0);
227         return ret;
228 }
229
230 const char *parse_fs_dst(struct trace_seq *p,
231                          const struct mlx5_flow_destination *dst,
232                          u32 counter_id)
233 {
234         const char *ret = trace_seq_buffer_ptr(p);
235
236         switch (dst->type) {
237         case MLX5_FLOW_DESTINATION_TYPE_VPORT:
238                 trace_seq_printf(p, "vport=%u\n", dst->vport_num);
239                 break;
240         case MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE:
241                 trace_seq_printf(p, "ft=%p\n", dst->ft);
242                 break;
243         case MLX5_FLOW_DESTINATION_TYPE_TIR:
244                 trace_seq_printf(p, "tir=%u\n", dst->tir_num);
245                 break;
246         case MLX5_FLOW_DESTINATION_TYPE_COUNTER:
247                 trace_seq_printf(p, "counter_id=%u\n", counter_id);
248                 break;
249         }
250
251         trace_seq_putc(p, 0);
252         return ret;
253 }
254
255 EXPORT_TRACEPOINT_SYMBOL(mlx5_fs_add_fg);
256 EXPORT_TRACEPOINT_SYMBOL(mlx5_fs_del_fg);
257 EXPORT_TRACEPOINT_SYMBOL(mlx5_fs_set_fte);
258 EXPORT_TRACEPOINT_SYMBOL(mlx5_fs_del_fte);
259 EXPORT_TRACEPOINT_SYMBOL(mlx5_fs_add_rule);
260 EXPORT_TRACEPOINT_SYMBOL(mlx5_fs_del_rule);
261