A wall following controller that is kinda working