rviz画长方体框

#include <ros/ros.h>
#include <visualization_msgs/Marker.h>

int main(int argc, char** argv) {
  ros::init(argc, argv, "showline");
  ros::NodeHandle n;
  ros::Publisher marker_pub =
      n.advertise<visualization_msgs::Marker>("visualization_marker", 10);
  visualization_msgs::Marker line_list;

  line_list.header.frame_id = "box";
  line_list.lifetime = ros::Duration(0.5);
  line_list.ns = "lines";
  line_list.action = visualization_msgs::Marker::ADD;
  line_list.pose.orientation.w = 1.0;
  line_list.id = 2;
  line_list.type = visualization_msgs::Marker::LINE_LIST;
  line_list.scale.x = 0.1;
  // Line list is red
  line_list.color.r = 1.0;
  line_list.color.a = 1.0;
  geometry_msgs::Point p;
  p.x = 1;
  p.y = 1;
  p.z = 1;
  geometry_msgs::Point p1;
  p1.x = 3;
  p1.y = 1;
  p1.z = 1;
  geometry_msgs::Point p2;
  p2.x = 3;
  p2.y = 2;
  p2.z = 1;
  geometry_msgs::Point p3;
  p3.x = 1;
  p3.y = 2;
  p3.z = 1;
  geometry_msgs::Point p4;
  p4.x = 1;
  p4.y = 1;
  p4.z = 7;
  geometry_msgs::Point p5;
  p5.x = 3;
  p5.y = 1;
  p5.z = 7;
  geometry_msgs::Point p6;
  p6.x = 3;
  p6.y = 2;
  p6.z = 7;
  geometry_msgs::Point p7;
  p7.x = 1;
  p7.y = 2;
  p7.z = 7;
  line_list.points.push_back(p);
  line_list.points.push_back(p1);
  line_list.points.push_back(p1);
  line_list.points.push_back(p2);
  line_list.points.push_back(p2);
  line_list.points.push_back(p3);
  line_list.points.push_back(p3);
  line_list.points.push_back(p);
  
  line_list.points.push_back(p4);
  line_list.points.push_back(p5);
  line_list.points.push_back(p5);
  line_list.points.push_back(p6);
  line_list.points.push_back(p6);
  line_list.points.push_back(p7);
  line_list.points.push_back(p7);
  line_list.points.push_back(p4);

  line_list.points.push_back(p4);
  line_list.points.push_back(p);
  line_list.points.push_back(p5);
  line_list.points.push_back(p1);
  line_list.points.push_back(p6);
  line_list.points.push_back(p2);
  line_list.points.push_back(p7);
  line_list.points.push_back(p3);
  while (ros::ok()) {
    marker_pub.publish(line_list);
    line_list.header.stamp = ros::Time::now();
  }
  // ros::spinOnce();

  return 0;
}
  • 1
    点赞
  • 8
    收藏
    觉得还不错? 一键收藏
  • 打赏
    打赏
  • 2
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论 2
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包

打赏作者

刀么克瑟拉莫

你的鼓励将是我创作的最大动力

¥1 ¥2 ¥4 ¥6 ¥10 ¥20
扫码支付:¥1
获取中
扫码支付

您的余额不足,请更换扫码支付或充值

打赏作者

实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

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

余额充值