moveTo algorithm with (theorically again) obstacle avoidance
Merge origin/master