1d1fadef1SBrendan Higgins // SPDX-License-Identifier: GPL-2.0
2d1fadef1SBrendan Higgins /*
3d1fadef1SBrendan Higgins * C++ stream style string builder used in KUnit for building messages.
4d1fadef1SBrendan Higgins *
5d1fadef1SBrendan Higgins * Copyright (C) 2019, Google LLC.
6d1fadef1SBrendan Higgins * Author: Brendan Higgins <[email protected]>
7d1fadef1SBrendan Higgins */
8d1fadef1SBrendan Higgins
9d1a0d699SRichard Fitzgerald #include <kunit/static_stub.h>
10d1fadef1SBrendan Higgins #include <kunit/test.h>
11d1fadef1SBrendan Higgins #include <linux/list.h>
12d1fadef1SBrendan Higgins #include <linux/slab.h>
13d1fadef1SBrendan Higgins
14109fb06fSAlan Maguire #include "string-stream.h"
15109fb06fSAlan Maguire
16d1fadef1SBrendan Higgins
alloc_string_stream_fragment(int len,gfp_t gfp)17a3fdf784SRichard Fitzgerald static struct string_stream_fragment *alloc_string_stream_fragment(int len, gfp_t gfp)
18d1fadef1SBrendan Higgins {
1978b1c658SDavid Gow struct string_stream_fragment *frag;
20d1fadef1SBrendan Higgins
21a3fdf784SRichard Fitzgerald frag = kzalloc(sizeof(*frag), gfp);
2278b1c658SDavid Gow if (!frag)
2378b1c658SDavid Gow return ERR_PTR(-ENOMEM);
2478b1c658SDavid Gow
25a3fdf784SRichard Fitzgerald frag->fragment = kmalloc(len, gfp);
2693ef8305SYoungJun.park if (!frag->fragment) {
27a3fdf784SRichard Fitzgerald kfree(frag);
2878b1c658SDavid Gow return ERR_PTR(-ENOMEM);
2993ef8305SYoungJun.park }
3078b1c658SDavid Gow
3178b1c658SDavid Gow return frag;
32d1fadef1SBrendan Higgins }
33d1fadef1SBrendan Higgins
string_stream_fragment_destroy(struct string_stream_fragment * frag)34a3fdf784SRichard Fitzgerald static void string_stream_fragment_destroy(struct string_stream_fragment *frag)
35d1fadef1SBrendan Higgins {
3678b1c658SDavid Gow list_del(&frag->node);
37a3fdf784SRichard Fitzgerald kfree(frag->fragment);
38a3fdf784SRichard Fitzgerald kfree(frag);
39d1fadef1SBrendan Higgins }
40d1fadef1SBrendan Higgins
string_stream_vadd(struct string_stream * stream,const char * fmt,va_list args)41d1fadef1SBrendan Higgins int string_stream_vadd(struct string_stream *stream,
42d1fadef1SBrendan Higgins const char *fmt,
43d1fadef1SBrendan Higgins va_list args)
44d1fadef1SBrendan Higgins {
45d1fadef1SBrendan Higgins struct string_stream_fragment *frag_container;
46a5abe7b2SRichard Fitzgerald int buf_len, result_len;
47d1fadef1SBrendan Higgins va_list args_for_counting;
48d1fadef1SBrendan Higgins
49d1fadef1SBrendan Higgins /* Make a copy because `vsnprintf` could change it */
50d1fadef1SBrendan Higgins va_copy(args_for_counting, args);
51d1fadef1SBrendan Higgins
525c54c9ebSRichard Fitzgerald /* Evaluate length of formatted string */
53a5abe7b2SRichard Fitzgerald buf_len = vsnprintf(NULL, 0, fmt, args_for_counting);
54d1fadef1SBrendan Higgins
55d1fadef1SBrendan Higgins va_end(args_for_counting);
56d1fadef1SBrendan Higgins
57a5abe7b2SRichard Fitzgerald if (buf_len == 0)
585c54c9ebSRichard Fitzgerald return 0;
595c54c9ebSRichard Fitzgerald
60a5abe7b2SRichard Fitzgerald /* Reserve one extra for possible appended newline. */
61a5abe7b2SRichard Fitzgerald if (stream->append_newlines)
62a5abe7b2SRichard Fitzgerald buf_len++;
63a5abe7b2SRichard Fitzgerald
645c54c9ebSRichard Fitzgerald /* Need space for null byte. */
65a5abe7b2SRichard Fitzgerald buf_len++;
665c54c9ebSRichard Fitzgerald
67a3fdf784SRichard Fitzgerald frag_container = alloc_string_stream_fragment(buf_len, stream->gfp);
6861888776SDan Carpenter if (IS_ERR(frag_container))
6961888776SDan Carpenter return PTR_ERR(frag_container);
70d1fadef1SBrendan Higgins
71a5abe7b2SRichard Fitzgerald if (stream->append_newlines) {
72a5abe7b2SRichard Fitzgerald /* Don't include reserved newline byte in writeable length. */
73a5abe7b2SRichard Fitzgerald result_len = vsnprintf(frag_container->fragment, buf_len - 1, fmt, args);
74a5abe7b2SRichard Fitzgerald
75a5abe7b2SRichard Fitzgerald /* Append newline if necessary. */
76a5abe7b2SRichard Fitzgerald if (frag_container->fragment[result_len - 1] != '\n')
77a5abe7b2SRichard Fitzgerald result_len = strlcat(frag_container->fragment, "\n", buf_len);
78a5abe7b2SRichard Fitzgerald } else {
79a5abe7b2SRichard Fitzgerald result_len = vsnprintf(frag_container->fragment, buf_len, fmt, args);
80a5abe7b2SRichard Fitzgerald }
81a5abe7b2SRichard Fitzgerald
82d1fadef1SBrendan Higgins spin_lock(&stream->lock);
83a5abe7b2SRichard Fitzgerald stream->length += result_len;
84d1fadef1SBrendan Higgins list_add_tail(&frag_container->node, &stream->fragments);
85d1fadef1SBrendan Higgins spin_unlock(&stream->lock);
86d1fadef1SBrendan Higgins
87d1fadef1SBrendan Higgins return 0;
88d1fadef1SBrendan Higgins }
89d1fadef1SBrendan Higgins
string_stream_add(struct string_stream * stream,const char * fmt,...)90d1fadef1SBrendan Higgins int string_stream_add(struct string_stream *stream, const char *fmt, ...)
91d1fadef1SBrendan Higgins {
92d1fadef1SBrendan Higgins va_list args;
93d1fadef1SBrendan Higgins int result;
94d1fadef1SBrendan Higgins
95d1fadef1SBrendan Higgins va_start(args, fmt);
96d1fadef1SBrendan Higgins result = string_stream_vadd(stream, fmt, args);
97d1fadef1SBrendan Higgins va_end(args);
98d1fadef1SBrendan Higgins
99d1fadef1SBrendan Higgins return result;
100d1fadef1SBrendan Higgins }
101d1fadef1SBrendan Higgins
string_stream_clear(struct string_stream * stream)102a3fdf784SRichard Fitzgerald void string_stream_clear(struct string_stream *stream)
103d1fadef1SBrendan Higgins {
104d1fadef1SBrendan Higgins struct string_stream_fragment *frag_container, *frag_container_safe;
105d1fadef1SBrendan Higgins
106d1fadef1SBrendan Higgins spin_lock(&stream->lock);
107d1fadef1SBrendan Higgins list_for_each_entry_safe(frag_container,
108d1fadef1SBrendan Higgins frag_container_safe,
109d1fadef1SBrendan Higgins &stream->fragments,
110d1fadef1SBrendan Higgins node) {
111a3fdf784SRichard Fitzgerald string_stream_fragment_destroy(frag_container);
112d1fadef1SBrendan Higgins }
113d1fadef1SBrendan Higgins stream->length = 0;
114d1fadef1SBrendan Higgins spin_unlock(&stream->lock);
115d1fadef1SBrendan Higgins }
116d1fadef1SBrendan Higgins
string_stream_get_string(struct string_stream * stream)117d1fadef1SBrendan Higgins char *string_stream_get_string(struct string_stream *stream)
118d1fadef1SBrendan Higgins {
119d1fadef1SBrendan Higgins struct string_stream_fragment *frag_container;
120d1fadef1SBrendan Higgins size_t buf_len = stream->length + 1; /* +1 for null byte. */
121d1fadef1SBrendan Higgins char *buf;
122d1fadef1SBrendan Higgins
123a3fdf784SRichard Fitzgerald buf = kzalloc(buf_len, stream->gfp);
124d1fadef1SBrendan Higgins if (!buf)
125d1fadef1SBrendan Higgins return NULL;
126d1fadef1SBrendan Higgins
127d1fadef1SBrendan Higgins spin_lock(&stream->lock);
128d1fadef1SBrendan Higgins list_for_each_entry(frag_container, &stream->fragments, node)
129d1fadef1SBrendan Higgins strlcat(buf, frag_container->fragment, buf_len);
130d1fadef1SBrendan Higgins spin_unlock(&stream->lock);
131d1fadef1SBrendan Higgins
132d1fadef1SBrendan Higgins return buf;
133d1fadef1SBrendan Higgins }
134d1fadef1SBrendan Higgins
string_stream_append(struct string_stream * stream,struct string_stream * other)135d1fadef1SBrendan Higgins int string_stream_append(struct string_stream *stream,
136d1fadef1SBrendan Higgins struct string_stream *other)
137d1fadef1SBrendan Higgins {
138d1fadef1SBrendan Higgins const char *other_content;
139a3fdf784SRichard Fitzgerald int ret;
140d1fadef1SBrendan Higgins
141d1fadef1SBrendan Higgins other_content = string_stream_get_string(other);
142d1fadef1SBrendan Higgins
143d1fadef1SBrendan Higgins if (!other_content)
144d1fadef1SBrendan Higgins return -ENOMEM;
145d1fadef1SBrendan Higgins
146a3fdf784SRichard Fitzgerald ret = string_stream_add(stream, other_content);
147a3fdf784SRichard Fitzgerald kfree(other_content);
148a3fdf784SRichard Fitzgerald
149a3fdf784SRichard Fitzgerald return ret;
150d1fadef1SBrendan Higgins }
151d1fadef1SBrendan Higgins
string_stream_is_empty(struct string_stream * stream)152d1fadef1SBrendan Higgins bool string_stream_is_empty(struct string_stream *stream)
153d1fadef1SBrendan Higgins {
154d1fadef1SBrendan Higgins return list_empty(&stream->fragments);
155d1fadef1SBrendan Higgins }
156d1fadef1SBrendan Higgins
alloc_string_stream(gfp_t gfp)157a3fdf784SRichard Fitzgerald struct string_stream *alloc_string_stream(gfp_t gfp)
158d1fadef1SBrendan Higgins {
159d1fadef1SBrendan Higgins struct string_stream *stream;
160d1fadef1SBrendan Higgins
161a3fdf784SRichard Fitzgerald stream = kzalloc(sizeof(*stream), gfp);
162d1fadef1SBrendan Higgins if (!stream)
16378b1c658SDavid Gow return ERR_PTR(-ENOMEM);
164d1fadef1SBrendan Higgins
16578b1c658SDavid Gow stream->gfp = gfp;
166d1fadef1SBrendan Higgins INIT_LIST_HEAD(&stream->fragments);
167d1fadef1SBrendan Higgins spin_lock_init(&stream->lock);
168d1fadef1SBrendan Higgins
16978b1c658SDavid Gow return stream;
170d1fadef1SBrendan Higgins }
171d1fadef1SBrendan Higgins
string_stream_destroy(struct string_stream * stream)17278b1c658SDavid Gow void string_stream_destroy(struct string_stream *stream)
173d1fadef1SBrendan Higgins {
174d1a0d699SRichard Fitzgerald KUNIT_STATIC_STUB_REDIRECT(string_stream_destroy, stream);
175d1a0d699SRichard Fitzgerald
176*15bf0000SRichard Fitzgerald if (IS_ERR_OR_NULL(stream))
177a3fdf784SRichard Fitzgerald return;
178a3fdf784SRichard Fitzgerald
179d1fadef1SBrendan Higgins string_stream_clear(stream);
180a3fdf784SRichard Fitzgerald kfree(stream);
181a3fdf784SRichard Fitzgerald }
182a3fdf784SRichard Fitzgerald
resource_free_string_stream(void * p)183a3fdf784SRichard Fitzgerald static void resource_free_string_stream(void *p)
184a3fdf784SRichard Fitzgerald {
185a3fdf784SRichard Fitzgerald struct string_stream *stream = p;
186a3fdf784SRichard Fitzgerald
187a3fdf784SRichard Fitzgerald string_stream_destroy(stream);
188d1fadef1SBrendan Higgins }
18920631e15SRichard Fitzgerald
kunit_alloc_string_stream(struct kunit * test,gfp_t gfp)19020631e15SRichard Fitzgerald struct string_stream *kunit_alloc_string_stream(struct kunit *test, gfp_t gfp)
19120631e15SRichard Fitzgerald {
192a3fdf784SRichard Fitzgerald struct string_stream *stream;
193a3fdf784SRichard Fitzgerald
194a3fdf784SRichard Fitzgerald stream = alloc_string_stream(gfp);
195a3fdf784SRichard Fitzgerald if (IS_ERR(stream))
196a3fdf784SRichard Fitzgerald return stream;
197a3fdf784SRichard Fitzgerald
198a3fdf784SRichard Fitzgerald if (kunit_add_action_or_reset(test, resource_free_string_stream, stream) != 0)
199a3fdf784SRichard Fitzgerald return ERR_PTR(-ENOMEM);
200a3fdf784SRichard Fitzgerald
201a3fdf784SRichard Fitzgerald return stream;
20220631e15SRichard Fitzgerald }
20320631e15SRichard Fitzgerald
kunit_free_string_stream(struct kunit * test,struct string_stream * stream)20420631e15SRichard Fitzgerald void kunit_free_string_stream(struct kunit *test, struct string_stream *stream)
20520631e15SRichard Fitzgerald {
206a3fdf784SRichard Fitzgerald kunit_release_action(test, resource_free_string_stream, (void *)stream);
20720631e15SRichard Fitzgerald }
208