Ask Your Question

Revision history [back]

the package robot_localization might be what you looking for. It is used to fuse multiple sensors together but I think it would work with just one sensor. It has a 2d mode and 3d mode. If the slopes that your dealing with are large enough then you should use 3d mode and that should solve your issue.