Add door detect maybe, play around with wall follow