5g-team
/
srsRAN_4G
mirror of https://github.com/pvnis/srsRAN_4G.git
2
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

add support for GPS-based sync to UE sync object

Browse Source
master
Andre Puschmann 5 years ago
parent d62b835a4c
commit 6cce22d6b8
2 changed files with 376 additions and 180 deletions
Show Stats Download Patch File Download Diff File

26
lib/include/srslte/phy/ue/ue_sync.h
Unescape Escape View File

@ -69,6 +69,7 @@
#define DEFAULT_CFO_EMA_TRACK 0.05 #define DEFAULT_CFO_EMA_TRACK 0.05
typedef enum SRSLTE_API { SYNC_MODE_PSS, SYNC_MODE_GNSS } srslte_ue_sync_mode_t;
typedef enum SRSLTE_API { SF_FIND, SF_TRACK} srslte_ue_sync_state_t; typedef enum SRSLTE_API { SF_FIND, SF_TRACK} srslte_ue_sync_state_t;
//#define MEASURE_EXEC_TIME //#define MEASURE_EXEC_TIME
@ -76,6 +77,7 @@ typedef enum SRSLTE_API { SF_FIND, SF_TRACK} srslte_ue_sync_state_t;
typedef int(ue_sync_recv_callback_t)(void*, cf_t * [SRSLTE_MAX_PORTS], uint32_t, srslte_timestamp_t*); typedef int(ue_sync_recv_callback_t)(void*, cf_t * [SRSLTE_MAX_PORTS], uint32_t, srslte_timestamp_t*);
typedef struct SRSLTE_API { typedef struct SRSLTE_API {
srslte_ue_sync_mode_t mode;
srslte_sync_t sfind; srslte_sync_t sfind;
srslte_sync_t strack; srslte_sync_t strack;
@ -115,6 +117,7 @@ typedef struct SRSLTE_API {
/* this is the system frame number (SFN) */ /* this is the system frame number (SFN) */
uint32_t frame_number; uint32_t frame_number;
uint32_t sfn_offset; ///< An offset value provided by higher layers
srslte_cell_t cell; srslte_cell_t cell;
uint32_t sf_idx; uint32_t sf_idx;
@ -168,6 +171,16 @@ SRSLTE_API int srslte_ue_sync_init_multi_decim(srslte_ue_sync_t *q,
void *stream_handler, void *stream_handler,
int decimate); int decimate);
SRSLTE_API int
srslte_ue_sync_init_multi_decim_mode(srslte_ue_sync_t* q,
uint32_t max_prb,
bool search_cell,
int(recv_callback)(void*, cf_t* [SRSLTE_MAX_PORTS], uint32_t, srslte_timestamp_t*),
uint32_t nof_rx_antennas,
void* stream_handler,
int decimate,
srslte_ue_sync_mode_t mode);
SRSLTE_API int srslte_ue_sync_init_file(srslte_ue_sync_t *q, SRSLTE_API int srslte_ue_sync_init_file(srslte_ue_sync_t *q,
uint32_t nof_prb, uint32_t nof_prb,
char *file_name, char *file_name,
@ -236,6 +249,8 @@ SRSLTE_API void srslte_ue_sync_set_cfo_i_enable(srslte_ue_sync_t *q,
SRSLTE_API void srslte_ue_sync_set_N_id_2(srslte_ue_sync_t *q, SRSLTE_API void srslte_ue_sync_set_N_id_2(srslte_ue_sync_t *q,
uint32_t N_id_2); uint32_t N_id_2);
SRSLTE_API uint32_t srslte_ue_sync_get_sfn(srslte_ue_sync_t* q);
SRSLTE_API uint32_t srslte_ue_sync_get_sfidx(srslte_ue_sync_t *q); SRSLTE_API uint32_t srslte_ue_sync_get_sfidx(srslte_ue_sync_t *q);
SRSLTE_API float srslte_ue_sync_get_cfo(srslte_ue_sync_t *q); SRSLTE_API float srslte_ue_sync_get_cfo(srslte_ue_sync_t *q);
@ -253,6 +268,17 @@ SRSLTE_API void srslte_ue_sync_set_sfo_ema(srslte_ue_sync_t *q,
SRSLTE_API void srslte_ue_sync_get_last_timestamp(srslte_ue_sync_t *q, SRSLTE_API void srslte_ue_sync_get_last_timestamp(srslte_ue_sync_t *q,
srslte_timestamp_t *timestamp); srslte_timestamp_t *timestamp);
SRSLTE_API int srslte_ue_sync_run_find_pss_mode(srslte_ue_sync_t* q, cf_t* input_buffer[SRSLTE_MAX_PORTS]);
SRSLTE_API int srslte_ue_sync_run_track_pss_mode(srslte_ue_sync_t* q, cf_t* input_buffer[SRSLTE_MAX_PORTS]);
SRSLTE_API int srslte_ue_sync_run_find_gnss_mode(srslte_ue_sync_t* q,
cf_t* input_buffer[SRSLTE_MAX_PORTS],
const uint32_t max_num_samples);
SRSLTE_API int srslte_ue_sync_run_track_gnss_mode(srslte_ue_sync_t* q, cf_t* input_buffer[SRSLTE_MAX_PORTS]);
SRSLTE_API int srslte_ue_sync_set_tti_from_timestamp(srslte_ue_sync_t* q, srslte_timestamp_t* rx_timestamp);
#endif // SRSLTE_UE_SYNC_H #endif // SRSLTE_UE_SYNC_H

246
lib/src/phy/ue/ue_sync.c
Unescape Escape View File

@ -43,8 +43,9 @@
? 0 \ ? 0 \
: ((SRSLTE_CP_NSYMB(q->cell.cp) - 3) * SRSLTE_SYMBOL_SZ(q->fft_size, q->cell.cp)))) : ((SRSLTE_CP_NSYMB(q->cell.cp) - 3) * SRSLTE_SYMBOL_SZ(q->fft_size, q->cell.cp))))
static cf_t dummy_buffer0[15 * 2048 / 2]; #define DUMMY_BUFFER_NUM_SAMPLES (15 * 2048 / 2)
static cf_t dummy_buffer1[15 * 2048 / 2]; static cf_t dummy_buffer0[DUMMY_BUFFER_NUM_SAMPLES];
static cf_t dummy_buffer1[DUMMY_BUFFER_NUM_SAMPLES];
static cf_t* dummy_offset_buffer[SRSLTE_MAX_PORTS] = {dummy_buffer0, dummy_buffer1, dummy_buffer1, dummy_buffer1}; static cf_t* dummy_offset_buffer[SRSLTE_MAX_PORTS] = {dummy_buffer0, dummy_buffer1, dummy_buffer1, dummy_buffer1};
int srslte_ue_sync_init_file(srslte_ue_sync_t* q, uint32_t nof_prb, char* file_name, int offset_time, float offset_freq) int srslte_ue_sync_init_file(srslte_ue_sync_t* q, uint32_t nof_prb, char* file_name, int offset_time, float offset_freq)
@ -123,8 +124,7 @@ void srslte_ue_sync_cfo_reset(srslte_ue_sync_t* q)
void srslte_ue_sync_reset(srslte_ue_sync_t* q) void srslte_ue_sync_reset(srslte_ue_sync_t* q)
{ {
if (!q->file_mode && q->mode == SYNC_MODE_PSS) {
if (!q->file_mode) {
srslte_sync_reset(&q->sfind); srslte_sync_reset(&q->sfind);
srslte_sync_reset(&q->strack); srslte_sync_reset(&q->strack);
} else { } else {
@ -182,7 +182,6 @@ int srslte_ue_sync_init_multi(srslte_ue_sync_t* q,
void* stream_handler) void* stream_handler)
{ {
return srslte_ue_sync_init_multi_decim(q, max_prb, search_cell, recv_callback, nof_rx_antennas, stream_handler, 1); return srslte_ue_sync_init_multi_decim(q, max_prb, search_cell, recv_callback, nof_rx_antennas, stream_handler, 1);
} }
@ -193,6 +192,20 @@ int srslte_ue_sync_init_multi_decim(srslte_ue_sync_t* q,
uint32_t nof_rx_antennas, uint32_t nof_rx_antennas,
void* stream_handler, void* stream_handler,
int decimate) int decimate)
{
return srslte_ue_sync_init_multi_decim_mode(
q, max_prb, search_cell, recv_callback, nof_rx_antennas, stream_handler, 1, SYNC_MODE_PSS);
}
int srslte_ue_sync_init_multi_decim_mode(
srslte_ue_sync_t* q,
uint32_t max_prb,
bool search_cell,
int(recv_callback)(void*, cf_t* [SRSLTE_MAX_PORTS], uint32_t, srslte_timestamp_t*),
uint32_t nof_rx_antennas,
void* stream_handler,
int decimate,
srslte_ue_sync_mode_t mode)
{ {
int ret = SRSLTE_ERROR_INVALID_INPUTS; int ret = SRSLTE_ERROR_INVALID_INPUTS;
@ -201,6 +214,7 @@ int srslte_ue_sync_init_multi_decim(srslte_ue_sync_t* q,
// int decimate = q->decimate; // int decimate = q->decimate;
bzero(q, sizeof(srslte_ue_sync_t)); bzero(q, sizeof(srslte_ue_sync_t));
q->decimate = decimate; q->decimate = decimate;
q->mode = mode;
q->stream = stream_handler; q->stream = stream_handler;
q->recv_callback = recv_callback; q->recv_callback = recv_callback;
q->nof_rx_antennas = nof_rx_antennas; q->nof_rx_antennas = nof_rx_antennas;
@ -242,6 +256,7 @@ int srslte_ue_sync_init_multi_decim(srslte_ue_sync_t* q,
q->decimate = 1; q->decimate = 1;
} }
if (q->mode == SYNC_MODE_PSS) {
if (srslte_sync_init_decim(&q->sfind, q->frame_len, q->frame_len, q->fft_size, q->decimate)) { if (srslte_sync_init_decim(&q->sfind, q->frame_len, q->frame_len, q->fft_size, q->decimate)) {
ERROR("Error initiating sync find\n"); ERROR("Error initiating sync find\n");
goto clean_exit; goto clean_exit;
@ -280,6 +295,7 @@ int srslte_ue_sync_init_multi_decim(srslte_ue_sync_t* q,
// Enable SSS on find and disable in track // Enable SSS on find and disable in track
srslte_sync_sss_en(&q->sfind, true); srslte_sync_sss_en(&q->sfind, true);
srslte_sync_sss_en(&q->strack, false); srslte_sync_sss_en(&q->strack, false);
}
ret = SRSLTE_SUCCESS; ret = SRSLTE_SUCCESS;
} }
@ -301,7 +317,7 @@ void srslte_ue_sync_free(srslte_ue_sync_t* q)
if (q->do_agc) { if (q->do_agc) {
srslte_agc_free(&q->agc); srslte_agc_free(&q->agc);
} }
if (!q->file_mode) { if (!q->file_mode && q->mode == SYNC_MODE_PSS) {
srslte_sync_free(&q->sfind); srslte_sync_free(&q->sfind);
srslte_sync_free(&q->strack); srslte_sync_free(&q->strack);
} else { } else {
@ -336,6 +352,8 @@ int srslte_ue_sync_set_cell(srslte_ue_sync_t* q, srslte_cell_t cell)
q->frame_len = q->nof_recv_sf * q->sf_len; q->frame_len = q->nof_recv_sf * q->sf_len;
if (q->mode == SYNC_MODE_PSS) {
// cell configuration for PSS-based sync
if (q->fft_size < 700 && q->decimate) { if (q->fft_size < 700 && q->decimate) {
q->decimate = 1; q->decimate = 1;
} }
@ -359,8 +377,8 @@ int srslte_ue_sync_set_cell(srslte_ue_sync_t* q, srslte_cell_t cell)
} }
} }
// When Cell ID is 1000, ue_sync receives nof_avg_find_frames frames in find state and does not go to tracking state // When Cell ID is 1000, ue_sync receives nof_avg_find_frames frames in find state and does not go to tracking
// and is used to search a cell // state and is used to search a cell
if (cell.id == 1000) { if (cell.id == 1000) {
q->nof_avg_find_frames = FIND_NOF_AVG_FRAMES; q->nof_avg_find_frames = FIND_NOF_AVG_FRAMES;
@ -405,6 +423,7 @@ int srslte_ue_sync_set_cell(srslte_ue_sync_t* q, srslte_cell_t cell)
// When cell is unknown, do CP CFO correction // When cell is unknown, do CP CFO correction
srslte_sync_set_cfo_cp_enable(&q->sfind, true, q->frame_len < 10000 ? 14 : 3); srslte_sync_set_cfo_cp_enable(&q->sfind, true, q->frame_len < 10000 ? 14 : 3);
q->cfo_correct_enable_find = false; q->cfo_correct_enable_find = false;
}
srslte_ue_sync_reset(q); srslte_ue_sync_reset(q);
@ -469,6 +488,11 @@ void srslte_ue_sync_set_cfo_ref(srslte_ue_sync_t* q, float ref_cfo)
} }
} }
uint32_t srslte_ue_sync_get_sfn(srslte_ue_sync_t* q)
{
return q->frame_number;
}
uint32_t srslte_ue_sync_get_sfidx(srslte_ue_sync_t* q) uint32_t srslte_ue_sync_get_sfidx(srslte_ue_sync_t* q)
{ {
return q->sf_idx; return q->sf_idx;
@ -708,7 +732,6 @@ static int receive_samples(srslte_ue_sync_t* q, cf_t* input_buffer[SRSLTE_MAX_PO
int srslte_ue_sync_zerocopy(srslte_ue_sync_t* q, cf_t* input_buffer[SRSLTE_MAX_PORTS], const uint32_t max_num_samples) int srslte_ue_sync_zerocopy(srslte_ue_sync_t* q, cf_t* input_buffer[SRSLTE_MAX_PORTS], const uint32_t max_num_samples)
{ {
int ret = SRSLTE_ERROR_INVALID_INPUTS; int ret = SRSLTE_ERROR_INVALID_INPUTS;
uint32_t track_idx;
if (q != NULL && input_buffer != NULL) { if (q != NULL && input_buffer != NULL) {
@ -748,7 +771,7 @@ int srslte_ue_sync_zerocopy(srslte_ue_sync_t* q, cf_t* input_buffer[SRSLTE_MAX_P
ERROR("Error receiving samples\n"); ERROR("Error receiving samples\n");
return SRSLTE_ERROR; return SRSLTE_ERROR;
} }
int n;
switch (q->state) { switch (q->state) {
case SF_FIND: case SF_FIND:
// Correct CFO before PSS/SSS find using the sync object corrector (initialized for 1 ms) // Correct CFO before PSS/SSS find using the sync object corrector (initialized for 1 ms)
@ -760,11 +783,62 @@ int srslte_ue_sync_zerocopy(srslte_ue_sync_t* q, cf_t* input_buffer[SRSLTE_MAX_P
} }
} }
} }
n = srslte_sync_find(&q->sfind, input_buffer[0], 0, &q->peak_idx);
// Run mode-specific find operation
if (q->mode == SYNC_MODE_PSS) {
ret = srslte_ue_sync_run_find_pss_mode(q, input_buffer);
} else if (q->mode == SYNC_MODE_GNSS) {
ret = srslte_ue_sync_run_find_gnss_mode(q, input_buffer, max_num_samples);
}
if (q->do_agc) {
srslte_agc_process(&q->agc, input_buffer[0], q->sf_len);
}
break;
case SF_TRACK:
ret = 1;
// Increase subframe counter and system frame number
q->sf_idx = (q->sf_idx + q->nof_recv_sf) % 10;
if (q->sf_idx == 0) {
q->frame_number = (q->frame_number + 1) % 1024;
}
// Correct CFO before PSS/SSS tracking using the sync object corrector (initialized for 1 ms)
if (q->cfo_correct_enable_track) {
for (int i = 0; i < q->nof_rx_antennas; i++) {
if (input_buffer[i]) {
srslte_cfo_correct(
&q->strack.cfo_corr_frame, input_buffer[i], input_buffer[i], -q->cfo_current_value / q->fft_size);
}
}
}
if (q->mode == SYNC_MODE_PSS) {
srslte_ue_sync_run_track_pss_mode(q, input_buffer);
} else {
srslte_ue_sync_run_track_gnss_mode(q, input_buffer);
}
break;
default:
ERROR("Unknown sync state %d\n", q->state);
}
}
}
return ret;
}
int srslte_ue_sync_run_find_pss_mode(srslte_ue_sync_t* q, cf_t* input_buffer[SRSLTE_MAX_PORTS])
{
int ret = SRSLTE_ERROR;
int n = srslte_sync_find(&q->sfind, input_buffer[0], 0, &q->peak_idx);
switch (n) { switch (n) {
case SRSLTE_SYNC_ERROR: case SRSLTE_SYNC_ERROR:
ERROR("Error finding correlation peak (%d)\n", ret); ERROR("Error finding correlation peak (%d)\n", ret);
return SRSLTE_ERROR; return ret;
case SRSLTE_SYNC_FOUND: case SRSLTE_SYNC_FOUND:
ret = find_peak_ok(q, input_buffer); ret = find_peak_ok(q, input_buffer);
break; break;
@ -779,9 +853,6 @@ int srslte_ue_sync_zerocopy(srslte_ue_sync_t* q, cf_t* input_buffer[SRSLTE_MAX_P
ret = SRSLTE_SUCCESS; ret = SRSLTE_SUCCESS;
break; break;
} }
if (q->do_agc) {
srslte_agc_process(&q->agc, input_buffer[0], q->sf_len);
}
INFO("SYNC FIND: sf_idx=%d, ret=%d, peak_pos=%d, peak_value=%.2f, mean_cp_cfo=%.2f, mean_pss_cfo=%.2f, " INFO("SYNC FIND: sf_idx=%d, ret=%d, peak_pos=%d, peak_value=%.2f, mean_cp_cfo=%.2f, mean_pss_cfo=%.2f, "
"total_cfo_khz=%.1f\n", "total_cfo_khz=%.1f\n",
@ -793,29 +864,16 @@ int srslte_ue_sync_zerocopy(srslte_ue_sync_t* q, cf_t* input_buffer[SRSLTE_MAX_P
q->sfind.cfo_pss_mean, q->sfind.cfo_pss_mean,
15 * srslte_sync_get_cfo(&q->sfind)); 15 * srslte_sync_get_cfo(&q->sfind));
break; return ret;
case SF_TRACK: };
ret = 1;
// Increase subframe counter
q->sf_idx = (q->sf_idx + q->nof_recv_sf) % 10;
// Correct CFO before PSS/SSS tracking using the sync object corrector (initialized for 1 ms)
if (q->cfo_correct_enable_track) {
for (int i = 0; i < q->nof_rx_antennas; i++) {
if (input_buffer[i]) {
srslte_cfo_correct(
&q->strack.cfo_corr_frame, input_buffer[i], input_buffer[i], -q->cfo_current_value / q->fft_size);
}
}
}
int srslte_ue_sync_run_track_pss_mode(srslte_ue_sync_t* q, cf_t* input_buffer[SRSLTE_MAX_PORTS])
{
int ret = SRSLTE_ERROR;
uint32_t track_idx = 0;
/* Every SF idx 0 and 5, find peak around known position q->peak_idx */ /* Every SF idx 0 and 5, find peak around known position q->peak_idx */
if ((q->sfind.frame_type == SRSLTE_FDD && (q->sf_idx == 0 || q->sf_idx == 5)) || if ((q->sfind.frame_type == SRSLTE_FDD && (q->sf_idx == 0 || q->sf_idx == 5)) ||
(q->sfind.frame_type == SRSLTE_TDD && (q->sf_idx == 1 || q->sf_idx == 6))) (q->sfind.frame_type == SRSLTE_TDD && (q->sf_idx == 1 || q->sf_idx == 6))) {
{
// Process AGC every period // Process AGC every period
if (q->do_agc && (q->agc_period == 0 || (q->agc_period && (q->frame_total_cnt % q->agc_period) == 0))) { if (q->do_agc && (q->agc_period == 0 || (q->agc_period && (q->frame_total_cnt % q->agc_period) == 0))) {
srslte_agc_process(&q->agc, input_buffer[0], q->sf_len); srslte_agc_process(&q->agc, input_buffer[0], q->sf_len);
@ -828,7 +886,7 @@ int srslte_ue_sync_zerocopy(srslte_ue_sync_t* q, cf_t* input_buffer[SRSLTE_MAX_P
// Expected PSS position is different for FDD and TDD // Expected PSS position is different for FDD and TDD
uint32_t pss_idx = q->frame_len - PSS_OFFSET - q->fft_size - q->strack.max_offset / 2; uint32_t pss_idx = q->frame_len - PSS_OFFSET - q->fft_size - q->strack.max_offset / 2;
n = srslte_sync_find(&q->strack, input_buffer[0], pss_idx, &track_idx); int n = srslte_sync_find(&q->strack, input_buffer[0], pss_idx, &track_idx);
switch (n) { switch (n) {
case SRSLTE_SYNC_ERROR: case SRSLTE_SYNC_ERROR:
ERROR("Error tracking correlation peak\n"); ERROR("Error tracking correlation peak\n");
@ -867,9 +925,121 @@ int srslte_ue_sync_zerocopy(srslte_ue_sync_t* q, cf_t* input_buffer[SRSLTE_MAX_P
} else { } else {
INFO("SYNC TRACK: sf_idx=%d, ret=%d, next_state=%d\n", q->sf_idx, ret, q->state); INFO("SYNC TRACK: sf_idx=%d, ret=%d, next_state=%d\n", q->sf_idx, ret, q->state);
} }
break;
return 1; ///< 1 means subframe in sync
}
int srslte_ue_sync_run_find_gnss_mode(srslte_ue_sync_t* q,
cf_t* input_buffer[SRSLTE_MAX_PORTS],
const uint32_t max_num_samples)
{
INFO("Calibration samples received start at %ld + %f\n", q->last_timestamp.full_secs, q->last_timestamp.frac_secs);
// round to nearest second
srslte_timestamp_t ts_next_rx;
srslte_timestamp_copy(&ts_next_rx, &q->last_timestamp);
ts_next_rx.full_secs++;
ts_next_rx.frac_secs = 0.0;
INFO("Next desired recv at %ld + %f\n", ts_next_rx.full_secs, ts_next_rx.frac_secs);
// get difference in time between second rx and now
srslte_timestamp_sub(&ts_next_rx, q->last_timestamp.full_secs, q->last_timestamp.frac_secs);
srslte_timestamp_sub(&ts_next_rx, 0, 0.001); ///< account for samples that have already been rx'ed
uint32_t align_len = srslte_timestamp_uint64(&ts_next_rx, q->sf_len * 1000);
DEBUG("Difference between first recv is %ld + %f or %d samples\n",
ts_next_rx.full_secs,
ts_next_rx.frac_secs,
align_len);
DEBUG("Realigning frame, reading %d samples\n", align_len);
// receive align_len samples into dummy_buffer, make sure to not exceed buffer len
uint32_t sample_count = 0;
while (sample_count < align_len) {
uint32_t actual_rx_len = SRSLTE_MIN(align_len, DUMMY_BUFFER_NUM_SAMPLES);
actual_rx_len = SRSLTE_MIN(align_len - sample_count, actual_rx_len);
q->recv_callback(q->stream, dummy_offset_buffer, actual_rx_len, &q->last_timestamp);
sample_count += actual_rx_len;
}
DEBUG("Received %d samples during alignment\n", sample_count);
// do one normal receive, the first time-aligned subframe
if (receive_samples(q, input_buffer, max_num_samples)) {
ERROR("Error receiving samples\n");
return SRSLTE_ERROR;
} }
// switch to track state, from here on, samples should be ms aligned
q->state = SF_TRACK;
// calculate system timing
if (srslte_ue_sync_set_tti_from_timestamp(q, &q->last_timestamp)) {
ERROR("Error deriving timing from received samples\n");
return SRSLTE_ERROR;
} }
INFO("SYNC FIND: sfn=%d, sf_idx=%d next_state=%d\n", q->frame_number, q->sf_idx, q->state);
return 1; ///< 1 means subframe in sync
}
///< The track function in GNSS mode only needs to increment the system frame number
int srslte_ue_sync_run_track_gnss_mode(srslte_ue_sync_t* q, cf_t* input_buffer[SRSLTE_MAX_PORTS])
{
INFO("SYNC TRACK: sfn=%d, sf_idx=%d, next_state=%d\n", q->frame_number, q->sf_idx, q->state);
return 1; ///< 1 means subframe in sync
}
/** Calculate TTI for UEs that are synced using GNSS time reference (TS 36.331 Sec. 5.10.14)
*
* @param q Pointer to current object
* @param rx_timestamp Pointer to receive timestamp
* @return SRSLTE_SUCCESS on success
*/
int srslte_ue_sync_set_tti_from_timestamp(srslte_ue_sync_t* q, srslte_timestamp_t* rx_timestamp)
{
// calculate time_t of Rx time
time_t t_cur = rx_timestamp->full_secs;
DEBUG("t_cur=%ld\n", t_cur);
// time_t of reference UTC time on 1. Jan 1900 at 0:00
// If we put this date in https://www.epochconverter.com it returns a negative number
time_t t_ref = {0};
#if 0
struct tm t = {0};
t.tm_year = 1900; // year-1900
t.tm_mday = 1; // first of January
// t.tm_isdst = 0; // Is DST on? 1 = yes, 0 = no, -1 = unknown
t_ref = mktime(&t);
#endif
DEBUG("t_ref=%ld\n", t_ref);
static const uint32_t MSECS_PER_SEC = 1000;
DEBUG("diff=%f\n", difftime(t_cur, t_ref));
double time_diff_secs = difftime(t_cur, t_ref);
if (time_diff_secs < 0) {
fprintf(stderr, "Time diff between Rx timestamp and reference UTC is negative. Is the timestamp correct?\n");
return SRSLTE_ERROR;
} }
return ret;
DEBUG("time diff in s %f\n", time_diff_secs);
// convert to ms and add fractional part
double time_diff_msecs = time_diff_secs * MSECS_PER_SEC + rx_timestamp->frac_secs;
DEBUG("time diff in ms %f\n", time_diff_msecs);
// calculate SFN and SF index according to TS 36.331 Sec. 5.10.14
q->frame_number = ((uint32_t)floor(0.1 * (time_diff_msecs - q->sfn_offset))) % 1024;
q->sf_idx = ((uint32_t)floor(time_diff_msecs - q->sfn_offset)) % 10;
return SRSLTE_SUCCESS;
} }

Write Preview
Loading…
Cancel
Save