/******************************************************************************
*
-* Copyright (c) 2019 Intel.
+* Copyright (c) 2020 Intel.
*
* Licensed under the Apache License, Version 2.0 (the "License");
* you may not use this file except in compliance with the License.
#include <stdio.h>
#include <stdlib.h>
#include <stdint.h>
-
+#include <immintrin.h>
#include "xran_timer.h"
#include "xran_printf.h"
#include "xran_mlog_lnx.h"
static struct timespec last_time;
static struct timespec cur_time;
+static uint64_t curr_tick;
+static uint64_t last_tick;
+
static struct timespec* p_cur_time = &cur_time;
static struct timespec* p_last_time = &last_time;
+
static struct timespec* p_temp_time;
-static unsigned long current_second = 0;
+static struct timespec sleeptime = {.tv_nsec = 1E3 }; /* 1 us */
+
+volatile static unsigned long current_second = 0;
static unsigned long started_second = 0;
static uint8_t numerlogy = 0;
-extern uint32_t xran_lib_ota_sym;
-extern uint32_t xran_lib_ota_tti;
-extern uint32_t xran_lib_ota_sym_idx;
+extern uint32_t xran_lib_ota_sym[];
+extern uint32_t xran_lib_ota_tti[];
+extern uint32_t xran_lib_ota_sym_idx[];
static int debugStop = 0;
static int debugStopCount = 0;
return current_second;
}
+uint32_t xran_max_ota_sym_idx(uint8_t numerlogy)
+{
+ return (XRAN_NUM_OF_SYMBOL_PER_SLOT * slots_per_subframe[numerlogy] * MSEC_PER_SEC);
+}
+
int timing_set_numerology(uint8_t value)
{
numerlogy = value;
return numerlogy;
}
+uint8_t timing_get_numerology(void)
+{
+ return numerlogy;
+}
int timing_set_debug_stop(int value, int count)
{
return debugStop;
}
-long poll_next_tick(long interval_ns)
+void timing_adjust_gps_second(struct timespec* p_time)
{
+ struct xran_device_ctx * p_xran_dev_ctx = xran_dev_get_ctx();
+
+ if (p_time->tv_nsec >= p_xran_dev_ctx->offset_nsec)
+ {
+ p_time->tv_nsec -= p_xran_dev_ctx->offset_nsec;
+ p_time->tv_sec -= p_xran_dev_ctx->offset_sec;
+ }
+ else
+ {
+ p_time->tv_nsec += 1e9 - p_xran_dev_ctx->offset_nsec;
+ p_time->tv_sec -= p_xran_dev_ctx->offset_sec + 1;
+ }
+
+ return;
+}
+uint64_t xran_tick(void)
+{
+ uint32_t hi, lo;
+ __asm volatile ("rdtsc" : "=a"(lo), "=d"(hi));
+ return ( (uint64_t)lo)|( ((uint64_t)hi)<<32 );
+}
+
+unsigned long get_ticks_diff(unsigned long curr_tick, unsigned long last_tick)
+{
+ if (curr_tick >= last_tick)
+ return (unsigned long)(curr_tick - last_tick);
+ else
+ return (unsigned long)(0xFFFFFFFFFFFFFFFF - last_tick + curr_tick);
+}
+extern uint16_t xran_getSfnSecStart(void);
+
+long poll_next_tick(long interval_ns, unsigned long *used_tick)
+{
+ struct xran_ethdi_ctx *p_eth = xran_ethdi_get_ctx();
+ struct xran_io_cfg *p_io_cfg = &(p_eth->io_cfg);
+ struct xran_device_ctx * p_xran_dev_ctx = xran_dev_get_ctx();
+ struct xran_common_counters* pCnt = &p_xran_dev_ctx->fh_counters;
+
long target_time;
- long delta;
+ long delta, tm_threshold_high, tm_threshold_low;//Update tm threhsolds
static int counter = 0;
static long sym_acc = 0;
static long sym_cnt = 0;
+ int i;
- if(counter){
+ if(counter == 0) {
clock_gettime(CLOCK_REALTIME, p_last_time);
+ last_tick = MLogTick();
+ if(unlikely(p_xran_dev_ctx->offset_sec || p_xran_dev_ctx->offset_nsec))
+ timing_adjust_gps_second(p_last_time);
current_second = p_last_time->tv_sec;
counter = 1;
}
target_time = (p_last_time->tv_sec * NSEC_PER_SEC + p_last_time->tv_nsec + interval_ns);
- while(1)
- {
+ while(1) {
clock_gettime(CLOCK_REALTIME, p_cur_time);
+ curr_tick = MLogTick();
+ if(unlikely(p_xran_dev_ctx->offset_sec || p_xran_dev_ctx->offset_nsec))
+ timing_adjust_gps_second(p_cur_time);
delta = (p_cur_time->tv_sec * NSEC_PER_SEC + p_cur_time->tv_nsec) - target_time;
- if(delta > 0 || (delta < 0 && abs(delta) < THRESHOLD)) {
- if (debugStop &&(debugStopCount > 0) && (tx_counter >= debugStopCount)){
+ tm_threshold_high = interval_ns * N_SYM_PER_SLOT * 2;//2 slots
+ tm_threshold_low = interval_ns * 2; //2 symbols
+ //add tm exception handling
+ if (unlikely(labs(delta) > tm_threshold_low)) {
+ print_dbg("poll_next_tick exceed 2 symbols threshold with delta:%ld(ns), used_tick:%ld(tick) \n", delta, used_tick);
+ pCnt->timer_missed_sym++;
+ if(unlikely(labs(delta) > tm_threshold_high)) {
+ print_dbg("poll_next_tick exceed 2 slots threshold, stop xran! delta:%ld(ns), used_tick:%ld(tick) \n", delta, used_tick);
+ //xran_if_current_state = XRAN_STOPPED;
+ pCnt->timer_missed_slot++;
+ }
+ }
+ if(delta > 0 || (delta < 0 && labs(delta) < THRESHOLD)) {
+ if (debugStop &&(debugStopCount > 0) && (pCnt->tx_counter >= debugStopCount)){
uint64_t t1;
- printf("STOP:[%ld.%09ld], debugStopCount %d, tx_counter %ld\n", p_cur_time->tv_sec, p_cur_time->tv_nsec, debugStopCount, tx_counter);
+ printf("STOP:[%ld.%09ld], debugStopCount %d, tx_counter %ld\n", p_cur_time->tv_sec, p_cur_time->tv_nsec, debugStopCount, pCnt->tx_counter);
t1 = MLogTick();
rte_pause();
MLogTask(PID_TIME_SYSTIME_STOP, t1, MLogTick());
}
if(current_second != p_cur_time->tv_sec){
current_second = p_cur_time->tv_sec;
- xran_lib_ota_sym_idx = 0;
- xran_lib_ota_tti = 0;
- xran_lib_ota_sym = 0;
+ xran_updateSfnSecStart();
+ for (i=0; i < XRAN_PORTS_NUM; i++)
+ {
+ xran_lib_ota_tti[i] = 0;
+ xran_lib_ota_sym[i] = 0;
+ xran_lib_ota_sym_idx[i] = 0;
+ }
sym_cnt = 0;
sym_acc = 0;
print_dbg("ToS:C Sync timestamp: [%ld.%09ld]\n", p_cur_time->tv_sec, p_cur_time->tv_nsec);
if(debugStop){
if(p_cur_time->tv_sec > started_second && ((p_cur_time->tv_sec % SEC_MOD_STOP) == 0)){
uint64_t t1;
- printf("STOP:[%ld.%09ld]\n", p_cur_time->tv_sec, p_cur_time->tv_nsec);
+ uint32_t tti = xran_lib_ota_tti[0];
+ uint32_t slot_id = XranGetSlotNum(tti, SLOTNUM_PER_SUBFRAME(interval_us));
+ uint32_t subframe_id = XranGetSubFrameNum(tti,SLOTNUM_PER_SUBFRAME(interval_us), SUBFRAMES_PER_SYSTEMFRAME);
+ uint32_t frame_id = XranGetFrameNum(tti,xran_getSfnSecStart(),SUBFRAMES_PER_SYSTEMFRAME, SLOTNUM_PER_SUBFRAME(interval_us));
+ printf("STOP:[%ld.%09ld] (%d : %d : %d)\n", p_cur_time->tv_sec, p_cur_time->tv_nsec,frame_id, subframe_id, slot_id);
t1 = MLogTick();
rte_pause();
MLogTask(PID_TIME_SYSTIME_STOP, t1, MLogTick());
}
p_cur_time->tv_nsec = 0; // adjust to 1pps
} else {
- xran_lib_ota_sym_idx = XranIncrementSymIdx(xran_lib_ota_sym_idx, XRAN_NUM_OF_SYMBOL_PER_SLOT*slots_per_subframe[numerlogy]);
+ xran_lib_ota_sym_idx[0] = XranIncrementSymIdx(xran_lib_ota_sym_idx[0], XRAN_NUM_OF_SYMBOL_PER_SLOT*slots_per_subframe[numerlogy]);
+ for (i=1; i < p_xran_dev_ctx->fh_init.xran_ports; i++)
+ {
+ struct xran_device_ctx * p_other_ctx = xran_dev_get_ctx_by_id(i);
+ if(p_other_ctx)
+ xran_lib_ota_sym_idx[i] = xran_lib_ota_sym_idx[0] >> (numerlogy - xran_get_conf_numerology(p_other_ctx));
+ }
/* adjust to sym boundary */
if(sym_cnt & 1)
sym_acc += fine_tuning[numerlogy][0];
p_cur_time->tv_nsec = sym_acc;
sym_cnt++;
}
+
+#ifdef USE_PTP_TIME
if(debugStop && delta < interval_ns*10)
MLogTask(PID_TIME_SYSTIME_POLL, (p_last_time->tv_sec * NSEC_PER_SEC + p_last_time->tv_nsec), (p_cur_time->tv_sec * NSEC_PER_SEC + p_cur_time->tv_nsec));
+#else
+ MLogXRANTask(PID_TIME_SYSTIME_POLL, last_tick, curr_tick);
+ last_tick = curr_tick;
+#endif
+
+
p_temp_time = p_last_time;
p_last_time = p_cur_time;
p_cur_time = p_temp_time;
break;
} else {
- if( likely(xran_if_current_state == XRAN_RUNNING)){
- ring_processing_func();
- process_dpdk_io();
+ if(likely((xran_if_current_state == XRAN_RUNNING)||(xran_if_current_state == XRAN_OWDM))){
+ uint64_t t1, t2;
+ t1 = xran_tick();
+
+ if(p_eth->time_wrk_cfg.f)
+ p_eth->time_wrk_cfg.f(p_eth->time_wrk_cfg.arg);
+
+ if(p_io_cfg->io_sleep)
+ nanosleep(&sleeptime,NULL);
+
+ t2 = xran_tick();
+ *used_tick += get_ticks_diff(t2, t1);
}
+
}
}
Code Review / o-du / phy.git / blobdiff