Sostituita azione Wait con Turnright che impiega meno tempo.
Modificato di conseguenza il sistema di evitamento delle persone e
fixati alcuni bug sul relativo replanning del percorso.

Eliminata euristica Priorità CLEAN perchè peggiorava penalita'.