Cette page a été traduite par traduction automatique. Cliquez ici pour voir la dernière version en anglais.

odometryMotionModel

Créer un modèle de mouvement d'odométrie

Description

odometryMotionModel crée un objet de modèle de mouvement d'odométrie pour les véhicules à entraînement différentiel. Cet objet contient des paramètres de modèle de mouvement spécifiques. Vous pouvez utiliser cet objet pour spécifier les paramètres du modèle de mouvement dans l'objet monteCarloLocalization .

Ce modèle de mouvement suppose que le véhicule effectue de purs mouvements de rotation et de translation pour se déplacer d'un endroit à l'autre. Le modèle propage les points pour un mouvement vers l'avant ou vers l'arrière en fonction de ces modèles de mouvement. Les éléments de la propriété Noise font référence à la variance du mouvement. Pour voir l'effet de la modification des paramètres de bruit, utilisez showNoiseDistribution.

Création

Syntaxe

omm = odometryMotionModel

Description

omm = odometryMotionModel crée un objet de modèle de mouvement d'odométrie pour les véhicules à entraînement différentiel.

Propriétés

Noise — Bruit gaussien pour le mouvement du véhicule

[0.2 0.2 0.2 0.2] (par défaut) | vecteur à 4 éléments

Bruit gaussien pour le mouvement du véhicule, spécifié comme vecteur à 4 éléments. Cette propriété représente les paramètres de variance du bruit gaussien appliqué au mouvement du véhicule. Les éléments du vecteur correspondent dans l'ordre aux erreurs suivantes :

• Erreur de rotation due au mouvement de rotation

• Erreur de rotation due au mouvement de translation

• Erreur de traduction due au mouvement de traduction

• Erreur de translation due au mouvement de rotation

Type — Type de modèle de mouvement d'odométrie

Lecture seule : 'DifferentialDrive' (par défaut)

Ce propriété est en lecture seule.

Type du modèle de mouvement d'odométrie, renvoyé sous la forme 'DifferentialDrive'. Cette propriété en lecture seule indique le type de modèle de mouvement d'odométrie utilisé par l'objet.

Fonctions d'objet

showNoiseDistribution

Afficher les effets des paramètres de bruit

Exemples

Prédire les poses basées sur un modèle de mouvement d'odométrie

Cet exemple montre comment utiliser la classe odometryMotionModel pour prédire la pose d'un véhicule. Un objet odometryMotionModel contient les paramètres du modèle de mouvement pour un véhicule à entraînement différentiel. Utilisez l'objet pour prédire la pose d'un véhicule en fonction de ses poses actuelles et précédentes et des paramètres du modèle de mouvement.

Créez un objet de modèle de mouvement d'odométrie.

motionModel = odometryMotionModel;

Définissez les poses précédentes et la lecture actuelle de l’odométrie. Chaque prédiction de pose correspond à une ligne du vecteur previousPoses .

previousPoses =  rand(10,3);
currentOdom = [0.1 0.1 0.1];

Le premier appel à l'objet initialise les valeurs et renvoie les poses précédentes comme poses actuelles.

currentPoses = motionModel(previousPoses, currentOdom);

Les appels ultérieurs à l'objet avec des poses d'odométrie mises à jour renvoient les poses prédites en fonction du modèle de mouvement.

currentOdom = currentOdom + [0.1 0.1 0.05];
predPoses = motionModel(previousPoses, currentOdom);

Afficher les effets de distribution du bruit pour le modèle de mouvement d'odométrie

Cet exemple montre comment visualiser l'effet de différents paramètres de bruit sur la classe odometryMotionModel . Un objet odometryMotionModel contient les paramètres de bruit du modèle de mouvement pour un véhicule à entraînement différentiel. Utilisez showNoiseDistribution pour visualiser comment la modification de ces valeurs affecte la distribution des poses prédites.

Créez un objet de modèle de mouvement.

motionModel = odometryMotionModel;

Affichez la distribution des particules avec les paramètres de bruit existants. Chaque particule est une hypothèse pour la pose prédite.

showNoiseDistribution(motionModel);

Afficher la distribution avec un changement de pose d'odométrie spécifié et un nombre d'échantillons. Le changement d'odométrie est utilisé comme pose finale avec des hypothèses réparties autour en fonction des paramètres Noise .

showNoiseDistribution(motionModel, ...
            'OdometryPoseChange', [0.5 0.1 0.25], ...
            'NumSamples', 1000);

Modifiez les paramètres Noise et visualisez les effets. Utilisez le même changement de pose d’odométrie et le même nombre d’échantillons.

 motionModel.Noise = [0.2 1 0.2 1];
 
 showNoiseDistribution(motionModel, ...
            'OdometryPoseChange', [0.5 0.1 0.25], ...
            'NumSamples', 1000);

Limites

Si vous apportez des modifications à votre modèle de mouvement après l'avoir utilisé avec l'objet monteCarloLocalization , appelez au préalable release sur cet objet. Par exemple:

mcl = monteCarloLocalization; 
[isUpdated,pose,covariance] = mcl(ranges,angles); 
release(mcl) 
mcl.MotionModel.Noise = [0.25 0.25 0.4 0.4];

Références

[1] Thrun, Sebatian, Wolfram Burgard, and Dieter Fox. Probabilistic Robotics. MIT Press, 2005.

Capacités étendues

Génération de code C/C++
Générez du code C et C++ avec MATLAB® Coder™.

Historique des versions

Introduit dans R2019b

Voir aussi

monteCarloLocalization | likelihoodFieldSensorModel

Rubriques

• Localize TurtleBot Using Monte Carlo Localization Algorithm