nbd-client.c 24.4 KB
Newer Older
M
Marc-André Lureau 已提交
1 2 3
/*
 * QEMU Block driver for  NBD
 *
4
 * Copyright (C) 2016 Red Hat, Inc.
M
Marc-André Lureau 已提交
5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29
 * Copyright (C) 2008 Bull S.A.S.
 *     Author: Laurent Vivier <Laurent.Vivier@bull.net>
 *
 * Some parts:
 *    Copyright (C) 2007 Anthony Liguori <anthony@codemonkey.ws>
 *
 * Permission is hereby granted, free of charge, to any person obtaining a copy
 * of this software and associated documentation files (the "Software"), to deal
 * in the Software without restriction, including without limitation the rights
 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
 * copies of the Software, and to permit persons to whom the Software is
 * furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
 * THE SOFTWARE.
 */

P
Peter Maydell 已提交
30
#include "qemu/osdep.h"
31
#include "qapi/error.h"
M
Marc-André Lureau 已提交
32 33
#include "nbd-client.h"

34 35
#define HANDLE_TO_INDEX(bs, handle) ((handle) ^ (uint64_t)(intptr_t)(bs))
#define INDEX_TO_HANDLE(bs, index)  ((index)  ^ (uint64_t)(intptr_t)(bs))
M
Marc-André Lureau 已提交
36

37
static void nbd_recv_coroutines_wake_all(NBDClientSession *s)
38 39 40 41
{
    int i;

    for (i = 0; i < MAX_NBD_REQUESTS; i++) {
42 43 44 45
        NBDClientRequest *req = &s->requests[i];

        if (req->coroutine && req->receiving) {
            aio_co_wake(req->coroutine);
46 47 48 49
        }
    }
}

M
Max Reitz 已提交
50
static void nbd_teardown_connection(BlockDriverState *bs)
51
{
52
    NBDClientSession *client = nbd_get_client_session(bs);
M
Max Reitz 已提交
53

54 55 56 57
    if (!client->ioc) { /* Already closed */
        return;
    }

58
    /* finish any pending coroutines */
59 60 61
    qio_channel_shutdown(client->ioc,
                         QIO_CHANNEL_SHUTDOWN_BOTH,
                         NULL);
62
    BDRV_POLL_WHILE(bs, client->read_reply_co);
63

M
Max Reitz 已提交
64
    nbd_client_detach_aio_context(bs);
65 66 67 68
    object_unref(OBJECT(client->sioc));
    client->sioc = NULL;
    object_unref(OBJECT(client->ioc));
    client->ioc = NULL;
69 70
}

71
static coroutine_fn void nbd_read_reply_entry(void *opaque)
M
Marc-André Lureau 已提交
72
{
73
    NBDClientSession *s = opaque;
M
Marc-André Lureau 已提交
74
    uint64_t i;
75
    int ret = 0;
76
    Error *local_err = NULL;
M
Marc-André Lureau 已提交
77

78
    while (!s->quit) {
79
        assert(s->reply.handle == 0);
80 81 82 83
        ret = nbd_receive_reply(s->ioc, &s->reply, &local_err);
        if (ret < 0) {
            error_report_err(local_err);
        }
84
        if (ret <= 0) {
85
            break;
M
Marc-André Lureau 已提交
86 87
        }

88 89 90 91 92
        /* There's no need for a mutex on the receive side, because the
         * handler acts as a synchronization point and ensures that only
         * one coroutine is called until the reply finishes.
         */
        i = HANDLE_TO_INDEX(s, s->reply.handle);
93 94
        if (i >= MAX_NBD_REQUESTS ||
            !s->requests[i].coroutine ||
95
            !s->requests[i].receiving ||
96
            (nbd_reply_is_structured(&s->reply) && !s->info.structured_reply))
97
        {
98 99
            break;
        }
M
Marc-André Lureau 已提交
100

101
        /* We're woken up again by the request itself.  Note that there
102 103 104
         * is no race between yielding and reentering read_reply_co.  This
         * is because:
         *
105
         * - if the request runs on the same AioContext, it is only
106 107
         *   entered after we yield
         *
108
         * - if the request runs on a different AioContext, reentering
109 110 111
         *   read_reply_co happens through a bottom half, which can only
         *   run after we yield.
         */
112
        aio_co_wake(s->requests[i].coroutine);
113
        qemu_coroutine_yield();
M
Marc-André Lureau 已提交
114
    }
115

116
    s->quit = true;
117
    nbd_recv_coroutines_wake_all(s);
118
    s->read_reply_co = NULL;
M
Marc-André Lureau 已提交
119 120
}

M
Max Reitz 已提交
121
static int nbd_co_send_request(BlockDriverState *bs,
122
                               NBDRequest *request,
E
Eric Blake 已提交
123
                               QEMUIOVector *qiov)
M
Marc-André Lureau 已提交
124
{
125
    NBDClientSession *s = nbd_get_client_session(bs);
126
    int rc, i;
M
Marc-André Lureau 已提交
127 128

    qemu_co_mutex_lock(&s->send_mutex);
129 130 131 132
    while (s->in_flight == MAX_NBD_REQUESTS) {
        qemu_co_queue_wait(&s->free_sema, &s->send_mutex);
    }
    s->in_flight++;
B
Bin Wu 已提交
133 134

    for (i = 0; i < MAX_NBD_REQUESTS; i++) {
135
        if (s->requests[i].coroutine == NULL) {
B
Bin Wu 已提交
136 137 138 139
            break;
        }
    }

140
    g_assert(qemu_in_coroutine());
B
Bin Wu 已提交
141
    assert(i < MAX_NBD_REQUESTS);
142 143

    s->requests[i].coroutine = qemu_coroutine_self();
144
    s->requests[i].offset = request->from;
145 146
    s->requests[i].receiving = false;

B
Bin Wu 已提交
147
    request->handle = INDEX_TO_HANDLE(s, i);
148

149
    if (s->quit) {
150 151
        rc = -EIO;
        goto err;
152
    }
153
    if (!s->ioc) {
154 155
        rc = -EPIPE;
        goto err;
156 157
    }

M
Marc-André Lureau 已提交
158
    if (qiov) {
159
        qio_channel_set_cork(s->ioc, true);
160
        rc = nbd_send_request(s->ioc, request);
161
        if (rc >= 0 && !s->quit) {
162 163
            if (qio_channel_writev_all(s->ioc, qiov->iov, qiov->niov,
                                       NULL) < 0) {
M
Marc-André Lureau 已提交
164 165
                rc = -EIO;
            }
166 167
        } else if (rc >= 0) {
            rc = -EIO;
M
Marc-André Lureau 已提交
168
        }
169
        qio_channel_set_cork(s->ioc, false);
M
Marc-André Lureau 已提交
170
    } else {
171
        rc = nbd_send_request(s->ioc, request);
M
Marc-André Lureau 已提交
172
    }
173 174

err:
175 176
    if (rc < 0) {
        s->quit = true;
177 178 179
        s->requests[i].coroutine = NULL;
        s->in_flight--;
        qemu_co_queue_next(&s->free_sema);
180
    }
M
Marc-André Lureau 已提交
181 182 183 184
    qemu_co_mutex_unlock(&s->send_mutex);
    return rc;
}

185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365
static inline uint16_t payload_advance16(uint8_t **payload)
{
    *payload += 2;
    return lduw_be_p(*payload - 2);
}

static inline uint32_t payload_advance32(uint8_t **payload)
{
    *payload += 4;
    return ldl_be_p(*payload - 4);
}

static inline uint64_t payload_advance64(uint8_t **payload)
{
    *payload += 8;
    return ldq_be_p(*payload - 8);
}

static int nbd_parse_offset_hole_payload(NBDStructuredReplyChunk *chunk,
                                         uint8_t *payload, uint64_t orig_offset,
                                         QEMUIOVector *qiov, Error **errp)
{
    uint64_t offset;
    uint32_t hole_size;

    if (chunk->length != sizeof(offset) + sizeof(hole_size)) {
        error_setg(errp, "Protocol error: invalid payload for "
                         "NBD_REPLY_TYPE_OFFSET_HOLE");
        return -EINVAL;
    }

    offset = payload_advance64(&payload);
    hole_size = payload_advance32(&payload);

    if (offset < orig_offset || hole_size > qiov->size ||
        offset > orig_offset + qiov->size - hole_size) {
        error_setg(errp, "Protocol error: server sent chunk exceeding requested"
                         " region");
        return -EINVAL;
    }

    qemu_iovec_memset(qiov, offset - orig_offset, 0, hole_size);

    return 0;
}

/* nbd_parse_error_payload
 * on success @errp contains message describing nbd error reply
 */
static int nbd_parse_error_payload(NBDStructuredReplyChunk *chunk,
                                   uint8_t *payload, int *request_ret,
                                   Error **errp)
{
    uint32_t error;
    uint16_t message_size;

    assert(chunk->type & (1 << 15));

    if (chunk->length < sizeof(error) + sizeof(message_size)) {
        error_setg(errp,
                   "Protocol error: invalid payload for structured error");
        return -EINVAL;
    }

    error = nbd_errno_to_system_errno(payload_advance32(&payload));
    if (error == 0) {
        error_setg(errp, "Protocol error: server sent structured error chunk"
                         "with error = 0");
        return -EINVAL;
    }

    *request_ret = -error;
    message_size = payload_advance16(&payload);

    if (message_size > chunk->length - sizeof(error) - sizeof(message_size)) {
        error_setg(errp, "Protocol error: server sent structured error chunk"
                         "with incorrect message size");
        return -EINVAL;
    }

    /* TODO: Add a trace point to mention the server complaint */

    /* TODO handle ERROR_OFFSET */

    return 0;
}

static int nbd_co_receive_offset_data_payload(NBDClientSession *s,
                                              uint64_t orig_offset,
                                              QEMUIOVector *qiov, Error **errp)
{
    QEMUIOVector sub_qiov;
    uint64_t offset;
    size_t data_size;
    int ret;
    NBDStructuredReplyChunk *chunk = &s->reply.structured;

    assert(nbd_reply_is_structured(&s->reply));

    if (chunk->length < sizeof(offset)) {
        error_setg(errp, "Protocol error: invalid payload for "
                         "NBD_REPLY_TYPE_OFFSET_DATA");
        return -EINVAL;
    }

    if (nbd_read(s->ioc, &offset, sizeof(offset), errp) < 0) {
        return -EIO;
    }
    be64_to_cpus(&offset);

    data_size = chunk->length - sizeof(offset);
    if (offset < orig_offset || data_size > qiov->size ||
        offset > orig_offset + qiov->size - data_size) {
        error_setg(errp, "Protocol error: server sent chunk exceeding requested"
                         " region");
        return -EINVAL;
    }

    qemu_iovec_init(&sub_qiov, qiov->niov);
    qemu_iovec_concat(&sub_qiov, qiov, offset - orig_offset, data_size);
    ret = qio_channel_readv_all(s->ioc, sub_qiov.iov, sub_qiov.niov, errp);
    qemu_iovec_destroy(&sub_qiov);

    return ret < 0 ? -EIO : 0;
}

#define NBD_MAX_MALLOC_PAYLOAD 1000
/* nbd_co_receive_structured_payload
 */
static coroutine_fn int nbd_co_receive_structured_payload(
        NBDClientSession *s, void **payload, Error **errp)
{
    int ret;
    uint32_t len;

    assert(nbd_reply_is_structured(&s->reply));

    len = s->reply.structured.length;

    if (len == 0) {
        return 0;
    }

    if (payload == NULL) {
        error_setg(errp, "Unexpected structured payload");
        return -EINVAL;
    }

    if (len > NBD_MAX_MALLOC_PAYLOAD) {
        error_setg(errp, "Payload too large");
        return -EINVAL;
    }

    *payload = g_new(char, len);
    ret = nbd_read(s->ioc, *payload, len, errp);
    if (ret < 0) {
        g_free(*payload);
        *payload = NULL;
        return ret;
    }

    return 0;
}

/* nbd_co_do_receive_one_chunk
 * for simple reply:
 *   set request_ret to received reply error
 *   if qiov is not NULL: read payload to @qiov
 * for structured reply chunk:
 *   if error chunk: read payload, set @request_ret, do not set @payload
 *   else if offset_data chunk: read payload data to @qiov, do not set @payload
 *   else: read payload to @payload
 *
 * If function fails, @errp contains corresponding error message, and the
 * connection with the server is suspect.  If it returns 0, then the
 * transaction succeeded (although @request_ret may be a negative errno
 * corresponding to the server's error reply), and errp is unchanged.
 */
static coroutine_fn int nbd_co_do_receive_one_chunk(
        NBDClientSession *s, uint64_t handle, bool only_structured,
        int *request_ret, QEMUIOVector *qiov, void **payload, Error **errp)
M
Marc-André Lureau 已提交
366
{
367
    int ret;
368
    int i = HANDLE_TO_INDEX(s, handle);
369 370 371 372 373 374 375
    void *local_payload = NULL;
    NBDStructuredReplyChunk *chunk;

    if (payload) {
        *payload = NULL;
    }
    *request_ret = 0;
M
Marc-André Lureau 已提交
376

377
    /* Wait until we're woken up by nbd_read_reply_entry.  */
378
    s->requests[i].receiving = true;
M
Marc-André Lureau 已提交
379
    qemu_coroutine_yield();
380
    s->requests[i].receiving = false;
381
    if (!s->ioc || s->quit) {
382 383 384 385 386 387 388 389 390 391 392
        error_setg(errp, "Connection closed");
        return -EIO;
    }

    assert(s->reply.handle == handle);

    if (nbd_reply_is_simple(&s->reply)) {
        if (only_structured) {
            error_setg(errp, "Protocol error: simple reply when structured "
                             "reply chunk was expected");
            return -EINVAL;
M
Marc-André Lureau 已提交
393 394
        }

395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433
        *request_ret = -nbd_errno_to_system_errno(s->reply.simple.error);
        if (*request_ret < 0 || !qiov) {
            return 0;
        }

        return qio_channel_readv_all(s->ioc, qiov->iov, qiov->niov,
                                     errp) < 0 ? -EIO : 0;
    }

    /* handle structured reply chunk */
    assert(s->info.structured_reply);
    chunk = &s->reply.structured;

    if (chunk->type == NBD_REPLY_TYPE_NONE) {
        if (!(chunk->flags & NBD_REPLY_FLAG_DONE)) {
            error_setg(errp, "Protocol error: NBD_REPLY_TYPE_NONE chunk without"
                             "NBD_REPLY_FLAG_DONE flag set");
            return -EINVAL;
        }
        return 0;
    }

    if (chunk->type == NBD_REPLY_TYPE_OFFSET_DATA) {
        if (!qiov) {
            error_setg(errp, "Unexpected NBD_REPLY_TYPE_OFFSET_DATA chunk");
            return -EINVAL;
        }

        return nbd_co_receive_offset_data_payload(s, s->requests[i].offset,
                                                  qiov, errp);
    }

    if (nbd_reply_type_is_error(chunk->type)) {
        payload = &local_payload;
    }

    ret = nbd_co_receive_structured_payload(s, payload, errp);
    if (ret < 0) {
        return ret;
M
Marc-André Lureau 已提交
434
    }
435

436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466
    if (nbd_reply_type_is_error(chunk->type)) {
        ret = nbd_parse_error_payload(chunk, local_payload, request_ret, errp);
        g_free(local_payload);
        return ret;
    }

    return 0;
}

/* nbd_co_receive_one_chunk
 * Read reply, wake up read_reply_co and set s->quit if needed.
 * Return value is a fatal error code or normal nbd reply error code
 */
static coroutine_fn int nbd_co_receive_one_chunk(
        NBDClientSession *s, uint64_t handle, bool only_structured,
        QEMUIOVector *qiov, NBDReply *reply, void **payload, Error **errp)
{
    int request_ret;
    int ret = nbd_co_do_receive_one_chunk(s, handle, only_structured,
                                          &request_ret, qiov, payload, errp);

    if (ret < 0) {
        s->quit = true;
    } else {
        /* For assert at loop start in nbd_read_reply_entry */
        if (reply) {
            *reply = s->reply;
        }
        s->reply.handle = 0;
        ret = request_ret;
    }
467 468 469

    if (s->read_reply_co) {
        aio_co_wake(s->read_reply_co);
M
Marc-André Lureau 已提交
470
    }
471

472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565
    return ret;
}

typedef struct NBDReplyChunkIter {
    int ret;
    Error *err;
    bool done, only_structured;
} NBDReplyChunkIter;

static void nbd_iter_error(NBDReplyChunkIter *iter, bool fatal,
                           int ret, Error **local_err)
{
    assert(ret < 0);

    if (fatal || iter->ret == 0) {
        if (iter->ret != 0) {
            error_free(iter->err);
            iter->err = NULL;
        }
        iter->ret = ret;
        error_propagate(&iter->err, *local_err);
    } else {
        error_free(*local_err);
    }

    *local_err = NULL;
}

/* NBD_FOREACH_REPLY_CHUNK
 */
#define NBD_FOREACH_REPLY_CHUNK(s, iter, handle, structured, \
                                qiov, reply, payload) \
    for (iter = (NBDReplyChunkIter) { .only_structured = structured }; \
         nbd_reply_chunk_iter_receive(s, &iter, handle, qiov, reply, payload);)

/* nbd_reply_chunk_iter_receive
 */
static bool nbd_reply_chunk_iter_receive(NBDClientSession *s,
                                         NBDReplyChunkIter *iter,
                                         uint64_t handle,
                                         QEMUIOVector *qiov, NBDReply *reply,
                                         void **payload)
{
    int ret;
    NBDReply local_reply;
    NBDStructuredReplyChunk *chunk;
    Error *local_err = NULL;
    if (s->quit) {
        error_setg(&local_err, "Connection closed");
        nbd_iter_error(iter, true, -EIO, &local_err);
        goto break_loop;
    }

    if (iter->done) {
        /* Previous iteration was last. */
        goto break_loop;
    }

    if (reply == NULL) {
        reply = &local_reply;
    }

    ret = nbd_co_receive_one_chunk(s, handle, iter->only_structured,
                                   qiov, reply, payload, &local_err);
    if (ret < 0) {
        /* If it is a fatal error s->quit is set by nbd_co_receive_one_chunk */
        nbd_iter_error(iter, s->quit, ret, &local_err);
    }

    /* Do not execute the body of NBD_FOREACH_REPLY_CHUNK for simple reply. */
    if (nbd_reply_is_simple(&s->reply) || s->quit) {
        goto break_loop;
    }

    chunk = &reply->structured;
    iter->only_structured = true;

    if (chunk->type == NBD_REPLY_TYPE_NONE) {
        /* NBD_REPLY_FLAG_DONE is already checked in nbd_co_receive_one_chunk */
        assert(chunk->flags & NBD_REPLY_FLAG_DONE);
        goto break_loop;
    }

    if (chunk->flags & NBD_REPLY_FLAG_DONE) {
        /* This iteration is last. */
        iter->done = true;
    }

    /* Execute the loop body */
    return true;

break_loop:
    s->requests[HANDLE_TO_INDEX(s, handle)].coroutine = NULL;

566 567 568 569
    qemu_co_mutex_lock(&s->send_mutex);
    s->in_flight--;
    qemu_co_queue_next(&s->free_sema);
    qemu_co_mutex_unlock(&s->send_mutex);
570

571
    return false;
M
Marc-André Lureau 已提交
572 573
}

574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637
static int nbd_co_receive_return_code(NBDClientSession *s, uint64_t handle,
                                      Error **errp)
{
    NBDReplyChunkIter iter;

    NBD_FOREACH_REPLY_CHUNK(s, iter, handle, false, NULL, NULL, NULL) {
        /* nbd_reply_chunk_iter_receive does all the work */
    }

    error_propagate(errp, iter.err);
    return iter.ret;
}

static int nbd_co_receive_cmdread_reply(NBDClientSession *s, uint64_t handle,
                                        uint64_t offset, QEMUIOVector *qiov,
                                        Error **errp)
{
    NBDReplyChunkIter iter;
    NBDReply reply;
    void *payload = NULL;
    Error *local_err = NULL;

    NBD_FOREACH_REPLY_CHUNK(s, iter, handle, s->info.structured_reply,
                            qiov, &reply, &payload)
    {
        int ret;
        NBDStructuredReplyChunk *chunk = &reply.structured;

        assert(nbd_reply_is_structured(&reply));

        switch (chunk->type) {
        case NBD_REPLY_TYPE_OFFSET_DATA:
            /* special cased in nbd_co_receive_one_chunk, data is already
             * in qiov */
            break;
        case NBD_REPLY_TYPE_OFFSET_HOLE:
            ret = nbd_parse_offset_hole_payload(&reply.structured, payload,
                                                offset, qiov, &local_err);
            if (ret < 0) {
                s->quit = true;
                nbd_iter_error(&iter, true, ret, &local_err);
            }
            break;
        default:
            if (!nbd_reply_type_is_error(chunk->type)) {
                /* not allowed reply type */
                s->quit = true;
                error_setg(&local_err,
                           "Unexpected reply type: %d (%s) for CMD_READ",
                           chunk->type, nbd_reply_type_lookup(chunk->type));
                nbd_iter_error(&iter, true, -EINVAL, &local_err);
            }
        }

        g_free(payload);
        payload = NULL;
    }

    error_propagate(errp, iter.err);
    return iter.ret;
}

static int nbd_co_request(BlockDriverState *bs, NBDRequest *request,
                          QEMUIOVector *write_qiov)
638 639
{
    int ret;
640 641
    Error *local_err = NULL;
    NBDClientSession *client = nbd_get_client_session(bs);
642

643 644 645 646
    assert(request->type != NBD_CMD_READ);
    if (write_qiov) {
        assert(request->type == NBD_CMD_WRITE);
        assert(request->len == iov_size(write_qiov->iov, write_qiov->niov));
647
    } else {
648
        assert(request->type != NBD_CMD_WRITE);
649
    }
650
    ret = nbd_co_send_request(bs, request, write_qiov);
651
    if (ret < 0) {
652
        return ret;
653
    }
654

655 656 657 658 659
    ret = nbd_co_receive_return_code(client, request->handle, &local_err);
    if (local_err) {
        error_report_err(local_err);
    }
    return ret;
660 661
}

662 663
int nbd_client_co_preadv(BlockDriverState *bs, uint64_t offset,
                         uint64_t bytes, QEMUIOVector *qiov, int flags)
M
Marc-André Lureau 已提交
664
{
665 666 667
    int ret;
    Error *local_err = NULL;
    NBDClientSession *client = nbd_get_client_session(bs);
668
    NBDRequest request = {
669 670 671 672
        .type = NBD_CMD_READ,
        .from = offset,
        .len = bytes,
    };
M
Marc-André Lureau 已提交
673

674 675
    assert(bytes <= NBD_MAX_BUFFER_SIZE);
    assert(!flags);
M
Marc-André Lureau 已提交
676

677 678 679 680 681 682 683 684 685 686 687
    ret = nbd_co_send_request(bs, &request, NULL);
    if (ret < 0) {
        return ret;
    }

    ret = nbd_co_receive_cmdread_reply(client, request.handle, offset, qiov,
                                       &local_err);
    if (ret < 0) {
        error_report_err(local_err);
    }
    return ret;
M
Marc-André Lureau 已提交
688 689
}

690 691
int nbd_client_co_pwritev(BlockDriverState *bs, uint64_t offset,
                          uint64_t bytes, QEMUIOVector *qiov, int flags)
M
Marc-André Lureau 已提交
692
{
693
    NBDClientSession *client = nbd_get_client_session(bs);
694
    NBDRequest request = {
695 696 697 698
        .type = NBD_CMD_WRITE,
        .from = offset,
        .len = bytes,
    };
M
Marc-André Lureau 已提交
699

E
Eric Blake 已提交
700
    if (flags & BDRV_REQ_FUA) {
701
        assert(client->info.flags & NBD_FLAG_SEND_FUA);
702
        request.flags |= NBD_CMD_FLAG_FUA;
M
Marc-André Lureau 已提交
703 704
    }

705
    assert(bytes <= NBD_MAX_BUFFER_SIZE);
M
Marc-André Lureau 已提交
706

707
    return nbd_co_request(bs, &request, qiov);
M
Marc-André Lureau 已提交
708 709
}

710
int nbd_client_co_pwrite_zeroes(BlockDriverState *bs, int64_t offset,
711
                                int bytes, BdrvRequestFlags flags)
712 713 714 715 716
{
    NBDClientSession *client = nbd_get_client_session(bs);
    NBDRequest request = {
        .type = NBD_CMD_WRITE_ZEROES,
        .from = offset,
717
        .len = bytes,
718 719
    };

720
    if (!(client->info.flags & NBD_FLAG_SEND_WRITE_ZEROES)) {
721 722 723 724
        return -ENOTSUP;
    }

    if (flags & BDRV_REQ_FUA) {
725
        assert(client->info.flags & NBD_FLAG_SEND_FUA);
726 727 728 729 730 731
        request.flags |= NBD_CMD_FLAG_FUA;
    }
    if (!(flags & BDRV_REQ_MAY_UNMAP)) {
        request.flags |= NBD_CMD_FLAG_NO_HOLE;
    }

732
    return nbd_co_request(bs, &request, NULL);
733 734
}

M
Max Reitz 已提交
735
int nbd_client_co_flush(BlockDriverState *bs)
M
Marc-André Lureau 已提交
736
{
737
    NBDClientSession *client = nbd_get_client_session(bs);
738
    NBDRequest request = { .type = NBD_CMD_FLUSH };
M
Marc-André Lureau 已提交
739

740
    if (!(client->info.flags & NBD_FLAG_SEND_FLUSH)) {
M
Marc-André Lureau 已提交
741 742 743 744 745 746
        return 0;
    }

    request.from = 0;
    request.len = 0;

747
    return nbd_co_request(bs, &request, NULL);
M
Marc-André Lureau 已提交
748 749
}

750
int nbd_client_co_pdiscard(BlockDriverState *bs, int64_t offset, int bytes)
M
Marc-André Lureau 已提交
751
{
752
    NBDClientSession *client = nbd_get_client_session(bs);
753
    NBDRequest request = {
754 755
        .type = NBD_CMD_TRIM,
        .from = offset,
756
        .len = bytes,
757
    };
M
Marc-André Lureau 已提交
758

759
    if (!(client->info.flags & NBD_FLAG_SEND_TRIM)) {
M
Marc-André Lureau 已提交
760 761 762
        return 0;
    }

763
    return nbd_co_request(bs, &request, NULL);
M
Marc-André Lureau 已提交
764 765
}

M
Max Reitz 已提交
766
void nbd_client_detach_aio_context(BlockDriverState *bs)
767
{
768
    NBDClientSession *client = nbd_get_client_session(bs);
P
Paolo Bonzini 已提交
769
    qio_channel_detach_aio_context(QIO_CHANNEL(client->ioc));
770 771
}

M
Max Reitz 已提交
772 773
void nbd_client_attach_aio_context(BlockDriverState *bs,
                                   AioContext *new_context)
774
{
775
    NBDClientSession *client = nbd_get_client_session(bs);
P
Paolo Bonzini 已提交
776
    qio_channel_attach_aio_context(QIO_CHANNEL(client->ioc), new_context);
777
    aio_co_schedule(new_context, client->read_reply_co);
778 779
}

M
Max Reitz 已提交
780
void nbd_client_close(BlockDriverState *bs)
M
Marc-André Lureau 已提交
781
{
782
    NBDClientSession *client = nbd_get_client_session(bs);
783
    NBDRequest request = { .type = NBD_CMD_DISC };
M
Marc-André Lureau 已提交
784

785
    if (client->ioc == NULL) {
786 787 788
        return;
    }

789
    nbd_send_request(client->ioc, &request);
790

M
Max Reitz 已提交
791
    nbd_teardown_connection(bs);
M
Marc-André Lureau 已提交
792 793
}

794 795 796 797 798 799
int nbd_client_init(BlockDriverState *bs,
                    QIOChannelSocket *sioc,
                    const char *export,
                    QCryptoTLSCreds *tlscreds,
                    const char *hostname,
                    Error **errp)
M
Marc-André Lureau 已提交
800
{
801
    NBDClientSession *client = nbd_get_client_session(bs);
M
Marc-André Lureau 已提交
802 803 804
    int ret;

    /* NBD handshake */
805
    logout("session init %s\n", export);
806 807
    qio_channel_set_blocking(QIO_CHANNEL(sioc), true, NULL);

808
    client->info.request_sizes = true;
809
    client->info.structured_reply = true;
810
    ret = nbd_receive_negotiate(QIO_CHANNEL(sioc), export,
811
                                tlscreds, hostname,
812
                                &client->ioc, &client->info, errp);
M
Marc-André Lureau 已提交
813 814 815 816
    if (ret < 0) {
        logout("Failed to negotiate with the NBD server\n");
        return ret;
    }
817
    if (client->info.flags & NBD_FLAG_SEND_FUA) {
818
        bs->supported_write_flags = BDRV_REQ_FUA;
819 820
        bs->supported_zero_flags |= BDRV_REQ_FUA;
    }
821
    if (client->info.flags & NBD_FLAG_SEND_WRITE_ZEROES) {
822
        bs->supported_zero_flags |= BDRV_REQ_MAY_UNMAP;
823
    }
824 825 826
    if (client->info.min_block > bs->bl.request_alignment) {
        bs->bl.request_alignment = client->info.min_block;
    }
M
Marc-André Lureau 已提交
827 828

    qemu_co_mutex_init(&client->send_mutex);
829
    qemu_co_queue_init(&client->free_sema);
830 831
    client->sioc = sioc;
    object_ref(OBJECT(client->sioc));
832 833 834 835 836

    if (!client->ioc) {
        client->ioc = QIO_CHANNEL(sioc);
        object_ref(OBJECT(client->ioc));
    }
M
Marc-André Lureau 已提交
837 838 839

    /* Now that we're connected, set the socket to be non-blocking and
     * kick the reply mechanism.  */
840
    qio_channel_set_blocking(QIO_CHANNEL(sioc), false, NULL);
841
    client->read_reply_co = qemu_coroutine_create(nbd_read_reply_entry, client);
M
Max Reitz 已提交
842
    nbd_client_attach_aio_context(bs, bdrv_get_aio_context(bs));
M
Marc-André Lureau 已提交
843 844 845 846

    logout("Established connection with NBD server\n");
    return 0;
}