bifrost/r25p0/kernel/drivers/gpu/arm/midgard/tests/kutf/kutf_utils.c

/*
 *
 * (C) COPYRIGHT 2014, 2017 ARM Limited. All rights reserved.
 *
 * This program is free software and is provided to you under the terms of the
 * GNU General Public License version 2 as published by the Free Software
 * Foundation, and any use by you of this program is subject to the terms
 * of such GNU licence.
 *
 * This program is distributed in the hope that 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.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, you can access it online at
 * http://www.gnu.org/licenses/gpl-2.0.html.
 *
 * SPDX-License-Identifier: GPL-2.0
 *
 */

/* Kernel UTF utility functions */

#include <linux/mutex.h>
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/printk.h>

#include <kutf/kutf_utils.h>
#include <kutf/kutf_mem.h>

static char tmp_buffer[KUTF_MAX_DSPRINTF_LEN];

DEFINE_MUTEX(buffer_lock);

const char *kutf_dsprintf(struct kutf_mempool *pool,
		const char *fmt, ...)
{
	va_list args;
	int len;
	int size;
	void *buffer;

	mutex_lock(&buffer_lock);
	va_start(args, fmt);
	len = vsnprintf(tmp_buffer, sizeof(tmp_buffer), fmt, args);
	va_end(args);

	if (len < 0) {
		pr_err("kutf_dsprintf: Bad format dsprintf format %s\n", fmt);
		goto fail_format;
	}

	if (len >= sizeof(tmp_buffer)) {
		pr_warn("kutf_dsprintf: Truncated dsprintf message %s\n", fmt);
		size = sizeof(tmp_buffer);
	} else {
		size = len + 1;
	}

	buffer = kutf_mempool_alloc(pool, size);
	if (!buffer)
		goto fail_alloc;

	memcpy(buffer, tmp_buffer, size);
	mutex_unlock(&buffer_lock);

	return buffer;

fail_alloc:
fail_format:
	mutex_unlock(&buffer_lock);
	return NULL;
}
EXPORT_SYMBOL(kutf_dsprintf);