在ROS中不使用Python，通过launch文件订阅机械手关节角度和模型后在rviz里显示topic信息，可以按照以下步骤实现： ### 1. 准备URDF文件 确保已经有机械手的URDF（Unified Robot Description Format）文件，该文件描述了机械手的模型。假设URDF文件名为 `your_robot.urdf`，位于 `your_package_name/urdf` 目录下。 ### 2. 编写launch文件 以下是一个示例的launch文件，用于订阅机械手关节角度和模型，并在rviz中显示： ```xml <launch> <!-- 设置urdf文件路径 --> <arg name="urdf_file" default="$(find your_package_name)/urdf/your_robot.urdf" /> <param name="robot_description" command="$(find xacro)/xacro $(arg urdf_file)" /> <!-- 启动joint_state_publisher --> <node name="joint_state_publisher" pkg="joint_state_publisher" type="joint_state_publisher" /> <!-- 启动robot_state_publisher --> <node name="robot_state_publisher" pkg="robot_state_publisher" type="robot_state_publisher" /> <!-- 启动rviz --> <node name="rviz" pkg="rviz" type="rviz" args="-d $(find your_package_name)/rviz/your_rviz_config.rviz" output="screen" /> </launch> ``` ### 3. 解释launch文件 - `<arg>` 标签：定义一个参数 `urdf_file`，指定URDF文件的路径。 - `<param>` 标签：将URDF文件的内容加载到ROS参数服务器中，使用 `xacro` 工具处理可能包含的宏定义。 - `joint_state_publisher` 节点：发布机械手的关节状态信息，通常用于模拟或手动控制关节角度。 - `robot_state_publisher` 节点：根据关节状态信息和URDF模型，发布TF（Transform）信息，用于描述机器人各个关节之间的坐标系变换。 - `rviz` 节点：启动RViz可视化工具，并加载指定的配置文件 `your_rviz_config.rviz`。 ### 4. 创建RViz配置文件 可以手动创建一个RViz配置文件，或者在启动RViz后进行配置并保存。以下是创建RViz配置文件的示例命令： ```bash mkdir -p ~/arm_ws/src/arm_description/config touch ~/arm_ws/src/arm_description/config/arm_rviz.rviz ``` ### 5. 运行launch文件 将上述launch文件保存为 `display.launch`，然后在终端中运行以下命令启动： ```bash roslaunch your_package_name display.launch ``` ### 代码示例 ```xml <launch> <arg name="urdf_file" default="$(find your_package_name)/urdf/your_robot.urdf" /> <param name="robot_description" command="$(find xacro)/xacro $(arg urdf_file)" /> <node name="joint_state_publisher" pkg="joint_state_publisher" type="joint_state_publisher" /> <node name="robot_state_publisher" pkg="robot_state_publisher" type="robot_state_publisher" /> <node name="rviz" pkg="rviz" type="rviz" args="-d $(find your_package_name)/rviz/your_rviz_config.rviz" output="screen" /> </launch> ```