| /* |
| * 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; |
| } |