|
Packit |
6d2c1b |
/*
|
|
Packit |
6d2c1b |
* Copyright (c) 2001-2020 Mellanox Technologies, Ltd. All rights reserved.
|
|
Packit |
6d2c1b |
*
|
|
Packit |
6d2c1b |
* This software is available to you under a choice of one of two
|
|
Packit |
6d2c1b |
* licenses. You may choose to be licensed under the terms of the GNU
|
|
Packit |
6d2c1b |
* General Public License (GPL) Version 2, available from the file
|
|
Packit |
6d2c1b |
* COPYING in the main directory of this source tree, or the
|
|
Packit |
6d2c1b |
* BSD license below:
|
|
Packit |
6d2c1b |
*
|
|
Packit |
6d2c1b |
* Redistribution and use in source and binary forms, with or
|
|
Packit |
6d2c1b |
* without modification, are permitted provided that the following
|
|
Packit |
6d2c1b |
* conditions are met:
|
|
Packit |
6d2c1b |
*
|
|
Packit |
6d2c1b |
* - Redistributions of source code must retain the above
|
|
Packit |
6d2c1b |
* copyright notice, this list of conditions and the following
|
|
Packit |
6d2c1b |
* disclaimer.
|
|
Packit |
6d2c1b |
*
|
|
Packit |
6d2c1b |
* - Redistributions in binary form must reproduce the above
|
|
Packit |
6d2c1b |
* copyright notice, this list of conditions and the following
|
|
Packit |
6d2c1b |
* disclaimer in the documentation and/or other materials
|
|
Packit |
6d2c1b |
* provided with the distribution.
|
|
Packit |
6d2c1b |
*
|
|
Packit |
6d2c1b |
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
|
|
Packit |
6d2c1b |
* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
|
|
Packit |
6d2c1b |
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
|
|
Packit |
6d2c1b |
* NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
|
|
Packit |
6d2c1b |
* BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
|
|
Packit |
6d2c1b |
* ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
|
|
Packit |
6d2c1b |
* CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
|
|
Packit |
6d2c1b |
* SOFTWARE.
|
|
Packit |
6d2c1b |
*/
|
|
Packit |
6d2c1b |
|
|
Packit |
6d2c1b |
|
|
Packit |
6d2c1b |
#include <stdlib.h>
|
|
Packit |
6d2c1b |
#include <vlogger/vlogger.h>
|
|
Packit |
6d2c1b |
#include "vma/event/event_handler_manager.h"
|
|
Packit |
6d2c1b |
#include <vma/util/sys_vars.h>
|
|
Packit |
6d2c1b |
#include "utils/rdtsc.h"
|
|
Packit |
6d2c1b |
#include "vma/util/instrumentation.h"
|
|
Packit |
6d2c1b |
#include "vma/util/utils.h"
|
|
Packit |
6d2c1b |
#include "vma/dev/time_converter_ptp.h"
|
|
Packit |
6d2c1b |
#include "vma/ib/base/verbs_extra.h"
|
|
Packit |
6d2c1b |
|
|
Packit |
6d2c1b |
|
|
Packit |
6d2c1b |
#ifdef DEFINED_IBV_CLOCK_INFO
|
|
Packit |
6d2c1b |
|
|
Packit |
6d2c1b |
#define MODULE_NAME "tc_ptp"
|
|
Packit |
6d2c1b |
|
|
Packit |
6d2c1b |
#define ibchtc_logerr __log_err
|
|
Packit |
6d2c1b |
#define ibchtc_logwarn __log_warn
|
|
Packit |
6d2c1b |
#define ibchtc_loginfo __log_info
|
|
Packit |
6d2c1b |
#define ibchtc_logdbg __log_info_dbg
|
|
Packit |
6d2c1b |
#define ibchtc_logfunc __log_info_func
|
|
Packit |
6d2c1b |
|
|
Packit |
6d2c1b |
#define UPDATE_HW_TIMER_PTP_PERIOD_MS 100
|
|
Packit |
6d2c1b |
|
|
Packit |
6d2c1b |
|
|
Packit |
6d2c1b |
time_converter_ptp::time_converter_ptp(struct ibv_context* ctx) :
|
|
Packit |
6d2c1b |
m_p_ibv_context(ctx), m_clock_values_id(0)
|
|
Packit |
6d2c1b |
{
|
|
Packit |
6d2c1b |
for (size_t i=0; i < ARRAY_SIZE(m_clock_values); i++) {
|
|
Packit |
6d2c1b |
memset(&m_clock_values[i], 0, sizeof(m_clock_values[i]));
|
|
Packit |
6d2c1b |
if (vma_ibv_query_clock_info(m_p_ibv_context, &m_clock_values[i])) {
|
|
Packit |
6d2c1b |
ibchtc_logerr("vma_ibv_query_clock_info failure for clock_info, (ibv context %p)", m_p_ibv_context);
|
|
Packit |
6d2c1b |
}
|
|
Packit |
6d2c1b |
}
|
|
Packit |
6d2c1b |
|
|
Packit |
6d2c1b |
m_timer_handle = g_p_event_handler_manager->register_timer_event(UPDATE_HW_TIMER_PTP_PERIOD_MS, this, PERIODIC_TIMER, 0);
|
|
Packit |
6d2c1b |
m_converter_status = TS_CONVERSION_MODE_PTP;
|
|
Packit |
6d2c1b |
}
|
|
Packit |
6d2c1b |
|
|
Packit |
6d2c1b |
void time_converter_ptp::handle_timer_expired(void* user_data) {
|
|
Packit |
6d2c1b |
|
|
Packit |
6d2c1b |
NOT_IN_USE(user_data);
|
|
Packit |
6d2c1b |
|
|
Packit |
6d2c1b |
if (is_cleaned()) {
|
|
Packit |
6d2c1b |
return;
|
|
Packit |
6d2c1b |
}
|
|
Packit |
6d2c1b |
|
|
Packit |
6d2c1b |
int ret = 0;
|
|
Packit |
6d2c1b |
ret = vma_ibv_query_clock_info(m_p_ibv_context, &m_clock_values[1 - m_clock_values_id]);
|
|
Packit |
6d2c1b |
if (ret)
|
|
Packit |
6d2c1b |
ibchtc_logerr("vma_ibv_query_clock_info failure for clock_info, (ibv context %p) (return value=%d)", m_p_ibv_context, ret);
|
|
Packit |
6d2c1b |
|
|
Packit |
6d2c1b |
m_clock_values_id = 1 - m_clock_values_id;
|
|
Packit |
6d2c1b |
}
|
|
Packit |
6d2c1b |
|
|
Packit |
6d2c1b |
void time_converter_ptp::convert_hw_time_to_system_time(uint64_t hwtime, struct timespec* systime) {
|
|
Packit |
6d2c1b |
uint64_t sync_hw_clock = vma_ibv_convert_ts_to_ns(&m_clock_values[m_clock_values_id], hwtime);
|
|
Packit |
6d2c1b |
systime->tv_sec = sync_hw_clock / NSEC_PER_SEC;
|
|
Packit |
6d2c1b |
systime->tv_nsec = sync_hw_clock % NSEC_PER_SEC;
|
|
Packit |
6d2c1b |
|
|
Packit |
6d2c1b |
ibchtc_logfunc("hwtime: %09ld", hwtime);
|
|
Packit |
6d2c1b |
ibchtc_logfunc("systime: %lld.%.9ld", systime->tv_sec, systime->tv_nsec);
|
|
Packit |
6d2c1b |
}
|
|
Packit |
6d2c1b |
#endif //DEFINED_IBV_CLOCK_INFO
|