Commande H prédictive pour l asservissement par vision d un stabilisateur cardiaque actif

Dimension: px

Commencer à balayer dès la page:

Download "Commande H prédictive pour l asservissement par vision d un stabilisateur cardiaque actif"

Irène Blanchard
il y a 8 ans
Total affichages :

1 Commande H prédictive pour l asservissement par vision d un stabilisateur cardiaque actif W. Bachta, E. Laroche, P. Renaud, J. Gangloff LSIIT, CNRS, Université de Strasbourg, INSA de Strasbourg, France Journée MOSAR, 23 janv. 2009, Besançon

2 Contenu 1 Le contexte 2 Problème de commande 3 Synthèse des lois de commande 4 Analyse de la robustesse 5 Conclusion

3 Outline 1 Le contexte 2 Problème de commande 3 Synthèse des lois de commande 4 Analyse de la robustesse 5 Conclusion

4 La chirurgie à cœur battant Contexte de la chirurgie à cœur battant Contexte Procédure antérieure : arrêt du cœur et mise en place d une circulation extracorporelle Opération sur cœur battant afin de limiter les complications Nécessité de réduire les mouvements de la zône à opérer par la mise en place d un stabilisateur mécanique Limitation des stabilisateur Mouvement résiduel de l ordre du mm [Cattin04] Précision requise : 0.1 mm Précision insuffisante en vue d une utilisation endoscopique [Loisance05] Figure: Stabilisateur invasif Octopus 4.3 (Medtronic) Solution proposée Développement d un stabilisateur actionné Figure: Stabilisateur endoscopique Octopus TE (Medtronic)

Limitation des stabilisateur Mouvement résiduel de l ordre du mm [Cattin04] Précision requise : 0.

5 Cardiolock : un stabilisateur cardiaque actif Cardiolock 1 Description Tige Diamètre compatible avec la chirurgie mini-invasive (diamètre de 10 mm) Stérilisable par autoclave Système de fixation par succion Système d actionnement

mini-invasive (diamètre de 10 mm) Stérilisable par

6 Cardiolock : un stabilisateur cardiaque actif Cardiolock 1 Description Tige Système d actionnement Mécanisme parallèle Articulations par afaiblissement (sans jeu) Actioneur linéaire piézo-électrique Protégeable par un sac stérile

parallèle Articulations par afaiblissement (sans jeu)

7 Cardiolock : un stabilisateur cardiaque actif Cardiolock 2 Système complet Détail d un DDL 2 DDL Chaque DDL est réalisé par un mécanisme parallèle en quasi-singularité

8 Outline 1 Le contexte 2 Problème de commande 3 Synthèse des lois de commande 4 Analyse de la robustesse 5 Conclusion

9 Cardialock en situation Cardialock en situation Perturbation d 1 Caméra Ampli ECG Commande u Calculateur Position y Rejet de perturbation (cœur et respiration) Possibilité de prendre en compte les mesures physilogiques (ECG + fréquence respiratoire) pour construire un modèle de la perturbation

(cœur et respiration) Possibilité de prendre en compte les mesures

10 Modèle dynamique Modèle dynamique q1 l2 F Modélisation Sous l hypothèse de mouvements rigides équivalents l1 q2 Figure: Schéma simplifié sous l hypothèse de mouvements rigides équivalents Commande : u = q 1 Mesure par caméra : y = position de l extrémité de la tige

simplifié sous l hypothèse de mouvements rigides équivalents

11 Modèle dynamique F c y(t) y(k) G(s) caméra z 1 v(k) u(k) ZOH u(t) = q1(t) Figure: Schéma bloc du système M 21 q 1 + M 22 q 2 = l 2 F c K 2 q 2 f 2 q 2 (1) q 1 = u (2) y = (l 1 + l 2 )q 1 + l 2 q 2 (3) Système flexible à non-minimum de phase

12 Problème de commande u(k) H(z) - + p(k) v(k) Figure: Schéma simplifié pour la synthèse Caméra + BOZ équivalent à un BOU [IFAC 2008] «H(z) = z 1 1 z 1 2 «ZL 1 G2 (s) T s 2 Problème de commande On se ramène à un rejet de perturbation de sortie Reconstruction par un simple estimateur ˆp = H(z) u v

1 z 1 2 «ZL 1 G2 (s) T s 2 Problème de commande On se ramène à un rejet

13 Modèle de la perturbation Prédiction de la perturbation Deux origines : cardiaque (dφ c/dt = 2πf c où f c est évaluée entre deux périodes de l ECG) respiratoire (dφ r/dt = 2πf r où f r est donnée par le respirateur) Composante respiratoire + composante cardiaque p(t) = M r(t) + M c(t) Composante respiratoire dépendant uniquement de la phase respiratoire : M r(t) = P n r l=1 a l sin `lφ r(t) + b l cos `lφ r(t) Composante cardiaque dépendant des phases cardiaque et respiratoire : M c(t) = C c(t)(1 + C r(t)) où C c(t) = P n c l=1 e l sin `lφ c(t) + f l cos `lφ c(t) C r(t) = P n r l=1 g l sin `lφ r(t) + h l cos `lφ r(t) Changement de variable pour obtenir une formulation linéaire et estimation par moindre carrés récursifs avec facteur d oubli

r l=1 a l sin `lφ r(t) + b l cos `lφ r(t) Composante cardiaque dépendant des phases cardiaque et respiratoire : M c(t) = C c(t)(1 + C r(t)) où C c(t) = P n c l=1 e l sin `lφ c(t) + f l

14 Modèle de la perturbation Évaluation sur données expérimentales pixels temps (s) Figure: Déplacement résiduel mesuré (trait continu) et prédit sur un horizon de trois périodes (trait pointillé, T e = 3 ms)

15 Outline 1 Le contexte 2 Problème de commande 3 Synthèse des lois de commande 4 Analyse de la robustesse 5 Conclusion

16 Correcteur 1 DDL Correcteur 1 DDL simple W 1 (s) z 1 W 2 (s) z 2 p K(s) u H(s) + - v Figure: Schéma de synthèse 2 blocs à temps continu (marge de module, précision, bande passante, roll-off) Transfert de p vers y The Transfer from p to u gain (db) gain (db) pulsation (rad/sec) pulsation (rad/sec) Figure: Analyse fréquentielle (gabarits : trait pointillé ; transferts obtenus : trait continu)

gain (db) 0 10 20 30 40 gain (db) 0 10 20 30 40 50 50 10 0 10 1 10 2 10 3 10 4 pulsation (rad/sec) 60 10 0 10 1 10 2 10 3

17 Correcteur 1 DDL Correcteur 1 DDL résonant W 1 (s) modifié avec un filtre résonant adapté sur le fondamental du mouvement cardiaque 20 The Transfer from p to e 20 The Transfer from p to u gain (db) gain (db) frequency (rad/sec) frequency (rad/sec)

Transfer from p to u 10 10 0 0 gain (db) 10 20 30 40 50 gain (db) 10 20 30 40 60 10

18 Correcteur prédictif Correcteur à 2 DDL p(t) K(z) u H(z) v Figure: Schema de commande avec mesure de la perturbation K(z) = [K 1 (z) K 2 (z)], H(z) = [H 1 (z) H 2 (z)] T vp(z) = (I H 2 (z) K 2 (z)) 1 (H 1 (z) + H 2 (z)k 2 (z)) Feedback K 2 (z) pour le rejet robuste en basse fréquence Feedforward K 1 (z) pour aider en haute fréquence (K 1 (z) = H 1 2 (z) H 1 (z)) avec une sensibilité aux erreurs de modélisation élevée Limitations : H 1 (z) d inverse non propre ou instable (les deux dans notre cas) Anternative : synthèse de K(s) en une seule étape ( mesure supplémentaire [Duc et Font])

Feedforward K 1 (z) pour aider en haute fréquence (K 1 (z) = H 1 2 (z) H 1 (z)) avec une sensibilité aux erreurs de modélisation élevée Limitations

19 Correcteur prédictif Correcteur prédictif p(t) p(t + n p T) avance K(z) u H(z) + - Figure: Principe de la commande prédictive de type preview v Avance réalisée par un modèle de prédiction Synthèse du correcteur en une seule étape Rapport avec la commande prédictive GPC : nécessité de connaître les valeurs futures des signaux exogènes Transposable au suivi de consigne

prédiction Synthèse du correcteur en une seule étape Rapport avec la commande prédictive GPC

20 Correcteur prédictif Schéma de commande complet ˆp(t + n p T) avance ˆp(t) Ĥ(z) p(t) + - K(z) u H(z) + - v Figure: Schéma de commande avec estimation de la perturbation

21 Correcteur prédictif Schéma de synthèse v 2 W 3 (s) p retard w e K(s) u H(s) - + v W 2 (s) z 2 W 1 (s) z 1 Figure: Schéma de synthèse pour retour de sortie et compensation de la perturbation permettant de régler fréquentiellement les effets de feedback et de feedforward

22 Correcteur prédictif Transfer de r vers e Transfert de p vers e gain (db) gain (db) pulsation (rad/sec) Transfert de r vers u pulsation (rad/sec) Transfert de p vers u gain (db) gain (db) pulsation (rad/sec) pulsation (rad/sec) Figure: Correction par retour de sortie et compensation de la perturbation (gabarits : trait pointillé ; transferts obtenus : trait continu)

23 Evaluation nominale Expérimentation au laboratoire Correcteur sans connaissance a priori Correcteur avec prise en compte de la fréquence cardiaque Correcteur avec modèle de mouvement cardiaque mm 1 mm 1 mm temps (sec) temps (sec) temps (sec) Feedback simple Feedback résonant 2 DDL prédictif Mouvement du cœur émulé par un robot pan-tilt Des expérimentations in-vivo ont également été faites qui confortent ces résultats

24 Evaluation nominale Évaluation en simulation sur données expérimentales Méthode de correction RMS mvt. résiduel (pixel) Sans correction 22,3 Retour de sortie simple 2,57 Retour de sortie résonant 1,69 Avec prédiction parfaite 0,064 Avec modèle de prédiction 1,21 Table: Mouvement résiduel, obtenu avec le modèle nominal et en simulation, pour les différentes lois de commande (la prédiction est faite avec n c = 10 et n r = n r = 4)

25 Evaluation nominale Analyse fréquentielle du mouvement résiduel 10 0 Position (pixels) Frequency (Hz) bleu : 1 DDL simple ; rouge : 1 DDL résonant ; violet : 2 DDL avec perturbation exacte ; vert : 2 DDL avec modèle de prédiction

26 Outline 1 Le contexte 2 Problème de commande 3 Synthèse des lois de commande 4 Analyse de la robustesse 5 Conclusion

27 Modèle incertain Problème de robustesse Modification du comportement lors du contact avec le cœur Modèle de l interaction avec le cœur F = F c k c y f c kẏ m c ÿ (4) F c : perturbation extérieure (signal exogène) Valeurs nominales m c = 2 g, K c = 250 N/m et f c = 0.1 N.s/m Variations de 0 à 200 %

28 Modèle incertain Contexte de la µ-analyse Paramètres constants incertains Modèle LFR Introduction d un critère de performance Robuste si µ < 1

29 Commande 1 DDL Modèle LFR (stabilité + performances) z 1 w 1 c w 2 r z 2 W 1 (s) K(s) u H u (s) p + - v Figure: Structure du modèle LFR incertain c diagonal réel ; r complex plein

30 Indice de répétition des paramètres incertains Paramètre Directe Réduction Robust toolbox m c K c f c Table: Indice de répétition des paramètres du modèle LFR pour les différentes méthodes (Directe et Réduction : avec la LFR toolbox

31 Tracé du µ bornes sup. et inf. de µ pulsation (rad/sec) Figure: Valeur singulière structurée µ < 1: système robuste pour les incertitudes prévues

32 Commande 2 DDL prédictive Système simplifié non causal µ-analyse non utilisable Évaluation en simulation avec p k = ρ p k0 où p k0 est la valeur nominale et ρ [0 ; 2] valeur efficace du mouvement résiduel (pixel) ρ Figure: Variation du mouvement résiduel en fonction de l incertitude ρ (trait continu : retour de sortie ; trait haché : avec prédiction)

33 Outline 1 Le contexte 2 Problème de commande 3 Synthèse des lois de commande 4 Analyse de la robustesse 5 Conclusion

34 Conclusion Développement d une loi de commande prédictive de type H Amélioration des résultats par prédiction de la perturbation Résultats satisfaisants pour la chirurgie à cœur battant Perspectives Évaluation du Cardiolock 2 Analyse de la robustesse en tenant compte de l estimation de la prédiction Comparaison avec le GPC

Documents pareils

Développement de lois et de structures de réglages destinées à la téléopération avec retour d effort

Développement de lois et de structures de réglages destinées à la téléopération avec retour d effort Thomas Delwiche, Laurent Catoire et Michel Kinnaert Faculté des Sciences Appliquées Service d Automatique