drone-rigide/launch/simple_loop.launch
2019-06-07 15:29:39 +02:00

94 lines
4.7 KiB
XML

<launch>
<node name="Ratex_param" pkg="dynamic_reconfigure" type="dynparam" args="load /ratex $(find detect_targets)/params/rate.yaml" />
<node name="Ratey_param" pkg="dynamic_reconfigure" type="dynparam" args="load /ratey $(find detect_targets)/params/rate.yaml" />
<node name="Ratez_param" pkg="dynamic_reconfigure" type="dynparam" args="load /ratez $(find detect_targets)/params/rate.yaml" />
<node name="Rateangz_param" pkg="dynamic_reconfigure" type="dynparam" args="load /rate_ang_z $(find detect_targets)/params/rate.yaml" />
<node name="safe_param" pkg="dynamic_reconfigure" type="dynparam" args="load /safe $(find detect_targets)/params/settings_safe.yaml"/>
<node name="targets_param" pkg="dynamic_reconfigure" type="dynparam" args="load /targets $(find detect_targets)/params/settings_targets.yaml"/>
<!-- <remap from="/reset" to="/bebop/reset"/> -->
<include file="$(find bebop_driver)/launch/bebop_node.launch" />
<node name="targets" pkg="detect_targets" type="target_publisher.py">
</node>
<node name="triangle" pkg="detect_targets" type="triangle.py" output="screen">
<remap from="component_centers" to="targets"/>
</node>
<node name="ratex" pkg="detect_targets" type="control_compute.py" args="rate" output="screen">
<remap from="input" to="linear_x" />
<remap from="output" to="rated_x" />
</node>
<include file="$(find detect_targets)/launch/control.launch" ns="controller_linear_x">
<arg name="reset" value="/reset_pid" />
<arg name="measure" value="/rated_x" />
<arg name="param_P" value="simple_loop/linear_x/P.yaml" />
<arg name="param_I" value="simple_loop/linear_x/I.yaml" />
<arg name="param_D" value="simple_loop/linear_x/D.yaml" />
<arg name="param_input" value="simple_loop/linear_x/input.yaml" />
</include>
<node name="ratey" pkg="detect_targets" type="control_compute.py" args="rate" output="screen">
<remap from="input" to="linear_y" />
<remap from="output" to="rated_y" />
</node>
<include file="$(find detect_targets)/launch/control.launch" ns="controller_linear_y">
<arg name="reset" value="/reset_pid" />
<arg name="measure" value="/rated_y" />
<arg name="param_P" value="simple_loop/linear_y/P.yaml" />
<arg name="param_I" value="simple_loop/linear_y/I.yaml" />
<arg name="param_D" value="simple_loop/linear_y/D.yaml" />
<arg name="param_input" value="simple_loop/linear_y/input.yaml" />
</include>
<node name="ratez" pkg="detect_targets" type="control_compute.py" args="rate" output="screen">
<remap from="input" to="linear_z" />
<remap from="output" to="rated_z" />
</node>
<include file="$(find detect_targets)/launch/control.launch" ns="controller_linear_z">
<arg name="reset" value="/reset_pid" />
<arg name="measure" value="/rated_z" />
<arg name="param_P" value="simple_loop/linear_z/P.yaml" />
<arg name="param_I" value="simple_loop/linear_z/I.yaml" />
<arg name="param_D" value="simple_loop/linear_z/D.yaml" />
<arg name="param_input" value="simple_loop/linear_z/input.yaml" />
</include>
<node name="rate_ang_z" pkg="detect_targets" type="control_compute.py" args="rate" output="screen">
<remap from="input" to="angular_z" />
<remap from="output" to="rated_ang_z" />
</node>
<include file="$(find detect_targets)/launch/control.launch" ns="controller_angular_z">
<arg name="reset" value="/reset_pid" />
<arg name="measure" value="/rated_ang_z" />
<arg name="param_P" value="simple_loop/angular_z/P.yaml" />
<arg name="param_I" value="simple_loop/angular_z/I.yaml" />
<arg name="param_D" value="simple_loop/angular_z/D.yaml" />
<arg name="param_input" value="simple_loop/angular_z/input.yaml" />
</include>
<node name="twister" pkg="detect_targets" type="twist_controls.py">
<remap from="control_linear_z" to="controller_linear_z/output" />
<remap from="control_angular_z" to="controller_angular_z/output" />
<remap from="control_linear_x" to="controller_linear_x/output" />
<remap from="control_linear_y" to="controller_linear_y/output" />
</node>
<node name="safe" pkg="detect_targets" type="safe_drone_teleop.py" output="screen" launch-prefix="xterm -e">
<remap from="takeoff" to="/bebop/takeoff"/>
<remap from="land" to="/bebop/land"/>
<remap from="reset" to="/bebop/reset"/>
<remap from="cmd_vel_out" to="/bebop/cmd_vel"/>
<remap from="cmd_vel_in" to="/cmd_vel"/>
</node>
<node name="view" pkg="rqt_image_view" type="rqt_image_view" args="/bebop/image_raw"/>
<node name="view_targets" pkg="rqt_image_view" type="rqt_image_view" args="/img_targets"/>
<node name="graph" pkg="rqt_graph" type="rqt_graph" output="screen"></node>
<node name="reconf" pkg="rqt_reconfigure" type="rqt_reconfigure"/>
</launch>