2022-03-01 14:06:18 -04:00
|
|
|
<?xml version="1.0"?>
|
|
|
|
<!--
|
|
|
|
Launch file to use klausen oscillaton damping ctrl in Gazebo
|
|
|
|
/-->
|
|
|
|
<launch>
|
|
|
|
<arg name="mav_name" default="spiri"/>
|
|
|
|
<arg name="command_input" default="1" />
|
|
|
|
<arg name="log_output" default="screen" />
|
|
|
|
<arg name="fcu_protocol" default="v2.0" />
|
|
|
|
<arg name="respawn_mavros" default="false" />
|
|
|
|
<arg name="gazebo_gui" default="false" />
|
2022-04-05 11:00:59 -03:00
|
|
|
<!--arg name="test_type" default="step.py" /-->
|
2022-03-14 16:09:30 -03:00
|
|
|
<arg name="model" default="spiri_with_tether"/>
|
2022-04-05 11:00:59 -03:00
|
|
|
<arg name='test' default="none"/>
|
2022-03-01 14:06:18 -04:00
|
|
|
|
|
|
|
<group ns="sim">
|
|
|
|
<rosparam file="$(find oscillation_ctrl)/config/Ctrl_param.yaml" />
|
|
|
|
</group>
|
|
|
|
|
2022-04-05 11:00:59 -03:00
|
|
|
<group ns="status">
|
|
|
|
<param name="test_type" value="$(arg test)"/>
|
|
|
|
</group>
|
|
|
|
|
2022-03-01 14:06:18 -04:00
|
|
|
<node
|
|
|
|
pkg="oscillation_ctrl"
|
|
|
|
type="LinkState.py"
|
|
|
|
name="linkStates_node"
|
2022-04-13 14:41:13 -03:00
|
|
|
launch-prefix="xterm -e"
|
2022-03-01 14:06:18 -04:00
|
|
|
/>
|
2022-03-18 11:50:09 -03:00
|
|
|
<node
|
|
|
|
pkg="oscillation_ctrl"
|
|
|
|
type="wpoint_tracker.py"
|
|
|
|
name="waypoints_server"
|
|
|
|
/>
|
2022-03-01 14:06:18 -04:00
|
|
|
<node
|
|
|
|
pkg="oscillation_ctrl"
|
|
|
|
type="ref_signalGen.py"
|
|
|
|
name="refSignal_node"
|
|
|
|
/>
|
|
|
|
<node
|
|
|
|
pkg="oscillation_ctrl"
|
|
|
|
type="klausen_control.py"
|
|
|
|
name="klausenCtrl_node"
|
|
|
|
output="screen"
|
|
|
|
|
|
|
|
/>
|
|
|
|
<node
|
|
|
|
pkg="oscillation_ctrl"
|
|
|
|
type="pathFollow_node"
|
|
|
|
name="pathFollow_node"
|
|
|
|
launch-prefix="xterm -e"
|
|
|
|
/>
|
|
|
|
|
2022-04-13 14:41:13 -03:00
|
|
|
<group if="$(eval test != 'none')">
|
|
|
|
<node
|
|
|
|
pkg="oscillation_ctrl"
|
|
|
|
type="perform_test.py"
|
|
|
|
name="test_node"
|
2022-04-18 10:10:17 -03:00
|
|
|
launch-prefix="xterm -e"
|
2022-04-13 14:41:13 -03:00
|
|
|
/>
|
|
|
|
</group>
|
2022-03-01 14:06:18 -04:00
|
|
|
<node pkg="geometric_controller" type="geometric_controller_node" name="geometric_controller" output="screen">
|
|
|
|
<param name="mav_name" type="string" value="$(arg mav_name)" />
|
|
|
|
<!--remap from="command/bodyrate_command" to="/mavros/setpoint_raw/attitude"/-->
|
|
|
|
<param name="ctrl_mode" value="$(arg command_input)" />
|
|
|
|
<param name="max_acc" value="8.0" />
|
|
|
|
<param name="Kp_x" value="8.0" />
|
|
|
|
<param name="Kp_y" value="8.0" />
|
|
|
|
<param name="Kp_z" value="10.0" />
|
|
|
|
<param name="Kv_x" value="3.0" />
|
|
|
|
<param name="Kv_y" value="3.0" />
|
|
|
|
<param name="Kv_z" value="6.0" />
|
|
|
|
</node>
|
|
|
|
<!-- PX4 LAUNCH -->
|
2022-03-14 16:09:30 -03:00
|
|
|
<include file="$(find px4)/launch/$(arg model).launch"/>
|
|
|
|
</launch>
|