Changes to basic_navigator.py

I am going to modify basic_navigator.py to add support to amcl localization. Here is a fragment of code, the complete file is available by the link above.

basic_navigator.py