factorise code et ajoute point de la position du scan pour la carto
Merge pull request #44 from loictrichaud/updateObstacle

factorise code et ajoute point de la position du scan pour la carto