Add support for decoding Intel Processor Trace packets.

This essentially provides intel_pt_get_packet() which takes a buffer of
binary data and returns the decoded packet.

Signed-off-by: Adrian Hunter <adrian.hun...@intel.com>
---
 tools/perf/util/Build                              |   1 +
 tools/perf/util/intel-pt-decoder/Build             |   1 +
 .../util/intel-pt-decoder/intel-pt-pkt-decoder.c   | 400 +++++++++++++++++++++
 .../util/intel-pt-decoder/intel-pt-pkt-decoder.h   |  64 ++++
 4 files changed, 466 insertions(+)
 create mode 100644 tools/perf/util/intel-pt-decoder/Build
 create mode 100644 tools/perf/util/intel-pt-decoder/intel-pt-pkt-decoder.c
 create mode 100644 tools/perf/util/intel-pt-decoder/intel-pt-pkt-decoder.h

diff --git a/tools/perf/util/Build b/tools/perf/util/Build
index 601d11440596..1b67598d4c87 100644
--- a/tools/perf/util/Build
+++ b/tools/perf/util/Build
@@ -76,6 +76,7 @@ libperf-$(CONFIG_X86) += tsc.o
 libperf-y += cloexec.o
 libperf-y += thread-stack.o
 libperf-$(CONFIG_AUXTRACE) += auxtrace.o
+libperf-$(CONFIG_AUXTRACE) += intel-pt-decoder/
 libperf-y += parse-branch-options.o
 
 libperf-$(CONFIG_LIBELF) += symbol-elf.o
diff --git a/tools/perf/util/intel-pt-decoder/Build 
b/tools/perf/util/intel-pt-decoder/Build
new file mode 100644
index 000000000000..9d67381a9bd3
--- /dev/null
+++ b/tools/perf/util/intel-pt-decoder/Build
@@ -0,0 +1 @@
+libperf-$(CONFIG_AUXTRACE) += intel-pt-pkt-decoder.o
diff --git a/tools/perf/util/intel-pt-decoder/intel-pt-pkt-decoder.c 
b/tools/perf/util/intel-pt-decoder/intel-pt-pkt-decoder.c
new file mode 100644
index 000000000000..988c82c6652d
--- /dev/null
+++ b/tools/perf/util/intel-pt-decoder/intel-pt-pkt-decoder.c
@@ -0,0 +1,400 @@
+/*
+ * intel_pt_pkt_decoder.c: Intel Processor Trace support
+ * Copyright (c) 2013-2014, Intel Corporation.
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms and conditions of the GNU General Public License,
+ * version 2, as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope it will be useful, but WITHOUT
+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
+ * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
+ * more details.
+ *
+ */
+
+#include <stdio.h>
+#include <string.h>
+#include <endian.h>
+#include <byteswap.h>
+
+#include "intel-pt-pkt-decoder.h"
+
+#define BIT(n)         (1 << (n))
+
+#define BIT63          ((uint64_t)1 << 63)
+
+#if __BYTE_ORDER == __BIG_ENDIAN
+#define le16_to_cpu bswap_16
+#define le32_to_cpu bswap_32
+#define le64_to_cpu bswap_64
+#define memcpy_le64(d, s, n) do { \
+       memcpy((d), (s), (n));    \
+       *(d) = le64_to_cpu(*(d)); \
+} while (0)
+#else
+#define le16_to_cpu
+#define le32_to_cpu
+#define le64_to_cpu
+#define memcpy_le64 memcpy
+#endif
+
+static const char * const packet_name[] = {
+       [INTEL_PT_BAD]          = "Bad Packet!",
+       [INTEL_PT_PAD]          = "PAD",
+       [INTEL_PT_TNT]          = "TNT",
+       [INTEL_PT_TIP_PGD]      = "TIP.PGD",
+       [INTEL_PT_TIP_PGE]      = "TIP.PGE",
+       [INTEL_PT_TSC]          = "TSC",
+       [INTEL_PT_MODE_EXEC]    = "MODE.Exec",
+       [INTEL_PT_MODE_TSX]     = "MODE.TSX",
+       [INTEL_PT_TIP]          = "TIP",
+       [INTEL_PT_FUP]          = "FUP",
+       [INTEL_PT_PSB]          = "PSB",
+       [INTEL_PT_PSBEND]       = "PSBEND",
+       [INTEL_PT_CBR]          = "CBR",
+       [INTEL_PT_PIP]          = "PIP",
+       [INTEL_PT_OVF]          = "OVF",
+};
+
+const char *intel_pt_pkt_name(enum intel_pt_pkt_type type)
+{
+       return packet_name[type];
+}
+
+static int intel_pt_get_long_tnt(const unsigned char *buf, size_t len,
+                                struct intel_pt_pkt *packet)
+{
+       uint64_t payload;
+       int count;
+
+       if (len < 8)
+               return INTEL_PT_NEED_MORE_BYTES;
+
+       payload = le64_to_cpu(*(uint64_t *)buf);
+
+       for (count = 47; count; count--) {
+               if (payload & BIT63)
+                       break;
+               payload <<= 1;
+       }
+
+       packet->type = INTEL_PT_TNT;
+       packet->count = count;
+       packet->payload = payload << 1;
+       return 8;
+}
+
+static int intel_pt_get_pip(const unsigned char *buf, size_t len,
+                           struct intel_pt_pkt *packet)
+{
+       uint64_t payload = 0;
+
+       if (len < 8)
+               return INTEL_PT_NEED_MORE_BYTES;
+
+       packet->type = INTEL_PT_PIP;
+       memcpy_le64(&payload, buf + 2, 6);
+       packet->payload = payload >> 1;
+
+       return 8;
+}
+
+static int intel_pt_get_cbr(const unsigned char *buf, size_t len,
+                           struct intel_pt_pkt *packet)
+{
+       if (len < 4)
+               return INTEL_PT_NEED_MORE_BYTES;
+       packet->type = INTEL_PT_CBR;
+       packet->payload = buf[2];
+       return 4;
+}
+
+static int intel_pt_get_ovf(struct intel_pt_pkt *packet)
+{
+       packet->type = INTEL_PT_OVF;
+       return 2;
+}
+
+static int intel_pt_get_psb(const unsigned char *buf, size_t len,
+                           struct intel_pt_pkt *packet)
+{
+       int i;
+
+       if (len < 16)
+               return INTEL_PT_NEED_MORE_BYTES;
+
+       for (i = 2; i < 16; i += 2) {
+               if (buf[i] != 2 || buf[i + 1] != 0x82)
+                       return INTEL_PT_BAD_PACKET;
+       }
+
+       packet->type = INTEL_PT_PSB;
+       return 16;
+}
+
+static int intel_pt_get_psbend(struct intel_pt_pkt *packet)
+{
+       packet->type = INTEL_PT_PSBEND;
+       return 2;
+}
+
+static int intel_pt_get_pad(struct intel_pt_pkt *packet)
+{
+       packet->type = INTEL_PT_PAD;
+       return 1;
+}
+
+static int intel_pt_get_ext(const unsigned char *buf, size_t len,
+                           struct intel_pt_pkt *packet)
+{
+       if (len < 2)
+               return INTEL_PT_NEED_MORE_BYTES;
+
+       switch (buf[1]) {
+       case 0xa3: /* Long TNT */
+               return intel_pt_get_long_tnt(buf, len, packet);
+       case 0x43: /* PIP */
+               return intel_pt_get_pip(buf, len, packet);
+       case 0x03: /* CBR */
+               return intel_pt_get_cbr(buf, len, packet);
+       case 0xf3: /* OVF */
+               return intel_pt_get_ovf(packet);
+       case 0x82: /* PSB */
+               return intel_pt_get_psb(buf, len, packet);
+       case 0x23: /* PSBEND */
+               return intel_pt_get_psbend(packet);
+       default:
+               return INTEL_PT_BAD_PACKET;
+       }
+}
+
+static int intel_pt_get_short_tnt(unsigned int byte,
+                                 struct intel_pt_pkt *packet)
+{
+       int count;
+
+       for (count = 6; count; count--) {
+               if (byte & BIT(7))
+                       break;
+               byte <<= 1;
+       }
+
+       packet->type = INTEL_PT_TNT;
+       packet->count = count;
+       packet->payload = (uint64_t)byte << 57;
+
+       return 1;
+}
+
+static int 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)
+{
+       switch (byte >> 5) {
+       case 0:
+               packet->count = 0;
+               break;
+       case 1:
+               if (len < 3)
+                       return INTEL_PT_NEED_MORE_BYTES;
+               packet->count = 2;
+               packet->payload = le16_to_cpu(*(uint16_t *)(buf + 1));
+               break;
+       case 2:
+               if (len < 5)
+                       return INTEL_PT_NEED_MORE_BYTES;
+               packet->count = 4;
+               packet->payload = le32_to_cpu(*(uint32_t *)(buf + 1));
+               break;
+       case 3:
+       case 6:
+               if (len < 7)
+                       return INTEL_PT_NEED_MORE_BYTES;
+               packet->count = 6;
+               memcpy_le64(&packet->payload, buf + 1, 6);
+               break;
+       default:
+               return INTEL_PT_BAD_PACKET;
+       }
+
+       packet->type = type;
+
+       return packet->count + 1;
+}
+
+static int intel_pt_get_mode(const unsigned char *buf, size_t len,
+                            struct intel_pt_pkt *packet)
+{
+       if (len < 2)
+               return INTEL_PT_NEED_MORE_BYTES;
+
+       switch (buf[1] >> 5) {
+       case 0:
+               packet->type = INTEL_PT_MODE_EXEC;
+               switch (buf[1] & 3) {
+               case 0:
+                       packet->payload = 16;
+                       break;
+               case 1:
+                       packet->payload = 64;
+                       break;
+               case 2:
+                       packet->payload = 32;
+                       break;
+               default:
+                       return INTEL_PT_BAD_PACKET;
+               }
+               break;
+       case 1:
+               packet->type = INTEL_PT_MODE_TSX;
+               if ((buf[1] & 3) == 3)
+                       return INTEL_PT_BAD_PACKET;
+               packet->payload = buf[1] & 3;
+               break;
+       default:
+               return INTEL_PT_BAD_PACKET;
+       }
+
+       return 2;
+}
+
+static int intel_pt_get_tsc(const unsigned char *buf, size_t len,
+                           struct intel_pt_pkt *packet)
+{
+       if (len < 8)
+               return INTEL_PT_NEED_MORE_BYTES;
+       packet->type = INTEL_PT_TSC;
+       memcpy_le64(&packet->payload, buf + 1, 7);
+       return 8;
+}
+
+static int intel_pt_do_get_packet(const unsigned char *buf, size_t len,
+                                 struct intel_pt_pkt *packet)
+{
+       unsigned int byte;
+
+       memset(packet, 0, sizeof(struct intel_pt_pkt));
+
+       if (!len)
+               return INTEL_PT_NEED_MORE_BYTES;
+
+       byte = buf[0];
+       if (!(byte & BIT(0))) {
+               if (byte == 0)
+                       return intel_pt_get_pad(packet);
+               if (byte == 2)
+                       return intel_pt_get_ext(buf, len, packet);
+               return intel_pt_get_short_tnt(byte, packet);
+       }
+
+       switch (byte & 0x1f) {
+       case 0x0D:
+               return intel_pt_get_ip(INTEL_PT_TIP, byte, buf, len, packet);
+       case 0x11:
+               return intel_pt_get_ip(INTEL_PT_TIP_PGE, byte, buf, len,
+                                      packet);
+       case 0x01:
+               return intel_pt_get_ip(INTEL_PT_TIP_PGD, byte, buf, len,
+                                      packet);
+       case 0x1D:
+               return intel_pt_get_ip(INTEL_PT_FUP, byte, buf, len, packet);
+       case 0x19:
+               switch (byte) {
+               case 0x99:
+                       return intel_pt_get_mode(buf, len, packet);
+               case 0x19:
+                       return intel_pt_get_tsc(buf, len, packet);
+               default:
+                       return INTEL_PT_BAD_PACKET;
+               }
+       default:
+               return INTEL_PT_BAD_PACKET;
+       }
+}
+
+int intel_pt_get_packet(const unsigned char *buf, size_t len,
+                       struct intel_pt_pkt *packet)
+{
+       int ret;
+
+       ret = intel_pt_do_get_packet(buf, len, packet);
+       if (ret > 0) {
+               while (ret < 8 && len > (size_t)ret && !buf[ret])
+                       ret += 1;
+       }
+       return ret;
+}
+
+int intel_pt_pkt_desc(const struct intel_pt_pkt *packet, char *buf,
+                     size_t buf_len)
+{
+       int ret, i;
+       unsigned long long payload = packet->payload;
+       const char *name = intel_pt_pkt_name(packet->type);
+
+       switch (packet->type) {
+       case INTEL_PT_BAD:
+       case INTEL_PT_PAD:
+       case INTEL_PT_PSB:
+       case INTEL_PT_PSBEND:
+       case INTEL_PT_OVF:
+               return snprintf(buf, buf_len, "%s", name);
+       case INTEL_PT_TNT: {
+               size_t blen = buf_len;
+
+               ret = snprintf(buf, blen, "%s ", name);
+               if (ret < 0)
+                       return ret;
+               buf += ret;
+               blen -= ret;
+               for (i = 0; i < packet->count; i++) {
+                       if (payload & BIT63)
+                               ret = snprintf(buf, blen, "T");
+                       else
+                               ret = snprintf(buf, blen, "N");
+                       if (ret < 0)
+                               return ret;
+                       buf += ret;
+                       blen -= ret;
+                       payload <<= 1;
+               }
+               ret = snprintf(buf, blen, " (%d)", packet->count);
+               if (ret < 0)
+                       return ret;
+               blen -= ret;
+               return buf_len - blen;
+       }
+       case INTEL_PT_TIP_PGD:
+       case INTEL_PT_TIP_PGE:
+       case INTEL_PT_TIP:
+       case INTEL_PT_FUP:
+               if (!(packet->count))
+                       return snprintf(buf, buf_len, "%s no ip", name);
+       case INTEL_PT_CBR:
+               return snprintf(buf, buf_len, "%s 0x%llx", name, payload);
+       case INTEL_PT_TSC:
+               if (packet->count)
+                       return snprintf(buf, buf_len,
+                                       "%s 0x%llx CTC 0x%x FC 0x%x",
+                                       name, payload, packet->count & 0xffff,
+                                       (packet->count >> 16) & 0x1ff);
+               else
+                       return snprintf(buf, buf_len, "%s 0x%llx",
+                                       name, payload);
+       case INTEL_PT_MODE_EXEC:
+               return snprintf(buf, buf_len, "%s %lld", name, payload);
+       case INTEL_PT_MODE_TSX:
+               return snprintf(buf, buf_len, "%s TXAbort:%u InTX:%u",
+                               name, (unsigned)(payload >> 1) & 1,
+                               (unsigned)payload & 1);
+       case INTEL_PT_PIP:
+               ret = snprintf(buf, buf_len, "%s 0x%llx",
+                              name, payload);
+               return ret;
+       default:
+               break;
+       }
+       return snprintf(buf, buf_len, "%s 0x%llx (%d)",
+                       name, payload, packet->count);
+}
diff --git a/tools/perf/util/intel-pt-decoder/intel-pt-pkt-decoder.h 
b/tools/perf/util/intel-pt-decoder/intel-pt-pkt-decoder.h
new file mode 100644
index 000000000000..53404fa942b3
--- /dev/null
+++ b/tools/perf/util/intel-pt-decoder/intel-pt-pkt-decoder.h
@@ -0,0 +1,64 @@
+/*
+ * intel_pt_pkt_decoder.h: Intel Processor Trace support
+ * Copyright (c) 2013-2014, Intel Corporation.
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms and conditions of the GNU General Public License,
+ * version 2, as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope it will be useful, but WITHOUT
+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
+ * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
+ * more details.
+ *
+ */
+
+#ifndef INCLUDE__INTEL_PT_PKT_DECODER_H__
+#define INCLUDE__INTEL_PT_PKT_DECODER_H__
+
+#include <stddef.h>
+#include <stdint.h>
+
+#define INTEL_PT_PKT_DESC_MAX  256
+
+#define INTEL_PT_NEED_MORE_BYTES       -1
+#define INTEL_PT_BAD_PACKET            -2
+
+#define INTEL_PT_PSB_STR               "\002\202\002\202\002\202\002\202" \
+                                       "\002\202\002\202\002\202\002\202"
+#define INTEL_PT_PSB_LEN               16
+
+#define INTEL_PT_PKT_MAX_SZ            16
+
+enum intel_pt_pkt_type {
+       INTEL_PT_BAD,
+       INTEL_PT_PAD,
+       INTEL_PT_TNT,
+       INTEL_PT_TIP_PGD,
+       INTEL_PT_TIP_PGE,
+       INTEL_PT_TSC,
+       INTEL_PT_MODE_EXEC,
+       INTEL_PT_MODE_TSX,
+       INTEL_PT_TIP,
+       INTEL_PT_FUP,
+       INTEL_PT_PSB,
+       INTEL_PT_PSBEND,
+       INTEL_PT_CBR,
+       INTEL_PT_PIP,
+       INTEL_PT_OVF,
+};
+
+struct intel_pt_pkt {
+       enum intel_pt_pkt_type  type;
+       int                     count;
+       uint64_t                payload;
+};
+
+const char *intel_pt_pkt_name(enum intel_pt_pkt_type);
+
+int intel_pt_get_packet(const unsigned char *buf, size_t len,
+                       struct intel_pt_pkt *packet);
+
+int intel_pt_pkt_desc(const struct intel_pt_pkt *packet, char *buf, size_t 
len);
+
+#endif
-- 
1.9.1

--
To unsubscribe from this list: send the line "unsubscribe linux-kernel" in
the body of a message to majord...@vger.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html
Please read the FAQ at  http://www.tux.org/lkml/

Reply via email to