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
 42enum 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
 54enum 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
 61static 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
 70static 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
 76union 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
 90static 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
104static 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
122static 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
143static 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
158int 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}