This is not a fix for localization during manipulation etc.
This is a fix for global localization. HERO does lose its global localization from time to time while just driving around. Its pose can be of for more than 1m and/or its rotation can be for minimal 20 degrees. That shouldn't happen.
Test it yourself. Just drive around in impuls for 15 minutes without and 15 minutes with this change.
Just so you know, with this change, the plugin still only uses less than 1% of its loop time, while running on 20Hz.
This is not a fix for localization during manipulation etc.
This is a fix for global localization. HERO does lose its global localization from time to time while just driving around. Its pose can be of for more than 1m and/or its rotation can be for minimal 20 degrees. That shouldn't happen.
Test it yourself. Just drive around in impuls for 15 minutes without and 15 minutes with this change.
Just so you know, with this change, the plugin still only uses less than 1% of its loop time, while running on 20Hz.