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