1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * HiSilicon PCIe Trace and Tuning (PTT) support
4  * Copyright (c) 2022 HiSilicon Technologies Co., Ltd.
5  */
6 
7 #include <stdlib.h>
8 #include <stdio.h>
9 #include <string.h>
10 #include <endian.h>
11 #include <byteswap.h>
12 #include <linux/bitops.h>
13 #include <stdarg.h>
14 
15 #include "../color.h"
16 #include "hisi-ptt-pkt-decoder.h"
17 
18 /*
19  * For 8DW format, the bit[31:11] of DW0 is always 0x1fffff, which can be
20  * used to distinguish the data format.
21  * 8DW format is like:
22  *   bits [                 31:11                 ][       10:0       ]
23  *        |---------------------------------------|-------------------|
24  *    DW0 [                0x1fffff               ][ Reserved (0x7ff) ]
25  *    DW1 [                       Prefix                              ]
26  *    DW2 [                     Header DW0                            ]
27  *    DW3 [                     Header DW1                            ]
28  *    DW4 [                     Header DW2                            ]
29  *    DW5 [                     Header DW3                            ]
30  *    DW6 [                   Reserved (0x0)                          ]
31  *    DW7 [                        Time                               ]
32  *
33  * 4DW format is like:
34  *   bits [31:30] [ 29:25 ][24][23][22][21][    20:11   ][    10:0    ]
35  *        |-----|---------|---|---|---|---|-------------|-------------|
36  *    DW0 [ Fmt ][  Type  ][T9][T8][TH][SO][   Length   ][    Time    ]
37  *    DW1 [                     Header DW1                            ]
38  *    DW2 [                     Header DW2                            ]
39  *    DW3 [                     Header DW3                            ]
40  */
41 
42 enum hisi_ptt_8dw_pkt_field_type {
43 	HISI_PTT_8DW_CHK_AND_RSV0,
44 	HISI_PTT_8DW_PREFIX,
45 	HISI_PTT_8DW_HEAD0,
46 	HISI_PTT_8DW_HEAD1,
47 	HISI_PTT_8DW_HEAD2,
48 	HISI_PTT_8DW_HEAD3,
49 	HISI_PTT_8DW_RSV1,
50 	HISI_PTT_8DW_TIME,
51 	HISI_PTT_8DW_TYPE_MAX
52 };
53 
54 enum hisi_ptt_4dw_pkt_field_type {
55 	HISI_PTT_4DW_HEAD1,
56 	HISI_PTT_4DW_HEAD2,
57 	HISI_PTT_4DW_HEAD3,
58 	HISI_PTT_4DW_TYPE_MAX
59 };
60 
61 static const char * const hisi_ptt_8dw_pkt_field_name[] = {
62 	[HISI_PTT_8DW_PREFIX]	= "Prefix",
63 	[HISI_PTT_8DW_HEAD0]	= "Header DW0",
64 	[HISI_PTT_8DW_HEAD1]	= "Header DW1",
65 	[HISI_PTT_8DW_HEAD2]	= "Header DW2",
66 	[HISI_PTT_8DW_HEAD3]	= "Header DW3",
67 	[HISI_PTT_8DW_TIME]	= "Time"
68 };
69 
70 static const char * const hisi_ptt_4dw_pkt_field_name[] = {
71 	[HISI_PTT_4DW_HEAD1]	= "Header DW1",
72 	[HISI_PTT_4DW_HEAD2]	= "Header DW2",
73 	[HISI_PTT_4DW_HEAD3]	= "Header DW3",
74 };
75 
76 union hisi_ptt_4dw {
77 	struct {
78 		uint32_t format : 2;
79 		uint32_t type : 5;
80 		uint32_t t9 : 1;
81 		uint32_t t8 : 1;
82 		uint32_t th : 1;
83 		uint32_t so : 1;
84 		uint32_t len : 10;
85 		uint32_t time : 11;
86 	};
87 	uint32_t value;
88 };
89 
hisi_ptt_print_pkt(const unsigned char * buf,int pos,const char * desc)90 static void hisi_ptt_print_pkt(const unsigned char *buf, int pos, const char *desc)
91 {
92 	const char *color = PERF_COLOR_BLUE;
93 	int i;
94 
95 	printf(".");
96 	color_fprintf(stdout, color, "  %08x: ", pos);
97 	for (i = 0; i < HISI_PTT_FIELD_LENTH; i++)
98 		color_fprintf(stdout, color, "%02x ", buf[pos + i]);
99 	for (i = 0; i < HISI_PTT_MAX_SPACE_LEN; i++)
100 		color_fprintf(stdout, color, "   ");
101 	color_fprintf(stdout, color, "  %s\n", desc);
102 }
103 
hisi_ptt_8dw_kpt_desc(const unsigned char * buf,int pos)104 static int hisi_ptt_8dw_kpt_desc(const unsigned char *buf, int pos)
105 {
106 	int i;
107 
108 	for (i = 0; i < HISI_PTT_8DW_TYPE_MAX; i++) {
109 		/* Do not show 8DW check field and reserved fields */
110 		if (i == HISI_PTT_8DW_CHK_AND_RSV0 || i == HISI_PTT_8DW_RSV1) {
111 			pos += HISI_PTT_FIELD_LENTH;
112 			continue;
113 		}
114 
115 		hisi_ptt_print_pkt(buf, pos, hisi_ptt_8dw_pkt_field_name[i]);
116 		pos += HISI_PTT_FIELD_LENTH;
117 	}
118 
119 	return hisi_ptt_pkt_size[HISI_PTT_8DW_PKT];
120 }
121 
hisi_ptt_4dw_print_dw0(const unsigned char * buf,int pos)122 static void hisi_ptt_4dw_print_dw0(const unsigned char *buf, int pos)
123 {
124 	const char *color = PERF_COLOR_BLUE;
125 	union hisi_ptt_4dw dw0;
126 	int i;
127 
128 	dw0.value = *(uint32_t *)(buf + pos);
129 	printf(".");
130 	color_fprintf(stdout, color, "  %08x: ", pos);
131 	for (i = 0; i < HISI_PTT_FIELD_LENTH; i++)
132 		color_fprintf(stdout, color, "%02x ", buf[pos + i]);
133 	for (i = 0; i < HISI_PTT_MAX_SPACE_LEN; i++)
134 		color_fprintf(stdout, color, "   ");
135 
136 	color_fprintf(stdout, color,
137 		      "  %s %x %s %x %s %x %s %x %s %x %s %x %s %x %s %x\n",
138 		      "Format", dw0.format, "Type", dw0.type, "T9", dw0.t9,
139 		      "T8", dw0.t8, "TH", dw0.th, "SO", dw0.so, "Length",
140 		      dw0.len, "Time", dw0.time);
141 }
142 
hisi_ptt_4dw_kpt_desc(const unsigned char * buf,int pos)143 static int hisi_ptt_4dw_kpt_desc(const unsigned char *buf, int pos)
144 {
145 	int i;
146 
147 	hisi_ptt_4dw_print_dw0(buf, pos);
148 	pos += HISI_PTT_FIELD_LENTH;
149 
150 	for (i = 0; i < HISI_PTT_4DW_TYPE_MAX; i++) {
151 		hisi_ptt_print_pkt(buf, pos, hisi_ptt_4dw_pkt_field_name[i]);
152 		pos += HISI_PTT_FIELD_LENTH;
153 	}
154 
155 	return hisi_ptt_pkt_size[HISI_PTT_4DW_PKT];
156 }
157 
hisi_ptt_pkt_desc(const unsigned char * buf,int pos,enum hisi_ptt_pkt_type type)158 int hisi_ptt_pkt_desc(const unsigned char *buf, int pos, enum hisi_ptt_pkt_type type)
159 {
160 	if (type == HISI_PTT_8DW_PKT)
161 		return hisi_ptt_8dw_kpt_desc(buf, pos);
162 
163 	return hisi_ptt_4dw_kpt_desc(buf, pos);
164 }
165