clock.cpp 5.62 KB
Newer Older
Martin Sustrik's avatar
Martin Sustrik committed
1
/*
2
    Copyright (c) 2007-2014 Contributors as noted in the AUTHORS file
Martin Sustrik's avatar
Martin Sustrik committed
3 4 5 6

    This file is part of 0MQ.

    0MQ is free software; you can redistribute it and/or modify it under
7
    the terms of the GNU Lesser General Public License as published by
Martin Sustrik's avatar
Martin Sustrik committed
8 9 10 11 12 13
    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
14
    GNU Lesser General Public License for more details.
Martin Sustrik's avatar
Martin Sustrik committed
15

16
    You should have received a copy of the GNU Lesser General Public License
Martin Sustrik's avatar
Martin Sustrik committed
17 18 19 20 21 22 23 24
    along with this program.  If not, see <http://www.gnu.org/licenses/>.
*/

#include "clock.hpp"
#include "platform.hpp"
#include "likely.hpp"
#include "config.hpp"
#include "err.hpp"
25
#include "mutex.hpp"
Martin Sustrik's avatar
Martin Sustrik committed
26 27 28

#include <stddef.h>

29
#if defined _MSC_VER
30
#if defined _WIN32_WCE
boris@boressoft.ru's avatar
boris@boressoft.ru committed
31 32
#include <cmnintrin.h>
#else
33 34
#include <intrin.h>
#endif
boris@boressoft.ru's avatar
boris@boressoft.ru committed
35
#endif
36

Martin Sustrik's avatar
Martin Sustrik committed
37 38 39 40
#if !defined ZMQ_HAVE_WINDOWS
#include <sys/time.h>
#endif

41
#if defined HAVE_CLOCK_GETTIME || defined HAVE_GETHRTIME
42 43 44
#include <time.h>
#endif

45
#ifdef ZMQ_HAVE_WINDOWS
46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78
typedef ULONGLONG (*f_compatible_get_tick_count64)();

static zmq::mutex_t compatible_get_tick_count64_mutex;

ULONGLONG compatible_get_tick_count64()
{
  compatible_get_tick_count64_mutex.lock();
  static DWORD s_wrap = 0;
  static DWORD s_last_tick = 0;
  const DWORD current_tick = ::GetTickCount();
  if (current_tick < s_last_tick)
    ++s_wrap;

  s_last_tick = current_tick;
  const ULONGLONG result = (static_cast<ULONGLONG>(s_wrap) << 32) + static_cast<ULONGLONG>(current_tick);
  compatible_get_tick_count64_mutex.unlock();
  return result;
}

f_compatible_get_tick_count64 init_compatible_get_tick_count64()
{
  f_compatible_get_tick_count64 func = NULL;
  HMODULE module = ::LoadLibraryA("Kernel32.dll");
  if (module != NULL)
    func = reinterpret_cast<f_compatible_get_tick_count64>(::GetProcAddress(module, "GetTickCount64"));

  if (func == NULL)
    func = compatible_get_tick_count64;

  return func;
}

static f_compatible_get_tick_count64 my_get_tick_count64 = init_compatible_get_tick_count64();
79
#endif
80

Martin Sustrik's avatar
Martin Sustrik committed
81 82
zmq::clock_t::clock_t () :
    last_tsc (rdtsc ()),
83 84 85
#ifdef ZMQ_HAVE_WINDOWS
    last_time (static_cast<uint64_t>((*my_get_tick_count64)()))
#else
86
    last_time (now_us () / 1000)
87
#endif
Martin Sustrik's avatar
Martin Sustrik committed
88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108
{
}

zmq::clock_t::~clock_t ()
{
}

uint64_t zmq::clock_t::now_us ()
{
#if defined ZMQ_HAVE_WINDOWS

    //  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.
109
    double ticks_div = ticksPerSecond.QuadPart / 1000000.0;
Martin Sustrik's avatar
Martin Sustrik committed
110 111
    return (uint64_t) (tick.QuadPart / ticks_div);

112
#elif defined HAVE_CLOCK_GETTIME && defined CLOCK_MONOTONIC
113 114 115 116

    //  Use POSIX clock_gettime function to get precise monotonic time.
    struct timespec tv;
    int rc = clock_gettime (CLOCK_MONOTONIC, &tv);
117
		// Fix case where system has clock_gettime but CLOCK_MONOTONIC is not supported.
118
		// This should be a configuration check, but I looked into it and writing an
119 120 121 122 123 124 125 126
		// AC_FUNC_CLOCK_MONOTONIC seems beyond my powers.
		if( rc != 0) {
			//  Use POSIX gettimeofday function to get precise time.
			struct timeval tv;
			int rc = gettimeofday (&tv, NULL);
			errno_assert (rc == 0);
			return (tv.tv_sec * (uint64_t) 1000000 + tv.tv_usec);
		}
127 128
    return (tv.tv_sec * (uint64_t) 1000000 + tv.tv_nsec / 1000);

129 130 131 132
#elif defined HAVE_GETHRTIME

    return (gethrtime () / 1000);

Martin Sustrik's avatar
Martin Sustrik committed
133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149
#else

    //  Use POSIX gettimeofday function to get precise time.
    struct timeval tv;
    int rc = gettimeofday (&tv, NULL);
    errno_assert (rc == 0);
    return (tv.tv_sec * (uint64_t) 1000000 + tv.tv_usec);

#endif
}

uint64_t zmq::clock_t::now_ms ()
{
    uint64_t tsc = rdtsc ();

    //  If TSC is not supported, get precise time and chop off the microseconds.
    if (!tsc)
150 151 152 153 154 155 156 157
    {
#ifdef ZMQ_HAVE_WINDOWS
        // Under Windows, now_us is not so reliable since QueryPerformanceCounter
        // does not guarantee that it will use a hardware that offers a monotonic timer.
        // So, lets use GetTickCount when GetTickCount64 is not available with an workaround
        // to its 32 bit limitation.
        return static_cast<uint64_t>((*my_get_tick_count64)());
#else
Martin Sustrik's avatar
Martin Sustrik committed
158
        return now_us () / 1000;
159 160
#endif
    }
Martin Sustrik's avatar
Martin Sustrik committed
161 162 163 164 165 166 167 168

    //  If TSC haven't jumped back (in case of migration to a different
    //  CPU core) and if not too much time elapsed since last measurement,
    //  we can return cached time value.
    if (likely (tsc - last_tsc <= (clock_precision / 2) && tsc >= last_tsc))
        return last_time;

    last_tsc = tsc;
169 170 171
#ifdef ZMQ_HAVE_WINDOWS
    last_time = static_cast<uint64_t>((*my_get_tick_count64)());
#else
172
    last_time = now_us () / 1000;
173
#endif
Martin Sustrik's avatar
Martin Sustrik committed
174 175 176 177 178 179
    return last_time;
}

uint64_t zmq::clock_t::rdtsc ()
{
#if (defined _MSC_VER && (defined _M_IX86 || defined _M_X64))
Martin Sustrik's avatar
Martin Sustrik committed
180
    return __rdtsc ();
Martin Sustrik's avatar
Martin Sustrik committed
181 182 183 184
#elif (defined __GNUC__ && (defined __i386__ || defined __x86_64__))
    uint32_t low, high;
    __asm__ volatile ("rdtsc" : "=a" (low), "=d" (high));
    return (uint64_t) high << 32 | low;
185 186 187 188 189 190 191 192
#elif (defined __SUNPRO_CC && (__SUNPRO_CC >= 0x5100) && (defined __i386 || \
    defined __amd64 || defined __x86_64))
    union {
        uint64_t u64val;
        uint32_t u32val [2];
    } tsc;
    asm("rdtsc" : "=a" (tsc.u32val [0]), "=d" (tsc.u32val [1]));
    return tsc.u64val;
193 194 195 196
#elif defined(__s390__)
    uint64_t tsc;
    asm("\tstck\t%0\n" : "=Q" (tsc) : : "cc");
    return(tsc);
Martin Sustrik's avatar
Martin Sustrik committed
197 198 199 200
#else
    return 0;
#endif
}