销售市场撒擦发

% 读取文件路径
filePath = 'C:\Users\lx192\Desktop\八协解mavlink结果2.txt';


% 打开文件
fid = fopen(filePath, 'r');

% 初始化数据存储变量
latitude = [];
longitude = [];
altitude = [];

% 逐行读取文件内容
while ~feof(fid)
    line = fgetl(fid);
    % 解析每一行的数据
    if startsWith(line, '飞行器纬度: ') && contains(line, ', 飞行器经度: ') && contains(line, ', 飞行器高度: ')
        % 提取纬度、经度和高度数据
        data = sscanf(line, '飞行器纬度: %f, 飞行器经度: %f, 飞行器高度: %fm');
        latitude = [latitude; data(1)];
        longitude = [longitude; data(2)];
        altitude = [altitude; data(3)];
    end
end

% 关闭文件
fclose(fid);

% 绘制三维可视化图
figure;
scatter3(latitude, longitude, altitude, 'filled');
xlabel('纬度');
ylabel('经度');
zlabel('高度 (米)');
title('飞行器轨迹三维可视化');
grid on;

% 设置坐标轴范围
xlim([34.75, 34.89]);
ylim([113.50, 113.58]);

using System;
using System.IO;

internal class Program
{
    static void Main(string[] args)
    {
        Console.WriteLine("请输入要读取的文件路径:");
        string filePath = Console.ReadLine();

        string desktopPath = Environment.GetFolderPath(Environment.SpecialFolder.Desktop);
        string outputPath = Path.Combine(desktopPath, "八协解mavlink结果2.txt");

        FileStream fileStream = new FileStream(outputPath, FileMode.Create);
        StreamWriter streamWriter = new StreamWriter(fileStream);
        Console.SetOut(streamWriter);

        FileStream fs = new FileStream(filePath, FileMode.Open);
        MAVLink.MavlinkParse parse = new MAVLink.MavlinkParse();
        while (fs.Position < fs.Length)
        {
            var msg = parse.ReadPacket(fs);
            if (msg != null && msg.msgid == 33)
            {
                MAVLink.mavlink_global_position_int_t p = (MAVLink.mavlink_global_position_int_t)msg.data;
                Console.WriteLine("飞行器纬度: {0}, 飞行器经度: {1}, 飞行器高度: {2}米", p.lat / 1E7, p.lon / 1E7, p.relative_alt / 1E3);
                // 还可以执行其他操作...
            }

        }
        fs.Close();

        // 关闭文件流
        streamWriter.Close();
        fileStream.Close();
    }
}
 

 

using System;
using System.IO;

internal class Program
{
    static void Main(string[] args)
    {
        Console.WriteLine("请输入要读取的文件路径:");
        string filePath = Console.ReadLine();

        string desktopPath = Environment.GetFolderPath(Environment.SpecialFolder.Desktop);
        string outputPath = Path.Combine(desktopPath, "八协解mavlink结果2.txt");

        FileStream fileStream = new FileStream(outputPath, FileMode.Create);
        StreamWriter streamWriter = new StreamWriter(fileStream);
        Console.SetOut(streamWriter);

        FileStream fs = new FileStream(filePath, FileMode.Open);
        MAVLink.MavlinkParse parse = new MAVLink.MavlinkParse();
        while (fs.Position < fs.Length)
        {
            var msg = parse.ReadPacket(fs);
            if (msg != null && msg.msgid == 33)
            {
                MAVLink.mavlink_global_position_int_t p = (MAVLink.mavlink_global_position_int_t)msg.data;
                Console.WriteLine("飞行器纬度: {0}, 飞行器经度: {1}, 飞行器高度: {2}米", p.lat / 1E7, p.lon / 1E7, p.relative_alt / 1E3);
                // 还可以执行其他操作...
            }

        }
        fs.Close();

        // 关闭文件流
        streamWriter.Close();
        fileStream.Close();
    }
}
  • 5
    点赞
  • 3
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值