AutoTest: add -j option to sim_vehicle

new option controls the number of processors used during compile
AC_WPNav: fix divide by zero when origin and dest are same location