《自主移动机器人技术》课件-项目5 机器人建模与可视化

机器人建模与可视化2026年7月8日CONTENTS目录01

可视化与机器人建模简介02

rviz2基本使用03

rviz2集成URDF基本流程04

URDF使用语法CONTENTS目录05

URDF优化_xacro06

案例演示07

本章小结

01可视化与机器人建模简介人机交互与可视化的重要性机器人系统数据交互需求机器人运行时产生里程计、激光雷达、IMU等多种数据，需实现人机双向数据交换，如调用者下发导航指令，机器人反馈模型、路径、传感器信息等。传统命令行交互的局限性命令行工具获取数据不够直观，尤其面向非专业用户时友好度低，难以高效进行程序开发调试与最终应用落地。可视化人机交互的优势以图形化方式实现交互，更直观、快捷、美观，可大幅提升开发调试效率，同时对非专业人员更友好，是理想的人机交互策略。rviz2与URDF核心概念rviz2的定义与作用rviz2是ROS2的三维可视化工具（ROSVisualizationTool），主要目的是以三维方式显示ROS消息，可将机器人模型、激光雷达数据、点云、图像等数据可视化表达。URDF的概念与功能URDF（UnifiedRobotDescriptionFormat）即统一机器人描述格式，以XML方式描述机器人结构，包括底盘、摄像头、关节自由度等，可被解释器转换为rviz或仿真环境中的可视化模型。二者在可视化中的核心地位rviz2提供图形化交互接口，URDF实现机器人建模，二者结合是ROS2中实现机器人可视化的关键，使调用者能以机器人视角直观感知数据与模型。02rviz2基本使用默认安装情况rviz2的安装与启动

以sudoaptinstallros-[ROS_DISTRO]-desktop格式安装ROS2时，rviz2已默认被安装。手动安装命令

若未默认安装，可调用命令：sudoaptinstallros-[ROS_DISTRO]-rviz2（[ROS_DISTRO]指代ROS2版本）。常用启动方式

方式1：直接在终端输入“rviz2”；方式2：输入“ros2runrviz2rviz2”。01rviz2界面布局解析上部工具栏包含视角控制、预估位姿设置、目标设置等功能，还可添加自定义插件。02左侧插件显示区可添加、删除、复制、重命名插件，显示插件及设置插件属性，默认有GlobalOptions和GlobalStatus插件。03中间3D视图显示区以可视化方式显示添加的插件信息，是数据可视化的主要区域。04右侧观测视角设置区用于设置不同的观测视角，方便从多角度查看可视化数据。05下侧时间显示区显示系统时间和ROS时间，帮助用户掌握数据更新的时间信息。

rviz2预定义插件功能Axes插件功能：显示rviz2默认的坐标系；无订阅消息类型。

Camera插件功能：显示相机图像，需使用Cameralnfo消息；订阅消息类型：sensor_msgs/msg/Image、sensor_msgs/msg/Cameralnfo。

LaserScan插件功能：显示激光雷达数据；订阅消息类型：sensor_msgs/msg/LaserScan。

RobotModel插件功能：显示机器人模型；无订阅消息类型。

TF插件功能：显示tf变换层次结构；无订阅消息类型。TF插件应用rviz2插件使用示例通过TF插件可直观展示机器人各部件之间的坐标变换关系，帮助理解机器人的运动学结构。LaserScan插件应用集成LaserScan插件后，能将激光雷达采集的障碍物信息以点云形式在3D视图中显示，清晰呈现机器人周围环境。Image插件应用Image插件可直接显示相机获取的图像数据，无需Cameralnfo消息，让用户实时查看机器人视觉感知到的场景。多插件协同效果同时集成TF、LaserScan、Image等插件，可综合展示机器人的位姿、周围环境及视觉信息，实现以机器人视角看世界的可视化效果。03rviz2集成URDF基本流程案例需求与分析案例需求：显示盒状机器人模型在rviz2中显示一个简单的盒状机器人，作为URDF与rviz2集成的基础案例，验证可视化流程的可行性。核心要素分析实现该案例需关注三个关键要素：编写符合语法规范的URDF文件、将URDF文件加载到ROS2系统、在rviz2中正确配置并显示机器人模型。流程概述整体流程包括：编写URDF文件定义机器人结构、编写launch文件启动相关节点、配置功能包依赖、编译功能包、执行launch文件并在rviz2中完成显示配置。

实现流程与准备工作主要实现步骤集成URDF到rviz2的核心步骤为：编写URDF文件描述机器人模型、编写launch文件组织节点启动、编辑配置文件声明依赖、编译功能包生成可执行文件、执行launch文件并在rviz2中加载模型。

功能包安装需安装关节状态发布相关功能包：sudoaptinstallros-humble-joint-state-publisher和sudoaptinstallros-humble-joint-state-publisher-gui，用于关节状态发布与可视化控制。

功能包新建在ROS2工作空间src目录下创建C++功能包：ros2pkgcreatecpp06_urdf--build-typeament_cmake，并新建urdf、rviz、launch、meshes等子目录，分别用于存储模型文件、配置文件和启动文件。URDF与launch文件实现URDF文件编写在urdf/urdf目录下创建demo01_helloworld.urdf，以robot为根标签，定义名称为base_link的连杆，通过visual标签设置立方体形状（size="0.50.20.1"），完成盒状机器人模型的基础描述。launch文件编写在launch目录下创建display.launch.py，通过ParameterValue加载URDF文件，启动robot_state_publisher节点发布机器人状态，启动joint_state_publisher节点发布关节状态，启动rviz2节点实现可视化，并支持通过model参数动态传入URDF文件路径。代码示例关键片段URDF核心代码：<robotname="hello_world"><linkname="base_link"><visual><geometry><boxsize="0.50.20.1"/></geometry></visual></link></robot>；launch文件通过DeclareLaunchArgument定义模型路径参数，Node节点配置实现各功能模块启动。配置、编译与执行显示配置文件编辑在package.xml中添加执行依赖：rviz2、xacro、robot_state_publisher、joint_state_publisher、ros2launch；在CMakeLists.txt中配置安装路径，将launch、urdf、rviz等目录文件安装到功能包共享目录。编译操作进入工作空间，执行编译命令：colconbuild--packages-selectcpp06_urdf，编译指定功能包，生成可执行文件和资源文件。执行与显示配置编译后，在工作空间终端执行：.install/setup.bash加载环境变量，再执行ros2launchcpp06_urdfdisplay.launch.py启动节点；在rviz2中设置GlobalOptions的FixedFrame为base_link，添加RobotModel插件并将DescriptionTopic设为/robot_description，即可显示盒状机器人模型。04URDF使用语法robot与link标签详解

robot标签：根标签的属性与子标签robot标签是URDF文件的根标签，所有link和joint等标签需包含其中。必选属性name用于设置机器人模型名称，子标签包括link、joint、material等，主文件与被包含文件的name属性需一致。示例：<robotname="mycar"></robot>。

link标签：描述机器人刚体属性link标签用于描述机器人部件的外观和物理属性，必填属性name为连杆命名。子标签包括visual（可视化属性）、collision（碰撞属性）、inertial（惯性属性），其中visual的geometry子标签可定义立方体、圆柱、球体等形状，origin设置偏移与旋转，material指定颜色或纹理。

link标签子标签示例应用以长方体部件为例，visual标签中geometry的box子标签设置size为0.50.30.1，origin设为xyz="000"rpy="000"，material引用预定义的yellow颜色。若无需仿真，collision和inertial标签可省略。

joint标签及类型01joint标签：连接部件的核心属性joint标签用于描述机器人关节的运动学和动力学属性，必填属性name（唯一命名）和type（关节类型）。子标签包括parent（父link）、child（子link）、origin（父到子的转换）、axis（运动轴）等，revolute和prismatic类型需设置limit子标签定义运动范围。

02常用关节类型及特点continuous：绕单轴无限旋转；revolute：带角度限制的旋转关节；prismatic：沿轴线移动且有位置极限；fixed：无运动的固定关节；planer：平面内平移或旋转；floating：允许平移和旋转。根据部件运动需求选择对应类型。

03关节示例：摄像头旋转关节创建类型为continuous的关节camera2baselink，parent为base_link，child为camera，origin设置xyz偏移量以确定安装位置，axis设为xyz="001"实现绕Z轴360度旋转，通过joint_state_publisher_gui可控制旋转角度。

base_footprint优化与四轮机器人案例base_footprint优化：解决模型沉地问题默认底盘中心点位于地图原点导致模型半沉地下，优化方法为添加base_footprint作为初始link（如半径0.001m的球体），通过fixed关节连接base_link并设置xyz偏移（如0.00.00.05），使底盘离地，FixedFrame设为base_footprint即可正常显示。

四轮机器人模型参数与结构底盘尺寸：长0.2m、宽0.12m、高0.07m，离地间距0.015m；车轮半径0.025m、厚度0.02m。结构包括base_footprint、base_link（长方体底盘）及四个车轮link，通过continuous关节连接，车轮关节axis设为010实现绕Y轴旋转。

URDF综合应用：关节与link配置左前轮关节frontleftwheel2baselink的originxyz为0.0750.06-0.025（基于底盘中心偏移），右后轮关节backrightwheel2baselink偏移为-0.075-0.06-0.025，通过check_urdf工具验证语法正确性，rviz2中显示完整四轮模型。check_urdf：语法检查工具URDF工具使用

安装命令：sudoaptinstallliburdfdom-tools。使用方法：进入urdf文件目录，执行check_urdf文件名.urdf，无异常则显示link层级关系，如"rootLink:base_footprinthas1child(ren)"，异常则输出错误提示，用于验证文件合法性。urdf_to_graphviz：模型结构可视化

使用方法：执行urdf_to_graphviz文件名.urdf，生成以robot名称命名的.pdf和.gv文件，PDF文件以树形结构展示link与joint的层级关系，直观呈现机器人模型的组成架构，帮助排查结构设计问题。工具应用：提升URDF编写效率

编写复杂模型时，先用check_urdf检查语法错误，再用urdf_to_graphviz确认link/joint关系是否符合设计预期。例如四轮机器人模型，通过工具可快速定位关节连接错误或link命名重复问题，确保模型正确加载到rviz2。05URDF优化_xacro

xacro概念与优势xacro概念Xacro是XMLMacros的缩写，是一种XML宏语言，是可编程的XML。它可以声明变量、进行数学运算、使用流程控制并通过宏封装复用功能。

URDF建模问题URDF存在计算繁琐（关节位置需人工计算易失误，参数改变需重新计算）、代码重复（如车轮设计高度重复，缺乏封装复用）等问题。

xacro优势xacro可编写更安全、精简、易读的机器人模型文件，通过变量封装参数、宏定义实现代码复用，提高编写效率，解决URDF的计算与复用痛点。

xacro快速体验需求与目标使用xacro优化四轮机器人底盘实现，通过变量封装车辆参数，用宏封装轮子重复代码并调用宏创建四个轮子，直观展示代码复用效果。

变量封装示例定义属性如wheel_radius（0.025）、wheel_length（0.02），封装车轮半径和长度参数，便于统一修改与管理。

宏定义与调用示例定义wheel_func宏，参数为wheel_name，内部包含轮子link的几何、原点、材质等描述；调用时传入不同wheel_name（如left_front、left_back等）生成四个轮子，实现代码复用。

xacro使用语法详解变量与算数运算变量定义：，如；变量调用：${变量名}；变量运算：${数学表达式}，如${PI/2}。

宏定义与调用单击此处添加项正文

文件包含语法格式：，可将机器人不同部件封装为单独xacro文件，再集成组合为完整模型，如包含car_base.xacro、car_camera.xacro等。

xacro练习：四轮机器人模型01需求与实现分析创建带相机和激光雷达的四轮机器人模型，将底盘、摄像头、雷达各部分封装为单独xacro文件，通过文件包含组织成完整模型，强化xacro实际应用。

02各部件xacro文件包括car.urdf.xacro（用于包含其他部件文件）、car_base.urdf.xacro（描述底盘，含变量定义、车轮宏等）、car_camera.urdf.xacro（描述摄像头）、car_laser.urdf.xacro（描述雷达）。

03执行与效果编译后通过命令ros2launchcpp06_urdfdisplay.launch.pymodel:=.../car.urdf.xacro启动，rviz2中可显示包含底盘、相机、雷达的完整机器人模型，体现xacro模块化与复用优势。06案例演示

rviz2基本使用演示启动rviz2通过两种常用命令启动rviz2：方式1直接输入“rviz2”；方式2输入“ros2runrviz2rviz2”。启动后默认显示包含工具栏、插件显示区、3D视图显示区等模块的界面。

全局参数配置在左侧“Displays”面板中，展开“GlobalOptions”，设置“FixedFrame”为参考坐标系（如“map”或“base_link”），调整“BackgroundColor”和“FrameRate”等参数，确保全局状态显示正常。

添加与配置插件点击“Add”按钮添加预定义插件，如“Grid”（显示网格）、“RobotModel”（显示机器人模型）、“LaserScan”（显示激光雷达数据）等。选中插件后，在属性面板中配置相关参数，如“LaserScan”需指定订阅的消息话题。

视角控制与交互使用工具栏中的“MoveCamera”工具调整3D视图视角，通过“2DPoseEstimate”或“2DGoalPose”与机器人进行交互，在右侧视角设置区选择不同观测视角（如“TopDownOrthographic”）。

自定义机器人模型显示演示URDF文件编写单击此处添加项正文

功能包与配置文件准备创建ROS2功能包，新建urdf、launch、rviz目录。在package.xml中添加依赖（rviz2、robot_state_publisher等），在CMakeLists.txt中配置安装路径，确保URDF、launch等文件正确部署。

Launch文件编写与执行编写launch