Lines Matching +full:byte +full:- +full:len
3 * Copyright (c) 2013-2014, Intel Corporation.
22 #include "intel-pt-pkt-decoder.h"
81 static int intel_pt_get_long_tnt(const unsigned char *buf, size_t len, in intel_pt_get_long_tnt() argument
87 if (len < 8) in intel_pt_get_long_tnt()
92 for (count = 47; count; count--) { in intel_pt_get_long_tnt()
98 packet->type = INTEL_PT_TNT; in intel_pt_get_long_tnt()
99 packet->count = count; in intel_pt_get_long_tnt()
100 packet->payload = payload << 1; in intel_pt_get_long_tnt()
104 static int intel_pt_get_pip(const unsigned char *buf, size_t len, in intel_pt_get_pip() argument
109 if (len < 8) in intel_pt_get_pip()
112 packet->type = INTEL_PT_PIP; in intel_pt_get_pip()
114 packet->payload = payload >> 1; in intel_pt_get_pip()
116 packet->payload |= NR_FLAG; in intel_pt_get_pip()
123 packet->type = INTEL_PT_TRACESTOP; in intel_pt_get_tracestop()
127 static int intel_pt_get_cbr(const unsigned char *buf, size_t len, in intel_pt_get_cbr() argument
130 if (len < 4) in intel_pt_get_cbr()
132 packet->type = INTEL_PT_CBR; in intel_pt_get_cbr()
133 packet->payload = le16_to_cpu(*(uint16_t *)(buf + 2)); in intel_pt_get_cbr()
137 static int intel_pt_get_vmcs(const unsigned char *buf, size_t len, in intel_pt_get_vmcs() argument
140 unsigned int count = (52 - 5) >> 3; in intel_pt_get_vmcs()
145 if (len < count + 2) in intel_pt_get_vmcs()
148 packet->type = INTEL_PT_VMCS; in intel_pt_get_vmcs()
149 packet->count = count; in intel_pt_get_vmcs()
150 memcpy_le64(&packet->payload, buf + 2, count); in intel_pt_get_vmcs()
157 packet->type = INTEL_PT_OVF; in intel_pt_get_ovf()
161 static int intel_pt_get_psb(const unsigned char *buf, size_t len, in intel_pt_get_psb() argument
166 if (len < 16) in intel_pt_get_psb()
174 packet->type = INTEL_PT_PSB; in intel_pt_get_psb()
180 packet->type = INTEL_PT_PSBEND; in intel_pt_get_psbend()
184 static int intel_pt_get_tma(const unsigned char *buf, size_t len, in intel_pt_get_tma() argument
187 if (len < 7) in intel_pt_get_tma()
190 packet->type = INTEL_PT_TMA; in intel_pt_get_tma()
191 packet->payload = buf[2] | (buf[3] << 8); in intel_pt_get_tma()
192 packet->count = buf[5] | ((buf[6] & BIT(0)) << 8); in intel_pt_get_tma()
198 packet->type = INTEL_PT_PAD; in intel_pt_get_pad()
202 static int intel_pt_get_mnt(const unsigned char *buf, size_t len, in intel_pt_get_mnt() argument
205 if (len < 11) in intel_pt_get_mnt()
207 packet->type = INTEL_PT_MNT; in intel_pt_get_mnt()
208 memcpy_le64(&packet->payload, buf + 3, 8); in intel_pt_get_mnt()
213 static int intel_pt_get_3byte(const unsigned char *buf, size_t len, in intel_pt_get_3byte() argument
216 if (len < 3) in intel_pt_get_3byte()
221 return intel_pt_get_mnt(buf, len, packet); in intel_pt_get_3byte()
227 static int intel_pt_get_ptwrite(const unsigned char *buf, size_t len, in intel_pt_get_ptwrite() argument
230 packet->count = (buf[1] >> 5) & 0x3; in intel_pt_get_ptwrite()
231 packet->type = buf[1] & BIT(7) ? INTEL_PT_PTWRITE_IP : in intel_pt_get_ptwrite()
234 switch (packet->count) { in intel_pt_get_ptwrite()
236 if (len < 6) in intel_pt_get_ptwrite()
238 packet->payload = le32_to_cpu(*(uint32_t *)(buf + 2)); in intel_pt_get_ptwrite()
241 if (len < 10) in intel_pt_get_ptwrite()
243 packet->payload = le64_to_cpu(*(uint64_t *)(buf + 2)); in intel_pt_get_ptwrite()
252 packet->type = INTEL_PT_EXSTOP; in intel_pt_get_exstop()
258 packet->type = INTEL_PT_EXSTOP_IP; in intel_pt_get_exstop_ip()
262 static int intel_pt_get_mwait(const unsigned char *buf, size_t len, in intel_pt_get_mwait() argument
265 if (len < 10) in intel_pt_get_mwait()
267 packet->type = INTEL_PT_MWAIT; in intel_pt_get_mwait()
268 packet->payload = le64_to_cpu(*(uint64_t *)(buf + 2)); in intel_pt_get_mwait()
272 static int intel_pt_get_pwre(const unsigned char *buf, size_t len, in intel_pt_get_pwre() argument
275 if (len < 4) in intel_pt_get_pwre()
277 packet->type = INTEL_PT_PWRE; in intel_pt_get_pwre()
278 memcpy_le64(&packet->payload, buf + 2, 2); in intel_pt_get_pwre()
282 static int intel_pt_get_pwrx(const unsigned char *buf, size_t len, in intel_pt_get_pwrx() argument
285 if (len < 7) in intel_pt_get_pwrx()
287 packet->type = INTEL_PT_PWRX; in intel_pt_get_pwrx()
288 memcpy_le64(&packet->payload, buf + 2, 5); in intel_pt_get_pwrx()
292 static int intel_pt_get_ext(const unsigned char *buf, size_t len, in intel_pt_get_ext() argument
295 if (len < 2) in intel_pt_get_ext()
299 return intel_pt_get_ptwrite(buf, len, packet); in intel_pt_get_ext()
303 return intel_pt_get_long_tnt(buf, len, packet); in intel_pt_get_ext()
305 return intel_pt_get_pip(buf, len, packet); in intel_pt_get_ext()
309 return intel_pt_get_cbr(buf, len, packet); in intel_pt_get_ext()
311 return intel_pt_get_vmcs(buf, len, packet); in intel_pt_get_ext()
315 return intel_pt_get_psb(buf, len, packet); in intel_pt_get_ext()
319 return intel_pt_get_tma(buf, len, packet); in intel_pt_get_ext()
320 case 0xC3: /* 3-byte header */ in intel_pt_get_ext()
321 return intel_pt_get_3byte(buf, len, packet); in intel_pt_get_ext()
327 return intel_pt_get_mwait(buf, len, packet); in intel_pt_get_ext()
329 return intel_pt_get_pwre(buf, len, packet); in intel_pt_get_ext()
331 return intel_pt_get_pwrx(buf, len, packet); in intel_pt_get_ext()
337 static int intel_pt_get_short_tnt(unsigned int byte, in intel_pt_get_short_tnt() argument
342 for (count = 6; count; count--) { in intel_pt_get_short_tnt()
343 if (byte & BIT(7)) in intel_pt_get_short_tnt()
345 byte <<= 1; in intel_pt_get_short_tnt()
348 packet->type = INTEL_PT_TNT; in intel_pt_get_short_tnt()
349 packet->count = count; in intel_pt_get_short_tnt()
350 packet->payload = (uint64_t)byte << 57; in intel_pt_get_short_tnt()
355 static int intel_pt_get_cyc(unsigned int byte, const unsigned char *buf, in intel_pt_get_cyc() argument
356 size_t len, struct intel_pt_pkt *packet) in intel_pt_get_cyc() argument
359 uint64_t payload = byte >> 3; in intel_pt_get_cyc()
361 byte >>= 2; in intel_pt_get_cyc()
362 len -= 1; in intel_pt_get_cyc()
363 for (shift = 5; byte & 1; shift += 7) { in intel_pt_get_cyc()
366 if (len < offs) in intel_pt_get_cyc()
368 byte = buf[offs++]; in intel_pt_get_cyc()
369 payload |= ((uint64_t)byte >> 1) << shift; in intel_pt_get_cyc()
372 packet->type = INTEL_PT_CYC; in intel_pt_get_cyc()
373 packet->payload = payload; in intel_pt_get_cyc()
377 static int intel_pt_get_ip(enum intel_pt_pkt_type type, unsigned int byte, in intel_pt_get_ip() argument
378 const unsigned char *buf, size_t len, in intel_pt_get_ip() argument
383 packet->count = byte >> 5; in intel_pt_get_ip()
385 switch (packet->count) { in intel_pt_get_ip()
390 if (len < 3) in intel_pt_get_ip()
393 packet->payload = le16_to_cpu(*(uint16_t *)(buf + 1)); in intel_pt_get_ip()
396 if (len < 5) in intel_pt_get_ip()
399 packet->payload = le32_to_cpu(*(uint32_t *)(buf + 1)); in intel_pt_get_ip()
403 if (len < 7) in intel_pt_get_ip()
406 memcpy_le64(&packet->payload, buf + 1, 6); in intel_pt_get_ip()
409 if (len < 9) in intel_pt_get_ip()
412 packet->payload = le64_to_cpu(*(uint64_t *)(buf + 1)); in intel_pt_get_ip()
418 packet->type = type; in intel_pt_get_ip()
423 static int intel_pt_get_mode(const unsigned char *buf, size_t len, in intel_pt_get_mode() argument
426 if (len < 2) in intel_pt_get_mode()
431 packet->type = INTEL_PT_MODE_EXEC; in intel_pt_get_mode()
434 packet->payload = 16; in intel_pt_get_mode()
437 packet->payload = 64; in intel_pt_get_mode()
440 packet->payload = 32; in intel_pt_get_mode()
447 packet->type = INTEL_PT_MODE_TSX; in intel_pt_get_mode()
450 packet->payload = buf[1] & 3; in intel_pt_get_mode()
459 static int intel_pt_get_tsc(const unsigned char *buf, size_t len, in intel_pt_get_tsc() argument
462 if (len < 8) in intel_pt_get_tsc()
464 packet->type = INTEL_PT_TSC; in intel_pt_get_tsc()
465 memcpy_le64(&packet->payload, buf + 1, 7); in intel_pt_get_tsc()
469 static int intel_pt_get_mtc(const unsigned char *buf, size_t len, in intel_pt_get_mtc() argument
472 if (len < 2) in intel_pt_get_mtc()
474 packet->type = INTEL_PT_MTC; in intel_pt_get_mtc()
475 packet->payload = buf[1]; in intel_pt_get_mtc()
479 static int intel_pt_do_get_packet(const unsigned char *buf, size_t len, in intel_pt_do_get_packet() argument
482 unsigned int byte; in intel_pt_do_get_packet() local
486 if (!len) in intel_pt_do_get_packet()
489 byte = buf[0]; in intel_pt_do_get_packet()
490 if (!(byte & BIT(0))) { in intel_pt_do_get_packet()
491 if (byte == 0) in intel_pt_do_get_packet()
493 if (byte == 2) in intel_pt_do_get_packet()
494 return intel_pt_get_ext(buf, len, packet); in intel_pt_do_get_packet()
495 return intel_pt_get_short_tnt(byte, packet); in intel_pt_do_get_packet()
498 if ((byte & 2)) in intel_pt_do_get_packet()
499 return intel_pt_get_cyc(byte, buf, len, packet); in intel_pt_do_get_packet()
501 switch (byte & 0x1f) { in intel_pt_do_get_packet()
503 return intel_pt_get_ip(INTEL_PT_TIP, byte, buf, len, packet); in intel_pt_do_get_packet()
505 return intel_pt_get_ip(INTEL_PT_TIP_PGE, byte, buf, len, in intel_pt_do_get_packet()
508 return intel_pt_get_ip(INTEL_PT_TIP_PGD, byte, buf, len, in intel_pt_do_get_packet()
511 return intel_pt_get_ip(INTEL_PT_FUP, byte, buf, len, packet); in intel_pt_do_get_packet()
513 switch (byte) { in intel_pt_do_get_packet()
515 return intel_pt_get_mode(buf, len, packet); in intel_pt_do_get_packet()
517 return intel_pt_get_tsc(buf, len, packet); in intel_pt_do_get_packet()
519 return intel_pt_get_mtc(buf, len, packet); in intel_pt_do_get_packet()
528 int intel_pt_get_packet(const unsigned char *buf, size_t len, in intel_pt_get_packet() argument
533 ret = intel_pt_do_get_packet(buf, len, packet); in intel_pt_get_packet()
535 while (ret < 8 && len > (size_t)ret && !buf[ret]) in intel_pt_get_packet()
545 unsigned long long payload = packet->payload; in intel_pt_pkt_desc()
546 const char *name = intel_pt_pkt_name(packet->type); in intel_pt_pkt_desc()
548 switch (packet->type) { in intel_pt_pkt_desc()
563 blen -= ret; in intel_pt_pkt_desc()
564 for (i = 0; i < packet->count; i++) { in intel_pt_pkt_desc()
572 blen -= ret; in intel_pt_pkt_desc()
575 ret = snprintf(buf, blen, " (%d)", packet->count); in intel_pt_pkt_desc()
578 blen -= ret; in intel_pt_pkt_desc()
579 return buf_len - blen; in intel_pt_pkt_desc()
585 if (!(packet->count)) in intel_pt_pkt_desc()
597 (unsigned)payload, packet->count); in intel_pt_pkt_desc()
605 nr = packet->payload & NR_FLAG ? 1 : 0; in intel_pt_pkt_desc()
623 return snprintf(buf, buf_len, "%s 0x%llx HW:%u CState:%u Sub-CState:%u", in intel_pt_pkt_desc()
637 name, payload, packet->count); in intel_pt_pkt_desc()