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