1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * intel_pt_pkt_decoder.c: Intel Processor Trace support
4  * Copyright (c) 2013-2014, Intel Corporation.
5  */
6 
7 #include <stdio.h>
8 #include <string.h>
9 #include <endian.h>
10 #include <byteswap.h>
11 #include <linux/compiler.h>
12 
13 #include "intel-pt-pkt-decoder.h"
14 
15 #define BIT(n)		(1 << (n))
16 
17 #define BIT63		((uint64_t)1 << 63)
18 
19 #if __BYTE_ORDER__ == __ORDER_BIG_ENDIAN__
20 #define le16_to_cpu bswap_16
21 #define le32_to_cpu bswap_32
22 #define le64_to_cpu bswap_64
23 #define memcpy_le64(d, s, n) do { \
24 	memcpy((d), (s), (n));    \
25 	*(d) = le64_to_cpu(*(d)); \
26 } while (0)
27 #else
28 #define le16_to_cpu
29 #define le32_to_cpu
30 #define le64_to_cpu
31 #define memcpy_le64 memcpy
32 #endif
33 
34 static const char * const packet_name[] = {
35 	[INTEL_PT_BAD]		= "Bad Packet!",
36 	[INTEL_PT_PAD]		= "PAD",
37 	[INTEL_PT_TNT]		= "TNT",
38 	[INTEL_PT_TIP_PGD]	= "TIP.PGD",
39 	[INTEL_PT_TIP_PGE]	= "TIP.PGE",
40 	[INTEL_PT_TSC]		= "TSC",
41 	[INTEL_PT_TMA]		= "TMA",
42 	[INTEL_PT_MODE_EXEC]	= "MODE.Exec",
43 	[INTEL_PT_MODE_TSX]	= "MODE.TSX",
44 	[INTEL_PT_MTC]		= "MTC",
45 	[INTEL_PT_TIP]		= "TIP",
46 	[INTEL_PT_FUP]		= "FUP",
47 	[INTEL_PT_CYC]		= "CYC",
48 	[INTEL_PT_VMCS]		= "VMCS",
49 	[INTEL_PT_PSB]		= "PSB",
50 	[INTEL_PT_PSBEND]	= "PSBEND",
51 	[INTEL_PT_CBR]		= "CBR",
52 	[INTEL_PT_TRACESTOP]	= "TraceSTOP",
53 	[INTEL_PT_PIP]		= "PIP",
54 	[INTEL_PT_OVF]		= "OVF",
55 	[INTEL_PT_MNT]		= "MNT",
56 	[INTEL_PT_PTWRITE]	= "PTWRITE",
57 	[INTEL_PT_PTWRITE_IP]	= "PTWRITE",
58 	[INTEL_PT_EXSTOP]	= "EXSTOP",
59 	[INTEL_PT_EXSTOP_IP]	= "EXSTOP",
60 	[INTEL_PT_MWAIT]	= "MWAIT",
61 	[INTEL_PT_PWRE]		= "PWRE",
62 	[INTEL_PT_PWRX]		= "PWRX",
63 	[INTEL_PT_BBP]		= "BBP",
64 	[INTEL_PT_BIP]		= "BIP",
65 	[INTEL_PT_BEP]		= "BEP",
66 	[INTEL_PT_BEP_IP]	= "BEP",
67 	[INTEL_PT_CFE]		= "CFE",
68 	[INTEL_PT_CFE_IP]	= "CFE",
69 	[INTEL_PT_EVD]		= "EVD",
70 };
71 
intel_pt_pkt_name(enum intel_pt_pkt_type type)72 const char *intel_pt_pkt_name(enum intel_pt_pkt_type type)
73 {
74 	return packet_name[type];
75 }
76 
intel_pt_get_long_tnt(const unsigned char * buf,size_t len,struct intel_pt_pkt * packet)77 static int intel_pt_get_long_tnt(const unsigned char *buf, size_t len,
78 				 struct intel_pt_pkt *packet)
79 {
80 	uint64_t payload;
81 	int count;
82 
83 	if (len < 8)
84 		return INTEL_PT_NEED_MORE_BYTES;
85 
86 	payload = le64_to_cpu(*(uint64_t *)buf);
87 
88 	for (count = 47; count; count--) {
89 		if (payload & BIT63)
90 			break;
91 		payload <<= 1;
92 	}
93 
94 	packet->type = INTEL_PT_TNT;
95 	packet->count = count;
96 	packet->payload = payload << 1;
97 	return 8;
98 }
99 
intel_pt_get_pip(const unsigned char * buf,size_t len,struct intel_pt_pkt * packet)100 static int intel_pt_get_pip(const unsigned char *buf, size_t len,
101 			    struct intel_pt_pkt *packet)
102 {
103 	uint64_t payload = 0;
104 
105 	if (len < 8)
106 		return INTEL_PT_NEED_MORE_BYTES;
107 
108 	packet->type = INTEL_PT_PIP;
109 	memcpy_le64(&payload, buf + 2, 6);
110 	packet->payload = payload;
111 
112 	return 8;
113 }
114 
intel_pt_get_tracestop(struct intel_pt_pkt * packet)115 static int intel_pt_get_tracestop(struct intel_pt_pkt *packet)
116 {
117 	packet->type = INTEL_PT_TRACESTOP;
118 	return 2;
119 }
120 
intel_pt_get_cbr(const unsigned char * buf,size_t len,struct intel_pt_pkt * packet)121 static int intel_pt_get_cbr(const unsigned char *buf, size_t len,
122 			    struct intel_pt_pkt *packet)
123 {
124 	if (len < 4)
125 		return INTEL_PT_NEED_MORE_BYTES;
126 	packet->type = INTEL_PT_CBR;
127 	packet->payload = le16_to_cpu(*(uint16_t *)(buf + 2));
128 	return 4;
129 }
130 
intel_pt_get_vmcs(const unsigned char * buf,size_t len,struct intel_pt_pkt * packet)131 static int intel_pt_get_vmcs(const unsigned char *buf, size_t len,
132 			     struct intel_pt_pkt *packet)
133 {
134 	unsigned int count = (52 - 5) >> 3;
135 
136 	if (count < 1 || count > 7)
137 		return INTEL_PT_BAD_PACKET;
138 
139 	if (len < count + 2)
140 		return INTEL_PT_NEED_MORE_BYTES;
141 
142 	packet->type = INTEL_PT_VMCS;
143 	packet->count = count;
144 	memcpy_le64(&packet->payload, buf + 2, count);
145 
146 	return count + 2;
147 }
148 
intel_pt_get_ovf(struct intel_pt_pkt * packet)149 static int intel_pt_get_ovf(struct intel_pt_pkt *packet)
150 {
151 	packet->type = INTEL_PT_OVF;
152 	return 2;
153 }
154 
intel_pt_get_psb(const unsigned char * buf,size_t len,struct intel_pt_pkt * packet)155 static int intel_pt_get_psb(const unsigned char *buf, size_t len,
156 			    struct intel_pt_pkt *packet)
157 {
158 	int i;
159 
160 	if (len < 16)
161 		return INTEL_PT_NEED_MORE_BYTES;
162 
163 	for (i = 2; i < 16; i += 2) {
164 		if (buf[i] != 2 || buf[i + 1] != 0x82)
165 			return INTEL_PT_BAD_PACKET;
166 	}
167 
168 	packet->type = INTEL_PT_PSB;
169 	return 16;
170 }
171 
intel_pt_get_psbend(struct intel_pt_pkt * packet)172 static int intel_pt_get_psbend(struct intel_pt_pkt *packet)
173 {
174 	packet->type = INTEL_PT_PSBEND;
175 	return 2;
176 }
177 
intel_pt_get_tma(const unsigned char * buf,size_t len,struct intel_pt_pkt * packet)178 static int intel_pt_get_tma(const unsigned char *buf, size_t len,
179 			    struct intel_pt_pkt *packet)
180 {
181 	if (len < 7)
182 		return INTEL_PT_NEED_MORE_BYTES;
183 
184 	packet->type = INTEL_PT_TMA;
185 	packet->payload = buf[2] | (buf[3] << 8);
186 	packet->count = buf[5] | ((buf[6] & BIT(0)) << 8);
187 	return 7;
188 }
189 
intel_pt_get_pad(struct intel_pt_pkt * packet)190 static int intel_pt_get_pad(struct intel_pt_pkt *packet)
191 {
192 	packet->type = INTEL_PT_PAD;
193 	return 1;
194 }
195 
intel_pt_get_mnt(const unsigned char * buf,size_t len,struct intel_pt_pkt * packet)196 static int intel_pt_get_mnt(const unsigned char *buf, size_t len,
197 			    struct intel_pt_pkt *packet)
198 {
199 	if (len < 11)
200 		return INTEL_PT_NEED_MORE_BYTES;
201 	packet->type = INTEL_PT_MNT;
202 	memcpy_le64(&packet->payload, buf + 3, 8);
203 	return 11;
204 }
205 
intel_pt_get_3byte(const unsigned char * buf,size_t len,struct intel_pt_pkt * packet)206 static int intel_pt_get_3byte(const unsigned char *buf, size_t len,
207 			      struct intel_pt_pkt *packet)
208 {
209 	if (len < 3)
210 		return INTEL_PT_NEED_MORE_BYTES;
211 
212 	switch (buf[2]) {
213 	case 0x88: /* MNT */
214 		return intel_pt_get_mnt(buf, len, packet);
215 	default:
216 		return INTEL_PT_BAD_PACKET;
217 	}
218 }
219 
intel_pt_get_ptwrite(const unsigned char * buf,size_t len,struct intel_pt_pkt * packet)220 static int intel_pt_get_ptwrite(const unsigned char *buf, size_t len,
221 				struct intel_pt_pkt *packet)
222 {
223 	packet->count = (buf[1] >> 5) & 0x3;
224 	packet->type = buf[1] & BIT(7) ? INTEL_PT_PTWRITE_IP :
225 					 INTEL_PT_PTWRITE;
226 
227 	switch (packet->count) {
228 	case 0:
229 		if (len < 6)
230 			return INTEL_PT_NEED_MORE_BYTES;
231 		packet->payload = le32_to_cpu(*(uint32_t *)(buf + 2));
232 		return 6;
233 	case 1:
234 		if (len < 10)
235 			return INTEL_PT_NEED_MORE_BYTES;
236 		packet->payload = le64_to_cpu(*(uint64_t *)(buf + 2));
237 		return 10;
238 	default:
239 		return INTEL_PT_BAD_PACKET;
240 	}
241 }
242 
intel_pt_get_exstop(struct intel_pt_pkt * packet)243 static int intel_pt_get_exstop(struct intel_pt_pkt *packet)
244 {
245 	packet->type = INTEL_PT_EXSTOP;
246 	return 2;
247 }
248 
intel_pt_get_exstop_ip(struct intel_pt_pkt * packet)249 static int intel_pt_get_exstop_ip(struct intel_pt_pkt *packet)
250 {
251 	packet->type = INTEL_PT_EXSTOP_IP;
252 	return 2;
253 }
254 
intel_pt_get_mwait(const unsigned char * buf,size_t len,struct intel_pt_pkt * packet)255 static int intel_pt_get_mwait(const unsigned char *buf, size_t len,
256 			      struct intel_pt_pkt *packet)
257 {
258 	if (len < 10)
259 		return INTEL_PT_NEED_MORE_BYTES;
260 	packet->type = INTEL_PT_MWAIT;
261 	packet->payload = le64_to_cpu(*(uint64_t *)(buf + 2));
262 	return 10;
263 }
264 
intel_pt_get_pwre(const unsigned char * buf,size_t len,struct intel_pt_pkt * packet)265 static int intel_pt_get_pwre(const unsigned char *buf, size_t len,
266 			     struct intel_pt_pkt *packet)
267 {
268 	if (len < 4)
269 		return INTEL_PT_NEED_MORE_BYTES;
270 	packet->type = INTEL_PT_PWRE;
271 	memcpy_le64(&packet->payload, buf + 2, 2);
272 	return 4;
273 }
274 
intel_pt_get_pwrx(const unsigned char * buf,size_t len,struct intel_pt_pkt * packet)275 static int intel_pt_get_pwrx(const unsigned char *buf, size_t len,
276 			     struct intel_pt_pkt *packet)
277 {
278 	if (len < 7)
279 		return INTEL_PT_NEED_MORE_BYTES;
280 	packet->type = INTEL_PT_PWRX;
281 	memcpy_le64(&packet->payload, buf + 2, 5);
282 	return 7;
283 }
284 
intel_pt_get_bbp(const unsigned char * buf,size_t len,struct intel_pt_pkt * packet)285 static int intel_pt_get_bbp(const unsigned char *buf, size_t len,
286 			    struct intel_pt_pkt *packet)
287 {
288 	if (len < 3)
289 		return INTEL_PT_NEED_MORE_BYTES;
290 	packet->type = INTEL_PT_BBP;
291 	packet->count = buf[2] >> 7;
292 	packet->payload = buf[2] & 0x1f;
293 	return 3;
294 }
295 
intel_pt_get_bip_4(const unsigned char * buf,size_t len,struct intel_pt_pkt * packet)296 static int intel_pt_get_bip_4(const unsigned char *buf, size_t len,
297 			      struct intel_pt_pkt *packet)
298 {
299 	if (len < 5)
300 		return INTEL_PT_NEED_MORE_BYTES;
301 	packet->type = INTEL_PT_BIP;
302 	packet->count = buf[0] >> 3;
303 	memcpy_le64(&packet->payload, buf + 1, 4);
304 	return 5;
305 }
306 
intel_pt_get_bip_8(const unsigned char * buf,size_t len,struct intel_pt_pkt * packet)307 static int intel_pt_get_bip_8(const unsigned char *buf, size_t len,
308 			      struct intel_pt_pkt *packet)
309 {
310 	if (len < 9)
311 		return INTEL_PT_NEED_MORE_BYTES;
312 	packet->type = INTEL_PT_BIP;
313 	packet->count = buf[0] >> 3;
314 	memcpy_le64(&packet->payload, buf + 1, 8);
315 	return 9;
316 }
317 
intel_pt_get_bep(size_t len,struct intel_pt_pkt * packet)318 static int intel_pt_get_bep(size_t len, struct intel_pt_pkt *packet)
319 {
320 	if (len < 2)
321 		return INTEL_PT_NEED_MORE_BYTES;
322 	packet->type = INTEL_PT_BEP;
323 	return 2;
324 }
325 
intel_pt_get_bep_ip(size_t len,struct intel_pt_pkt * packet)326 static int intel_pt_get_bep_ip(size_t len, struct intel_pt_pkt *packet)
327 {
328 	if (len < 2)
329 		return INTEL_PT_NEED_MORE_BYTES;
330 	packet->type = INTEL_PT_BEP_IP;
331 	return 2;
332 }
333 
intel_pt_get_cfe(const unsigned char * buf,size_t len,struct intel_pt_pkt * packet)334 static int intel_pt_get_cfe(const unsigned char *buf, size_t len,
335 			    struct intel_pt_pkt *packet)
336 {
337 	if (len < 4)
338 		return INTEL_PT_NEED_MORE_BYTES;
339 	packet->type = buf[2] & 0x80 ? INTEL_PT_CFE_IP : INTEL_PT_CFE;
340 	packet->count = buf[2] & 0x1f;
341 	packet->payload = buf[3];
342 	return 4;
343 }
344 
intel_pt_get_evd(const unsigned char * buf,size_t len,struct intel_pt_pkt * packet)345 static int intel_pt_get_evd(const unsigned char *buf, size_t len,
346 			    struct intel_pt_pkt *packet)
347 {
348 	if (len < 11)
349 		return INTEL_PT_NEED_MORE_BYTES;
350 	packet->type = INTEL_PT_EVD;
351 	packet->count = buf[2] & 0x3f;
352 	packet->payload = buf[3];
353 	memcpy_le64(&packet->payload, buf + 3, 8);
354 	return 11;
355 }
356 
intel_pt_get_ext(const unsigned char * buf,size_t len,struct intel_pt_pkt * packet)357 static int intel_pt_get_ext(const unsigned char *buf, size_t len,
358 			    struct intel_pt_pkt *packet)
359 {
360 	if (len < 2)
361 		return INTEL_PT_NEED_MORE_BYTES;
362 
363 	if ((buf[1] & 0x1f) == 0x12)
364 		return intel_pt_get_ptwrite(buf, len, packet);
365 
366 	switch (buf[1]) {
367 	case 0xa3: /* Long TNT */
368 		return intel_pt_get_long_tnt(buf, len, packet);
369 	case 0x43: /* PIP */
370 		return intel_pt_get_pip(buf, len, packet);
371 	case 0x83: /* TraceStop */
372 		return intel_pt_get_tracestop(packet);
373 	case 0x03: /* CBR */
374 		return intel_pt_get_cbr(buf, len, packet);
375 	case 0xc8: /* VMCS */
376 		return intel_pt_get_vmcs(buf, len, packet);
377 	case 0xf3: /* OVF */
378 		return intel_pt_get_ovf(packet);
379 	case 0x82: /* PSB */
380 		return intel_pt_get_psb(buf, len, packet);
381 	case 0x23: /* PSBEND */
382 		return intel_pt_get_psbend(packet);
383 	case 0x73: /* TMA */
384 		return intel_pt_get_tma(buf, len, packet);
385 	case 0xC3: /* 3-byte header */
386 		return intel_pt_get_3byte(buf, len, packet);
387 	case 0x62: /* EXSTOP no IP */
388 		return intel_pt_get_exstop(packet);
389 	case 0xE2: /* EXSTOP with IP */
390 		return intel_pt_get_exstop_ip(packet);
391 	case 0xC2: /* MWAIT */
392 		return intel_pt_get_mwait(buf, len, packet);
393 	case 0x22: /* PWRE */
394 		return intel_pt_get_pwre(buf, len, packet);
395 	case 0xA2: /* PWRX */
396 		return intel_pt_get_pwrx(buf, len, packet);
397 	case 0x63: /* BBP */
398 		return intel_pt_get_bbp(buf, len, packet);
399 	case 0x33: /* BEP no IP */
400 		return intel_pt_get_bep(len, packet);
401 	case 0xb3: /* BEP with IP */
402 		return intel_pt_get_bep_ip(len, packet);
403 	case 0x13: /* CFE */
404 		return intel_pt_get_cfe(buf, len, packet);
405 	case 0x53: /* EVD */
406 		return intel_pt_get_evd(buf, len, packet);
407 	default:
408 		return INTEL_PT_BAD_PACKET;
409 	}
410 }
411 
intel_pt_get_short_tnt(unsigned int byte,struct intel_pt_pkt * packet)412 static int intel_pt_get_short_tnt(unsigned int byte,
413 				  struct intel_pt_pkt *packet)
414 {
415 	int count;
416 
417 	for (count = 6; count; count--) {
418 		if (byte & BIT(7))
419 			break;
420 		byte <<= 1;
421 	}
422 
423 	packet->type = INTEL_PT_TNT;
424 	packet->count = count;
425 	packet->payload = (uint64_t)byte << 57;
426 
427 	return 1;
428 }
429 
intel_pt_get_cyc(unsigned int byte,const unsigned char * buf,size_t len,struct intel_pt_pkt * packet)430 static int intel_pt_get_cyc(unsigned int byte, const unsigned char *buf,
431 			    size_t len, struct intel_pt_pkt *packet)
432 {
433 	unsigned int offs = 1, shift;
434 	uint64_t payload = byte >> 3;
435 
436 	byte >>= 2;
437 	len -= 1;
438 	for (shift = 5; byte & 1; shift += 7) {
439 		if (offs > 9)
440 			return INTEL_PT_BAD_PACKET;
441 		if (len < offs)
442 			return INTEL_PT_NEED_MORE_BYTES;
443 		byte = buf[offs++];
444 		payload |= ((uint64_t)byte >> 1) << shift;
445 	}
446 
447 	packet->type = INTEL_PT_CYC;
448 	packet->payload = payload;
449 	return offs;
450 }
451 
intel_pt_get_ip(enum intel_pt_pkt_type type,unsigned int byte,const unsigned char * buf,size_t len,struct intel_pt_pkt * packet)452 static int intel_pt_get_ip(enum intel_pt_pkt_type type, unsigned int byte,
453 			   const unsigned char *buf, size_t len,
454 			   struct intel_pt_pkt *packet)
455 {
456 	int ip_len;
457 
458 	packet->count = byte >> 5;
459 
460 	switch (packet->count) {
461 	case 0:
462 		ip_len = 0;
463 		break;
464 	case 1:
465 		if (len < 3)
466 			return INTEL_PT_NEED_MORE_BYTES;
467 		ip_len = 2;
468 		packet->payload = le16_to_cpu(*(uint16_t *)(buf + 1));
469 		break;
470 	case 2:
471 		if (len < 5)
472 			return INTEL_PT_NEED_MORE_BYTES;
473 		ip_len = 4;
474 		packet->payload = le32_to_cpu(*(uint32_t *)(buf + 1));
475 		break;
476 	case 3:
477 	case 4:
478 		if (len < 7)
479 			return INTEL_PT_NEED_MORE_BYTES;
480 		ip_len = 6;
481 		memcpy_le64(&packet->payload, buf + 1, 6);
482 		break;
483 	case 6:
484 		if (len < 9)
485 			return INTEL_PT_NEED_MORE_BYTES;
486 		ip_len = 8;
487 		packet->payload = le64_to_cpu(*(uint64_t *)(buf + 1));
488 		break;
489 	default:
490 		return INTEL_PT_BAD_PACKET;
491 	}
492 
493 	packet->type = type;
494 
495 	return ip_len + 1;
496 }
497 
intel_pt_get_mode(const unsigned char * buf,size_t len,struct intel_pt_pkt * packet)498 static int intel_pt_get_mode(const unsigned char *buf, size_t len,
499 			     struct intel_pt_pkt *packet)
500 {
501 	if (len < 2)
502 		return INTEL_PT_NEED_MORE_BYTES;
503 
504 	switch (buf[1] >> 5) {
505 	case 0:
506 		packet->type = INTEL_PT_MODE_EXEC;
507 		packet->count = buf[1];
508 		switch (buf[1] & 3) {
509 		case 0:
510 			packet->payload = 16;
511 			break;
512 		case 1:
513 			packet->payload = 64;
514 			break;
515 		case 2:
516 			packet->payload = 32;
517 			break;
518 		default:
519 			return INTEL_PT_BAD_PACKET;
520 		}
521 		break;
522 	case 1:
523 		packet->type = INTEL_PT_MODE_TSX;
524 		if ((buf[1] & 3) == 3)
525 			return INTEL_PT_BAD_PACKET;
526 		packet->payload = buf[1] & 3;
527 		break;
528 	default:
529 		return INTEL_PT_BAD_PACKET;
530 	}
531 
532 	return 2;
533 }
534 
intel_pt_get_tsc(const unsigned char * buf,size_t len,struct intel_pt_pkt * packet)535 static int intel_pt_get_tsc(const unsigned char *buf, size_t len,
536 			    struct intel_pt_pkt *packet)
537 {
538 	if (len < 8)
539 		return INTEL_PT_NEED_MORE_BYTES;
540 	packet->type = INTEL_PT_TSC;
541 	memcpy_le64(&packet->payload, buf + 1, 7);
542 	return 8;
543 }
544 
intel_pt_get_mtc(const unsigned char * buf,size_t len,struct intel_pt_pkt * packet)545 static int intel_pt_get_mtc(const unsigned char *buf, size_t len,
546 			    struct intel_pt_pkt *packet)
547 {
548 	if (len < 2)
549 		return INTEL_PT_NEED_MORE_BYTES;
550 	packet->type = INTEL_PT_MTC;
551 	packet->payload = buf[1];
552 	return 2;
553 }
554 
intel_pt_do_get_packet(const unsigned char * buf,size_t len,struct intel_pt_pkt * packet,enum intel_pt_pkt_ctx ctx)555 static int intel_pt_do_get_packet(const unsigned char *buf, size_t len,
556 				  struct intel_pt_pkt *packet,
557 				  enum intel_pt_pkt_ctx ctx)
558 {
559 	unsigned int byte;
560 
561 	memset(packet, 0, sizeof(struct intel_pt_pkt));
562 
563 	if (!len)
564 		return INTEL_PT_NEED_MORE_BYTES;
565 
566 	byte = buf[0];
567 
568 	switch (ctx) {
569 	case INTEL_PT_NO_CTX:
570 		break;
571 	case INTEL_PT_BLK_4_CTX:
572 		if ((byte & 0x7) == 4)
573 			return intel_pt_get_bip_4(buf, len, packet);
574 		break;
575 	case INTEL_PT_BLK_8_CTX:
576 		if ((byte & 0x7) == 4)
577 			return intel_pt_get_bip_8(buf, len, packet);
578 		break;
579 	default:
580 		break;
581 	}
582 
583 	if (!(byte & BIT(0))) {
584 		if (byte == 0)
585 			return intel_pt_get_pad(packet);
586 		if (byte == 2)
587 			return intel_pt_get_ext(buf, len, packet);
588 		return intel_pt_get_short_tnt(byte, packet);
589 	}
590 
591 	if ((byte & 2))
592 		return intel_pt_get_cyc(byte, buf, len, packet);
593 
594 	switch (byte & 0x1f) {
595 	case 0x0D:
596 		return intel_pt_get_ip(INTEL_PT_TIP, byte, buf, len, packet);
597 	case 0x11:
598 		return intel_pt_get_ip(INTEL_PT_TIP_PGE, byte, buf, len,
599 				       packet);
600 	case 0x01:
601 		return intel_pt_get_ip(INTEL_PT_TIP_PGD, byte, buf, len,
602 				       packet);
603 	case 0x1D:
604 		return intel_pt_get_ip(INTEL_PT_FUP, byte, buf, len, packet);
605 	case 0x19:
606 		switch (byte) {
607 		case 0x99:
608 			return intel_pt_get_mode(buf, len, packet);
609 		case 0x19:
610 			return intel_pt_get_tsc(buf, len, packet);
611 		case 0x59:
612 			return intel_pt_get_mtc(buf, len, packet);
613 		default:
614 			return INTEL_PT_BAD_PACKET;
615 		}
616 	default:
617 		return INTEL_PT_BAD_PACKET;
618 	}
619 }
620 
intel_pt_upd_pkt_ctx(const struct intel_pt_pkt * packet,enum intel_pt_pkt_ctx * ctx)621 void intel_pt_upd_pkt_ctx(const struct intel_pt_pkt *packet,
622 			  enum intel_pt_pkt_ctx *ctx)
623 {
624 	switch (packet->type) {
625 	case INTEL_PT_BAD:
626 	case INTEL_PT_PAD:
627 	case INTEL_PT_TSC:
628 	case INTEL_PT_TMA:
629 	case INTEL_PT_MTC:
630 	case INTEL_PT_FUP:
631 	case INTEL_PT_CYC:
632 	case INTEL_PT_CBR:
633 	case INTEL_PT_MNT:
634 	case INTEL_PT_EXSTOP:
635 	case INTEL_PT_EXSTOP_IP:
636 	case INTEL_PT_PWRE:
637 	case INTEL_PT_PWRX:
638 	case INTEL_PT_BIP:
639 		break;
640 	case INTEL_PT_TNT:
641 	case INTEL_PT_TIP:
642 	case INTEL_PT_TIP_PGD:
643 	case INTEL_PT_TIP_PGE:
644 	case INTEL_PT_MODE_EXEC:
645 	case INTEL_PT_MODE_TSX:
646 	case INTEL_PT_PIP:
647 	case INTEL_PT_OVF:
648 	case INTEL_PT_VMCS:
649 	case INTEL_PT_TRACESTOP:
650 	case INTEL_PT_PSB:
651 	case INTEL_PT_PSBEND:
652 	case INTEL_PT_PTWRITE:
653 	case INTEL_PT_PTWRITE_IP:
654 	case INTEL_PT_MWAIT:
655 	case INTEL_PT_BEP:
656 	case INTEL_PT_BEP_IP:
657 	case INTEL_PT_CFE:
658 	case INTEL_PT_CFE_IP:
659 	case INTEL_PT_EVD:
660 		*ctx = INTEL_PT_NO_CTX;
661 		break;
662 	case INTEL_PT_BBP:
663 		if (packet->count)
664 			*ctx = INTEL_PT_BLK_4_CTX;
665 		else
666 			*ctx = INTEL_PT_BLK_8_CTX;
667 		break;
668 	default:
669 		break;
670 	}
671 }
672 
intel_pt_get_packet(const unsigned char * buf,size_t len,struct intel_pt_pkt * packet,enum intel_pt_pkt_ctx * ctx)673 int intel_pt_get_packet(const unsigned char *buf, size_t len,
674 			struct intel_pt_pkt *packet, enum intel_pt_pkt_ctx *ctx)
675 {
676 	int ret;
677 
678 	ret = intel_pt_do_get_packet(buf, len, packet, *ctx);
679 	if (ret > 0) {
680 		while (ret < 8 && len > (size_t)ret && !buf[ret])
681 			ret += 1;
682 		intel_pt_upd_pkt_ctx(packet, ctx);
683 	}
684 	return ret;
685 }
686 
intel_pt_pkt_desc(const struct intel_pt_pkt * packet,char * buf,size_t buf_len)687 int intel_pt_pkt_desc(const struct intel_pt_pkt *packet, char *buf,
688 		      size_t buf_len)
689 {
690 	int ret, i, nr;
691 	unsigned long long payload = packet->payload;
692 	const char *name = intel_pt_pkt_name(packet->type);
693 
694 	switch (packet->type) {
695 	case INTEL_PT_BAD:
696 	case INTEL_PT_PAD:
697 	case INTEL_PT_PSB:
698 	case INTEL_PT_PSBEND:
699 	case INTEL_PT_TRACESTOP:
700 	case INTEL_PT_OVF:
701 		return snprintf(buf, buf_len, "%s", name);
702 	case INTEL_PT_TNT: {
703 		size_t blen = buf_len;
704 
705 		ret = snprintf(buf, blen, "%s ", name);
706 		if (ret < 0)
707 			return ret;
708 		buf += ret;
709 		blen -= ret;
710 		for (i = 0; i < packet->count; i++) {
711 			if (payload & BIT63)
712 				ret = snprintf(buf, blen, "T");
713 			else
714 				ret = snprintf(buf, blen, "N");
715 			if (ret < 0)
716 				return ret;
717 			buf += ret;
718 			blen -= ret;
719 			payload <<= 1;
720 		}
721 		ret = snprintf(buf, blen, " (%d)", packet->count);
722 		if (ret < 0)
723 			return ret;
724 		blen -= ret;
725 		return buf_len - blen;
726 	}
727 	case INTEL_PT_TIP_PGD:
728 	case INTEL_PT_TIP_PGE:
729 	case INTEL_PT_TIP:
730 	case INTEL_PT_FUP:
731 		if (!(packet->count))
732 			return snprintf(buf, buf_len, "%s no ip", name);
733 		__fallthrough;
734 	case INTEL_PT_CYC:
735 	case INTEL_PT_VMCS:
736 	case INTEL_PT_MTC:
737 	case INTEL_PT_MNT:
738 	case INTEL_PT_CBR:
739 	case INTEL_PT_TSC:
740 		return snprintf(buf, buf_len, "%s 0x%llx", name, payload);
741 	case INTEL_PT_TMA:
742 		return snprintf(buf, buf_len, "%s CTC 0x%x FC 0x%x", name,
743 				(unsigned)payload, packet->count);
744 	case INTEL_PT_MODE_EXEC:
745 		return snprintf(buf, buf_len, "%s IF:%d %lld",
746 				name, !!(packet->count & 4), payload);
747 	case INTEL_PT_MODE_TSX:
748 		return snprintf(buf, buf_len, "%s TXAbort:%u InTX:%u",
749 				name, (unsigned)(payload >> 1) & 1,
750 				(unsigned)payload & 1);
751 	case INTEL_PT_PIP:
752 		nr = packet->payload & INTEL_PT_VMX_NR_FLAG ? 1 : 0;
753 		payload &= ~INTEL_PT_VMX_NR_FLAG;
754 		ret = snprintf(buf, buf_len, "%s 0x%llx (NR=%d)",
755 			       name, payload >> 1, nr);
756 		return ret;
757 	case INTEL_PT_PTWRITE:
758 		return snprintf(buf, buf_len, "%s 0x%llx IP:0", name, payload);
759 	case INTEL_PT_PTWRITE_IP:
760 		return snprintf(buf, buf_len, "%s 0x%llx IP:1", name, payload);
761 	case INTEL_PT_BEP:
762 	case INTEL_PT_EXSTOP:
763 		return snprintf(buf, buf_len, "%s IP:0", name);
764 	case INTEL_PT_BEP_IP:
765 	case INTEL_PT_EXSTOP_IP:
766 		return snprintf(buf, buf_len, "%s IP:1", name);
767 	case INTEL_PT_MWAIT:
768 		return snprintf(buf, buf_len, "%s 0x%llx Hints 0x%x Extensions 0x%x",
769 				name, payload, (unsigned int)(payload & 0xff),
770 				(unsigned int)((payload >> 32) & 0x3));
771 	case INTEL_PT_PWRE:
772 		return snprintf(buf, buf_len, "%s 0x%llx HW:%u CState:%u Sub-CState:%u",
773 				name, payload, !!(payload & 0x80),
774 				(unsigned int)((payload >> 12) & 0xf),
775 				(unsigned int)((payload >> 8) & 0xf));
776 	case INTEL_PT_PWRX:
777 		return snprintf(buf, buf_len, "%s 0x%llx Last CState:%u Deepest CState:%u Wake Reason 0x%x",
778 				name, payload,
779 				(unsigned int)((payload >> 4) & 0xf),
780 				(unsigned int)(payload & 0xf),
781 				(unsigned int)((payload >> 8) & 0xf));
782 	case INTEL_PT_BBP:
783 		return snprintf(buf, buf_len, "%s SZ %s-byte Type 0x%llx",
784 				name, packet->count ? "4" : "8", payload);
785 	case INTEL_PT_BIP:
786 		return snprintf(buf, buf_len, "%s ID 0x%02x Value 0x%llx",
787 				name, packet->count, payload);
788 	case INTEL_PT_CFE:
789 	case INTEL_PT_CFE_IP:
790 		return snprintf(buf, buf_len, "%s IP:%d Type 0x%02x Vector 0x%llx",
791 				name, packet->type == INTEL_PT_CFE_IP, packet->count, payload);
792 	case INTEL_PT_EVD:
793 		return snprintf(buf, buf_len, "%s Type 0x%02x Payload 0x%llx",
794 				name, packet->count, payload);
795 	default:
796 		break;
797 	}
798 	return snprintf(buf, buf_len, "%s 0x%llx (%d)",
799 			name, payload, packet->count);
800 }
801