You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
84 lines
3.0 KiB
84 lines
3.0 KiB
#include "xsync.hpp"
|
|
using namespace iflytop;
|
|
|
|
Xsync::Xsync(/* args */) {}
|
|
Xsync::~Xsync() {}
|
|
|
|
xs_error_code_t Xsync::reg_write(uint32_t regadd, uint32_t regvalue) {}
|
|
xs_error_code_t Xsync::reg_read(uint32_t regadd, uint32_t ®value) {}
|
|
xs_error_code_t Xsync::reg_read_muti(uint32_t regadd, uint32_t ®value) {}
|
|
|
|
Xsync &Xsync::Ins() {
|
|
static Xsync xsync;
|
|
return xsync;
|
|
}
|
|
void Xsync::initialize(I_XSUDPFactory *xsync_udp_factory) { m_xsync_udp_factory = xsync_udp_factory; }
|
|
|
|
void Xsync::connect(string xsync_ip) {
|
|
/**
|
|
* @brief 创建 m_xsync_reg_udp
|
|
*/
|
|
m_xsync_reg_udp = m_xsync_udp_factory->createXSUDP();
|
|
m_xsync_reg_udp->initialize(m_xsync_ip, IFLYTOP_XSYNC_SERVICE_PC_PORT);
|
|
|
|
/**
|
|
* @brief 创建 m_xsync_timecode_udp_listener
|
|
*/
|
|
m_xsync_timecode_udp_listener = m_xsync_udp_factory->createXSUDP();
|
|
m_xsync_timecode_udp_listener->initialize(m_xsync_ip, IFLYTOP_XSYNC_TIMECODE_REPORT_PC_PORT);
|
|
m_xsync_timecode_udp_listener->startReceive([this](XsyncNetAdd &from, uint8_t *data, size_t length) { parseTimecodeMsgAndReport(from, data, length); });
|
|
|
|
/**
|
|
* @brief 创建 m_xsync_camera_sync_udp_listener
|
|
*/
|
|
m_xsync_camera_sync_udp_listener = m_xsync_udp_factory->createXSUDP();
|
|
m_xsync_camera_sync_udp_listener->initialize(m_xsync_ip, IFLYTOP_XSYNC_CAMERA_SYNC_PACKET_PC_PORT);
|
|
m_xsync_camera_sync_udp_listener->startReceive([this](XsyncNetAdd &from, uint8_t *data, size_t length) { parseCameraSyncMsgAndReport(from, data, length); });
|
|
}
|
|
void Xsync::disConnect() {
|
|
if (m_xsync_reg_udp != nullptr) {
|
|
m_xsync_reg_udp->stopReceive();
|
|
m_xsync_reg_udp = nullptr;
|
|
}
|
|
}
|
|
|
|
void Xsync::parseTimecodeMsgAndReport(XsyncNetAdd &from, uint8_t *data, size_t length) {
|
|
//
|
|
iflytop_timecode_report_packet_t *packet = (iflytop_timecode_report_packet_t *)data;
|
|
xysnc_timecode_t timecode;
|
|
/**
|
|
* @brief
|
|
*/
|
|
|
|
uint8_t frameuints = packet->timecode0 & 0x0f;
|
|
uint8_t frame10s = (packet->timecode0 >> 8) & 0x3;
|
|
uint8_t seconduints = (packet->timecode0 >> 16) & 0x0f;
|
|
uint8_t second10s = (packet->timecode0 >> 24) & 0x03;
|
|
|
|
uint8_t minuteuints = packet->timecode1 & 0x0f;
|
|
uint8_t minute10s = (packet->timecode1 >> 8) & 0x03;
|
|
uint8_t houruints = (packet->timecode1 >> 16) & 0x0f;
|
|
uint8_t hour10s = (packet->timecode1 >> 24) & 0x03;
|
|
|
|
timecode.hour = hour10s * 10 + houruints;
|
|
timecode.minute = minute10s * 10 + minuteuints;
|
|
timecode.second = second10s * 10 + seconduints;
|
|
timecode.frame = frame10s * 10 + frameuints;
|
|
|
|
if (m_on_timecode_msg_cb) m_on_timecode_msg_cb(&timecode);
|
|
}
|
|
void Xsync::parseCameraSyncMsgAndReport(XsyncNetAdd &from, uint8_t *data, size_t length) {
|
|
uint32_t count = 0;
|
|
|
|
uint32_t data0 = data[0];
|
|
uint32_t data1 = data[1];
|
|
uint32_t data2 = data[2];
|
|
uint32_t data3 = data[3];
|
|
|
|
count = data0 + (data1 << 8) + (data2 << 16) + (data3 << 24);
|
|
|
|
xysnc_camera_sync_data_t camera_sync_data;
|
|
camera_sync_data.frameIndex = count;
|
|
|
|
if (m_on_camera_sync_msg_cb) m_on_camera_sync_msg_cb(&camera_sync_data);
|
|
}
|