ALGORITHME NUMERIQUE POURLESCHANGEMENTSDECOORDONNEES DES MECANISMES ARTICULES THESE N 1737 (1997) PRESENTEE AU DEPARTEMENT DE GENIE MECANIQUE ECOLE POLYTECHNIQUE FEDERALE DE LAUSANNE POUR L'OBTENTION DU GRADE DE DOCTEUR ES SCIENCES PAR Olivier CHETELAT Ingenieur electricien diplöme EPF originaire de Montsevelier (JU) acceptee sur propos~ion du jury: P,O!. R. Longchamp. directeur de these Dr A. Codourey. corapporteur PlO!. J.-P. Merlet. corapporteur Dr P. Mysz!<()(owski. corapporteur Plol. M. TlOyanov. corapporteur Lausanne. EPFL 1997
Resume Commande de rabot Cinclllatique Continuation polynollliale Plate-forrne de Gough-Stewart Dans un contexte de commande, l'information en provenanee d'uu meeanisme est generalement disponible en eoordonnccs articulaires. Pour que la eommande puisse avoir le eontrole du mecanisme, il [aut qu'elle soit capahle de calclller la position et l'orientation de chaque solide a. partir de eette information. Denotons l'information en provenance du meeanisme par un veetcur q et la description de la position et de l'orientation de chaquc solide par un veeteur 1/. Formellcment, une fonction polynomiale 1/J : nn ---+ nn deerit eomplctement le ehangerneut de coordonnecs de TJ vers q, c'est-a.-dire que l'on a 1/J (TJ) = (q,o). Le ehangement de eoordonnees invcrse, de q vers 1/, n'existe que localement, ear la fonction 1/J n'est gcneralement pas hijeetive : plllsieurs modes d'assemblage 1/i ont leur image 1/J (TJi) identiqtle. A un moment donne, la eomlllande ne doit connaltre que lc mode d'assemblage oeeupc rcellcment par le rnccanisme, les autrcs nc l'interessent pas. La seleetion du bon mode d'assemblage 1/ parilli les diffcrents modes TJi n 'est pas tln problcmc ~rivial: cn. toute gener~l~te, l~ hon. TJ,est ~elui ~ui.appar~ient a la sollltlon 17 (t) de l"cqllallon dlffcrentwlle ~ 17 = (q,o). Dans eelte these, on propose un algorithme numerique de complexite polynomiale pour I'intcgration de cette equation qui sera utilise pour le calcul du bon TJ. II faut insister sur le fait qu'uu «algorithrne nurneriqlle» se distingue d'une «methode numerique» dans le sens qu'un algorithme fournit toujouts la honne solntion dans un temps fini (pour nne prccision hornee donnce). En d'autres mots, eontraircment aux Illcthodes numeriques, un algorithme numerique est d'une fiabilitc totale (pas de probleme de convergence ni de saut possible dans un mauvais bassin d'attraetion, mcme en arithmetique a virgule flottante). Pour convaincre de son utilite pratique, l'algorithme propose est applique sur un exemple reputc di/neile (prohlcme du rnoclcle geometrique direct d'une plate-forme de Gough Stewart gcncralisce).
ii Abstract Robot Control Kinematies Polynomial Continuation Gough-Stewart Platforrn The inforrnation on the meehanislll is in general available through the joint eoordinates. Full eont rol of the rneehanism requires that the position and orientation of eaeh solid he derivable from this inforrnation. Let us denote the information cominj?; from the nipehanism hy a vector q and the deseription of the position anc! orientation of each solid hy a vector 1]. Formally, a po!ynomial function 1/J : Rn ---> Rn deserihes totally the coonlinate transformation from 1] to q i.e., 1/1 (1]) = (q, 0). The inverse transforlllation i.e., from q to 1] exists only locally since the function 1/; is usually not bijective: several a~sembly modes, 1].. map to the same vector (q,o). For control purposes, only the assembly mode that describes the eurrent mechanism posture is of interest. The selection of the right a~sembly mode 1] among the different 1]. is not a trivial problern. The generality of the approach requires that the right 7] belong to the solution 1] (t) af the differential equation ~ 7) = (q,o). In this thesis, wc proposcd a numerieal algarithm of polynomial eornplexity that ean be used to compute the right 7] hy integration of this differential equation. lt should be stressed that a "numerical algorithm" is distinguished from a "nurnerical method" sinee the cxpected solution is always (within a given error bound) cornputed in finite time. In other words, unlike numerical methods, a numerical algorithrn cannot fail (no convergenee problems and no possible jurnp onto a wrong attra.cting hassin, even with a f10ating point arithmetic). The efficiency of the proposed algorithm is tested on a reputed diffieult exarnple of a generalized Gough-Stcwart platform.
Table des matieres 1 Introduction 1 1.1 Enoncc du problerne et postulat. 1 1.2 Organisation du mcmoire 3 1.3 Notions clementaircs 4 1.4 Contcxte bibliographique 31 2 Formulation et caracterisation 39 2.1 Formulation. 39 2.2 Caractcrisation... 44 3 Domaines de bijection 51 3.1 Theorcmcs locaux et serni-locaux 51 3.2 Thcorcmcs globaux.. 56 4 Continuation exacte certifiee 61 4.1 Algorithme iteratif. 67 4.2 Reeonstitution de l'information 79 5 Conc1usion 85 A Rappels mathematiques 89 A.1 Mecanique analytique lagrangienne 89 A.2 Norme infinie de Hölder. 92 A.3 Quaternions....... 93 A.4 Reeonstitution de Shannon 95 B Programmation en Matlab 91 B.1 Paramctres d'entree (exemple 16) 97 8.2 Paramctn'_'i d'entree (excmplc 18) 101 v
vi TABLE DES MATIERES C B.3 Represcntation unifi6c B.4 Algorithme.. Resultats annexes C.1 Rcmarques sur la formulation C.2 Domaincs dc bijcction 106 109 115 115 118 Bibliographie Index Curriculum vitre 131 139 143