Just to clarify (in case I'm not explaining myself clearly): currently the bot successfully navigates the nodes and ends up at the final waypoint. The final waypoint is always one that is the closest and has 'line of sight'. This would be fine if the bot needed to attack, but in this case I want the (friendly) bot to navigate itself to the owner's position.
The problem is the way the 'final waypoint' is determined. Currently, it's decided by 'the last one the owner touched', but this does not mean that its the closest, or the most accessible. Let's take another look at the scenario I described earlier:
The blue line is the path the owner took. The bot is standing at the last wp the owner touched. Once the onwer is in the position shown, the command goes out "come here, bot", but from the bots current position he cant reach me.