First initial test working. Added walls and boxes.