Adding some logging messages
Error handling for small paths.
Fix the error handling in dubin
Fix search algorithm
Fix problem with the generateCircle method
Use constant instead of hardcoded value