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