-/******************************************************************************\r
-*\r
-* Copyright (c) 2019 Intel.\r
-*\r
-* Licensed under the Apache License, Version 2.0 (the "License");\r
-* you may not use this file except in compliance with the License.\r
-* You may obtain a copy of the License at\r
-*\r
-* http://www.apache.org/licenses/LICENSE-2.0\r
-*\r
-* Unless required by applicable law or agreed to in writing, software\r
-* distributed under the License is distributed on an "AS IS" BASIS,\r
-* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.\r
-* See the License for the specific language governing permissions and\r
-* limitations under the License.\r
-*\r
-*******************************************************************************/\r
-\r
-/**\r
- * @brief This file provides implementation to Timing for XRAN.\r
- *\r
- * @file xran_timer.c\r
- * @ingroup group_lte_source_xran\r
- * @author Intel Corporation\r
- *\r
- **/\r
-\r
-#include <time.h>\r
-#include <stdio.h>\r
-#include <stdlib.h>\r
-#include <stdint.h>\r
-\r
-#include "xran_timer.h"\r
-#include "xran_printf.h"\r
-#include "xran_mlog_lnx.h"\r
-#include "xran_lib_mlog_tasks_id.h"\r
-#include "ethdi.h"\r
-#include "xran_fh_o_du.h"\r
-#include "xran_common.h"\r
-\r
-#define NSEC_PER_SEC 1000000000L\r
-#define NSEC_PER_USEC 1000L\r
-#define THRESHOLD 35 /**< the avg cost of clock_gettime() in ns */\r
-#define TIMECOMPENSATION 2 /**< time compensation in us, avg latency of clock_nanosleep */\r
-\r
-#define SEC_MOD_STOP (60)\r
-\r
-static struct timespec started_time;\r
-static struct timespec last_time;\r
-static struct timespec cur_time;\r
-\r
-static uint64_t curr_tick;\r
-static uint64_t last_tick;\r
-\r
-static struct timespec* p_cur_time = &cur_time;\r
-static struct timespec* p_last_time = &last_time;\r
-\r
-\r
-static struct timespec* p_temp_time;\r
-\r
-static unsigned long current_second = 0;\r
-static unsigned long started_second = 0;\r
-static uint8_t numerlogy = 0;\r
-extern uint32_t xran_lib_ota_sym;\r
-extern uint32_t xran_lib_ota_tti;\r
-extern uint32_t xran_lib_ota_sym_idx;\r
-\r
-static int debugStop = 0;\r
-static int debugStopCount = 0;\r
-\r
-static long fine_tuning[5][2] =\r
-{\r
- {71428L, 71429L}, /* mu = 0 */\r
- {35714L, 35715L}, /* mu = 1 */\r
- {0, 0}, /* mu = 2 not supported */\r
- {8928L, 8929L}, /* mu = 3 */\r
- {0,0 } /* mu = 4 not supported */\r
-};\r
-\r
-static uint8_t slots_per_subframe[4] =\r
-{\r
- 1, /* mu = 0 */\r
- 2, /* mu = 1 */\r
- 4, /* mu = 2 */\r
- 8, /* mu = 3 */\r
-};\r
-\r
-uint64_t timing_get_current_second(void)\r
-{\r
- return current_second;\r
-}\r
-\r
-int timing_set_numerology(uint8_t value)\r
-{\r
- numerlogy = value;\r
- return numerlogy;\r
-}\r
-\r
-int timing_set_debug_stop(int value, int count)\r
-{\r
- debugStop = value;\r
- debugStopCount = count;\r
-\r
- if(debugStop){\r
- clock_gettime(CLOCK_REALTIME, &started_time);\r
- started_second =started_time.tv_sec;\r
- }\r
- return debugStop;\r
-}\r
-\r
-int timing_get_debug_stop(void)\r
-{\r
- return debugStop;\r
-}\r
-\r
-void timing_adjust_gps_second(struct timespec* p_time)\r
-{\r
- struct xran_device_ctx * p_xran_dev_ctx = xran_dev_get_ctx();\r
-\r
- long nsec = p_time->tv_nsec + p_xran_dev_ctx->offset_nsec;\r
- p_time->tv_sec += p_xran_dev_ctx->offset_sec;\r
- if (nsec >= 1e9)\r
- {\r
- nsec -=1e9;\r
- p_time->tv_sec += 1;\r
- }\r
- p_time->tv_nsec = nsec;\r
-\r
- return;\r
-}\r
-uint64_t xran_tick(void)\r
-{\r
- uint32_t hi, lo;\r
- __asm volatile ("rdtsc" : "=a"(lo), "=d"(hi));\r
- return ( (uint64_t)lo)|( ((uint64_t)hi)<<32 );\r
-}\r
-\r
-unsigned long get_ticks_diff(unsigned long curr_tick, unsigned long last_tick)\r
-{\r
- if (curr_tick >= last_tick)\r
- return (unsigned long)(curr_tick - last_tick);\r
- else\r
- return (unsigned long)(0xFFFFFFFFFFFFFFFF - last_tick + curr_tick);\r
-}\r
-\r
-long poll_next_tick(long interval_ns, unsigned long *used_tick)\r
-{\r
- struct xran_device_ctx * p_xran_dev_ctx = xran_dev_get_ctx();\r
- long target_time;\r
- long delta;\r
- static int counter = 0;\r
- static long sym_acc = 0;\r
- static long sym_cnt = 0;\r
-\r
- if(counter == 0) {\r
- clock_gettime(CLOCK_REALTIME, p_last_time);\r
- last_tick = MLogTick();\r
- if(unlikely(p_xran_dev_ctx->offset_sec || p_xran_dev_ctx->offset_nsec))\r
- timing_adjust_gps_second(p_last_time);\r
- current_second = p_last_time->tv_sec;\r
- counter = 1;\r
- }\r
-\r
- target_time = (p_last_time->tv_sec * NSEC_PER_SEC + p_last_time->tv_nsec + interval_ns);\r
-\r
- while(1) {\r
- clock_gettime(CLOCK_REALTIME, p_cur_time);\r
- curr_tick = MLogTick();\r
- if(unlikely(p_xran_dev_ctx->offset_sec || p_xran_dev_ctx->offset_nsec))\r
- timing_adjust_gps_second(p_cur_time);\r
- delta = (p_cur_time->tv_sec * NSEC_PER_SEC + p_cur_time->tv_nsec) - target_time;\r
- if(delta > 0 || (delta < 0 && abs(delta) < THRESHOLD)) {\r
- if (debugStop &&(debugStopCount > 0) && (tx_counter >= debugStopCount)){\r
- uint64_t t1;\r
- printf("STOP:[%ld.%09ld], debugStopCount %d, tx_counter %ld\n", p_cur_time->tv_sec, p_cur_time->tv_nsec, debugStopCount, tx_counter);\r
- t1 = MLogTick();\r
- rte_pause();\r
- MLogTask(PID_TIME_SYSTIME_STOP, t1, MLogTick());\r
- xran_if_current_state = XRAN_STOPPED;\r
- }\r
- if(current_second != p_cur_time->tv_sec){\r
- current_second = p_cur_time->tv_sec;\r
- xran_updateSfnSecStart();\r
- xran_lib_ota_sym_idx = 0;\r
- xran_lib_ota_tti = 0;\r
- xran_lib_ota_sym = 0;\r
- sym_cnt = 0;\r
- sym_acc = 0;\r
- print_dbg("ToS:C Sync timestamp: [%ld.%09ld]\n", p_cur_time->tv_sec, p_cur_time->tv_nsec);\r
- if(debugStop){\r
- if(p_cur_time->tv_sec > started_second && ((p_cur_time->tv_sec % SEC_MOD_STOP) == 0)){\r
- uint64_t t1;\r
- printf("STOP:[%ld.%09ld]\n", p_cur_time->tv_sec, p_cur_time->tv_nsec);\r
- t1 = MLogTick();\r
- rte_pause();\r
- MLogTask(PID_TIME_SYSTIME_STOP, t1, MLogTick());\r
- xran_if_current_state = XRAN_STOPPED;\r
- }\r
- }\r
- p_cur_time->tv_nsec = 0; // adjust to 1pps\r
- } else {\r
- xran_lib_ota_sym_idx = XranIncrementSymIdx(xran_lib_ota_sym_idx, XRAN_NUM_OF_SYMBOL_PER_SLOT*slots_per_subframe[numerlogy]);\r
- /* adjust to sym boundary */\r
- if(sym_cnt & 1)\r
- sym_acc += fine_tuning[numerlogy][0];\r
- else\r
- sym_acc += fine_tuning[numerlogy][1];\r
- /* fine tune to second boundary */\r
- if(sym_cnt % 13 == 0)\r
- sym_acc += 1;\r
-\r
- p_cur_time->tv_nsec = sym_acc;\r
- sym_cnt++;\r
- }\r
-\r
-#ifdef USE_PTP_TIME\r
- if(debugStop && delta < interval_ns*10)\r
- 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));\r
-#else\r
- MLogTask(PID_TIME_SYSTIME_POLL, last_tick, curr_tick);\r
- last_tick = curr_tick;\r
-#endif\r
-\r
-\r
- p_temp_time = p_last_time;\r
- p_last_time = p_cur_time;\r
- p_cur_time = p_temp_time;\r
- break;\r
- } else {\r
- if( likely(xran_if_current_state == XRAN_RUNNING)){\r
- uint64_t t1, t2;\r
- t1 = xran_tick();\r
-\r
- ring_processing_func();\r
- process_dpdk_io();\r
-\r
- t2 = xran_tick();\r
- *used_tick += get_ticks_diff(t2, t1);\r
- }\r
- }\r
- }\r
-\r
- return delta;\r
-}\r
-\r
-long sleep_next_tick(long interval)\r
-{\r
- struct timespec start_time;\r
- struct timespec cur_time;\r
- //struct timespec target_time_convert;\r
- struct timespec sleep_target_time_convert;\r
- long target_time;\r
- long sleep_target_time;\r
- long delta;\r
-\r
- clock_gettime(CLOCK_REALTIME, &start_time);\r
- target_time = (start_time.tv_sec * NSEC_PER_SEC + start_time.tv_nsec + interval * NSEC_PER_USEC) / (interval * NSEC_PER_USEC) * interval;\r
- //printf("target: %ld, current: %ld, %ld\n", target_time, start_time.tv_sec, start_time.tv_nsec);\r
- sleep_target_time = target_time - TIMECOMPENSATION;\r
- sleep_target_time_convert.tv_sec = sleep_target_time * NSEC_PER_USEC / NSEC_PER_SEC;\r
- sleep_target_time_convert.tv_nsec = (sleep_target_time * NSEC_PER_USEC) % NSEC_PER_SEC;\r
-\r
- //target_time_convert.tv_sec = target_time * NSEC_PER_USEC / NSEC_PER_SEC;\r
- //target_time_convert.tv_nsec = (target_time * NSEC_PER_USEC) % NSEC_PER_SEC;\r
-\r
- clock_nanosleep(CLOCK_REALTIME, TIMER_ABSTIME, &sleep_target_time_convert, NULL);\r
-\r
- clock_gettime(CLOCK_REALTIME, &cur_time);\r
-\r
- delta = (cur_time.tv_sec * NSEC_PER_SEC + cur_time.tv_nsec) - target_time * NSEC_PER_USEC;\r
-\r
- return delta;\r
-}\r
-\r
-\r
-\r
+/******************************************************************************
+*
+* 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.
+* 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.
+*
+*******************************************************************************/
+
+/**
+ * @brief This file provides implementation to Timing for XRAN.
+ *
+ * @file xran_timer.c
+ * @ingroup group_lte_source_xran
+ * @author Intel Corporation
+ *
+ **/
+
+#include <time.h>
+#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"
+#include "xran_lib_mlog_tasks_id.h"
+#include "ethdi.h"
+#include "xran_fh_o_du.h"
+#include "xran_common.h"
+
+#define NSEC_PER_SEC 1000000000L
+#define NSEC_PER_USEC 1000L
+#define THRESHOLD 35 /**< the avg cost of clock_gettime() in ns */
+#define TIMECOMPENSATION 2 /**< time compensation in us, avg latency of clock_nanosleep */
+
+#define SEC_MOD_STOP (60)
+
+static struct timespec started_time;
+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 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[];
+
+static int debugStop = 0;
+static int debugStopCount = 0;
+
+static long fine_tuning[5][2] =
+{
+ {71428L, 71429L}, /* mu = 0 */
+ {35714L, 35715L}, /* mu = 1 */
+ {0, 0}, /* mu = 2 not supported */
+ {8928L, 8929L}, /* mu = 3 */
+ {0,0 } /* mu = 4 not supported */
+};
+
+static uint8_t slots_per_subframe[4] =
+{
+ 1, /* mu = 0 */
+ 2, /* mu = 1 */
+ 4, /* mu = 2 */
+ 8, /* mu = 3 */
+};
+
+uint64_t timing_get_current_second(void)
+{
+ 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)
+{
+ debugStop = value;
+ debugStopCount = count;
+
+ if(debugStop){
+ clock_gettime(CLOCK_REALTIME, &started_time);
+ started_second =started_time.tv_sec;
+ }
+ return debugStop;
+}
+
+int timing_get_debug_stop(void)
+{
+ return debugStop;
+}
+
+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;
+ static int counter = 0;
+ static long sym_acc = 0;
+ static long sym_cnt = 0;
+ int i;
+
+ 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) {
+ 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) && (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, pCnt->tx_counter);
+ t1 = MLogTick();
+ rte_pause();
+ MLogTask(PID_TIME_SYSTIME_STOP, t1, MLogTick());
+ xran_if_current_state = XRAN_STOPPED;
+ }
+ if(current_second != p_cur_time->tv_sec){
+ current_second = p_cur_time->tv_sec;
+ 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;
+ 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());
+ xran_if_current_state = XRAN_STOPPED;
+ }
+ }
+ p_cur_time->tv_nsec = 0; // adjust to 1pps
+ } else {
+ 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);
+ 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];
+ else
+ sym_acc += fine_tuning[numerlogy][1];
+ /* fine tune to second boundary */
+ if(sym_cnt % 13 == 0)
+ sym_acc += 1;
+
+ 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
+ MLogTask(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)||(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);
+ }
+
+ }
+ }
+
+ return delta;
+}
+
+long sleep_next_tick(long interval)
+{
+ struct timespec start_time;
+ struct timespec cur_time;
+ //struct timespec target_time_convert;
+ struct timespec sleep_target_time_convert;
+ long target_time;
+ long sleep_target_time;
+ long delta;
+
+ clock_gettime(CLOCK_REALTIME, &start_time);
+ target_time = (start_time.tv_sec * NSEC_PER_SEC + start_time.tv_nsec + interval * NSEC_PER_USEC) / (interval * NSEC_PER_USEC) * interval;
+ //printf("target: %ld, current: %ld, %ld\n", target_time, start_time.tv_sec, start_time.tv_nsec);
+ sleep_target_time = target_time - TIMECOMPENSATION;
+ sleep_target_time_convert.tv_sec = sleep_target_time * NSEC_PER_USEC / NSEC_PER_SEC;
+ sleep_target_time_convert.tv_nsec = (sleep_target_time * NSEC_PER_USEC) % NSEC_PER_SEC;
+
+ //target_time_convert.tv_sec = target_time * NSEC_PER_USEC / NSEC_PER_SEC;
+ //target_time_convert.tv_nsec = (target_time * NSEC_PER_USEC) % NSEC_PER_SEC;
+
+ clock_nanosleep(CLOCK_REALTIME, TIMER_ABSTIME, &sleep_target_time_convert, NULL);
+
+ clock_gettime(CLOCK_REALTIME, &cur_time);
+
+ delta = (cur_time.tv_sec * NSEC_PER_SEC + cur_time.tv_nsec) - target_time * NSEC_PER_USEC;
+
+ return delta;
+}
+
+
+