]>
Commit | Line | Data |
---|---|---|
b2441318 | 1 | // SPDX-License-Identifier: GPL-2.0 |
3a161d99 SRRH |
2 | /* |
3 | * seq_buf.c | |
4 | * | |
5 | * Copyright (C) 2014 Red Hat Inc, Steven Rostedt <[email protected]> | |
6 | * | |
7 | * The seq_buf is a handy tool that allows you to pass a descriptor around | |
8 | * to a buffer that other functions can write to. It is similar to the | |
9 | * seq_file functionality but has some differences. | |
10 | * | |
11 | * To use it, the seq_buf must be initialized with seq_buf_init(). | |
12 | * This will set up the counters within the descriptor. You can call | |
13 | * seq_buf_init() more than once to reset the seq_buf to start | |
14 | * from scratch. | |
15 | */ | |
16 | #include <linux/uaccess.h> | |
17 | #include <linux/seq_file.h> | |
18 | #include <linux/seq_buf.h> | |
19 | ||
9b772153 SRRH |
20 | /** |
21 | * seq_buf_can_fit - can the new data fit in the current buffer? | |
22 | * @s: the seq_buf descriptor | |
23 | * @len: The length to see if it can fit in the current buffer | |
24 | * | |
25 | * Returns true if there's enough unused space in the seq_buf buffer | |
26 | * to fit the amount of new data according to @len. | |
27 | */ | |
28 | static bool seq_buf_can_fit(struct seq_buf *s, size_t len) | |
29 | { | |
8cd709ae | 30 | return s->len + len <= s->size; |
9b772153 SRRH |
31 | } |
32 | ||
3a161d99 SRRH |
33 | /** |
34 | * seq_buf_print_seq - move the contents of seq_buf into a seq_file | |
35 | * @m: the seq_file descriptor that is the destination | |
36 | * @s: the seq_buf descriptor that is the source. | |
37 | * | |
38 | * Returns zero on success, non zero otherwise | |
39 | */ | |
40 | int seq_buf_print_seq(struct seq_file *m, struct seq_buf *s) | |
41 | { | |
eeab9815 | 42 | unsigned int len = seq_buf_used(s); |
3a161d99 SRRH |
43 | |
44 | return seq_write(m, s->buffer, len); | |
45 | } | |
46 | ||
47 | /** | |
48 | * seq_buf_vprintf - sequence printing of information. | |
49 | * @s: seq_buf descriptor | |
50 | * @fmt: printf format string | |
51 | * @args: va_list of arguments from a printf() type function | |
52 | * | |
53 | * Writes a vnprintf() format into the sequencce buffer. | |
54 | * | |
55 | * Returns zero on success, -1 on overflow. | |
56 | */ | |
57 | int seq_buf_vprintf(struct seq_buf *s, const char *fmt, va_list args) | |
58 | { | |
59 | int len; | |
60 | ||
61 | WARN_ON(s->size == 0); | |
62 | ||
63 | if (s->len < s->size) { | |
64 | len = vsnprintf(s->buffer + s->len, s->size - s->len, fmt, args); | |
4a8fe4e1 | 65 | if (s->len + len < s->size) { |
3a161d99 SRRH |
66 | s->len += len; |
67 | return 0; | |
68 | } | |
69 | } | |
70 | seq_buf_set_overflow(s); | |
71 | return -1; | |
72 | } | |
73 | ||
74 | /** | |
75 | * seq_buf_printf - sequence printing of information | |
76 | * @s: seq_buf descriptor | |
77 | * @fmt: printf format string | |
78 | * | |
79 | * Writes a printf() format into the sequence buffer. | |
80 | * | |
81 | * Returns zero on success, -1 on overflow. | |
82 | */ | |
83 | int seq_buf_printf(struct seq_buf *s, const char *fmt, ...) | |
84 | { | |
85 | va_list ap; | |
86 | int ret; | |
87 | ||
88 | va_start(ap, fmt); | |
89 | ret = seq_buf_vprintf(s, fmt, ap); | |
90 | va_end(ap); | |
91 | ||
92 | return ret; | |
93 | } | |
94 | ||
2448913e | 95 | #ifdef CONFIG_BINARY_PRINTF |
3a161d99 SRRH |
96 | /** |
97 | * seq_buf_bprintf - Write the printf string from binary arguments | |
98 | * @s: seq_buf descriptor | |
99 | * @fmt: The format string for the @binary arguments | |
100 | * @binary: The binary arguments for @fmt. | |
101 | * | |
102 | * When recording in a fast path, a printf may be recorded with just | |
103 | * saving the format and the arguments as they were passed to the | |
104 | * function, instead of wasting cycles converting the arguments into | |
105 | * ASCII characters. Instead, the arguments are saved in a 32 bit | |
106 | * word array that is defined by the format string constraints. | |
107 | * | |
108 | * This function will take the format and the binary array and finish | |
109 | * the conversion into the ASCII string within the buffer. | |
110 | * | |
111 | * Returns zero on success, -1 on overflow. | |
112 | */ | |
113 | int seq_buf_bprintf(struct seq_buf *s, const char *fmt, const u32 *binary) | |
114 | { | |
115 | unsigned int len = seq_buf_buffer_left(s); | |
116 | int ret; | |
117 | ||
118 | WARN_ON(s->size == 0); | |
119 | ||
120 | if (s->len < s->size) { | |
121 | ret = bstr_printf(s->buffer + s->len, len, fmt, binary); | |
4d4eb4d4 | 122 | if (s->len + ret < s->size) { |
3a161d99 SRRH |
123 | s->len += ret; |
124 | return 0; | |
125 | } | |
126 | } | |
127 | seq_buf_set_overflow(s); | |
128 | return -1; | |
129 | } | |
2448913e | 130 | #endif /* CONFIG_BINARY_PRINTF */ |
3a161d99 SRRH |
131 | |
132 | /** | |
133 | * seq_buf_puts - sequence printing of simple string | |
134 | * @s: seq_buf descriptor | |
135 | * @str: simple string to record | |
136 | * | |
137 | * Copy a simple string into the sequence buffer. | |
138 | * | |
139 | * Returns zero on success, -1 on overflow | |
140 | */ | |
141 | int seq_buf_puts(struct seq_buf *s, const char *str) | |
142 | { | |
143 | unsigned int len = strlen(str); | |
144 | ||
145 | WARN_ON(s->size == 0); | |
146 | ||
9b772153 | 147 | if (seq_buf_can_fit(s, len)) { |
3a161d99 SRRH |
148 | memcpy(s->buffer + s->len, str, len); |
149 | s->len += len; | |
150 | return 0; | |
151 | } | |
152 | seq_buf_set_overflow(s); | |
153 | return -1; | |
154 | } | |
155 | ||
156 | /** | |
157 | * seq_buf_putc - sequence printing of simple character | |
158 | * @s: seq_buf descriptor | |
159 | * @c: simple character to record | |
160 | * | |
161 | * Copy a single character into the sequence buffer. | |
162 | * | |
163 | * Returns zero on success, -1 on overflow | |
164 | */ | |
165 | int seq_buf_putc(struct seq_buf *s, unsigned char c) | |
166 | { | |
167 | WARN_ON(s->size == 0); | |
168 | ||
9b772153 | 169 | if (seq_buf_can_fit(s, 1)) { |
3a161d99 SRRH |
170 | s->buffer[s->len++] = c; |
171 | return 0; | |
172 | } | |
173 | seq_buf_set_overflow(s); | |
174 | return -1; | |
175 | } | |
176 | ||
177 | /** | |
178 | * seq_buf_putmem - write raw data into the sequenc buffer | |
179 | * @s: seq_buf descriptor | |
180 | * @mem: The raw memory to copy into the buffer | |
181 | * @len: The length of the raw memory to copy (in bytes) | |
182 | * | |
183 | * There may be cases where raw memory needs to be written into the | |
184 | * buffer and a strcpy() would not work. Using this function allows | |
185 | * for such cases. | |
186 | * | |
187 | * Returns zero on success, -1 on overflow | |
188 | */ | |
189 | int seq_buf_putmem(struct seq_buf *s, const void *mem, unsigned int len) | |
190 | { | |
191 | WARN_ON(s->size == 0); | |
192 | ||
9b772153 | 193 | if (seq_buf_can_fit(s, len)) { |
3a161d99 SRRH |
194 | memcpy(s->buffer + s->len, mem, len); |
195 | s->len += len; | |
196 | return 0; | |
197 | } | |
198 | seq_buf_set_overflow(s); | |
199 | return -1; | |
200 | } | |
201 | ||
202 | #define MAX_MEMHEX_BYTES 8U | |
203 | #define HEX_CHARS (MAX_MEMHEX_BYTES*2 + 1) | |
204 | ||
205 | /** | |
206 | * seq_buf_putmem_hex - write raw memory into the buffer in ASCII hex | |
207 | * @s: seq_buf descriptor | |
208 | * @mem: The raw memory to write its hex ASCII representation of | |
209 | * @len: The length of the raw memory to copy (in bytes) | |
210 | * | |
211 | * This is similar to seq_buf_putmem() except instead of just copying the | |
212 | * raw memory into the buffer it writes its ASCII representation of it | |
213 | * in hex characters. | |
214 | * | |
215 | * Returns zero on success, -1 on overflow | |
216 | */ | |
217 | int seq_buf_putmem_hex(struct seq_buf *s, const void *mem, | |
218 | unsigned int len) | |
219 | { | |
220 | unsigned char hex[HEX_CHARS]; | |
221 | const unsigned char *data = mem; | |
222 | unsigned int start_len; | |
223 | int i, j; | |
224 | ||
225 | WARN_ON(s->size == 0); | |
226 | ||
227 | while (len) { | |
228 | start_len = min(len, HEX_CHARS - 1); | |
229 | #ifdef __BIG_ENDIAN | |
230 | for (i = 0, j = 0; i < start_len; i++) { | |
231 | #else | |
232 | for (i = start_len-1, j = 0; i >= 0; i--) { | |
233 | #endif | |
234 | hex[j++] = hex_asc_hi(data[i]); | |
235 | hex[j++] = hex_asc_lo(data[i]); | |
236 | } | |
237 | if (WARN_ON_ONCE(j == 0 || j/2 > len)) | |
238 | break; | |
239 | ||
240 | /* j increments twice per loop */ | |
241 | len -= j / 2; | |
242 | hex[j++] = ' '; | |
243 | ||
244 | seq_buf_putmem(s, hex, j); | |
245 | if (seq_buf_has_overflowed(s)) | |
246 | return -1; | |
247 | } | |
248 | return 0; | |
249 | } | |
250 | ||
251 | /** | |
252 | * seq_buf_path - copy a path into the sequence buffer | |
253 | * @s: seq_buf descriptor | |
254 | * @path: path to write into the sequence buffer. | |
dd23180a | 255 | * @esc: set of characters to escape in the output |
3a161d99 SRRH |
256 | * |
257 | * Write a path name into the sequence buffer. | |
258 | * | |
dd23180a | 259 | * Returns the number of written bytes on success, -1 on overflow |
3a161d99 | 260 | */ |
dd23180a | 261 | int seq_buf_path(struct seq_buf *s, const struct path *path, const char *esc) |
3a161d99 | 262 | { |
01cb06a4 SRRH |
263 | char *buf; |
264 | size_t size = seq_buf_get_buf(s, &buf); | |
dd23180a | 265 | int res = -1; |
3a161d99 SRRH |
266 | |
267 | WARN_ON(s->size == 0); | |
268 | ||
dd23180a SRRH |
269 | if (size) { |
270 | char *p = d_path(path, buf, size); | |
271 | if (!IS_ERR(p)) { | |
272 | char *end = mangle_path(buf, p, esc); | |
273 | if (end) | |
274 | res = end - buf; | |
3a161d99 SRRH |
275 | } |
276 | } | |
01cb06a4 | 277 | seq_buf_commit(s, res); |
dd23180a SRRH |
278 | |
279 | return res; | |
3a161d99 SRRH |
280 | } |
281 | ||
282 | /** | |
283 | * seq_buf_to_user - copy the squence buffer to user space | |
284 | * @s: seq_buf descriptor | |
285 | * @ubuf: The userspace memory location to copy to | |
286 | * @cnt: The amount to copy | |
287 | * | |
288 | * Copies the sequence buffer into the userspace memory pointed to | |
289 | * by @ubuf. It starts from the last read position (@s->readpos) | |
290 | * and writes up to @cnt characters or till it reaches the end of | |
291 | * the content in the buffer (@s->len), which ever comes first. | |
292 | * | |
293 | * On success, it returns a positive number of the number of bytes | |
294 | * it copied. | |
295 | * | |
296 | * On failure it returns -EBUSY if all of the content in the | |
297 | * sequence has been already read, which includes nothing in the | |
298 | * sequence (@s->len == @s->readpos). | |
299 | * | |
300 | * Returns -EFAULT if the copy to userspace fails. | |
301 | */ | |
302 | int seq_buf_to_user(struct seq_buf *s, char __user *ubuf, int cnt) | |
303 | { | |
304 | int len; | |
305 | int ret; | |
306 | ||
307 | if (!cnt) | |
308 | return 0; | |
309 | ||
ff078d8f JS |
310 | len = seq_buf_used(s); |
311 | ||
312 | if (len <= s->readpos) | |
3a161d99 SRRH |
313 | return -EBUSY; |
314 | ||
ff078d8f | 315 | len -= s->readpos; |
3a161d99 SRRH |
316 | if (cnt > len) |
317 | cnt = len; | |
318 | ret = copy_to_user(ubuf, s->buffer + s->readpos, cnt); | |
319 | if (ret == cnt) | |
320 | return -EFAULT; | |
321 | ||
322 | cnt -= ret; | |
323 | ||
324 | s->readpos += cnt; | |
325 | return cnt; | |
326 | } |