-
Notifications
You must be signed in to change notification settings - Fork 117
New issue
Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.
By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.
Already on GitHub? Sign in to your account
Expose internal errors and convergence status #265
Conversation
[#676] FAILED on melodicTest failed
[#676] FAILED on kineticTest failed
|
[#677] PASSED on kineticAll tests passed
[#677] PASSED on melodicAll tests passed
|
Codecov Report
@@ Coverage Diff @@
## master #265 +/- ##
==========================================
+ Coverage 94.28% 94.28% +<.01%
==========================================
Files 28 28
Lines 1661 1662 +1
==========================================
+ Hits 1566 1567 +1
Misses 95 95
Continue to review full report at Codecov.
|
src/mcl_3dl.cpp
Outdated
const float float_max = std::numeric_limits<float>::max(); | ||
pnh_.param("std_warn_thresh_x", std_warn_thresh_[0], float_max); | ||
pnh_.param("std_warn_thresh_y", std_warn_thresh_[1], float_max); | ||
pnh_.param("std_warn_thresh_z", std_warn_thresh_[2], float_max); |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
As 3D stddev can't represent orientation of the error ellipse (excepting 0 and 90 deg), it would better be 1D threshold. (or 2D (xy and z) may have meaning for mobile robot.)
I would like to recommend to use amcl_pose.covariance
if the user want to check convergency in 3D or 6DOF.
[#682] PASSED on melodicAll tests passed
[#682] PASSED on kineticAll tests passed
|
src/mcl_3dl.cpp
Outdated
@@ -1289,6 +1344,11 @@ class MCL3dlNode | |||
pnh_.param("publish_tf", publish_tf_, true); | |||
pnh_.param("output_pcd", output_pcd_, false); | |||
|
|||
const float float_max = std::numeric_limits<float>::max(); | |||
pnh_.param("std_warn_thresh_x", std_warn_thresh_[0], float_max); | |||
pnh_.param("std_warn_thresh_y", std_warn_thresh_[1], float_max); |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
IMO, having x and y separately doesn't make sense as the error ellipse represented by (x, y) parameter can't represent the major axis orientation of the ellipse.
For mobile robot purpose, separating z may make sense due to the constraint of the floor.
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
@at-wat Addressed your comment.
[#705] PASSED on kineticAll tests passed
[#705] PASSED on melodicAll tests passed
|
[#706] PASSED on kineticAll tests passed
[#706] PASSED on melodicAll tests passed
|
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
Added minor comments, otherwise looks good.
src/mcl_3dl.cpp
Outdated
@@ -28,6 +28,7 @@ | |||
*/ | |||
|
|||
#include <algorithm> | |||
#include <limits> |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
please sort this block
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
done
src/mcl_3dl.cpp
Outdated
|
||
bool fake_imu_, fake_odom_; | ||
ros::Time match_output_last_; | ||
ros::Time odom_last_; | ||
bool has_map_; | ||
bool has_odom_; | ||
bool has_imu_; | ||
bool has_points_; |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
seems not used?
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
removed
[#710] PASSED on kineticAll tests passed
[#710] PASSED on melodicAll tests passed
|
Co-Authored-By: Atsushi Watanabe <[email protected]>
[#711] PASSED on kineticAll tests passed
[#711] PASSED on melodicAll tests passed
|
[#712] PASSED on melodicAll tests passed
[#712] PASSED on kineticAll tests passed
|
Co-Authored-By: Atsushi Watanabe <[email protected]>
[#713] PASSED on melodicAll tests passed
[#713] PASSED on kineticAll tests passed
|
src/mcl_3dl.cpp
Outdated
* * Neither the name of the copyright holder nor the names of its | ||
* contributors may be used to endorse or promote products derived from | ||
* * Neither the name of the copyright holder nor the names of its | ||
* contributors may be used to endorse or promote products derived from |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
spaces are added?
[#714] PASSED on kineticAll tests passed
[#714] PASSED on melodicAll tests passed
|
closes #264