1/*
2 * Copyright 1995-2021 The OpenSSL Project Authors. All Rights Reserved.
3 *
4 * Licensed under the Apache License 2.0 (the "License").  You may not use
5 * this file except in compliance with the License.  You can obtain a copy
6 * in the file LICENSE in the source distribution or at
7 * https://www.openssl.org/source/license.html
8 */
9
10/*
11 * Stolen from tjh's ssl/ssl_trc.c stuff.
12 */
13
14#include <stdio.h>
15#include "bio_local.h"
16
17#define DUMP_WIDTH      16
18#define DUMP_WIDTH_LESS_INDENT(i) (DUMP_WIDTH - ((i - (i > 6 ? 6 : i) + 3) / 4))
19
20#define SPACE(buf, pos, n)   (sizeof(buf) - (pos) > (n))
21
22int BIO_dump_cb(int (*cb) (const void *data, size_t len, void *u),
23                void *u, const void *s, int len)
24{
25    return BIO_dump_indent_cb(cb, u, s, len, 0);
26}
27
28int BIO_dump_indent_cb(int (*cb) (const void *data, size_t len, void *u),
29                       void *u, const void *v, int len, int indent)
30{
31    const unsigned char *s = v;
32    int res, ret = 0;
33    char buf[288 + 1];
34    int i, j, rows, n;
35    unsigned char ch;
36    int dump_width;
37
38    if (indent < 0)
39        indent = 0;
40    else if (indent > 64)
41        indent = 64;
42
43    dump_width = DUMP_WIDTH_LESS_INDENT(indent);
44    rows = len / dump_width;
45    if ((rows * dump_width) < len)
46        rows++;
47    for (i = 0; i < rows; i++) {
48        n = BIO_snprintf(buf, sizeof(buf), "%*s%04x - ", indent, "",
49                         i * dump_width);
50        for (j = 0; j < dump_width; j++) {
51            if (SPACE(buf, n, 3)) {
52                if (((i * dump_width) + j) >= len) {
53                    strcpy(buf + n, "   ");
54                } else {
55                    ch = *(s + i * dump_width + j) & 0xff;
56                    BIO_snprintf(buf + n, 4, "%02x%c", ch,
57                                 j == 7 ? '-' : ' ');
58                }
59                n += 3;
60            }
61        }
62        if (SPACE(buf, n, 2)) {
63            strcpy(buf + n, "  ");
64            n += 2;
65        }
66        for (j = 0; j < dump_width; j++) {
67            if (((i * dump_width) + j) >= len)
68                break;
69            if (SPACE(buf, n, 1)) {
70                ch = *(s + i * dump_width + j) & 0xff;
71#ifndef CHARSET_EBCDIC
72                buf[n++] = ((ch >= ' ') && (ch <= '~')) ? ch : '.';
73#else
74                buf[n++] = ((ch >= os_toascii[' ']) && (ch <= os_toascii['~']))
75                           ? os_toebcdic[ch]
76                           : '.';
77#endif
78                buf[n] = '\0';
79            }
80        }
81        if (SPACE(buf, n, 1)) {
82            buf[n++] = '\n';
83            buf[n] = '\0';
84        }
85        /*
86         * if this is the last call then update the ddt_dump thing so that we
87         * will move the selection point in the debug window
88         */
89        res = cb((void *)buf, n, u);
90        if (res < 0)
91            return res;
92        ret += res;
93    }
94    return ret;
95}
96
97#ifndef OPENSSL_NO_STDIO
98static int write_fp(const void *data, size_t len, void *fp)
99{
100    return UP_fwrite(data, len, 1, fp);
101}
102
103int BIO_dump_fp(FILE *fp, const void *s, int len)
104{
105    return BIO_dump_cb(write_fp, fp, s, len);
106}
107
108int BIO_dump_indent_fp(FILE *fp, const void *s, int len, int indent)
109{
110    return BIO_dump_indent_cb(write_fp, fp, s, len, indent);
111}
112#endif
113
114static int write_bio(const void *data, size_t len, void *bp)
115{
116    return BIO_write((BIO *)bp, (const char *)data, len);
117}
118
119int BIO_dump(BIO *bp, const void *s, int len)
120{
121    return BIO_dump_cb(write_bio, bp, s, len);
122}
123
124int BIO_dump_indent(BIO *bp, const void *s, int len, int indent)
125{
126    return BIO_dump_indent_cb(write_bio, bp, s, len, indent);
127}
128
129int BIO_hex_string(BIO *out, int indent, int width, const void *data,
130                   int datalen)
131{
132    const unsigned char *d = data;
133    int i, j = 0;
134
135    if (datalen < 1)
136        return 1;
137
138    for (i = 0; i < datalen - 1; i++) {
139        if (i && !j)
140            BIO_printf(out, "%*s", indent, "");
141
142        BIO_printf(out, "%02X:", d[i]);
143
144        j = (j + 1) % width;
145        if (!j)
146            BIO_printf(out, "\n");
147    }
148
149    if (i && !j)
150        BIO_printf(out, "%*s", indent, "");
151    BIO_printf(out, "%02X", d[datalen - 1]);
152    return 1;
153}
154