Add unit tests for follow path, compute path to pose, and navigate to pose BT action nodes#1844

SteveMacenski merged 3 commits intoros-navigation:masterros-navigation/navigation2:masterfrom

naiveHobo:bt-action-testsnaiveHobo/navigation2:bt-action-testsCopy head branch name to clipboard