WO2016034516A2 - Location and mapping device and method - Google Patents

Location and mapping device and method Download PDF

Info

Publication number
WO2016034516A2
WO2016034516A2 PCT/EP2015/069787 EP2015069787W WO2016034516A2 WO 2016034516 A2 WO2016034516 A2 WO 2016034516A2 EP 2015069787 W EP2015069787 W EP 2015069787W WO 2016034516 A2 WO2016034516 A2 WO 2016034516A2
Authority
WO
WIPO (PCT)
Prior art keywords
likelihood
occupation
zone
values
module
Prior art date
Application number
PCT/EP2015/069787
Other languages
French (fr)
Other versions
WO2016034516A3 (en
Inventor
Guillaume TREHARD
Evangeline POLLARD
Fawzi Nashashibi
Benazouz Bradai
Original Assignee
Valeo Schalter Und Sensoren Gmbh
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Valeo Schalter Und Sensoren Gmbh filed Critical Valeo Schalter Und Sensoren Gmbh
Priority to CN201580058177.XA priority Critical patent/CN107209515A/en
Priority to JP2017511921A priority patent/JP6682508B2/en
Priority to EP15763237.3A priority patent/EP3189389B1/en
Priority to US15/506,973 priority patent/US10379542B2/en
Publication of WO2016034516A2 publication Critical patent/WO2016034516A2/en
Publication of WO2016034516A3 publication Critical patent/WO2016034516A3/en

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/88Lidar systems specially adapted for specific applications
    • G01S17/93Lidar systems specially adapted for specific applications for anti-collision purposes
    • G01S17/931Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0238Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
    • G05D1/024Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0268Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
    • G05D1/0274Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device

Definitions

  • the present invention relates to locating and mapping techniques used by a mobile machine in an environment.
  • It relates more particularly to a device and a method of locating and mapping for equipping such a mobile machine.
  • the invention is particularly advantageous in the case where a sensor delivers obstacle positioning data relative to the mobile machine.
  • Locating and mapping devices are known designed to equip a mobile machine (for example a robot) in order both to locate the mobile machine in its environment and to produce a cartography of this environment.
  • SLAM Simultaneous Localization and Mapping
  • the present invention proposes a locating and mapping device for equipping a mobile machine in an environment comprising a plurality of zones, with a receiving module designed to receive obstacle positioning data relative to the machine. ; a processing module designed to determine, based on the data received and for a plurality of zones positioned relative to the machine, measurement values respectively representative of a likelihood of occupation of the area concerned, a likelihood of non-occupation of concerned area and a likelihood of non-knowledge of the area concerned; a mapping module designed to construct, for each zone of said plurality of zones of the environment, values respectively representative of a likelihood of occupation of the zone concerned, of a likelihood of non-occupation of the zone concerned and a likelihood of non-knowledge of the area concerned; and a location module adapted to determine the positioning of the craft in the environment that maximizes a measure of correspondence between the measured values and the constructed values.
  • the position of the mobile machine is determined by finding the best match between the measurement values, generated on the basis of the positioning data received from a sensor at a given time, and the constructed values, which describe the mapping. developed by the device at previous iterations.
  • the values representative of the likelihood of occupation of a zone and the likelihood of non-occupation of a zone are also influenced by the absence of information for the area concerned, since in general, the above-mentioned three representative values (likelihood of occupation, likelihood of non-occupation and likelihood of non-knowledge), referred to as "masses” in the description that follows, have a fixed sum (generally equal to 1).
  • the location module is designed to determine the correspondence measurement by using a measure of conflict between the measurement values and the constructed values
  • the correspondence measurement is indicative of a correspondence between a spatial distribution of the measurement values representative of the likelihood of occupation and a spatial distribution of the constructed values representative of the likelihood of occupation;
  • the locating module is designed to determine the measurement of correspondence for a given positioning of the mobile machine by using a sum of terms each associated with a given zone of the environment, and to calculate each term using the product of the measurement value representative of the likelihood of occupation of the zone corresponding to the given zone for the given positioning of the machine and the constructed value representative of the likelihood of occupation of the given zone;
  • the location module is designed to calculate each term by dividing the aforementioned product by a conflict factor using a sum of the measurement value representative of the likelihood of occupation of the zone corresponding to the given zone for the given positioning of the machine, multiplied by the constructed value representative of the likelihood of non-occupation of the given zone, and the measurement value representative of the likelihood of non-occupation of the zone corresponding to the given zone for the given positioning of the gear, multiplied by the constructed value representative of the likelihood of occupation of the given area;
  • the mapping module comprises a combination module designed to determine for each zone, by combining the said measurement values relative to the zone concerned and the values constructed by the mapping module for the zone concerned during a previous iteration, values raw respectively representative of a likelihood of occupation of the area concerned, a likelihood of non-occupation of the area concerned, a likelihood of non-knowledge of the area concerned and a likelihood of conflict in the area concerned;
  • mapping module comprises a normalization module designed to determine the said constructed values according to the said raw values
  • the processing module comprises a conversion module designed to determine, for each zone of the plurality of zones positioned with respect to the machine, said measurement values relating to the zone concerned as a function of corresponding values assigned, in a polar grid; , to a cell corresponding to the area concerned.
  • the invention also proposes a system comprising a locating and mapping device as mentioned above and a sensor designed to generate said positioning data.
  • This sensor is for example a lidar, but it could be another type of sensor, for example a radar.
  • the invention proposes, in a correlative manner, a method of locating and mapping used by a mobile machine in an environment comprising a plurality of zones, comprising the following steps:
  • Locating the machine by determining the positioning of the machine in the environment that maximizes a measure of correspondence between the measured values and the constructed values.
  • This method may optionally further comprise a step of combining said measurement values relative to the area concerned and of values constructed by the mapping module for the area concerned during a previous iteration in order to generate raw values respectively representative of a given region. likelihood of occupation of the area concerned, a likelihood of non-occupation of the area concerned, a likelihood of non-knowledge of the area concerned and a likelihood of conflict in the area concerned.
  • FIG. 1 represents a system comprising a sensor and an exemplary localization and mapping device according to the invention
  • FIG. 2 represents in functional form the processes performed by the localization and mapping device of FIG. 1;
  • FIG. 3 represents a polar grid constructed from the positioning data received from the sensor.
  • FIG. 1 schematically represents the main elements of a system including a locating and mapping device 10.
  • Such a system equips a mobile machine in an environment, for example a motor vehicle or a robot.
  • a system equipped with a localization and mapping device sometimes called SLAM (Anglo-Saxon acronym meaning “Simultaneous Location And Mapping”), allows both the location of the system (and therefore mobile gear) in the environment and the discovery of environmental mapping.
  • the system of FIG. 1 comprises a sensor 2 which generates positioning data (relative to the system) of obstacles present in the environment.
  • the sensor 2 is for example lidar type; in this case, the positioning data are representative, for a plurality of orientations with respect to a reference direction of the system, of the distance d (a) (with respect to the system) of the first obstacle encountered in the direction associated with this orientation a.
  • the system of FIG. 1 also comprises the locating and mapping device 10, which receives as input the positioning data generated by the sensor 2 and generates at the output location information X t of the system (and therefore of the mobile machine equipped with the system) at each moment t and GRI mapping information.
  • This GRI mapping information is for example an occupancy grid which describes, in the form of a grid, the locations of the environment in which an obstacle has been detected.
  • the location information X t include for example the x, y coordinates of the system in the mapping plane (precisely its x-coordinate and its y-coordinate) and its heading ⁇ (in English "heading").
  • the locating and mapping device 10 here comprises a processor 4 (for example a microprocessor) and a storage means 6 (for example a hard disk).
  • a processor 4 for example a microprocessor
  • a storage means 6 for example a hard disk
  • the processor 4 is designed to implement the processes described below, in particular with reference to FIG. 2, for example because of the execution of computer program instructions stored in the storage means 6. In a variant these processing could be carried out by a specific application integrated circuit (or ASIC of the "Application Specifies Integrated Circuit") implanted in the locating and mapping device 10.
  • ASIC Application Specifies Integrated Circuit
  • the storage means 6 also allow the storage of the data used during the processing described below, in particular the data representative of likelihoods or credibilities, hereinafter called “masses”.
  • FIG. 2 represents in functional form the processes carried out by the locating and mapping device 10 in order to determine the location information X t and the mapping information GRI from the positioning data d (a) generated by the sensor 2.
  • FIG. 2 the various treatments performed by the locating and mapping device 10 are shown in FIG. 2 implemented by different modules 1 1, 12, 14, 1 6, 18, 20, 22 although these can be set implemented in practice because of the execution of instructions by the same processor 4.
  • the locating and mapping device 10 comprises a reception module 1 1 connected to the sensor 2 and which thus receives the positioning data d (a) generated by the sensor 2 and transmits them to a polar grid construction module 12.
  • the polar grid construction module 12 determines, for each of the cells j of a polar grid, the three following parameters:
  • a polar grid is a set of cells of the environment (here represented in two dimensions) in which each cell corresponds to a given range of distances to the system (specifically to sensor 2) and to a given angular sector. (the angles being measured with respect to the reference direction of the system already mentioned).
  • the occupancy mass M_POL t, j (0) represents the possibility that the cell j concerned in the polar grid is occupied, according to some information, here the positioning data received from the sensor 2 at time t.
  • the occupation mass M_POL t , j (0) is therefore representative of a likelihood or credibility of occupation of this cell j.
  • the non-occupation mass M_POL t, j (F) represents the possibility that the cell j concerned in the polar grid is empty, according to some information, here the positioning data received from the sensor 2 at time t.
  • the non-occupation mass M_POL t , j (F) is therefore representative of a likelihood or credibility of non-occupation of this cell j.
  • the mass of non-knowledge M_POL t, j (U) represents the possibility that the cell j concerned has not been explored, that is to say that no knowledge is available for this cell according to the information available (here the positioning data).
  • the mass of non-knowledge M_POL t, j (U) is therefore representative of a likelihood or credibility of non-knowledge of the cell j.
  • the cell j blackened in FIG. 3 located at a distance d (6) from the system (that is to say, in the case where the sensor 2 is a lidar, the one where an object has been impacted by the laser shown in dashed lines in FIG.
  • the smallest distance d (6) for the determination of masses as described above is retained.
  • the polar grid construction module 12 transmits all the mass parameters M_POL t, j thus determined to a conversion module 14 which assigns, for each cell j of the polar gate, the masses determined for this cell j to one ( or more) corresponding cell (s) i of a measurement grid in Cartesian coordinates (expressed relative to the current position of the system at time t).
  • an occupancy mass M_SCAN t, j (O) for the cell i representing the likelihood (or credibility) of occupation of the cell i (according to the positioning data provided by the sensor 2 at time t );
  • a non-occupation mass M_SCAN t, j (F) for the cell i representing the likelihood of non-occupation of the cell i (according to the positioning data provided by the sensor 2 at time t);
  • processing module is used to denote the assembly formed by the polar grid construction module 12 and the conversion module 14.
  • the processing module thus makes it possible to determine the masses M_SCAN t, j (A) from the data of FIG. positioning d ( ⁇ ).
  • the different masses M_SCAN t, j (A) (with A € ⁇ O, F, U ⁇ ) produced by the conversion module 1 6 for the different cells i of the measurement grid are transmitted from a part to a location module 1 6 and secondly to a combination module 18.
  • the location module 1 6 also receives as input the following information produced by the combination module 18 and the normalization module 20 at the previous iteration t-1 (as explained hereinafter for the current iteration t) and relative to the cells k of a grid representing the environment (in Cartesian coordinates with respect to a fixed reference, such as the initial position of the system):
  • the location module 1 6 then only indicates that the current position (defined by the coordinates x, y and heading ⁇ ) is equal to the initial position already mentioned (defined by the coordinates x 0 , y o and by the heading ⁇ ).
  • the location module 1 6 determines the position X t of the system (and therefore of the mobile machine), defined here by the coordinates x, y and the heading ⁇ , which maximizes a measurement of correspondence between the values associated with the measurement grid (located in relation to the position of the system) and the values associated with the fixed grid representing the environment.
  • i (k, Z) is the cell of the measurement grid (positioned relative to the system, that is to say to the mobile machine as already indicated) corresponding to the cell k of the fixed gate when the system has the Z position and where M t, k, z (C) measures the conflict between the information used in the numerator:
  • a correspondence measurement is thus used which quantifies a correspondence between a spatial distribution (within the cells) of the occupation likelihoods in the measurement grid and a spatial distribution of the occupation likelihoods in the fixed grid.
  • the measurement N (Z) is calculated for a (discrete) set of Z positions verifying:
  • a priori position is used derived from the position determined at the previous iteration on the basis of a constant speed model:
  • S x , S y , S ⁇ are predetermined thresholds.
  • the combination module 18 then combines the information provided by the sensor 2 at the instant t (represented by the masses M_SCAN t, i (A)) and the information constructed by the device 10 up to the instant t-1 ( represented by the masses M_GRI t-1, k (A)) in order to derive from them raw masses M_COMB t, k (A) representative of the state of knowledge of the fixed gate at time t, for example in applying to each cell k of the fixed grid a formula of the type:
  • i (k, X t ) is the cell of the measurement grid which corresponds to the cell k of the fixed gate when the system is at the position X t and where is a
  • the raw masses M_COMB t, k produced by the combination module 18 are transmitted to the normalization module 20 which retains (in each cell) the distribution of the masses of occupation, non-occupation and non-knowledge but eliminates the notion of mass of conflict, which makes it possible to free oneself from moving obstacles.
  • the conflict raw masses M_COMB t, k (C) for the different cells k can be stored in order to be used for the detection of moving obstacles.
  • the normalization module 20 thus calculates the following masses (after normalization):
  • mapping module refers to the assembly formed by the combination module 18 and the normalization module 20.
  • the masses M_GRI t, k produced at the output of the module 20 are transmitted (through a delay of an iteration 22) to the location module 1 6 and the combination module 18 to be used at the next iteration.

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • General Physics & Mathematics (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Electromagnetism (AREA)
  • Optics & Photonics (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Traffic Control Systems (AREA)
  • Image Analysis (AREA)
  • Radar Systems Or Details Thereof (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)

Abstract

The invention relates to a location and mapping device intended for being installed in a mobile vehicle in an environment comprising a plurality of zones, with: a receiving module (11) designed to receive data of the position (d(a)) of obstacles relative to the vehicle; a processing module (12, 14) designed to determine, in accordance with the data received (d(a)) and for a plurality of zones positioned relative to the vehicle, measurement values (M_SCANt,i) that respectively represent a likelihood of occupation of the zone in question, a likelihood of non-occupation of the zone in question and a likelihood of not knowing the zone in question; a mapping module (18, 20) designed to build, for each zone of said plurality of zones of the environment, values (M_GRIt,k) which respectively represent a likelihood of occupation of the zone in question, a likelihood of non-occupation of the zone in question and a likelihood of not knowing the zone in question; and a location module (16) designed to determine the position of the vehicle in the environment, which maximises a measurement of correspondence between the measurement values (M_SCANt,i) and the built values (M_GRIt,k). The invention also describes an associated method.

Description

Dispositif et procédé de localisation et de cartographie  Device and method for locating and mapping
DOMAINE TECHNIQUE AUQUEL SE RAPPORTE L'INVENTION La présente invention concerne les techniques de localisation et de cartographie utilisées par un engin mobile dans un environnement. TECHNICAL FIELD TO WHICH THE INVENTION RELATES The present invention relates to locating and mapping techniques used by a mobile machine in an environment.
Elle concerne plus particulièrement un dispositif et un procédé de localisation et de cartographie destiné à équiper un tel engin mobile.  It relates more particularly to a device and a method of locating and mapping for equipping such a mobile machine.
L'invention s'applique particulièrement avantageusement dans le cas où un capteur délivre des données de positionnement d'obstacles relativement à l'engin mobile.  The invention is particularly advantageous in the case where a sensor delivers obstacle positioning data relative to the mobile machine.
ARRIERE-PLAN TECHNOLOGIQUE  BACKGROUND
On connaît des dispositifs de localisation et de cartographie conçus pour équiper un engin mobile (par exemple un robot) afin à la fois de localiser l'engin mobile dans son environnement et de produire une cartographie de cet environnement.  Locating and mapping devices are known designed to equip a mobile machine (for example a robot) in order both to locate the mobile machine in its environment and to produce a cartography of this environment.
De tels dispositifs sont couramment dénommés SLAM, en référence à l'acronyme anglo-saxon pour "Simultaneous Localization And Mapping".  Such devices are commonly referred to as SLAM, with reference to the English acronym for "Simultaneous Localization and Mapping".
Ils sont en général basés sur une approche probabiliste. Dans certaines solutions par exemple, on détermine, en fonction de données fournies par un capteur, la probabilité d'occupation de chacune des cellules d'une grille qui recouvre l'environnement. On peut se référer à ce sujet à l'article "Online localization and mapping with moving objects détection in dynamic outdoor environments", in IEEE 5th Internation Conférence on Intelligent Computer Communication and Processing, 2009, ICCP 2009, 2009, pp. 410-408.  They are usually based on a probabilistic approach. In some solutions for example, it is determined, based on data provided by a sensor, the probability of occupation of each cell of a grid that covers the environment. One can refer to this topic in the article "Online localization and mapping with moving objects detection in dynamic outdoor environments", in IEEE 5th International Conference on Intelligent Computer Communication and Processing, 2009, ICCP 2009, 2009, pp. 410-408.
OBJET DE L'INVENTION  OBJECT OF THE INVENTION
Dans ce contexte, la présente invention propose un dispositif de localisation et de cartographie destiné à équiper un engin mobile dans un environnement comprenant une pluralité de zones, avec un module de réception conçu pour recevoir des données de positionnement d'obstacles relativement à l'engin ; un module de traitement conçu pour déterminer, en fonction des données reçues et pour une pluralité de zones positionnées par rapport à l'engin, des valeurs de mesure respectivement représentatives d'une vraisemblance d'occupation de la zone concernée, d'une vraisemblance de non-occupation de la zone concernée et d'une vraisemblance de non-connaissance de la zone concernée ; un module de cartographie conçu pour construire, pour chaque zone de ladite pluralité de zones de l'environnement, des valeurs respectivement représentatives d'une vraisemblance d'occupation de la zone concernée, d'une vraisemblance de non-occupation de la zone concernée et d'une vraisemblance de non-connaissance de la zone concernée ; et un module de localisation conçu pour déterminer le positionnement de l'engin dans l'environnement qui maximise une mesure de correspondance entre les valeurs de mesure et les valeurs construites. In this context, the present invention proposes a locating and mapping device for equipping a mobile machine in an environment comprising a plurality of zones, with a receiving module designed to receive obstacle positioning data relative to the machine. ; a processing module designed to determine, based on the data received and for a plurality of zones positioned relative to the machine, measurement values respectively representative of a likelihood of occupation of the area concerned, a likelihood of non-occupation of concerned area and a likelihood of non-knowledge of the area concerned; a mapping module designed to construct, for each zone of said plurality of zones of the environment, values respectively representative of a likelihood of occupation of the zone concerned, of a likelihood of non-occupation of the zone concerned and a likelihood of non-knowledge of the area concerned; and a location module adapted to determine the positioning of the craft in the environment that maximizes a measure of correspondence between the measured values and the constructed values.
Ainsi, la position de l'engin mobile est déterminée par recherche de la meilleure correspondance entre les valeurs de mesure, générées sur la base des données de positionnement reçues d'un capteur à un instant donné, et les valeurs construites, qui décrivent la cartographie élaborée par le dispositif aux itérations précédentes.  Thus, the position of the mobile machine is determined by finding the best match between the measurement values, generated on the basis of the positioning data received from a sensor at a given time, and the constructed values, which describe the mapping. developed by the device at previous iterations.
Ces valeurs ne se limitent pas toutefois à évaluer, comme les approches probabilistes classiques, la probabilité de présence ou d'absence d'un obstacle dans les différentes zones de l'environnement, mais tiennent compte en outre de l'absence d'information pour certaines zones, grâce aux valeurs représentatives de la vraisemblance de non-connaissance de ces zones.  These values, however, are not limited to evaluating, like classical probabilistic approaches, the probability of presence or absence of an obstacle in the different zones of the environment, but also take into account the lack of information for certain areas, thanks to the representative values of the likelihood of non-knowledge of these zones.
On remarque d'ailleurs que les valeurs représentatives de la vraisemblance d'occupation d'une zone et de la vraisemblance de non-occupation d'une zone sont elles aussi influencées par l'absence d'information pour la zone concernée puisqu'on prévoit en général que les trois valeurs représentatives précitées (vraisemblance d'occupation, vraisemblance de non-occupation et vraisemblance de non-connaissance), dénommées "masses" dans la description qui suit, ont une somme fixe (en général égale à 1 ).  It should be noted that the values representative of the likelihood of occupation of a zone and the likelihood of non-occupation of a zone are also influenced by the absence of information for the area concerned, since in general, the above-mentioned three representative values (likelihood of occupation, likelihood of non-occupation and likelihood of non-knowledge), referred to as "masses" in the description that follows, have a fixed sum (generally equal to 1).
Selon d'autres caractéristiques optionnelles (et donc non limitatives) : According to other optional features (and therefore not limiting):
- le module de localisation est conçu pour déterminer la mesure de correspondance en utilisant une mesure de conflit entre les valeurs de mesure et les valeurs construites ; the location module is designed to determine the correspondence measurement by using a measure of conflict between the measurement values and the constructed values;
- la mesure de correspondance est indicative d'une correspondance entre une répartition spatiale des valeurs de mesure représentatives de la vraisemblance d'occupation et une répartition spatiale des valeurs construites représentatives de la vraisemblance d'occupation ; - le module de localisation est conçu pour déterminer la mesure de correspondance pour un positionnement donné de l'engin mobile en utilisant une somme de termes associés chacun à une zone donnée de l'environnement, et pour calculer chaque terme en utilisant le produit de la valeur de mesure représentative de la vraisemblance d'occupation de la zone correspondant à la zone donnée pour le positionnement donné de l'engin et de la valeur construite représentative de la vraisemblance d'occupation de la zone donnée ; the correspondence measurement is indicative of a correspondence between a spatial distribution of the measurement values representative of the likelihood of occupation and a spatial distribution of the constructed values representative of the likelihood of occupation; the locating module is designed to determine the measurement of correspondence for a given positioning of the mobile machine by using a sum of terms each associated with a given zone of the environment, and to calculate each term using the product of the measurement value representative of the likelihood of occupation of the zone corresponding to the given zone for the given positioning of the machine and the constructed value representative of the likelihood of occupation of the given zone;
- le module de localisation est conçu pour calculer chaque terme en divisant le produit précité par un facteur de conflit utilisant une somme de la valeur de mesure représentative de la vraisemblance d'occupation de la zone correspondant à la zone donnée pour le positionnement donné de l'engin, multipliée par la valeur construite représentative de la vraisemblance de non- occupation de la zone donnée, et de la valeur de mesure représentative de la vraisemblance de non-occupation de la zone correspondant à la zone donnée pour le positionnement donné de l'engin, multipliée par la valeur construite représentative de la vraisemblance d'occupation de la zone donnée ;  the location module is designed to calculate each term by dividing the aforementioned product by a conflict factor using a sum of the measurement value representative of the likelihood of occupation of the zone corresponding to the given zone for the given positioning of the machine, multiplied by the constructed value representative of the likelihood of non-occupation of the given zone, and the measurement value representative of the likelihood of non-occupation of the zone corresponding to the given zone for the given positioning of the gear, multiplied by the constructed value representative of the likelihood of occupation of the given area;
- le module de cartographie comprend un module de combinaison conçu pour déterminer pour chaque zone, en combinant lesdites valeurs de mesure relatives à la zone concernée et des valeurs construites par le module de cartographie pour la zone concernée lors d'une précédente itération, des valeurs brutes respectivement représentatives d'une vraisemblance d'occupation de la zone concernée, d'une vraisemblance de non-occupation de la zone concernée, d'une vraisemblance de non-connaissance de la zone concernée et d'une vraisemblance de conflit sur la zone concernée ;  the mapping module comprises a combination module designed to determine for each zone, by combining the said measurement values relative to the zone concerned and the values constructed by the mapping module for the zone concerned during a previous iteration, values raw respectively representative of a likelihood of occupation of the area concerned, a likelihood of non-occupation of the area concerned, a likelihood of non-knowledge of the area concerned and a likelihood of conflict in the area concerned;
- le module de cartographie comprend un module de normalisation conçu pour déterminer lesdites valeurs construites en fonction desdites valeurs brutes ;  the mapping module comprises a normalization module designed to determine the said constructed values according to the said raw values;
- le module de traitement comprend un module de conversion conçu pour déterminer, pour chaque zone de la pluralité de zones positionnées par rapport à l'engin, lesdites valeurs de mesure relatives à la zone concernée en fonction de valeurs correspondantes attribuées, dans une grille polaire, à une cellule correspondant à la zone concernée.  the processing module comprises a conversion module designed to determine, for each zone of the plurality of zones positioned with respect to the machine, said measurement values relating to the zone concerned as a function of corresponding values assigned, in a polar grid; , to a cell corresponding to the area concerned.
L'invention propose également un système comprenant un dispositif de localisation et de cartographie comme mentionné ci-dessus et un capteur conçu pour générer lesdites données de positionnement. Ce capteur est par exemple un lidar, mais il pourrait s'agir d'un autre type de capteur, par exemple un radar. The invention also proposes a system comprising a locating and mapping device as mentioned above and a sensor designed to generate said positioning data. This sensor is for example a lidar, but it could be another type of sensor, for example a radar.
L'invention propose de façon corrélative un procédé de localisation et de cartographie utilisé par un engin mobile dans un environnement comprenant une pluralité de zones, comprenant les étapes suivantes :  The invention proposes, in a correlative manner, a method of locating and mapping used by a mobile machine in an environment comprising a plurality of zones, comprising the following steps:
- réception de données de positionnement d'obstacles relativement à l'engin ;  receiving obstacle positioning data relating to the machine;
- détermination, en fonction des données reçues et pour une pluralité de zones positionnées par rapport à l'engin, de valeurs de mesure respectivement représentatives d'une vraisemblance d'occupation de la zone concernée, d'une vraisemblance de non-occupation de la zone concernée et d'une vraisemblance de non-connaissance de la zone concernée ;  determination, based on the data received and for a plurality of zones positioned with respect to the machine, of measurement values respectively representative of a likelihood of occupation of the zone concerned, of a likelihood of non-occupation of the concerned area and a likelihood of non-knowledge of the area concerned;
- construction, pour chaque zone de ladite pluralité de zones de l'environnement, de valeurs respectivement représentatives d'une vraisemblance d'occupation de la zone concernée, d'une vraisemblance de non-occupation de la zone concernée et d'une vraisemblance de non-connaissance de la zone concernée ;  constructing, for each zone of said plurality of zones of the environment, respectively representative values of a likelihood of occupation of the zone concerned, a likelihood of non-occupation of the zone concerned and a likelihood of lack of knowledge of the area concerned;
- localisation de l'engin par détermination du positionnement de l'engin dans l'environnement qui maximise une mesure de correspondance entre les valeurs de mesure et les valeurs construites.  - Locating the machine by determining the positioning of the machine in the environment that maximizes a measure of correspondence between the measured values and the constructed values.
Ce procédé peut éventuellement comprendre en outre une étape de combinaison desdites valeurs de mesure relatives à la zone concernée et de valeurs construites par le module de cartographie pour la zone concernée lors d'une précédente itération afin de générer des valeurs brutes respectivement représentatives d'une vraisemblance d'occupation de la zone concernée, d'une vraisemblance de non-occupation de la zone concernée, d'une vraisemblance de non-connaissance de la zone concernée et d'une vraisemblance de conflit sur la zone concernée.  This method may optionally further comprise a step of combining said measurement values relative to the area concerned and of values constructed by the mapping module for the area concerned during a previous iteration in order to generate raw values respectively representative of a given region. likelihood of occupation of the area concerned, a likelihood of non-occupation of the area concerned, a likelihood of non-knowledge of the area concerned and a likelihood of conflict in the area concerned.
Les caractéristiques optionnelles présentées ci-dessus relative au dispositif de localisation et de cartographie peuvent également s'appliquer à de tels procédés.  The optional features presented above relating to the locating and mapping device can also be applied to such methods.
DESCRIPTION DÉTAILLÉE D'UN EXEMPLE DE RÉALISATION La description qui va suivre en regard des dessins annexés, donnés à titre d'exemples non limitatifs, fera bien comprendre en quoi consiste l'invention et comment elle peut être réalisée. Sur les dessins annexés : DETAILED DESCRIPTION OF AN EXEMPLARY EMBODIMENT The following description with reference to the accompanying drawings, given by way of non-limiting examples, will make it clear what the invention consists of and how it can be implemented. In the accompanying drawings:
- la figure 1 représente un système comprenant un capteur et un exemple de dispositif de localisation et de cartographie conforme à l'invention ;  FIG. 1 represents a system comprising a sensor and an exemplary localization and mapping device according to the invention;
- la figure 2 représente sous forme fonctionnelle les traitements effectués par le dispositif de localisation et de cartographie de la figure 1 ;  FIG. 2 represents in functional form the processes performed by the localization and mapping device of FIG. 1;
- la figure 3 représente une grille polaire construite à partir des données de positionnement reçues du capteur.  FIG. 3 represents a polar grid constructed from the positioning data received from the sensor.
La figure 1 représente schématiquement les éléments principaux d'un système incluant un dispositif de localisation et de cartographie 10.  FIG. 1 schematically represents the main elements of a system including a locating and mapping device 10.
Un tel système équipe un engin mobile dans un environnement, par exemple un véhicule automobile ou un robot. Comme cela ressortira de la description qui suit, un système équipé d'un dispositif de localisation et de cartographie, parfois dénommé SLAM (acronyme anglo-saxon signifiant "Simultaneous Localisation And Mapping"), permet à la fois la localisation du système (et donc de l'engin mobile) dans l'environnement et la découverte de la cartographie de l'environnement.  Such a system equips a mobile machine in an environment, for example a motor vehicle or a robot. As will be apparent from the description which follows, a system equipped with a localization and mapping device, sometimes called SLAM (Anglo-Saxon acronym meaning "Simultaneous Location And Mapping"), allows both the location of the system (and therefore mobile gear) in the environment and the discovery of environmental mapping.
Le système de la figure 1 comprend un capteur 2 qui génère des données de positionnement (relativement au système) d'obstacles présents dans l'environnement. Le capteur 2 est par exemple de type lidar ; dans ce cas, les données de positionnement sont représentatives, pour une pluralité d'orientations a par rapport à une direction de référence du système, de la distance d(a) (par rapport au système) du premier obstacle rencontré dans la direction associé à cette orientation a.  The system of FIG. 1 comprises a sensor 2 which generates positioning data (relative to the system) of obstacles present in the environment. The sensor 2 is for example lidar type; in this case, the positioning data are representative, for a plurality of orientations with respect to a reference direction of the system, of the distance d (a) (with respect to the system) of the first obstacle encountered in the direction associated with this orientation a.
On pourrait en variante utiliser un capteur d'un autre type, par exemple un radar.  One could alternatively use a sensor of another type, for example a radar.
Le système de la figure 1 comprend également le dispositif de localisation et de cartographie 10, qui reçoit en entrée les données de positionnement générées par le capteur 2 et génère en sortie des informations de localisation Xt du système (et donc de l'engin mobile équipé du système) à chaque instant t et des informations de cartographie GRI. The system of FIG. 1 also comprises the locating and mapping device 10, which receives as input the positioning data generated by the sensor 2 and generates at the output location information X t of the system (and therefore of the mobile machine equipped with the system) at each moment t and GRI mapping information.
Ces informations de cartographie GRI sont par exemple une grille d'occupation (en anglais "occupancy grid") qui décrit, sous forme de grille, les lieux de l'environnement dans lesquels un obstacle a été détecté.  This GRI mapping information is for example an occupancy grid which describes, in the form of a grid, the locations of the environment in which an obstacle has been detected.
Dans le cas décrit ici où l'environnement est cartographié en 2 dimensions, les informations de localisation Xt comprennent par exemple les coordonnées x,y du système dans le plan de cartographie (précisément son abscisse x et son ordonnée y) et son cap Θ (en anglais "heading"). Ces informations de localisation X sont déterminées comme décrit ci-dessous par rapport à des coordonnées initiales x0,yo et un cap initial θ0 définis par convention (on prend par exemple x0 = 0 ; y0 = 0 ; θ0 = 0). In the case described here where the environment is mapped in 2 dimensions, the location information X t include for example the x, y coordinates of the system in the mapping plane (precisely its x-coordinate and its y-coordinate) and its heading Θ (in English "heading"). This location information X is determined as described below with respect to initial coordinates x 0 , y o and an initial heading θ 0 defined by convention (for example, x 0 = 0; y 0 = 0; θ 0 = 0).
Afin de mettre en œuvre les traitements décrits ci-dessous, le dispositif de localisation et de cartographie 10 comprend ici un processeur 4 (par exemple un microprocesseur) et un moyen de mémorisation 6 (par exemple un disque dur).  In order to implement the processes described below, the locating and mapping device 10 here comprises a processor 4 (for example a microprocessor) and a storage means 6 (for example a hard disk).
Le processeur 4 est conçu pour mettre en œuvre les traitements décrits ci-dessous, notamment en référence à la figure 2, par exemple du fait de l'exécution d'instructions de programme d'ordinateur mémorisées dans les moyens de mémorisation 6. En variante, ces traitements pourraient être effectués par un circuit intégré à application spécifique (ou ASIC de l'anglais "Application Spécifie Integrated Circuit') implanté dans le dispositif de localisation et de cartographie 10.  The processor 4 is designed to implement the processes described below, in particular with reference to FIG. 2, for example because of the execution of computer program instructions stored in the storage means 6. In a variant these processing could be carried out by a specific application integrated circuit (or ASIC of the "Application Specifies Integrated Circuit") implanted in the locating and mapping device 10.
Les moyens de mémorisation 6 permettent par ailleurs la mémorisation des données utilisées lors du traitement décrit ci-après, notamment les données représentatives de vraisemblances ou crédibilités, dénommées "masses" dans la suite.  The storage means 6 also allow the storage of the data used during the processing described below, in particular the data representative of likelihoods or credibilities, hereinafter called "masses".
La figure 2 représente sous forme fonctionnelle les traitements effectués par le dispositif de localisation et de cartographie 10 afin de déterminer les informations de localisation Xt et les informations de cartographie GRI à partir des données de positionnement d(a) générées par le capteur 2. FIG. 2 represents in functional form the processes carried out by the locating and mapping device 10 in order to determine the location information X t and the mapping information GRI from the positioning data d (a) generated by the sensor 2.
Ainsi, les différents traitements réalisés par le dispositif de localisation et de cartographie 10 sont représentés sur la figure 2 mis en œuvre par différents modules 1 1 , 12, 14, 1 6, 18, 20, 22 bien que ceux-ci puissent être mis en œuvre en pratique du fait de l'exécution d'instructions par le même processeur 4.  Thus, the various treatments performed by the locating and mapping device 10 are shown in FIG. 2 implemented by different modules 1 1, 12, 14, 1 6, 18, 20, 22 although these can be set implemented in practice because of the execution of instructions by the same processor 4.
Le dispositif de localisation et de cartographie 10 comprend un module de réception 1 1 connecté au capteur 2 et qui reçoit ainsi les données de positionnement d(a) générées par le capteur 2 et les transmet à un module de construction de grille polaire 12.  The locating and mapping device 10 comprises a reception module 1 1 connected to the sensor 2 and which thus receives the positioning data d (a) generated by the sensor 2 and transmits them to a polar grid construction module 12.
En fonction des données de positionnement d(a) qu'il reçoit en entrée à un instant t, le module de construction de grille polaire 12 détermine, pour chacune des cellules j d'une grille polaire, les trois paramètres suivants : According to the positioning data d (a) that it receives as input at a time t, the polar grid construction module 12 determines, for each of the cells j of a polar grid, the three following parameters:
- une masse d'occupation M_POLt,j(0) (en anglais "occupation mass") ;an occupancy mass M_POL t, j (0) (in English "occupation mass");
- une masse de non-occupation M_POLt,j(F) (en anglais "free mass") ;a mass of non-occupation M_POL t, j (F) (in English "free mass");
- une masse de non-connaissance M_POLt,j(U) (en anglais "unknown mass"). a mass of non-knowledge M_POL t, j (U) (in English "unknown mass").
Pour chaque cellule j, la somme des différentes masses relatives à cette cellule est égale à 1 .  For each cell j, the sum of the different masses relating to this cell is equal to 1.
Comme représenté en figure 3, une grille polaire est un ensemble de cellules de l'environnement (ici représenté en deux dimensions) dans lequel chaque cellule correspond à une plage donnée de distances au système (précisément au capteur 2) et à un secteur angulaire donné (les angles étant mesurés par rapport à la direction de référence du système déjà mentionnée).  As shown in FIG. 3, a polar grid is a set of cells of the environment (here represented in two dimensions) in which each cell corresponds to a given range of distances to the system (specifically to sensor 2) and to a given angular sector. (the angles being measured with respect to the reference direction of the system already mentioned).
La masse d'occupation M_POLt,j(0) représente la possibilité que la cellule j concernée dans la grille polaire soit occupée, d'après certaines informations, ici les données de positionnement reçues du capteur 2 à l'instant t. La masse d'occupation M_POLt,j(0) est donc représentative d'une vraisemblance ou crédibilité d'occupation de cette cellule j. The occupancy mass M_POL t, j (0) represents the possibility that the cell j concerned in the polar grid is occupied, according to some information, here the positioning data received from the sensor 2 at time t. The occupation mass M_POL t , j (0) is therefore representative of a likelihood or credibility of occupation of this cell j.
La masse de non-occupation M_POLt,j(F) représente la possibilité que la cellule j concernée dans la grille polaire soit vide, d'après certaines informations, ici les données de positionnement reçues du capteur 2 à l'instant t. La masse de non-occupation M_POLt,j(F) est donc représentative d'une vraisemblance ou crédibilité de non-occupation de cette cellule j. The non-occupation mass M_POL t, j (F) represents the possibility that the cell j concerned in the polar grid is empty, according to some information, here the positioning data received from the sensor 2 at time t. The non-occupation mass M_POL t , j (F) is therefore representative of a likelihood or credibility of non-occupation of this cell j.
La masse de non-connaissance M_POLt,j(U) représente la possibilité que la cellule j concernée n'ait pas été explorée, c'est-à-dire qu'aucune connaissance ne soit disponible pour cette cellule j d'après les informations disponibles (ici les données de positionnement). La masse de non-connaissance M_POLt,j(U) est donc représentative d'une vraisemblance ou crédibilité de non- connaissance de la cellule j. The mass of non-knowledge M_POL t, j (U) represents the possibility that the cell j concerned has not been explored, that is to say that no knowledge is available for this cell according to the information available (here the positioning data). The mass of non-knowledge M_POL t, j (U) is therefore representative of a likelihood or credibility of non-knowledge of the cell j.
Pour les cellules j situées dans le secteur angulaire correspondant à une direction Θ, on détermine par exemple comme suit les différentes masses :  For cells j situated in the angular sector corresponding to a direction Θ, the following are for example determined as follows:
- pour la cellule j (noircie en figure 3) située à une distance d(6) du système (c'est-à-dire, dans le cas où le capteur 2 est un lidar, celle où un objet a été impacté par le laser représenté en pointillés en figure 3),  for the cell j (blackened in FIG. 3) located at a distance d (6) from the system (that is to say, in the case where the sensor 2 is a lidar, the one where an object has been impacted by the laser shown in dashed lines in FIG.
M_POLt,j(0) = I CONF, M_POLt,j(F) = 0, M_POLt,j(U) = 1 - ICONF, OÙ ICONF est un indice de confiance du capteur 2 (par exemple prédéfini ou délivré par le capteur 2), typiquement compris entre 0,5 et 1 ; M_POL t, j (0) = I CONF, M_POL t, j (F) = 0, M_POL t, j (U) = 1 - ICONF, WHERE I CONF is a confidence index of the sensor 2 (for example predefined or delivered by the sensor 2), typically between 0.5 and 1;
- pour les cellules j situées à une distance inférieure à la distance d(6) (c'est-à-dire celles traversées par le laser dans le cas du lidar),
Figure imgf000010_0001
for cells j situated at a distance less than the distance d (6) (that is to say those traversed by the laser in the case of lidar),
Figure imgf000010_0001
- pour les cellules j situées à une distance supérieure à la distance d(6) (c'est-à-dire celles situées au-delà de l'impact du laser dans le cas du lidar, représentées hachurées en figure 3),
Figure imgf000010_0002
for cells j located at a distance greater than the distance d (6) (that is to say those situated beyond the impact of the laser in the case of the lidar, represented hatched in FIG. 3),
Figure imgf000010_0002
Lorsque le capteur délivre plusieurs données de positionnement d(6) pour un même secteur angulaire de la grille polaire (par exemple lorsque le lidar délivre des données pour plusieurs altitudes ou couches, ou lorsque la résolution du lidar est plus fine que celle de la grille polaire), on retient par exemple la distance d(6) la plus faible pour la détermination des masses telle que décrite ci- dessus.  When the sensor delivers several positioning data d (6) for the same angular sector of the polar grid (for example when the lidar delivers data for several altitudes or layers, or when the resolution of the lidar is thinner than that of the grid polar), for example, the smallest distance d (6) for the determination of masses as described above is retained.
Le module de construction de grille polaire 12 transmet l'ensemble des paramètres de masse M_POLt,j ainsi déterminés à un module de conversion 14 qui attribue, pour chaque cellule j de la grille polaire, les masses déterminées pour cette cellule j à une (ou plusieurs) cellule(s) correspondante(s) i d'une grille de mesure en coordonnées cartésiennes (exprimées relativement à la position actuelle du système à l'instant t). The polar grid construction module 12 transmits all the mass parameters M_POL t, j thus determined to a conversion module 14 which assigns, for each cell j of the polar gate, the masses determined for this cell j to one ( or more) corresponding cell (s) i of a measurement grid in Cartesian coordinates (expressed relative to the current position of the system at time t).
Autrement dit, pour tout
Figure imgf000010_0003
lorsque la cellule i de la grille de mesure correspond à la cellule j de la grille polaire.
In other words, for everything
Figure imgf000010_0003
when the cell i of the measurement grid corresponds to the cell j of the polar grid.
On définit ainsi pour chaque cellule i de la grille de mesure :  We thus define for each cell i of the measurement grid:
- une masse d'occupation M_SCANt,j(O) pour la cellule i, représentant la vraisemblance (ou crédibilité) d'occupation de la cellule i (d'après les données de positionnement fournies par le capteur 2 à l'instant t) ; an occupancy mass M_SCAN t, j (O) for the cell i, representing the likelihood (or credibility) of occupation of the cell i (according to the positioning data provided by the sensor 2 at time t );
- une masse de non-occupation M_SCANt,j(F) pour la cellule i, représentant la vraisemblance de non-occupation de la cellule i (d'après les données de positionnement fournies par le capteur 2 à l'instant t) ; a non-occupation mass M_SCAN t, j (F) for the cell i, representing the likelihood of non-occupation of the cell i (according to the positioning data provided by the sensor 2 at time t);
- une masse de non-connaissance M_SCANt,j(U) pour la cellule i, représentant la vraisemblance de non-connaissance de la cellule i (d'après les données de positionnement fournies par le capteur 2 à l'instant t). a mass of non-knowledge M_SCAN t, j (U) for cell i, representing the likelihood of non-knowledge of cell i (according to the positioning data provided by sensor 2 at time t).
Pour chaque cellule i, la somme des différentes masses relatives à cette cellule est égale à 1 . For each cell i, the sum of the different masses relating to this cell is equal to 1.
On dénomme ici "module de traitement" l'ensemble formé par le module de construction de grille polaire 12 et le module de conversion 14. Le module de traitement permet ainsi de déterminer les masses M_SCANt,j(A) à partir des données de positionnement d(θ). Here, the term "processing module" is used to denote the assembly formed by the polar grid construction module 12 and the conversion module 14. The processing module thus makes it possible to determine the masses M_SCAN t, j (A) from the data of FIG. positioning d (θ).
Comme visible en figure 2, les différentes masses M_SCANt,j(A) (avec A€{O,F,U}) produites par le module de conversion 1 6 pour les différentes cellules i de la grille de mesure sont transmises d'une part à un module de localisation 1 6 et d'autre part à un module de combinaison 18. As can be seen in FIG. 2, the different masses M_SCAN t, j (A) (with A € {O, F, U}) produced by the conversion module 1 6 for the different cells i of the measurement grid are transmitted from a part to a location module 1 6 and secondly to a combination module 18.
Le module de localisation 1 6 reçoit également en entrée les informations suivantes, produites par le module de combinaison 18 et le module de normalisation 20 à l'itération précédente t-1 (comme expliqué ci-après pour l'itération courante t) et relatives aux cellules k d'une grille représentant l'environnement (en coordonnées cartésiennes par rapport à une référence fixe, telle que la position initiale du système) :  The location module 1 6 also receives as input the following information produced by the combination module 18 and the normalization module 20 at the previous iteration t-1 (as explained hereinafter for the current iteration t) and relative to the cells k of a grid representing the environment (in Cartesian coordinates with respect to a fixed reference, such as the initial position of the system):
- pour chaque cellule k, une masse d'occupation M_GRIt-1,k(0), représentant la vraisemblance d'occupation de la cellule k, construite par le dispositif 10 du fait du traitement effectué jusqu'à l'instant t-1 ; for each cell k, an occupation mass M_GRI t-1 , k (0), representing the likelihood of occupation of the cell k, constructed by the device 10 due to the processing carried out up to the instant t- 1;
- pour chaque cellule k, une masse de non-occupation M_GRIt- 1,k(F), représentant la vraisemblance de non-occupation de la cellule k, construite par le dispositif 10 du fait du traitement effectué jusqu'à l'instant t-1 ; for each cell k, a non-occupation mass M_GRI t-1 , k (F), representing the likelihood of non-occupation of the cell k, constructed by the device 10 due to the processing carried out up to the moment t-1;
- pour chaque cellule k, une masse de non-connaissance M_GRIt- 1,k(U), représentant la vraisemblance de non-connaissance de la cellule k, construite par le dispositif 10 du fait du traitement effectué jusqu'à l'instant t-1 . for each cell k, a mass of non-knowledge M_GRI t-1 , k (U), representing the likelihood of non-knowledge of the cell k, constructed by the device 10 due to the processing carried out up to the moment t-1.
On remarque que ces informations ne sont pas disponibles lors de la première itération. Aucun traitement n'est toutefois nécessaire lors de cette première itération : le module de localisation 1 6 indique seulement alors que la position courante (définie par les coordonnées x,y et le cap Θ) est égale à la position initiale déjà mentionnée (définie par les coordonnées x0, yo et par le cap θο). Note that this information is not available during the first iteration. However, no processing is necessary during this first iteration: the location module 1 6 then only indicates that the current position (defined by the coordinates x, y and heading Θ) is equal to the initial position already mentioned (defined by the coordinates x 0 , y o and by the heading θο).
Pour les autres itérations, le module de localisation 1 6 détermine la position Xt du système (et donc de l'engin mobile), définie ici par les coordonnées x, y et le cap Θ, qui maximise une mesure de correspondance entre les valeurs associées à la grille de mesure (localisée par rapport à la position du système) et les valeurs associées à la grille fixe représentant l'environnement. For the other iterations, the location module 1 6 determines the position X t of the system (and therefore of the mobile machine), defined here by the coordinates x, y and the heading Θ, which maximizes a measurement of correspondence between the values associated with the measurement grid (located in relation to the position of the system) and the values associated with the fixed grid representing the environment.
On utilise par exemple la mesure suivante pour ce faire, définie pour une position Z par :
Figure imgf000012_0001
For example, the following measurement is used for this purpose, defined for a Z position by:
Figure imgf000012_0001
où i(k,Z) est la cellule de la grille de mesure (positionnée relativement au système, c'est-à-dire à l'engin mobile comme déjà indiqué) correspondant à la cellule k de la grille fixe lorsque le système a la position Z et où Mt,k,z(C) mesure le conflit entre les informations utilisées au numérateur :
Figure imgf000012_0002
where i (k, Z) is the cell of the measurement grid (positioned relative to the system, that is to say to the mobile machine as already indicated) corresponding to the cell k of the fixed gate when the system has the Z position and where M t, k, z (C) measures the conflict between the information used in the numerator:
Figure imgf000012_0002
On utilise ainsi une mesure de correspondance qui quantifie une correspondance entre une répartition spatiale (au sein des cellules) des vraisemblances d'occupation dans la grille de mesure et une répartition spatiale des vraisemblances d'occupation dans la grille fixe.  A correspondence measurement is thus used which quantifies a correspondence between a spatial distribution (within the cells) of the occupation likelihoods in the measurement grid and a spatial distribution of the occupation likelihoods in the fixed grid.
L'utilisation du dénominateur (1 - Mt,k,z(C)) permet de pondérer dans la somme des cellules pour lesquelles les informations utilisées au numérateur sont contradictoires afin d'en tenir compte à bon escient. The use of the denominator (1 - M t, k, z (C)) makes it possible to weight in the sum of the cells for which the information used in the numerator is contradictory in order to take it into account wisely.
En variante, on pourrait utiliser, pour chaque terme de la somme mentionnée ci-dessus, un autre opérateur de fusion afin de combiner les masses M_GRIt-1 ,k reçues du module de combinaison 18 (via le module de normalisation 20) et les masses M_SCANt,j(k,z) reçues du module de conversion 14, par exemple un opérateur de fusion tel que ceux utilisés dans le cadre de la théorie de l'évidence (également dénommée théorie de Dempster-Shafer). As a variant, it would be possible to use, for each term of the sum mentioned above, another fusion operator in order to combine the masses M_GRI t-1, k received from the combination module 18 (via the normalization module 20) and the M_SCAN masses t, j (k, z) received from the conversion module 14, for example a fusion operator such as those used in the context of the theory of evidence (also called Dempster-Shafer theory).
La valeur XT délivrée par le module de localisation 16 est donc dans ce cas la valeur de Z qui maximise la mesure N(Z) : X est tel que N(X) = maxz N(Z). The value X T delivered by the location module 16 is therefore in this case the value of Z which maximizes the measurement N (Z): X is such that N (X) = maxz N (Z).
Ceci est par exemple déterminé en pratique en calculant la mesure N(Z) pour une pluralité de positions Z. On note dans la suite zx, zy, ζθ respectivement l'abscisse, l'ordonnée et le cap définissant une position Z. This is for example determined in practice by calculating the measurement N (Z) for a plurality of Z positions. In the following, z x , z y , ζ θ are respectively denoted by the abscissa, the ordinate and the heading defining a Z position. .
Selon une première possibilité de réalisation, on calcule la mesure N(Z) pour un ensemble (discret) de positions Z vérifiant :
Figure imgf000012_0003
According to a first embodiment, the measurement N (Z) is calculated for a (discrete) set of Z positions verifying:
Figure imgf000012_0003
où xt-1 , yt-1 , Θt-1 sont l'abscisse, l'ordonnée et le cap définissant la position Xt-1 déterminée à l'itération précédente (ou l'abscisse, l'ordonnée et le cap initiaux lors de l'itération t=1 ) et où Sx, Sy, Sθ sont des seuils prédéterminés. En exprimant les coordonnées en nombre de pas de la grille fixe (les cellules étant ici de même taille dans la grille fixe et dans la grille de mesure) - ou en degrés pour le cap, on utilise par exemple Sx = Sy = 5 et Sθ = 10° et : where x t-1 , y t-1 , Θ t-1 are the abscissa, the ordinate and the heading defining the position X t-1 determined at the preceding iteration (or the abscissa, the ordinate and the initial captions during the iteration t = 1) and where S x , S y , S θ are predetermined thresholds. By expressing the coordinates in number of steps of the fixed grid (the cells being here of the same size in the fixed grid and in the measuring grid) - or in degrees for the heading, we use for example S x = S y = 5 and S θ = 10 ° and:
Figure imgf000013_0001
Figure imgf000013_0001
soit un calcul de la mesure N(Z) pour 1331 positions possibles Z.  a calculation of the measure N (Z) for 1331 possible positions Z.
Selon une seconde possibilité de réalisation, on utilise une position a priori
Figure imgf000013_0007
dérivée de la position
Figure imgf000013_0008
déterminée à l'itération précédente sur la base d'un modèle à vitesse constante :
Figure imgf000013_0002
According to a second embodiment, a priori position is used
Figure imgf000013_0007
derived from the position
Figure imgf000013_0008
determined at the previous iteration on the basis of a constant speed model:
Figure imgf000013_0002
où est la dérivée de la position Xt-1 à l'instant t-1where is the derivative of the position X t-1 at time t-1
Figure imgf000013_0009
Figure imgf000013_0005
Figure imgf000013_0009
Figure imgf000013_0005
On peut alors calculer la mesure N(Z) pour un ensemble (discret) de positions Z vérifiant :
Figure imgf000013_0003
We can then calculate the measure N (Z) for a (discrete) set of Z positions verifying:
Figure imgf000013_0003
où Sx, Sy, Sθ sont des seuils prédéterminés. where S x , S y , S θ are predetermined thresholds.
En exprimant les coordonnées en nombre de pas de la grille fixe (les cellules étant ici de même taille dans la grille fixe et dans la grille de mesure), on utilise par exemple Sx = Sy = 5 et Sθ = 10° et : By expressing the coordinates in number of steps of the fixed gate (the cells being here of the same size in the fixed gate and in the measuring gate), for example S x = S y = 5 and S θ = 10 ° are used. :
Figure imgf000013_0004
Figure imgf000013_0004
soit un calcul de la mesure N(Z) pour 1331 positions possibles Z autour de la position a priori déterminée sur la base d'un modèle à vitesse
Figure imgf000013_0006
a calculation of the measurement N (Z) for 1331 possible positions Z around the position a priori determined on the basis of a speed model
Figure imgf000013_0006
constante.  constant.
On pourra se référer à ce sujet à l'article "A real-time robust SLAM for large-scale outdoor environments", de J. Xie, F. Nashashibi, M. N. Parent et O. Garcia-Favrot in ITS World Congr. 2010. La position Xt déterminée par le module de localisation 1 6 est transmise au module de combinaison 18, qui reçoit également en entrée comme déjà indiqué les différentes masses produites par le
Figure imgf000014_0005
Reference can be made to this topic in the article "A real-time robust SLAM for large-scale outdoor environments" by J. Xie, F. Nashashibi, MN Parent and O. Garcia-Favrot in ITS World Congress. 2010. The position X t determined by the locator module 1 6 is transmitted to the combination module 18, which also receives as input as already indicated the different masses produced by the
Figure imgf000014_0005
module de conversion 14 pour les différentes cellules i de la grille de mesure, ainsi que les différentes masses produites comme
Figure imgf000014_0006
conversion module 14 for the different cells i of the measurement grid, as well as the different masses produced as
Figure imgf000014_0006
expliqué ci-dessus par le module de normalisation 20 à l'itération précédente t-1 pour les cellules k de la grille fixe.  explained above by the normalization module 20 at the previous iteration t-1 for the cells k of the fixed gate.
Le module de combinaison 18 combine alors les informations fournies par le capteur 2 à l'instant t (représentées par les masses M_SCANt,i(A)) et les informations construites par le dispositif 10 jusqu'à l'instant t-1 (représentées par les masses M_GRIt-1 ,k(A)) afin d'en déduire des masses brutes M_COMBt,k(A) représentatives de l'état de la connaissance de la grille fixe à l'instant t, par exemple en appliquant à chaque cellule k de la grille fixe une formule du type :
Figure imgf000014_0001
The combination module 18 then combines the information provided by the sensor 2 at the instant t (represented by the masses M_SCAN t, i (A)) and the information constructed by the device 10 up to the instant t-1 ( represented by the masses M_GRI t-1, k (A)) in order to derive from them raw masses M_COMB t, k (A) representative of the state of knowledge of the fixed gate at time t, for example in applying to each cell k of the fixed grid a formula of the type:
Figure imgf000014_0001
où i(k,Xt) est la cellule de la grille de mesure qui correspond à la cellule k de la grille fixe lorsque le système est à la position Xt et où est un opérateur de
Figure imgf000014_0007
where i (k, X t ) is the cell of the measurement grid which corresponds to the cell k of the fixed gate when the system is at the position X t and where is a
Figure imgf000014_0007
conjonction défini par exemple dans l'article "Credibilist occupancy grids for vehicle perception in dynamic environments", de J. Moras, V. Cherfaoui et P. Bonnifait in IEEE Int. Conf. Robot. Automat. (ICRA201 1 ), pages 84-89, 201 1 .  Conjunction defined for example in the article "Credibilist occupancy grids for vehicle perception in dynamic environments", J. Moras, V. Cherfaoui and P. Bonnifait in IEEE Int. Conf. Robot. Automat. (ICRA201 1), pages 84-89, 201 1.
En explicitant les calculs effectués du fait de cet opérateur on obtient
Figure imgf000014_0008
By explaining the calculations made because of this operator we obtain
Figure imgf000014_0008
ainsi pour chaque cellule k :  so for each cell k:
- une masse brute d'occupation M_COMBt,k(O), représentant la vraisemblance d'occupation de la cellule k, ici par : a raw mass of occupation M_COMB t, k (O), representing the likelihood of occupation of the cell k, here by:
Figure imgf000014_0002
Figure imgf000014_0002
- une masse brute de non-occupation M_COMBt,k(F), représentant la vraisemblance de non-occupation de la cellule k, ici par :
Figure imgf000014_0003
a non-occupation gross mass M_COMB t, k (F), representing the likelihood of non-occupation of the cell k, here by:
Figure imgf000014_0003
- une masse brute de non-connaissance M_COMBt,k(U), représentant la vraisemblance de non-connaissance de la cellule k, ici par :
Figure imgf000014_0004
- une masse brute de conflit M_COMBt,k(C), représentant une vraisemblance de conflit à propos de cette cellule k (entre l'information délivrée par le capteur 2 et l'information construite par le dispositif 10 jusqu'à l'instant t-1 ), ici par :
Figure imgf000015_0001
a gross mass of non-knowledge M_COMB t, k (U), representing the likelihood of non-knowledge of the cell k, here by:
Figure imgf000014_0004
a raw mass of conflict M_COMB t, k (C), representing a likelihood of conflict about this cell k (between the information delivered by the sensor 2 and the information constructed by the device 10 until the instant t-1), here by:
Figure imgf000015_0001
Pour chaque cellule k, la somme des différentes masses brutes relatives à cette cellule est égale à 1 .  For each cell k, the sum of the different raw masses relating to this cell is equal to 1.
Les masses brutes M_COMBt,k produites par le module de combinaison 18 sont transmises au module de normalisation 20 qui conserve (dans chaque cellule) la répartition des masses d'occupation, de non-occupation et de non- connaissance mais fait disparaître la notion de masse de conflit, ce qui permet de s'affranchir des obstacles mobiles. Selon un mode de réalisation envisageable, les masses brutes de conflit M_COMBt,k(C) pour les différentes cellules k peuvent être mémorisées afin d'être utilisées en vue de la détection des obstacles mobiles. The raw masses M_COMB t, k produced by the combination module 18 are transmitted to the normalization module 20 which retains (in each cell) the distribution of the masses of occupation, non-occupation and non-knowledge but eliminates the notion of mass of conflict, which makes it possible to free oneself from moving obstacles. According to one conceivable embodiment, the conflict raw masses M_COMB t, k (C) for the different cells k can be stored in order to be used for the detection of moving obstacles.
Le module de normalisation 20 calcule ainsi les masses suivantes (après normalisation) :
Figure imgf000015_0002
The normalization module 20 thus calculates the following masses (after normalization):
Figure imgf000015_0002
pour toutes les cellules k.  for all cells k.
On obtient ainsi pour chaque cellule k une masse d'occupation We thus obtain for each cell k a mass of occupation
M_GRIt,k(0), une masse de non-occupation M_GRIt,k(F) et une masse de non- connaissance M_GRIt,k(U), qui constituent ici les informations de cartographie GRI délivrées par le dispositif 10. Grâce à la normalisation, pour chaque cellule k, la somme des différentes masses
Figure imgf000015_0003
relatives à cette cellule est égale à 1 .
M_GRI t, k (0), a non-occupancy mass M_GRI t, k (F) and a mass of non-knowledge M_GRI t, k (U), which here constitute the mapping information GRI delivered by the device 10. Thanks to the normalization, for each cell k, the sum of the different masses
Figure imgf000015_0003
relating to this cell is equal to 1.
On dénomme ici "module de cartographie" l'ensemble formé par le module de combinaison 18 et le module de normalisation 20.  Here, the term "mapping module" refers to the assembly formed by the combination module 18 and the normalization module 20.
On peut alors par exemple représenter ces informations sur une carte (affichée par exemple sur un écran de l'engin mobile), éventuellement en faisant apparaître chaque cellule k dans une couleur définie en fonction des masses
Figure imgf000015_0004
relatives à cette cellule k ; on utilise par exemple pour une cellule k une couleur dont les coordonnées trichromatiques dans le repère RVB sont
Figure imgf000015_0005
We can then for example represent this information on a map (displayed for example on a screen of the mobile machine), possibly by showing each cell k in a color defined according to the masses.
Figure imgf000015_0004
relating to this cell k; for example, for a cell k, a color is used whose trichromatic coordinates in the reference frame RGB are
Figure imgf000015_0005
Comme déjà indiqué, les masses M_GRIt,k produites en sortie du module de normalisation 20 sont transmises (à travers un retardateur d'une itération 22) au module de localisation 1 6 et au module de combinaison 18 afin d'y être utilisées à l'itération suivante. As already indicated, the masses M_GRI t, k produced at the output of the module 20 are transmitted (through a delay of an iteration 22) to the location module 1 6 and the combination module 18 to be used at the next iteration.

Claims

REVENDICATIONS
1 . Dispositif de localisation et de cartographie (10) destiné à équiper un engin mobile dans un environnement comprenant une pluralité de zones, avec : 1. Locating and mapping device (10) for equipping a mobile machine in an environment comprising a plurality of zones, with:
- un module de réception (1 1 ) conçu pour recevoir des données de positionnement (d(a)) d'obstacles relativement à l'engin ;  - a receiving module (1 1) designed to receive positioning data (d (a)) obstacles relative to the machine;
- un module de traitement (12, 14) conçu pour déterminer, en fonction des données reçues (d(a)) et pour une pluralité de zones positionnées par rapport à l'engin, des valeurs de mesure (M_SCANt,j) respectivement représentatives d'une vraisemblance d'occupation de la zone concernée, d'une vraisemblance de non-occupation de la zone concernée et d'une vraisemblance de non- connaissance de la zone concernée ; - a processing module (12, 14) designed to determine, based on the data received (d (a)) and for a plurality of zones positioned relative to the machine, measurement values (M_SCAN t, j ) respectively representative of a likelihood of occupation of the area concerned, a likelihood of non-occupation of the area concerned and a likelihood of non-knowledge of the area concerned;
- un module de cartographie (18, 20) conçu pour construire, pour chaque zone de ladite pluralité de zones de l'environnement, des valeurs (M_GRIt,k) respectivement représentatives d'une vraisemblance d'occupation de la zone concernée, d'une vraisemblance de non-occupation de la zone concernée et d'une vraisemblance de non-connaissance de la zone concernée ; et a mapping module (18, 20) designed to construct, for each zone of said plurality of zones of the environment, values (M_GRI t , k ) respectively representative of a likelihood of occupation of the zone concerned, d a likelihood of non-occupation of the area concerned and a likelihood of non-knowledge of the area concerned; and
- un module de localisation (1 6) conçu pour déterminer le positionnement de l'engin dans l'environnement qui maximise une mesure de correspondance entre les valeurs de mesure (M_SCANt,j) et les valeurs construites (M_GRIt,k)- a locating module (1 6) designed to determine the positioning of the machine in the environment which maximizes a measurement of correspondence between the measured values (M_SCAN t, j ) and the constructed values (M_GRI t , k) -
2. Dispositif de localisation et de cartographie selon la revendication 1 , dans lequel le module de localisation (1 6) est conçu pour déterminer la mesure de correspondance en utilisant une mesure de conflit entre les valeurs de mesure (M_SCANt,j) et les valeurs construites (M_GRIt,k). A locator and mapping device according to claim 1, wherein the locator module (1 6) is adapted to determine the mapping measure using a measure of conflict between the measured values (M_SCAN t, j ) and the constructed values (M_GRI t, k ).
3. Dispositif de localisation et de cartographie selon la revendication 1 ou 2, dans lequel la mesure de correspondance est indicative d'une correspondance entre une répartition spatiale des valeurs de mesure (M_SCANt,j) représentatives de la vraisemblance d'occupation et une répartition spatiale des valeurs construites (M_GRIt,k) représentatives de la vraisemblance d'occupation. A locating and mapping device according to claim 1 or 2, wherein the correspondence measure is indicative of a correspondence between a spatial distribution of the measured values (M_SCAN t, j ) representative of the likelihood of occupancy and a spatial distribution of the constructed values (M_GRI t , k ) representative of the likelihood of occupation.
4. Dispositif de localisation et de cartographie selon l'une des revendications 1 à 3, dans lequel le module de localisation (1 6) est conçu pour déterminer la mesure de correspondance pour un positionnement donné de l'engin mobile en utilisant une somme de termes associés chacun à une zone donnée de l'environnement, et pour calculer chaque terme en utilisant le produit de la valeur de mesure (M_SCANt,i) représentative de la vraisemblance d'occupation de la zone correspondant à la zone donnée pour le positionnement donné de l'engin et de la valeur construite (M_GRIt,k) représentative de la vraisemblance d'occupation de la zone donnée. 4. Locating and mapping device according to one of claims 1 to 3, wherein the location module (1 6) is designed to determining the correspondence measurement for a given positioning of the mobile machine by using a sum of terms each associated with a given area of the environment, and for calculating each term using the product of the measurement value (M_SCAN t, i ) representative of the likelihood of occupation of the zone corresponding to the given zone for the given positioning of the machine and the constructed value (M_GRI t , k ) representative of the likelihood of occupation of the given zone.
5. Dispositif de localisation et de cartographie selon la revendication 4, dans lequel le module de localisation (16) est conçu pour calculer chaque terme en divisant le produit précité par un facteur de conflit utilisant une somme de la valeur de mesure (M_SCANt,j) représentative de la vraisemblance d'occupation de la zone correspondant à la zone donnée pour le positionnement donné de l'engin, multipliée par la valeur construite (M_GRIt,k) représentative de la vraisemblance de non-occupation de la zone donnée, et de la valeur de mesure (M_SCANt,j) représentative de la vraisemblance de non-occupation de la zone correspondant à la zone donnée pour le positionnement donné de l'engin, multipliée par la valeur construite (M_GRIt,k) représentative de la vraisemblance d'occupation de la zone donnée. A locating and mapping device according to claim 4, wherein the locator module (16) is adapted to calculate each term by dividing the aforementioned product by a conflict factor using a sum of the measurement value (M_SCAN t, j ) representative of the likelihood of occupation of the zone corresponding to the given zone for the given positioning of the machine, multiplied by the constructed value (M_GRI t , k ) representative of the likelihood of non-occupation of the given zone, and the measurement value (M_SCAN t, j ) representative of the likelihood of non-occupation of the zone corresponding to the given zone for the given positioning of the machine, multiplied by the constructed value (M_GRI t , k ) representative of the likelihood of occupation of the given area.
6. Dispositif de localisation et de cartographie selon l'une des revendications 1 à 5, dans lequel le module de cartographie (18, 20) comprend un module de combinaison (18) conçu pour déterminer pour chaque zone, en combinant lesdites valeurs de mesure (M_SCANt,i) relatives à la zone concernée et des valeurs construites (M_GRIt- 1,k) par le module de cartographie (18, 20) pour la zone concernée lors d'une précédente itération, des valeurs brutes (M_COMBt,k) respectivement représentatives d'une vraisemblance d'occupation de la zone concernée, d'une vraisemblance de non-occupation de la zone concernée, d'une vraisemblance de non-connaissance de la zone concernée et d'une vraisemblance de conflit sur la zone concernée. 6. A locating and mapping device according to one of claims 1 to 5, wherein the mapping module (18, 20) comprises a combination module (18) designed to determine for each zone, combining said measured values. (M_SCAN t , i) relative to the area concerned and constructed values (M_GRI t-1 , k ) by the mapping module (18, 20) for the zone concerned during a previous iteration, raw values (M_COMB t , k ) respectively representative of a likelihood of occupation of the area concerned, a likelihood of non-occupation of the area concerned, a likelihood of non-knowledge of the area concerned and a likelihood of conflict on the area concerned.
7. Dispositif de localisation et de cartographie selon la revendication 6, dans lequel le module de cartographie (18, 20) comprend un module de normalisation (20) conçu pour déterminer lesdites valeurs construites (M_GRIt,k) en fonction desdites valeurs brutes (M_COMBt,k)- The locating and mapping device according to claim 6, wherein the mapping module (18, 20) comprises a normalization module (20) adapted to determine said constructed values (M_GRI t, k ). according to said raw values (M_COMB t, k ) -
8. Dispositif de localisation et de cartographie selon l'une des revendications 1 à 7, dans lequel le module de traitement (12, 14) comprend un module de conversion (14) conçu pour déterminer, pour chaque zone de la pluralité de zones positionnées par rapport à l'engin, lesdites valeurs de mesure (M_SCANt,j) relatives à la zone concernée en fonction de valeurs correspondantes (M_POLt,j) attribuées, dans une grille polaire, à une cellule correspondant à la zone concernée. 8. Locating and mapping device according to one of claims 1 to 7, wherein the processing module (12, 14) comprises a conversion module (14) adapted to determine, for each zone of the plurality of positioned zones relative to the machine, said measurement values (M_SCAN t, j ) relative to the area concerned as a function of corresponding values (M_POL t, j ) allocated, in a polar grid, to a cell corresponding to the zone concerned.
9. Système comprenant un dispositif de localisation et de cartographie (10) selon l'une des revendications 1 à 8 et un capteur (2) conçu pour générer lesdites données de positionnement (d(a)). 9. A system comprising a locating and mapping device (10) according to one of claims 1 to 8 and a sensor (2) adapted to generate said positioning data (d (a)).
10. Système selon la revendication 9, dans lequel le capteur (2) est un lidar. The system of claim 9, wherein the sensor (2) is a lidar.
1 1 . Procédé de localisation et de cartographie utilisé par un engin mobile dans un environnement comprenant une pluralité de zones, comprenant les étapes suivantes : 1 1. A method of locating and mapping used by a mobile craft in an environment comprising a plurality of areas, comprising the steps of:
- réception de données de positionnement (d(a)) d'obstacles relativement à l'engin ;  receiving positioning data (d (a)) of obstacles relative to the machine;
- détermination, en fonction des données reçues (d(a)) et pour une pluralité de zones positionnées par rapport à l'engin, de valeurs de mesure (M_SCANt,j) respectivement représentatives d'une vraisemblance d'occupation de la zone concernée, d'une vraisemblance de non-occupation de la zone concernée et d'une vraisemblance de non-connaissance de la zone concernée ; determination, as a function of the data received (d (a)) and for a plurality of zones positioned with respect to the machine, of measurement values (M_SCAN t, j ) respectively representative of a likelihood of occupation of the zone concerned, a likelihood of non-occupation of the area concerned and a likelihood of non-knowledge of the area concerned;
- construction, pour chaque zone de ladite pluralité de zones de l'environnement, de valeurs (M_GRIt,k) respectivement représentatives d'une vraisemblance d'occupation de la zone concernée, d'une vraisemblance de non- occupation de la zone concernée et d'une vraisemblance de non-connaissance de la zone concernée ; - construction, for each zone of said plurality of zones of the environment, values (M_GRI t, k ) respectively representative of a likelihood of occupation of the area concerned, a likelihood of non-occupation of the area concerned and a likelihood of non-knowledge of the area concerned;
- localisation de l'engin par détermination du positionnement de l'engin dans l'environnement qui maximise une mesure de correspondance entre les valeurs de mesure (M_SCANt,j) et les valeurs construites (M_GRIt,k)- locating the machine by determining the positioning of the machine in the environment which maximizes a measurement of correspondence between the measurement values (M_SCAN t, j ) and constructed values (M_GRI t , k ) -
12. Procédé selon la revendication 1 1 , comprenant une étape de combinaison, pour chaque zone de l'environnement, desdites valeurs de mesure (M_SCANt,j) relatives à la zone concernée et de valeurs (M_GRIt--1 ,k) construites par le module de cartographie pour la zone concernée lors d'une précédente itération afin de générer des valeurs brutes (M_COMBt,k) respectivement représentatives d'une vraisemblance d'occupation de la zone concernée, d'une vraisemblance de non-occupation de la zone concernée, d'une vraisemblance de non-connaissance de la zone concernée et d'une vraisemblance de conflit sur la zone concernée. 12. The method of claim 1 1, comprising a step of combining, for each zone of the environment, said measurement values (M_SCAN t, j ) relative to the area concerned and values (M_GRI t - 1, k ). constructed by the mapping module for the area concerned during a previous iteration in order to generate raw values (M_COMB t , k ) respectively representative of a likelihood of occupation of the zone concerned, of a likelihood of non-occupation the area concerned, a likelihood of non-knowledge of the area concerned and a likelihood of conflict in the area concerned.
PCT/EP2015/069787 2014-09-01 2015-08-28 Location and mapping device and method WO2016034516A2 (en)

Priority Applications (4)

Application Number Priority Date Filing Date Title
CN201580058177.XA CN107209515A (en) 2014-09-01 2015-08-28 Positioning and map drawing device and method
JP2017511921A JP6682508B2 (en) 2014-09-01 2015-08-28 Positioning and mapping apparatus and method
EP15763237.3A EP3189389B1 (en) 2014-09-01 2015-08-28 Location and mapping device with associated method
US15/506,973 US10379542B2 (en) 2014-09-01 2015-08-28 Location and mapping device and method

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
FR1401938A FR3025325B1 (en) 2014-09-01 2014-09-01 DEVICE AND METHOD FOR LOCALIZATION AND MAPPING
FR14/01938 2014-09-01

Publications (2)

Publication Number Publication Date
WO2016034516A2 true WO2016034516A2 (en) 2016-03-10
WO2016034516A3 WO2016034516A3 (en) 2016-05-26

Family

ID=52423742

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/EP2015/069787 WO2016034516A2 (en) 2014-09-01 2015-08-28 Location and mapping device and method

Country Status (6)

Country Link
US (1) US10379542B2 (en)
EP (1) EP3189389B1 (en)
JP (1) JP6682508B2 (en)
CN (1) CN107209515A (en)
FR (1) FR3025325B1 (en)
WO (1) WO2016034516A2 (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US11505292B2 (en) 2014-12-31 2022-11-22 FLIR Belgium BVBA Perimeter ranging sensor systems and methods
US12084155B2 (en) 2017-06-16 2024-09-10 FLIR Belgium BVBA Assisted docking graphical user interface systems and methods
US12117832B2 (en) 2018-10-31 2024-10-15 FLIR Belgium BVBA Dynamic proximity alert systems and methods

Families Citing this family (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10093021B2 (en) * 2015-12-02 2018-10-09 Qualcomm Incorporated Simultaneous mapping and planning by a robot
US10613541B1 (en) * 2016-02-16 2020-04-07 AI Incorporated Surface coverage optimization method for autonomous mobile machines
US11815602B2 (en) 2017-10-03 2023-11-14 Intel Corporation Grid occupancy mapping using error range distribution
FR3081598A1 (en) * 2018-06-15 2019-11-29 Orange MAPPING AND SIMULTANEOUS LOCATION OF AN OBJECT IN AN INTERNAL ENVIRONMENT
US11442171B2 (en) * 2019-07-26 2022-09-13 6 Watch, Inc. Threat detection and notification system for public safety vehicles
CN112581613A (en) * 2020-12-08 2021-03-30 纵目科技(上海)股份有限公司 Grid map generation method and system, electronic device and storage medium

Family Cites Families (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000292538A (en) * 1999-04-07 2000-10-20 Mitsubishi Electric Corp Obstacle detector for vehicle
JP4061596B2 (en) * 2004-05-20 2008-03-19 学校法人早稲田大学 Movement control device, environment recognition device, and moving body control program
US8577538B2 (en) * 2006-07-14 2013-11-05 Irobot Corporation Method and system for controlling a remote vehicle
US7211980B1 (en) * 2006-07-05 2007-05-01 Battelle Energy Alliance, Llc Robotic follow system and method
JP4788722B2 (en) * 2008-02-26 2011-10-05 トヨタ自動車株式会社 Autonomous mobile robot, self-position estimation method, environmental map generation method, environmental map generation device, and environmental map data structure
JP5298741B2 (en) * 2008-10-01 2013-09-25 村田機械株式会社 Autonomous mobile device
KR101202695B1 (en) * 2008-10-01 2012-11-19 무라다기카이가부시끼가이샤 Autonomous movement device
CN104699099B (en) * 2009-08-31 2018-03-23 Neato机器人技术公司 The method and apparatus of positioning and mapping while mobile robot environment
JP5803054B2 (en) * 2009-12-02 2015-11-04 村田機械株式会社 Autonomous mobile device
JP5745067B2 (en) * 2010-09-24 2015-07-08 アイロボット・コーポレーション System and method for VSLAM optimization
CN103558856A (en) * 2013-11-21 2014-02-05 东南大学 Service mobile robot navigation method in dynamic environment
CN103901891A (en) * 2014-04-12 2014-07-02 复旦大学 Dynamic particle tree SLAM algorithm based on hierarchical structure
WO2015193941A1 (en) * 2014-06-16 2015-12-23 株式会社日立製作所 Map generation system and map generation method

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US11505292B2 (en) 2014-12-31 2022-11-22 FLIR Belgium BVBA Perimeter ranging sensor systems and methods
US12084155B2 (en) 2017-06-16 2024-09-10 FLIR Belgium BVBA Assisted docking graphical user interface systems and methods
US12117832B2 (en) 2018-10-31 2024-10-15 FLIR Belgium BVBA Dynamic proximity alert systems and methods

Also Published As

Publication number Publication date
FR3025325B1 (en) 2016-12-30
US10379542B2 (en) 2019-08-13
JP2017526083A (en) 2017-09-07
JP6682508B2 (en) 2020-04-15
US20170261996A1 (en) 2017-09-14
WO2016034516A3 (en) 2016-05-26
FR3025325A1 (en) 2016-03-04
CN107209515A (en) 2017-09-26
EP3189389A2 (en) 2017-07-12
EP3189389B1 (en) 2021-09-08

Similar Documents

Publication Publication Date Title
EP3189389B1 (en) Location and mapping device with associated method
EP3137355B1 (en) Device for designating objects to a navigation module of a vehicle equipped with said device
EP3018447B1 (en) Method for determining a radius of protection associated with a navigation parameter of a hybrid inertial navigation system, and associated system
EP3364213B1 (en) Method and system for contextualised perception of material bodies
FR3054886A1 (en) GLOBAL SYSTEM AND METHOD FOR GLOBAL GEOLOCATION FROM MEASUREMENTS OF DISTANCES AND POSITIONS OF IMPREGNED ANCHORS
Hsu et al. Hong Kong UrbanNav: An open-source multisensory dataset for benchmarking urban navigation algorithms
EP3680615A1 (en) Method for determining a radius of protection for a vision-based navigation system
EP3126864B1 (en) Method for geolocating the environment of a carrier
WO2014170478A1 (en) Integrity control method and merging/consolidation device comprising a plurality of processing modules
EP4046390A1 (en) Improved location of an acoustic source
EP2544020B1 (en) Method and device for detecting a target masked by high-energy reflectors
CN117930295A (en) Information detection method and device, electronic equipment and storage medium
EP3384462B1 (en) Method for characterising a scene by calculating the 3d orientation
WO2023180143A1 (en) Method for determining at least one protection radius associated with at least one navigation parameter, and associated electronic determination device
EP2876462B1 (en) System and method for determining the position error of a satellite positioning receiver
WO2021032749A1 (en) Detection of a decoy operation of a satellite signal receiver
WO2019239027A1 (en) Mapping and simultaneous localisation of an object in an interior environment
FR3090126A1 (en) Method for locating, in an absolute coordinate system, a device, computer and associated vehicle.
WO2024009048A1 (en) Method for correcting an attitude provided by a dead reckoning navigation system by means of a relative positioning system
FR3039642B1 (en) METHOD FOR LOCATING A MOBILE MACHINE AND ASSOCIATED LOCATION DEVICE
WO2022123136A1 (en) Method and device for generating an optimized 3d point cloud of an elongate object from images generated by a multipath synthetic-aperture radar
FR3044774A1 (en) METHOD USING POWER MEASUREMENTS FOR DETERMINING POSITIONING DATA BETWEEN TWO BODIES
FR3144668A1 (en) Process for acoustic localization of an object
FR3096129A1 (en) method of geolocation of platforms moving in formation, computer program product and associated geolocation module
FR3115608A1 (en) METHOD FOR DETECTING A MASKING OF ONE OR MORE SATELLITES, ELECTRONIC DETECTION DEVICE AND ASSOCIATED COMPUTER PROGRAM PRODUCT

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 15763237

Country of ref document: EP

Kind code of ref document: A2

WWE Wipo information: entry into national phase

Ref document number: 15506973

Country of ref document: US

ENP Entry into the national phase

Ref document number: 2017511921

Country of ref document: JP

Kind code of ref document: A

NENP Non-entry into the national phase

Ref country code: DE

REEP Request for entry into the european phase

Ref document number: 2015763237

Country of ref document: EP