-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathsim_mav_odom.launch.py
91 lines (79 loc) · 3.03 KB
/
sim_mav_odom.launch.py
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
from launch import LaunchDescription
from launch_ros.actions import Node
# For environment variables
from launch.actions import SetEnvironmentVariable
# Import other 'launch files'
from launch.actions import IncludeLaunchDescription
from launch.launch_description_sources import PythonLaunchDescriptionSource
import os
from ament_index_python import get_package_share_directory
def generate_launch_description():
ld = LaunchDescription()
# Set ROS Domain ID
# ld.add_action(SetEnvironmentVariable('ROS_DOMAIN_ID', '101'))
# TF
tf2_ros = Node(
package='tf2_ros',
executable='static_transform_publisher',
arguments=['0', '0', '0', '0', '0', '0', 'map', 'odom'],
name='odom_to_odom'
)
odom_to_base_link = Node(
package='tf2_ros',
executable='static_transform_publisher',
arguments=['0', '0', '0', '0', '0', '0', 'odom', 'base_link'],
name='odom_to_base_link'
)
base_link_to_camera_link = Node(
package='tf2_ros',
executable='static_transform_publisher',
arguments=['0', '0', '0', '0', '0', '0', 'base_link', 'x500_vision_0/camera_link/camera'],
name='base_link_to_camera_link'
)
x500_to_camera_frame= Node(
package='tf2_ros',
executable='static_transform_publisher',
arguments=['0', '0', '0', '0', '0', '0', 'x500_vision_0/camera_link/camera', 'camera_frame'],
name='base_link_to_camera_link'
)
# ros2 run stella_vslam_ros run_slam -v ./orb_vocab.fbow -c ./runcam_720p.yaml --map-db-out ./runcam_720_0420.msg
stella_ros = Node(
package='stella_vslam_ros',
executable='run_slam',
name='stella_ros',
output="screen",
remappings=[("/stella_ros/camera_pose","/mavros/odometry/out")],
arguments=["-v","./orb_vocab.fbow","-c","./gazebo_480p.yaml",
"--map-db-out","./gazebo_480.msg"
#"--ros-args","-r", "/camera/image_raw:=/cam0/image_raw"
#"--ros-args","-p","publish_tf:=false"
]
)
#ros2 run micro_ros_agent micro_ros_agent udp4 --port 8888 ROS_DOMAIN_ID=0
# micro_ros = Node(
# package='micro_ros_agent',
# executable='micro_ros_agent',
# name='micro_ros',
# arguments=["udp4","--port","8888","ROS_DOMAIN_ID=0"]
# )
#ros2 run ros_gz_image image_bridge /camera
ros_gz_camera_bridge = Node(
package='ros_gz_image',
executable='image_bridge',
name='camera_bridge',
arguments=["/camera/image_raw"]
)
# #ros2 run px4_ros_com offboard_control
# px4_offboard = Node(
# package='px4_ros_com',
# executable='offboard_control',
# name='offboard_takeoff'
# )
ld.add_action(stella_ros)
# ld.add_action(tf2_ros)
ld.add_action(odom_to_base_link)
ld.add_action(base_link_to_camera_link)
ld.add_action(x500_to_camera_frame)
ld.add_action(ros_gz_camera_bridge)
# ld.add_action(px4_offboard)
return ld