UbiquityRobotics / move_basic

A minimal navigation node
BSD 3-Clause "New" or "Revised" License
69 stars 21 forks source link

External force during goal following #80

Closed dorkamotorka closed 3 years ago

dorkamotorka commented 3 years ago

Currently if the robot is moving towards the goal and is moved or hit by some other dynamic object it does not update it's pose according to the goal and therefore misses it.

PROPOSED SOLUTION: Keep track of goal_frame~base_frame transform during movement and update it accordingly if needed.

MoffKalast commented 3 years ago

@tp4348 I've just done a round of tests with ezmap and feature-external-force in gazebo and it performs super well, at least as long as the map localization manages to actually find the new position properly. So if it works well in real life tests I'd vote for it to be merged into kinetic-devel as soon as possible since it's really a much needed addition.

dorkamotorka commented 3 years ago

Well yeah it's updating in map frame haha. I think I will be able to test it on Sunday if @GreTimotej can't make it earlier.

MoffKalast commented 3 years ago

Yep, it's expected, I'm just saying we might need to look at iris_lama next if we're still having problems afterwards.

GreTimotej commented 3 years ago

Today I tried the above mentioned issue. I was moving the robot while driving and it went back to its course. I think that is it?

MoffKalast commented 3 years ago

That's mostly it, but I think there were some issues with it the first time it was tested? Are those resolved?

dorkamotorka commented 3 years ago

Timotej was the one testing it so I guess since the second testing was successful we can close this.

dorkamotorka commented 3 years ago

On which branch were you testing @GreTimotej? This one: https://github.com/UbiquityRobotics/move_basic/tree/feature-external-force?