基于 NVIDIA Isaac Sim 与 ROS2 实现 Kaya 机器人全向运动控制

其中 kaya_drive.py 代码核心功能为：循环发布预设的速度指令到/cmd_vel 话题，控制 Kaya 机器人按照固定序列完成'前进→停止→横向移动→停止→旋转→停止'的循环运动。

完整代码如下所示：

import rclpy
from rclpy.node import Node
from rclpy.logging import LoggingSeverity
from geometry_msgs.msg import Twist

class KayaControlNode(Node):
    def __init__(self):
        super().__init__('kaya_control_node')
        # 设置日志级别为 DEBUG，确保所有调试信息都能显示
        self.get_logger().set_level(LoggingSeverity.DEBUG)
        self.cmd_vel_pub = self.create_publisher(Twist, '/cmd_vel', 10)
        self.timer = self.create_timer(0.1, self.timer_callback)  # 10Hz 更新
        self.sequence_step = 0
        self.sequence = [
            # (linear.x, linear.y, angular.z, duration_sec)
            (-0.5, 0.0, 0.0, 2.0),  # 前进 2 秒
            (0.0, 0.0, 0.0, 1.0),  # 停止 1 秒
            (0.0, 0.5, 0.0, 2.0),  # 横向移动 2 秒
            (0.0, 0.0, 0.0, 1.0),  # 停止 1 秒
            (0.0, 0.0, 0.1, 2.0),  # 旋转 2 秒
            (0.0, 0.0, 0.0, 1.0),  # 停止 1 秒
        ]
        self.start_time = self.get_clock().now()
        self.get_logger().info("Kaya 控制节点启动，运动序列将循环执行")
        self.get_logger().info(f"序列包含 {len(self.sequence)} 个步骤")

    def timer_callback(self):
        self.get_logger().debug("定时器回调被触发")
        # 当序列执行完毕后，重置为第一步（实现循环）
        if self.sequence_step >= len(self.sequence):
            self.sequence_step = 0  # 重置步骤索引
            self.start_time = self.get_clock().now()  # 重置计时
            self.get_logger().info("运动序列执行完毕，开始新一轮循环")

        # 获取当前步骤的运动参数
        linear_x, linear_y, angular_z, duration = self.sequence[self.sequence_step]
        current_time = self.get_clock().now()
        elapsed = (current_time - self.start_time).nanoseconds / 1e9
        self.get_logger().debug(
            f"步骤 {self.sequence_step+1}/{len(self.sequence)} - "
            f"已耗时：{elapsed:.2f}秒，总时长：{duration}秒"
        )
        if elapsed < duration:
            # 发布速度指令
            twist = Twist()
            twist.linear.x = linear_x
            twist.linear.y = linear_y
            twist.angular.z = angular_z
            self.cmd_vel_pub.publish(twist)
            # 使用 INFO 级别确保能看到发布的速度指令
            self.get_logger().info(
                f"步骤 {self.sequence_step+1}/{len(self.sequence)} - "
                f"发布速度指令：linear.x={linear_x}, linear.y={linear_y}, angular.z={angular_z}"
            )
        else:
            # 进入下一个运动步骤
            self.sequence_step += 1
            self.start_time = self.get_clock().now()
            self.get_logger().info(f"进入步骤 {self.sequence_step}/{len(self.sequence)}")

def main(args=None):
    rclpy.init(args=args)
    node = KayaControlNode()
    try:
        rclpy.spin(node)
    except KeyboardInterrupt:
        node.get_logger().info("用户中断，节点停止")
        node.destroy_node()
        rclpy.shutdown()

if __name__ == '__main__':
    main()

五、总结与拓展

通过 NVIDIA Isaac Sim 与 ROS2 的协同，我们可以高效实现 Kaya 机器人的全向运动控制。Isaac Sim 的 OmniGraph 与 USD 配置为仿真提供了精准的物理模型支撑，ROS2 则为实时控制提供了灵活的通信框架。本文的 kaya_drive.py 脚本实现了基础的运动序列控制，在此基础上，开发者可以进一步集成激光雷达、视觉传感器等模块，开发避障、自主导航等更复杂的应用，适用于仓储、服务等多样化的机器人场景。