基于单开链有序求解的机构正向运动学建模原理及其两种求解方法

doi:10.3969/j.issn.1004-132X.2020.14.002

摘要/Abstract

摘要： 提出了一种基于单开链有序求解的机构正向运动学建模原理。将机构分解为一系列具有不同约束度值的单开链单元，再根据约束度总和为零的原则，将一系列单开链单元划分为若干个自由度为零、耦合度为κ_i的基本运动链（BKC_i），逐一按BKC_i建立含最少虚拟变量数目的机构位置方程；给出了具体的数值法和封闭法两种方法。由于数值法较简单，故用κ维搜索法直接求解机构位置方程；封闭法求解时先用Mathematica进行符号处理，从含变量数为κ的机构位置方程中导出一个一元高次的非线性位置正解封闭方程，再求解该一元高次方程。分别给出4个实例予以详细说明与验证。所提原理及求解方法思路清晰，可使机构正向位置方程中的变量和计算量大大减少，适用于求解任意复杂平面机构、空间并联机构的位置正解。

关键词: 并联机构, 位置正解, 有序单开链, 耦合度, 封闭解

Abstract: A novel modeling principle for solving the position forward solution of any mechanism was presented based on ordered SOC units. Firstly, the mechanisms were decomposed into a series of SOC units with different constraint degrees based on the principle of mechanism composition. Then, according to the principle that the sum of all constraint degrees was equal to zero, a series of SOC units were grouped into several basic kinematic chains(BKC_i) with zero degree-of-freedom and the value of coupling degree was κ_i. Position equations for each BKC_i with the minimum number of variables were obtained. In addition, two methods, i.e., numerical solution and closed-form solution were given. The numerical method was relatively simple, and the position equation of the mechanisms was solved directly by κ-dimensional search method. However, the closed-form solution, nonlinear position equations with higher order were firstly derived from the position equation of the mechanisms with κ virtual variables by using the symbolic processing of Mathematica, and then the higher order equation was solved by using the conventional method. Four examples were illustrated in details. The solving processes of the kinematics modeling principle that considers the ordered topological decomposition and SOC unit solution and its two methods are clear, and the solving method for forward solution of parallel mechanisms may be simplified and its calculation amounts are greatly reduced. The kinematics modelling principle is suitable for solving the position forward solution of any complex planar and spatial parallel mechanisms.

Key words: parallel mechanism, position forward solution, ordered single-open-chain(SOC), coupling degree, closed-form solution

中图分类号:

TH112

沈惠平, 许可, 杨廷力. 基于单开链有序求解的机构正向运动学建模原理及其两种求解方法[J]. 中国机械工程, 2020, 31(14): 1647-1658.

SHEN Huiping, XU Ke, YANG Tingli. A Novel Forward Position Kinematics Modelling Principle for Mechanisms Based on Ordered Solutions for SOC Units and Its Two Solving Methods[J]. China Mechanical Engineering, 2020, 31(14): 1647-1658.

参考文献

[1] ROONEY G T. Constraint Approach to Displacement Analysis of Planer Linkages[J]. Mechanism, 1972(9):60-63.
[2] JALÓN J G D, SERNA M A, AVILÉS R, et al. Computer Method for Kinematic Analysis of Lower-pair Mechanisms[J]. Mechanism & Machine Theory, 1981, 16(5):543-566.
[3] PENNOCK G R, HASAN A. A Polynomial Equation for a Coupler Curve of the Double Butterfly Linkage[J]. Journal of Mechanical Design, 2002, 124(1):39-46.
[4] KINZEL G L, CHANG C. The Analysis of Planar Linkage Using a Modular Approach[J]. Mechanism and Machine Theory,1984, 19(1):165-172.
[5] KONG X, GOSSELIN C M. Generation and Forward Displacement Analysis of RPR-PR-RPR Analytic Planar Parallel Manipulators[J].Journal of Mechanical Design,2001, 8(18):2195-304.
[6] 罗佑新,黎大志. 求一般6-SPS并联机器人机构的全部置正解的混沌迭代法[J].工程设计学报, 2003, 10(2):70-74. LUO Youxin, LI Dazhi. Finding allSolutions to Forward Displacement Analysis Problem of 6-SPS Parallel Robot Mechanism with Chaos-iteration Method[J]. Journal of Engineering Design, 2003, 10(2):70-74.
[7] 曲易远,黄真. 空间六自由度多回路机构位置的三维搜索方法[J].机器人, 1989, 3(5):25-29. QU Yiyuan, HUANG Zhen. Three-dinensional Optimization Algorithm of Six-DOF Multi-loop Spatial Mechanism[J]. Robot, 1989, 3(5):25-29.
[8] 刘安心,杨廷力. 机械系统运动学设计[M]. 北京:中国石化出版社, 1999. LIU Anxin, YANG Tingli. Kinematic Design of Mechanical System[M]. Beijing:China Petrochemical Press, 1999.
[9] 刘安心,杨廷力. 求一般6-SPS并联机器人机构的全部位置正解[J].机械科学与技术, 1996, 15(4):543-546. LIU Anxin, YANG Tingli. Finding All Solutions to Forward Displacement Analysis Problem of 6-SPS Parallel Robot Mechanism[J].Mechanical Science and Technology, 1996,15(4):543-546.
[10] 黄昔光,廖启征,魏世民,等. 一般6-6型平台并联机构位置正解代数消元法[J]. 机械工程学报, 2009, 45(1):56-61. HUANG Xiguang, LIAO Qizheng, WEI Shimin, et al. Forward Kinematics Analysis of the General 6-6 Platform Parallel Mechanism Based on Algebraic Elimination[J]. Journal of Mechanical Engineering, 2009, 45(1):56-61.
[11] 韩林,文福安,梁崇高. 6-5平台型并联机构的位置正解[J]. 北京邮电大学学报, 1998, 21(2):33-37. HAN Lin, WEN Fuan, LIANG Chonggao. Forward Displacement Analysis of the 6-5 Stewart Platform[J]. Journal of Beijing University of Posts and Telecommunications, 1998, 21(2):33-37.
[12] 苏海军,廖启征,梁崇高. 一种5-5型台体并联机器人机构的位置正解[J]. 北京邮电大学学报, 1997, 20(3):1-8. SU Haijun, LIAO Qizheng, LIANG Chonggao. Forward Positional Analysis for a Kind of 5-5 Platform In-parallel Robotic Mechanism[J]. Journal of Beijing University of Posts and Telecommunications, 1997, 20(3):1-8.
[13] 张英,廖启征,魏世民. 一般6-4台体型并联机构位置正解分析[J]. 机械工程学报,2012,48(9):26-32. ZHANG Ying,LIAO Qizheng,WEI Shimin. Forward Displacement Analysis of a General 6-4 In-parallel Platform[J].Journal of Mechanical Engineering,2012,48(9):26-32.
[14] LIAO Qizheng,SENEVIRATNE L D,EARLES S W E. Forward Positional Analysis for the General 4-6 In-parallel Platform[J].Proceedings of the Institution of Mechanical Engineers, Part C:Journal of Mechanical Engineering Science,1995,209(13):55-67.
[15] 梁崇高,荣辉. 一种Stewart平台型机械手位移正解[J].机械工程学报,1991,27(2):26-30. LIANG Chonggao,RONG Hui. The Forward Displacement Solution to a Stewart Platform Type Manipulator[J]. Journal of Mechanical Engineering,1991,27(2):26-30.
[16] 黄昔光,廖启征,魏世民,等. 基于Groebner-Sylvester法的一般6-6型台体并联机构位置正解[J]. 西安交通大学学报,2008,42(3):300-303. HUANG Xiguang,LIAO Qizheng,WEI Shimin,et al. Forward Kinematics of General 6-6 Stewart Mechanisms Based on Grobner-sylvester Approach[J]. Journal of Xian Jiaotong University,2008,42(3):300-303.
[17] NANUA P,WALDRON K J. Direct Kinematic Solution of a Stewart Platform[C]//Proceedings of the IEEE International Conference on Robotics and Automation. Scottsdale,1989:431-437.
[18] HUSAIN M,WALDRON K J. Direct position Kinematics of the 3-1-1-1 Stewart Platforms[J]. Journal of Mechanical Design, 1994, 116(4):1102-1107.
[19] WAMPLER C W. Forward Displacement Analysis of General Six-in-parallel SPS(Stewart) Platform Manipulator Using Soma Coordinates[J]. Mechanism and Machine Theory, 1996, 31(3):311-337.
[20] HUSTY M L. Algorithm for Solving the Direct Kinematic of Stewart-gough-type Platforms[J]. Mechanism and Machine Theory, 1996, 31(4):365-380.
[21] DASGUPTA B,MRUTHYUNJAYA T S. A Constructive Predictor-corrector Algorithm for the Direct Position Kinematics Problem for a General 6-6 Stewart Platform[J]. Mechanism and Machine Theory,1996,31(6):799-811.
[22] SREENIVASAN S V,NANUA P. Solution of the Direct Position Kinematics Problem of the General Stewart Platform Using Advanced Polynomial Continuation[C]//Proceedings of the 22nd Biennial Mechanisms Conference. New York, 1992:99-106.
[23] 陈宁新,白师贤. 6-6型Stewart并联机器人的正向位移分析[J]. 机械科学与技术,1994,13(3):46-52. CHEN Ningxin, BAI Shixian. Forward Position Analysis of the 6-6 Stewart Platform[J]. Mechanical Science and Technology, 1994,13(3):46-52.
[24] 沈惠平,尹洪波,王振,等.基于拓扑结构分析的求解6-SPS并联机构位置正解的研究[J].机械工程学报,2013, 49(21):70-80. SHEN Huiping, YIN Hongbo, WANG Zhen, et al. Research on Forward Position Solutions for 6-SPS Parallel Mechanisms Based on Topology Structure Analysis[J]. Journal of Mechanical Engineering, 2013, 49(21):70-80.
[25] 杨廷力,刘安心,罗玉峰,等.机器人机构拓扑结构设计[M]. 北京:科学出版社,2012. YANG Tingli, LIU Anxin,LUO Yufeng,et al. Theory and Application of Robot Mechanism Topology[M]. Beijing:Science Press,2012.
[26] YANG Tingli,LIU Anxin,SHEN Huiping,et al. Topology Design of Robot Mechanisms[M]. Singapore:Springer Publishing Company,2018.
[27] 沈惠平,朱小蓉,尹洪波,等,并联机构的结构降耦原理与设计方法研究[J].机械工程学报, 2016, 52(8):388-398. SHEN Huiping, ZHU Xiaorong, YIN Hongbo, et al. Principle and Design Method for Structure Coupling -Reducing of Parallel Mechanisms[J]. Journal of Mechanical Engineering, 2016, 52(8):388-398.
[28] 许可.基于耦合度分析的并联机构运动学研究[D].常州:常州大学,2018. XU Ke.Kinematics Study for Parellel Mechanisms Based on Coupling Degree[D].Changzhou:Changzhou University,2018.
[29] 沈惠平,许可,邓嘉鸣,等. 运动解耦和低耦合度选择顺应性装配机器手臂并联机构的设计及其运动分析[J]. 中国机械工程,2018,29(8):883-892. SHEN Huiping, XU Ke, DENG Jiaming, et al. Design and Kinematics of a SCARA Parallel Mechanism with Motion Decoupling and Low Coupling Degree[J]. China Mechanical Engineering, 2018, 29(8):883-892.
[30] ROJAS N, THOMAS F.On Closed-form Solutions to the Position Analysis of Baranov Trusses[J].Mechanism and Machine Theory, 2012, 50:179-196.
[31] 沈惠平,赵迎春,许可,等. 一种可重构、部分运动解耦的空间n维平移1维转动并联机构的拓扑及其运动学设计[J].中国机械工程, 2019, 30(4):413-422. SHEN Huiping,ZHAO Yingchun,XU Ke,et al. Topology and Kinematics Design of Spatially nT1R-type Reconfigurable and Partial Motion Decoupling Parallel Mechanism[J].China Mechanical Engineering, 2019, 30(4):413-422.