zmq.cpp 18.9 KB
Newer Older
Martin Sustrik's avatar
Martin Sustrik committed
1
/*
2
    Copyright (c) 2007-2010 iMatix Corporation
Martin Sustrik's avatar
Martin Sustrik committed
3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19

    This file is part of 0MQ.

    0MQ is free software; you can redistribute it and/or modify it under
    the terms of the Lesser GNU General Public License as published by
    the Free Software Foundation; either version 3 of the License, or
    (at your option) any later version.

    0MQ is distributed in the hope that it will be useful,
    but WITHOUT ANY WARRANTY; without even the implied warranty of
    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
    Lesser GNU General Public License for more details.

    You should have received a copy of the Lesser GNU General Public License
    along with this program.  If not, see <http://www.gnu.org/licenses/>.
*/

20
#include "../bindings/c/zmq.h"
Martin Sustrik's avatar
Martin Sustrik committed
21

22
#include <string.h>
Martin Sustrik's avatar
Martin Sustrik committed
23 24 25 26
#include <errno.h>
#include <stdlib.h>
#include <new>

27
#include "socket_base.hpp"
28
#include "app_thread.hpp"
29
#include "dispatcher.hpp"
30
#include "msg_content.hpp"
31 32
#include "platform.hpp"
#include "stdint.hpp"
33
#include "config.hpp"
34
#include "err.hpp"
35
#include "fd.hpp"
36

37 38 39 40
#if defined ZMQ_HAVE_LINUX || defined ZMQ_HAVE_FREEBSD ||\
    defined ZMQ_HAVE_OPENBSD || defined ZMQ_HAVE_SOLARIS ||\
    defined ZMQ_HAVE_OSX || defined ZMQ_HAVE_QNXNTO ||\
    defined ZMQ_HAVE_HPUX || defined ZMQ_HAVE_AIX
41 42
#include <poll.h>
#endif
43 44 45 46 47

#if !defined ZMQ_HAVE_WINDOWS
#include <unistd.h>
#include <sys/time.h>
#endif
Martin Sustrik's avatar
Martin Sustrik committed
48

49 50 51 52
#if defined ZMQ_HAVE_OPENPGM
#include <pgm/pgm.h>
#endif

53 54
void zmq_version (int *major_, int *minor_, int *patch_)
{
55 56 57
    *major_ = PACKAGE_VERSION_MAJOR;
    *minor_ = PACKAGE_VERSION_MINOR;
    *patch_ = PACKAGE_VERSION_PATCH;
58 59
}

60 61 62
const char *zmq_strerror (int errnum_)
{
    switch (errnum_) {
63 64 65 66 67
#if defined ZMQ_HAVE_WINDOWS
    case ENOTSUP:
        return "Not supported";
    case EPROTONOSUPPORT:
        return "Protocol not supported";
68 69 70 71 72 73 74 75
    case ENOBUFS:
        return "No buffer space available";
    case ENETDOWN:
        return "Network is down";
    case EADDRINUSE:
        return "Address in use";
    case EADDRNOTAVAIL:
        return "Address not available";
76
#endif
77 78 79 80 81 82 83
    case EMTHREAD:
        return "Number of preallocated application threads exceeded";
    case EFSM:
        return "Operation cannot be accomplished in current state";
    case ENOCOMPATPROTO:
        return "The protocol is not compatible with the socket type";
    default:
84 85 86 87
#if defined _MSC_VER
#pragma warning (push)
#pragma warning (disable:4996)
#endif
88
        return strerror (errnum_);
89 90 91
#if defined _MSC_VER
#pragma warning (pop)
#endif
92 93 94
    }
}

95
int zmq_msg_init (zmq_msg_t *msg_)
Martin Sustrik's avatar
Martin Sustrik committed
96
{
97
    msg_->content = (zmq::msg_content_t*) ZMQ_VSM;
Martin Sustrik's avatar
Martin Sustrik committed
98 99 100 101
    msg_->vsm_size = 0;
    return 0;
}

102
int zmq_msg_init_size (zmq_msg_t *msg_, size_t size_)
Martin Sustrik's avatar
Martin Sustrik committed
103
{
Martin Sustrik's avatar
Martin Sustrik committed
104
    if (size_ <= ZMQ_MAX_VSM_SIZE) {
105
        msg_->content = (zmq::msg_content_t*) ZMQ_VSM;
106
        msg_->vsm_size = (uint8_t) size_;
Martin Sustrik's avatar
Martin Sustrik committed
107 108
    }
    else {
109 110
        msg_->content =
            (zmq::msg_content_t*) malloc (sizeof (zmq::msg_content_t) + size_);
Martin Sustrik's avatar
Martin Sustrik committed
111 112 113 114 115
        if (!msg_->content) {
            errno = ENOMEM;
            return -1;
        }
        msg_->shared = 0;
116 117 118 119 120

        zmq::msg_content_t *content = (zmq::msg_content_t*) msg_->content;
        content->data = (void*) (content + 1);
        content->size = size_;
        content->ffn = NULL;
121
        content->hint = NULL;
122
        new (&content->refcnt) zmq::atomic_counter_t ();
Martin Sustrik's avatar
Martin Sustrik committed
123 124 125 126
    }
    return 0;
}

127
int zmq_msg_init_data (zmq_msg_t *msg_, void *data_, size_t size_,
128
    zmq_free_fn *ffn_, void *hint_)
Martin Sustrik's avatar
Martin Sustrik committed
129 130
{
    msg_->shared = 0;
131
    msg_->content = (zmq::msg_content_t*) malloc (sizeof (zmq::msg_content_t));
Martin Sustrik's avatar
Martin Sustrik committed
132
    zmq_assert (msg_->content);
133 134 135 136
    zmq::msg_content_t *content = (zmq::msg_content_t*) msg_->content;
    content->data = data_;
    content->size = size_;
    content->ffn = ffn_;
137
    content->hint = hint_;
138
    new (&content->refcnt) zmq::atomic_counter_t ();
Martin Sustrik's avatar
Martin Sustrik committed
139 140 141
    return 0;
}

142
int zmq_msg_close (zmq_msg_t *msg_)
Martin Sustrik's avatar
Martin Sustrik committed
143
{
144 145
    //  For VSMs and delimiters there are no resources to free.
    if (msg_->content == (zmq::msg_content_t*) ZMQ_DELIMITER ||
146
          msg_->content == (zmq::msg_content_t*) ZMQ_VSM)
Martin Sustrik's avatar
Martin Sustrik committed
147 148
        return 0;

149
    //  If the content is not shared, or if it is shared and the reference.
Martin Sustrik's avatar
Martin Sustrik committed
150
    //  count has dropped to zero, deallocate it.
151 152
    zmq::msg_content_t *content = (zmq::msg_content_t*) msg_->content;
    if (!msg_->shared || !content->refcnt.sub (1)) {
Martin Sustrik's avatar
Martin Sustrik committed
153

154
        //  We used "placement new" operator to initialize the reference.
Martin Sustrik's avatar
Martin Sustrik committed
155
        //  counter so we call its destructor now.
156
        content->refcnt.~atomic_counter_t ();
Martin Sustrik's avatar
Martin Sustrik committed
157

158
        if (content->ffn)
159
            content->ffn (content->data, content->hint);
160
        free (content);
Martin Sustrik's avatar
Martin Sustrik committed
161 162 163 164 165
    }

    return 0;
}

166
int zmq_msg_move (zmq_msg_t *dest_, zmq_msg_t *src_)
Martin Sustrik's avatar
Martin Sustrik committed
167
{
Martin Sustrik's avatar
Martin Sustrik committed
168
    zmq_msg_close (dest_);
Martin Sustrik's avatar
Martin Sustrik committed
169
    *dest_ = *src_;
Martin Sustrik's avatar
Martin Sustrik committed
170
    zmq_msg_init (src_);
Martin Sustrik's avatar
Martin Sustrik committed
171 172 173
    return 0;
}

174
int zmq_msg_copy (zmq_msg_t *dest_, zmq_msg_t *src_)
Martin Sustrik's avatar
Martin Sustrik committed
175
{
Martin Sustrik's avatar
Martin Sustrik committed
176
    zmq_msg_close (dest_);
Martin Sustrik's avatar
Martin Sustrik committed
177 178

    //  VSMs and delimiters require no special handling.
179 180
    if (src_->content != (zmq::msg_content_t*) ZMQ_DELIMITER &&
          src_->content != (zmq::msg_content_t*) ZMQ_VSM) {
Martin Sustrik's avatar
Martin Sustrik committed
181 182 183

        //  One reference is added to shared messages. Non-shared messages
        //  are turned into shared messages and reference count is set to 2.
184
        zmq::msg_content_t *content = (zmq::msg_content_t*) src_->content;
Martin Sustrik's avatar
Martin Sustrik committed
185
        if (src_->shared)
186
            content->refcnt.add (1);
Martin Sustrik's avatar
Martin Sustrik committed
187 188
        else {
            src_->shared = true;
189
            content->refcnt.set (2);
Martin Sustrik's avatar
Martin Sustrik committed
190 191 192 193 194 195 196
        }
    }

    *dest_ = *src_;
    return 0;
}

197
void *zmq_msg_data (zmq_msg_t *msg_)
Martin Sustrik's avatar
Martin Sustrik committed
198
{
199
    if (msg_->content == (zmq::msg_content_t*) ZMQ_VSM)
Martin Sustrik's avatar
Martin Sustrik committed
200
        return msg_->vsm_data;
201
    if (msg_->content == (zmq::msg_content_t*) ZMQ_DELIMITER)
Martin Sustrik's avatar
Martin Sustrik committed
202
        return NULL;
203 204

    return ((zmq::msg_content_t*) msg_->content)->data;
Martin Sustrik's avatar
Martin Sustrik committed
205 206
}

207
size_t zmq_msg_size (zmq_msg_t *msg_)
Martin Sustrik's avatar
Martin Sustrik committed
208
{
209
    if (msg_->content == (zmq::msg_content_t*) ZMQ_VSM)
Martin Sustrik's avatar
Martin Sustrik committed
210
        return msg_->vsm_size;
211
    if (msg_->content == (zmq::msg_content_t*) ZMQ_DELIMITER)
Martin Sustrik's avatar
Martin Sustrik committed
212
        return 0;
213 214

    return ((zmq::msg_content_t*) msg_->content)->size;
Martin Sustrik's avatar
Martin Sustrik committed
215 216
}

217
void *zmq_init (int app_threads_, int io_threads_, int flags_)
Martin Sustrik's avatar
Martin Sustrik committed
218
{
219 220 221 222
    //  There should be at least a single application thread managed
    //  by the dispatcher. There's no need for I/O threads if 0MQ is used
    //  only for inproc messaging
    if (app_threads_ < 1 || io_threads_ < 0 ||
223
          app_threads_ > 63 || io_threads_ > 63) {
Martin Sustrik's avatar
Martin Sustrik committed
224 225 226 227
        errno = EINVAL;
        return NULL;
    }

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
#if defined ZMQ_HAVE_OPENPGM
    //  Unfortunately, OpenPGM doesn't support refcounted init/shutdown, thus,
    //  let's fail if it was initialised beforehand.
    zmq_assert (!pgm_supported ());

    //  Init PGM transport. Ensure threading and timer are enabled. Find PGM
    //  protocol ID. Note that if you want to use gettimeofday and sleep for
    //  openPGM timing, set environment variables PGM_TIMER to "GTOD" and
    //  PGM_SLEEP to "USLEEP".
    GError *pgm_error = NULL;
    int rc = pgm_init (&pgm_error);
    if (rc != TRUE) {
        if (pgm_error->domain == PGM_IF_ERROR && (
              pgm_error->code == PGM_IF_ERROR_INVAL ||
              pgm_error->code == PGM_IF_ERROR_XDEV ||
              pgm_error->code == PGM_IF_ERROR_NODEV ||
              pgm_error->code == PGM_IF_ERROR_NOTUNIQ ||
              pgm_error->code == PGM_IF_ERROR_ADDRFAMILY ||
              pgm_error->code == PGM_IF_ERROR_FAMILY ||
              pgm_error->code == PGM_IF_ERROR_NODATA ||
              pgm_error->code == PGM_IF_ERROR_NONAME ||
              pgm_error->code == PGM_IF_ERROR_SERVICE)) {
            g_error_free (pgm_error);
            errno = EINVAL;
            return NULL;
        }
        zmq_assert (false);
    }
#endif

    //  Create 0MQ context.
259 260
    zmq::dispatcher_t *dispatcher = new (std::nothrow) zmq::dispatcher_t (
        app_threads_, io_threads_, flags_);
261 262
    zmq_assert (dispatcher);
    return (void*) dispatcher;
Martin Sustrik's avatar
Martin Sustrik committed
263 264
}

265
int zmq_term (void *dispatcher_)
Martin Sustrik's avatar
Martin Sustrik committed
266
{
267 268 269 270 271 272 273 274 275 276 277
    int rc = ((zmq::dispatcher_t*) dispatcher_)->term ();
    int en = errno;

#if defined ZMQ_HAVE_OPENPGM
    //  Shut down the OpenPGM library.
    if (pgm_shutdown () != TRUE)
        zmq_assert (false);
#endif

    errno = en;
    return rc;
Martin Sustrik's avatar
Martin Sustrik committed
278 279
}

280
void *zmq_socket (void *dispatcher_, int type_)
Martin Sustrik's avatar
Martin Sustrik committed
281
{
282
    return (void*) (((zmq::dispatcher_t*) dispatcher_)->create_socket (type_));
Martin Sustrik's avatar
Martin Sustrik committed
283 284
}

Martin Sustrik's avatar
Martin Sustrik committed
285
int zmq_close (void *s_)
Martin Sustrik's avatar
Martin Sustrik committed
286
{
287
    ((zmq::socket_base_t*) s_)->close ();
Martin Sustrik's avatar
Martin Sustrik committed
288 289 290
    return 0;
}

291 292
int zmq_setsockopt (void *s_, int option_, const void *optval_,
    size_t optvallen_)
Martin Sustrik's avatar
Martin Sustrik committed
293
{
294 295
    return (((zmq::socket_base_t*) s_)->setsockopt (option_, optval_,
        optvallen_));
Martin Sustrik's avatar
Martin Sustrik committed
296 297
}

298
int zmq_bind (void *s_, const char *addr_)
Martin Sustrik's avatar
Martin Sustrik committed
299
{
300
    return (((zmq::socket_base_t*) s_)->bind (addr_));
301 302 303 304
}

int zmq_connect (void *s_, const char *addr_)
{
305
    return (((zmq::socket_base_t*) s_)->connect (addr_));
Martin Sustrik's avatar
Martin Sustrik committed
306 307
}

308
int zmq_send (void *s_, zmq_msg_t *msg_, int flags_)
Martin Sustrik's avatar
Martin Sustrik committed
309
{
310
    return (((zmq::socket_base_t*) s_)->send (msg_, flags_));
Martin Sustrik's avatar
Martin Sustrik committed
311 312
}

Martin Sustrik's avatar
Martin Sustrik committed
313
int zmq_flush (void *s_)
Martin Sustrik's avatar
Martin Sustrik committed
314
{
315
    return (((zmq::socket_base_t*) s_)->flush ());
Martin Sustrik's avatar
Martin Sustrik committed
316 317
}

318
int zmq_recv (void *s_, zmq_msg_t *msg_, int flags_)
Martin Sustrik's avatar
Martin Sustrik committed
319
{
320
    return (((zmq::socket_base_t*) s_)->recv (msg_, flags_));
Martin Sustrik's avatar
Martin Sustrik committed
321
}
322

323
int zmq_poll (zmq_pollitem_t *items_, int nitems_, long timeout_)
324
{
325 326 327 328
#if defined ZMQ_HAVE_LINUX || defined ZMQ_HAVE_FREEBSD ||\
    defined ZMQ_HAVE_OPENBSD || defined ZMQ_HAVE_SOLARIS ||\
    defined ZMQ_HAVE_OSX || defined ZMQ_HAVE_QNXNTO ||\
    defined ZMQ_HAVE_HPUX || defined ZMQ_HAVE_AIX
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 366 367 368 369 370 371 372 373 374 375 376 377 378 379

    pollfd *pollfds = (pollfd*) malloc (nitems_ * sizeof (pollfd));
    zmq_assert (pollfds);
    int npollfds = 0;
    int nsockets = 0;

    zmq::app_thread_t *app_thread = NULL;

    for (int i = 0; i != nitems_; i++) {

        //  0MQ sockets.
        if (items_ [i].socket) {

            //  Get the app_thread the socket is living in. If there are two
            //  sockets in the same pollset with different app threads, fail.
            zmq::socket_base_t *s = (zmq::socket_base_t*) items_ [i].socket;
            if (app_thread) {
                if (app_thread != s->get_thread ()) {
                    free (pollfds);
                    errno = EFAULT;
                    return -1;
                }
            }
            else
                app_thread = s->get_thread ();

            nsockets++;
            continue;
        }

        //  Raw file descriptors.
        pollfds [npollfds].fd = items_ [i].fd;
        pollfds [npollfds].events =
            (items_ [i].events & ZMQ_POLLIN ? POLLIN : 0) |
            (items_ [i].events & ZMQ_POLLOUT ? POLLOUT : 0);
        npollfds++;
    }

    //  If there's at least one 0MQ socket in the pollset we have to poll
    //  for 0MQ commands. If ZMQ_POLL was not set, fail.
    if (nsockets) {
        pollfds [npollfds].fd = app_thread->get_signaler ()->get_fd ();
        if (pollfds [npollfds].fd == zmq::retired_fd) {
            free (pollfds);
            errno = ENOTSUP;
            return -1;
        }
        pollfds [npollfds].events = POLLIN;
        npollfds++;
    }

380 381 382 383 384 385 386 387 388 389
    //  First iteration just check for events, don't block. Waiting would
    //  prevent exiting on any events that may already been signaled on
    //  0MQ sockets.
    int rc = poll (pollfds, npollfds, 0);
    if (rc == -1 && errno == EINTR) {
        free (pollfds);
        return 0;
    }
    errno_assert (rc >= 0);

390
    int timeout = timeout_ > 0 ? timeout_ / 1000 : -1;
391
    int nevents = 0;
392

393
    while (true) {
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

        //  Process 0MQ commands if needed.
        if (nsockets && pollfds [npollfds -1].revents & POLLIN)
            app_thread->process_commands (false, false);

        //  Check for the events.
        int pollfd_pos = 0;
        for (int i = 0; i != nitems_; i++) {

            //  If the poll item is a raw file descriptor, simply convert
            //  the events to zmq_pollitem_t-style format.
            if (!items_ [i].socket) {
                items_ [i].revents =
                    (pollfds [pollfd_pos].revents & POLLIN ? ZMQ_POLLIN : 0) |
                    (pollfds [pollfd_pos].revents & POLLOUT ? ZMQ_POLLOUT : 0);
                if (items_ [i].revents)
                    nevents++;
                pollfd_pos++;
                continue;
            }

            //  The poll item is a 0MQ socket.
            zmq::socket_base_t *s = (zmq::socket_base_t*) items_ [i].socket;
            items_ [i].revents = 0;
            if ((items_ [i].events & ZMQ_POLLOUT) && s->has_out ())
                items_ [i].revents |= ZMQ_POLLOUT;
            if ((items_ [i].events & ZMQ_POLLIN) && s->has_in ())
                items_ [i].revents |= ZMQ_POLLIN;
            if (items_ [i].revents)
                nevents++;
        }
425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445

        //  If there's at least one event, or if we are asked not to block,
        //  return immediately.
        if (nevents || !timeout)
            break;

        //  Wait for events.
        rc = poll (pollfds, npollfds, timeout);
        if (rc == -1 && errno == EINTR)
            break;
        errno_assert (rc >= 0);

        //  If timeout was hit with no events signaled, return zero.
        if (rc == 0)
            break;

        //  If timeout was already applied, we don't want to poll anymore.
        //  Setting timeout to zero will cause termination of the function
        //  once the events we've got are processed.
        if (timeout > 0)
            timeout = 0;
446 447 448 449 450
    }

    free (pollfds);
    return nevents;

451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 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
#elif defined ZMQ_HAVE_WINDOWS || defined ZMQ_HAVE_OPENVMS

    fd_set pollset_in;
    FD_ZERO (&pollset_in);
    fd_set pollset_out;
    FD_ZERO (&pollset_out);
    fd_set pollset_err;
    FD_ZERO (&pollset_err);

    zmq::app_thread_t *app_thread = NULL;
    int nsockets = 0;
    zmq::fd_t maxfd = zmq::retired_fd;
    zmq::fd_t notify_fd = zmq::retired_fd;

    for (int i = 0; i != nitems_; i++) {

        //  0MQ sockets.
        if (items_ [i].socket) {

            //  Get the app_thread the socket is living in. If there are two
            //  sockets in the same pollset with different app threads, fail.
            zmq::socket_base_t *s = (zmq::socket_base_t*) items_ [i].socket;
            if (app_thread) {
                if (app_thread != s->get_thread ()) {
                    errno = EFAULT;
                    return -1;
                }
            }
            else
                app_thread = s->get_thread ();

            nsockets++;
            continue;
        }

        //  Raw file descriptors.
        if (items_ [i].events & ZMQ_POLLIN)
            FD_SET (items_ [i].fd, &pollset_in);
        if (items_ [i].events & ZMQ_POLLOUT)
            FD_SET (items_ [i].fd, &pollset_out);
        if (maxfd == zmq::retired_fd || maxfd < items_ [i].fd)
            maxfd = items_ [i].fd;
    }

    //  If there's at least one 0MQ socket in the pollset we have to poll
    //  for 0MQ commands. If ZMQ_POLL was not set, fail.
    if (nsockets) {
        notify_fd = app_thread->get_signaler ()->get_fd ();
        if (notify_fd == zmq::retired_fd) {
            errno = ENOTSUP;
            return -1;
        }
        FD_SET (notify_fd, &pollset_in);
        if (maxfd == zmq::retired_fd || maxfd < notify_fd)
            maxfd = notify_fd;
    }

508
    bool block = (timeout_ < 0);
509 510
    timeval timeout = {timeout_ / 1000000, timeout_ % 1000000};
    timeval zero_timeout = {0, 0};
511 512
    int nevents = 0;

513 514 515
    //  First iteration just check for events, don't block. Waiting would
    //  prevent exiting on any events that may already been signaled on
    //  0MQ sockets.
516 517 518 519 520
    fd_set inset, outset, errset;
    memcpy (&inset, &pollset_in, sizeof (fd_set));
    memcpy (&outset, &pollset_out, sizeof (fd_set));
    memcpy (&errset, &pollset_err, sizeof (fd_set));
    int rc = select (maxfd, &inset, &outset, &errset, &zero_timeout);
521
#if defined ZMQ_HAVE_WINDOWS
522
    wsa_assert (rc != SOCKET_ERROR);
523
#else
524
    errno_assert (rc != -1 || errno != EINTR);
525
#endif
526

527
    while (true) {
528 529

        //  Process 0MQ commands if needed.
530
        if (nsockets && FD_ISSET (notify_fd, &inset))
531 532 533 534 535 536 537 538 539
            app_thread->process_commands (false, false);

        //  Check for the events.
        for (int i = 0; i != nitems_; i++) {

            //  If the poll item is a raw file descriptor, simply convert
            //  the events to zmq_pollitem_t-style format.
            if (!items_ [i].socket) {
                items_ [i].revents =
540 541
                    (FD_ISSET (items_ [i].fd, &inset) ? ZMQ_POLLIN : 0) |
                    (FD_ISSET (items_ [i].fd, &outset) ? ZMQ_POLLOUT : 0);
542 543 544 545 546 547 548 549 550 551 552 553 554 555 556
                if (items_ [i].revents)
                    nevents++;
                continue;
            }

            //  The poll item is a 0MQ socket.
            zmq::socket_base_t *s = (zmq::socket_base_t*) items_ [i].socket;
            items_ [i].revents = 0;
            if ((items_ [i].events & ZMQ_POLLOUT) && s->has_out ())
                items_ [i].revents |= ZMQ_POLLOUT;
            if ((items_ [i].events & ZMQ_POLLIN) && s->has_in ())
                items_ [i].revents |= ZMQ_POLLIN;
            if (items_ [i].revents)
                nevents++;
        }
557 558 559 560 561 562 563

        //  If there's at least one event, or if we are asked not to block,
        //  return immediately.
        if (nevents || (timeout.tv_sec == 0 && timeout.tv_usec == 0))
            break;

        //  Wait for events.
564 565 566 567
        memcpy (&inset, &pollset_in, sizeof (fd_set));
        memcpy (&outset, &pollset_out, sizeof (fd_set));
        memcpy (&errset, &pollset_err, sizeof (fd_set));
        int rc = select (maxfd, &inset, &outset, &errset,
568 569 570 571
            block ? NULL : &timeout);
#if defined ZMQ_HAVE_WINDOWS
        wsa_assert (rc != SOCKET_ERROR);
#else
572
        errno_assert (rc != -1 || errno != EINTR);
573 574 575 576 577 578 579 580 581 582 583
#endif
        
        //  If timeout was hit with no events signaled, return zero.
        if (rc == 0)
            break;

        //  If timeout was already applied, we don't want to poll anymore.
        //  Setting timeout to zero will cause termination of the function
        //  once the events we've got are processed.
        if (!block)
            timeout = zero_timeout;
584 585 586 587 588 589 590
    }

    return nevents;

#else
    errno = ENOTSUP;
    return -1;
591 592 593
#endif
}

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 638 639 640 641 642 643 644 645 646 647 648 649
#if defined ZMQ_HAVE_WINDOWS

static uint64_t now ()
{    
    //  Get the high resolution counter's accuracy.
    LARGE_INTEGER ticksPerSecond;
    QueryPerformanceFrequency (&ticksPerSecond);

    //  What time is it?
    LARGE_INTEGER tick;
    QueryPerformanceCounter (&tick);

    //  Convert the tick number into the number of seconds
    //  since the system was started.
    double ticks_div = (double) (ticksPerSecond.QuadPart / 1000000);     
    return (uint64_t) (tick.QuadPart / ticks_div);
}

void zmq_sleep (int seconds_)
{
    Sleep (seconds_ * 1000);
}

#else

static uint64_t now ()
{
    struct timeval tv;
    int rc;

    rc = gettimeofday (&tv, NULL);
    assert (rc == 0);
    return (tv.tv_sec * (uint64_t) 1000000 + tv.tv_usec);
}

void zmq_sleep (int seconds_)
{
    sleep (seconds_);
}

#endif

void *zmq_stopwatch_start ()
{
    uint64_t *watch = (uint64_t*) malloc (sizeof (uint64_t));
    zmq_assert (watch);
    *watch = now ();
    return (void*) watch;
}

unsigned long zmq_stopwatch_stop (void *watch_)
{
    uint64_t end = now ();
    uint64_t start = *(uint64_t*) watch_;
    free (watch_);
    return (unsigned long) (end - start);
malosek's avatar
malosek committed
650
}