Merge pull request #116 from Jailander/hydro-devel

Adding joy add waypoint
Improving general navigation behaviour especially some special cases dending on the types of actions on queue