Un filtre de Kalman convient-il pour filtrer les positions des points projetés, étant donné les angles d'Euler du dispositif de capture?

Mon système est le suivant. J'utilise l'appareil photo d'un appareil mobile pour suivre un objet. De ce suivi, j'obtiens quatre points 3D que je projette à l'écran, pour obtenir quatre points 2D. Ces 8 valeurs sont un peu bruyantes, à cause de la détection, donc je veux les filtrer pour rendre le mouvement plus fluide et plus réaliste. Comme deuxième mesure, j'utilise la sortie du gyroscope de l'appareil, qui fournit trois angles d'Euler (c'est-à-dire l'attitude de l'appareil). Celles-ci sont plus précises et à une fréquence plus élevée (jusqu'à 100 Hz) que les positions 2D (environ 20 Hz).

Ma première tentative a été avec un simple filtre passe-bas, mais le décalage était important, alors j'essaie maintenant d'utiliser un filtre de Kalman, en espérant qu'il sera capable de lisser les positions avec peu de retard. Comme vu dans une question précédente , un point clé d'un filtre de Kalman est la relation entre les mesures et les variables d'état internes. Ici, les mesures sont à la fois mes 8 coordonnées de points 2D et les 3 angles d'Euler, mais je ne suis pas sûr de ce que je devrais utiliser comme variables d'état interne et comment je dois connecter les angles d'Euler aux points 2D. D'où la question principale: un filtre de Kalman convient-il même à ce problème? Et si oui, comment?

filters kalman-filters state-space Stéphane Péchard
la source

Si tout le but est de lisser les valeurs avec un retard minimum, vous pouvez essayer d'utiliser un filtre de phase minimum si vous ne l'avez pas déjà essayé. Je serais surpris si le filtrage de Kalman peut vous donner mieux que le «retard de phase minimum». Pour les filtres linéaires, je m'attendrais à ce qu'un filtre à phase minimale donne le plus petit retard possible.

niaren

@niaren: Merci pour le commentaire, je vais également étudier cela.

Stéphane Péchard

On ne sait pas quelles sont vos mesures. Dans le cadre du filtre de Kalman, les "mesures" se réfèrent aux quantités que vous observez réellement. Si vous mesurez quatre points 3D (par exemple en fusionnant plusieurs images de caméra ensemble), ce sont vos mesures. Vous devez également décider quelles variables d'état vous essayez d'estimer. Essayez-vous de suivre les emplacements des objets 3D au fil du temps? Si oui, ce sont vos variables d'état. Il peut être approprié que la représentation 2D puisse être utilisée uniquement pour l'affichage et ne soit pas incluse dans votre modèle. Des détails supplémentaires aideront à suggérer une approche.

Jason R

Comme le dit Jsaon, vos mesures ne sont pas claires. Vous dites:

From this tracking, I get four 3D points that I project on a mobile device screen, to get four 2D points. These 8 values are kinda noisy

et ensuite vous dites What's available to me is the device's gyroscope output, which provides three Euler angles (i.e. the device attitude).. Lequel est-ce? Les quatre points 2D ou les trois angles d'Euler? Ou le train de traitement prend-il des angles d'Euler -> points 3D -> points 2D?

Peter K.

J'ai en fait deux ensembles de mesures: les positions des points détectés par la caméra et les angles d'Euler, mais ils ne sont pas triviaux à relier. De plus, je ne suis intéressé que par les positions filtrées en sortie. Je vais modifier la question pour clarifier.

Stéphane Péchard

Réponses:

Filtrage passe-bas

Il serait bon de savoir ce que vous entendez par "simple filtre passe-bas".

Par exemple, si vos mesures au temps sont $k$

p_{k} = [\begin{matrix} X_{k} \\ y_{k} \end{matrix}]

$p_{k} = \left[ \begin{array}{c} x_k \\ y_k \end{array} \right]$

et vos estimations filtrées passe-bas sont:

p_{k}^{L P F} = α p_{k - 1}^{L P F} + (1 - α) p_{k}

$p^{\tt LPF}_k = \alpha p^{\tt LPF}_{k-1} + (1-\alpha)p_k$

alors vous aurez un retard de groupe assez important dans le filtre d'environ (pour un alpha proche de 1). $1/(1-\alpha)$

Modélisation du signal: approche simpliste

Pour utiliser le filtre de Kalman (ou toute autre approche similaire), vous devez disposer d'un modèle pour l'acquisition et la mise à jour de vos mesures.

Cela ressemble généralement à:

où est le bruit de processus (d'attaque), est la matrice de transition d'état et est votre matrice d'entrée.

p_{k + 1}^{T R U E} = UNE p_{k}^{T R U E} + B ϵ_{k}

$p^{\tt TRUE}_{k+1} = {\mathbf A} p^{\tt TRUE}_k + {\mathbf B} \epsilon_k$

ϵ_{k}

$\epsilon_k$

A

${\mathbf A}$

B

${\mathbf B}$

Et alors vos mesurés sont: où est le bruit de sortie (mesure), est la matrice de sortie et est votre matrice de bruit de mesure. $p_k$

p_{k} = C p_{k}^{T R U E} + ré ν_{k}

$p_k = {\mathbf C} p^{\tt TRUE}_k + {\mathbf D} \nu_k$

ν_{k}

$\nu_k$

C

${\mathbf C}$

D

${\mathbf D}$

Ici, "l'état" du modèle est choisi comme position réelle, et les choses que vous mesurez sont la sortie.

Vous pouvez ensuite appliquer les équations du filtre de Kalman à ceci pour obtenir des estimations d'état de la position vraie. $\hat{p^{\tt TRUE}_k }$

Cependant, cette approche est simpliste car elle n'utilise aucune connaissance de la façon dont les points pourraient se déplacer (pas plus qu'elle n'utilise vos 4 points et aucune connaissance que vous pourriez avoir sur la façon dont ils se déplacent ensemble).

Modélisation du signal: démarrer une meilleure approche

Cette page montre comment régler le problème impliquant les positions et les angles d'Euler. Il fait quelque chose de différent de ce dont vous avez besoin, mais l'état est le suivant:

p_{k}^{T R U E} = {[X_{k} y_{k} z_{k} {\dot{X}}_{k} {\dot{y}}_{k} {\dot{z}}_{k} {\ddot{X}}_{k} {\ddot{y}}_{k} {\ddot{z}}_{k} ϕ ψ θ \dot{ϕ} \dot{ψ} \dot{θ} \ddot{ϕ} \ddot{ψ} \ddot{θ}]}^{T}

$p^{\tt TRUE}_{k} = \left[ x_k\ y_k\ z_k\ \dot{x}_k\ \dot{y}_k\ \dot{z}_k\ \ddot{x}_k\ \ddot{y}_k\ \ddot{z}_k\ \phi\ \psi\ \theta\ \dot{\phi}\ \dot{\psi}\ \dot{\theta}\ \ddot{\phi}\ \ddot{\psi}\ \ddot{\theta}\ \right]^T$

et les mesures (sortie) est

p_{k} = {[X_{k} y_{k} z_{k} ϕ ψ θ]}^{T}

$p_k = \left[ x_k\ y_k\ z_k\ \phi\ \psi\ \theta\ \right ]^T$

Tout ce que fait le modèle sur cette page, c'est: (mais pour chacun deet).

X_{k}^{T R U E} = \sum_{n = 0}^{k} {\dot{X}}_{n}^{T R U E} n Δ t + \frac{1}{2} \sum_{n = 0}^{k} {\ddot{X}}_{n}^{T R U E} (n Δ t)^{2}

$x^{\tt TRUE}_k = \sum_{n=0}^k \dot{x}^{\tt TRUE}_n n\Delta t + \frac{1}{2} \sum_{n=0}^k \ddot{x}^{\tt TRUE}_n (n\Delta t)^2$

x, y,

$x,y,$

z

$z$

Ce ne sont que les «équations du mouvement» classiques. Voir l'équation (3) ici.

Peter K.
la source

p_{k} = α p_{k - 1} + (α - 1) p_{k}

$p_k = \alpha p_{k-1} + (\alpha - 1) p_k$

α

$\alpha$

Δ t; \frac{1}{2} (Δ^{2})

$\Delta t \qquad ; \qquad \frac{1}{2} (\Delta^2)$

Δ t

$\Delta t$

1 / f_{s}

$1/f_s$

f_{s}

$f_s$

Δ t

$\Delta t$

Δ t

$\Delta t$

\frac{1}{2} Δ t^{2}

$\frac{1}{2} \Delta t^2$

Votre filtre passe-bas peut être comme;

p_{k} = α p_{k - 1} + (1 - α) z_{k}

$p_k = \alpha p_{k-1} + (1-\alpha) z_k$

$z_k$ $k$ $p_k$ $k$

Le LPF peut être déformé en suivant:

p_{k} = p_{k - 1} + K (z_{k} - p_{k - 1})

$p_k = p_{k-1} + K (z_k - p_{k-1})$

K = (1 - α)

$K = (1-\alpha)$

$K$

fumio ueda
la source