1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * C++ stream style string builder used in KUnit for building messages.
4*4882a593Smuzhiyun *
5*4882a593Smuzhiyun * Copyright (C) 2019, Google LLC.
6*4882a593Smuzhiyun * Author: Brendan Higgins <brendanhiggins@google.com>
7*4882a593Smuzhiyun */
8*4882a593Smuzhiyun
9*4882a593Smuzhiyun #include <kunit/test.h>
10*4882a593Smuzhiyun #include <linux/list.h>
11*4882a593Smuzhiyun #include <linux/slab.h>
12*4882a593Smuzhiyun
13*4882a593Smuzhiyun #include "string-stream.h"
14*4882a593Smuzhiyun
15*4882a593Smuzhiyun struct string_stream_fragment_alloc_context {
16*4882a593Smuzhiyun struct kunit *test;
17*4882a593Smuzhiyun int len;
18*4882a593Smuzhiyun gfp_t gfp;
19*4882a593Smuzhiyun };
20*4882a593Smuzhiyun
string_stream_fragment_init(struct kunit_resource * res,void * context)21*4882a593Smuzhiyun static int string_stream_fragment_init(struct kunit_resource *res,
22*4882a593Smuzhiyun void *context)
23*4882a593Smuzhiyun {
24*4882a593Smuzhiyun struct string_stream_fragment_alloc_context *ctx = context;
25*4882a593Smuzhiyun struct string_stream_fragment *frag;
26*4882a593Smuzhiyun
27*4882a593Smuzhiyun frag = kunit_kzalloc(ctx->test, sizeof(*frag), ctx->gfp);
28*4882a593Smuzhiyun if (!frag)
29*4882a593Smuzhiyun return -ENOMEM;
30*4882a593Smuzhiyun
31*4882a593Smuzhiyun frag->test = ctx->test;
32*4882a593Smuzhiyun frag->fragment = kunit_kmalloc(ctx->test, ctx->len, ctx->gfp);
33*4882a593Smuzhiyun if (!frag->fragment)
34*4882a593Smuzhiyun return -ENOMEM;
35*4882a593Smuzhiyun
36*4882a593Smuzhiyun res->data = frag;
37*4882a593Smuzhiyun
38*4882a593Smuzhiyun return 0;
39*4882a593Smuzhiyun }
40*4882a593Smuzhiyun
string_stream_fragment_free(struct kunit_resource * res)41*4882a593Smuzhiyun static void string_stream_fragment_free(struct kunit_resource *res)
42*4882a593Smuzhiyun {
43*4882a593Smuzhiyun struct string_stream_fragment *frag = res->data;
44*4882a593Smuzhiyun
45*4882a593Smuzhiyun list_del(&frag->node);
46*4882a593Smuzhiyun kunit_kfree(frag->test, frag->fragment);
47*4882a593Smuzhiyun kunit_kfree(frag->test, frag);
48*4882a593Smuzhiyun }
49*4882a593Smuzhiyun
alloc_string_stream_fragment(struct kunit * test,int len,gfp_t gfp)50*4882a593Smuzhiyun static struct string_stream_fragment *alloc_string_stream_fragment(
51*4882a593Smuzhiyun struct kunit *test, int len, gfp_t gfp)
52*4882a593Smuzhiyun {
53*4882a593Smuzhiyun struct string_stream_fragment_alloc_context context = {
54*4882a593Smuzhiyun .test = test,
55*4882a593Smuzhiyun .len = len,
56*4882a593Smuzhiyun .gfp = gfp
57*4882a593Smuzhiyun };
58*4882a593Smuzhiyun
59*4882a593Smuzhiyun return kunit_alloc_resource(test,
60*4882a593Smuzhiyun string_stream_fragment_init,
61*4882a593Smuzhiyun string_stream_fragment_free,
62*4882a593Smuzhiyun gfp,
63*4882a593Smuzhiyun &context);
64*4882a593Smuzhiyun }
65*4882a593Smuzhiyun
string_stream_fragment_destroy(struct string_stream_fragment * frag)66*4882a593Smuzhiyun static int string_stream_fragment_destroy(struct string_stream_fragment *frag)
67*4882a593Smuzhiyun {
68*4882a593Smuzhiyun return kunit_destroy_resource(frag->test,
69*4882a593Smuzhiyun kunit_resource_instance_match,
70*4882a593Smuzhiyun frag);
71*4882a593Smuzhiyun }
72*4882a593Smuzhiyun
string_stream_vadd(struct string_stream * stream,const char * fmt,va_list args)73*4882a593Smuzhiyun int string_stream_vadd(struct string_stream *stream,
74*4882a593Smuzhiyun const char *fmt,
75*4882a593Smuzhiyun va_list args)
76*4882a593Smuzhiyun {
77*4882a593Smuzhiyun struct string_stream_fragment *frag_container;
78*4882a593Smuzhiyun int len;
79*4882a593Smuzhiyun va_list args_for_counting;
80*4882a593Smuzhiyun
81*4882a593Smuzhiyun /* Make a copy because `vsnprintf` could change it */
82*4882a593Smuzhiyun va_copy(args_for_counting, args);
83*4882a593Smuzhiyun
84*4882a593Smuzhiyun /* Need space for null byte. */
85*4882a593Smuzhiyun len = vsnprintf(NULL, 0, fmt, args_for_counting) + 1;
86*4882a593Smuzhiyun
87*4882a593Smuzhiyun va_end(args_for_counting);
88*4882a593Smuzhiyun
89*4882a593Smuzhiyun frag_container = alloc_string_stream_fragment(stream->test,
90*4882a593Smuzhiyun len,
91*4882a593Smuzhiyun stream->gfp);
92*4882a593Smuzhiyun if (!frag_container)
93*4882a593Smuzhiyun return -ENOMEM;
94*4882a593Smuzhiyun
95*4882a593Smuzhiyun len = vsnprintf(frag_container->fragment, len, fmt, args);
96*4882a593Smuzhiyun spin_lock(&stream->lock);
97*4882a593Smuzhiyun stream->length += len;
98*4882a593Smuzhiyun list_add_tail(&frag_container->node, &stream->fragments);
99*4882a593Smuzhiyun spin_unlock(&stream->lock);
100*4882a593Smuzhiyun
101*4882a593Smuzhiyun return 0;
102*4882a593Smuzhiyun }
103*4882a593Smuzhiyun
string_stream_add(struct string_stream * stream,const char * fmt,...)104*4882a593Smuzhiyun int string_stream_add(struct string_stream *stream, const char *fmt, ...)
105*4882a593Smuzhiyun {
106*4882a593Smuzhiyun va_list args;
107*4882a593Smuzhiyun int result;
108*4882a593Smuzhiyun
109*4882a593Smuzhiyun va_start(args, fmt);
110*4882a593Smuzhiyun result = string_stream_vadd(stream, fmt, args);
111*4882a593Smuzhiyun va_end(args);
112*4882a593Smuzhiyun
113*4882a593Smuzhiyun return result;
114*4882a593Smuzhiyun }
115*4882a593Smuzhiyun
string_stream_clear(struct string_stream * stream)116*4882a593Smuzhiyun static void string_stream_clear(struct string_stream *stream)
117*4882a593Smuzhiyun {
118*4882a593Smuzhiyun struct string_stream_fragment *frag_container, *frag_container_safe;
119*4882a593Smuzhiyun
120*4882a593Smuzhiyun spin_lock(&stream->lock);
121*4882a593Smuzhiyun list_for_each_entry_safe(frag_container,
122*4882a593Smuzhiyun frag_container_safe,
123*4882a593Smuzhiyun &stream->fragments,
124*4882a593Smuzhiyun node) {
125*4882a593Smuzhiyun string_stream_fragment_destroy(frag_container);
126*4882a593Smuzhiyun }
127*4882a593Smuzhiyun stream->length = 0;
128*4882a593Smuzhiyun spin_unlock(&stream->lock);
129*4882a593Smuzhiyun }
130*4882a593Smuzhiyun
string_stream_get_string(struct string_stream * stream)131*4882a593Smuzhiyun char *string_stream_get_string(struct string_stream *stream)
132*4882a593Smuzhiyun {
133*4882a593Smuzhiyun struct string_stream_fragment *frag_container;
134*4882a593Smuzhiyun size_t buf_len = stream->length + 1; /* +1 for null byte. */
135*4882a593Smuzhiyun char *buf;
136*4882a593Smuzhiyun
137*4882a593Smuzhiyun buf = kunit_kzalloc(stream->test, buf_len, stream->gfp);
138*4882a593Smuzhiyun if (!buf)
139*4882a593Smuzhiyun return NULL;
140*4882a593Smuzhiyun
141*4882a593Smuzhiyun spin_lock(&stream->lock);
142*4882a593Smuzhiyun list_for_each_entry(frag_container, &stream->fragments, node)
143*4882a593Smuzhiyun strlcat(buf, frag_container->fragment, buf_len);
144*4882a593Smuzhiyun spin_unlock(&stream->lock);
145*4882a593Smuzhiyun
146*4882a593Smuzhiyun return buf;
147*4882a593Smuzhiyun }
148*4882a593Smuzhiyun
string_stream_append(struct string_stream * stream,struct string_stream * other)149*4882a593Smuzhiyun int string_stream_append(struct string_stream *stream,
150*4882a593Smuzhiyun struct string_stream *other)
151*4882a593Smuzhiyun {
152*4882a593Smuzhiyun const char *other_content;
153*4882a593Smuzhiyun
154*4882a593Smuzhiyun other_content = string_stream_get_string(other);
155*4882a593Smuzhiyun
156*4882a593Smuzhiyun if (!other_content)
157*4882a593Smuzhiyun return -ENOMEM;
158*4882a593Smuzhiyun
159*4882a593Smuzhiyun return string_stream_add(stream, other_content);
160*4882a593Smuzhiyun }
161*4882a593Smuzhiyun
string_stream_is_empty(struct string_stream * stream)162*4882a593Smuzhiyun bool string_stream_is_empty(struct string_stream *stream)
163*4882a593Smuzhiyun {
164*4882a593Smuzhiyun return list_empty(&stream->fragments);
165*4882a593Smuzhiyun }
166*4882a593Smuzhiyun
167*4882a593Smuzhiyun struct string_stream_alloc_context {
168*4882a593Smuzhiyun struct kunit *test;
169*4882a593Smuzhiyun gfp_t gfp;
170*4882a593Smuzhiyun };
171*4882a593Smuzhiyun
string_stream_init(struct kunit_resource * res,void * context)172*4882a593Smuzhiyun static int string_stream_init(struct kunit_resource *res, void *context)
173*4882a593Smuzhiyun {
174*4882a593Smuzhiyun struct string_stream *stream;
175*4882a593Smuzhiyun struct string_stream_alloc_context *ctx = context;
176*4882a593Smuzhiyun
177*4882a593Smuzhiyun stream = kunit_kzalloc(ctx->test, sizeof(*stream), ctx->gfp);
178*4882a593Smuzhiyun if (!stream)
179*4882a593Smuzhiyun return -ENOMEM;
180*4882a593Smuzhiyun
181*4882a593Smuzhiyun res->data = stream;
182*4882a593Smuzhiyun stream->gfp = ctx->gfp;
183*4882a593Smuzhiyun stream->test = ctx->test;
184*4882a593Smuzhiyun INIT_LIST_HEAD(&stream->fragments);
185*4882a593Smuzhiyun spin_lock_init(&stream->lock);
186*4882a593Smuzhiyun
187*4882a593Smuzhiyun return 0;
188*4882a593Smuzhiyun }
189*4882a593Smuzhiyun
string_stream_free(struct kunit_resource * res)190*4882a593Smuzhiyun static void string_stream_free(struct kunit_resource *res)
191*4882a593Smuzhiyun {
192*4882a593Smuzhiyun struct string_stream *stream = res->data;
193*4882a593Smuzhiyun
194*4882a593Smuzhiyun string_stream_clear(stream);
195*4882a593Smuzhiyun }
196*4882a593Smuzhiyun
alloc_string_stream(struct kunit * test,gfp_t gfp)197*4882a593Smuzhiyun struct string_stream *alloc_string_stream(struct kunit *test, gfp_t gfp)
198*4882a593Smuzhiyun {
199*4882a593Smuzhiyun struct string_stream_alloc_context context = {
200*4882a593Smuzhiyun .test = test,
201*4882a593Smuzhiyun .gfp = gfp
202*4882a593Smuzhiyun };
203*4882a593Smuzhiyun
204*4882a593Smuzhiyun return kunit_alloc_resource(test,
205*4882a593Smuzhiyun string_stream_init,
206*4882a593Smuzhiyun string_stream_free,
207*4882a593Smuzhiyun gfp,
208*4882a593Smuzhiyun &context);
209*4882a593Smuzhiyun }
210*4882a593Smuzhiyun
string_stream_destroy(struct string_stream * stream)211*4882a593Smuzhiyun int string_stream_destroy(struct string_stream *stream)
212*4882a593Smuzhiyun {
213*4882a593Smuzhiyun return kunit_destroy_resource(stream->test,
214*4882a593Smuzhiyun kunit_resource_instance_match,
215*4882a593Smuzhiyun stream);
216*4882a593Smuzhiyun }
217