Extended handleSubstateFenceApproach() by collision detection andmake