1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25#include "qemu/osdep.h"
26#include "chardev/char.h"
27#include "qapi/error.h"
28#include "qapi/qapi-commands-char.h"
29#include "qemu/base64.h"
30#include "qemu/module.h"
31#include "qemu/option.h"
32#include "qom/object.h"
33
34
35
36struct RingBufChardev {
37 Chardev parent;
38 size_t size;
39 size_t prod;
40 size_t cons;
41 uint8_t *cbuf;
42};
43typedef struct RingBufChardev RingBufChardev;
44
45DECLARE_INSTANCE_CHECKER(RingBufChardev, RINGBUF_CHARDEV,
46 TYPE_CHARDEV_RINGBUF)
47
48static size_t ringbuf_count(const Chardev *chr)
49{
50 const RingBufChardev *d = RINGBUF_CHARDEV(chr);
51
52 return d->prod - d->cons;
53}
54
55static int ringbuf_chr_write(Chardev *chr, const uint8_t *buf, int len)
56{
57 RingBufChardev *d = RINGBUF_CHARDEV(chr);
58 int i;
59
60 if (!buf || (len < 0)) {
61 return -1;
62 }
63
64 for (i = 0; i < len; i++) {
65 d->cbuf[d->prod++ & (d->size - 1)] = buf[i];
66 if (d->prod - d->cons > d->size) {
67 d->cons = d->prod - d->size;
68 }
69 }
70
71 return len;
72}
73
74static int ringbuf_chr_read(Chardev *chr, uint8_t *buf, int len)
75{
76 RingBufChardev *d = RINGBUF_CHARDEV(chr);
77 int i;
78
79 qemu_mutex_lock(&chr->chr_write_lock);
80 for (i = 0; i < len && d->cons != d->prod; i++) {
81 buf[i] = d->cbuf[d->cons++ & (d->size - 1)];
82 }
83 qemu_mutex_unlock(&chr->chr_write_lock);
84
85 return i;
86}
87
88static void char_ringbuf_finalize(Object *obj)
89{
90 RingBufChardev *d = RINGBUF_CHARDEV(obj);
91
92 g_free(d->cbuf);
93}
94
95static void qemu_chr_open_ringbuf(Chardev *chr,
96 ChardevBackend *backend,
97 bool *be_opened,
98 Error **errp)
99{
100 ChardevRingbuf *opts = backend->u.ringbuf.data;
101 RingBufChardev *d = RINGBUF_CHARDEV(chr);
102
103 d->size = opts->has_size ? opts->size : 65536;
104
105
106 if (d->size & (d->size - 1)) {
107 error_setg(errp, "size of ringbuf chardev must be power of two");
108 return;
109 }
110
111 d->prod = 0;
112 d->cons = 0;
113 d->cbuf = g_malloc0(d->size);
114}
115
116void qmp_ringbuf_write(const char *device, const char *data,
117 bool has_format, enum DataFormat format,
118 Error **errp)
119{
120 Chardev *chr;
121 const uint8_t *write_data;
122 int ret;
123 gsize write_count;
124
125 chr = qemu_chr_find(device);
126 if (!chr) {
127 error_setg(errp, "Device '%s' not found", device);
128 return;
129 }
130
131 if (!CHARDEV_IS_RINGBUF(chr)) {
132 error_setg(errp, "%s is not a ringbuf device", device);
133 return;
134 }
135
136 if (has_format && (format == DATA_FORMAT_BASE64)) {
137 write_data = qbase64_decode(data, -1,
138 &write_count,
139 errp);
140 if (!write_data) {
141 return;
142 }
143 } else {
144 write_data = (uint8_t *)data;
145 write_count = strlen(data);
146 }
147
148 ret = ringbuf_chr_write(chr, write_data, write_count);
149
150 if (write_data != (uint8_t *)data) {
151 g_free((void *)write_data);
152 }
153
154 if (ret < 0) {
155 error_setg(errp, "Failed to write to device %s", device);
156 return;
157 }
158}
159
160char *qmp_ringbuf_read(const char *device, int64_t size,
161 bool has_format, enum DataFormat format,
162 Error **errp)
163{
164 Chardev *chr;
165 uint8_t *read_data;
166 size_t count;
167 char *data;
168
169 chr = qemu_chr_find(device);
170 if (!chr) {
171 error_setg(errp, "Device '%s' not found", device);
172 return NULL;
173 }
174
175 if (!CHARDEV_IS_RINGBUF(chr)) {
176 error_setg(errp, "%s is not a ringbuf device", device);
177 return NULL;
178 }
179
180 if (size <= 0) {
181 error_setg(errp, "size must be greater than zero");
182 return NULL;
183 }
184
185 count = ringbuf_count(chr);
186 size = size > count ? count : size;
187 read_data = g_malloc(size + 1);
188
189 ringbuf_chr_read(chr, read_data, size);
190
191 if (has_format && (format == DATA_FORMAT_BASE64)) {
192 data = g_base64_encode(read_data, size);
193 g_free(read_data);
194 } else {
195
196
197
198
199
200
201
202 read_data[size] = 0;
203 data = (char *)read_data;
204 }
205
206 return data;
207}
208
209static void qemu_chr_parse_ringbuf(QemuOpts *opts, ChardevBackend *backend,
210 Error **errp)
211{
212 int val;
213 ChardevRingbuf *ringbuf;
214
215 backend->type = CHARDEV_BACKEND_KIND_RINGBUF;
216 ringbuf = backend->u.ringbuf.data = g_new0(ChardevRingbuf, 1);
217 qemu_chr_parse_common(opts, qapi_ChardevRingbuf_base(ringbuf));
218
219 val = qemu_opt_get_size(opts, "size", 0);
220 if (val != 0) {
221 ringbuf->has_size = true;
222 ringbuf->size = val;
223 }
224}
225
226static void char_ringbuf_class_init(ObjectClass *oc, void *data)
227{
228 ChardevClass *cc = CHARDEV_CLASS(oc);
229
230 cc->parse = qemu_chr_parse_ringbuf;
231 cc->open = qemu_chr_open_ringbuf;
232 cc->chr_write = ringbuf_chr_write;
233}
234
235static const TypeInfo char_ringbuf_type_info = {
236 .name = TYPE_CHARDEV_RINGBUF,
237 .parent = TYPE_CHARDEV,
238 .class_init = char_ringbuf_class_init,
239 .instance_size = sizeof(RingBufChardev),
240 .instance_finalize = char_ringbuf_finalize,
241};
242
243
244static const TypeInfo char_memory_type_info = {
245 .name = TYPE_CHARDEV_MEMORY,
246 .parent = TYPE_CHARDEV_RINGBUF,
247};
248
249static void register_types(void)
250{
251 type_register_static(&char_ringbuf_type_info);
252 type_register_static(&char_memory_type_info);
253}
254
255type_init(register_types);
256