Updated Main and RoutePlanner and Added several new functions

New functions
- Compass
- ExistOnMap
- NextStep

New data files
- RobotSensorData(Improved).xlsx
- testOpen.txt