Localisation et optimisation de trajectoires pour des robots autonomes