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
+
+
+
-
+
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