add time util function.
This commit is contained in:
@@ -219,3 +219,28 @@ void TimeCtrl_SetOptimizeStep(TIMECTRL_INST* instPtr, TIME_FRAC* tmFrac) {
|
||||
ASSERT(tmFrac != NULL);
|
||||
TMC_Write(instPtr, CNTSTEP_OPT, *tmFrac);
|
||||
}
|
||||
|
||||
|
||||
/*****************************************************************************/
|
||||
/**
|
||||
* @brief Calculate tmA - tmA.
|
||||
*
|
||||
* @param tmA time stamp A
|
||||
* @param tmA time stamp B
|
||||
* @param tRound t round
|
||||
*
|
||||
* @return NONE
|
||||
*
|
||||
******************************************************************************/
|
||||
void TimeCtrl_CalculateTimeGap(const TIME_WORD *a, const TIME_WORD *b, TIME_WORD *gap){
|
||||
ASSERT(a != NULL);
|
||||
ASSERT(b != NULL);
|
||||
ASSERT(gap != NULL);
|
||||
uint64_t timeDiff;
|
||||
timeDiff = (uint64_t) b->frac_part;
|
||||
timeDiff += ((uint64_t)b->int_part) * COUNTE_FRAC_MAX;
|
||||
timeDiff -= ((uint64_t)a->int_part) * COUNTE_FRAC_MAX;
|
||||
timeDiff -= (uint64_t) a->frac_part;
|
||||
gap->frac_part = (TIME_FRAC)(timeDiff % COUNTE_FRAC_MAX);
|
||||
gap->frac_part = (TIME_INT)(timeDiff / COUNTE_FRAC_MAX);
|
||||
}
|
||||
Reference in New Issue
Block a user