Blame src/vma/dev/time_converter_ptp.cpp

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