diff --git a/src/description/urdf/athena_drive.urdf.xacro b/src/description/urdf/athena_drive.urdf.xacro index eb376ac..9deb819 100644 --- a/src/description/urdf/athena_drive.urdf.xacro +++ b/src/description/urdf/athena_drive.urdf.xacro @@ -49,9 +49,9 @@ - - - + + + diff --git a/src/description/urdf/depth_camera.xacro b/src/description/urdf/depth_camera.xacro index 14d6483..1485297 100644 --- a/src/description/urdf/depth_camera.xacro +++ b/src/description/urdf/depth_camera.xacro @@ -1,7 +1,7 @@ - + @@ -18,20 +18,13 @@ - - - - - - + @@ -42,12 +35,13 @@ - + 1 - 30 + 10 + true depth_camera - 1.047198 + 1.05 640 480 @@ -57,8 +51,11 @@ 0.1 10.0 + + points + - + ogre2 diff --git a/src/simulation/launch/bridge.launch.py b/src/simulation/launch/bridge.launch.py index 60d5040..4ea873d 100644 --- a/src/simulation/launch/bridge.launch.py +++ b/src/simulation/launch/bridge.launch.py @@ -29,8 +29,8 @@ def generate_launch_description(): name='depth_camera_bridge', output='screen', arguments=[ - '/depth_camera@sensor_msgs/msg/Image[ignition.msgs.Image', - '/depth_camera/points@sensor_msgs/msg/PointCloud2[ignition.msgs.PointCloudPacked', + '/depth_camera@sensor_msgs/msg/Image@gz.msgs.Image', + '/depth_camera/points@sensor_msgs/msg/PointCloud2@gz.msgs.PointCloudPacked', ], ), diff --git a/src/simulation/launch/bringup.launch.py b/src/simulation/launch/bringup.launch.py index 198f2c5..301bf6e 100644 --- a/src/simulation/launch/bringup.launch.py +++ b/src/simulation/launch/bringup.launch.py @@ -40,13 +40,19 @@ choices=['true', 'false'], description='Publish ground truth odom -> base_link transform' ), + DeclareLaunchArgument( + 'rqt', + default_value='false', + choices=['true', 'false'], + description='Open RQt.' + ), ] def generate_launch_description(): pkg_sim = get_package_share_directory('simulation') gazebo_launch = PathJoinSubstitution( - [pkg_sim, 'launch', 'gz_sim.launch.py']) + [pkg_sim, 'launch', 'gz_sim.launch.py']) robot_spawn_launch = PathJoinSubstitution( [pkg_sim, 'launch', 'spawn.launch.py']) bridge_launch = PathJoinSubstitution( @@ -93,4 +99,4 @@ def generate_launch_description(): ld.add_action(bridge) ld.add_action(control) ld.add_action(ground_truth_tf) - return ld \ No newline at end of file + return ld diff --git a/src/simulation/launch/spawn.launch.py b/src/simulation/launch/spawn.launch.py index 4b5bdf0..5eccecf 100644 --- a/src/simulation/launch/spawn.launch.py +++ b/src/simulation/launch/spawn.launch.py @@ -11,11 +11,16 @@ DeclareLaunchArgument('rviz', default_value='false', choices=['true', 'false'], description='Start rviz.'), + DeclareLaunchArgument('rqt', default_value='false', + description='Open RQt.'), + DeclareLaunchArgument('image_topic', default_value='/depth_camera', + description='Topic to start viewing in RQt.'), DeclareLaunchArgument('use_sim_time', default_value='true', choices=['true', 'false'], description='use_sim_time'), DeclareLaunchArgument('namespace', default_value='', description='Robot namespace'), + ] @@ -70,10 +75,19 @@ def generate_launch_description(): executable='rviz2', name='rviz2', output='screen', - condition=conditions.IfCondition(LaunchConfiguration('rviz')) + condition=conditions.IfCondition(LaunchConfiguration('rviz')), + parameters=[{'use_sim_time': LaunchConfiguration('use_sim_time')}] + ), + + Node( + package='rqt_image_view', + executable='rqt_image_view', + name='rqt', + arguments=[LaunchConfiguration('image_topic')], + condition=conditions.IfCondition(LaunchConfiguration('rqt')) ), ]) ld = LaunchDescription(ARGUMENTS) ld.add_action(spawn_robot_group_action) - return ld \ No newline at end of file + return ld