benchmark_aux.c

/*
 * Copyright (c) 2016, Linaro Limited
 * SPDX-License-Identifier: BSD-2-Clause
 */
#include <fcntl.h>
#include <libgen.h>
#include <linux/limits.h>
#include <math.h>
#include <stdlib.h>
#include <stdio.h>
#include <string.h>
#include <sys/mman.h>
#include <sys/stat.h>
#include <unistd.h>

#include "benchmark_aux.h"
#include "common.h"

/* Misc auxilary functions */
void tee_errx(const char *msg, TEEC_Result res)
{
	ERROR_EXIT("%s: 0x%08x\n", msg, res);
}

void tee_check_res(TEEC_Result res, const char *errmsg)
{
	if (res != TEEC_SUCCESS)
		tee_errx(errmsg, res);
}

const char *bench_str_src(uint64_t source)
{
	switch (source) {
	case TEE_BENCH_CORE:
		return "core";
	case TEE_BENCH_KMOD:
		return "kmodule";
	case TEE_BENCH_CLIENT:
		return "libteec";
	case TEE_BENCH_UTEE:
		return "libutee";
	default:
		return "-";
	}
}

void print_line(void)
{
		int n = 115;

		while (n-- > 0)
			printf("=");
		printf("\n");
}

void alloc_argv(int argc, char *argv[], char **new_argv[])
{
	char *res, *base;
	char path[PATH_MAX];
	char **testapp_argv;
	int i;

	res = realpath(argv[1], path);
	if (!res)
		_exit(EXIT_FAILURE);

	*new_argv = malloc(argc * sizeof(void *));
	if (!(*new_argv))
		_exit(EXIT_FAILURE);

	testapp_argv = *new_argv;
	testapp_argv[argc-1] = NULL;
	base = basename(path);

	testapp_argv[0] = malloc(strlen(base) + 1);
	if (!testapp_argv[0])
		_exit(EXIT_FAILURE);

	memcpy(testapp_argv[0], base, strlen(base) + 1);

	for (i = 2; i < argc; i++) {
		size_t length = strlen(argv[i]) + 1;

		testapp_argv[i - 1] = malloc(length);
		if (!testapp_argv[i - 1])
			_exit(EXIT_FAILURE);

		memcpy(testapp_argv[i-1], argv[i], length);
	}
}

void dealloc_argv(int new_argc, char **new_argv)
{
	int i;
	for (i = 0; i < new_argc; ++i)
		free(new_argv[i]);

	free(new_argv);
}

uint32_t get_cores(void)
{
	return sysconf(_SC_NPROCESSORS_ONLN);
}

void *mmap_paddr(intptr_t paddr, uint64_t size)
{
	int devmem;
	off_t offset = 0;
	off_t page_addr;
	intptr_t *hw_addr = (intptr_t *)paddr;

	devmem = open("/dev/mem", O_RDWR);
	if (!devmem)
		return NULL;

	offset = (off_t)(uintptr_t)hw_addr % getpagesize();
	page_addr = (off_t)(uintptr_t)(hw_addr - offset);

	hw_addr = (intptr_t *)mmap(0, size, PROT_READ|PROT_WRITE,
					MAP_SHARED, devmem, page_addr);
	if (hw_addr == MAP_FAILED) {
		close(devmem);
		return NULL;
	}

	close(devmem);
	return (hw_addr + offset);
}

size_t get_library_load_offset(pid_t pid, const char *libname)
{
	char path[256];
	char buf[256];
	FILE *file;
	size_t addr = 0;
	size_t start, end, offset;
	char flags[4];
	int len;
	int len_libname = strlen(libname);

	snprintf(path, sizeof(path), "/proc/%d/smaps", pid);

	file = fopen(path, "rt");
	if (file == NULL)
		return 0;

	while (fgets(buf, sizeof(buf), file) != NULL) {
		len = strlen(buf);
		if (len > 0 && buf[len-1] == '\n')
			buf[--len] = '\0';

		if (len <= len_libname || !strstr(buf, libname))
			continue;

		if (sscanf(buf, "%zx-%zx %c%c%c%c %zx", &start, &end,
			   &flags[0], &flags[1],
			   &flags[2], &flags[3], &offset) != 7)
			continue;

		if (flags[0] != 'r' || flags[2] != 'x')
			continue;

		addr = start - offset;
		break;
	}

	fclose(file);

	return addr;
}