wait for head to finish moving, fail HeadStep if head position is not close to desired