ros多个小乌龟_ROS通过图形化界面控制和查看小乌龟参数(示例代码)

ROS图形化界面能够让我们快速开发ROS,也有利于我们观测数据。

下面介绍一下利用图形化界面控制小乌龟按照指令行进和查看小乌龟的行进参数。

首先我们需要做一些准备工作:

在Terminal中运行以下命令:

$ roscore

新开一个terminal,运行以下命令,打开小乌龟窗口:

$ rosrun turtlesim turtlesim_node

新开一个terminal,运行以下命令,打开乌龟控制窗口,可使用方向键控制乌龟运动:

$ rosrun turtlesim turtle_teleop_key

选中控制窗口,按方向键,可看到小乌龟窗口中乌龟在运动。

1.图形化界面控制小乌龟行进

(1)新打开一个terminal,输入如下命令打开publisher 图形化界面

rosrun rqt_publisher rqt_pulisher

出现如下界面

(2)topic选择/cmd_vel 点击加号,如下图所示:

(3)修改linear 和angular 中的值控制小乌龟行走。在选择框中打勾,表示没一秒发送一次指令。

小乌龟就出现画圆状态。

2.查看小乌龟运行参数

(1)新开一个terminal,输入如下指令,打开topic

rosrun rqt_topic rqt_topic

出现如下图图形化界面

(2)下拉/turtle1/cmd_vel出现如下界面

(3)通过小乌龟键盘控制terminal 方向健控制小乌龟行进,在topic 界面中观察linear和angular中值的变化。

也可以在publisher界面中设置参数控制小乌龟行走,在topic 中观测。

  • 0
    点赞
  • 2
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
ROS是一个机器人操作系统,其中包括了一个用于创建机器人应用程序的框架。其中,小乌龟绘图是ROS中一个经典的入门例子。 以下是实现小乌龟画图形的C++代码: ``` #include <ros/ros.h> #include <geometry_msgs/Twist.h> #include <turtlesim/Pose.h> #include <iostream> using namespace std; const double PI = 3.14159265359; double degree2radian(double degree) { return degree * PI / 180.0; } class Turtle { public: Turtle() { // 初始化ROS节点 n = ros::NodeHandle(); // 订阅小乌龟的位置信息 pose_sub = n.subscribe("/turtle1/pose", 10, &Turtle::poseCallback, this); // 发布小乌龟的速度信息 velocity_pub = n.advertise<geometry_msgs::Twist>("/turtle1/cmd_vel", 10); } void move(double speed, double distance, bool isForward) { // 初始化速度消息 geometry_msgs::Twist vel_msg; vel_msg.linear.x = abs(speed); if (isForward) { vel_msg.linear.x = abs(speed); } else { vel_msg.linear.x = -abs(speed); } vel_msg.linear.y = 0; vel_msg.linear.z = 0; vel_msg.angular.x = 0; vel_msg.angular.y = 0; vel_msg.angular.z = 0; double t0 = ros::Time::now().toSec(); double current_distance = 0; ros::Rate loop_rate(10); while (current_distance < distance) { velocity_pub.publish(vel_msg); double t1 = ros::Time::now().toSec(); current_distance = speed * (t1 - t0); ros::spinOnce(); loop_rate.sleep(); } // 停止小乌龟运动 vel_msg.linear.x = 0; velocity_pub.publish(vel_msg); } void rotate(double angular_speed, double angle, bool clockwise) { // 初始化速度消息 geometry_msgs::Twist vel_msg; vel_msg.linear.x = 0; vel_msg.linear.y = 0; vel_msg.linear.z = 0; vel_msg.angular.x = 0; vel_msg.angular.y = 0; if (clockwise) { vel_msg.angular.z = -abs(angular_speed); } else { vel_msg.angular.z = abs(angular_speed); } double current_angle = 0.0; double t0 = ros::Time::now().toSec(); ros::Rate loop_rate(10); while (current_angle < angle) { velocity_pub.publish(vel_msg); double t1 = ros::Time::now().toSec(); current_angle = angular_speed * (t1 - t0); ros::spinOnce(); loop_rate.sleep(); } // 停止小乌龟旋转 vel_msg.angular.z = 0; velocity_pub.publish(vel_msg); } void poseCallback(const turtlesim::Pose::ConstPtr &pose_msg) { this->pose = *pose_msg; } private: ros::NodeHandle n; ros::Publisher velocity_pub; ros::Subscriber pose_sub; turtlesim::Pose pose; }; int main(int argc, char **argv) { // 初始化ROS节点 ros::init(argc, argv, "turtle"); Turtle turtle; double speed, angular_speed; double distance, angle; bool isForward, clockwise; cout << "请输入线速度:"; cin >> speed; cout << "请输入角速度:"; cin >> angular_speed; cout << "请输入距离:"; cin >> distance; cout << "是否前进?(1为前进,0为后退):"; cin >> isForward; cout << "请输入旋转角度:"; cin >> angle; cout << "是否顺时针旋转?(1为顺时针,0为逆时针):"; cin >> clockwise; turtle.move(speed, distance, isForward); turtle.rotate(degree2radian(angular_speed), degree2radian(angle), clockwise); // 输出小乌龟的位置信息 ROS_INFO("Turtle position: (%.2f, %.2f)", turtle.pose.x, turtle.pose.y); ROS_INFO("Turtle orientation: %.2f", turtle.pose.theta); return 0; } ```

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

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

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值