Multiple 2D nav goal

angtzewern 2018-09-13 02:30:04 UTC #1

Is there any way to set multiple 2D nav goal and let it load in sequence?
from the husarion tutorial i can only set one 2d nav goal.

lukasz.mitka 2018-09-13 05:11:44 UTC #2

Hi angtzewern,

You could use follow_waypoints node to load a sequence of goals.
If that is not enough, you could build your own node with use of actionlib library. Here you can find tutorial explaining how to use actionlib to send navigation goals.

Regards
Łukasz

angtzewern 2018-09-20 10:29:45 UTC #3

Thank you for your guidance.
The above method seems to be working !

urahara94 2018-10-04 01:54:19 UTC #4

is there a way we can fix the sequence of goal and save it and load it every time?
like pressing a button to reload those sequence

lukasz.mitka 2018-10-05 09:45:22 UTC #5

Hi urahara94,

You could record a sequence of goals with rosbag and then play them every time you want to reload the sequence.

Regards,
Łukasz

urahara94 2018-10-05 10:08:11 UTC #6

does this still maintain the obstacle avoidance and lidar function on the husarion?
or will this just repeat what has been done in the previous sequence?
so far i tested the follow_waypoints and upon completion the waypoint disappears

lukasz.mitka 2018-10-05 10:13:02 UTC #7

This will maintain obstacle avoidance and other functions. Just remember to record and play only the waypoints topic.

urahara94 2018-10-12 03:46:43 UTC #8

i tried out recording and playing the waypoint topic and i dont seem to be able to publish the waypoint to the waypoint node
it can replay it tho
attach is the waypoint bag (i attach it as c but change it back to waypoint.bag since this page dont allow me to post .bag format

waypoint.c (8.2 KB)

**update i found the solution where the follow_waypoint is publish at /initialpose instead of /waypoint (this is just indication)

lukasz.mitka 2018-10-22 11:29:14 UTC #9

Yes, you’re right.

The /waypoints is for visualization.
What is required is an /initialpose topic with desired points and /path_ready topic to trigger the process.
It can be recorded with:

rosbag record initialpose path_ready -O points

Then played back with:

rosbag play points.bag

Regards,
Łukasz

urahara94 2018-10-24 03:42:03 UTC #10

ok thank you
but i notice another problem if i want to use amcl instead of gmapping.
It seems to clash with the initial pose setting. Is there anyway to disable the initial pose of amcl before setting the waypoint?

lukasz.mitka 2018-10-24 07:48:10 UTC #11

Hello urahara94,

You could remap topic name for one of this nodes.
E.g. this could be:

rosrun follow_waypoints follow_waypoints initialpose:=points_to_follow

or use <remap> tag in launch file:

<remap from="initialpose" to="points_to_follow"/>

You will need to change topic name also for rosbag and rviz.

Regards,
Łukasz

urahara94 2018-10-24 09:20:38 UTC #12

Hi lukasz

Ah i might have overlook the remap function. And yes this solved my issue i been having over the past week.

Thank you very much!