Jetson Orin NX 开发指南(7): EGO-Swarm 的编译与运行

2023-10-14 01:15

本文主要是介绍Jetson Orin NX 开发指南(7): EGO-Swarm 的编译与运行,希望对大家解决编程问题提供一定的参考价值,需要的开发者们随着小编来一起学习吧!

一、前言

EGO-Planner 浙江大学 FAST-LAB 实验室的开源轨迹规划算法是,受到 IEEE Spectrum 等知名科技媒体的报道,其理论技术较为前沿,是一种不依赖于ESDF,基于B样条的规划算法,并且规划成功率、算法消耗时间、代价数值等性能方面都要高于其他几种知名算法。

而 EGO-Swarm 是基于 EGO-Planner 拓展的去中心化的无人机集群算法,有助于智能小车或自主无人机集群的规划的学习与开发

由于 EGO-Planner 是 EGO-Swarm 的一部分,并且他们的安装其实差别不大,因此本文主要介绍 EGO-Swarm 的编译与运行,参考

https://github.com/ZJU-FAST-Lab/ego-planner-swarm

https://github.com/ZJU-FAST-Lab/ego-planner

GitHub - ZJU-FAST-Lab/Fast-Drone-250: hardware and software design of the 250mm autonomous drone

由于 Jetson 系列开发板常用于当作机载电脑,因此本文介绍如何在 Jetson Orin NX 开发板上编译和运行 EGO-Swarm,当然本文对 EGO-Planner 同样适用。

二、编译 EGO-Swarm

首先安装依赖

sudo apt-get install libarmadillo-dev

然后创建并进入工作空间

mkdir -p ~/catkin_ws/src/
cd ~/catkin_ws/src/

从 GitHub 上下载 EGO-Swarm 源码

git clone https://github.com/ZJU-FAST-Lab/ego-planner-swarm.git

进入 EGO-Swarm 工作空间并编译

cd ~/catkin_ws/src/ego-planner-swarm
catkin_make

编译完成显示如下结果

三、运行 EGO-Swarm

接下来我们运行 EGO-Swarm,主要分为仿真和实验两个部分

3.1 EGO-Swarm 仿真

首先通过快捷键 ctrl + alt + A 打开超级终端,如果没有安装则参考下文安装

Jetson Orin NX 开发指南(2): 基本环境配置_想要个小姑娘的博客-CSDN博客

将超级终端划分为两个终端,全选后 source 一下工作空间,终端输入

source ~/catkin_ws/src/ego-planner-swarm/devel/setup.bash

在第一个终端输入

roslaunch ego_planner rviz.launch

在第二个终端输入

roslaunch ego_planner swarm.launch

如下所示

依次执行可以得到如下结果

至此,EGO-Swarm 的仿真运行就实现了!

3.2 EGO-Swarm 实验

由于条件有限,我么在此仅仅只是将 EGO-Swarm 与 VINS-Fusion 进行连接,并且这里只涉及单个无人机(在这种情况下 EGO-Swarm 与 EGO-Planner 是等价的),其中 EGO-Swarm 单个无人机通过 VINS-Fusion 来获取里程计信息,同时通过深度相机数据来获取周围环境的情况。

3.2.1 创建文件配置

首先需要配置实验用的一些参数,对应于仿真中的 advanced_param.xml 文件,

其次需要配置调用 VINS-Fusion 里程计信息和 Realsense 深度相机信息的 launch 启动文件,对应于仿真中的 single_run_in_sim.launch 文件,

此外还需要用于可视化的 rviz 文件,对应于仿真中的 default.rviz 文件,

具体的配置可以参考 FAST-LAB 实验室的 fast-drone-250 中采用的 xml 和 launch 文件:

GitHub - ZJU-FAST-Lab/Fast-Drone-250: hardware and software design of the 250mm autonomous drone

主要是如下三个文件

但是由于 VINS-Fusion 中里程计发布的话题是 /vins_estimator/imu_propagate,而上面订阅的话题是 /vins_fusion/imu_propagate,这是因为在 fast-drone-250 中,vins_estimator 节点被重命名为了 vins_fusion,从而产生了差异,只需修改以下订阅的话题即可,其余的可以不做修改,(当然如果标定了相机内外参以及 imu 的噪声,则可以将之后的数据修改上去,VINS-Fusion 或者 EGO-Swarm 上都要修改),具体操作如下

在 ~/catkin_ws/src/ego-planner-swarm/src/planner/plan_manage/launch/ 路径下创建四个文件

(1)advanced_param_exp.xml,其内容如下

<launch><arg name="map_size_x_"/><arg name="map_size_y_"/><arg name="map_size_z_"/><arg name="odometry_topic"/><arg name="camera_pose_topic"/><arg name="depth_topic"/><arg name="cloud_topic"/><arg name="cx"/><arg name="cy"/><arg name="fx"/><arg name="fy"/><arg name="max_vel"/><arg name="max_acc"/><arg name="planning_horizon"/><arg name="point_num"/><arg name="point0_x"/><arg name="point0_y"/><arg name="point0_z"/><arg name="point1_x"/><arg name="point1_y"/><arg name="point1_z"/><arg name="point2_x"/><arg name="point2_y"/><arg name="point2_z"/><arg name="point3_x"/><arg name="point3_y"/><arg name="point3_z"/><arg name="point4_x"/><arg name="point4_y"/><arg name="point4_z"/><arg name="flight_type"/><arg name="use_distinctive_trajs"/><arg name="obj_num_set"/><arg name="drone_id"/><!-- main node --><!-- <node pkg="ego_planner" name="ego_planner_node" type="ego_planner_node" output="screen" launch-prefix="valgrind"> --><node pkg="ego_planner" name="drone_$(arg drone_id)_ego_planner_node" type="ego_planner_node" output="screen"><remap from="~odom_world" to="$(arg odometry_topic)"/><remap from="~planning/bspline" to = "/drone_$(arg drone_id)_planning/bspline"/><remap from="~planning/data_display" to = "/drone_$(arg drone_id)_planning/data_display"/><remap from="~planning/broadcast_bspline_from_planner" to = "/broadcast_bspline"/><remap from="~planning/broadcast_bspline_to_planner" to = "/broadcast_bspline"/><remap from="~grid_map/odom" to="$(arg odometry_topic)"/><remap from="~grid_map/cloud" to="$(arg cloud_topic)"/><remap from="~grid_map/pose"   to = "$(arg camera_pose_topic)"/> <remap from="~grid_map/depth" to = "$(arg depth_topic)"/><!-- planning fsm --><param name="fsm/flight_type" value="$(arg flight_type)" type="int"/><param name="fsm/thresh_replan_time" value="1.0" type="double"/><param name="fsm/thresh_no_replan_meter" value="1.0" type="double"/><param name="fsm/planning_horizon" value="$(arg planning_horizon)" type="double"/> <!--always set to 1.5 times grater than sensing horizen--><param name="fsm/planning_horizen_time" value="3" type="double"/><param name="fsm/emergency_time" value="1.0" type="double"/><param name="fsm/realworld_experiment" value="true"/><param name="fsm/fail_safe" value="true"/><param name="fsm/waypoint_num" value="$(arg point_num)" type="int"/><param name="fsm/waypoint0_x" value="$(arg point0_x)" type="double"/><param name="fsm/waypoint0_y" value="$(arg point0_y)" type="double"/><param name="fsm/waypoint0_z" value="$(arg point0_z)" type="double"/><param name="fsm/waypoint1_x" value="$(arg point1_x)" type="double"/><param name="fsm/waypoint1_y" value="$(arg point1_y)" type="double"/><param name="fsm/waypoint1_z" value="$(arg point1_z)" type="double"/><param name="fsm/waypoint2_x" value="$(arg point2_x)" type="double"/><param name="fsm/waypoint2_y" value="$(arg point2_y)" type="double"/><param name="fsm/waypoint2_z" value="$(arg point2_z)" type="double"/><param name="fsm/waypoint3_x" value="$(arg point3_x)" type="double"/><param name="fsm/waypoint3_y" value="$(arg point3_y)" type="double"/><param name="fsm/waypoint3_z" value="$(arg point3_z)" type="double"/><param name="fsm/waypoint4_x" value="$(arg point4_x)" type="double"/><param name="fsm/waypoint4_y" value="$(arg point4_y)" type="double"/><param name="fsm/waypoint4_z" value="$(arg point4_z)" type="double"/><param name="grid_map/resolution"      value="0.15" /> <param name="grid_map/map_size_x"   value="$(arg map_size_x_)" /> <param name="grid_map/map_size_y"   value="$(arg map_size_y_)" /> <param name="grid_map/map_size_z"   value="$(arg map_size_z_)" /> <param name="grid_map/local_update_range_x"  value="5.5" /> <param name="grid_map/local_update_range_y"  value="5.5" /> <param name="grid_map/local_update_range_z"  value="4.5" /> <param name="grid_map/obstacles_inflation"     value="0.299" /> <param name="grid_map/local_map_margin" value="10"/><param name="grid_map/ground_height"        value="-0.01"/><!-- camera parameter --><param name="grid_map/cx" value="$(arg cx)"/><param name="grid_map/cy" value="$(arg cy)"/><param name="grid_map/fx" value="$(arg fx)"/><param name="grid_map/fy" value="$(arg fy)"/><!-- depth filter --><param name="grid_map/use_depth_filter" value="true"/><param name="grid_map/depth_filter_tolerance" value="0.15"/><param name="grid_map/depth_filter_maxdist"   value="5.0"/><param name="grid_map/depth_filter_mindist"   value="0.2"/><param name="grid_map/depth_filter_margin"    value="2"/><param name="grid_map/k_depth_scaling_factor" value="1000.0"/><param name="grid_map/skip_pixel" value="2"/><!-- local fusion --><param name="grid_map/p_hit"  value="0.65"/><param name="grid_map/p_miss" value="0.35"/><param name="grid_map/p_min"  value="0.12"/><param name="grid_map/p_max"  value="0.90"/><param name="grid_map/p_occ"  value="0.80"/><param name="grid_map/min_ray_length" value="0.3"/><param name="grid_map/max_ray_length" value="5.0"/><param name="grid_map/visualization_truncate_height"   value="1.8"/><param name="grid_map/show_occ_time"  value="false"/><param name="grid_map/pose_type"     value="2"/>  <param name="grid_map/frame_id"      value="world"/><!-- planner manager --><param name="manager/max_vel" value="$(arg max_vel)" type="double"/><param name="manager/max_acc" value="$(arg max_acc)" type="double"/><param name="manager/max_jerk" value="4" type="double"/><param name="manager/control_points_distance" value="0.4" type="double"/><param name="manager/feasibility_tolerance" value="0.05" type="double"/><param name="manager/planning_horizon" value="$(arg planning_horizon)" type="double"/><param name="manager/use_distinctive_trajs" value="$(arg use_distinctive_trajs)" type="bool"/><param name="manager/drone_id" value="$(arg drone_id)"/><!-- trajectory optimization --><param name="optimization/lambda_smooth" value="1.0" type="double"/><param name="optimization/lambda_collision" value="0.5" type="double"/><param name="optimization/lambda_feasibility" value="0.1" type="double"/><param name="optimization/lambda_fitness" value="1.0" type="double"/><param name="optimization/dist0" value="0.5" type="double"/><param name="optimization/swarm_clearance" value="0.5" type="double"/><param name="optimization/max_vel" value="$(arg max_vel)" type="double"/><param name="optimization/max_acc" value="$(arg max_acc)" type="double"/><param name="bspline/limit_vel" value="$(arg max_vel)" type="double"/><param name="bspline/limit_acc" value="$(arg max_acc)" type="double"/><param name="bspline/limit_ratio" value="1.1" type="double"/><!-- objects prediction --><param name="prediction/obj_num" value="$(arg obj_num_set)" type="int"/><param name="prediction/lambda" value="1.0" type="double"/><param name="prediction/predict_rate" value="1.0" type="double"/></node></launch>

(2)single_run_in_exp.launch,其内容如下

<launch><!-- number of moving objects --><arg name="obj_num" value="10" /><arg name="drone_id" value="0"/><arg name="map_size_x" value="100"/><arg name="map_size_y" value="50"/><arg name="map_size_z" value="3.0"/><arg name="odom_topic" value="/vins_estimator/imu_propagate"/><!-- main algorithm params --><include file="$(find ego_planner)/launch/advanced_param_exp.xml"><arg name="drone_id" value="$(arg drone_id)"/><arg name="map_size_x_" value="$(arg map_size_x)"/><arg name="map_size_y_" value="$(arg map_size_y)"/><arg name="map_size_z_" value="$(arg map_size_z)"/><arg name="odometry_topic" value="$(arg odom_topic)"/><arg name="obj_num_set" value="$(arg obj_num)" /><!-- camera pose: transform of camera frame in the world frame --><!-- depth topic: depth image, 640x480 by default --><!-- don't set cloud_topic if you already set these ones! --><arg name="camera_pose_topic" value="nouse1"/><arg name="depth_topic" value="/camera/depth/image_rect_raw"/><!-- topic of point cloud measurement, such as from LIDAR  --><!-- don't set camera pose and depth, if you already set this one! --><arg name="cloud_topic" value="nouse2"/><!-- intrinsic params of the depth camera --><arg name="cx" value="323.3316345214844"/><arg name="cy" value="234.95498657226562"/><arg name="fx" value="384.39654541015625"/><arg name="fy" value="384.39654541015625"/><!-- maximum velocity and acceleration the drone will reach --><arg name="max_vel" value="0.5" /><arg name="max_acc" value="6.0" /><!--always set to 1.5 times grater than sensing horizen--><arg name="planning_horizon" value="6" /><arg name="use_distinctive_trajs" value="false" /><!-- 1: use 2D Nav Goal to select goal  --><!-- 2: use global waypoints below  --><arg name="flight_type" value="1" /><!-- global waypoints --><!-- It generates a piecewise min-snap traj passing all waypoints --><arg name="point_num" value="1" /><arg name="point0_x" value="15" /><arg name="point0_y" value="0" /><arg name="point0_z" value="1" /><arg name="point1_x" value="0.0" /><arg name="point1_y" value="0.0" /><arg name="point1_z" value="1.0" /><arg name="point2_x" value="15.0" /><arg name="point2_y" value="0.0" /><arg name="point2_z" value="1.0" /><arg name="point3_x" value="0.0" /><arg name="point3_y" value="0.0" /><arg name="point3_z" value="1.0" /><arg name="point4_x" value="15.0" /><arg name="point4_y" value="0.0" /><arg name="point4_z" value="1.0" /></include><!-- trajectory server --><node pkg="ego_planner" name="drone_$(arg drone_id)_traj_server" type="traj_server" output="screen"><!-- <remap from="position_cmd" to="/setpoints_cmd"/> --><remap from="~planning/bspline" to="drone_$(arg drone_id)_planning/bspline"/><param name="traj_server/time_forward" value="1.0" type="double"/></node>
</launch>

(3)rviz_exp.launch 文件,其内容如下

<launch><node name="rviz" pkg="rviz" type="rviz" args="-d $(find ego_planner)/launch/default_exp.rviz" required="true" />
</launch>

(4)default_exp.rviz 文件,其内容如下

Panels:- Class: rviz/DisplaysHelp Height: 0Name: DisplaysProperty Tree Widget:Expanded:- /Global Options1- /Status1- /drone01/Planning1- /drone01/Planning1/drone_path1/Offset1- /drone01/Mapping1/map inflate1- /Odometry1/Shape1Splitter Ratio: 0.43611112236976624Tree Height: 517- Class: rviz/SelectionName: Selection- Class: rviz/Tool PropertiesExpanded:- /2D Pose Estimate1- /2D Nav Goal1- /Publish Point1Name: Tool PropertiesSplitter Ratio: 0.5886790156364441- Class: rviz/ViewsExpanded:- /Current View1Name: ViewsSplitter Ratio: 0.5- Class: rviz/TimeName: TimeSyncMode: 0SyncSource: map inflate
Preferences:PromptSaveOnExit: true
Toolbars:toolButtonStyle: 2
Visualization Manager:Class: ""Displays:- Alpha: 1Class: rviz/AxesEnabled: trueLength: 1Name: AxesRadius: 0.10000000149011612Reference Frame: <Fixed Frame>Show Trail: falseValue: true- Alpha: 0.5Cell Size: 1Class: rviz/GridColor: 160; 160; 164Enabled: trueLine Style:Line Width: 0.029999999329447746Value: LinesName: GridNormal Cell Count: 0Offset:X: 0Y: 0Z: 0Plane: XYPlane Cell Count: 1000Reference Frame: <Fixed Frame>Value: true- Class: rviz/GroupDisplays:- Class: rviz/GroupDisplays:- Class: rviz/MarkerEnabled: trueMarker Topic: /drone_0_ego_planner_node/goal_pointName: goal_pointNamespaces:{}Queue Size: 100Value: true- Class: rviz/MarkerEnabled: trueMarker Topic: /ego_planner_node/global_listName: global_pathNamespaces:{}Queue Size: 100Value: true- Class: rviz/MarkerEnabled: trueMarker Topic: /drone_0_ego_planner_node/optimal_listName: optimal_trajNamespaces:{}Queue Size: 100Value: true- Class: rviz/MarkerEnabled: falseMarker Topic: /ego_planner_node/a_star_listName: AStarNamespaces:{}Queue Size: 100Value: false- Class: rviz/MarkerEnabled: trueMarker Topic: /drone_0_ego_planner_node/init_listName: InitTrajNamespaces:{}Queue Size: 100Value: true- Alpha: 1Buffer Length: 1Class: rviz/PathColor: 29; 108; 212Enabled: trueHead Diameter: 0.30000001192092896Head Length: 0.20000000298023224Length: 0.30000001192092896Line Style: BillboardsLine Width: 0.10000000149011612Name: drone_pathOffset:X: 0Y: 0Z: 0Pose Color: 255; 85; 255Pose Style: NoneQueue Size: 10Radius: 0.029999999329447746Shaft Diameter: 0.10000000149011612Shaft Length: 0.10000000149011612Topic: /drone_0_odom_visualization/pathUnreliable: falseValue: trueEnabled: trueName: Planning- Class: rviz/GroupDisplays:- Alpha: 1Autocompute Intensity Bounds: trueAutocompute Value Bounds:Max Value: 1.565000057220459Min Value: 0.06499999761581421Value: trueAxis: ZChannel Name: intensityClass: rviz/PointCloud2Color: 29; 108; 212Color Transformer: AxisColorDecay Time: 0Enabled: trueInvert Rainbow: falseMax Color: 255; 255; 255Min Color: 0; 0; 0Name: map inflatePosition Transformer: XYZQueue Size: 10Selectable: trueSize (Pixels): 3Size (m): 0.15000000596046448Style: BoxesTopic: /drone_0_ego_planner_node/grid_map/occupancy_inflateUnreliable: falseUse Fixed Frame: trueUse rainbow: trueValue: trueEnabled: trueName: Mapping- Class: rviz/GroupDisplays:- Class: rviz/MarkerEnabled: trueMarker Topic: /drone_0_odom_visualization/robotName: robotNamespaces:{}Queue Size: 100Value: true- Class: rviz/ImageEnabled: falseImage Topic: /drone_0_pcl_render_node/depthMax Value: 1Median window: 5Min Value: 0Name: depthNormalize Range: trueQueue Size: 2Transport Hint: rawUnreliable: falseValue: falseEnabled: trueName: SimulationEnabled: trueName: drone0- Class: rviz/ImageEnabled: falseImage Topic: /camera/depth/image_rect_rawMax Value: 1Median window: 5Min Value: 0Name: ImageNormalize Range: trueQueue Size: 2Transport Hint: rawUnreliable: falseValue: false- Alpha: 1Buffer Length: 1Class: rviz/PathColor: 25; 255; 0Enabled: trueHead Diameter: 0.30000001192092896Head Length: 0.20000000298023224Length: 0.30000001192092896Line Style: LinesLine Width: 0.029999999329447746Name: PathOffset:X: 0Y: 0Z: 0Pose Color: 255; 85; 255Pose Style: NoneQueue Size: 10Radius: 0.029999999329447746Shaft Diameter: 0.10000000149011612Shaft Length: 0.10000000149011612Topic: /vins_estimator/pathUnreliable: falseValue: true- Angle Tolerance: 0.10000000149011612Class: rviz/OdometryCovariance:Orientation:Alpha: 0.5Color: 255; 255; 127Color Style: UniqueFrame: LocalOffset: 1Scale: 1Value: truePosition:Alpha: 0.30000001192092896Color: 204; 51; 204Scale: 1Value: trueValue: trueEnabled: trueKeep: 1Name: OdometryPosition Tolerance: 0.10000000149011612Queue Size: 10Shape:Alpha: 1Axes Length: 0.5Axes Radius: 0.20000000298023224Color: 255; 25; 0Head Length: 0.30000001192092896Head Radius: 0.10000000149011612Shaft Length: 1Shaft Radius: 0.05000000074505806Value: AxesTopic: /vins_estimator/odometryUnreliable: falseValue: trueEnabled: trueGlobal Options:Background Color: 255; 255; 255Default Light: trueFixed Frame: worldFrame Rate: 30Name: rootTools:- Class: rviz/InteractHide Inactive Objects: true- Class: rviz/Select- Class: rviz/FocusCamera- Class: rviz/Measure- Class: rviz/SetInitialPoseTheta std deviation: 0.2617993950843811Topic: /initialposeX std deviation: 0.5Y std deviation: 0.5- Class: rviz/SetGoalTopic: /move_base_simple/goal- Class: rviz/PublishPointSingle click: trueTopic: /clicked_pointValue: trueViews:Current:Class: rviz/ThirdPersonFollowerDistance: 14.900397300720215Enable Stereo Rendering:Stereo Eye Separation: 0.05999999865889549Stereo Focal Distance: 1Swap Stereo Eyes: falseValue: falseField of View: 0.7853981852531433Focal Point:X: -1.706774115562439Y: -2.435426712036133Z: 5.149927346792538e-06Focal Shape Fixed Size: trueFocal Shape Size: 0.05000000074505806Invert Z Axis: falseName: Current ViewNear Clip Distance: 0.009999999776482582Pitch: 1.0197973251342773Target Frame: <Fixed Frame>Yaw: 3.5065858364105225Saved:- Class: rviz/FPSEnable Stereo Rendering:Stereo Eye Separation: 0.05999999865889549Stereo Focal Distance: 1Swap Stereo Eyes: falseValue: falseInvert Z Axis: falseName: FPSNear Clip Distance: 0.009999999776482582Pitch: 0.4000000059604645Position:X: -11Y: 0Z: 8Roll: 0Target Frame: my_viewYaw: 0- Class: rviz/FPSEnable Stereo Rendering:Stereo Eye Separation: 0.05999999865889549Stereo Focal Distance: 1Swap Stereo Eyes: falseValue: falseInvert Z Axis: falseName: FPSNear Clip Distance: 0.009999999776482582Pitch: 0.5Position:X: -10Y: 0Z: 10Roll: 0Target Frame: my_viewYaw: 0- Class: rviz/FPSEnable Stereo Rendering:Stereo Eye Separation: 0.05999999865889549Stereo Focal Distance: 1Swap Stereo Eyes: falseValue: falseInvert Z Axis: falseName: FPSNear Clip Distance: 0.009999999776482582Pitch: 0.6000000238418579Position:X: -10Y: 0Z: 10Roll: 0Target Frame: my_viewYaw: 0
Window Geometry:Displays:collapsed: falseHeight: 668Hide Left Dock: falseHide Right Dock: falseImage:collapsed: falseQMainWindow State: 000000ff00000000fd00000004000000000000017b00000242fc0200000024fb0000001200530065006c0065006300740069006f006e00000001e10000009b0000005c00fffffffb0000001e0054006f006f006c002000500072006f007000650072007400690065007302000001ed000001df00000185000000a3fb000000120056006900650077007300200054006f006f02000001df000002110000018500000122fb000000200054006f006f006c002000500072006f0070006500720074006900650073003203000002880000011d000002210000017afb000000100044006900730070006c006100790073000000003d00000242000000c900fffffffb0000000a0049006d006100670065000000015d000001220000001600fffffffb0000000a0056006900650077007300000001ee000000ad000000a400fffffffb0000002000730065006c0065006300740069006f006e00200062007500660066006500720200000138000000aa0000023a00000294fb00000014005700690064006500530074006500720065006f02000000e6000000d2000003ee0000030bfb0000000c004b0069006e0065006300740200000186000001060000030c00000261fb0000000c00430061006d00650072006100000001d1000000b50000000000000000fb0000000a00640065007000740068000000031d000002310000001600fffffffb0000000a0049006d0061006700650100000415000000f80000000000000000fb0000000a0049006d00610067006501000003f4000001190000000000000000fb0000000a0064006500700074006800000004a2000000ac0000000000000000fb0000000a0064006500700074006800000003b4000001b60000000000000000fb0000000a0064006500700074006800000004b9000000950000000000000000fb0000000a006400650070007400680000000481000000cd0000000000000000fb0000000a006400650070007400680000000429000001250000000000000000fb0000000a0064006500700074006800000003b7000000af0000000000000000fb0000000a0064006500700074006800000003d5000000b50000000000000000fb0000000a006400650070007400680000000444000001260000000000000000fb0000000a00640065007000740068000000041f0000014b0000000000000000fb0000000a0064006500700074006800000001b8000000160000000000000000fb0000000a0064006500700074006800000001c1000000160000000000000000fb0000000a0064006500700074006800000004b1000000550000000000000000fb0000000a006400650070007400680000000505000000650000000000000000fb0000000a006400650070007400680000000502000000680000000000000000fb0000000a0064006500700074006800000004f9000000710000000000000000fb0000000a0064006500700074006800000004e9000000810000000000000000fb0000000a0064006500700074006800000004de0000008c0000000000000000fb0000000a0064006500700074006800000004cc0000009e0000000000000000fb0000000a0064006500700074006800000004bb000000af0000000000000000fb0000000a0064006500700074006800000004aa000000c00000000000000000fb0000000a006400650070007400680000000498000000d20000000000000000fb0000000a0049006d00610067006500000003fa000001540000000000000000000000010000010f00000385fc0200000002fb0000001e0054006f006f006c002000500072006f00700065007200740069006500730100000041000000780000000000000000fb0000001200530065006c0065006300740069006f006e010000025a000000b200000000000000000000000200000490000000a9fc0100000001fb0000000a00560069006500770073030000004e00000080000002e10000019700000003000006100000003bfc0100000002fb0000000800540069006d00650000000000000006100000041800fffffffb0000000800540069006d00650100000000000004500000000000000000000002600000024200000004000000040000000800000008fc0000000100000002000000010000000a0054006f006f006c00730100000000ffffffff0000000000000000Selection:collapsed: falseTime:collapsed: falseTool Properties:collapsed: falseViews:collapsed: falseWidth: 608X: 1265Y: 60depth:collapsed: false

修改完成后保存即可!

3.2.2 VINS-Fusion-gpu + EGO-Swarm 实验

接下来我们先运行 Realsense 和 VINS-Fusion-gpu,如果没有安装 Realsense 和 VINS-Fusion-gpu,参考以下两篇文章

Jetson Orin NX 开发指南(4): 安装 CUDA 和 Realsense_想要个小姑娘的博客-CSDN博客

Jetson Orin NX 开发指南(6): VINS-Fusion-gpu 的编译和运行_想要个小姑娘的博客-CSDN博客

首先打开超级终端,划分为四个终端,

然后在第一个终端输入

roslaunch realsense2_camera rs_camera.launch

在第二个终端输入

source ~/catkin_ws/src/vins-fusion-gpu/devel/setup.bash
roslaunch vins realsense_d435i.launch

第三个终端输入

source ~/catkin_ws/src/ego-planner-swarm/devel/setup.bash
roslaunch ego_planner single_run_in_exp.launch

第四个终端输入

source ~/catkin_ws/src/ego-planner-swarm/devel/setup.bash
roslaunch ego_planner rviz_exp.launch

如下所示

依次运行后显示如下结果

这篇关于Jetson Orin NX 开发指南(7): EGO-Swarm 的编译与运行的文章就介绍到这儿,希望我们推荐的文章对编程师们有所帮助!



http://www.chinasem.cn/article/207123

相关文章

SQL Server数据库迁移到MySQL的完整指南

《SQLServer数据库迁移到MySQL的完整指南》在企业应用开发中,数据库迁移是一个常见的需求,随着业务的发展,企业可能会从SQLServer转向MySQL,原因可能是成本、性能、跨平台兼容性等... 目录一、迁移前的准备工作1.1 确定迁移范围1.2 评估兼容性1.3 备份数据二、迁移工具的选择2.1

基于Python开发PPTX压缩工具

《基于Python开发PPTX压缩工具》在日常办公中,PPT文件往往因为图片过大而导致文件体积过大,不便于传输和存储,所以本文将使用Python开发一个PPTX压缩工具,需要的可以了解下... 目录引言全部代码环境准备代码结构代码实现运行结果引言在日常办公中,PPT文件往往因为图片过大而导致文件体积过大,

通过prometheus监控Tomcat运行状态的操作流程

《通过prometheus监控Tomcat运行状态的操作流程》文章介绍了如何安装和配置Tomcat,并使用Prometheus和TomcatExporter来监控Tomcat的运行状态,文章详细讲解了... 目录Tomcat安装配置以及prometheus监控Tomcat一. 安装并配置tomcat1、安装

在 Windows 上安装 DeepSeek 的完整指南(最新推荐)

《在Windows上安装DeepSeek的完整指南(最新推荐)》在Windows上安装DeepSeek的完整指南,包括下载和安装Ollama、下载DeepSeekRXNUMX模型、运行Deep... 目录在www.chinasem.cn Windows 上安装 DeepSeek 的完整指南步骤 1:下载并安装

nginx-rtmp-module构建流媒体直播服务器实战指南

《nginx-rtmp-module构建流媒体直播服务器实战指南》本文主要介绍了nginx-rtmp-module构建流媒体直播服务器实战指南,文中通过示例代码介绍的非常详细,对大家的学习或者工作具有... 目录1. RTMP协议介绍与应用RTMP协议的原理RTMP协议的应用RTMP与现代流媒体技术的关系2

mysqld_multi在Linux服务器上运行多个MySQL实例

《mysqld_multi在Linux服务器上运行多个MySQL实例》在Linux系统上使用mysqld_multi来启动和管理多个MySQL实例是一种常见的做法,这种方式允许你在同一台机器上运行多个... 目录1. 安装mysql2. 配置文件示例配置文件3. 创建数据目录4. 启动和管理实例启动所有实例

Spring Boot统一异常拦截实践指南(最新推荐)

《SpringBoot统一异常拦截实践指南(最新推荐)》本文介绍了SpringBoot中统一异常处理的重要性及实现方案,包括使用`@ControllerAdvice`和`@ExceptionHand... 目录Spring Boot统一异常拦截实践指南一、为什么需要统一异常处理二、核心实现方案1. 基础组件

使用DeepSeek API 结合VSCode提升开发效率

《使用DeepSeekAPI结合VSCode提升开发效率》:本文主要介绍DeepSeekAPI与VisualStudioCode(VSCode)结合使用,以提升软件开发效率,具有一定的参考价值... 目录引言准备工作安装必要的 VSCode 扩展配置 DeepSeek API1. 创建 API 请求文件2.

电脑密码怎么设置? 一文读懂电脑密码的详细指南

《电脑密码怎么设置?一文读懂电脑密码的详细指南》为了保护个人隐私和数据安全,设置电脑密码显得尤为重要,那么,如何在电脑上设置密码呢?详细请看下文介绍... 设置电脑密码是保护个人隐私、数据安全以及系统安全的重要措施,下面以Windows 11系统为例,跟大家分享一下设置电脑密码的具体办php法。Windo

IDEA运行spring项目时,控制台未出现的解决方案

《IDEA运行spring项目时,控制台未出现的解决方案》文章总结了在使用IDEA运行代码时,控制台未出现的问题和解决方案,问题可能是由于点击图标或重启IDEA后控制台仍未显示,解决方案提供了解决方法... 目录问题分析解决方案总结问题js使用IDEA,点击运行按钮,运行结束,但控制台未出现http://