Rework auto focus behavior, closes #222
Rework smart walk, fix #247