A* self destructs intentionally after goal changes. Need to add proper exception handling to fix client/server interaction
refactor driving code. All in terms of TF. Added angular path correction