17a338472SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
2783e9e51SPaolo Bonzini /*
3783e9e51SPaolo Bonzini  * tools/testing/selftests/kvm/lib/assert.c
4783e9e51SPaolo Bonzini  *
5783e9e51SPaolo Bonzini  * Copyright (C) 2018, Google LLC.
6783e9e51SPaolo Bonzini  */
7783e9e51SPaolo Bonzini #include "test_util.h"
8783e9e51SPaolo Bonzini 
9783e9e51SPaolo Bonzini #include <execinfo.h>
10783e9e51SPaolo Bonzini #include <sys/syscall.h>
11783e9e51SPaolo Bonzini 
12cc68765dSAndrew Jones #include "kselftest.h"
13ab0e9c4bSShuah Khan (Samsung OSG) 
14783e9e51SPaolo Bonzini /* Dumps the current stack trace to stderr. */
15783e9e51SPaolo Bonzini static void __attribute__((noinline)) test_dump_stack(void);
test_dump_stack(void)16783e9e51SPaolo Bonzini static void test_dump_stack(void)
17783e9e51SPaolo Bonzini {
18783e9e51SPaolo Bonzini 	/*
19783e9e51SPaolo Bonzini 	 * Build and run this command:
20783e9e51SPaolo Bonzini 	 *
21783e9e51SPaolo Bonzini 	 *	addr2line -s -e /proc/$PPID/exe -fpai {backtrace addresses} | \
22*09636efdSDavid Matlack 	 *		cat -n 1>&2
23783e9e51SPaolo Bonzini 	 *
24783e9e51SPaolo Bonzini 	 * Note that the spacing is different and there's no newline.
25783e9e51SPaolo Bonzini 	 */
26783e9e51SPaolo Bonzini 	size_t i;
27783e9e51SPaolo Bonzini 	size_t n = 20;
28783e9e51SPaolo Bonzini 	void *stack[n];
29783e9e51SPaolo Bonzini 	const char *addr2line = "addr2line -s -e /proc/$PPID/exe -fpai";
30783e9e51SPaolo Bonzini 	const char *pipeline = "|cat -n 1>&2";
31783e9e51SPaolo Bonzini 	char cmd[strlen(addr2line) + strlen(pipeline) +
32783e9e51SPaolo Bonzini 		 /* N bytes per addr * 2 digits per byte + 1 space per addr: */
33783e9e51SPaolo Bonzini 		 n * (((sizeof(void *)) * 2) + 1) +
34783e9e51SPaolo Bonzini 		 /* Null terminator: */
35783e9e51SPaolo Bonzini 		 1];
36*09636efdSDavid Matlack 	char *c = cmd;
37783e9e51SPaolo Bonzini 
38783e9e51SPaolo Bonzini 	n = backtrace(stack, n);
39783e9e51SPaolo Bonzini 	/*
40*09636efdSDavid Matlack 	 * Skip the first 2 frames, which should be test_dump_stack() and
41*09636efdSDavid Matlack 	 * test_assert(); both of which are declared noinline.  Bail if the
42*09636efdSDavid Matlack 	 * resulting stack trace would be empty. Otherwise, addr2line will block
43*09636efdSDavid Matlack 	 * waiting for addresses to be passed in via stdin.
44783e9e51SPaolo Bonzini 	 */
45*09636efdSDavid Matlack 	if (n <= 2) {
46*09636efdSDavid Matlack 		fputs("  (stack trace empty)\n", stderr);
47*09636efdSDavid Matlack 		return;
48*09636efdSDavid Matlack 	}
49*09636efdSDavid Matlack 
50*09636efdSDavid Matlack 	c += sprintf(c, "%s", addr2line);
51783e9e51SPaolo Bonzini 	for (i = 2; i < n; i++)
52783e9e51SPaolo Bonzini 		c += sprintf(c, " %lx", ((unsigned long) stack[i]) - 1);
53*09636efdSDavid Matlack 
54783e9e51SPaolo Bonzini 	c += sprintf(c, "%s", pipeline);
55783e9e51SPaolo Bonzini #pragma GCC diagnostic push
56783e9e51SPaolo Bonzini #pragma GCC diagnostic ignored "-Wunused-result"
57783e9e51SPaolo Bonzini 	system(cmd);
58783e9e51SPaolo Bonzini #pragma GCC diagnostic pop
59783e9e51SPaolo Bonzini }
60783e9e51SPaolo Bonzini 
_gettid(void)61e37f9f13SVitaly Kuznetsov static pid_t _gettid(void)
62783e9e51SPaolo Bonzini {
63783e9e51SPaolo Bonzini 	return syscall(SYS_gettid);
64783e9e51SPaolo Bonzini }
65783e9e51SPaolo Bonzini 
66783e9e51SPaolo Bonzini void __attribute__((noinline))
test_assert(bool exp,const char * exp_str,const char * file,unsigned int line,const char * fmt,...)67783e9e51SPaolo Bonzini test_assert(bool exp, const char *exp_str,
68783e9e51SPaolo Bonzini 	const char *file, unsigned int line, const char *fmt, ...)
69783e9e51SPaolo Bonzini {
70783e9e51SPaolo Bonzini 	va_list ap;
71783e9e51SPaolo Bonzini 
72783e9e51SPaolo Bonzini 	if (!(exp)) {
73783e9e51SPaolo Bonzini 		va_start(ap, fmt);
74783e9e51SPaolo Bonzini 
75783e9e51SPaolo Bonzini 		fprintf(stderr, "==== Test Assertion Failure ====\n"
76783e9e51SPaolo Bonzini 			"  %s:%u: %s\n"
77c412d6acSYanan Wang 			"  pid=%d tid=%d errno=%d - %s\n",
78e37f9f13SVitaly Kuznetsov 			file, line, exp_str, getpid(), _gettid(),
79c412d6acSYanan Wang 			errno, strerror(errno));
80783e9e51SPaolo Bonzini 		test_dump_stack();
81783e9e51SPaolo Bonzini 		if (fmt) {
82783e9e51SPaolo Bonzini 			fputs("  ", stderr);
83783e9e51SPaolo Bonzini 			vfprintf(stderr, fmt, ap);
84783e9e51SPaolo Bonzini 			fputs("\n", stderr);
85783e9e51SPaolo Bonzini 		}
86783e9e51SPaolo Bonzini 		va_end(ap);
87783e9e51SPaolo Bonzini 
88d0aac332SAndrew Jones 		if (errno == EACCES) {
89d0aac332SAndrew Jones 			print_skip("Access denied - Exiting");
90d0aac332SAndrew Jones 			exit(KSFT_SKIP);
91d0aac332SAndrew Jones 		}
92783e9e51SPaolo Bonzini 		exit(254);
93783e9e51SPaolo Bonzini 	}
94783e9e51SPaolo Bonzini 
95783e9e51SPaolo Bonzini 	return;
96783e9e51SPaolo Bonzini }
97