|
1 | 1 | <launch> |
2 | | - <arg name="robot_id" default="$(optenv ID 1)" doc="Unique identifier of the robot [1-Inf.)"/> |
3 | | - <arg name="ns" value="create$(arg robot_id)" doc="Namespace of the robot. By default: create1"/> |
4 | | - <arg name="tf_prefix" value="$(arg ns)_tf" doc="Tf prefix"/> |
5 | | - |
6 | | - <arg name="use_nodelets" default="false" /> |
7 | | - <arg name="nodelet_manager" default="$optenv robot_localization_NODELET_MANAGER robot_localization_nodelet_manager)" /> |
| 2 | + <arg name="use_nodelets" default="$(optenv NODELET true)" doc="Use nodelets: http://wiki.ros.org/nodelet" /> |
| 3 | + <arg name="nodelet_manager" value="nodelet_manager" /> |
8 | 4 |
|
9 | 5 | <remap from="set_pose" to="amcl_pose"/> |
10 | 6 |
|
|
14 | 10 | <rosparam command="load" file="$(find ca_localization)/config/ekf_localization.yaml"/> |
15 | 11 | <rosparam command="load" file="$(find ca_localization)/config/ekf_odom.yaml"/> |
16 | 12 | <rosparam command="load" file="$(find ca_localization)/config/ekf_imu.yaml"/> |
17 | | - <!-- <rosparam command="load" file="$(find ca_localization)/config/ekf_scan_matcher.yaml"/> --> |
18 | | - <!-- <rosparam command="load" file="$(find ca_localization)/config/ekf_angle.yaml"/> --> |
19 | | - |
20 | | - <!-- |
21 | | - The filter accepts an arbitrary number of inputs from each input message type |
22 | | - (nav_msgs/Odometry, geometry_msgs/PoseWithCovarianceStamped, |
23 | | - geometry_msgs/TwistWithCovarianceStamped, sensor_msgs/Imu). To add an input, |
24 | | - simply append the next number in the sequence to its "base" name, e.g., odom0, odom1, |
25 | | - twist0, twist1, imu0, imu1, imu2, etc. The value should be the topic name. |
26 | | - These parameters obviously have no default values, and must be specified. |
27 | | - --> |
28 | | - <param name="odom0" value="odom"/> |
29 | | - <param name="imu0" value="imu/data"/> |
30 | 13 |
|
31 | 14 | <remap from="odometry/filtered" to="odom_combined"/> |
32 | | - |
33 | | - <param name="odom_frame" value="odom"/> |
34 | | - <param name="base_link_frame" value="base_footprint"/> |
35 | | - <param name="world_frame" value="odom"/> |
36 | 15 | </node> |
37 | 16 |
|
38 | | - <!-- <node if="$(arg use_nodelets)" |
| 17 | + <node if="$(arg use_nodelets)" |
39 | 18 | pkg="nodelet" type="nodelet" name="ekf_se" output="screen" |
40 | 19 | args="load RobotLocalization/EkfNodelet $(arg nodelet_manager)"> |
41 | 20 | <rosparam command="load" file="$(find ca_localization)/config/ekf_localization.yaml"/> |
| 21 | + |
42 | 22 | <rosparam command="load" file="$(find ca_localization)/config/ekf_odom.yaml"/> |
43 | | - <rosparam command="load" file="$(find ca_localization)/config/ekf_angle.yaml"/> |
44 | 23 | <rosparam command="load" file="$(find ca_localization)/config/ekf_imu.yaml"/> |
45 | | - </node> --> |
| 24 | + |
| 25 | + <remap from="odometry/filtered" to="odom_combined"/> |
| 26 | + </node> |
46 | 27 |
|
47 | 28 | <!-- RViz --> |
48 | 29 | <arg name="rviz" default="false"/> |
49 | 30 | <include if="$(arg rviz)" file="$(find ca_tools)/launch/rviz.launch"/> |
50 | | - |
51 | | - <!-- Start laser odometry node --> |
52 | | - <!-- https://wiki.ros.org/laser_scan_matcher --> |
53 | | - <!-- <node pkg="laser_scan_matcher" type="laser_scan_matcher_node" name="laser_scan_matcher_node" output="screen"> |
54 | | - <param name="fixed_frame" value = "$(arg tf_prefix)/odom"/> |
55 | | - <param name="base_frame" value="$(arg tf_prefix)/base_footprint"/> |
56 | | - <param name="publish_tf" value="false"/> |
57 | | - <param name="publish_pose_with_covariance_stamped" value="true"/> |
58 | | - <param name="max_iterations" value="10"/> |
59 | | - <param name="use_odom" value="false"/> |
60 | | - <param name="use_imu" value="true"/> |
61 | | - <param name="angle_compensate" value="true"/> |
62 | | - <remap from="pose_with_covariance_stamped" to="scan_match_pose"/> |
63 | | - <remap from="pose2D" to="scan_match_pose2d"/> |
64 | | - <remap from="imu/data" to="/android/phone1/imu"/> |
65 | | - <remap from="scan" to="/create1/rplidar/scan"/> |
66 | | - </node> --> |
67 | 31 | </launch> |
0 commit comments