)
generate_dynamic_reconfigure_options(
- cfg/path_following.cfg
+ config/path_following.cfg
)
###################################
+++ /dev/null
-analyzers:
- motors:
- type: diagnostic_aggregator/GenericAnalyzer
- path: Motors
- startswith: 'Motor'
- find_and_remove_prefix: motor
- reset:
- type: diagnostic_aggregator/GenericAnalyzer
- path: Reset
- startswith: 'Reset'
- timeout: -1
- voltage:
- type: diagnostic_aggregator/GenericAnalyzer
- path: Voltage
- startswith: 'Voltage'
- Razor9DofImu:
- type: diagnostic_aggregator/GenericAnalyzer
- path: 'Imu'
- timeout: 5.0
- contains: ['Razor_Imu']
+++ /dev/null
-subscribers:
- - name: "Default input"
- topic: "/cmd_vel"
- timeout: 0.1
- priority: 0
- short_desc: "The default cmd_vel, controllers unaware that we are multiplexing cmd_vel should come here"
- - name: "Navigation stack"
- topic: "/move_base/cmd_vel"
- timeout: 0.5
- priority: 1
- short_desc: "Navigation stack controller"
- - name: "Wii Teleop"
- topic: "/turtlebot_teleop_joystick/cmd_vel"
- timeout: 0.1
- priority: 10
-publisher: "/cmd_vel_out"
+++ /dev/null
-#!/usr/bin/env python
-
-from dynamic_reconfigure.parameter_generator_catkin import *
-
-gen = ParameterGenerator()
-
-gen.add("binary_threshold", int_t, 0, "Binary Threshold", 192, 0, 255)
-gen.add("ht_min_points", int_t, 0, "HT Min Points", 30, 0, 1000)
-gen.add("roi_y", int_t, 0, "ROI Y (cm)", 70, 0, 1000)
-gen.add("road_distance_cm", double_t, 0, "Road distance (cm)", 15, 0, 1000)
-gen.add("lad_cm", double_t, 0, "Look ahead distance (cm)", 60, 0, 1000)
-gen.add("speed_m_s", double_t, 0, "Speed m/s", 0, 0, 1)
-
-exit(gen.generate("wild_thumper", "path_following", "PathFollowing"))
+++ /dev/null
-## USB port
-port: /dev/ttyUSB0
-
-
-##### Calibration ####
-### accelerometer
-accel_x_min: -275
-accel_x_max: 290
-accel_y_min: -295
-accel_y_max: 275
-accel_z_min: -295
-accel_z_max: 215
-
-### magnetometer
-# standard calibration
-magn_x_min: -470
-magn_x_max: 542
-magn_y_min: -767
-magn_y_max: 523
-magn_z_min: -417
-magn_z_max: 596
-
-
-# extended calibration
-calibration_magn_use_extended: true
-magn_ellipsoid_center: [293.553, 46.4419, -692.900]
-magn_ellipsoid_transform: [[0.939516, 0.0193393, 0.0340815], [0.0193393, 0.957723, 0.0120572], [0.0340815, 0.0120572, 0.966198]]
-
-
-# AHRS to robot calibration
-imu_yaw_calibration: 0.0
-
-### gyroscope
-gyro_average_offset_x: -29.0
-gyro_average_offset_y: -21.0
-gyro_average_offset_z: 4.0
+++ /dev/null
-%YAML:1.0
-transformation_matrix: !!opencv-matrix
- rows: 3
- cols: 3
- dt: d
- data: [ 1.27755347e-02, 7.48846231e-02, -2.97173802e-01, -2.46883581e-03, 1.59522560e-01, -5.47704021e-01, -5.19536325e-06, 2.98962964e-04, 1.52353391e-02]
--- /dev/null
+analyzers:
+ motors:
+ type: diagnostic_aggregator/GenericAnalyzer
+ path: Motors
+ startswith: 'Motor'
+ find_and_remove_prefix: motor
+ reset:
+ type: diagnostic_aggregator/GenericAnalyzer
+ path: Reset
+ startswith: 'Reset'
+ timeout: -1
+ voltage:
+ type: diagnostic_aggregator/GenericAnalyzer
+ path: Voltage
+ startswith: 'Voltage'
+ Razor9DofImu:
+ type: diagnostic_aggregator/GenericAnalyzer
+ path: 'Imu'
+ timeout: 5.0
+ contains: ['Razor_Imu']
--- /dev/null
+subscribers:
+ - name: "Default input"
+ topic: "/cmd_vel"
+ timeout: 0.1
+ priority: 0
+ short_desc: "The default cmd_vel, controllers unaware that we are multiplexing cmd_vel should come here"
+ - name: "Navigation stack"
+ topic: "/move_base/cmd_vel"
+ timeout: 0.5
+ priority: 1
+ short_desc: "Navigation stack controller"
+ - name: "Wii Teleop"
+ topic: "/turtlebot_teleop_joystick/cmd_vel"
+ timeout: 0.1
+ priority: 10
+publisher: "/cmd_vel_out"
--- /dev/null
+#!/usr/bin/env python
+
+from dynamic_reconfigure.parameter_generator_catkin import *
+
+gen = ParameterGenerator()
+
+gen.add("binary_threshold", int_t, 0, "Binary Threshold", 192, 0, 255)
+gen.add("ht_min_points", int_t, 0, "HT Min Points", 30, 0, 1000)
+gen.add("roi_y", int_t, 0, "ROI Y (cm)", 70, 0, 1000)
+gen.add("road_distance_cm", double_t, 0, "Road distance (cm)", 15, 0, 1000)
+gen.add("lad_cm", double_t, 0, "Look ahead distance (cm)", 60, 0, 1000)
+gen.add("speed_m_s", double_t, 0, "Speed m/s", 0, 0, 1)
+
+exit(gen.generate("wild_thumper", "path_following", "PathFollowing"))
--- /dev/null
+## USB port
+port: /dev/ttyUSB0
+
+
+##### Calibration ####
+### accelerometer
+accel_x_min: -275
+accel_x_max: 290
+accel_y_min: -295
+accel_y_max: 275
+accel_z_min: -295
+accel_z_max: 215
+
+### magnetometer
+# standard calibration
+magn_x_min: -470
+magn_x_max: 542
+magn_y_min: -767
+magn_y_max: 523
+magn_z_min: -417
+magn_z_max: 596
+
+
+# extended calibration
+calibration_magn_use_extended: true
+magn_ellipsoid_center: [250.567, 49.8387, -698.641]
+magn_ellipsoid_transform: [[0.940458, 0.0129812, 0.0164252], [0.0129812, 0.947417, 0.0255152], [0.0164252, 0.0255152, 0.978453]]
+
+# AHRS to robot calibration
+imu_yaw_calibration: 0.0
+
+### gyroscope
+gyro_average_offset_x: -29.0
+gyro_average_offset_y: -21.0
+gyro_average_offset_z: 4.0
--- /dev/null
+%YAML:1.0
+transformation_matrix: !!opencv-matrix
+ rows: 3
+ cols: 3
+ dt: d
+ data: [ 1.27755347e-02, 7.48846231e-02, -2.97173802e-01, -2.46883581e-03, 1.59522560e-01, -5.47704021e-01, -5.19536325e-06, 2.98962964e-04, 1.52353391e-02]
<node pkg="joint_state_publisher" type="joint_state_publisher" name="joint_state_publisher" output="screen"/>
<node pkg="diagnostic_aggregator" type="aggregator_node" name="diagnostic_aggregator" output="screen">
- <rosparam command="load" file="$(find wild_thumper)/cfg/analyzers.yaml"/>
+ <rosparam command="load" file="$(find wild_thumper)/config/analyzers.yaml"/>
</node>
<node pkg="wild_thumper" type="wt_node.py" name="wild_thumper" output="screen" respawn="false" required="true">
</node>
<node pkg="razor_imu_9dof" type="imu_node.py" name="imu_node" output="screen" if="$(arg use_imu)">
- <rosparam file="$(find wild_thumper)/cfg/razor.yaml" command="load"/>
+ <rosparam file="$(find wild_thumper)/config/razor.yaml" command="load"/>
</node>
<node pkg="gpsd_client" type="gpsd_client" name="gpsd_client" output="screen">
</node>
<include file="$(find yocs_cmd_vel_mux)/launch/cmd_vel_mux.launch">
- <arg name="config_file" value="$(find wild_thumper)/cfg/cmd_vel_mux.yaml" />
+ <arg name="config_file" value="$(find wild_thumper)/config/cmd_vel_mux.yaml" />
<arg name="nodelet_manager_name" value="nodelet_manager" />
</include>
</launch>
PathFollower() : it(nh)
{
ros::NodeHandle pnh("~");
- FileStorage fs(ros::package::getPath("wild_thumper") + "/cfg/transformation_matrix.yml", FileStorage::READ);
+ FileStorage fs(ros::package::getPath("wild_thumper") + "/config/transformation_matrix.yml", FileStorage::READ);
dynamic_reconfigure::Server<wild_thumper::PathFollowingConfig>::CallbackType f;
fs["transformation_matrix"] >> transformation_matrix;