mirror of
https://github.com/projectacrn/acrn-hypervisor.git
synced 2025-05-04 06:26:54 +00:00
925e3d95b4
sbuf_put copies sbuf->ele_size of data, and puts into ring. Currently this function assumes that data size from caller is no less than sbuf->ele_size. But as sbuf->ele_size is usually setup by some sources outside of the HV (e.g., the service VM), it is not meant to be trusted. So caller should provide the max length of the data for safety reason. sbuf_put() will return UINT32_MAX if max_len of data is less than element size. Additionally, a helper function sbuf_put_many() is added for putting multiple entries. Tracked-On: #8547 Signed-off-by: Wu Zhou <wu.zhou@intel.com> Reviewed-by: Junjie Mao <junjie.mao@intel.com>
136 lines
2.9 KiB
C
136 lines
2.9 KiB
C
/*
|
|
* Copyright (C) 2018-2022 Intel Corporation.
|
|
*
|
|
* SPDX-License-Identifier: BSD-3-Clause
|
|
*/
|
|
|
|
#include <types.h>
|
|
#include <asm/per_cpu.h>
|
|
#include <ticks.h>
|
|
#include <trace.h>
|
|
|
|
#define TRACE_CUSTOM 0xFCU
|
|
#define TRACE_FUNC_ENTER 0xFDU
|
|
#define TRACE_FUNC_EXIT 0xFEU
|
|
#define TRACE_STR 0xFFU
|
|
|
|
/* sizeof(trace_entry) == 4 x 64bit */
|
|
struct trace_entry {
|
|
uint64_t tsc; /* TSC */
|
|
uint64_t id:48;
|
|
uint8_t n_data; /* nr of data in trace_entry */
|
|
uint8_t cpu; /* pcpu id of trace_entry */
|
|
|
|
union {
|
|
struct {
|
|
uint32_t a, b, c, d;
|
|
} fields_32;
|
|
struct {
|
|
uint8_t a1, a2, a3, a4;
|
|
uint8_t b1, b2, b3, b4;
|
|
uint8_t c1, c2, c3, c4;
|
|
uint8_t d1, d2, d3, d4;
|
|
} fields_8;
|
|
struct {
|
|
uint64_t e;
|
|
uint64_t f;
|
|
} fields_64;
|
|
char str[16];
|
|
} payload;
|
|
} __aligned(8);
|
|
|
|
static inline bool trace_check(uint16_t cpu_id)
|
|
{
|
|
if (per_cpu(sbuf, cpu_id)[ACRN_TRACE] == NULL) {
|
|
return false;
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
static inline void trace_put(uint16_t cpu_id, uint32_t evid, uint32_t n_data, struct trace_entry *entry)
|
|
{
|
|
struct shared_buf *sbuf = per_cpu(sbuf, cpu_id)[ACRN_TRACE];
|
|
|
|
entry->tsc = cpu_ticks();
|
|
entry->id = evid;
|
|
entry->n_data = (uint8_t)n_data;
|
|
entry->cpu = (uint8_t)cpu_id;
|
|
(void)sbuf_put(sbuf, (uint8_t *)entry, sizeof(*entry));
|
|
}
|
|
|
|
void TRACE_2L(uint32_t evid, uint64_t e, uint64_t f)
|
|
{
|
|
struct trace_entry entry;
|
|
uint16_t cpu_id = get_pcpu_id();
|
|
|
|
if (!trace_check(cpu_id)) {
|
|
return;
|
|
}
|
|
|
|
entry.payload.fields_64.e = e;
|
|
entry.payload.fields_64.f = f;
|
|
trace_put(cpu_id, evid, 2U, &entry);
|
|
}
|
|
|
|
void TRACE_4I(uint32_t evid, uint32_t a, uint32_t b, uint32_t c, uint32_t d)
|
|
{
|
|
struct trace_entry entry;
|
|
uint16_t cpu_id = get_pcpu_id();
|
|
|
|
if (!trace_check(cpu_id)) {
|
|
return;
|
|
}
|
|
|
|
entry.payload.fields_32.a = a;
|
|
entry.payload.fields_32.b = b;
|
|
entry.payload.fields_32.c = c;
|
|
entry.payload.fields_32.d = d;
|
|
trace_put(cpu_id, evid, 4U, &entry);
|
|
}
|
|
|
|
void TRACE_6C(uint32_t evid, uint8_t a1, uint8_t a2, uint8_t a3, uint8_t a4, uint8_t b1, uint8_t b2)
|
|
{
|
|
struct trace_entry entry;
|
|
uint16_t cpu_id = get_pcpu_id();
|
|
|
|
if (!trace_check(cpu_id)) {
|
|
return;
|
|
}
|
|
|
|
entry.payload.fields_8.a1 = a1;
|
|
entry.payload.fields_8.a2 = a2;
|
|
entry.payload.fields_8.a3 = a3;
|
|
entry.payload.fields_8.a4 = a4;
|
|
entry.payload.fields_8.b1 = b1;
|
|
entry.payload.fields_8.b2 = b2;
|
|
/* payload.fields_8.b3/b4 not used, but is put in trace buf */
|
|
trace_put(cpu_id, evid, 8U, &entry);
|
|
}
|
|
|
|
#define TRACE_ENTER TRACE_16STR(TRACE_FUNC_ENTER, __func__)
|
|
#define TRACE_EXIT TRACE_16STR(TRACE_FUNC_EXIT, __func__)
|
|
|
|
static inline void TRACE_16STR(uint32_t evid, const char name[])
|
|
{
|
|
struct trace_entry entry;
|
|
uint16_t cpu_id = get_pcpu_id();
|
|
size_t len, i;
|
|
|
|
if (!trace_check(cpu_id)) {
|
|
return;
|
|
}
|
|
|
|
entry.payload.fields_64.e = 0UL;
|
|
entry.payload.fields_64.f = 0UL;
|
|
|
|
len = strnlen_s(name, 20U);
|
|
len = (len > 16U) ? 16U : len;
|
|
for (i = 0U; i < len; i++) {
|
|
entry.payload.str[i] = name[i];
|
|
}
|
|
|
|
entry.payload.str[15] = 0;
|
|
trace_put(cpu_id, evid, 16U, &entry);
|
|
}
|