Wall following works. MAJOT tuning needed