marker list thread safe
fixed bug in getStart when footstep list is empty | fixed heuristic to circumvent local minima in backward walking