摘要:
A method of performing simultaneous localization of a mobile body and mapping of its environment, comprising the steps of: a) defining an occupancy grid (G) on a region of said environment and a pose grid (Π) comprising for the mobile body; b) receiving a first time series of distance measurements (z 1 , z 2 ) and, upon reception of a distance measurement: either b1) updating occupancy probabilities of the occupancy grid; or b2) updating pose probabilities of the pose grid; and
c) receiving a second time series of odometry measurements (u 1 , u 2 ), each of said measurements being representative of a motion of the mobile body in the environment and, upon reception of an odometry measurement, updating the pose probabilities of the pose grid. An apparatus for carrying out such a method.
摘要:
L'invention concerne L'invention concerne un procédé de perception de corps matériels destiné à localiser lesdits corps sur une grille d'occupation G à au moins 2 dimensions, ayant un premier pas de résolution R G , et comprenant un ensemble de cellules représentées par des sommets (couramment appelés vertex en anglais) et des segments reliant ces sommets, le procédé utilisant un capteur de détection d'obstacles positionné en point source S, comportant au moins les étapes suivantes : • Acquisition par ledit capteur d'une mesure de la position d'un corps matériel détecté en un point F ; • Définir les coordonnées d'un point M en utilisant un espace discrétisé à l'aide d'un pas spatial δ plus fin que le pas de résolution R G , • Initialiser un paramètre d'erreur, entier, représentatif de la position d'au moins une coordonnée d'un sommet de la cellule contenant le point source S dans l'espace discrétisé par rapport à un trajet défini dans l'espace d'observation, • Calculer la valeur du paramètre d'erreur pour au moins un premier sommet de la cellule de la grille en cours, en réalisant des additions ou soustractions de nombres entiers, • Etablir la liste {c i } des cellules situées sur le trajet [SF] ou situées à une distance prédéfinie du trajet [SF].
摘要:
An environment sensing method comprising the following steps, carried out by a data processor (DP): a) defining an occupancy grid (OG) comprising a plurality of cells; b) acquiring at least one measurement result (z) from a distance sensor, representative of the distance of one or more nearest targets; and c) computing an occupation probability of the cells of the occupancy grid by applying to the measurement an inverse sensor model stored in a memory device (MD) in the form of a data structure representing a plurality of model grids (MG) associated to respective distance measurement results, at least some cells of a model grid corresponding to a plurality of contiguous cells of the occupancy grid belonging to a same of a plurality of angular sectors into which the field of view of the distance sensor is divided, and associating a same occupation probability to each one of said plurality of cells. An apparatus programmed or configured for carrying out said environment sensing method. A computer-implemented method of computing an inverse sensor model suitable for carrying out said environment sensing method.