Shortest path algorithm corrected and improved
Method to return to charging station implemented
floorplan.xml file corrected

close #14
fixed #17