finish Dijkstra's task#2

chuangtsh wants to merge 2 commits intoJustinShih0918:KeslerJustinShih0918/Navigation_Tutorial:Keslerfrom

chuangtsh:mainchuangtsh/Navigation_Tutorial:mainCopy head branch name to clipboard