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
BIO_dump_cb(int (* cb)(const void * data,size_t len,void * u),void * u,const void * s,int len)22 int 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
BIO_dump_indent_cb(int (* cb)(const void * data,size_t len,void * u),void * u,const void * v,int len,int indent)28 int 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
write_fp(const void * data,size_t len,void * fp)98 static int write_fp(const void *data, size_t len, void *fp)
99 {
100 return UP_fwrite(data, len, 1, fp);
101 }
102
BIO_dump_fp(FILE * fp,const void * s,int len)103 int BIO_dump_fp(FILE *fp, const void *s, int len)
104 {
105 return BIO_dump_cb(write_fp, fp, s, len);
106 }
107
BIO_dump_indent_fp(FILE * fp,const void * s,int len,int indent)108 int 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
write_bio(const void * data,size_t len,void * bp)114 static int write_bio(const void *data, size_t len, void *bp)
115 {
116 return BIO_write((BIO *)bp, (const char *)data, len);
117 }
118
BIO_dump(BIO * bp,const void * s,int len)119 int BIO_dump(BIO *bp, const void *s, int len)
120 {
121 return BIO_dump_cb(write_bio, bp, s, len);
122 }
123
BIO_dump_indent(BIO * bp,const void * s,int len,int indent)124 int 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
BIO_hex_string(BIO * out,int indent,int width,const void * data,int datalen)129 int 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