Modified wall follow code to get squaa