UavUdpSocket

该模块主要用于和无人机地面站通信单元进行数据的收发,基于udpsocket.

cpp 复制代码
#pragma once
#include <QObject>
#include "libCore.h"
#include "LkCommonStruct.h"

class LkUavUdpSocket : public LkUdpSocket
{
	Q_OBJECT
public:
	LkUavUdpSocket(QObject *parent = 0);
	~LkUavUdpSocket();	

	//向无人机发送命令
	template <class T>
	int cmdToUav(T cmd, MsgHeader type)
	{
		int len = cmd.ByteSize();
		char* buff;
		buff = new char[len];
		memset(buff, 0, len);
		cmd.SerializeToArray(buff, len);
		QByteArray sendTo;
		LittleEndianStream(out, sendTo);

		out << int(type);
		out.writeRawData(buff, len);
		delete buff;
		//qDebug() << QString("cmdToUav:Type %1: %2").arg(type).arg(QDateTime::currentDateTime().toString("hh:mm:ss:.zzz"));
		int r =  mSendSocket->writeDatagram(sendTo.data(), sendTo.size(), QHostAddress(mUavComIp), mUavSendPort);
		//qDebug() << QString("cmdToUav:End %1: %2").arg(type).arg(QDateTime::currentDateTime().toString("hh:mm:ss:.zzz"));
		return r;
	}
	void init(QString ip, int port);
private:
	void parse(QByteArray &ba);
	
public slots:
	virtual void readPendingDatagrams();
signals:

public:
	QString mUavComIp;
	int mUavSendPort;
	QSharedPointer<LkUdpSocket> mSendSocket;
private:
};


```cpp
#include "LkUavUdpSocket.h"

LkUavUdpSocket::LkUavUdpSocket(QObject *parent)
	: LkUdpSocket(parent)
{
	connect(this, &LkUavUdpSocket::readyRead, this, &LkUavUdpSocket::readPendingDatagrams);
	mSendSocket = QSharedPointer<LkUdpSocket>::create();
}

LkUavUdpSocket::~LkUavUdpSocket()
{
}

void LkUavUdpSocket::init(QString ip, int port)
{	
	bool b = bind(QHostAddress::Any, port);
	mUavComIp = ip;	
}

void LkUavUdpSocket::readPendingDatagrams()
{
	while (hasPendingDatagrams())
	{
		QByteArray datagram;
		datagram.resize(pendingDatagramSize());
		QNetworkDatagram netDgm = receiveDatagram();
		QString senderIP = netDgm.senderAddress().toString();
		datagram = netDgm.data();
		parse(datagram);
	}
}

void LkUavUdpSocket::parse(QByteArray &ba)
{
	LittleEndianStream(in, ba);
	int msgId;
	in >> msgId;
	if (msgId > 0)
	{
		LkMessageEvent me(QString::number(msgId));
		me.setData(ba.size() - sizeof(int), ba.data() + sizeof(int));
		gNetListener->dispatch(me);
	}
}
复制代码
相关推荐
虾球xz1 小时前
CppCon 2018 学习:EFFECTIVE REPLACEMENT OF DYNAMIC POLYMORPHISM WITH std::variant
开发语言·c++·学习
杨浦老苏1 小时前
Docker端口映射查看工具Dockpeek
网络·docker·群晖
未来之窗软件服务1 小时前
通过网页调用身份证阅读器http websocket方法-华视电子————仙盟创梦IDE
网络·网络协议·http·仙盟创梦ide·东方仙盟·硬件接入
创小匠2 小时前
创客匠人解析创始人 IP 定位:从专业度到用户心智的占领之道
网络·网络协议·tcp/ip
津津有味道2 小时前
Qt C++串口SerialPort通讯发送指令读写NFC M1卡
linux·c++·qt·串口通信·serial·m1·nfc
让我们一起加油好吗3 小时前
【C++】list 简介与模拟实现(详解)
开发语言·c++·visualstudio·stl·list
傅里叶的耶3 小时前
C++系列(二):告别低效循环!选择、循环、跳转原理与优化实战全解析
c++·visual studio
车载测试工程师3 小时前
车载以太网网络测试-29【SOME/IP-SD】-SD状态机
网络·网络协议·tcp/ip·车载系统·php
高兴达3 小时前
RPC--自定义注解注册发布服务
网络·网络协议·rpc
Vitta_U3 小时前
MFC的List Control自适应主界面大小
c++·list·mfc