add obstacle avoiding straight line testing
Merge remote-tracking branch 'origin/master'
add obstacle avoiding test