| 1 | |
| 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 |
|
| 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 | {
|
| 30 | return s->len + len <= s->size;
|
| 31 | }
|
| 32 |
|
| 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 | {
|
| 42 | unsigned int len = seq_buf_used(s);
|
| 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);
|
| 65 | if (s->len + len < s->size) {
|
| 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 |
|
| 95 | #ifdef CONFIG_BINARY_PRINTF
|
| 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);
|
| 122 | if (s->len + ret < s->size) {
|
| 123 | s->len += ret;
|
| 124 | return 0;
|
| 125 | }
|
| 126 | }
|
| 127 | seq_buf_set_overflow(s);
|
| 128 | return -1;
|
| 129 | }
|
| 130 | #endif
|
| 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 |
|
| 147 | if (seq_buf_can_fit(s, len)) {
|
| 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 |
|
| 169 | if (seq_buf_can_fit(s, 1)) {
|
| 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 |
|
| 193 | if (seq_buf_can_fit(s, len)) {
|
| 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 |
|
| 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.
|
| 255 | * @esc: set of characters to escape in the output
|
| 256 | *
|
| 257 | * Write a path name into the sequence buffer.
|
| 258 | *
|
| 259 | * Returns the number of written bytes on success, -1 on overflow
|
| 260 |
|
| 261 | int seq_buf_path(struct seq_buf *s, const struct path *path, const char *esc)
|
| 262 | {
|
| 263 | char *buf;
|
| 264 | size_t size = seq_buf_get_buf(s, &buf);
|
| 265 | int res = -1;
|
| 266 |
|
| 267 | WARN_ON(s->size == 0);
|
| 268 |
|
| 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;
|
| 275 | }
|
| 276 | }
|
| 277 | seq_buf_commit(s, res);
|
| 278 |
|
| 279 | return res;
|
| 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 |
|
| 310 | len = seq_buf_used(s);
|
| 311 |
|
| 312 | if (len <= s->readpos)
|
| 313 | return -EBUSY;
|
| 314 |
|
| 315 | len -= s->readpos;
|
| 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 | }
|