转发多台px4仿真UDP数据到地面站

转发脚本的任务需求

仿真采用UDP通信方式,在 wsl 中仿真三台飞机,项目需要将一台电脑中的三台飞机的数据打包发送到另一台飞机的地面站,但地面站是无法直接访问另一台主机的 wsl 中的端口的,wsl 中的端口需要本机才能访问,接收数据,因此,需要编写一个脚本在主机运行,接收 wsl 中仿真飞机的数据,通过主机的 ip 与端口发送给 app 的主机 ip 与端口(),并且,接收 app 的命令,转发给三台飞机(命令中会包含飞机id,因此脚本不需要做筛选,直接转发给三个即可)。

目标端口与本机都需要在同一个局域网下(连接同一个wifi),整体框图如下:

脚本编写的注意点

仿真飞机的发送端口

仿真飞控在没有收到地面站心跳包时,是往 14550 端口发送数据的,只有在收到自己预先配置的接收端口接收到数据后,才会往配置的接收端口发送数据,一般配置的端口都是 18570,多台飞机就往后顺延,18571,18572

地面站发送心跳也是必须往飞机配置的端口发送心跳才行,例如飞机是18570,那么必须往这个端口发心跳,飞控才会改为往18570发送数据。

代码:

#! /usr/bin/env python
# -*-coding:utf-8-*
import socketimport socket
import threading
import time# 监控gcs发送的心跳包并转发给飞机的心跳端口 14550 (心跳端口为多机共用端口)
def udp_listen_gcs_to_uav(gcs_sock, uav1_sock, uav2_sock, uav3_sock, uav_ip, uav1_port, uav2_port, uav3_port):# print("listen GCS UDP port") while True:# 接收数据        buffer_size = 255  #缓冲区大小        gcs_data, gcs_addr = gcs_sock.recvfrom(buffer_size)  #读取gcs发送过来的数据包,转发给wsl的飞控 print("addr:", gcs_addr, "data:", gcs_data)#发送数据到wsl的飞机地址与端口        uav1_sock.sendto(gcs_data, (uav_ip, uav1_port))uav2_sock.sendto(gcs_data, (uav_ip, uav2_port))uav3_sock.sendto(gcs_data, (uav_ip, uav3_port))# 监控uav1 18570 端口发送的消息并转发给gcs端口
def udp_listen_uav_to_gcs(uav_sock, gsc_sock, gcs_ip, gcs_port):# print("listen uav UDP port:") while True:# 接收数据        buffer_size = 255  #缓冲区大小        uav_data, uav_addr = uav_sock.recvfrom(buffer_size)  #读取gcs发送过来的数据包,转发给wsl的飞控 # print("uav_addr:", uav_addr, "uav_data:", uav_data)  # 发送数据到wsl的飞机地址与端口        gsc_sock.sendto(uav_data, (gcs_ip, gcs_port))def main():self_UDP_IP = "172.16.20.86"  # 本机IP UDP通信可以不使用此字段    gcs_tx_ip = "172.16.20.16"    # gcs发送ip    gcs_tx_port = 14650  # gcs发送端口    gcs_rx_ip = "172.16.20.16"   # gcs接收ip    gcs_rx_port = 14650  # gcs接收端口    uav_ip = "172.27.21.175"  # 飞机的ip都是相同的    uav1_port = 18570   # 飞机1的端口号  在发送了心跳包后,需要与飞机在此端口进行通信    uav2_port = 18571   # 飞机1的端口号  在发送了心跳包后,需要与飞机在此端口进行通信    uav3_port = 18572   # 飞机1的端口号  在发送了心跳包后,需要与飞机在此端口进行通信    #创建与地面站以及与飞机通信的sock,之后传入各个线程    gcs_sock = socket.socket(socket.AF_INET, socket.SOCK_DGRAM)gcs_sock.bind(('', gcs_tx_port))# 绑定使用哪个端口发送  要让飞机往18570发送数据,因此心跳包也要从18570发送,飞控从18570接收到心跳包后,就会往18570发送自身数据    uav1_sock = socket.socket(socket.AF_INET, socket.SOCK_DGRAM)uav1_sock.bind(('', uav1_port))uav2_sock = socket.socket(socket.AF_INET, socket.SOCK_DGRAM)uav2_sock.bind(('', uav2_port))uav3_sock = socket.socket(socket.AF_INET, socket.SOCK_DGRAM)uav3_sock.bind(('', uav3_port))# 创建线程 监听gcs的包之后转发给飞控心跳端口 14550    listen_gcs_to_uav_thread = threading.Thread(target=udp_listen_gcs_to_uav, args=[gcs_sock, uav1_sock, uav2_sock, uav3_sock, uav_ip, uav1_port, uav2_port, uav3_port])# 创建线程 监听wsl中的uav1,2,3端口消息 18570,18571,18572  并转发给gcs端口    listen_uav1_to_gcs_thread = threading.Thread(target=udp_listen_uav_to_gcs, args=[uav1_sock, gcs_sock, gcs_rx_ip, gcs_rx_port])listen_uav2_to_gcs_thread = threading.Thread(target=udp_listen_uav_to_gcs, args=[uav2_sock, gcs_sock, gcs_rx_ip, gcs_rx_port])listen_uav3_to_gcs_thread = threading.Thread(target=udp_listen_uav_to_gcs, args=[uav3_sock, gcs_sock, gcs_rx_ip, gcs_rx_port])listen_gcs_to_uav_thread.start()listen_uav1_to_gcs_thread.start()listen_uav2_to_gcs_thread.start()listen_uav3_to_gcs_thread.start()# 等待线程结束    listen_gcs_to_uav_thread.join()  # 等待心跳包发送完成后就启动下一个任务    listen_uav1_to_gcs_thread.join()listen_uav2_to_gcs_thread.join()listen_uav3_to_gcs_thread.join()# Press the green button in the gutter to run the script.
if __name__ == '__main__':main()

在上述代码中,UDP 在接收时是用不到此ip的,也就是 gcs_sock.bind(('', gcs_tx_port)),函数中的 ip 可以不填,只需要将端口号填对即可,但在发送时,需要指定 ip,而且在给飞控发送心跳时,需要绑定端口号为飞机的端口号

本文来自互联网用户投稿,该文观点仅代表作者本人,不代表本站立场。本站仅提供信息存储空间服务,不拥有所有权,不承担相关法律责任。如若转载,请注明出处:http://www.mzph.cn/web/79801.shtml

如若内容造成侵权/违法违规/事实不符,请联系多彩编程网进行投诉反馈email:809451989@qq.com,一经查实,立即删除!

相关文章

FPGA图像处理(五)------ 图片水平镜像

利用bram形成双缓冲,如下图配置所示: wr_flag 表明 buffer0写 还是 buffer1写 rd_flag 表明 buffer0读 还是 buffer1读 通过写入逻辑控制(结合wr_finish) 写哪个buffer ;写地址 进而控制ip的写使能 通过状态缓存来跳转buffer的…

微服务八股(自用)

微服务 SpringCloud 注册中心:Eureka 负载均衡:Ribbon 远程调用:Feign 服务熔断:Hystrix 网关:Gateway/Zuul Alibaba 配置中心:Nacos 负载均衡:Ribbon 服务调用:Feign 服务…

ESP32_IDF_OTA_HTTP升级固件

ESP32_IDF_OTA_HTTP升级固件 前言:一个项目的主控使用的是ESP32,因为封装外壳的原因,所以需要采用OTA的方式进行升级,因为之前有对WIFI的OTA有所了解,所以在此基础上,使用官方提供的native_ota_example例程…

MySQL表结构化:数据类型与表生命周期详解

引言 各位数据库学习者大家好!今天我们将深入探讨MySQL中最核心的对象——表(Table)的各类操作 🎯。表是存储数据的基石,就像Excel中的工作表一样,但功能要强大得多!无论是电商网站的用户信息&…

React中的状态管理Dva总结

在 React 开发中,随着应用的复杂度增加,如何高效地管理应用状态成为了一个非常重要的问题。为了解决这一问题,很多开发者选择了 Redux,然而 Redux 的学习曲线较陡,且需要配置较多的样板代码。为此,Ant Desi…

数据结构中的高级排序算法

希尔排序 你可以将希尔排序理解成——先通过几次分组的、较小的组间插入排序将原数组变得有序&#xff0c;最后再进行一次序列基本有序的完整插入排序。 #include <stdio.h>#define ARR_LEN(arr) (sizeof(arr) / sizeof(arr[0]))void print_arr(int arr[], int len) {for…

计算机视觉最不卷的方向:三维重建学习路线梳理

提到计算机视觉&#xff08;CV&#xff09;&#xff0c;大多数人脑海中会立马浮现出一个字&#xff1a;“卷”。卷到什么程度呢&#xff1f;2022年秋招CV工程师岗位数下降了16%&#xff0c;但求职人数增加了23%&#xff0c;求职人数与招聘岗位的比例达到了恐怖的15:1&#xff0…

【Docker】Docker环境下快速部署Ollama与Open-WebUI:详细指南

Docker环境下快速部署Ollama与Open-WebUI&#xff1a;详细指南 在本篇文章中&#xff0c;我们将深入探讨如何在Docker中高效部署 Ollama 和 Open-WebUI&#xff0c;并解决在实际使用中常见的问题&#xff0c;确保你的模型服务稳定高效地运行。 一、Ollama 和 Open-WebUI 快速部…

Vue3学习(组合式API——Watch侦听器详解)

目录 一、Watch侦听器。 &#xff08;1&#xff09;侦听单个数据。 &#xff08;2&#xff09;侦听多个数据。&#xff08;数组写法&#xff1f;&#xff01;&#xff09; &#xff08;3&#xff09;immediate参数。(立即执行回调) &#xff08;3&#xff09;deep参数。(深层监…

SARIMA-LSTM融合模型对太阳黑子数量预测分析|附智能体数据代码

全文智能体链接&#xff1a;https://tecdat.cn/?p41969 分析师&#xff1a;Peng Fan 本研究以太阳黑子活动数据为研究对象&#xff0c;旨在帮助客户探索其未来走势并提供预测分析。首先&#xff0c;通过对数据的清洗和处理&#xff0c;包括离群值的识别与处理以及时间序列的建…

简单易懂的JavaScript中的this指针

文章目录 默认绑定 / 隐式绑定如何调整this1.用变量固定this2.箭头函数2.bind3.call/apply&#xff08;一次性&#xff09; 默认绑定 / 隐式绑定 要找this指针指向谁&#xff0c;我们首先要做的是&#xff1a;找到一个明确的对象&#xff0c;这个对象调用了含有this指针的函数…

Spring MVC数据绑定和响应 你了解多少?

数据绑定的概念 在程序运行时&#xff0c;Spring MVC接收到客户端的请求后&#xff0c;会根据客户端请求的参数和请求头等数据信息&#xff0c;将参数以特定的方式转换并绑定到处理器的形参中。Spring MVC中将请求消息数据与处理器的形参建立连接的过程就是Spring MVC的数据绑…

BMS工具箱用来执行贝叶斯模型平均(BMA)计算模块

贝叶斯模型平均&#xff08;Bayesian Model Averaging&#xff0c;BMA&#xff09;是一种用于处理模型不确定性的统计方法&#xff0c;通过结合多个模型的预测结果来提高预测的准确性和鲁棒性。在 MATLAB 中&#xff0c;可以使用专门的工具箱&#xff08;如 BMS 工具箱&#xf…

Java内存马的检测与发现

【网络安全】Java内存马的检测与发现 一、Java内存马的现象二、检测思路三、重点关注类四、检测方法1. 检查方法&#xff08;FindShell&#xff09;2. 检查方法&#xff08;sa-jdi&#xff09;3. 检查方法&#xff08;arthas-boot&#xff09;4. 检查方法&#xff08;cop.jar&a…

ISP有感自发

一、黑电平 由于传感器&#xff0c;即便在无光的情况下&#xff0c;依然会产生微小的暗电流&#xff0c;这些暗电流可能是噪点会影响后期的调试。因此&#xff0c;我们便将这些电流处理为0&#xff0c;成为纯黑的颜色。可以在源头消除这些误差。 如何矫正黑电平&#xff1a; …

数字信号处理-大实验1.1

MATLAB仿真实验目录 验证实验&#xff1a;常见离散信号产生和实现验证实验&#xff1a;离散系统的时域分析应用实验&#xff1a;语音信号的基音周期&#xff08;频率&#xff09;测定 目录 一、常见离散信号产生和实现 1.1 实验目的 1.2 实验要求与内容 1.3 实验…

【SSL证书系列】https双向认证中客户端认证的原理

HTTPS双向认证&#xff08;也称为双向SSL/TLS认证&#xff09;是一种增强安全性的机制&#xff0c;其中客户端和服务器都需要验证彼此的数字证书&#xff0c;以确保双方身份的真实性。以下是其核心原理和步骤的详细解析&#xff1a; 一、双向认证的核心目标 双向身份验证&#…

Linux系统编程——fork函数的使用方法

在 Linux 系统编程 中&#xff0c;fork() 函数是创建新进程的关键系统调用。fork() 在当前进程&#xff08;父进程&#xff09;中创建一个几乎完全相同的子进程。子进程和父进程从调用 fork() 的位置继续执行&#xff0c;但它们是两个独立的进程&#xff0c;每个进程都有自己的…

LLMs之ChatGPT:《Connecting GitHub to ChatGPT deep research》翻译与解读

LLMs之ChatGPT&#xff1a;《Connecting GitHub to ChatGPT deep research》翻译与解读 导读&#xff1a;这篇OpenAI帮助文档全面介绍了将GitHub连接到ChatGPT进行深度代码研究的方法、优势和注意事项。通过连接GitHub&#xff0c;用户可以充分利用ChatGPT强大的代码理解和生成…

flutter 视频通话flutter_webrtc

flutter 比较热门的库 flutter_webrtc | Flutter package agora_rtc_engine | Flutter package 我使用的是flutter_webrtc 下面是官方推荐的demo库 GitHub - flutter-webrtc/flutter-webrtc-demo: Demo for flutter-webrtc 其中 https://demo.cloudwebrtc.com:8086/ 已经停…