Rename "subsystems" directory to "base"
[oonf.git] / src / base / os_linux / os_clock_linux.c
1
2 /*
3  * The olsr.org Optimized Link-State Routing daemon version 2 (olsrd2)
4  * Copyright (c) 2004-2015, the olsr.org team - see HISTORY file
5  * All rights reserved.
6  *
7  * Redistribution and use in source and binary forms, with or without
8  * modification, are permitted provided that the following conditions
9  * are met:
10  *
11  * * Redistributions of source code must retain the above copyright
12  *   notice, this list of conditions and the following disclaimer.
13  * * Redistributions in binary form must reproduce the above copyright
14  *   notice, this list of conditions and the following disclaimer in
15  *   the documentation and/or other materials provided with the
16  *   distribution.
17  * * Neither the name of olsr.org, olsrd nor the names of its
18  *   contributors may be used to endorse or promote products derived
19  *   from this software without specific prior written permission.
20  *
21  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
22  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
23  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
24  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
25  * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
26  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
27  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
28  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
29  * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
30  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
31  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
32  * POSSIBILITY OF SUCH DAMAGE.
33  *
34  * Visit http://www.olsr.org for more information.
35  *
36  * If you find this software useful feel free to make a donation
37  * to the project. For more information see the website or contact
38  * the copyright holders.
39  *
40  */
41
42 /**
43  * @file
44  */
45
46 #include <time.h>
47
48 #include <oonf/oonf.h>
49 #include <oonf/libcore/oonf_subsystem.h>
50 #include <oonf/base/os_clock.h>
51
52 /* prototypes */
53 static int _init(void);
54
55 /* type of clock source to be used */
56 #if defined(CLOCK_MONOTONIC_RAW) || defined(CLOCK_MONOTONIC)
57 static int _clock_source = 0;
58 #endif
59
60 /* subsystem definition */
61 static struct oonf_subsystem oonf_os_clock_subsystem = {
62   .name = OONF_OS_CLOCK_SUBSYSTEM,
63   .init = _init,
64   .no_logging = true,
65 };
66 DECLARE_OONF_PLUGIN(oonf_os_clock_subsystem);
67
68 /**
69  * Initialize os-specific subsystem
70  * @return always return 0
71  */
72 static int
73 _init(void) {
74   struct timespec ts;
75
76 #ifdef CLOCK_MONOTONIC_RAW
77   if (clock_gettime(CLOCK_MONOTONIC_RAW, &ts) == 0) {
78     _clock_source = CLOCK_MONOTONIC_RAW;
79   }
80 #endif
81 #ifdef CLOCK_MONOTONIC
82   if (_clock_source == 0 && clock_gettime(CLOCK_MONOTONIC, &ts) == 0) {
83     _clock_source = CLOCK_MONOTONIC;
84   }
85 #endif
86   return 0;
87 }
88
89 /**
90  * Reads the current time in nanoseconds as a monotonic timestamp
91  * @param t64 pointer to timestamp
92  * @return 0 if valid timestamp was read, negative otherwise
93  */
94 int
95 os_clock_linux_gettime64_ns(uint64_t *t64) {
96   int error;
97
98 #if defined(CLOCK_MONOTONIC_RAW) || defined(CLOCK_MONOTONIC)
99   if (_clock_source) {
100     struct timespec ts;
101
102     if ((error = clock_gettime(_clock_source, &ts)) != 0) {
103       return error;
104     }
105
106     *t64 = 1000000000ull * ts.tv_sec + ts.tv_nsec;
107     return 0;
108   }
109 #endif
110   return -1;
111 }
112
113 /**
114  * Reads the current time in milliseconds as a monotonic timestamp
115  * @param t64 pointer to timestamp
116  * @return 0 if valid timestamp was read, negative otherwise
117  */
118 int
119 os_clock_linux_gettime64(uint64_t *t64) {
120   static time_t offset = 0, last_sec = 0;
121   struct timeval tv;
122   int error;
123
124 #if defined(CLOCK_MONOTONIC_RAW) || defined(CLOCK_MONOTONIC)
125   if (_clock_source) {
126     struct timespec ts;
127
128     if ((error = clock_gettime(_clock_source, &ts)) != 0) {
129       return error;
130     }
131
132     *t64 = 1000ull * ts.tv_sec + ts.tv_nsec / 1000000ull;
133     return 0;
134   }
135 #endif
136   if ((error = gettimeofday(&tv, NULL)) != 0) {
137     return error;
138   }
139
140   tv.tv_sec += offset;
141   if (last_sec == 0) {
142     last_sec = tv.tv_sec;
143   }
144   if (tv.tv_sec < last_sec || tv.tv_sec > last_sec + 60) {
145     offset += last_sec - tv.tv_sec;
146     tv.tv_sec = last_sec;
147   }
148   last_sec = tv.tv_sec;
149
150   *t64 = 1000ull * tv.tv_sec + tv.tv_usec / 1000ull;
151   return 0;
152 }