位置: IT常识 - 正文

ros(23):接收rviz中的2D Nav Goal、2D Pose Estimate消息(ros urdf)

编辑:rootadmin
ros(23):接收rviz中的2D Nav Goal、2D Pose Estimate消息 1 rviz 教程1.1 2D Nav Goal2D Nav Goal (Keyboard shortcut: g)

推荐整理分享ros(23):接收rviz中的2D Nav Goal、2D Pose Estimate消息(ros urdf),希望有所帮助,仅作参考,欢迎阅读内容。

文章相关热门搜索词:ros irq,ros subscribe 参数,ros subscribe 参数,ros接收发送节点信息,ros接收发送节点信息,ros接收发送节点信息,ros irq,ros接入ssr,内容如对您有帮助,希望把文章链接给更多的朋友!

This tool lets you set a goal sent on the "goal" ROS topic. Click on a location on the ground plane and drag to select the orientation:

二维导航目标(快捷键:g) 此工具允许您设置在“goal”ROS主题上发送的目标。单击地平面上的某个位置并拖动以选择方向:

即设置二维导航目标,并使用“goal”这个话题进行通讯(结合rviz的其他教程,话题名也可能是“/move_base_simple/goal”)

其消息类型为:geometry_msgs/PoseStamped

meng@meng:~/ideas/ros_ws$ rosmsg info geometry_msgs/PoseStampedstd_msgs/Header header uint32 seq time stamp string frame_idgeometry_msgs/Pose pose geometry_msgs/Point position float64 x float64 y float64 z geometry_msgs/Quaternion orientation float64 x float64 y float64 z float64 w1.2 2D Pose Estimate2D Pose Estimate (Keyboard shortcut: p)

This tool lets you set an initial pose to seed the localization system (sent on the "initialpose" ROS topic). Click on a location on the ground plane and drag to select the orientation:

二维姿势估计(键盘快捷键:p) 此工具允许您设置初始姿势以播种定位系统(发送至“initialpose”ROS主题)。单击地平面上的某个位置并拖动以选择方向:

即设置二维初始位姿并使用“initialpose”进行通讯

ros(23):接收rviz中的2D Nav Goal、2D Pose Estimate消息(ros urdf)

其消息类型为:geometry_msgs/PoseWithCovarianceStamped

meng@meng:~/ideas/ros_ws$ rosmsg info geometry_msgs/PoseWithCovarianceStampedstd_msgs/Header header uint32 seq time stamp string frame_idgeometry_msgs/PoseWithCovariance pose geometry_msgs/Pose pose geometry_msgs/Point position float64 x float64 y float64 z geometry_msgs/Quaternion orientation float64 x float64 y float64 z float64 w float64[36] covariance1.3 打开rviz查看

Panels--Tool Properties(勾选)

 

2 订阅话题

订阅起点位姿和终点话题并打印输出的c++文件:receive_2d_nav_goal.cpp

#include "ros/ros.h"#include "std_msgs/String.h"#include <geometry_msgs/PoseWithCovarianceStamped.h>#include <iostream>#include <geometry_msgs/PoseStamped.h>void chatterCallback(const geometry_msgs::PoseWithCovarianceStamped::ConstPtr& msg){ double x=msg->pose.pose.position.x; double y=msg->pose.pose.position.y; std::cout<<x<<y<<std::endl;}void chatterCallback1(const geometry_msgs::PoseStamped::ConstPtr& msg){ std::cout<<"1111"<<std::endl; double x=msg->pose.position.x; double y=msg->pose.position.y; std::cout<<x<<y<<std::endl;}int main(int argc, char **argv){ ros::init(argc, argv, "reveive_rviz"); ros::NodeHandle nh; ros::Subscriber sub = nh.subscribe("/initialpose", 1, chatterCallback);//队列长度:1000或1或其他 ros::Subscriber sub1 = nh.subscribe("/move_base_simple/goal", 1, chatterCallback1);//队列长度:1000或1或其他while(ros::ok()){ ros::spinOnce();} return 0;}

启动rviz和节点程序,用 2D Nav Goal、2D Pose Estimate 在rviz中做标记,即可打印输出:

订阅起点位姿和终点,并保持发布:

#include "ros/ros.h"#include "std_msgs/String.h"#include <geometry_msgs/PoseWithCovarianceStamped.h>#include <iostream>#include <geometry_msgs/PoseStamped.h>ros::Publisher initialpose_pub,goal_pub;geometry_msgs::PoseWithCovarianceStamped initialpose_tmp;//设置为全局变量,可以一直被发布出来geometry_msgs::PoseStamped goal_tmp;void initialpose_handler(const geometry_msgs::PoseWithCovarianceStamped::ConstPtr& msg){ double x=msg->pose.pose.position.x; double y=msg->pose.pose.position.y; std::cout<<"起点坐标:("<<x<<", "<<y<<")"<<std::endl; initialpose_tmp=*msg; // initialpose_tmp.header=msg->header; // initialpose_tmp.header=msg->header; initialpose_pub.publish(initialpose_tmp);}void goal_handler(const geometry_msgs::PoseStamped::ConstPtr& msg){ double x=msg->pose.position.x; double y=msg->pose.position.y; std::cout<<"终点坐标:("<<x<<", "<<y<<")"<<std::endl; goal_tmp=*msg; goal_pub.publish(*msg);}int main(int argc, char **argv){ ros::init(argc, argv, "reveive_rviz"); ros::NodeHandle nh; ros::Subscriber sub = nh.subscribe("/initialpose", 1, initialpose_handler);//1000改为1 ros::Subscriber sub1 = nh.subscribe("/move_base_simple/goal", 1, goal_handler);//1000改为1 initialpose_pub = nh.advertise<geometry_msgs::PoseWithCovarianceStamped>("initialpose_my", 1); goal_pub = nh.advertise<geometry_msgs::PoseStamped>("goal_my", 1); while(ros::ok()) { ros::spinOnce(); } return 0;}

参考链接:

2D Nav Goal和2D Pose Estimate功能介绍:rviz/UserGuide - ROS Wiki

2D Nav Goal和2D Pose Estimate的消息类型:navigation/Tutorials/Using rviz with the Navigation Stack - ROS Wiki 

本文链接地址:https://www.jiuchutong.com/zhishi/292298.html 转载请保留说明!

上一篇:一年一度的施瓦本哈尔圣诞市集,德国巴登-符腾堡州 (© sack/Getty Images Plus)

下一篇:阿拉斯加普拉德霍湾附近的雄性麝牛 (© Oliver Smart/Alamy)(阿拉斯给加拉普)

  • oppok9s能开空调吗(oppor9手机能开空调)

    oppok9s能开空调吗(oppor9手机能开空调)

  • 网易邮箱怎么换绑(网易邮箱怎么换实名认证)

    网易邮箱怎么换绑(网易邮箱怎么换实名认证)

  • 微信群屏蔽不接收消息怎么办(微信群屏蔽某个人接收不到群内消息)

    微信群屏蔽不接收消息怎么办(微信群屏蔽某个人接收不到群内消息)

  • 抖音买热门能看出来吗(抖音买热门浏览有用吗)

    抖音买热门能看出来吗(抖音买热门浏览有用吗)

  • 美图秀秀能去掉小视频水印吗(美图秀秀能去掉多余人)

    美图秀秀能去掉小视频水印吗(美图秀秀能去掉多余人)

  • 系统软件就是操作系统对不对(软件系统就是操作系统吗)

    系统软件就是操作系统对不对(软件系统就是操作系统吗)

  • 苹果手机下载需要验证是怎么回事(苹果手机下载需要密码怎么设置)

    苹果手机下载需要验证是怎么回事(苹果手机下载需要密码怎么设置)

  • 挂电话会提示什么(挂电话会提示什么语音)

    挂电话会提示什么(挂电话会提示什么语音)

  • 手机视频看不了怎么回事(手机视频看不了是什么情况)

    手机视频看不了怎么回事(手机视频看不了是什么情况)

  • 苹果相册里的视频加载不出来(苹果相册里的视频怎么变慢动作)

    苹果相册里的视频加载不出来(苹果相册里的视频怎么变慢动作)

  • 提示null什么意思(nullnull啥意思)

    提示null什么意思(nullnull啥意思)

  • 笔记本上有摄像头吗(笔记本上有摄像头但就是打不开)

    笔记本上有摄像头吗(笔记本上有摄像头但就是打不开)

  • 小米note3是什么材质的屏幕(小米note3属于什么系列)

    小米note3是什么材质的屏幕(小米note3属于什么系列)

  • 抖音视频怎么彻底删除(如何彻底删除抖音视频)

    抖音视频怎么彻底删除(如何彻底删除抖音视频)

  • iphone11有5g网络吗(苹果11手机有5g)

    iphone11有5g网络吗(苹果11手机有5g)

  • 苹果11老是重启(苹果11老是重启修不了什么办呢)

    苹果11老是重启(苹果11老是重启修不了什么办呢)

  • 天猫小黑盒是啥意思(天猫小黑盒子是什么意思)

    天猫小黑盒是啥意思(天猫小黑盒子是什么意思)

  • 做视频用什么软件(做视频用什么软件最好无水印)

    做视频用什么软件(做视频用什么软件最好无水印)

  • 荣耀10怎么才能熄屏显示时间(荣耀怎么才能开出shr)

    荣耀10怎么才能熄屏显示时间(荣耀怎么才能开出shr)

  • 步数宝寒冬补助怎么领不了(步数宝怎么样)

    步数宝寒冬补助怎么领不了(步数宝怎么样)

  • apple教育优惠怎么买(apple教育优惠怎么用)

    apple教育优惠怎么买(apple教育优惠怎么用)

  • u盘装系统后系统不能进入一直黑屏的原因分析及解决方法(u盘装系统系统放哪里)

    u盘装系统后系统不能进入一直黑屏的原因分析及解决方法(u盘装系统系统放哪里)

  • 芒通,法国 (© Flavio Foglietta/Getty Images)

    芒通,法国 (© Flavio Foglietta/Getty Images)

  • 增值税开票软件客服电话
  • 增值税结转和个体工商户的增值税缴纳分录如何做?
  • 母公司给子公司注资需要什么手续
  • 服务费的增值税怎么算
  • 企业筹建期间契税账务处理
  • 固定资产变卖怎么开票
  • 非限定性净资产包括哪些科目
  • 负数发票可以作废不
  • 盘盈的固定资产怎么做账务处理
  • 避税方法一般有几种
  • 退货应入会计什么科目
  • 购进原材料验收入库,贷款商业汇票结算
  • 非盈利组织捐赠支出
  • 银行里的钱没有了怎么办
  • 公司团建收取员工费用
  • 销售退回跨年所得税如何做账?
  • 公司为员工购买五险一金是什么意思
  • 个人劳务报酬所得汇算清缴
  • 税款滞纳金怎么入账
  • 去年没有交社保,今年交了有用吗
  • 垫资的利息的合法区间
  • 合同资产减值准备对应科目
  • 本期免税收入是什么
  • 公司开一般户弊端
  • 招标文件费开票品目
  • 个人收回转让的股权个税应如何处理?
  • 顶账物品都有哪些
  • 弥补以前年度亏损是什么意思
  • 连接另外一个设备
  • 651错误是怎么回事
  • 电脑上网速度慢的原因及解决方法
  • 代开专票计提附加税吗
  • 电脑dwm.exe是什么
  • 投资性房地产转换日公允价值大于账面价值
  • dghm.exe是什么程序
  • 哪些情况需要做进项税转出
  • 如何配置apache
  • vue中的use
  • php 抓取别的网站的内容
  • discuz论坛修改密码位置
  • 模式识别与图像处理能做什么
  • chat gpt 国内版免费手机
  • torch.nn.Conv3d
  • discuz如何关闭站点
  • python字典keys方法 顺序
  • 苹果cmsv10官网
  • 印花税没交会怎么样
  • 库存盘点差异分录
  • 资产负债表中应交税费为负数是什么意思
  • python的socket
  • mysql binlog详解
  • 收到返工费会计分录
  • 工费经费计入哪里
  • 先预付货款,货到了怎么做账
  • 提取折旧的意义
  • 收到银行承兑汇票怎么处理
  • 专项应付款如何核算
  • 企业尚未给予指定用途
  • 诉讼费给开发票吗
  • 预付性费用支出计入
  • 飞机票没有发票只有行程单
  • 软件开发过程中,一个错误发现的越晚
  • 目标考核奖金做什么科目
  • 哪些行为应作为证据
  • 预提费用怎么做凭证
  • mysql不同数据库不同数据表导入数据
  • windows自带安全
  • mac上怎么取消itunes自动续费
  • windows 安装app
  • mac如何用u盘安装win10
  • win8开机进入开始界面
  • redhat无法启动
  • win7打开回收站
  • Unity5 Assetbundle简单使用 及 打包Material文件超大的问题
  • css fontstyle
  • javascript用什么写
  • python设计gui
  • java script课程
  • 买新房子需要交契税吗
  • 年度申报个人所得税专项扣除多填了怎么办
  • 免责声明:网站部分图片文字素材来源于网络,如有侵权,请及时告知,我们会第一时间删除,谢谢! 邮箱:opceo@qq.com

    鄂ICP备2023003026号

    网站地图: 企业信息 工商信息 财税知识 网络常识 编程技术

    友情链接: 武汉网站建设