mem: fix undefined behavior in NUMA-aware mapping
[dpdk.git] / lib / librte_eal / linuxapp / eal / eal_timer.c
1 /* SPDX-License-Identifier: BSD-3-Clause
2  * Copyright(c) 2010-2014 Intel Corporation.
3  * Copyright(c) 2012-2013 6WIND S.A.
4  */
5
6 #include <string.h>
7 #include <stdlib.h>
8 #include <stdio.h>
9 #include <stdint.h>
10 #include <unistd.h>
11 #include <fcntl.h>
12 #include <inttypes.h>
13 #include <sys/mman.h>
14 #include <sys/queue.h>
15 #include <pthread.h>
16 #include <errno.h>
17
18 #include <rte_common.h>
19 #include <rte_log.h>
20 #include <rte_cycles.h>
21 #include <rte_lcore.h>
22 #include <rte_memory.h>
23 #include <rte_eal.h>
24 #include <rte_debug.h>
25
26 #include "eal_private.h"
27 #include "eal_internal_cfg.h"
28
29 enum timer_source eal_timer_source = EAL_TIMER_HPET;
30
31 #ifdef RTE_LIBEAL_USE_HPET
32
33 #define DEV_HPET "/dev/hpet"
34
35 /* Maximum number of counters. */
36 #define HPET_TIMER_NUM 3
37
38 /* General capabilities register */
39 #define CLK_PERIOD_SHIFT     32 /* Clock period shift. */
40 #define CLK_PERIOD_MASK      0xffffffff00000000ULL /* Clock period mask. */
41
42 /**
43  * HPET timer registers. From the Intel IA-PC HPET (High Precision Event
44  * Timers) Specification.
45  */
46 struct eal_hpet_regs {
47         /* Memory-mapped, software visible registers */
48         uint64_t capabilities;      /**< RO General Capabilities Register. */
49         uint64_t reserved0;         /**< Reserved for future use. */
50         uint64_t config;            /**< RW General Configuration Register. */
51         uint64_t reserved1;         /**< Reserved for future use. */
52         uint64_t isr;               /**< RW Clear General Interrupt Status. */
53         uint64_t reserved2[25];     /**< Reserved for future use. */
54         union {
55                 uint64_t counter;   /**< RW Main Counter Value Register. */
56                 struct {
57                         uint32_t counter_l; /**< RW Main Counter Low. */
58                         uint32_t counter_h; /**< RW Main Counter High. */
59                 };
60         };
61         uint64_t reserved3;         /**< Reserved for future use. */
62         struct {
63                 uint64_t config;    /**< RW Timer Config and Capability Reg. */
64                 uint64_t comp;      /**< RW Timer Comparator Value Register. */
65                 uint64_t fsb;       /**< RW FSB Interrupt Route Register. */
66                 uint64_t reserved4; /**< Reserved for future use. */
67         } timers[HPET_TIMER_NUM]; /**< Set of HPET timers. */
68 };
69
70 /* Mmap'd hpet registers */
71 static volatile struct eal_hpet_regs *eal_hpet = NULL;
72
73 /* Period at which the HPET counter increments in
74  * femtoseconds (10^-15 seconds). */
75 static uint32_t eal_hpet_resolution_fs = 0;
76
77 /* Frequency of the HPET counter in Hz */
78 static uint64_t eal_hpet_resolution_hz = 0;
79
80 /* Incremented 4 times during one 32bits hpet full count */
81 static uint32_t eal_hpet_msb;
82
83 static pthread_t msb_inc_thread_id;
84
85 /*
86  * This function runs on a specific thread to update a global variable
87  * containing used to process MSB of the HPET (unfortunately, we need
88  * this because hpet is 32 bits by default under linux).
89  */
90 static void
91 hpet_msb_inc(__attribute__((unused)) void *arg)
92 {
93         uint32_t t;
94
95         while (1) {
96                 t = (eal_hpet->counter_l >> 30);
97                 if (t != (eal_hpet_msb & 3))
98                         eal_hpet_msb ++;
99                 sleep(10);
100         }
101 }
102
103 uint64_t
104 rte_get_hpet_hz(void)
105 {
106         if(internal_config.no_hpet)
107                 rte_panic("Error, HPET called, but no HPET present\n");
108
109         return eal_hpet_resolution_hz;
110 }
111
112 uint64_t
113 rte_get_hpet_cycles(void)
114 {
115         uint32_t t, msb;
116         uint64_t ret;
117
118         if(internal_config.no_hpet)
119                 rte_panic("Error, HPET called, but no HPET present\n");
120
121         t = eal_hpet->counter_l;
122         msb = eal_hpet_msb;
123         ret = (msb + 2 - (t >> 30)) / 4;
124         ret <<= 32;
125         ret += t;
126         return ret;
127 }
128
129 #endif
130
131 #ifdef RTE_LIBEAL_USE_HPET
132 /*
133  * Open and mmap /dev/hpet (high precision event timer) that will
134  * provide our time reference.
135  */
136 int
137 rte_eal_hpet_init(int make_default)
138 {
139         int fd, ret;
140
141         if (internal_config.no_hpet) {
142                 RTE_LOG(NOTICE, EAL, "HPET is disabled\n");
143                 return -1;
144         }
145
146         fd = open(DEV_HPET, O_RDONLY);
147         if (fd < 0) {
148                 RTE_LOG(ERR, EAL, "ERROR: Cannot open "DEV_HPET": %s!\n",
149                         strerror(errno));
150                 internal_config.no_hpet = 1;
151                 return -1;
152         }
153         eal_hpet = mmap(NULL, 1024, PROT_READ, MAP_SHARED, fd, 0);
154         if (eal_hpet == MAP_FAILED) {
155                 RTE_LOG(ERR, EAL, "ERROR: Cannot mmap "DEV_HPET"!\n"
156                                 "Please enable CONFIG_HPET_MMAP in your kernel configuration "
157                                 "to allow HPET support.\n"
158                                 "To run without using HPET, set CONFIG_RTE_LIBEAL_USE_HPET=n "
159                                 "in your build configuration or use '--no-hpet' EAL flag.\n");
160                 close(fd);
161                 internal_config.no_hpet = 1;
162                 return -1;
163         }
164         close(fd);
165
166         eal_hpet_resolution_fs = (uint32_t)((eal_hpet->capabilities &
167                                         CLK_PERIOD_MASK) >>
168                                         CLK_PERIOD_SHIFT);
169
170         eal_hpet_resolution_hz = (1000ULL*1000ULL*1000ULL*1000ULL*1000ULL) /
171                 (uint64_t)eal_hpet_resolution_fs;
172
173         RTE_LOG(INFO, EAL, "HPET frequency is ~%"PRIu64" kHz\n",
174                         eal_hpet_resolution_hz/1000);
175
176         eal_hpet_msb = (eal_hpet->counter_l >> 30);
177
178         /* create a thread that will increment a global variable for
179          * msb (hpet is 32 bits by default under linux) */
180         ret = rte_ctrl_thread_create(&msb_inc_thread_id, "hpet-msb-inc", NULL,
181                         (void *(*)(void *))hpet_msb_inc, NULL);
182         if (ret != 0) {
183                 RTE_LOG(ERR, EAL, "ERROR: Cannot create HPET timer thread!\n");
184                 internal_config.no_hpet = 1;
185                 return -1;
186         }
187
188         if (make_default)
189                 eal_timer_source = EAL_TIMER_HPET;
190         return 0;
191 }
192 #endif
193
194 static void
195 check_tsc_flags(void)
196 {
197         char line[512];
198         FILE *stream;
199
200         stream = fopen("/proc/cpuinfo", "r");
201         if (!stream) {
202                 RTE_LOG(WARNING, EAL, "WARNING: Unable to open /proc/cpuinfo\n");
203                 return;
204         }
205
206         while (fgets(line, sizeof line, stream)) {
207                 char *constant_tsc;
208                 char *nonstop_tsc;
209
210                 if (strncmp(line, "flags", 5) != 0)
211                         continue;
212
213                 constant_tsc = strstr(line, "constant_tsc");
214                 nonstop_tsc = strstr(line, "nonstop_tsc");
215                 if (!constant_tsc || !nonstop_tsc)
216                         RTE_LOG(WARNING, EAL,
217                                 "WARNING: cpu flags "
218                                 "constant_tsc=%s "
219                                 "nonstop_tsc=%s "
220                                 "-> using unreliable clock cycles !\n",
221                                 constant_tsc ? "yes":"no",
222                                 nonstop_tsc ? "yes":"no");
223                 break;
224         }
225
226         fclose(stream);
227 }
228
229 uint64_t
230 get_tsc_freq(void)
231 {
232 #ifdef CLOCK_MONOTONIC_RAW
233 #define NS_PER_SEC 1E9
234
235         struct timespec sleeptime = {.tv_nsec = NS_PER_SEC / 10 }; /* 1/10 second */
236
237         struct timespec t_start, t_end;
238         uint64_t tsc_hz;
239
240         if (clock_gettime(CLOCK_MONOTONIC_RAW, &t_start) == 0) {
241                 uint64_t ns, end, start = rte_rdtsc();
242                 nanosleep(&sleeptime,NULL);
243                 clock_gettime(CLOCK_MONOTONIC_RAW, &t_end);
244                 end = rte_rdtsc();
245                 ns = ((t_end.tv_sec - t_start.tv_sec) * NS_PER_SEC);
246                 ns += (t_end.tv_nsec - t_start.tv_nsec);
247
248                 double secs = (double)ns/NS_PER_SEC;
249                 tsc_hz = (uint64_t)((end - start)/secs);
250                 return tsc_hz;
251         }
252 #endif
253         return 0;
254 }
255
256 int
257 rte_eal_timer_init(void)
258 {
259
260         eal_timer_source = EAL_TIMER_TSC;
261
262         set_tsc_freq();
263         check_tsc_flags();
264         return 0;
265 }