ros2 cars publish cmd_vel 同步 同时 多车

import rclpy  
from rclpy.node import Node  
from geometry_msgs.msg import Twist  
  
class MyPublisherNode(Node):  
    def __init__(self,x=0.0,z=0.0):  
        super().__init__('my_publisher_node') 
        self.mpubs = []
        # cars="89"
        for i in range(8,10):
            pb=self.create_publisher(Twist, '/Car'+str(i)+'/cmd_vel', 10)  
            self.mpubs.append(pb)
        print(self.mpubs)
        self.x = x
        self.z = z
        self.timer = self.create_timer(0.1, self.timer_callback)  

  
    def timer_callback(self):  
        twist = Twist()  
        twist.linear.x = self.x  # 设置你想要发布的线性速度x分量值  
        twist.angular.z = self.z  # 设置你想要发布的角速度z分量值  
        for pb in self.mpubs:

            pb.publish(twist)  
  
def main(x=0.0,z=0.0):  
    rclpy.init()  
    node = MyPublisherNode(x,z)  
    rclpy.spin(node)  
  
if __name__ == '__main__': 
    import sys 

    print('par', sys.argv, 'x, z, carid: 0.1 0 1')
    if len(sys.argv) >= 3:
        # 获取参数值
        x = float(sys.argv[1])
        z = float(sys.argv[2])
        
        main(x,z)
    else:
      main()

  • 8
    点赞
  • 8
    收藏
    觉得还不错? 一键收藏
  • 0
    评论

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

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

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值