162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * C++ stream style string builder used in KUnit for building messages. 462306a36Sopenharmony_ci * 562306a36Sopenharmony_ci * Copyright (C) 2019, Google LLC. 662306a36Sopenharmony_ci * Author: Brendan Higgins <brendanhiggins@google.com> 762306a36Sopenharmony_ci */ 862306a36Sopenharmony_ci 962306a36Sopenharmony_ci#include <kunit/test.h> 1062306a36Sopenharmony_ci#include <linux/list.h> 1162306a36Sopenharmony_ci#include <linux/slab.h> 1262306a36Sopenharmony_ci 1362306a36Sopenharmony_ci#include "string-stream.h" 1462306a36Sopenharmony_ci 1562306a36Sopenharmony_ci 1662306a36Sopenharmony_cistatic struct string_stream_fragment *alloc_string_stream_fragment( 1762306a36Sopenharmony_ci struct kunit *test, int len, gfp_t gfp) 1862306a36Sopenharmony_ci{ 1962306a36Sopenharmony_ci struct string_stream_fragment *frag; 2062306a36Sopenharmony_ci 2162306a36Sopenharmony_ci frag = kunit_kzalloc(test, sizeof(*frag), gfp); 2262306a36Sopenharmony_ci if (!frag) 2362306a36Sopenharmony_ci return ERR_PTR(-ENOMEM); 2462306a36Sopenharmony_ci 2562306a36Sopenharmony_ci frag->fragment = kunit_kmalloc(test, len, gfp); 2662306a36Sopenharmony_ci if (!frag->fragment) { 2762306a36Sopenharmony_ci kunit_kfree(test, frag); 2862306a36Sopenharmony_ci return ERR_PTR(-ENOMEM); 2962306a36Sopenharmony_ci } 3062306a36Sopenharmony_ci 3162306a36Sopenharmony_ci return frag; 3262306a36Sopenharmony_ci} 3362306a36Sopenharmony_ci 3462306a36Sopenharmony_cistatic void string_stream_fragment_destroy(struct kunit *test, 3562306a36Sopenharmony_ci struct string_stream_fragment *frag) 3662306a36Sopenharmony_ci{ 3762306a36Sopenharmony_ci list_del(&frag->node); 3862306a36Sopenharmony_ci kunit_kfree(test, frag->fragment); 3962306a36Sopenharmony_ci kunit_kfree(test, frag); 4062306a36Sopenharmony_ci} 4162306a36Sopenharmony_ci 4262306a36Sopenharmony_ciint string_stream_vadd(struct string_stream *stream, 4362306a36Sopenharmony_ci const char *fmt, 4462306a36Sopenharmony_ci va_list args) 4562306a36Sopenharmony_ci{ 4662306a36Sopenharmony_ci struct string_stream_fragment *frag_container; 4762306a36Sopenharmony_ci int len; 4862306a36Sopenharmony_ci va_list args_for_counting; 4962306a36Sopenharmony_ci 5062306a36Sopenharmony_ci /* Make a copy because `vsnprintf` could change it */ 5162306a36Sopenharmony_ci va_copy(args_for_counting, args); 5262306a36Sopenharmony_ci 5362306a36Sopenharmony_ci /* Need space for null byte. */ 5462306a36Sopenharmony_ci len = vsnprintf(NULL, 0, fmt, args_for_counting) + 1; 5562306a36Sopenharmony_ci 5662306a36Sopenharmony_ci va_end(args_for_counting); 5762306a36Sopenharmony_ci 5862306a36Sopenharmony_ci frag_container = alloc_string_stream_fragment(stream->test, 5962306a36Sopenharmony_ci len, 6062306a36Sopenharmony_ci stream->gfp); 6162306a36Sopenharmony_ci if (IS_ERR(frag_container)) 6262306a36Sopenharmony_ci return PTR_ERR(frag_container); 6362306a36Sopenharmony_ci 6462306a36Sopenharmony_ci len = vsnprintf(frag_container->fragment, len, fmt, args); 6562306a36Sopenharmony_ci spin_lock(&stream->lock); 6662306a36Sopenharmony_ci stream->length += len; 6762306a36Sopenharmony_ci list_add_tail(&frag_container->node, &stream->fragments); 6862306a36Sopenharmony_ci spin_unlock(&stream->lock); 6962306a36Sopenharmony_ci 7062306a36Sopenharmony_ci return 0; 7162306a36Sopenharmony_ci} 7262306a36Sopenharmony_ci 7362306a36Sopenharmony_ciint string_stream_add(struct string_stream *stream, const char *fmt, ...) 7462306a36Sopenharmony_ci{ 7562306a36Sopenharmony_ci va_list args; 7662306a36Sopenharmony_ci int result; 7762306a36Sopenharmony_ci 7862306a36Sopenharmony_ci va_start(args, fmt); 7962306a36Sopenharmony_ci result = string_stream_vadd(stream, fmt, args); 8062306a36Sopenharmony_ci va_end(args); 8162306a36Sopenharmony_ci 8262306a36Sopenharmony_ci return result; 8362306a36Sopenharmony_ci} 8462306a36Sopenharmony_ci 8562306a36Sopenharmony_cistatic void string_stream_clear(struct string_stream *stream) 8662306a36Sopenharmony_ci{ 8762306a36Sopenharmony_ci struct string_stream_fragment *frag_container, *frag_container_safe; 8862306a36Sopenharmony_ci 8962306a36Sopenharmony_ci spin_lock(&stream->lock); 9062306a36Sopenharmony_ci list_for_each_entry_safe(frag_container, 9162306a36Sopenharmony_ci frag_container_safe, 9262306a36Sopenharmony_ci &stream->fragments, 9362306a36Sopenharmony_ci node) { 9462306a36Sopenharmony_ci string_stream_fragment_destroy(stream->test, frag_container); 9562306a36Sopenharmony_ci } 9662306a36Sopenharmony_ci stream->length = 0; 9762306a36Sopenharmony_ci spin_unlock(&stream->lock); 9862306a36Sopenharmony_ci} 9962306a36Sopenharmony_ci 10062306a36Sopenharmony_cichar *string_stream_get_string(struct string_stream *stream) 10162306a36Sopenharmony_ci{ 10262306a36Sopenharmony_ci struct string_stream_fragment *frag_container; 10362306a36Sopenharmony_ci size_t buf_len = stream->length + 1; /* +1 for null byte. */ 10462306a36Sopenharmony_ci char *buf; 10562306a36Sopenharmony_ci 10662306a36Sopenharmony_ci buf = kunit_kzalloc(stream->test, buf_len, stream->gfp); 10762306a36Sopenharmony_ci if (!buf) 10862306a36Sopenharmony_ci return NULL; 10962306a36Sopenharmony_ci 11062306a36Sopenharmony_ci spin_lock(&stream->lock); 11162306a36Sopenharmony_ci list_for_each_entry(frag_container, &stream->fragments, node) 11262306a36Sopenharmony_ci strlcat(buf, frag_container->fragment, buf_len); 11362306a36Sopenharmony_ci spin_unlock(&stream->lock); 11462306a36Sopenharmony_ci 11562306a36Sopenharmony_ci return buf; 11662306a36Sopenharmony_ci} 11762306a36Sopenharmony_ci 11862306a36Sopenharmony_ciint string_stream_append(struct string_stream *stream, 11962306a36Sopenharmony_ci struct string_stream *other) 12062306a36Sopenharmony_ci{ 12162306a36Sopenharmony_ci const char *other_content; 12262306a36Sopenharmony_ci 12362306a36Sopenharmony_ci other_content = string_stream_get_string(other); 12462306a36Sopenharmony_ci 12562306a36Sopenharmony_ci if (!other_content) 12662306a36Sopenharmony_ci return -ENOMEM; 12762306a36Sopenharmony_ci 12862306a36Sopenharmony_ci return string_stream_add(stream, other_content); 12962306a36Sopenharmony_ci} 13062306a36Sopenharmony_ci 13162306a36Sopenharmony_cibool string_stream_is_empty(struct string_stream *stream) 13262306a36Sopenharmony_ci{ 13362306a36Sopenharmony_ci return list_empty(&stream->fragments); 13462306a36Sopenharmony_ci} 13562306a36Sopenharmony_ci 13662306a36Sopenharmony_cistruct string_stream *alloc_string_stream(struct kunit *test, gfp_t gfp) 13762306a36Sopenharmony_ci{ 13862306a36Sopenharmony_ci struct string_stream *stream; 13962306a36Sopenharmony_ci 14062306a36Sopenharmony_ci stream = kunit_kzalloc(test, sizeof(*stream), gfp); 14162306a36Sopenharmony_ci if (!stream) 14262306a36Sopenharmony_ci return ERR_PTR(-ENOMEM); 14362306a36Sopenharmony_ci 14462306a36Sopenharmony_ci stream->gfp = gfp; 14562306a36Sopenharmony_ci stream->test = test; 14662306a36Sopenharmony_ci INIT_LIST_HEAD(&stream->fragments); 14762306a36Sopenharmony_ci spin_lock_init(&stream->lock); 14862306a36Sopenharmony_ci 14962306a36Sopenharmony_ci return stream; 15062306a36Sopenharmony_ci} 15162306a36Sopenharmony_ci 15262306a36Sopenharmony_civoid string_stream_destroy(struct string_stream *stream) 15362306a36Sopenharmony_ci{ 15462306a36Sopenharmony_ci string_stream_clear(stream); 15562306a36Sopenharmony_ci} 156