Resolved path finder issue (last obstacle position was wrong)
Merge branch 'origin/develop'