FIx negative index problem for dynamic maps#31

grimmmyshini wants to merge 2 commits intokarlkurzer:masterkarlkurzer/path_planner:masterfrom

grimmmyshini:mastergrimmmyshini/path_planner:masterCopy head branch name to clipboard