1 /*
2 * SPDX-License-Identifier: BSD-3-Clause
3 *
4 * Copyright © 2021 Keith Packard
5 *
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions
8 * are met:
9 *
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 *
13 * 2. Redistributions in binary form must reproduce the above
14 * copyright notice, this list of conditions and the following
15 * disclaimer in the documentation and/or other materials provided
16 * with the distribution.
17 *
18 * 3. Neither the name of the copyright holder nor the names of its
19 * contributors may be used to endorse or promote products derived
20 * from this software without specific prior written permission.
21 *
22 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
23 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
24 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
25 * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
26 * COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT,
27 * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
28 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
29 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
30 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
31 * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
32 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED
33 * OF THE POSSIBILITY OF SUCH DAMAGE.
34 */
35
36 #include <sys/time.h>
37 #include "semihost.h"
38
39 int
gettimeofday(struct timeval * restrict tv,void * restrict tz)40 gettimeofday(struct timeval *restrict tv, void *restrict tz)
41 {
42 uint64_t ticks;
43 uint64_t elapsed;
44 static uint64_t start_elapsed;
45 static uint64_t start_ticks;
46 static uintptr_t tick_freq;
47 static int been_here;
48
49 (void) tz;
50 elapsed = sys_semihost_elapsed();
51 if (!been_here) {
52 start_elapsed = elapsed;
53 tick_freq = sys_semihost_tickfreq();
54 start_ticks = (uint64_t) sys_semihost_time() * tick_freq;
55 been_here = 1;
56 }
57
58 ticks = start_ticks + (elapsed - start_elapsed);
59
60 tv->tv_sec = (time_t) (ticks / tick_freq);
61 tv->tv_usec = (suseconds_t) (ticks % tick_freq) * 1000000 / tick_freq;
62 return 0;
63 }
64