add walk function to dubins_path.hpp and test "walk" function