Skip to main content
 首页 » 编程设计

python之如何使用 python 脚本自动化 ROS 的终端命令

2024年11月24日10飞鱼

我目前正在尝试用 python 编写一个运行以下 ROS 命令的可执行程序:rostopic echo dvrk/PSM1/position_cartesian_current 然而,尽管阅读了 ROS 教程,但我不确定如何去做这。在名为 arm.py 的文件中,以下订阅者和定义已经存在:

rospy.Subscriber(self.__full_ros_namespace + '/position_cartesian_current', PoseStamped, self.__position_cartesian_current_cb) 
 
def __position_cartesian_current_cb(self, data): 
        self.__position_cartesian_current = posemath.fromMsg(data.pose) 

我应该在新的自动化 python 脚本中重用这个订阅者和定义吗?在获得当前的笛卡尔位置后,机器人将随后移动到不同的位置,目前可以在终端中使用 ROS 命令来完成,但是,目的是编写一个 python 脚本来自动执行这些命令。任何帮助将不胜感激!

import rospy 
from tf import transformations 
from tf_conversions import posemath 
from std_msgs.msg import String, Bool, Float32, Empty, Float64MultiArray 
from geometry_msgs.msg import Pose, PoseStamped, Vector3, Quaternion, Wrench, WrenchStamped, TwistStamped 
 
def callback(data): 
  rospy.loginfo(rospy.get_caller_id() + data.data) 
 
def listener(): 
    rospy.init_node('listener', anonymous=True) 
    rospy.Subscriber(self.__full_ros_namespace + '/position_cartesian_current', PoseStamped, callback) 
    rospy.spin() 
 
if __name__ == '__main__': 
    listener() 

请您参考如下方法:

您要做的是编写一个 Python ROS 节点来订阅主题并实现您的逻辑。

您可以按照 this guide 进行操作.

主要思想是订阅位置主题,在回调函数中获取相关数据并在同一个回调中发布您通常通过命令行执行的命令。

要重现一个简单的rostopic echo,您可以只打印您在回调中收到的值。