Skip to content
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

Problems with path planning using d435i camera navigation #1147

Open
smile6023326 opened this issue Apr 16, 2024 · 3 comments
Open

Problems with path planning using d435i camera navigation #1147

smile6023326 opened this issue Apr 16, 2024 · 3 comments

Comments

@smile6023326
Copy link

smile6023326 commented Apr 16, 2024

Hello, when I use rtabmap to navigate, why does the robot walk on the left side of the path plan? If the navigation is successful, I will share the program code with those who need it.
Thank you for taking the time to answer.

my tf tree:
螢幕擷取畫面 2024-04-09 014235

mapping:
roslaunch realsense2_camera rs_rgbd.launch

roslaunch my_package rtabmap402.launch rtabmap_args:="--delete_db_on_start" depth_topic:=/camera/depth/image_rect_raw rgb_topic:=/camera/color/image_raw camera_info_topic:=/camera/color/camera_info

rviz

navigation :
roslaunch realsense2_camera rs_rgbd.launch

roslaunch my_package rtabmap402.launch database_path:="~/.ros/rtabmap.db" depth_topic:=/camera/depth/image_rect_raw rgb_topic:=/camera/color/image_raw camera_info_topic:=/camera/color/camera_info localization:=true

roslaunch my_package robot_rtabmap_nav.launch

.launch:
rs_rgbd.txt
rtabmap402.txt
robot_rtabmap_nav.txt

In actual situations, the green line is the planned path, and my robot does not follow the green line.
螢幕擷取畫面 2024-04-16 213947

amcl positioning and navigation robot can travel according to the planned path, so the parameters of move_base.launch are the same as amcl.

@matlabbe
Copy link
Member

If the green line is the global plan, it is normal that the robot doesn't follow it exactly. You may vheck the output of the local planner, I guess this one is planning slightly off the global one to be farther from obstacles.

@smile6023326
Copy link
Author

But when I use this method to navigate, there are no obstacles in front of me.
my robot Length 90cm,Width 70cm,Height 95cm.
D435i is located on a flat surface with a height of 90cm.
This is my video, the speed is much faster due to the upload size limit.
https://github.com/introlab/rtabmap_ros/assets/48814064/0579eb54-acd4-4676-9b2d-7ab086695e1a

@matlabbe
Copy link
Member

Try to visualize the local costmap at the same time, to see if the camera is seeing some ghost obstacles (noise).

Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
None yet
Projects
None yet
Development

No branches or pull requests

2 participants