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);
	}
}
复制代码
相关推荐
闭着眼睛学算法12 分钟前
【双机位A卷】华为OD笔试之【哈希表】双机位A-跳房子I【Py/Java/C++/C/JS/Go六种语言】【欧弟算法】全网注释最详细分类最全的华子OD真题题解
java·c语言·c++·python·算法·华为od·散列表
国科安芯27 分钟前
ASP3605A电源芯片在高速ADC子卡中的适配性研究
网络·人工智能·单片机·嵌入式硬件·安全
开发者驿站32 分钟前
2025年保姆级C++环境配置教程(Windows/macOS双平台)
c++·windows·macos
要加油哦~35 分钟前
前端八股文 | HTTP - 实时通信方式/前后端通信方式
网络·网络协议·http
辰尘_星启40 分钟前
『CMake』关于使用CMake构建项目时的现代/传统指令
c++·架构·系统·cmake·项目·构建
AA陈超1 小时前
虚幻引擎5 GAS开发俯视角RPG游戏 P06-13 属性菜单 - 边框值
c++·游戏·ue5·游戏引擎·虚幻
姝孟2 小时前
C++学习——类与对象详细知识点总结
c++·笔记·学习
像风一样!2 小时前
NFS文件存储
linux·服务器·网络·nfs文件存储
小龙报2 小时前
《算法通关指南之C++编程篇(5)----- 条件判断与循环(下)》
c语言·开发语言·c++·算法·visualstudio·学习方法·visual studio
郝学胜-神的一滴2 小时前
C++ STL(标准模板库)深度解析:从基础到实践
linux·服务器·开发语言·c++·算法