Formal analysis of the kinematic Jacobian in screw theory

Abstract

Abstract

As robotic systems flourish, reliability has become a topic of paramount importance in the human–robot relationship. The Jacobian matrix in screw theory underpins the design and optimization of robotic manipulators. Kernel properties of robotic manipulators, including dexterity and singularity, are characterized with the Jacobian matrix. The accurate specification and the rigorous analysis of the Jacobian matrix are indispensable in guaranteeing correct evaluation of the kinematics performance of manipulators. In this paper, a formal method for analyzing the Jacobian matrix in screw theory is presented using the higher-order logic theorem prover HOL4. Formalizations of twists and the forward kinematics are performed using the product of exponentials formula and the theory of functional matrices. To the best of our knowledge, this work is the first to formally analyze the kinematic Jacobian using theorem proving. The formal modeling and analysis of the Stanford manipulator demonstrate the effectiveness and applicability of the proposed approach to the formal verification of the kinematic properties of robotic manipulators.

References

1. AC17 Affeldt R, Cohen C (2017) Formal foundations of 3D geometry to model robot manipulators. In: ACM sigplan conference on certified programs and proofs, pp 30–42
2. AD16 Aransay JDivasn JFormalisation of the computation of the echelon form of a matrix in Isabelle/HOLForm Asp Comput2016286122355124910.1007/s00165-016-0383-1
3. AMC+12 Amine SMasouleh MTCaro SWenger PGosselin CSingularity analysis of 3T2R parallel mechanisms using Grassmann–Cayley algebra and grassmann geometryMech Mach Theory20125232634010.1016/j.mechmachtheory.2011.11.015
4. BKL08 Baier CKatoen JLarsen KGPrinciples of model checking2008CambridgeMIT Press1179.68076
5. CGH+15 Chen ZGu YHuang ZZheng JLiu CLiu ZModel checking aircraft controller software: a case studySoftw Pract Exp2015457989101710.1002/spe.2242
6. CR12 Choi H-BRyu JSingularity analysis of a four degree-of-freedom parallel manipulator based on an expanded 6 × 6 Jacobian matrixMech Mach Theory201257516110.1016/j.mechmachtheory.2012.06.008
7. CWZL09 Chen GWang HZhao KLin ZModular calculation of the Jacobian matrix and its application to the performance analyses of a forging robotAdv Robot200923101261127910.1163/156855309X462574
8. DRGR13 Darvekar SRao ABKGanesh SSRamji KOptimal design and development of a 2-DOF PKM-based machine toolInt J Adv Manuf Technol2013675–81609162110.1007/s00170-012-4594-1
9. FHI13 Farooq BinyameenHasan OsmanIqbal SohailFormal Kinematic Analysis of the Two-Link Planar ManipulatorFormal Methods and Software Engineering2013Berlin, HeidelbergSpringer Berlin Heidelberg34736210.1007/978-3-642-41202-8_23
10. FT03 Fang YTsai L-WInverse velocity and singularity analysis of low-DOF serial manipulatorsJ Robot Syst200320417718810.1002/rob.10079
11. GG97 Ghorbel FGunawardana RA uniform bound for the Jacobian of the gravitational force vector for a class of robot manipulatorsTrans Am Soc Mech Eng J Dyn Syst Meas Control199711911011410.1115/1.2801200
12. GM93 Gordon MJCMelham TFIntroduction to HOL: a theorem proving environment for higher order logic1993CambridgeCambridge Univeristy Press0779.68007
13. Har05 Harrison JohnA HOL Theory of Euclidean SpaceLecture Notes in Computer Science2005Berlin, HeidelbergSpringer Berlin Heidelberg114129
14. HL14 Han XLiu YGeometric condition of 3UPS-S parallel mechanism in singular configurationChin J Mech Eng201427113013710.3901/CJME.2014.01.130
15. HLC11 Huang TLiu HTChetwynd DGGeneralized Jacobian analysis of lower mobility manipulatorsMech Mach Theory201146683184410.1016/j.mechmachtheory.2011.01.009
16. HYW+15 Huang TYang SWang MSun TChetwynd DGAn approach to determining the unknown twist/wrench subspaces of lower mobility serial kinematic chainsJ Mech Robot20157303100310.1115/1.4028622
17. MLSS94 Murray RMLi ZSastry SSSastry SSA mathematical introduction to robotic manipulation1994Boca RatonCRC Press0858.70001
18. RA15 Rezaei AAkbarzadeh AStudy on Jacobian, singularity and kinematics sensitivity of the FUM 3-PSP parallel manipulatorMech Mach Theory20158621123410.1016/j.mechmachtheory.2014.11.009
19. RRL15 Roberts RRodriguez-Leal EKinematic and workspace-based dimensional optimization of a 2-DOF mechanism for a novel multipoint deviceMechatronics20152810311410.1016/j.mechatronics.2015.04.011
20. RTD11 Rocha CRTonetto CPDias AA comparison between the Denavit–Hartenberg and the screw-based methods used in kinematic modeling of robot manipulatorsRobot Comput-Integr Manuf201127472372810.1016/j.rcim.2010.12.009
21. SLG+14 Shi Z, Liu Z, Guan Y, Ye S, Zhang J, Wei H (2014) Formalization of function matrix theory in HOL. J Appl Math, 2014
22. SSL13 Shim H-SSeo TLee JWOptimal torque distribution method for a redundantly actuated 3-RRR parallel robot using a geometrical approachRobotica2013310454955410.1017/S0263574712000562
23. SWH14 Schadlbauer JWalter DRHusty MLThe 3-RPS parallel manipulator from an algebraic viewpointMech Mach Theory20147516117610.1016/j.mechmachtheory.2013.12.007
24. SZL+14 Shi ZZhang YLiu ZKang XGuan YZhang JSong XFormalization of matrix theory in HOL4Adv Mech Eng2014619527610.1155/2014/195276
25. Tsa99 Tsai L-WRobot analysis: the mechanics of serial and parallel manipulators1999New YorkWiley
26. WSL+15 Wu A, Shi Z, Li Y, Wu M, Guan Y, Zhang J, Wei H (2015) Formal kinematic analysis of a general 6R manipulator using the screw theory. Math Probl Eng, 2015
27. ZMG13 Zhang JMao DGuan YFormalization of linear space theory in the higher-order logic proving systemJ Appl Math20132013111030454311315.03021