Don't move robot and simplify checking for previously added boxes.

Don't move robot and simplify checking for previously added boxes. #441