1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
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
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
|
/*
* Copyright (C) 2011 The Android Open Source Project
*
* Licensed under the Apache License, Version 2.0 (the "License");
* you may not use this file except in compliance with the License.
* You may obtain a copy of the License at
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS,
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
* See the License for the specific language governing permissions and
* limitations under the License.
*/
/**
************************************************************************
* @file M4OSA_Clock.c
* @brief Clock related functions
* @note This file implements functions to manipulate clock
************************************************************************
*/
#include <sys/time.h>
#include <time.h>
#include "M4OSA_Debug.h"
#include "M4OSA_Clock.h"
#include "M4OSA_Memory.h"
#include "M4OSA_Types.h"
/**
************************************************************************
* @brief This function gets an absolute time to an unknown reference with
* a high precision.
* @note It means it can only be used to get a relative time by computing
* differences between to times.
* It is to the caller to allocate time. Time is expressed in
* timescale unit.
* M4OSA_ROLLOVER_CLOCK in M4OSA_Types.h must be configured with the rollover
* offset of this function.
* @param time: (IN/OUT) time
* @param timescale: (IN) The timescale (time unit per second)
* @return M4NO_ERROR: there is no error
* @return M4ERR_PARAMETER: at least one parameter is NULL
* @return M4WAR_TIMESCALE_TOO_BIG: the precision of the system clock is
* not
* compliant with the input timescale
************************************************************************
*/
M4OSA_ERR M4OSA_clockGetTime(M4OSA_Time* pTime, M4OSA_UInt32 timescale)
{
struct timeval tv;
struct timezone tz;
M4OSA_UInt32 u32_time = 0;
M4OSA_UInt32 u32_time_hi;
M4OSA_UInt32 u32_time_lo;
M4OSA_UInt32 u32_time_lh;
M4OSA_UInt32 factor;
M4OSA_TRACE1_2("M4OSA_clockGetTime\t\tM4OSA_Time* 0x%x\tM4OSA_UInt32 %d",
pTime, timescale);
M4OSA_DEBUG_IF2(M4OSA_NULL == pTime, M4ERR_PARAMETER,
"M4OSA_clockGetTime: pTime is M4OSA_NULL");
M4OSA_DEBUG_IF2(0 == timescale, M4ERR_PARAMETER,
"M4OSA_clockGetTime: timescale is 0");
factor = 1000000 / timescale;
if(gettimeofday(&tv, &tz) == 0)
{
u32_time_lo = (tv.tv_sec & 0xFFFF) * timescale;
u32_time_hi = (((tv.tv_sec >> 16) & 0xFFFF) * timescale) + ((u32_time_lo >> 16) & 0xFFFF);
u32_time_lo &= 0xFFFF;
u32_time_lo += tv.tv_usec / factor;
u32_time_hi += ((u32_time_lo >> 16) & 0xFFFF);
u32_time_lo &= 0xFFFF;
u32_time = ((u32_time_hi & 0x7FFF) << 16) | u32_time_lo;
}
/* M4OSA_Time is signed, so we need to check the max value*/
if (u32_time > M4OSA_INT32_MAX)
{
u32_time = u32_time - M4OSA_INT32_MAX;
}
*pTime = (M4OSA_Time)u32_time;
if( timescale > 10000 )
{
return M4WAR_TIMESCALE_TOO_BIG;
}
return M4NO_ERROR;
}
|
