| /* |
| * |
| * (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. |
| * |
| * A copy of the licence is included with the program, and can also be obtained |
| * from Free Software Foundation, Inc., 51 Franklin Street, Fifth Floor, |
| * Boston, MA 02110-1301, USA. |
| * |
| */ |
| |
| |
| |
| /* 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); |