Controller Update
This commit is contained in:
@@ -14,36 +14,42 @@ def generate_launch_description():
|
||||
|
||||
world_arg = DeclareLaunchArgument(
|
||||
'world',
|
||||
default_value=os.path.join(pkg_share, 'worlds', 'empty_custom.world'),
|
||||
description='Path to world file'
|
||||
default_value='iris_runway.sdf',
|
||||
description='World file name'
|
||||
)
|
||||
|
||||
# Gazebo Harmonic
|
||||
gazebo = ExecuteProcess(
|
||||
cmd=['gazebo', '--verbose', LaunchConfiguration('world')],
|
||||
cmd=[
|
||||
'gz', 'sim', '-v4', '-r',
|
||||
os.path.expanduser('~/ardupilot_gazebo/worlds/iris_runway.sdf')
|
||||
],
|
||||
output='screen',
|
||||
additional_env={
|
||||
'GAZEBO_MODEL_PATH': f"{pkg_share}/models:" + os.path.expanduser('~/ardupilot_gazebo/models'),
|
||||
'GZ_SIM_RESOURCE_PATH': f"{pkg_share}/models:{os.path.expanduser('~/ardupilot_gazebo/models')}:{os.path.expanduser('~/ardupilot_gazebo/worlds')}",
|
||||
'GZ_SIM_SYSTEM_PLUGIN_PATH': os.path.expanduser('~/ardupilot_gazebo/build')
|
||||
}
|
||||
)
|
||||
|
||||
ardupilot = TimerAction(
|
||||
period=3.0,
|
||||
period=5.0,
|
||||
actions=[
|
||||
ExecuteProcess(
|
||||
cmd=[
|
||||
'sim_vehicle.py', '-v', 'ArduCopter', '-f', 'gazebo-iris',
|
||||
'--model', 'JSON', '--map', '--console', '-I0',
|
||||
'--out', '127.0.0.1:14550',
|
||||
'--add-param-file', os.path.join(pkg_share, 'config', 'ardupilot_gps_denied.parm')
|
||||
'--model', 'JSON', '--no-mavproxy', '-I0',
|
||||
],
|
||||
cwd=os.path.expanduser('~/ardupilot/ArduCopter'),
|
||||
output='screen'
|
||||
cwd=os.path.expanduser('~/ardupilot'),
|
||||
output='screen',
|
||||
additional_env={
|
||||
'PATH': os.environ.get('PATH', '') + ':' + os.path.expanduser('~/ardupilot/Tools/autotest')
|
||||
}
|
||||
)
|
||||
]
|
||||
)
|
||||
|
||||
mavros = TimerAction(
|
||||
period=8.0,
|
||||
period=15.0,
|
||||
actions=[
|
||||
Node(
|
||||
package='mavros',
|
||||
@@ -53,7 +59,7 @@ def generate_launch_description():
|
||||
output='screen',
|
||||
parameters=[
|
||||
os.path.join(pkg_share, 'config', 'mavros_params.yaml'),
|
||||
{'fcu_url': 'udp://:14550@127.0.0.1:14555'}
|
||||
{'fcu_url': 'tcp://127.0.0.1:5760'}
|
||||
]
|
||||
)
|
||||
]
|
||||
|
||||
Reference in New Issue
Block a user