GPS 定位信息获取（北斗星通 GPS）

GPS 定位信息获取（1）

首先回顾北斗星通 GPS 数据获取（1）~（5）

  • gps_pub.cpp 将接收到的串口数据转化为GPS的经纬度信息
  • gps_path.cpp 将经纬度信息转化为全局坐标系下的XY值，以第一个GPS经纬度为原点

目前已确定可以接收差分数据，但是 GPGGA 指令只能获取经纬度信息，无法获取航向信息

GPRMC 指令

查阅指令手册发现 GPRMC 指令可以位置、速度、航向等期望的信息

在这里插入图片描述
在这里插入图片描述
在这里插入图片描述

Heading 模式指令

要获取航向角信息需要满足一定的条件，即需要开启 Heading 模式

在这里插入图片描述

💡 本指令用于设置支持单板卡（模块）双天线定向的接收机（UB482、UM482、UM442）

车载接收机的型号是 NC502 系列，内置板卡 UB482，支持 Heading 模式

在这里插入图片描述

接收机及蘑菇头安装

按照《NPOS220S接收机操作使用说明书》中的说明，接收机和双天线的安装需要满足如下要求

在这里插入图片描述
在这里插入图片描述
但是由于接收机型号不同，本接收机机身并未标有 X/Y/Z 轴指向，可能需要根据实际的数据判断

GPS 定位信息获取（2）

下午把车开出去跑了一下，没有开下坡，直接从台阶那边搬下去，没有开很远，所幸没坏

用 cutecom 获取数据，原始数据如下

[16:52:13:433] $command,gprmc 1,response: OK*24␍␊
[16:52:14:643] $GPRMC,085115.00,A,3150.93331124,N,11717.59467080,E,0.014,5.3,101123,5.6,W,D*21␍␊
[16:52:15:643] $GPRMC,085116.00,A,3150.93332581,N,11717.59468186,E,0.041,59.4,101123,5.6,W,D*1C␍␊
[16:52:16:641] $GPRMC,085117.00,A,3150.93333013,N,11717.59468264,E,0.066,81.7,101123,5.6,W,D*1E␍␊
[16:52:17:642] $GPRMC,085118.00,A,3150.93333688,N,11717.59468779,E,0.071,77.2,101123,5.6,W,D*16␍␊
[16:52:18:645] $GPRMC,085119.00,A,3150.93333483,N,11717.59468236,E,0.038,89.2,101123,5.6,W,D*1C␍␊
[16:52:19:646] $GPRMC,085120.00,A,3150.93334090,N,11717.59465670,E,0.061,337.7,101123,5.6,W,D*23␍␊
[16:52:20:646] $GPRMC,085121.00,A,3150.93331782,N,11717.59463967,E,0.082,331.4,101123,5.6,W,D*24␍␊
[16:52:21:646] $GPRMC,085122.00,A,3150.93330466,N,11717.59461499,E,0.089,238.0,101123,5.6,W,D*26␍␊

为了更接近串口通信获取到的数据，进行一些简单的处理

sed 's/^\[.*\] //' input.txt > output.txt
sed 's/..$//' input.txt > output.txt
  • s/^\[.*\] //：替换每一行开头的**[16:52:14:643]为空白。这里使用正则表达式 ^\[.*\] 匹配每一行开头的[16:52:14:643]**，然后用空白替换
  • 使用正则表达式 ..$ 匹配每一行末尾的最后两个字符，然后将其替换为空白

处理后如下

$command,gprmc 1,response: OK*24
$GPRMC,085115.00,A,3150.93331124,N,11717.59467080,E,0.014,5.3,101123,5.6,W,D*21
$GPRMC,085116.00,A,3150.93332581,N,11717.59468186,E,0.041,59.4,101123,5.6,W,D*1C
$GPRMC,085117.00,A,3150.93333013,N,11717.59468264,E,0.066,81.7,101123,5.6,W,D*1E
$GPRMC,085118.00,A,3150.93333688,N,11717.59468779,E,0.071,77.2,101123,5.6,W,D*16
$GPRMC,085119.00,A,3150.93333483,N,11717.59468236,E,0.038,89.2,101123,5.6,W,D*1C
$GPRMC,085120.00,A,3150.93334090,N,11717.59465670,E,0.061,337.7,101123,5.6,W,D*23
$GPRMC,085121.00,A,3150.93331782,N,11717.59463967,E,0.082,331.4,101123,5.6,W,D*24

注意进行 3 组实验

  1. 原地顺时针转向 — clockwise.txt
  2. 原地逆时针转向 — anticlockwise.txt
  3. 任意轨迹运动 — path.txt

GPRMC 指令的纬度、经度、航向角信息分别对应 4、6、9 字段

在这里插入图片描述
在这里插入图片描述

参考陆辉东编写的 gps_sensor 功能包编写解析代码如下

#include <iostream>
#include <string.h>
#include <stdio.h>
#include <boost/algorithm/string.hpp>
#include <vector>
#include <cstdlib>
#include <sstream>
#include <fstream>
#include <math.h>
using namespace std;static double EARTH_RADIUS = 6371.393;//6378.137;//地球半径struct my_pose
{double latitude;double longitude;
};// 角度制转弧度制
double rad(double d)
{return d * 3.1415926 / 180.0;
}int main(int argc, char **argv)
{const string filePath = "/home/redwall/catkin_ws/src/gps_sensor/log/2023-11-10/clockwise.txt";ifstream log_file(filePath);if (!log_file.is_open()){cerr << "Failed to open the file!" << endl;return -1;}bool is_init_pose = false;my_pose init_pose;string one_line;vector<string> raw_strs;while (getline(log_file, one_line)){// split one line data by ","boost::split(raw_strs, one_line, boost::is_any_of(","));cout << "raw data:" << raw_strs[3] << "\t" << raw_strs[5] << "\t" << raw_strs[8] << endl;double latitude, longitude, heading_angle;vector<string> data_strs;boost::split(data_strs, raw_strs[3], boost::is_any_of("."));latitude = atoi(data_strs[0].c_str()) / 100 + (atoi(data_strs[0].c_str()) % 100 + atoi(data_strs[1].c_str()) / 100000000.0) / 60.0;boost::split(data_strs, raw_strs[5], boost::is_any_of("."));longitude = atoi(data_strs[0].c_str()) / 100 + (atoi(data_strs[0].c_str()) % 100 + atoi(data_strs[1].c_str()) / 100000000.0) / 60.0;heading_angle = stod(raw_strs[8]);cout << "latitude: " << latitude << "\tlongitude: " << longitude << "\theading_angle: " << heading_angle << endl;if (!is_init_pose){init_pose.latitude = latitude;init_pose.longitude = longitude;is_init_pose = true;}else{// 计算相对位置double radLat1, radLat2, radLong1, radLong2, delta_lat, delta_long;radLat1 = rad(init_pose.latitude);radLong1 = rad(init_pose.longitude);radLat2 = rad(latitude);radLong2 = rad(longitude);// 计算xdelta_lat = radLat2 - radLat1;delta_long = 0;double x = 2 * asin(sqrt(pow(sin(delta_lat / 2), 2) + cos(radLat1) * cos(radLat2) * pow(sin(delta_long / 2), 2)));x = x * EARTH_RADIUS * 1000;// 计算ydelta_lat = 0;delta_long = radLong1 - radLong2;double y = 2 * asin(sqrt(pow(sin(delta_lat / 2), 2) + cos(radLat2) * cos(radLat2) * pow(sin(delta_long / 2), 2)));y = y * EARTH_RADIUS * 1000;cout << "x: " << x << "\ty: " << y << endl;cout << "---------" << endl;}}return 0;
}

输出如下，与原始数据中的对应字段相符

raw data:3150.93331124	11717.59467080	5.3
latitude: 31.8489	longitude: 117.293	heading_angle: 5.3
raw data:3150.93332581	11717.59468186	59.4
latitude: 31.8489	longitude: 117.293	heading_angle: 59.4
x: 0.0270035	y: 0.017412
---------
raw data:3150.93333013	11717.59468264	81.7
latitude: 31.8489	longitude: 117.293	heading_angle: 81.7
x: 0.03501	y: 0.01864
---------
raw data:3150.93333688	11717.59468779	77.2
latitude: 31.8489	longitude: 117.293	heading_angle: 77.2
x: 0.0475202	y: 0.0267478
---------
raw data:3150.93333483	11717.59468236	89.2
latitude: 31.8489	longitude: 117.293	heading_angle: 89.2
x: 0.0437208	y: 0.0181992
---------
raw data:3150.93334090	11717.59465670	337.7
latitude: 31.8489	longitude: 117.293	heading_angle: 337.7
x: 0.0549707	y: 0.022198
---------
raw data:3150.93331782	11717.59463967	331.4
latitude: 31.8489	longitude: 117.293	heading_angle: 331.4
x: 0.0121951	y: 0.0490088
---------
raw data:3150.93330466	11717.59461499	238.0
latitude: 31.8489	longitude: 117.293	heading_angle: 238
x: 0.0121951	y: 0.0878631
---------
raw data:3150.93333556	11717.59459573	269.0
latitude: 31.8489	longitude: 117.293	heading_angle: 269
x: 0.0450738	y: 0.118185
---------
raw data:3150.93335679	11717.59456484	265.9
latitude: 31.8489	longitude: 117.293	heading_angle: 265.9
x: 0.0844207	y: 0.166816
---------
raw data:3150.93336170	11717.59454041	282.2
latitude: 31.8489	longitude: 117.293	heading_angle: 282.2
x: 0.0935207	y: 0.205276
---------
raw data:3150.93338996	11717.59451834	294.5
latitude: 31.8489	longitude: 117.293	heading_angle: 294.5
x: 0.145897	y: 0.240022
---------
raw data:3150.93342933	11717.59450323	334.3
latitude: 31.8489	longitude: 117.293	heading_angle: 334.3
x: 0.218864	y: 0.26381
---------
raw data:3150.93345386	11717.59449815	338.9
latitude: 31.8489	longitude: 117.293	heading_angle: 338.9
x: 0.264327	y: 0.271807
---------
raw data:3150.93348823	11717.59450537	10.2
latitude: 31.8489	longitude: 117.293	heading_angle: 10.2
x: 0.328027	y: 0.260441
---------
raw data:3150.93353467	11717.59451156	6.5
latitude: 31.8489	longitude: 117.293	heading_angle: 6.5
x: 0.414097	y: 0.250696
---------
raw data:3150.93358054	11717.59453627	24.7
latitude: 31.8489	longitude: 117.293	heading_angle: 24.7
x: 0.499111	y: 0.211794
---------
raw data:3150.93360846	11717.59458635	56.9
latitude: 31.8489	longitude: 117.293	heading_angle: 56.9
x: 0.550857	y: 0.132952
---------
raw data:3150.93366693	11717.59460345	14.0
latitude: 31.8489	longitude: 117.293	heading_angle: 14
x: 0.659223	y: 0.106031
---------
raw data:3150.93370425	11717.59465149	47.7
latitude: 31.8489	longitude: 117.293	heading_angle: 47.7
x: 0.72839	y: 0.0304002
---------
raw data:3150.93372192	11717.59471207	63.2
latitude: 31.8489	longitude: 117.293	heading_angle: 63.2
x: 0.761139	y: 0.0649724
---------
raw data:3150.93370758	11717.59477295	87.8
latitude: 31.8489	longitude: 117.293	heading_angle: 87.8
x: 0.734562	y: 0.160817
---------
raw data:3150.93369450	11717.59483801	93.8
latitude: 31.8489	longitude: 117.293	heading_angle: 93.8
x: 0.71032	y: 0.263243
---------
raw data:3150.93367488	11717.59488022	116.6
latitude: 31.8489	longitude: 117.293	heading_angle: 116.6
x: 0.673957	y: 0.329695
---------
raw data:3150.93365466	11717.59492160	118.6
latitude: 31.8489	longitude: 117.293	heading_angle: 118.6
x: 0.636482	y: 0.394841
---------
raw data:3150.93361987	11717.59494557	122.0
latitude: 31.8489	longitude: 117.293	heading_angle: 122
x: 0.572003	y: 0.432577
---------
raw data:3150.93356921	11717.59496880	130.5
latitude: 31.8489	longitude: 117.293	heading_angle: 130.5
x: 0.478112	y: 0.469149
---------
raw data:3150.93353325	11717.59498063	148.4
latitude: 31.8489	longitude: 117.293	heading_angle: 148.4
x: 0.411465	y: 0.487773
---------
raw data:3150.93347774	11717.59498615	164.2
latitude: 31.8489	longitude: 117.293	heading_angle: 164.2
x: 0.308585	y: 0.496464
---------
raw data:3150.93341225	11717.59497409	183.9
latitude: 31.8489	longitude: 117.293	heading_angle: 183.9
x: 0.187208	y: 0.477477
---------
raw data:3150.93335876	11717.59495099	200.5
latitude: 31.8489	longitude: 117.293	heading_angle: 200.5
x: 0.0880718	y: 0.44111
---------
raw data:3150.93331556	11717.59490935	227.1
latitude: 31.8489	longitude: 117.293	heading_angle: 227.1
x: 0.00800653	y: 0.375555
---------
raw data:3150.93328314	11717.59486159	233.1
latitude: 31.8489	longitude: 117.293	heading_angle: 233.1
x: 0.0520795	y: 0.300366
---------
raw data:3150.93326676	11717.59479839	239.3
latitude: 31.8489	longitude: 117.293	heading_angle: 239.3
x: 0.0824376	y: 0.200868
---------
raw data:3150.93325654	11717.59472604	255.8
latitude: 31.8489	longitude: 117.293	heading_angle: 255.8
x: 0.101379	y: 0.0869658
---------
raw data:3150.93325328	11717.59474098	253.8
latitude: 31.8489	longitude: 117.293	heading_angle: 253.8
x: 0.107421	y: 0.110486
---------
raw data:3150.93324540	11717.59474752	255.1
latitude: 31.8489	longitude: 117.293	heading_angle: 255.1
x: 0.122025	y: 0.120782
---------
raw data:3150.93324398	11717.59474844	280.4
latitude: 31.8489	longitude: 117.293	heading_angle: 280.4
x: 0.124657	y: 0.122231
---------
raw data:3150.93324677	11717.59474572	270.3
latitude: 31.8489	longitude: 117.293	heading_angle: 270.3
x: 0.119486	y: 0.117948
---------

需要在 MATLAB 中进一步分析结果

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

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

相关文章

webrtc AEC 线性滤波 PBFDAF（均匀分块频域自适应滤波）介绍

webrtc AEC 线性滤波 PBFDAF（均匀分块频域自适应滤波）介绍

计算一个脉冲响应和输入信号的卷积&#xff0c;除了使用原始的时域卷积以外&#xff0c;还有如下方法&#xff1a; FFT卷积的方法&#xff1a;对输入信号&#xff08;长度M&#xff09;和脉冲响应&#xff08;长度N&#xff09;分别补零到K&#xff08;K>MN-1)&#xff0c;…
阅读更多...
spring aop核心原理概念

spring aop核心原理概念

目录 概述aop核心概念解析Target(目标对象)Joinpoint(连接点)Advice(通知/增加)Pointcut(切入点)Aspect(切面)Advisor(通知器)Weaving(织入)Proxy(代理)Introduction(引介) 结束 概述 aop核心概念解析 Target(目标对象) 代理的目标对象 目标对象(Target)的确立&#xff0c;是…
阅读更多...
微信公众号对接获取用户openid预约项目心路全历程

微信公众号对接获取用户openid预约项目心路全历程

公众号对接获取openid全历程 一、背景二、选型三、开始修改若依框架四、自己搭后端框架五、前端框架uni-app修改六、对接获取公众号登录用户openId七、总结 一、背景 老板接了朋友的一个公众号需求&#xff0c;要求做一个简单的疫苗预约系统。功能是获取当前登录用户&#xff0…
阅读更多...
系列十五、BeanDefinition

系列十五、BeanDefinition

一、BeanDefinition 1.1、概述 BeanDefinition是一个接口&#xff0c;主要负责存储bean的定义信息&#xff0c;决定bean的生产方式&#xff0c;类似于说明书。后续BeanFactory就可以根据这些信息生产bean了。比如实例化&#xff1a;可以通过反射得到实例对象&#xff1b;比如&…
阅读更多...
【版本管理 | Git 】Git最佳实践系列（一） —— LFS .gitignore 最佳实践，确定不来看看？

【版本管理 | Git 】Git最佳实践系列（一） —— LFS .gitignore 最佳实践，确定不来看看？

&#x1f935;‍♂️ 个人主页: AI_magician &#x1f4e1;主页地址&#xff1a; 作者简介&#xff1a;CSDN内容合伙人&#xff0c;全栈领域优质创作者。 &#x1f468;‍&#x1f4bb;景愿&#xff1a;旨在于能和更多的热爱计算机的伙伴一起成长&#xff01;&#xff01;&…
阅读更多...
【腾讯云云上实验室-向量数据库】用向量数据库——实现高效文本检索功能

【腾讯云云上实验室-向量数据库】用向量数据库——实现高效文本检索功能

文章目录 前言Tencent Cloud VectorDB 简介Tencent Cloud VectorDB 使用实战申请腾讯云向量数据库腾讯云向量数据库使用步骤腾讯云向量数据库实现文本检索 结论和建议 前言 想必各位开发者一定使用过关系型数据库MySQL去存储我们的项目的数据&#xff0c;也有部分人使用过非关…
阅读更多...
Kafka配置SASL认证密码登录

Kafka配置SASL认证密码登录

​​​​​​1、修改config/server.properties&#xff0c;添加如下内容 listenersSASL_PLAINTEXT://内网ip:9092 advertised.listenersSASL_PLAINTEXT://外网ip:9092 security.inter.broker.protocolSASL_PLAINTEXT sasl.mechanism.inter.broker.protocolPLAIN sasl.enabled.…
阅读更多...
Vue解析器

Vue解析器

解析器本质上是一个状态机。但我们也曾提到&#xff0c;正则表达式其实也是一个状态机。因此在编写 parser 的时候&#xff0c;利用正则表达式能够让我们少写不少代码。本章我们将更多地利用正则表达式来实现 HTML 解析器。另外&#xff0c;一个完善的 HTML 解析器远比想象的要…
阅读更多...
高性能Mysql第三版学习（一）

高性能Mysql第三版学习（一）

学习目标&#xff1a; 高性能Mysql第3版 学习内容&#xff1a; MySQL架构与历史Mysql基座测试服务器性能Schema与数据类型优化创建高性能的索引查询性能优化Mysql高级特性Explain 学习时间&#xff1a; 周一至周五晚上 9点—晚上10点周六晚上9点-10点周日晚上9 点-10点 学习…
阅读更多...
鸿蒙开发-ArkTS 语言-基础语法

鸿蒙开发-ArkTS 语言-基础语法

1. 初识 ArkTS 语言 ArkTS 是 HarmonyOS 优选主力开发语言。ArkTS 是基于 TypeScript (TS) 扩展的一门语言&#xff0c;继承了 TS 的所有特性&#xff0c;是TS的超集。 主要是扩展了以下几个方面&#xff1a; 声明式UI描述和自定义组件&#xff1a; ArkTS使用声明式的方式描述用…
阅读更多...
java计算下一个整10分钟时间点

java计算下一个整10分钟时间点

最近工作上遇到需要固定在整10分钟一个周期调度某个任务&#xff0c;所以需要这样一个功能&#xff0c;记录下 package org.example;import com.google.gson.Gson; import org.apache.commons.lang3.time.DateUtils;import java.io.InputStream; import java.util.Calendar; i…
阅读更多...
JWT和Token之间的区别

JWT和Token之间的区别

✅作者简介&#xff1a;大家好&#xff0c;我是Leo&#xff0c;热爱Java后端开发者&#xff0c;一个想要与大家共同进步的男人&#x1f609;&#x1f609; &#x1f34e;个人主页&#xff1a;Leo的博客 &#x1f49e;当前专栏&#xff1a;每天一个知识点 ✨特色专栏&#xff1a…
阅读更多...
推荐文章
最新文章

Copyright @ 2022~2023