X-Git-Url: https://defiant.homedns.org/gitweb/?p=ros_wild_thumper.git;a=blobdiff_plain;f=launch%2Fwild_thumper.launch;h=80dbf6fb14f65fb04167b239989d4b4964fa0f56;hp=a3f39f957fbb569c4c43cd44e81cbc34681037cf;hb=a40cf061b04718ece7057174a36f3c3c818f6f61;hpb=b301eb19e6487497a8bb946c538a25aa4ee28c1d

diff --git a/launch/wild_thumper.launch b/launch/wild_thumper.launch
index a3f39f9..80dbf6f 100644
--- a/launch/wild_thumper.launch
+++ b/launch/wild_thumper.launch
@@ -1,5 +1,7 @@
 <?xml version="1.0"?>
 <launch>
+	<env name="ROSCONSOLE_CONFIG_FILE" value="$(find wild_thumper)/config/rosconsole.config"/>
+
 	<arg name="use_imu" default="true"/>
 
 	<node pkg="nodelet" type="nodelet" name="nodelet_manager" args="manager"/>
@@ -20,42 +22,28 @@
 		<param name="enable_odom_tf" value="false" if="$(arg use_imu)"/>
 	</node>
 
-	<node pkg="wild_thumper" type="tinkerforge_imu2.py" name="tinkerforge_imu_brick2" output="screen">
+	<node pkg="wild_thumper" type="tinkerforge_imu2.py" name="tinkerforge_imu_brick2" output="screen" if="$(arg use_imu)">
 		<param name="uid" value="6DdNSn"/>
 	</node>
 
-	<node pkg="gpsd_client" type="gpsd_client"  name="gpsd_client" output="screen">
-		<param name="use_gps_time" value="false"/>
-	</node>
-
 	<include file="$(find yocs_cmd_vel_mux)/launch/cmd_vel_mux.launch">
 		<arg name="config_file" value="$(find wild_thumper)/config/cmd_vel_mux.yaml" />
 		<arg name="nodelet_manager_name" value="nodelet_manager" />
 	</include>
 
-	<!--
-	<node pkg="robot_pose_ekf" type="robot_pose_ekf" name="robot_pose_ekf" output="screen" if="$(arg use_imu)">
-		<remap from="imu_data" to="imu"/>
-		<remap from="vo" to="gps"/>
-		<remap from="robot_pose_ekf/odom_combined" to="odom_combined"/>
-		<param name="output_frame" value="odom"/>
-		<param name="freq" value="20.0"/>
-		<param name="vo_used" value="false"/>
-		<param name="debug" value="false"/>
-		<param name="sensor_timeout" value="2.0"/>
+	<node pkg="robot_localization" type="ekf_localization_node" name="ekf" clear_params="true" output="screen" if="$(arg use_imu)">
+		<rosparam command="load" file="$(find wild_thumper)/config/robot_localization.yaml"/>
+		<remap from="odometry/filtered" to="odom_combined"/>
 	</node>
 
-	<node pkg="gps_common" type="utm_odometry_node" name="gps_conv" output="screen">
-		<remap from="odom" to="gps"/>
-		<param name="frame_id" value="odom"/>
-		<param name="child_frame_id" value="base_footprint"/>
+	<node pkg="gpsd_client" type="gpsd_client"  name="gpsd_client" output="screen">
+		<param name="use_gps_time" value="false"/>
+		<param name="frame_id" value="base_footprint"/>
 	</node>
-	-->
 
-	<include file="$(find wild_thumper)/launch/robot_localization.launch" if="$(arg use_imu)"/>
-	<node pkg="robot_localization" type="navsat_transform_node" name="navsat_transform_node">
-		<param name="magnetic_declination_radians" value="0.48"/>
-		<param name="yaw_offset" value="1.5708"/>
+	<node pkg="robot_localization" type="navsat_transform_node" name="navsat_transform_node" output="screen">
+		<param name="magnetic_declination_radians" value="0.047"/>
+		<param name="yaw_offset" value="0.0"/>
 		<param name="zero_altitude" value="true"/>
 		<param name="broadcast_utm_transform" value="true"/>