xref: /openbmc/qemu/nbd/server.c (revision 97841438)
1 /*
2  *  Copyright (C) 2016-2020 Red Hat, Inc.
3  *  Copyright (C) 2005  Anthony Liguori <anthony@codemonkey.ws>
4  *
5  *  Network Block Device Server Side
6  *
7  *  This program is free software; you can redistribute it and/or modify
8  *  it under the terms of the GNU General Public License as published by
9  *  the Free Software Foundation; under version 2 of the License.
10  *
11  *  This program is distributed in the hope that it will be useful,
12  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
13  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14  *  GNU General Public License for more details.
15  *
16  *  You should have received a copy of the GNU General Public License
17  *  along with this program; if not, see <http://www.gnu.org/licenses/>.
18  */
19 
20 #include "qemu/osdep.h"
21 
22 #include "block/export.h"
23 #include "qapi/error.h"
24 #include "qemu/queue.h"
25 #include "trace.h"
26 #include "nbd-internal.h"
27 #include "qemu/units.h"
28 
29 #define NBD_META_ID_BASE_ALLOCATION 0
30 #define NBD_META_ID_DIRTY_BITMAP 1
31 
32 /*
33  * NBD_MAX_BLOCK_STATUS_EXTENTS: 1 MiB of extents data. An empirical
34  * constant. If an increase is needed, note that the NBD protocol
35  * recommends no larger than 32 mb, so that the client won't consider
36  * the reply as a denial of service attack.
37  */
38 #define NBD_MAX_BLOCK_STATUS_EXTENTS (1 * MiB / 8)
39 
40 static int system_errno_to_nbd_errno(int err)
41 {
42     switch (err) {
43     case 0:
44         return NBD_SUCCESS;
45     case EPERM:
46     case EROFS:
47         return NBD_EPERM;
48     case EIO:
49         return NBD_EIO;
50     case ENOMEM:
51         return NBD_ENOMEM;
52 #ifdef EDQUOT
53     case EDQUOT:
54 #endif
55     case EFBIG:
56     case ENOSPC:
57         return NBD_ENOSPC;
58     case EOVERFLOW:
59         return NBD_EOVERFLOW;
60     case ENOTSUP:
61 #if ENOTSUP != EOPNOTSUPP
62     case EOPNOTSUPP:
63 #endif
64         return NBD_ENOTSUP;
65     case ESHUTDOWN:
66         return NBD_ESHUTDOWN;
67     case EINVAL:
68     default:
69         return NBD_EINVAL;
70     }
71 }
72 
73 /* Definitions for opaque data types */
74 
75 typedef struct NBDRequestData NBDRequestData;
76 
77 struct NBDRequestData {
78     QSIMPLEQ_ENTRY(NBDRequestData) entry;
79     NBDClient *client;
80     uint8_t *data;
81     bool complete;
82 };
83 
84 struct NBDExport {
85     BlockExport common;
86 
87     char *name;
88     char *description;
89     uint64_t size;
90     uint16_t nbdflags;
91     QTAILQ_HEAD(, NBDClient) clients;
92     QTAILQ_ENTRY(NBDExport) next;
93 
94     BlockBackend *eject_notifier_blk;
95     Notifier eject_notifier;
96 
97     BdrvDirtyBitmap *export_bitmap;
98     char *export_bitmap_context;
99 };
100 
101 static QTAILQ_HEAD(, NBDExport) exports = QTAILQ_HEAD_INITIALIZER(exports);
102 
103 /* NBDExportMetaContexts represents a list of contexts to be exported,
104  * as selected by NBD_OPT_SET_META_CONTEXT. Also used for
105  * NBD_OPT_LIST_META_CONTEXT. */
106 typedef struct NBDExportMetaContexts {
107     NBDExport *exp;
108     bool valid; /* means that negotiation of the option finished without
109                    errors */
110     bool base_allocation; /* export base:allocation context (block status) */
111     bool bitmap; /* export qemu:dirty-bitmap:<export bitmap name> */
112 } NBDExportMetaContexts;
113 
114 struct NBDClient {
115     int refcount;
116     void (*close_fn)(NBDClient *client, bool negotiated);
117 
118     NBDExport *exp;
119     QCryptoTLSCreds *tlscreds;
120     char *tlsauthz;
121     QIOChannelSocket *sioc; /* The underlying data channel */
122     QIOChannel *ioc; /* The current I/O channel which may differ (eg TLS) */
123 
124     Coroutine *recv_coroutine;
125 
126     CoMutex send_lock;
127     Coroutine *send_coroutine;
128 
129     QTAILQ_ENTRY(NBDClient) next;
130     int nb_requests;
131     bool closing;
132 
133     uint32_t check_align; /* If non-zero, check for aligned client requests */
134 
135     bool structured_reply;
136     NBDExportMetaContexts export_meta;
137 
138     uint32_t opt; /* Current option being negotiated */
139     uint32_t optlen; /* remaining length of data in ioc for the option being
140                         negotiated now */
141 };
142 
143 static void nbd_client_receive_next_request(NBDClient *client);
144 
145 /* Basic flow for negotiation
146 
147    Server         Client
148    Negotiate
149 
150    or
151 
152    Server         Client
153    Negotiate #1
154                   Option
155    Negotiate #2
156 
157    ----
158 
159    followed by
160 
161    Server         Client
162                   Request
163    Response
164                   Request
165    Response
166                   ...
167    ...
168                   Request (type == 2)
169 
170 */
171 
172 static inline void set_be_option_rep(NBDOptionReply *rep, uint32_t option,
173                                      uint32_t type, uint32_t length)
174 {
175     stq_be_p(&rep->magic, NBD_REP_MAGIC);
176     stl_be_p(&rep->option, option);
177     stl_be_p(&rep->type, type);
178     stl_be_p(&rep->length, length);
179 }
180 
181 /* Send a reply header, including length, but no payload.
182  * Return -errno on error, 0 on success. */
183 static int nbd_negotiate_send_rep_len(NBDClient *client, uint32_t type,
184                                       uint32_t len, Error **errp)
185 {
186     NBDOptionReply rep;
187 
188     trace_nbd_negotiate_send_rep_len(client->opt, nbd_opt_lookup(client->opt),
189                                      type, nbd_rep_lookup(type), len);
190 
191     assert(len < NBD_MAX_BUFFER_SIZE);
192 
193     set_be_option_rep(&rep, client->opt, type, len);
194     return nbd_write(client->ioc, &rep, sizeof(rep), errp);
195 }
196 
197 /* Send a reply header with default 0 length.
198  * Return -errno on error, 0 on success. */
199 static int nbd_negotiate_send_rep(NBDClient *client, uint32_t type,
200                                   Error **errp)
201 {
202     return nbd_negotiate_send_rep_len(client, type, 0, errp);
203 }
204 
205 /* Send an error reply.
206  * Return -errno on error, 0 on success. */
207 static int GCC_FMT_ATTR(4, 0)
208 nbd_negotiate_send_rep_verr(NBDClient *client, uint32_t type,
209                             Error **errp, const char *fmt, va_list va)
210 {
211     ERRP_GUARD();
212     g_autofree char *msg = NULL;
213     int ret;
214     size_t len;
215 
216     msg = g_strdup_vprintf(fmt, va);
217     len = strlen(msg);
218     assert(len < NBD_MAX_STRING_SIZE);
219     trace_nbd_negotiate_send_rep_err(msg);
220     ret = nbd_negotiate_send_rep_len(client, type, len, errp);
221     if (ret < 0) {
222         return ret;
223     }
224     if (nbd_write(client->ioc, msg, len, errp) < 0) {
225         error_prepend(errp, "write failed (error message): ");
226         return -EIO;
227     }
228 
229     return 0;
230 }
231 
232 /*
233  * Return a malloc'd copy of @name suitable for use in an error reply.
234  */
235 static char *
236 nbd_sanitize_name(const char *name)
237 {
238     if (strnlen(name, 80) < 80) {
239         return g_strdup(name);
240     }
241     /* XXX Should we also try to sanitize any control characters? */
242     return g_strdup_printf("%.80s...", name);
243 }
244 
245 /* Send an error reply.
246  * Return -errno on error, 0 on success. */
247 static int GCC_FMT_ATTR(4, 5)
248 nbd_negotiate_send_rep_err(NBDClient *client, uint32_t type,
249                            Error **errp, const char *fmt, ...)
250 {
251     va_list va;
252     int ret;
253 
254     va_start(va, fmt);
255     ret = nbd_negotiate_send_rep_verr(client, type, errp, fmt, va);
256     va_end(va);
257     return ret;
258 }
259 
260 /* Drop remainder of the current option, and send a reply with the
261  * given error type and message. Return -errno on read or write
262  * failure; or 0 if connection is still live. */
263 static int GCC_FMT_ATTR(4, 0)
264 nbd_opt_vdrop(NBDClient *client, uint32_t type, Error **errp,
265               const char *fmt, va_list va)
266 {
267     int ret = nbd_drop(client->ioc, client->optlen, errp);
268 
269     client->optlen = 0;
270     if (!ret) {
271         ret = nbd_negotiate_send_rep_verr(client, type, errp, fmt, va);
272     }
273     return ret;
274 }
275 
276 static int GCC_FMT_ATTR(4, 5)
277 nbd_opt_drop(NBDClient *client, uint32_t type, Error **errp,
278              const char *fmt, ...)
279 {
280     int ret;
281     va_list va;
282 
283     va_start(va, fmt);
284     ret = nbd_opt_vdrop(client, type, errp, fmt, va);
285     va_end(va);
286 
287     return ret;
288 }
289 
290 static int GCC_FMT_ATTR(3, 4)
291 nbd_opt_invalid(NBDClient *client, Error **errp, const char *fmt, ...)
292 {
293     int ret;
294     va_list va;
295 
296     va_start(va, fmt);
297     ret = nbd_opt_vdrop(client, NBD_REP_ERR_INVALID, errp, fmt, va);
298     va_end(va);
299 
300     return ret;
301 }
302 
303 /* Read size bytes from the unparsed payload of the current option.
304  * If @check_nul, require that no NUL bytes appear in buffer.
305  * Return -errno on I/O error, 0 if option was completely handled by
306  * sending a reply about inconsistent lengths, or 1 on success. */
307 static int nbd_opt_read(NBDClient *client, void *buffer, size_t size,
308                         bool check_nul, Error **errp)
309 {
310     if (size > client->optlen) {
311         return nbd_opt_invalid(client, errp,
312                                "Inconsistent lengths in option %s",
313                                nbd_opt_lookup(client->opt));
314     }
315     client->optlen -= size;
316     if (qio_channel_read_all(client->ioc, buffer, size, errp) < 0) {
317         return -EIO;
318     }
319 
320     if (check_nul && strnlen(buffer, size) != size) {
321         return nbd_opt_invalid(client, errp,
322                                "Unexpected embedded NUL in option %s",
323                                nbd_opt_lookup(client->opt));
324     }
325     return 1;
326 }
327 
328 /* Drop size bytes from the unparsed payload of the current option.
329  * Return -errno on I/O error, 0 if option was completely handled by
330  * sending a reply about inconsistent lengths, or 1 on success. */
331 static int nbd_opt_skip(NBDClient *client, size_t size, Error **errp)
332 {
333     if (size > client->optlen) {
334         return nbd_opt_invalid(client, errp,
335                                "Inconsistent lengths in option %s",
336                                nbd_opt_lookup(client->opt));
337     }
338     client->optlen -= size;
339     return nbd_drop(client->ioc, size, errp) < 0 ? -EIO : 1;
340 }
341 
342 /* nbd_opt_read_name
343  *
344  * Read a string with the format:
345  *   uint32_t len     (<= NBD_MAX_STRING_SIZE)
346  *   len bytes string (not 0-terminated)
347  *
348  * On success, @name will be allocated.
349  * If @length is non-null, it will be set to the actual string length.
350  *
351  * Return -errno on I/O error, 0 if option was completely handled by
352  * sending a reply about inconsistent lengths, or 1 on success.
353  */
354 static int nbd_opt_read_name(NBDClient *client, char **name, uint32_t *length,
355                              Error **errp)
356 {
357     int ret;
358     uint32_t len;
359     g_autofree char *local_name = NULL;
360 
361     *name = NULL;
362     ret = nbd_opt_read(client, &len, sizeof(len), false, errp);
363     if (ret <= 0) {
364         return ret;
365     }
366     len = cpu_to_be32(len);
367 
368     if (len > NBD_MAX_STRING_SIZE) {
369         return nbd_opt_invalid(client, errp,
370                                "Invalid name length: %" PRIu32, len);
371     }
372 
373     local_name = g_malloc(len + 1);
374     ret = nbd_opt_read(client, local_name, len, true, errp);
375     if (ret <= 0) {
376         return ret;
377     }
378     local_name[len] = '\0';
379 
380     if (length) {
381         *length = len;
382     }
383     *name = g_steal_pointer(&local_name);
384 
385     return 1;
386 }
387 
388 /* Send a single NBD_REP_SERVER reply to NBD_OPT_LIST, including payload.
389  * Return -errno on error, 0 on success. */
390 static int nbd_negotiate_send_rep_list(NBDClient *client, NBDExport *exp,
391                                        Error **errp)
392 {
393     ERRP_GUARD();
394     size_t name_len, desc_len;
395     uint32_t len;
396     const char *name = exp->name ? exp->name : "";
397     const char *desc = exp->description ? exp->description : "";
398     QIOChannel *ioc = client->ioc;
399     int ret;
400 
401     trace_nbd_negotiate_send_rep_list(name, desc);
402     name_len = strlen(name);
403     desc_len = strlen(desc);
404     assert(name_len <= NBD_MAX_STRING_SIZE && desc_len <= NBD_MAX_STRING_SIZE);
405     len = name_len + desc_len + sizeof(len);
406     ret = nbd_negotiate_send_rep_len(client, NBD_REP_SERVER, len, errp);
407     if (ret < 0) {
408         return ret;
409     }
410 
411     len = cpu_to_be32(name_len);
412     if (nbd_write(ioc, &len, sizeof(len), errp) < 0) {
413         error_prepend(errp, "write failed (name length): ");
414         return -EINVAL;
415     }
416 
417     if (nbd_write(ioc, name, name_len, errp) < 0) {
418         error_prepend(errp, "write failed (name buffer): ");
419         return -EINVAL;
420     }
421 
422     if (nbd_write(ioc, desc, desc_len, errp) < 0) {
423         error_prepend(errp, "write failed (description buffer): ");
424         return -EINVAL;
425     }
426 
427     return 0;
428 }
429 
430 /* Process the NBD_OPT_LIST command, with a potential series of replies.
431  * Return -errno on error, 0 on success. */
432 static int nbd_negotiate_handle_list(NBDClient *client, Error **errp)
433 {
434     NBDExport *exp;
435     assert(client->opt == NBD_OPT_LIST);
436 
437     /* For each export, send a NBD_REP_SERVER reply. */
438     QTAILQ_FOREACH(exp, &exports, next) {
439         if (nbd_negotiate_send_rep_list(client, exp, errp)) {
440             return -EINVAL;
441         }
442     }
443     /* Finish with a NBD_REP_ACK. */
444     return nbd_negotiate_send_rep(client, NBD_REP_ACK, errp);
445 }
446 
447 static void nbd_check_meta_export(NBDClient *client)
448 {
449     client->export_meta.valid &= client->exp == client->export_meta.exp;
450 }
451 
452 /* Send a reply to NBD_OPT_EXPORT_NAME.
453  * Return -errno on error, 0 on success. */
454 static int nbd_negotiate_handle_export_name(NBDClient *client, bool no_zeroes,
455                                             Error **errp)
456 {
457     ERRP_GUARD();
458     g_autofree char *name = NULL;
459     char buf[NBD_REPLY_EXPORT_NAME_SIZE] = "";
460     size_t len;
461     int ret;
462     uint16_t myflags;
463 
464     /* Client sends:
465         [20 ..  xx]   export name (length bytes)
466        Server replies:
467         [ 0 ..   7]   size
468         [ 8 ..   9]   export flags
469         [10 .. 133]   reserved     (0) [unless no_zeroes]
470      */
471     trace_nbd_negotiate_handle_export_name();
472     if (client->optlen > NBD_MAX_STRING_SIZE) {
473         error_setg(errp, "Bad length received");
474         return -EINVAL;
475     }
476     name = g_malloc(client->optlen + 1);
477     if (nbd_read(client->ioc, name, client->optlen, "export name", errp) < 0) {
478         return -EIO;
479     }
480     name[client->optlen] = '\0';
481     client->optlen = 0;
482 
483     trace_nbd_negotiate_handle_export_name_request(name);
484 
485     client->exp = nbd_export_find(name);
486     if (!client->exp) {
487         error_setg(errp, "export not found");
488         return -EINVAL;
489     }
490 
491     myflags = client->exp->nbdflags;
492     if (client->structured_reply) {
493         myflags |= NBD_FLAG_SEND_DF;
494     }
495     trace_nbd_negotiate_new_style_size_flags(client->exp->size, myflags);
496     stq_be_p(buf, client->exp->size);
497     stw_be_p(buf + 8, myflags);
498     len = no_zeroes ? 10 : sizeof(buf);
499     ret = nbd_write(client->ioc, buf, len, errp);
500     if (ret < 0) {
501         error_prepend(errp, "write failed: ");
502         return ret;
503     }
504 
505     QTAILQ_INSERT_TAIL(&client->exp->clients, client, next);
506     blk_exp_ref(&client->exp->common);
507     nbd_check_meta_export(client);
508 
509     return 0;
510 }
511 
512 /* Send a single NBD_REP_INFO, with a buffer @buf of @length bytes.
513  * The buffer does NOT include the info type prefix.
514  * Return -errno on error, 0 if ready to send more. */
515 static int nbd_negotiate_send_info(NBDClient *client,
516                                    uint16_t info, uint32_t length, void *buf,
517                                    Error **errp)
518 {
519     int rc;
520 
521     trace_nbd_negotiate_send_info(info, nbd_info_lookup(info), length);
522     rc = nbd_negotiate_send_rep_len(client, NBD_REP_INFO,
523                                     sizeof(info) + length, errp);
524     if (rc < 0) {
525         return rc;
526     }
527     info = cpu_to_be16(info);
528     if (nbd_write(client->ioc, &info, sizeof(info), errp) < 0) {
529         return -EIO;
530     }
531     if (nbd_write(client->ioc, buf, length, errp) < 0) {
532         return -EIO;
533     }
534     return 0;
535 }
536 
537 /* nbd_reject_length: Handle any unexpected payload.
538  * @fatal requests that we quit talking to the client, even if we are able
539  * to successfully send an error reply.
540  * Return:
541  * -errno  transmission error occurred or @fatal was requested, errp is set
542  * 0       error message successfully sent to client, errp is not set
543  */
544 static int nbd_reject_length(NBDClient *client, bool fatal, Error **errp)
545 {
546     int ret;
547 
548     assert(client->optlen);
549     ret = nbd_opt_invalid(client, errp, "option '%s' has unexpected length",
550                           nbd_opt_lookup(client->opt));
551     if (fatal && !ret) {
552         error_setg(errp, "option '%s' has unexpected length",
553                    nbd_opt_lookup(client->opt));
554         return -EINVAL;
555     }
556     return ret;
557 }
558 
559 /* Handle NBD_OPT_INFO and NBD_OPT_GO.
560  * Return -errno on error, 0 if ready for next option, and 1 to move
561  * into transmission phase.  */
562 static int nbd_negotiate_handle_info(NBDClient *client, Error **errp)
563 {
564     int rc;
565     g_autofree char *name = NULL;
566     NBDExport *exp;
567     uint16_t requests;
568     uint16_t request;
569     uint32_t namelen = 0;
570     bool sendname = false;
571     bool blocksize = false;
572     uint32_t sizes[3];
573     char buf[sizeof(uint64_t) + sizeof(uint16_t)];
574     uint32_t check_align = 0;
575     uint16_t myflags;
576 
577     /* Client sends:
578         4 bytes: L, name length (can be 0)
579         L bytes: export name
580         2 bytes: N, number of requests (can be 0)
581         N * 2 bytes: N requests
582     */
583     rc = nbd_opt_read_name(client, &name, &namelen, errp);
584     if (rc <= 0) {
585         return rc;
586     }
587     trace_nbd_negotiate_handle_export_name_request(name);
588 
589     rc = nbd_opt_read(client, &requests, sizeof(requests), false, errp);
590     if (rc <= 0) {
591         return rc;
592     }
593     requests = be16_to_cpu(requests);
594     trace_nbd_negotiate_handle_info_requests(requests);
595     while (requests--) {
596         rc = nbd_opt_read(client, &request, sizeof(request), false, errp);
597         if (rc <= 0) {
598             return rc;
599         }
600         request = be16_to_cpu(request);
601         trace_nbd_negotiate_handle_info_request(request,
602                                                 nbd_info_lookup(request));
603         /* We care about NBD_INFO_NAME and NBD_INFO_BLOCK_SIZE;
604          * everything else is either a request we don't know or
605          * something we send regardless of request */
606         switch (request) {
607         case NBD_INFO_NAME:
608             sendname = true;
609             break;
610         case NBD_INFO_BLOCK_SIZE:
611             blocksize = true;
612             break;
613         }
614     }
615     if (client->optlen) {
616         return nbd_reject_length(client, false, errp);
617     }
618 
619     exp = nbd_export_find(name);
620     if (!exp) {
621         g_autofree char *sane_name = nbd_sanitize_name(name);
622 
623         return nbd_negotiate_send_rep_err(client, NBD_REP_ERR_UNKNOWN,
624                                           errp, "export '%s' not present",
625                                           sane_name);
626     }
627 
628     /* Don't bother sending NBD_INFO_NAME unless client requested it */
629     if (sendname) {
630         rc = nbd_negotiate_send_info(client, NBD_INFO_NAME, namelen, name,
631                                      errp);
632         if (rc < 0) {
633             return rc;
634         }
635     }
636 
637     /* Send NBD_INFO_DESCRIPTION only if available, regardless of
638      * client request */
639     if (exp->description) {
640         size_t len = strlen(exp->description);
641 
642         assert(len <= NBD_MAX_STRING_SIZE);
643         rc = nbd_negotiate_send_info(client, NBD_INFO_DESCRIPTION,
644                                      len, exp->description, errp);
645         if (rc < 0) {
646             return rc;
647         }
648     }
649 
650     /* Send NBD_INFO_BLOCK_SIZE always, but tweak the minimum size
651      * according to whether the client requested it, and according to
652      * whether this is OPT_INFO or OPT_GO. */
653     /* minimum - 1 for back-compat, or actual if client will obey it. */
654     if (client->opt == NBD_OPT_INFO || blocksize) {
655         check_align = sizes[0] = blk_get_request_alignment(exp->common.blk);
656     } else {
657         sizes[0] = 1;
658     }
659     assert(sizes[0] <= NBD_MAX_BUFFER_SIZE);
660     /* preferred - Hard-code to 4096 for now.
661      * TODO: is blk_bs(blk)->bl.opt_transfer appropriate? */
662     sizes[1] = MAX(4096, sizes[0]);
663     /* maximum - At most 32M, but smaller as appropriate. */
664     sizes[2] = MIN(blk_get_max_transfer(exp->common.blk), NBD_MAX_BUFFER_SIZE);
665     trace_nbd_negotiate_handle_info_block_size(sizes[0], sizes[1], sizes[2]);
666     sizes[0] = cpu_to_be32(sizes[0]);
667     sizes[1] = cpu_to_be32(sizes[1]);
668     sizes[2] = cpu_to_be32(sizes[2]);
669     rc = nbd_negotiate_send_info(client, NBD_INFO_BLOCK_SIZE,
670                                  sizeof(sizes), sizes, errp);
671     if (rc < 0) {
672         return rc;
673     }
674 
675     /* Send NBD_INFO_EXPORT always */
676     myflags = exp->nbdflags;
677     if (client->structured_reply) {
678         myflags |= NBD_FLAG_SEND_DF;
679     }
680     trace_nbd_negotiate_new_style_size_flags(exp->size, myflags);
681     stq_be_p(buf, exp->size);
682     stw_be_p(buf + 8, myflags);
683     rc = nbd_negotiate_send_info(client, NBD_INFO_EXPORT,
684                                  sizeof(buf), buf, errp);
685     if (rc < 0) {
686         return rc;
687     }
688 
689     /*
690      * If the client is just asking for NBD_OPT_INFO, but forgot to
691      * request block sizes in a situation that would impact
692      * performance, then return an error. But for NBD_OPT_GO, we
693      * tolerate all clients, regardless of alignments.
694      */
695     if (client->opt == NBD_OPT_INFO && !blocksize &&
696         blk_get_request_alignment(exp->common.blk) > 1) {
697         return nbd_negotiate_send_rep_err(client,
698                                           NBD_REP_ERR_BLOCK_SIZE_REQD,
699                                           errp,
700                                           "request NBD_INFO_BLOCK_SIZE to "
701                                           "use this export");
702     }
703 
704     /* Final reply */
705     rc = nbd_negotiate_send_rep(client, NBD_REP_ACK, errp);
706     if (rc < 0) {
707         return rc;
708     }
709 
710     if (client->opt == NBD_OPT_GO) {
711         client->exp = exp;
712         client->check_align = check_align;
713         QTAILQ_INSERT_TAIL(&client->exp->clients, client, next);
714         blk_exp_ref(&client->exp->common);
715         nbd_check_meta_export(client);
716         rc = 1;
717     }
718     return rc;
719 }
720 
721 
722 /* Handle NBD_OPT_STARTTLS. Return NULL to drop connection, or else the
723  * new channel for all further (now-encrypted) communication. */
724 static QIOChannel *nbd_negotiate_handle_starttls(NBDClient *client,
725                                                  Error **errp)
726 {
727     QIOChannel *ioc;
728     QIOChannelTLS *tioc;
729     struct NBDTLSHandshakeData data = { 0 };
730 
731     assert(client->opt == NBD_OPT_STARTTLS);
732 
733     trace_nbd_negotiate_handle_starttls();
734     ioc = client->ioc;
735 
736     if (nbd_negotiate_send_rep(client, NBD_REP_ACK, errp) < 0) {
737         return NULL;
738     }
739 
740     tioc = qio_channel_tls_new_server(ioc,
741                                       client->tlscreds,
742                                       client->tlsauthz,
743                                       errp);
744     if (!tioc) {
745         return NULL;
746     }
747 
748     qio_channel_set_name(QIO_CHANNEL(tioc), "nbd-server-tls");
749     trace_nbd_negotiate_handle_starttls_handshake();
750     data.loop = g_main_loop_new(g_main_context_default(), FALSE);
751     qio_channel_tls_handshake(tioc,
752                               nbd_tls_handshake,
753                               &data,
754                               NULL,
755                               NULL);
756 
757     if (!data.complete) {
758         g_main_loop_run(data.loop);
759     }
760     g_main_loop_unref(data.loop);
761     if (data.error) {
762         object_unref(OBJECT(tioc));
763         error_propagate(errp, data.error);
764         return NULL;
765     }
766 
767     return QIO_CHANNEL(tioc);
768 }
769 
770 /* nbd_negotiate_send_meta_context
771  *
772  * Send one chunk of reply to NBD_OPT_{LIST,SET}_META_CONTEXT
773  *
774  * For NBD_OPT_LIST_META_CONTEXT @context_id is ignored, 0 is used instead.
775  */
776 static int nbd_negotiate_send_meta_context(NBDClient *client,
777                                            const char *context,
778                                            uint32_t context_id,
779                                            Error **errp)
780 {
781     NBDOptionReplyMetaContext opt;
782     struct iovec iov[] = {
783         {.iov_base = &opt, .iov_len = sizeof(opt)},
784         {.iov_base = (void *)context, .iov_len = strlen(context)}
785     };
786 
787     assert(iov[1].iov_len <= NBD_MAX_STRING_SIZE);
788     if (client->opt == NBD_OPT_LIST_META_CONTEXT) {
789         context_id = 0;
790     }
791 
792     trace_nbd_negotiate_meta_query_reply(context, context_id);
793     set_be_option_rep(&opt.h, client->opt, NBD_REP_META_CONTEXT,
794                       sizeof(opt) - sizeof(opt.h) + iov[1].iov_len);
795     stl_be_p(&opt.context_id, context_id);
796 
797     return qio_channel_writev_all(client->ioc, iov, 2, errp) < 0 ? -EIO : 0;
798 }
799 
800 /*
801  * Return true if @query matches @pattern, or if @query is empty when
802  * the @client is performing _LIST_.
803  */
804 static bool nbd_meta_empty_or_pattern(NBDClient *client, const char *pattern,
805                                       const char *query)
806 {
807     if (!*query) {
808         trace_nbd_negotiate_meta_query_parse("empty");
809         return client->opt == NBD_OPT_LIST_META_CONTEXT;
810     }
811     if (strcmp(query, pattern) == 0) {
812         trace_nbd_negotiate_meta_query_parse(pattern);
813         return true;
814     }
815     trace_nbd_negotiate_meta_query_skip("pattern not matched");
816     return false;
817 }
818 
819 /*
820  * Return true and adjust @str in place if it begins with @prefix.
821  */
822 static bool nbd_strshift(const char **str, const char *prefix)
823 {
824     size_t len = strlen(prefix);
825 
826     if (strncmp(*str, prefix, len) == 0) {
827         *str += len;
828         return true;
829     }
830     return false;
831 }
832 
833 /* nbd_meta_base_query
834  *
835  * Handle queries to 'base' namespace. For now, only the base:allocation
836  * context is available.  Return true if @query has been handled.
837  */
838 static bool nbd_meta_base_query(NBDClient *client, NBDExportMetaContexts *meta,
839                                 const char *query)
840 {
841     if (!nbd_strshift(&query, "base:")) {
842         return false;
843     }
844     trace_nbd_negotiate_meta_query_parse("base:");
845 
846     if (nbd_meta_empty_or_pattern(client, "allocation", query)) {
847         meta->base_allocation = true;
848     }
849     return true;
850 }
851 
852 /* nbd_meta_qemu_query
853  *
854  * Handle queries to 'qemu' namespace. For now, only the qemu:dirty-bitmap:
855  * context is available.  Return true if @query has been handled.
856  */
857 static bool nbd_meta_qemu_query(NBDClient *client, NBDExportMetaContexts *meta,
858                                 const char *query)
859 {
860     if (!nbd_strshift(&query, "qemu:")) {
861         return false;
862     }
863     trace_nbd_negotiate_meta_query_parse("qemu:");
864 
865     if (!*query) {
866         if (client->opt == NBD_OPT_LIST_META_CONTEXT) {
867             meta->bitmap = !!meta->exp->export_bitmap;
868         }
869         trace_nbd_negotiate_meta_query_parse("empty");
870         return true;
871     }
872 
873     if (nbd_strshift(&query, "dirty-bitmap:")) {
874         trace_nbd_negotiate_meta_query_parse("dirty-bitmap:");
875         if (!meta->exp->export_bitmap) {
876             trace_nbd_negotiate_meta_query_skip("no dirty-bitmap exported");
877             return true;
878         }
879         if (nbd_meta_empty_or_pattern(client,
880                                       meta->exp->export_bitmap_context +
881                                       strlen("qemu:dirty-bitmap:"), query)) {
882             meta->bitmap = true;
883         }
884         return true;
885     }
886 
887     trace_nbd_negotiate_meta_query_skip("not dirty-bitmap");
888     return true;
889 }
890 
891 /* nbd_negotiate_meta_query
892  *
893  * Parse namespace name and call corresponding function to parse body of the
894  * query.
895  *
896  * The only supported namespaces are 'base' and 'qemu'.
897  *
898  * Return -errno on I/O error, 0 if option was completely handled by
899  * sending a reply about inconsistent lengths, or 1 on success. */
900 static int nbd_negotiate_meta_query(NBDClient *client,
901                                     NBDExportMetaContexts *meta, Error **errp)
902 {
903     int ret;
904     g_autofree char *query = NULL;
905     uint32_t len;
906 
907     ret = nbd_opt_read(client, &len, sizeof(len), false, errp);
908     if (ret <= 0) {
909         return ret;
910     }
911     len = cpu_to_be32(len);
912 
913     if (len > NBD_MAX_STRING_SIZE) {
914         trace_nbd_negotiate_meta_query_skip("length too long");
915         return nbd_opt_skip(client, len, errp);
916     }
917 
918     query = g_malloc(len + 1);
919     ret = nbd_opt_read(client, query, len, true, errp);
920     if (ret <= 0) {
921         return ret;
922     }
923     query[len] = '\0';
924 
925     if (nbd_meta_base_query(client, meta, query)) {
926         return 1;
927     }
928     if (nbd_meta_qemu_query(client, meta, query)) {
929         return 1;
930     }
931 
932     trace_nbd_negotiate_meta_query_skip("unknown namespace");
933     return 1;
934 }
935 
936 /* nbd_negotiate_meta_queries
937  * Handle NBD_OPT_LIST_META_CONTEXT and NBD_OPT_SET_META_CONTEXT
938  *
939  * Return -errno on I/O error, or 0 if option was completely handled. */
940 static int nbd_negotiate_meta_queries(NBDClient *client,
941                                       NBDExportMetaContexts *meta, Error **errp)
942 {
943     int ret;
944     g_autofree char *export_name = NULL;
945     NBDExportMetaContexts local_meta;
946     uint32_t nb_queries;
947     int i;
948 
949     if (!client->structured_reply) {
950         return nbd_opt_invalid(client, errp,
951                                "request option '%s' when structured reply "
952                                "is not negotiated",
953                                nbd_opt_lookup(client->opt));
954     }
955 
956     if (client->opt == NBD_OPT_LIST_META_CONTEXT) {
957         /* Only change the caller's meta on SET. */
958         meta = &local_meta;
959     }
960 
961     memset(meta, 0, sizeof(*meta));
962 
963     ret = nbd_opt_read_name(client, &export_name, NULL, errp);
964     if (ret <= 0) {
965         return ret;
966     }
967 
968     meta->exp = nbd_export_find(export_name);
969     if (meta->exp == NULL) {
970         g_autofree char *sane_name = nbd_sanitize_name(export_name);
971 
972         return nbd_opt_drop(client, NBD_REP_ERR_UNKNOWN, errp,
973                             "export '%s' not present", sane_name);
974     }
975 
976     ret = nbd_opt_read(client, &nb_queries, sizeof(nb_queries), false, errp);
977     if (ret <= 0) {
978         return ret;
979     }
980     nb_queries = cpu_to_be32(nb_queries);
981     trace_nbd_negotiate_meta_context(nbd_opt_lookup(client->opt),
982                                      export_name, nb_queries);
983 
984     if (client->opt == NBD_OPT_LIST_META_CONTEXT && !nb_queries) {
985         /* enable all known contexts */
986         meta->base_allocation = true;
987         meta->bitmap = !!meta->exp->export_bitmap;
988     } else {
989         for (i = 0; i < nb_queries; ++i) {
990             ret = nbd_negotiate_meta_query(client, meta, errp);
991             if (ret <= 0) {
992                 return ret;
993             }
994         }
995     }
996 
997     if (meta->base_allocation) {
998         ret = nbd_negotiate_send_meta_context(client, "base:allocation",
999                                               NBD_META_ID_BASE_ALLOCATION,
1000                                               errp);
1001         if (ret < 0) {
1002             return ret;
1003         }
1004     }
1005 
1006     if (meta->bitmap) {
1007         ret = nbd_negotiate_send_meta_context(client,
1008                                               meta->exp->export_bitmap_context,
1009                                               NBD_META_ID_DIRTY_BITMAP,
1010                                               errp);
1011         if (ret < 0) {
1012             return ret;
1013         }
1014     }
1015 
1016     ret = nbd_negotiate_send_rep(client, NBD_REP_ACK, errp);
1017     if (ret == 0) {
1018         meta->valid = true;
1019     }
1020 
1021     return ret;
1022 }
1023 
1024 /* nbd_negotiate_options
1025  * Process all NBD_OPT_* client option commands, during fixed newstyle
1026  * negotiation.
1027  * Return:
1028  * -errno  on error, errp is set
1029  * 0       on successful negotiation, errp is not set
1030  * 1       if client sent NBD_OPT_ABORT, i.e. on valid disconnect,
1031  *         errp is not set
1032  */
1033 static int nbd_negotiate_options(NBDClient *client, Error **errp)
1034 {
1035     uint32_t flags;
1036     bool fixedNewstyle = false;
1037     bool no_zeroes = false;
1038 
1039     /* Client sends:
1040         [ 0 ..   3]   client flags
1041 
1042        Then we loop until NBD_OPT_EXPORT_NAME or NBD_OPT_GO:
1043         [ 0 ..   7]   NBD_OPTS_MAGIC
1044         [ 8 ..  11]   NBD option
1045         [12 ..  15]   Data length
1046         ...           Rest of request
1047 
1048         [ 0 ..   7]   NBD_OPTS_MAGIC
1049         [ 8 ..  11]   Second NBD option
1050         [12 ..  15]   Data length
1051         ...           Rest of request
1052     */
1053 
1054     if (nbd_read32(client->ioc, &flags, "flags", errp) < 0) {
1055         return -EIO;
1056     }
1057     trace_nbd_negotiate_options_flags(flags);
1058     if (flags & NBD_FLAG_C_FIXED_NEWSTYLE) {
1059         fixedNewstyle = true;
1060         flags &= ~NBD_FLAG_C_FIXED_NEWSTYLE;
1061     }
1062     if (flags & NBD_FLAG_C_NO_ZEROES) {
1063         no_zeroes = true;
1064         flags &= ~NBD_FLAG_C_NO_ZEROES;
1065     }
1066     if (flags != 0) {
1067         error_setg(errp, "Unknown client flags 0x%" PRIx32 " received", flags);
1068         return -EINVAL;
1069     }
1070 
1071     while (1) {
1072         int ret;
1073         uint32_t option, length;
1074         uint64_t magic;
1075 
1076         if (nbd_read64(client->ioc, &magic, "opts magic", errp) < 0) {
1077             return -EINVAL;
1078         }
1079         trace_nbd_negotiate_options_check_magic(magic);
1080         if (magic != NBD_OPTS_MAGIC) {
1081             error_setg(errp, "Bad magic received");
1082             return -EINVAL;
1083         }
1084 
1085         if (nbd_read32(client->ioc, &option, "option", errp) < 0) {
1086             return -EINVAL;
1087         }
1088         client->opt = option;
1089 
1090         if (nbd_read32(client->ioc, &length, "option length", errp) < 0) {
1091             return -EINVAL;
1092         }
1093         assert(!client->optlen);
1094         client->optlen = length;
1095 
1096         if (length > NBD_MAX_BUFFER_SIZE) {
1097             error_setg(errp, "len (%" PRIu32" ) is larger than max len (%u)",
1098                        length, NBD_MAX_BUFFER_SIZE);
1099             return -EINVAL;
1100         }
1101 
1102         trace_nbd_negotiate_options_check_option(option,
1103                                                  nbd_opt_lookup(option));
1104         if (client->tlscreds &&
1105             client->ioc == (QIOChannel *)client->sioc) {
1106             QIOChannel *tioc;
1107             if (!fixedNewstyle) {
1108                 error_setg(errp, "Unsupported option 0x%" PRIx32, option);
1109                 return -EINVAL;
1110             }
1111             switch (option) {
1112             case NBD_OPT_STARTTLS:
1113                 if (length) {
1114                     /* Unconditionally drop the connection if the client
1115                      * can't start a TLS negotiation correctly */
1116                     return nbd_reject_length(client, true, errp);
1117                 }
1118                 tioc = nbd_negotiate_handle_starttls(client, errp);
1119                 if (!tioc) {
1120                     return -EIO;
1121                 }
1122                 ret = 0;
1123                 object_unref(OBJECT(client->ioc));
1124                 client->ioc = QIO_CHANNEL(tioc);
1125                 break;
1126 
1127             case NBD_OPT_EXPORT_NAME:
1128                 /* No way to return an error to client, so drop connection */
1129                 error_setg(errp, "Option 0x%x not permitted before TLS",
1130                            option);
1131                 return -EINVAL;
1132 
1133             default:
1134                 /* Let the client keep trying, unless they asked to
1135                  * quit. Always try to give an error back to the
1136                  * client; but when replying to OPT_ABORT, be aware
1137                  * that the client may hang up before receiving the
1138                  * error, in which case we are fine ignoring the
1139                  * resulting EPIPE. */
1140                 ret = nbd_opt_drop(client, NBD_REP_ERR_TLS_REQD,
1141                                    option == NBD_OPT_ABORT ? NULL : errp,
1142                                    "Option 0x%" PRIx32
1143                                    " not permitted before TLS", option);
1144                 if (option == NBD_OPT_ABORT) {
1145                     return 1;
1146                 }
1147                 break;
1148             }
1149         } else if (fixedNewstyle) {
1150             switch (option) {
1151             case NBD_OPT_LIST:
1152                 if (length) {
1153                     ret = nbd_reject_length(client, false, errp);
1154                 } else {
1155                     ret = nbd_negotiate_handle_list(client, errp);
1156                 }
1157                 break;
1158 
1159             case NBD_OPT_ABORT:
1160                 /* NBD spec says we must try to reply before
1161                  * disconnecting, but that we must also tolerate
1162                  * guests that don't wait for our reply. */
1163                 nbd_negotiate_send_rep(client, NBD_REP_ACK, NULL);
1164                 return 1;
1165 
1166             case NBD_OPT_EXPORT_NAME:
1167                 return nbd_negotiate_handle_export_name(client, no_zeroes,
1168                                                         errp);
1169 
1170             case NBD_OPT_INFO:
1171             case NBD_OPT_GO:
1172                 ret = nbd_negotiate_handle_info(client, errp);
1173                 if (ret == 1) {
1174                     assert(option == NBD_OPT_GO);
1175                     return 0;
1176                 }
1177                 break;
1178 
1179             case NBD_OPT_STARTTLS:
1180                 if (length) {
1181                     ret = nbd_reject_length(client, false, errp);
1182                 } else if (client->tlscreds) {
1183                     ret = nbd_negotiate_send_rep_err(client,
1184                                                      NBD_REP_ERR_INVALID, errp,
1185                                                      "TLS already enabled");
1186                 } else {
1187                     ret = nbd_negotiate_send_rep_err(client,
1188                                                      NBD_REP_ERR_POLICY, errp,
1189                                                      "TLS not configured");
1190                 }
1191                 break;
1192 
1193             case NBD_OPT_STRUCTURED_REPLY:
1194                 if (length) {
1195                     ret = nbd_reject_length(client, false, errp);
1196                 } else if (client->structured_reply) {
1197                     ret = nbd_negotiate_send_rep_err(
1198                         client, NBD_REP_ERR_INVALID, errp,
1199                         "structured reply already negotiated");
1200                 } else {
1201                     ret = nbd_negotiate_send_rep(client, NBD_REP_ACK, errp);
1202                     client->structured_reply = true;
1203                 }
1204                 break;
1205 
1206             case NBD_OPT_LIST_META_CONTEXT:
1207             case NBD_OPT_SET_META_CONTEXT:
1208                 ret = nbd_negotiate_meta_queries(client, &client->export_meta,
1209                                                  errp);
1210                 break;
1211 
1212             default:
1213                 ret = nbd_opt_drop(client, NBD_REP_ERR_UNSUP, errp,
1214                                    "Unsupported option %" PRIu32 " (%s)",
1215                                    option, nbd_opt_lookup(option));
1216                 break;
1217             }
1218         } else {
1219             /*
1220              * If broken new-style we should drop the connection
1221              * for anything except NBD_OPT_EXPORT_NAME
1222              */
1223             switch (option) {
1224             case NBD_OPT_EXPORT_NAME:
1225                 return nbd_negotiate_handle_export_name(client, no_zeroes,
1226                                                         errp);
1227 
1228             default:
1229                 error_setg(errp, "Unsupported option %" PRIu32 " (%s)",
1230                            option, nbd_opt_lookup(option));
1231                 return -EINVAL;
1232             }
1233         }
1234         if (ret < 0) {
1235             return ret;
1236         }
1237     }
1238 }
1239 
1240 /* nbd_negotiate
1241  * Return:
1242  * -errno  on error, errp is set
1243  * 0       on successful negotiation, errp is not set
1244  * 1       if client sent NBD_OPT_ABORT, i.e. on valid disconnect,
1245  *         errp is not set
1246  */
1247 static coroutine_fn int nbd_negotiate(NBDClient *client, Error **errp)
1248 {
1249     ERRP_GUARD();
1250     char buf[NBD_OLDSTYLE_NEGOTIATE_SIZE] = "";
1251     int ret;
1252 
1253     /* Old style negotiation header, no room for options
1254         [ 0 ..   7]   passwd       ("NBDMAGIC")
1255         [ 8 ..  15]   magic        (NBD_CLIENT_MAGIC)
1256         [16 ..  23]   size
1257         [24 ..  27]   export flags (zero-extended)
1258         [28 .. 151]   reserved     (0)
1259 
1260        New style negotiation header, client can send options
1261         [ 0 ..   7]   passwd       ("NBDMAGIC")
1262         [ 8 ..  15]   magic        (NBD_OPTS_MAGIC)
1263         [16 ..  17]   server flags (0)
1264         ....options sent, ending in NBD_OPT_EXPORT_NAME or NBD_OPT_GO....
1265      */
1266 
1267     qio_channel_set_blocking(client->ioc, false, NULL);
1268 
1269     trace_nbd_negotiate_begin();
1270     memcpy(buf, "NBDMAGIC", 8);
1271 
1272     stq_be_p(buf + 8, NBD_OPTS_MAGIC);
1273     stw_be_p(buf + 16, NBD_FLAG_FIXED_NEWSTYLE | NBD_FLAG_NO_ZEROES);
1274 
1275     if (nbd_write(client->ioc, buf, 18, errp) < 0) {
1276         error_prepend(errp, "write failed: ");
1277         return -EINVAL;
1278     }
1279     ret = nbd_negotiate_options(client, errp);
1280     if (ret != 0) {
1281         if (ret < 0) {
1282             error_prepend(errp, "option negotiation failed: ");
1283         }
1284         return ret;
1285     }
1286 
1287     /* Attach the channel to the same AioContext as the export */
1288     if (client->exp && client->exp->common.ctx) {
1289         qio_channel_attach_aio_context(client->ioc, client->exp->common.ctx);
1290     }
1291 
1292     assert(!client->optlen);
1293     trace_nbd_negotiate_success();
1294 
1295     return 0;
1296 }
1297 
1298 static int nbd_receive_request(QIOChannel *ioc, NBDRequest *request,
1299                                Error **errp)
1300 {
1301     uint8_t buf[NBD_REQUEST_SIZE];
1302     uint32_t magic;
1303     int ret;
1304 
1305     ret = nbd_read(ioc, buf, sizeof(buf), "request", errp);
1306     if (ret < 0) {
1307         return ret;
1308     }
1309 
1310     /* Request
1311        [ 0 ..  3]   magic   (NBD_REQUEST_MAGIC)
1312        [ 4 ..  5]   flags   (NBD_CMD_FLAG_FUA, ...)
1313        [ 6 ..  7]   type    (NBD_CMD_READ, ...)
1314        [ 8 .. 15]   handle
1315        [16 .. 23]   from
1316        [24 .. 27]   len
1317      */
1318 
1319     magic = ldl_be_p(buf);
1320     request->flags  = lduw_be_p(buf + 4);
1321     request->type   = lduw_be_p(buf + 6);
1322     request->handle = ldq_be_p(buf + 8);
1323     request->from   = ldq_be_p(buf + 16);
1324     request->len    = ldl_be_p(buf + 24);
1325 
1326     trace_nbd_receive_request(magic, request->flags, request->type,
1327                               request->from, request->len);
1328 
1329     if (magic != NBD_REQUEST_MAGIC) {
1330         error_setg(errp, "invalid magic (got 0x%" PRIx32 ")", magic);
1331         return -EINVAL;
1332     }
1333     return 0;
1334 }
1335 
1336 #define MAX_NBD_REQUESTS 16
1337 
1338 void nbd_client_get(NBDClient *client)
1339 {
1340     client->refcount++;
1341 }
1342 
1343 void nbd_client_put(NBDClient *client)
1344 {
1345     if (--client->refcount == 0) {
1346         /* The last reference should be dropped by client->close,
1347          * which is called by client_close.
1348          */
1349         assert(client->closing);
1350 
1351         qio_channel_detach_aio_context(client->ioc);
1352         object_unref(OBJECT(client->sioc));
1353         object_unref(OBJECT(client->ioc));
1354         if (client->tlscreds) {
1355             object_unref(OBJECT(client->tlscreds));
1356         }
1357         g_free(client->tlsauthz);
1358         if (client->exp) {
1359             QTAILQ_REMOVE(&client->exp->clients, client, next);
1360             blk_exp_unref(&client->exp->common);
1361         }
1362         g_free(client);
1363     }
1364 }
1365 
1366 static void client_close(NBDClient *client, bool negotiated)
1367 {
1368     if (client->closing) {
1369         return;
1370     }
1371 
1372     client->closing = true;
1373 
1374     /* Force requests to finish.  They will drop their own references,
1375      * then we'll close the socket and free the NBDClient.
1376      */
1377     qio_channel_shutdown(client->ioc, QIO_CHANNEL_SHUTDOWN_BOTH,
1378                          NULL);
1379 
1380     /* Also tell the client, so that they release their reference.  */
1381     if (client->close_fn) {
1382         client->close_fn(client, negotiated);
1383     }
1384 }
1385 
1386 static NBDRequestData *nbd_request_get(NBDClient *client)
1387 {
1388     NBDRequestData *req;
1389 
1390     assert(client->nb_requests <= MAX_NBD_REQUESTS - 1);
1391     client->nb_requests++;
1392 
1393     req = g_new0(NBDRequestData, 1);
1394     nbd_client_get(client);
1395     req->client = client;
1396     return req;
1397 }
1398 
1399 static void nbd_request_put(NBDRequestData *req)
1400 {
1401     NBDClient *client = req->client;
1402 
1403     if (req->data) {
1404         qemu_vfree(req->data);
1405     }
1406     g_free(req);
1407 
1408     client->nb_requests--;
1409     nbd_client_receive_next_request(client);
1410 
1411     nbd_client_put(client);
1412 }
1413 
1414 static void blk_aio_attached(AioContext *ctx, void *opaque)
1415 {
1416     NBDExport *exp = opaque;
1417     NBDClient *client;
1418 
1419     trace_nbd_blk_aio_attached(exp->name, ctx);
1420 
1421     exp->common.ctx = ctx;
1422 
1423     QTAILQ_FOREACH(client, &exp->clients, next) {
1424         qio_channel_attach_aio_context(client->ioc, ctx);
1425         if (client->recv_coroutine) {
1426             aio_co_schedule(ctx, client->recv_coroutine);
1427         }
1428         if (client->send_coroutine) {
1429             aio_co_schedule(ctx, client->send_coroutine);
1430         }
1431     }
1432 }
1433 
1434 static void blk_aio_detach(void *opaque)
1435 {
1436     NBDExport *exp = opaque;
1437     NBDClient *client;
1438 
1439     trace_nbd_blk_aio_detach(exp->name, exp->common.ctx);
1440 
1441     QTAILQ_FOREACH(client, &exp->clients, next) {
1442         qio_channel_detach_aio_context(client->ioc);
1443     }
1444 
1445     exp->common.ctx = NULL;
1446 }
1447 
1448 static void nbd_eject_notifier(Notifier *n, void *data)
1449 {
1450     NBDExport *exp = container_of(n, NBDExport, eject_notifier);
1451 
1452     blk_exp_request_shutdown(&exp->common);
1453 }
1454 
1455 void nbd_export_set_on_eject_blk(BlockExport *exp, BlockBackend *blk)
1456 {
1457     NBDExport *nbd_exp = container_of(exp, NBDExport, common);
1458     assert(exp->drv == &blk_exp_nbd);
1459     assert(nbd_exp->eject_notifier_blk == NULL);
1460 
1461     blk_ref(blk);
1462     nbd_exp->eject_notifier_blk = blk;
1463     nbd_exp->eject_notifier.notify = nbd_eject_notifier;
1464     blk_add_remove_bs_notifier(blk, &nbd_exp->eject_notifier);
1465 }
1466 
1467 static int nbd_export_create(BlockExport *blk_exp, BlockExportOptions *exp_args,
1468                              Error **errp)
1469 {
1470     NBDExport *exp = container_of(blk_exp, NBDExport, common);
1471     BlockExportOptionsNbd *arg = &exp_args->u.nbd;
1472     BlockBackend *blk = blk_exp->blk;
1473     int64_t size;
1474     uint64_t perm, shared_perm;
1475     bool readonly = !exp_args->writable;
1476     bool shared = !exp_args->writable;
1477     int ret;
1478 
1479     assert(exp_args->type == BLOCK_EXPORT_TYPE_NBD);
1480 
1481     if (!nbd_server_is_running()) {
1482         error_setg(errp, "NBD server not running");
1483         return -EINVAL;
1484     }
1485 
1486     if (!arg->has_name) {
1487         arg->name = exp_args->node_name;
1488     }
1489 
1490     if (strlen(arg->name) > NBD_MAX_STRING_SIZE) {
1491         error_setg(errp, "export name '%s' too long", arg->name);
1492         return -EINVAL;
1493     }
1494 
1495     if (arg->description && strlen(arg->description) > NBD_MAX_STRING_SIZE) {
1496         error_setg(errp, "description '%s' too long", arg->description);
1497         return -EINVAL;
1498     }
1499 
1500     if (nbd_export_find(arg->name)) {
1501         error_setg(errp, "NBD server already has export named '%s'", arg->name);
1502         return -EEXIST;
1503     }
1504 
1505     size = blk_getlength(blk);
1506     if (size < 0) {
1507         error_setg_errno(errp, -size,
1508                          "Failed to determine the NBD export's length");
1509         return size;
1510     }
1511 
1512     /* Don't allow resize while the NBD server is running, otherwise we don't
1513      * care what happens with the node. */
1514     blk_get_perm(blk, &perm, &shared_perm);
1515     ret = blk_set_perm(blk, perm, shared_perm & ~BLK_PERM_RESIZE, errp);
1516     if (ret < 0) {
1517         return ret;
1518     }
1519 
1520     QTAILQ_INIT(&exp->clients);
1521     exp->name = g_strdup(arg->name);
1522     exp->description = g_strdup(arg->description);
1523     exp->nbdflags = (NBD_FLAG_HAS_FLAGS | NBD_FLAG_SEND_FLUSH |
1524                      NBD_FLAG_SEND_FUA | NBD_FLAG_SEND_CACHE);
1525     if (readonly) {
1526         exp->nbdflags |= NBD_FLAG_READ_ONLY;
1527         if (shared) {
1528             exp->nbdflags |= NBD_FLAG_CAN_MULTI_CONN;
1529         }
1530     } else {
1531         exp->nbdflags |= (NBD_FLAG_SEND_TRIM | NBD_FLAG_SEND_WRITE_ZEROES |
1532                           NBD_FLAG_SEND_FAST_ZERO);
1533     }
1534     exp->size = QEMU_ALIGN_DOWN(size, BDRV_SECTOR_SIZE);
1535 
1536     if (arg->bitmap) {
1537         BlockDriverState *bs = blk_bs(blk);
1538         BdrvDirtyBitmap *bm = NULL;
1539 
1540         while (bs) {
1541             bm = bdrv_find_dirty_bitmap(bs, arg->bitmap);
1542             if (bm != NULL) {
1543                 break;
1544             }
1545 
1546             bs = bdrv_filter_or_cow_bs(bs);
1547         }
1548 
1549         if (bm == NULL) {
1550             ret = -ENOENT;
1551             error_setg(errp, "Bitmap '%s' is not found", arg->bitmap);
1552             goto fail;
1553         }
1554 
1555         if (bdrv_dirty_bitmap_check(bm, BDRV_BITMAP_ALLOW_RO, errp)) {
1556             ret = -EINVAL;
1557             goto fail;
1558         }
1559 
1560         if (readonly && bdrv_is_writable(bs) &&
1561             bdrv_dirty_bitmap_enabled(bm)) {
1562             ret = -EINVAL;
1563             error_setg(errp,
1564                        "Enabled bitmap '%s' incompatible with readonly export",
1565                        arg->bitmap);
1566             goto fail;
1567         }
1568 
1569         bdrv_dirty_bitmap_set_busy(bm, true);
1570         exp->export_bitmap = bm;
1571         assert(strlen(arg->bitmap) <= BDRV_BITMAP_MAX_NAME_SIZE);
1572         exp->export_bitmap_context = g_strdup_printf("qemu:dirty-bitmap:%s",
1573                                                      arg->bitmap);
1574         assert(strlen(exp->export_bitmap_context) < NBD_MAX_STRING_SIZE);
1575     }
1576 
1577     blk_add_aio_context_notifier(blk, blk_aio_attached, blk_aio_detach, exp);
1578 
1579     QTAILQ_INSERT_TAIL(&exports, exp, next);
1580 
1581     return 0;
1582 
1583 fail:
1584     g_free(exp->name);
1585     g_free(exp->description);
1586     return ret;
1587 }
1588 
1589 NBDExport *nbd_export_find(const char *name)
1590 {
1591     NBDExport *exp;
1592     QTAILQ_FOREACH(exp, &exports, next) {
1593         if (strcmp(name, exp->name) == 0) {
1594             return exp;
1595         }
1596     }
1597 
1598     return NULL;
1599 }
1600 
1601 AioContext *
1602 nbd_export_aio_context(NBDExport *exp)
1603 {
1604     return exp->common.ctx;
1605 }
1606 
1607 static void nbd_export_request_shutdown(BlockExport *blk_exp)
1608 {
1609     NBDExport *exp = container_of(blk_exp, NBDExport, common);
1610     NBDClient *client, *next;
1611 
1612     blk_exp_ref(&exp->common);
1613     /*
1614      * TODO: Should we expand QMP NbdServerRemoveNode enum to allow a
1615      * close mode that stops advertising the export to new clients but
1616      * still permits existing clients to run to completion? Because of
1617      * that possibility, nbd_export_close() can be called more than
1618      * once on an export.
1619      */
1620     QTAILQ_FOREACH_SAFE(client, &exp->clients, next, next) {
1621         client_close(client, true);
1622     }
1623     if (exp->name) {
1624         g_free(exp->name);
1625         exp->name = NULL;
1626         QTAILQ_REMOVE(&exports, exp, next);
1627     }
1628     blk_exp_unref(&exp->common);
1629 }
1630 
1631 static void nbd_export_delete(BlockExport *blk_exp)
1632 {
1633     NBDExport *exp = container_of(blk_exp, NBDExport, common);
1634 
1635     assert(exp->name == NULL);
1636     assert(QTAILQ_EMPTY(&exp->clients));
1637 
1638     g_free(exp->description);
1639     exp->description = NULL;
1640 
1641     if (exp->common.blk) {
1642         if (exp->eject_notifier_blk) {
1643             notifier_remove(&exp->eject_notifier);
1644             blk_unref(exp->eject_notifier_blk);
1645         }
1646         blk_remove_aio_context_notifier(exp->common.blk, blk_aio_attached,
1647                                         blk_aio_detach, exp);
1648     }
1649 
1650     if (exp->export_bitmap) {
1651         bdrv_dirty_bitmap_set_busy(exp->export_bitmap, false);
1652         g_free(exp->export_bitmap_context);
1653     }
1654 }
1655 
1656 const BlockExportDriver blk_exp_nbd = {
1657     .type               = BLOCK_EXPORT_TYPE_NBD,
1658     .instance_size      = sizeof(NBDExport),
1659     .create             = nbd_export_create,
1660     .delete             = nbd_export_delete,
1661     .request_shutdown   = nbd_export_request_shutdown,
1662 };
1663 
1664 static int coroutine_fn nbd_co_send_iov(NBDClient *client, struct iovec *iov,
1665                                         unsigned niov, Error **errp)
1666 {
1667     int ret;
1668 
1669     g_assert(qemu_in_coroutine());
1670     qemu_co_mutex_lock(&client->send_lock);
1671     client->send_coroutine = qemu_coroutine_self();
1672 
1673     ret = qio_channel_writev_all(client->ioc, iov, niov, errp) < 0 ? -EIO : 0;
1674 
1675     client->send_coroutine = NULL;
1676     qemu_co_mutex_unlock(&client->send_lock);
1677 
1678     return ret;
1679 }
1680 
1681 static inline void set_be_simple_reply(NBDSimpleReply *reply, uint64_t error,
1682                                        uint64_t handle)
1683 {
1684     stl_be_p(&reply->magic, NBD_SIMPLE_REPLY_MAGIC);
1685     stl_be_p(&reply->error, error);
1686     stq_be_p(&reply->handle, handle);
1687 }
1688 
1689 static int nbd_co_send_simple_reply(NBDClient *client,
1690                                     uint64_t handle,
1691                                     uint32_t error,
1692                                     void *data,
1693                                     size_t len,
1694                                     Error **errp)
1695 {
1696     NBDSimpleReply reply;
1697     int nbd_err = system_errno_to_nbd_errno(error);
1698     struct iovec iov[] = {
1699         {.iov_base = &reply, .iov_len = sizeof(reply)},
1700         {.iov_base = data, .iov_len = len}
1701     };
1702 
1703     trace_nbd_co_send_simple_reply(handle, nbd_err, nbd_err_lookup(nbd_err),
1704                                    len);
1705     set_be_simple_reply(&reply, nbd_err, handle);
1706 
1707     return nbd_co_send_iov(client, iov, len ? 2 : 1, errp);
1708 }
1709 
1710 static inline void set_be_chunk(NBDStructuredReplyChunk *chunk, uint16_t flags,
1711                                 uint16_t type, uint64_t handle, uint32_t length)
1712 {
1713     stl_be_p(&chunk->magic, NBD_STRUCTURED_REPLY_MAGIC);
1714     stw_be_p(&chunk->flags, flags);
1715     stw_be_p(&chunk->type, type);
1716     stq_be_p(&chunk->handle, handle);
1717     stl_be_p(&chunk->length, length);
1718 }
1719 
1720 static int coroutine_fn nbd_co_send_structured_done(NBDClient *client,
1721                                                     uint64_t handle,
1722                                                     Error **errp)
1723 {
1724     NBDStructuredReplyChunk chunk;
1725     struct iovec iov[] = {
1726         {.iov_base = &chunk, .iov_len = sizeof(chunk)},
1727     };
1728 
1729     trace_nbd_co_send_structured_done(handle);
1730     set_be_chunk(&chunk, NBD_REPLY_FLAG_DONE, NBD_REPLY_TYPE_NONE, handle, 0);
1731 
1732     return nbd_co_send_iov(client, iov, 1, errp);
1733 }
1734 
1735 static int coroutine_fn nbd_co_send_structured_read(NBDClient *client,
1736                                                     uint64_t handle,
1737                                                     uint64_t offset,
1738                                                     void *data,
1739                                                     size_t size,
1740                                                     bool final,
1741                                                     Error **errp)
1742 {
1743     NBDStructuredReadData chunk;
1744     struct iovec iov[] = {
1745         {.iov_base = &chunk, .iov_len = sizeof(chunk)},
1746         {.iov_base = data, .iov_len = size}
1747     };
1748 
1749     assert(size);
1750     trace_nbd_co_send_structured_read(handle, offset, data, size);
1751     set_be_chunk(&chunk.h, final ? NBD_REPLY_FLAG_DONE : 0,
1752                  NBD_REPLY_TYPE_OFFSET_DATA, handle,
1753                  sizeof(chunk) - sizeof(chunk.h) + size);
1754     stq_be_p(&chunk.offset, offset);
1755 
1756     return nbd_co_send_iov(client, iov, 2, errp);
1757 }
1758 
1759 static int coroutine_fn nbd_co_send_structured_error(NBDClient *client,
1760                                                      uint64_t handle,
1761                                                      uint32_t error,
1762                                                      const char *msg,
1763                                                      Error **errp)
1764 {
1765     NBDStructuredError chunk;
1766     int nbd_err = system_errno_to_nbd_errno(error);
1767     struct iovec iov[] = {
1768         {.iov_base = &chunk, .iov_len = sizeof(chunk)},
1769         {.iov_base = (char *)msg, .iov_len = msg ? strlen(msg) : 0},
1770     };
1771 
1772     assert(nbd_err);
1773     trace_nbd_co_send_structured_error(handle, nbd_err,
1774                                        nbd_err_lookup(nbd_err), msg ? msg : "");
1775     set_be_chunk(&chunk.h, NBD_REPLY_FLAG_DONE, NBD_REPLY_TYPE_ERROR, handle,
1776                  sizeof(chunk) - sizeof(chunk.h) + iov[1].iov_len);
1777     stl_be_p(&chunk.error, nbd_err);
1778     stw_be_p(&chunk.message_length, iov[1].iov_len);
1779 
1780     return nbd_co_send_iov(client, iov, 1 + !!iov[1].iov_len, errp);
1781 }
1782 
1783 /* Do a sparse read and send the structured reply to the client.
1784  * Returns -errno if sending fails. bdrv_block_status_above() failure is
1785  * reported to the client, at which point this function succeeds.
1786  */
1787 static int coroutine_fn nbd_co_send_sparse_read(NBDClient *client,
1788                                                 uint64_t handle,
1789                                                 uint64_t offset,
1790                                                 uint8_t *data,
1791                                                 size_t size,
1792                                                 Error **errp)
1793 {
1794     int ret = 0;
1795     NBDExport *exp = client->exp;
1796     size_t progress = 0;
1797 
1798     while (progress < size) {
1799         int64_t pnum;
1800         int status = bdrv_block_status_above(blk_bs(exp->common.blk), NULL,
1801                                              offset + progress,
1802                                              size - progress, &pnum, NULL,
1803                                              NULL);
1804         bool final;
1805 
1806         if (status < 0) {
1807             char *msg = g_strdup_printf("unable to check for holes: %s",
1808                                         strerror(-status));
1809 
1810             ret = nbd_co_send_structured_error(client, handle, -status, msg,
1811                                                errp);
1812             g_free(msg);
1813             return ret;
1814         }
1815         assert(pnum && pnum <= size - progress);
1816         final = progress + pnum == size;
1817         if (status & BDRV_BLOCK_ZERO) {
1818             NBDStructuredReadHole chunk;
1819             struct iovec iov[] = {
1820                 {.iov_base = &chunk, .iov_len = sizeof(chunk)},
1821             };
1822 
1823             trace_nbd_co_send_structured_read_hole(handle, offset + progress,
1824                                                    pnum);
1825             set_be_chunk(&chunk.h, final ? NBD_REPLY_FLAG_DONE : 0,
1826                          NBD_REPLY_TYPE_OFFSET_HOLE,
1827                          handle, sizeof(chunk) - sizeof(chunk.h));
1828             stq_be_p(&chunk.offset, offset + progress);
1829             stl_be_p(&chunk.length, pnum);
1830             ret = nbd_co_send_iov(client, iov, 1, errp);
1831         } else {
1832             ret = blk_pread(exp->common.blk, offset + progress,
1833                             data + progress, pnum);
1834             if (ret < 0) {
1835                 error_setg_errno(errp, -ret, "reading from file failed");
1836                 break;
1837             }
1838             ret = nbd_co_send_structured_read(client, handle, offset + progress,
1839                                               data + progress, pnum, final,
1840                                               errp);
1841         }
1842 
1843         if (ret < 0) {
1844             break;
1845         }
1846         progress += pnum;
1847     }
1848     return ret;
1849 }
1850 
1851 typedef struct NBDExtentArray {
1852     NBDExtent *extents;
1853     unsigned int nb_alloc;
1854     unsigned int count;
1855     uint64_t total_length;
1856     bool can_add;
1857     bool converted_to_be;
1858 } NBDExtentArray;
1859 
1860 static NBDExtentArray *nbd_extent_array_new(unsigned int nb_alloc)
1861 {
1862     NBDExtentArray *ea = g_new0(NBDExtentArray, 1);
1863 
1864     ea->nb_alloc = nb_alloc;
1865     ea->extents = g_new(NBDExtent, nb_alloc);
1866     ea->can_add = true;
1867 
1868     return ea;
1869 }
1870 
1871 static void nbd_extent_array_free(NBDExtentArray *ea)
1872 {
1873     g_free(ea->extents);
1874     g_free(ea);
1875 }
1876 G_DEFINE_AUTOPTR_CLEANUP_FUNC(NBDExtentArray, nbd_extent_array_free);
1877 
1878 /* Further modifications of the array after conversion are abandoned */
1879 static void nbd_extent_array_convert_to_be(NBDExtentArray *ea)
1880 {
1881     int i;
1882 
1883     assert(!ea->converted_to_be);
1884     ea->can_add = false;
1885     ea->converted_to_be = true;
1886 
1887     for (i = 0; i < ea->count; i++) {
1888         ea->extents[i].flags = cpu_to_be32(ea->extents[i].flags);
1889         ea->extents[i].length = cpu_to_be32(ea->extents[i].length);
1890     }
1891 }
1892 
1893 /*
1894  * Add extent to NBDExtentArray. If extent can't be added (no available space),
1895  * return -1.
1896  * For safety, when returning -1 for the first time, .can_add is set to false,
1897  * further call to nbd_extent_array_add() will crash.
1898  * (to avoid the situation, when after failing to add an extent (returned -1),
1899  * user miss this failure and add another extent, which is successfully added
1900  * (array is full, but new extent may be squashed into the last one), then we
1901  * have invalid array with skipped extent)
1902  */
1903 static int nbd_extent_array_add(NBDExtentArray *ea,
1904                                 uint32_t length, uint32_t flags)
1905 {
1906     assert(ea->can_add);
1907 
1908     if (!length) {
1909         return 0;
1910     }
1911 
1912     /* Extend previous extent if flags are the same */
1913     if (ea->count > 0 && flags == ea->extents[ea->count - 1].flags) {
1914         uint64_t sum = (uint64_t)length + ea->extents[ea->count - 1].length;
1915 
1916         if (sum <= UINT32_MAX) {
1917             ea->extents[ea->count - 1].length = sum;
1918             ea->total_length += length;
1919             return 0;
1920         }
1921     }
1922 
1923     if (ea->count >= ea->nb_alloc) {
1924         ea->can_add = false;
1925         return -1;
1926     }
1927 
1928     ea->total_length += length;
1929     ea->extents[ea->count] = (NBDExtent) {.length = length, .flags = flags};
1930     ea->count++;
1931 
1932     return 0;
1933 }
1934 
1935 static int blockstatus_to_extents(BlockDriverState *bs, uint64_t offset,
1936                                   uint64_t bytes, NBDExtentArray *ea)
1937 {
1938     while (bytes) {
1939         uint32_t flags;
1940         int64_t num;
1941         int ret = bdrv_block_status_above(bs, NULL, offset, bytes, &num,
1942                                           NULL, NULL);
1943 
1944         if (ret < 0) {
1945             return ret;
1946         }
1947 
1948         flags = (ret & BDRV_BLOCK_ALLOCATED ? 0 : NBD_STATE_HOLE) |
1949                 (ret & BDRV_BLOCK_ZERO      ? NBD_STATE_ZERO : 0);
1950 
1951         if (nbd_extent_array_add(ea, num, flags) < 0) {
1952             return 0;
1953         }
1954 
1955         offset += num;
1956         bytes -= num;
1957     }
1958 
1959     return 0;
1960 }
1961 
1962 /*
1963  * nbd_co_send_extents
1964  *
1965  * @ea is converted to BE by the function
1966  * @last controls whether NBD_REPLY_FLAG_DONE is sent.
1967  */
1968 static int nbd_co_send_extents(NBDClient *client, uint64_t handle,
1969                                NBDExtentArray *ea,
1970                                bool last, uint32_t context_id, Error **errp)
1971 {
1972     NBDStructuredMeta chunk;
1973     struct iovec iov[] = {
1974         {.iov_base = &chunk, .iov_len = sizeof(chunk)},
1975         {.iov_base = ea->extents, .iov_len = ea->count * sizeof(ea->extents[0])}
1976     };
1977 
1978     nbd_extent_array_convert_to_be(ea);
1979 
1980     trace_nbd_co_send_extents(handle, ea->count, context_id, ea->total_length,
1981                               last);
1982     set_be_chunk(&chunk.h, last ? NBD_REPLY_FLAG_DONE : 0,
1983                  NBD_REPLY_TYPE_BLOCK_STATUS,
1984                  handle, sizeof(chunk) - sizeof(chunk.h) + iov[1].iov_len);
1985     stl_be_p(&chunk.context_id, context_id);
1986 
1987     return nbd_co_send_iov(client, iov, 2, errp);
1988 }
1989 
1990 /* Get block status from the exported device and send it to the client */
1991 static int nbd_co_send_block_status(NBDClient *client, uint64_t handle,
1992                                     BlockDriverState *bs, uint64_t offset,
1993                                     uint32_t length, bool dont_fragment,
1994                                     bool last, uint32_t context_id,
1995                                     Error **errp)
1996 {
1997     int ret;
1998     unsigned int nb_extents = dont_fragment ? 1 : NBD_MAX_BLOCK_STATUS_EXTENTS;
1999     g_autoptr(NBDExtentArray) ea = nbd_extent_array_new(nb_extents);
2000 
2001     ret = blockstatus_to_extents(bs, offset, length, ea);
2002     if (ret < 0) {
2003         return nbd_co_send_structured_error(
2004                 client, handle, -ret, "can't get block status", errp);
2005     }
2006 
2007     return nbd_co_send_extents(client, handle, ea, last, context_id, errp);
2008 }
2009 
2010 /* Populate @ea from a dirty bitmap. */
2011 static void bitmap_to_extents(BdrvDirtyBitmap *bitmap,
2012                               uint64_t offset, uint64_t length,
2013                               NBDExtentArray *es)
2014 {
2015     int64_t start, dirty_start, dirty_count;
2016     int64_t end = offset + length;
2017     bool full = false;
2018 
2019     bdrv_dirty_bitmap_lock(bitmap);
2020 
2021     for (start = offset;
2022          bdrv_dirty_bitmap_next_dirty_area(bitmap, start, end, INT32_MAX,
2023                                            &dirty_start, &dirty_count);
2024          start = dirty_start + dirty_count)
2025     {
2026         if ((nbd_extent_array_add(es, dirty_start - start, 0) < 0) ||
2027             (nbd_extent_array_add(es, dirty_count, NBD_STATE_DIRTY) < 0))
2028         {
2029             full = true;
2030             break;
2031         }
2032     }
2033 
2034     if (!full) {
2035         /* last non dirty extent */
2036         nbd_extent_array_add(es, end - start, 0);
2037     }
2038 
2039     bdrv_dirty_bitmap_unlock(bitmap);
2040 }
2041 
2042 static int nbd_co_send_bitmap(NBDClient *client, uint64_t handle,
2043                               BdrvDirtyBitmap *bitmap, uint64_t offset,
2044                               uint32_t length, bool dont_fragment, bool last,
2045                               uint32_t context_id, Error **errp)
2046 {
2047     unsigned int nb_extents = dont_fragment ? 1 : NBD_MAX_BLOCK_STATUS_EXTENTS;
2048     g_autoptr(NBDExtentArray) ea = nbd_extent_array_new(nb_extents);
2049 
2050     bitmap_to_extents(bitmap, offset, length, ea);
2051 
2052     return nbd_co_send_extents(client, handle, ea, last, context_id, errp);
2053 }
2054 
2055 /* nbd_co_receive_request
2056  * Collect a client request. Return 0 if request looks valid, -EIO to drop
2057  * connection right away, and any other negative value to report an error to
2058  * the client (although the caller may still need to disconnect after reporting
2059  * the error).
2060  */
2061 static int nbd_co_receive_request(NBDRequestData *req, NBDRequest *request,
2062                                   Error **errp)
2063 {
2064     NBDClient *client = req->client;
2065     int valid_flags;
2066 
2067     g_assert(qemu_in_coroutine());
2068     assert(client->recv_coroutine == qemu_coroutine_self());
2069     if (nbd_receive_request(client->ioc, request, errp) < 0) {
2070         return -EIO;
2071     }
2072 
2073     trace_nbd_co_receive_request_decode_type(request->handle, request->type,
2074                                              nbd_cmd_lookup(request->type));
2075 
2076     if (request->type != NBD_CMD_WRITE) {
2077         /* No payload, we are ready to read the next request.  */
2078         req->complete = true;
2079     }
2080 
2081     if (request->type == NBD_CMD_DISC) {
2082         /* Special case: we're going to disconnect without a reply,
2083          * whether or not flags, from, or len are bogus */
2084         return -EIO;
2085     }
2086 
2087     if (request->type == NBD_CMD_READ || request->type == NBD_CMD_WRITE ||
2088         request->type == NBD_CMD_CACHE)
2089     {
2090         if (request->len > NBD_MAX_BUFFER_SIZE) {
2091             error_setg(errp, "len (%" PRIu32" ) is larger than max len (%u)",
2092                        request->len, NBD_MAX_BUFFER_SIZE);
2093             return -EINVAL;
2094         }
2095 
2096         if (request->type != NBD_CMD_CACHE) {
2097             req->data = blk_try_blockalign(client->exp->common.blk,
2098                                            request->len);
2099             if (req->data == NULL) {
2100                 error_setg(errp, "No memory");
2101                 return -ENOMEM;
2102             }
2103         }
2104     }
2105 
2106     if (request->type == NBD_CMD_WRITE) {
2107         if (nbd_read(client->ioc, req->data, request->len, "CMD_WRITE data",
2108                      errp) < 0)
2109         {
2110             return -EIO;
2111         }
2112         req->complete = true;
2113 
2114         trace_nbd_co_receive_request_payload_received(request->handle,
2115                                                       request->len);
2116     }
2117 
2118     /* Sanity checks. */
2119     if (client->exp->nbdflags & NBD_FLAG_READ_ONLY &&
2120         (request->type == NBD_CMD_WRITE ||
2121          request->type == NBD_CMD_WRITE_ZEROES ||
2122          request->type == NBD_CMD_TRIM)) {
2123         error_setg(errp, "Export is read-only");
2124         return -EROFS;
2125     }
2126     if (request->from > client->exp->size ||
2127         request->len > client->exp->size - request->from) {
2128         error_setg(errp, "operation past EOF; From: %" PRIu64 ", Len: %" PRIu32
2129                    ", Size: %" PRIu64, request->from, request->len,
2130                    client->exp->size);
2131         return (request->type == NBD_CMD_WRITE ||
2132                 request->type == NBD_CMD_WRITE_ZEROES) ? -ENOSPC : -EINVAL;
2133     }
2134     if (client->check_align && !QEMU_IS_ALIGNED(request->from | request->len,
2135                                                 client->check_align)) {
2136         /*
2137          * The block layer gracefully handles unaligned requests, but
2138          * it's still worth tracing client non-compliance
2139          */
2140         trace_nbd_co_receive_align_compliance(nbd_cmd_lookup(request->type),
2141                                               request->from,
2142                                               request->len,
2143                                               client->check_align);
2144     }
2145     valid_flags = NBD_CMD_FLAG_FUA;
2146     if (request->type == NBD_CMD_READ && client->structured_reply) {
2147         valid_flags |= NBD_CMD_FLAG_DF;
2148     } else if (request->type == NBD_CMD_WRITE_ZEROES) {
2149         valid_flags |= NBD_CMD_FLAG_NO_HOLE | NBD_CMD_FLAG_FAST_ZERO;
2150     } else if (request->type == NBD_CMD_BLOCK_STATUS) {
2151         valid_flags |= NBD_CMD_FLAG_REQ_ONE;
2152     }
2153     if (request->flags & ~valid_flags) {
2154         error_setg(errp, "unsupported flags for command %s (got 0x%x)",
2155                    nbd_cmd_lookup(request->type), request->flags);
2156         return -EINVAL;
2157     }
2158 
2159     return 0;
2160 }
2161 
2162 /* Send simple reply without a payload, or a structured error
2163  * @error_msg is ignored if @ret >= 0
2164  * Returns 0 if connection is still live, -errno on failure to talk to client
2165  */
2166 static coroutine_fn int nbd_send_generic_reply(NBDClient *client,
2167                                                uint64_t handle,
2168                                                int ret,
2169                                                const char *error_msg,
2170                                                Error **errp)
2171 {
2172     if (client->structured_reply && ret < 0) {
2173         return nbd_co_send_structured_error(client, handle, -ret, error_msg,
2174                                             errp);
2175     } else {
2176         return nbd_co_send_simple_reply(client, handle, ret < 0 ? -ret : 0,
2177                                         NULL, 0, errp);
2178     }
2179 }
2180 
2181 /* Handle NBD_CMD_READ request.
2182  * Return -errno if sending fails. Other errors are reported directly to the
2183  * client as an error reply. */
2184 static coroutine_fn int nbd_do_cmd_read(NBDClient *client, NBDRequest *request,
2185                                         uint8_t *data, Error **errp)
2186 {
2187     int ret;
2188     NBDExport *exp = client->exp;
2189 
2190     assert(request->type == NBD_CMD_READ);
2191 
2192     /* XXX: NBD Protocol only documents use of FUA with WRITE */
2193     if (request->flags & NBD_CMD_FLAG_FUA) {
2194         ret = blk_co_flush(exp->common.blk);
2195         if (ret < 0) {
2196             return nbd_send_generic_reply(client, request->handle, ret,
2197                                           "flush failed", errp);
2198         }
2199     }
2200 
2201     if (client->structured_reply && !(request->flags & NBD_CMD_FLAG_DF) &&
2202         request->len)
2203     {
2204         return nbd_co_send_sparse_read(client, request->handle, request->from,
2205                                        data, request->len, errp);
2206     }
2207 
2208     ret = blk_pread(exp->common.blk, request->from, data, request->len);
2209     if (ret < 0) {
2210         return nbd_send_generic_reply(client, request->handle, ret,
2211                                       "reading from file failed", errp);
2212     }
2213 
2214     if (client->structured_reply) {
2215         if (request->len) {
2216             return nbd_co_send_structured_read(client, request->handle,
2217                                                request->from, data,
2218                                                request->len, true, errp);
2219         } else {
2220             return nbd_co_send_structured_done(client, request->handle, errp);
2221         }
2222     } else {
2223         return nbd_co_send_simple_reply(client, request->handle, 0,
2224                                         data, request->len, errp);
2225     }
2226 }
2227 
2228 /*
2229  * nbd_do_cmd_cache
2230  *
2231  * Handle NBD_CMD_CACHE request.
2232  * Return -errno if sending fails. Other errors are reported directly to the
2233  * client as an error reply.
2234  */
2235 static coroutine_fn int nbd_do_cmd_cache(NBDClient *client, NBDRequest *request,
2236                                          Error **errp)
2237 {
2238     int ret;
2239     NBDExport *exp = client->exp;
2240 
2241     assert(request->type == NBD_CMD_CACHE);
2242 
2243     ret = blk_co_preadv(exp->common.blk, request->from, request->len,
2244                         NULL, BDRV_REQ_COPY_ON_READ | BDRV_REQ_PREFETCH);
2245 
2246     return nbd_send_generic_reply(client, request->handle, ret,
2247                                   "caching data failed", errp);
2248 }
2249 
2250 /* Handle NBD request.
2251  * Return -errno if sending fails. Other errors are reported directly to the
2252  * client as an error reply. */
2253 static coroutine_fn int nbd_handle_request(NBDClient *client,
2254                                            NBDRequest *request,
2255                                            uint8_t *data, Error **errp)
2256 {
2257     int ret;
2258     int flags;
2259     NBDExport *exp = client->exp;
2260     char *msg;
2261 
2262     switch (request->type) {
2263     case NBD_CMD_CACHE:
2264         return nbd_do_cmd_cache(client, request, errp);
2265 
2266     case NBD_CMD_READ:
2267         return nbd_do_cmd_read(client, request, data, errp);
2268 
2269     case NBD_CMD_WRITE:
2270         flags = 0;
2271         if (request->flags & NBD_CMD_FLAG_FUA) {
2272             flags |= BDRV_REQ_FUA;
2273         }
2274         ret = blk_pwrite(exp->common.blk, request->from, data, request->len,
2275                          flags);
2276         return nbd_send_generic_reply(client, request->handle, ret,
2277                                       "writing to file failed", errp);
2278 
2279     case NBD_CMD_WRITE_ZEROES:
2280         flags = 0;
2281         if (request->flags & NBD_CMD_FLAG_FUA) {
2282             flags |= BDRV_REQ_FUA;
2283         }
2284         if (!(request->flags & NBD_CMD_FLAG_NO_HOLE)) {
2285             flags |= BDRV_REQ_MAY_UNMAP;
2286         }
2287         if (request->flags & NBD_CMD_FLAG_FAST_ZERO) {
2288             flags |= BDRV_REQ_NO_FALLBACK;
2289         }
2290         ret = 0;
2291         /* FIXME simplify this when blk_pwrite_zeroes switches to 64-bit */
2292         while (ret >= 0 && request->len) {
2293             int align = client->check_align ?: 1;
2294             int len = MIN(request->len, QEMU_ALIGN_DOWN(BDRV_REQUEST_MAX_BYTES,
2295                                                         align));
2296             ret = blk_pwrite_zeroes(exp->common.blk, request->from, len, flags);
2297             request->len -= len;
2298             request->from += len;
2299         }
2300         return nbd_send_generic_reply(client, request->handle, ret,
2301                                       "writing to file failed", errp);
2302 
2303     case NBD_CMD_DISC:
2304         /* unreachable, thanks to special case in nbd_co_receive_request() */
2305         abort();
2306 
2307     case NBD_CMD_FLUSH:
2308         ret = blk_co_flush(exp->common.blk);
2309         return nbd_send_generic_reply(client, request->handle, ret,
2310                                       "flush failed", errp);
2311 
2312     case NBD_CMD_TRIM:
2313         ret = 0;
2314         /* FIXME simplify this when blk_co_pdiscard switches to 64-bit */
2315         while (ret >= 0 && request->len) {
2316             int align = client->check_align ?: 1;
2317             int len = MIN(request->len, QEMU_ALIGN_DOWN(BDRV_REQUEST_MAX_BYTES,
2318                                                         align));
2319             ret = blk_co_pdiscard(exp->common.blk, request->from, len);
2320             request->len -= len;
2321             request->from += len;
2322         }
2323         if (ret >= 0 && request->flags & NBD_CMD_FLAG_FUA) {
2324             ret = blk_co_flush(exp->common.blk);
2325         }
2326         return nbd_send_generic_reply(client, request->handle, ret,
2327                                       "discard failed", errp);
2328 
2329     case NBD_CMD_BLOCK_STATUS:
2330         if (!request->len) {
2331             return nbd_send_generic_reply(client, request->handle, -EINVAL,
2332                                           "need non-zero length", errp);
2333         }
2334         if (client->export_meta.valid &&
2335             (client->export_meta.base_allocation ||
2336              client->export_meta.bitmap))
2337         {
2338             bool dont_fragment = request->flags & NBD_CMD_FLAG_REQ_ONE;
2339 
2340             if (client->export_meta.base_allocation) {
2341                 ret = nbd_co_send_block_status(client, request->handle,
2342                                                blk_bs(exp->common.blk),
2343                                                request->from,
2344                                                request->len, dont_fragment,
2345                                                !client->export_meta.bitmap,
2346                                                NBD_META_ID_BASE_ALLOCATION,
2347                                                errp);
2348                 if (ret < 0) {
2349                     return ret;
2350                 }
2351             }
2352 
2353             if (client->export_meta.bitmap) {
2354                 ret = nbd_co_send_bitmap(client, request->handle,
2355                                          client->exp->export_bitmap,
2356                                          request->from, request->len,
2357                                          dont_fragment,
2358                                          true, NBD_META_ID_DIRTY_BITMAP, errp);
2359                 if (ret < 0) {
2360                     return ret;
2361                 }
2362             }
2363 
2364             return 0;
2365         } else {
2366             return nbd_send_generic_reply(client, request->handle, -EINVAL,
2367                                           "CMD_BLOCK_STATUS not negotiated",
2368                                           errp);
2369         }
2370 
2371     default:
2372         msg = g_strdup_printf("invalid request type (%" PRIu32 ") received",
2373                               request->type);
2374         ret = nbd_send_generic_reply(client, request->handle, -EINVAL, msg,
2375                                      errp);
2376         g_free(msg);
2377         return ret;
2378     }
2379 }
2380 
2381 /* Owns a reference to the NBDClient passed as opaque.  */
2382 static coroutine_fn void nbd_trip(void *opaque)
2383 {
2384     NBDClient *client = opaque;
2385     NBDRequestData *req;
2386     NBDRequest request = { 0 };    /* GCC thinks it can be used uninitialized */
2387     int ret;
2388     Error *local_err = NULL;
2389 
2390     trace_nbd_trip();
2391     if (client->closing) {
2392         nbd_client_put(client);
2393         return;
2394     }
2395 
2396     req = nbd_request_get(client);
2397     ret = nbd_co_receive_request(req, &request, &local_err);
2398     client->recv_coroutine = NULL;
2399 
2400     if (client->closing) {
2401         /*
2402          * The client may be closed when we are blocked in
2403          * nbd_co_receive_request()
2404          */
2405         goto done;
2406     }
2407 
2408     nbd_client_receive_next_request(client);
2409     if (ret == -EIO) {
2410         goto disconnect;
2411     }
2412 
2413     if (ret < 0) {
2414         /* It wans't -EIO, so, according to nbd_co_receive_request()
2415          * semantics, we should return the error to the client. */
2416         Error *export_err = local_err;
2417 
2418         local_err = NULL;
2419         ret = nbd_send_generic_reply(client, request.handle, -EINVAL,
2420                                      error_get_pretty(export_err), &local_err);
2421         error_free(export_err);
2422     } else {
2423         ret = nbd_handle_request(client, &request, req->data, &local_err);
2424     }
2425     if (ret < 0) {
2426         error_prepend(&local_err, "Failed to send reply: ");
2427         goto disconnect;
2428     }
2429 
2430     /* We must disconnect after NBD_CMD_WRITE if we did not
2431      * read the payload.
2432      */
2433     if (!req->complete) {
2434         error_setg(&local_err, "Request handling failed in intermediate state");
2435         goto disconnect;
2436     }
2437 
2438 done:
2439     nbd_request_put(req);
2440     nbd_client_put(client);
2441     return;
2442 
2443 disconnect:
2444     if (local_err) {
2445         error_reportf_err(local_err, "Disconnect client, due to: ");
2446     }
2447     nbd_request_put(req);
2448     client_close(client, true);
2449     nbd_client_put(client);
2450 }
2451 
2452 static void nbd_client_receive_next_request(NBDClient *client)
2453 {
2454     if (!client->recv_coroutine && client->nb_requests < MAX_NBD_REQUESTS) {
2455         nbd_client_get(client);
2456         client->recv_coroutine = qemu_coroutine_create(nbd_trip, client);
2457         aio_co_schedule(client->exp->common.ctx, client->recv_coroutine);
2458     }
2459 }
2460 
2461 static coroutine_fn void nbd_co_client_start(void *opaque)
2462 {
2463     NBDClient *client = opaque;
2464     Error *local_err = NULL;
2465 
2466     qemu_co_mutex_init(&client->send_lock);
2467 
2468     if (nbd_negotiate(client, &local_err)) {
2469         if (local_err) {
2470             error_report_err(local_err);
2471         }
2472         client_close(client, false);
2473         return;
2474     }
2475 
2476     nbd_client_receive_next_request(client);
2477 }
2478 
2479 /*
2480  * Create a new client listener using the given channel @sioc.
2481  * Begin servicing it in a coroutine.  When the connection closes, call
2482  * @close_fn with an indication of whether the client completed negotiation.
2483  */
2484 void nbd_client_new(QIOChannelSocket *sioc,
2485                     QCryptoTLSCreds *tlscreds,
2486                     const char *tlsauthz,
2487                     void (*close_fn)(NBDClient *, bool))
2488 {
2489     NBDClient *client;
2490     Coroutine *co;
2491 
2492     client = g_new0(NBDClient, 1);
2493     client->refcount = 1;
2494     client->tlscreds = tlscreds;
2495     if (tlscreds) {
2496         object_ref(OBJECT(client->tlscreds));
2497     }
2498     client->tlsauthz = g_strdup(tlsauthz);
2499     client->sioc = sioc;
2500     object_ref(OBJECT(client->sioc));
2501     client->ioc = QIO_CHANNEL(sioc);
2502     object_ref(OBJECT(client->ioc));
2503     client->close_fn = close_fn;
2504 
2505     co = qemu_coroutine_create(nbd_co_client_start, client);
2506     qemu_coroutine_enter(co);
2507 }
2508