robotique 1 mi4 - université de montpellier
TRANSCRIPT
![Page 1: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/1.jpg)
Robotique 1MI4
Philippe Fraisse
Universite de Montpellier
20 Janvier 2020
[email protected] (UM) Robotique 1 20 Janvier 2020 1 / 42
![Page 3: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/3.jpg)
Introduction a la robotique mobileModelisation cinematique d’un vehicule
Il existe plusieurs types de cinematiques de vehicules terrestres dont deuxsont tres couramment utilises :
Il s’agit d’une part du robot mobile de type unicycle avec 2 rouesmotrices independantes assurant a la fois la vitesse et l’orientation duvehicule.
D’autre part, il y a le robot mobile de type vehicule a 3 ou 4 rouesdont 1 ou 2 roues placees a l’avant sont orientables et assurent ladirection independamment de la vitesse.
[email protected] (UM) Robotique 1 20 Janvier 2020 3 / 42
![Page 4: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/4.jpg)
Introduction a la robotique mobileModelisation cinematique d’un vehicule
La disposition des roues est viable s’il existe un point unique de vitessenulle autour duquel tourne le robot. Il s’agit du Centre Instantane deRotation (CIR).
Le CIR est situe a l’intersection des perpendiculaires de tous lesvecteurs vitesses du vehicule.
[email protected] (UM) Robotique 1 20 Janvier 2020 4 / 42
![Page 5: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/5.jpg)
Introduction a la robotique mobileModelisation cinematique d’un vehicule
Hypotheses :
Contact roue-sol ponctuel,
Les roues sont indeformables de rayon r,
Roulement sans glissement,
En realite le contact est une surface deformable (roue deformable) avecglissement.
−−→VQ =
−−→VP +−→ω ∧
−−−→PQ = ~0
[email protected] (UM) Robotique 1 20 Janvier 2020 5 / 42
![Page 6: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/6.jpg)
Introduction a la robotique mobileModelisation cinematique d’un vehicule
Modelisation cinematique
Avec :
−→ω =
ψ sin(θ)~x
−ψ cos(θ)~y
θ~z
(1)
−−−→PQ =
00−r~z
(2)
−−→VP =
x~xy~y0
(3)
On obtient :
x~x+ y~y + (θ~z + ψ sin(θ)~x− ψ cos(θ)~y) ∧ (−r~z) = ~0 (4)
[email protected] (UM) Robotique 1 20 Janvier 2020 6 / 42
![Page 7: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/7.jpg)
Introduction a la robotique mobileModelisation cinematique d’un vehicule
Modelisation cinematique
On projette cette equation sur les axes x et y.
x~x+ y~y + (θ~z + ψ sin(θ)~x− ψ cos(θ)~y) ∧ (−r~z) = ~0 (5)
On obtient :l/~x : x+ rψ cos(θ) = 0
/~y : y + rψ sin(θ) = 0(6)
On exprime ainsi le roulement sans glissement de la roue par unecontrainte non integrale de la forme :
y cos(θ)− x sin(θ) = 0 (7)
Il s’agit d’une contrainte de non-holonomie. c’est une contraintenon-integrable.
[email protected] (UM) Robotique 1 20 Janvier 2020 7 / 42
![Page 8: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/8.jpg)
Introduction a la robotique mobileModelisation cinematique de l’unicyle
Determiner la relation cinematique entre la vitesse des roues du vehiculeVd et Vg et le vecteur vitesse ~P = (x, y, θ) dans le plan (o, ~x, ~y)
[email protected] (UM) Robotique 1 20 Janvier 2020 8 / 42
![Page 9: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/9.jpg)
Introduction a la robotique mobileModelisation cinematique de l’unicyle
Modelisation de l’unicycle
On considere un vehicule unicycle avec L = 0.5m, etVgmax = Vdmax = 3m/s.
1 On veut realiser une trajectoire circulaire dans le plan (o, x, y) avec lavitesse maximale. Donner l’expression de x(t) et y(t).
2 En deduire les expressions des vitesses x(t) et y(t).
3 Determiner les expressions de θ(t) et θ(t).
4 Donner les expressions de Vg(t) et Vd(t).
5 Determiner le rayon de braquage maximal rmax pour une vitesse derotation ω0 donnee en prenant en compte la vitesse maximale desroues.
[email protected] (UM) Robotique 1 20 Janvier 2020 9 / 42
![Page 10: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/10.jpg)
Introduction a la robotique mobileModelisation cinematique du vehicule
Determiner la relation cinematique entre la vitesse des roues du vehicule Vet la commande du volant η et le vecteur vitesse ~P = (x, y, θ, ψ) dans leplan (o, ~x, ~y)
[email protected] (UM) Robotique 1 20 Janvier 2020 10 / 42
![Page 11: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/11.jpg)
Introduction a la robotique mobileModelisation cinematique du vehicule
Modelisation du vehicule
On considere un vehicule avec D = 1m et Vmax = 10m/s.
1 On veut realiser une trajectoire circulaire dans le plan (o, x, y) avec lavitesse maximale. Donner l’expression de x(t) et y(t).
2 En deduire les expressions des vitesses x(t) et y(t).
3 Determiner les expressions de θ(t), θ(t) et ψ(t).
4 Donner les expressions de V (t) et η(t).
5 Determiner le rayon de braquage maximal rmax pour une vitesse derotation ω0 donnee en prenant en compte la vitesse du vehicule.
[email protected] (UM) Robotique 1 20 Janvier 2020 11 / 42
![Page 12: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/12.jpg)
Introduction a la robotique mobileModelisation cinematique d’un manipulateur mobile
Determiner la relation cinematique entre la vitesse de l’effecteur Xe, Yeainsi que l’orientation du vehicule θ et les variables de commandes dansl’espace des configurations θ1, θ2, θ1, θ1, Vd et Vg.
[email protected] (UM) Robotique 1 20 Janvier 2020 12 / 42
![Page 13: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/13.jpg)
Modelisation et commande des robot a chaınescinematiques series ou arborescentes
[email protected] (UM) Robotique 1 20 Janvier 2020 13 / 42
![Page 14: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/14.jpg)
Introduction a la robotiqueIntroduction
Figure 1: Bras manipulateur Kuka a 7ddl
On peut ecrire le modele geometrique direct (MGD) d’une chaınecinematique serie en utilisant la convention DH afin d’exprimer laposition et l’orientation en fonction des positions articulaires du robotOn peut deriver directement du MGD le modele cinematique direct(MCD) permettant d’exprimer la relation entre les vitesses de l’outilet les vitesses articulaires. Il s’agit du calcul de la matrice Jacobienne.L’expression du MGI peut etre egalement extraire sous [email protected] (UM) Robotique 1 20 Janvier 2020 14 / 42
![Page 15: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/15.jpg)
Introduction a la robotiqueExercice
Modelisation du Centre de Masse (CdM)
On souhaite modeliser la position du Centre de Masse d’un robotmanipulateur a 2ddl.
Figure 2: Controle de la position du CdM
[email protected] (UM) Robotique 1 20 Janvier 2020 15 / 42
![Page 16: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/16.jpg)
Introduction a la robotiqueExercice
Modelisation du Centre de Masse (CdM)
Le calcul de la position du centre de masse ou centre de gravite d’unsysteme mecanique est defini par :
~OCdM =1
M
N∑i=1
mi~Oci (8)
Avec M =∑N
i=1mi
1 Determiner la position du CdM du robot en fonction des variablesarticulaires (θ1, θ2).
2 Comparer ce resultat avec le MGD du bras manipulateur a 2ddl.Conclusions. En deduire le MGI.
3 Representer le bras de robot serie equivalent dont la position del’effecteur est associee a la position du CdM. Determiner leslongueurs equivalentes r1 et r2 de ce bras serie?
4 En deduire la matrice jacobienne associee au MDG du [email protected] (UM) Robotique 1 20 Janvier 2020 16 / 42
![Page 17: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/17.jpg)
Introduction a la robotiqueExercice
Identification Centre de Masse (CdM)
On realise deux mesures statiques sur un robot a 2ddl en utilisant uneplate-forme de force fixee au sol permettant de relever uniquement lavaleur du CdM selon l’axe x.On a mesure l1 = 0.82m, l2 = 0.9m, M = 80kg et ci = li/2.
1er Essai θ1 = π2 , θ2 = −π
4
CdMx 0.179mCdMy pas de mesure
2nd Essai θ1 = 3π4 θ2 = −π
4
CdMx -0.453mCdMy pas de mesure
1 Determiner les coefficients r1 et r2.
2 En deduire les valeurs des masses m1 et m2.
[email protected] (UM) Robotique 1 20 Janvier 2020 17 / 42
![Page 18: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/18.jpg)
Modelisation et Commande AvanceeModelisation 3D du Centre de Masse pour une chaıne serie
Chaıne cinematique serie
Exercice : Modelisation du CdM
Exprimer la position du CdM pour cette chaıne cinematique serie.
[email protected] (UM) Robotique 1 20 Janvier 2020 18 / 42
![Page 19: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/19.jpg)
Modelisation et Commande AvanceeModelisation du Centre de Masse en 3D
Exercice : Modelisation du CdM pour une chaine serie a 3ddl
On calcule en utilisant les Matrices Homogenes l’expression du CdM. Onobtient :[
CdM
1
]=m1
MT1
[c11
]+m2
MT1T2
[c21
]+m3
MT1T2T3
[c31
]Demontrer que le CdM peut s’exprimer comme :
CdM = r1 + A1r2 + A1A2r3 + A1A2A3r4
Determiner l’expression des ri.
[email protected] (UM) Robotique 1 20 Janvier 2020 19 / 42
![Page 20: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/20.jpg)
Modelisation et Commande AvanceeModelisation du Centre de Masse en 3D
Exercice : Modelisation du CdM pour une chaıne arborescente
Developper l’expression de la position du CdM du robot :[CdM
1
]=m1
MT1
[c11
]+m2
MT1T2
[c21
]+m3
MT1T3
[c31
]+m4
MT1T3T4
[c41
]
Modelisation du Centre de Masse en 3D
[email protected] (UM) Robotique 1 20 Janvier 2020 20 / 42
![Page 21: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/21.jpg)
Modelisation et Commande AvanceeModelisation du Centre de Masse en 3D
Exercice : Modelisation du CdM en 3D
Montrer que la position du CdM peut s’ecrire sous la forme suivante :
CdM = r1 + A1r2 + A1A2r3 + A1A3r4 + A1A3A4r5
[email protected] (UM) Robotique 1 20 Janvier 2020 21 / 42
![Page 22: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/22.jpg)
Introduction a la robotiqueCommande Geometrique
Commande Geometrique
On souhaite controler la position d’un robot manipulateur en utilisant leMGI. Soit :
θ = g(X) (9)
Determiner le schema de commande de la position de l’effecteur(xr, yr) du robot en utilisant le MGI.
Conclusions
[email protected] (UM) Robotique 1 20 Janvier 2020 22 / 42
![Page 23: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/23.jpg)
Introduction a la robotiqueCommande Cinematique
Commande Cinematique
On souhaite controler la position d’un robot manipulateur en utilisant leMCI. Soit :
θ = J−1e (10)
On choisit e = X −Xd. Avec Xd On defini le comportement dynamiquedu robot avec la relation suivante
e+ λe = 0
Determiner le vecteur de commande θ pour le controle du robot avecle MCI.
En deduire le schema de commande.
Conclusions
[email protected] (UM) Robotique 1 20 Janvier 2020 23 / 42
![Page 24: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/24.jpg)
Introduction a la robotiqueExercice
Figure 3: Kuka LWR
Modelisation du robot Kuka LWR
En utilisant la table des parametres modifies de DH, Calculer le MGD duRobot Kuka LWR donnant la position et l’orientation du repere R7 dans lerepere R0.
[email protected] (UM) Robotique 1 20 Janvier 2020 24 / 42
![Page 25: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/25.jpg)
Introduction a la robotiqueExercice
Modelisation du robot Kuka LWR
En deduire l’expression du centre de masse donnant la position duCdM dans le repere R0. On utilisera les valeurs donnees par leconstructeur mi = 2.7kg, avec i = 1, .., 6 et m7 = 0.3kg.
Les ci pour i = 1..7 se situent au mielieu du segment qui relie deuxarticulations successives.
Caculer la matrice jacobienne geometrique J(q) au point origine durepere R7.
Realiser une trajectoire lineaire dans le plan (x,y) de l’effecteur durobot Kuka en utilisant Jupyterlab et V-REP.
[email protected] (UM) Robotique 1 20 Janvier 2020 25 / 42
![Page 26: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/26.jpg)
Introduction a la robotiqueCommande Dynamique
Technique du couple calcule
On souhaite controler un robot manipulateur dont le modele dynamiquedirect est :
Γ = A(θ)θ +H(θ, θ)θ + Fv θ +G(θ) (11)
Proposer un schema de commande de type proportionnel-derive surl’erreur de position (θd − θ) capable de controler la position articulairedu robot. Conclusions
Est-il possible d’eliminer les effets de la dynamique avec l’hypotheseque le modele est parfaitement connu? Conclusions.
Choisissons une commande de type lineaire qui ne tient pas comptede la dynamique du robot avec Γc = Kp(θd − θ) +Kd(θd − θ)Ecrire l’equation du systeme en boucle fermee. Conclusions.
[email protected] (UM) Robotique 1 20 Janvier 2020 26 / 42
![Page 27: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/27.jpg)
Introduction a la robotiqueCommande Dynamique
Technique du couple calcule
On choisit cette fois-ci :
Γc = A(Kp(θd − θ) +Kd(θd − θ) + θd) + H(θ, θ)θ + Fv θ + G(θ) (12)
Reecrire l’equation de la boucle fermee. Conclusions.
Discuter sur le cas ou les valeurs du modele estimees sont differentesdu systeme reel.
Ecrire l’equation du systeme en boucle fermee. Conclusions.
Que represente les gains Kp et Kd dans cette equation?
Calculer
[email protected] (UM) Robotique 1 20 Janvier 2020 27 / 42
![Page 28: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/28.jpg)
Introduction a la robotiqueCommande Dynamique
Espace operationnel
On souhaite controler un robot manipulateur dont le modele dynamiqueest exprime dans l’espace operationnel :
Fc = M(θ)X + Λ(θ, θ) + Fext (13)
Determiner les expressions de M(θ) et Λ(θ, θ)
En utilisant la technique du couple calcule determine un vecteur decommande Fc tel que le comportement du robot dans l’espaceoperationnel soit lineaire.
Conclusions
[email protected] (UM) Robotique 1 20 Janvier 2020 28 / 42
![Page 29: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/29.jpg)
Introduction a la resolution de lacinematique inverse des robots
redondants
[email protected] (UM) Robotique 1 20 Janvier 2020 29 / 42
![Page 30: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/30.jpg)
Modelisation et commande avanceeEtude des robots redondants
Systemes sous-determines
Soit le systeme algebrique :Ax = b (14)
Avec A une matrice de dimension m× n et x un vecteur de dimensionn× 1 et b de dimension m× 1.On considere le cas sous-determine avec : m < n et rang(A) = m. Lesysteme presente un nombre d’equations (m) inferieur aux nombresd’inconnus (n).Le nombre de solution est infinie. On propose alors le choix de minimiserla norme euclidienne du vecteur x. Dans ce cas essayons de trouver quelleest la relation qui permet de realiser cette minimisation. Soit :
argminx
1
2|| x ||22
s.t. : Ax− b = 0
(15)
[email protected] (UM) Robotique 1 20 Janvier 2020 30 / 42
![Page 31: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/31.jpg)
Modelisation et Commande AvanceeEtude des robots redondants
Systemes sous-determines
On propose de determiner sa solution en utilisant les multiplicateurs deLagrange. Soit une nouvelle fonction objectif definie par :
ξ(x) =1
2|| x ||22 +λT (Ax− b)
Avec un vecteur de dimension m. On a maintenant un probleme deminimisation non-contraint avec m+ n variables, les m composantes de bet les n composantes de x. On peut les regrouper dans le vecteur :
y = [xTλT ]T
On peut maintenant etablir la solution de ce probleme par :
∂ξ(x)
∂y= 0
[email protected] (UM) Robotique 1 20 Janvier 2020 31 / 42
![Page 32: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/32.jpg)
Modelisation et Commande AvanceeEtude des robots redondants
Systemes sous-determines
On peut decomposer cette expression en deux solutions :
∂ξ
∂x= x+ATλ = 0n
et∂ξ
∂x= Ax− b = 0m
. On a : x = −ATλ et AATλ− b = 0 De ces deux expressions on endeduit :
x = AT (AAT )−1b (16)
Avec :A+ = AT (AAT )−1 (17)
A+ est appelee la pseudo-inverse de Moore-Penrose de la matrice A ouinverse generalisee.
[email protected] (UM) Robotique 1 20 Janvier 2020 32 / 42
![Page 33: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/33.jpg)
Modelisation et Commande AvanceeEtude des robots redondants
proprietes de la pseudo-inverse
En considerant la relation :Ax = b
avec x = A+b et A+ = AT (AAT )−1, on obtient les proprietes suivantes :
AA+A = A
A+AA+ = A+
(A+A)T = A+A
Une solution particuliere xp peut-etre trouver en utilisant le projecteurdans le noyau de la matrice A. Soit :
xp = A+b+ (I −A+A)z (18)
Avec z un vecteur quelconque.
[email protected] (UM) Robotique 1 20 Janvier 2020 33 / 42
![Page 34: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/34.jpg)
Modelisation et Commande AvanceeEtude des robots redondants
proprietes de la pseudo-inverse
Demonstration :
xp = A+b+ (I −A+A)z
Axp = AAT (AAT )−1b+A(I −AT (AAT )−1A)z
Axp = AAT (AAT )−1b+Az −AAT (AAT )−1Az
Axp = b+Az −Az
soit :Axp = b
[email protected] (UM) Robotique 1 20 Janvier 2020 34 / 42
![Page 35: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/35.jpg)
Modelisation et Commande AvanceeEtude des robots redondants
Exercice : systeme sur-determine
Soit l’ensemble des points suivants :
1 X = [1 3 8 9 13 19 25] et Y = [40 34 28 22 19 15 11]
2 Determiner la droite d’equation Y = a ∗X + b minimisant l’ecartentre la distribution des points et la droite au sens des moindrescarres.
[email protected] (UM) Robotique 1 20 Janvier 2020 35 / 42
![Page 36: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/36.jpg)
Modelisation et Commande AvanceeEtude des robots redondants
Exercice : systeme sur-determine
Soit l’ensemble des points suivants :
(ab
)=
X1 1X2 1...X7 1
+
Y T =
(−1.161737.0875
)(19)
[email protected] (UM) Robotique 1 20 Janvier 2020 36 / 42
![Page 37: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/37.jpg)
Modelisation et Commande AvanceeEtude des robots redondants
Exercice : systeme sous-determine
Soit le systeme suivant a 2 equations et 4 inconnues :
(0.5 −1 3 0.12 1 1.5 2
)a1a2a3a4
=
(1225
)
on obtient :a1a2a3a4
=
(0.5 −1 3 0.12 1 1.5 2
)+(1225
)=
4.381.983.774.30
[email protected] (UM) Robotique 1 20 Janvier 2020 37 / 42
![Page 38: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/38.jpg)
Modelisation et Commande AvanceeEtude des robots redondants
Hierarchie de tache
On suppose que l’on a N taches a realiser sur le robot humanoıde qui estune chaıne cinematique arborescente (CoM, Marche, saisie d’objets,manipulation, evitement de collision, etc..).
Est-il possible d’avoir N taches concurrentes utilisant en meme temps lesarticulations θ du robot humanoıde? Dans une premiere approximation, on
considere donc le probleme suivant :
θ =
N∑k=1
J+k ek (20)
Est-ce que cette solution est viable?
Expliquer l’incoherence de cette proposition.
[email protected] (UM) Robotique 1 20 Janvier 2020 38 / 42
![Page 39: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/39.jpg)
Modelisation et Commande AvanceeEtude des robots redondants
Hierarchie de tache
On propose d’etudier 2 taches e1 et e2 sur le robot humanoıde. Si l’onprend independamment les 2 taches dans le cas general on a :
θ = J+1 e1 + (I− J+
1 J1)Z1 (21)
etθ = J+
2 e2 + (I− J+2 J2)Z2 (22)
avec Z1 et Z2 deux vecteurs quelconques.On peut reecrire la premiere equation en multipliant pat J2 a gauche et adroite :
J2θ = J2J+1 e1 + J2(I− J+
1 J1)Z1 (23)
e2 = J2J+1 e1 + J2(I− J+
1 J1)Z1 (24)
[email protected] (UM) Robotique 1 20 Janvier 2020 39 / 42
![Page 40: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/40.jpg)
Modelisation et Commande AvanceeEtude des robots redondants
Hierarchie de tacheon a :
Z1 = (J2(I− J+1 J1))
+(e2 − J2J+1 e1) (25)
On insere ce resultat dans l’equation (8) et on obtient :
θ∗ = J+1 e1 + (I− J+
1 J1)(J2(I− J+1 J1))
+(e2 − J2J+1 e1) (26)
Avec P1 = (I− J+1 J1) et P2 = (I− J+
2 J2) on a :
θ∗ = J+1 e1 + P1(J2P1)
+(e2 − J2J+1 e1) (27)
On peut simplifier cette equation car P1(J2P1)+ = (J2P1)
+. On obtient :
θ∗ = J+1 e1 + (J2P1)
+(e2 − J2J+1 e1) (28)
[email protected] (UM) Robotique 1 20 Janvier 2020 40 / 42
![Page 41: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/41.jpg)
Modelisation et Commande AvanceeEtude des robots redondants
Hierarchie de tache
θ∗ = J+1 e1 + (J2P1)
+(e2 − J2J+1 e1) (29)
Cette equation peut ainsi se decomposer par :
u1 = J+1 e1 (30)
u2 = (J2P1)+(e2 − J2u1) (31)
et :
θ∗ = u1 + u2 (32)
[email protected] (UM) Robotique 1 20 Janvier 2020 41 / 42
![Page 42: Robotique 1 MI4 - Université de Montpellier](https://reader033.vdocuments.net/reader033/viewer/2022051114/62775470ff9279747645f247/html5/thumbnails/42.jpg)
Modelisation et Commande AvanceeEtude des robots redondants
Hierarchie de tache
Si l’on souhaite generaliser a N taches, on a :
1 u1 = J+1 e1
2 u2 = (J2P1)+(e2 − J2u1)
3 u3 = (J3P2)+(e3 − J3u2)
4 u4 = (J4P3)+(e4 − J4u3)
5 ...
6 uN = (JNPN−1)+(eN − JNuN−1)
7 θ∗ = u1 + u2 + u3 + u4 + ...+ uN
θ∗ =N∑k=1
uk + PNZN (33)
Avec uk = (JkPk−1)+(ek − Jkuk−1), P0 = I et u0 = 0.
[email protected] (UM) Robotique 1 20 Janvier 2020 42 / 42