3-RPS型并联机构运动正解的研究
2022-09-25
来源:步旅网
第32卷第3期 2014年05月 佳木斯大学学报(自然科学版) Journal of Jiamusi University(Natural Science Edition) V01.32 No.3 May 2014 文章编号:1008—1402(2014)O3—0412—03 3一RPS型并联机构运动正解的研究① 任文博,颜兵兵,殷宝麟,帅俊峰 (佳木斯大学机械工程学院,黑龙江佳木斯154007) 摘要: 并联机构运动学正解是一个位置和姿态耦合的复杂非线性问题,一般难以求得封闭形 式的解析解.应用解析法对3一RPS型并联机构进行运动学正解问题进行了求解,并给出正解方 程通式以及各项系数值,得到封闭形式的解析解.并给出具体数值实例进行求解,得出全部位置 解,同时给出部分机构空间图形验证了解法可靠性. 关键词:3一RPS型并联机构;运动学正解;解析法 中图分类号:TP242 文献标识码:A O 引 言 并联机构(Parallel Mechanism,简称PM)¨ J, 可以定义为动平台和定平台通过至少两个独立的 运动链相连接,机构具有两个或两个以上自由度, 且以并联方式驱动的一种闭环机构.与串联机器人 相同的运动支链连接运动平台与基座.其中第i运 动支链(i=1,2,3)与基座Bi点处通过转动副R 连接,与运动平台 点处通过球面副.s 连接,R 与 S 间通过主动移动副P 连接.设定基座坐标系0 Y ,其中0 位于基座形状中心, 轴、Y 轴 处于基座平面内.设定基座坐标系O肘一 Y , 其中0 位于基座形状中心, 轴、Y 轴处于运动 一 相比具有无累积误差、负载力大、工作空间小,并且 结构简单,动态响应好等特点 J,而被学者广泛 研究. 平台平面内.设定0 B 与 轴夹角为 且R 的 轴线与0 B 垂直,0村Mi与 Ⅳ轴夹角为 胁.. 机构的运动学分析包括两种问题,即运动学正 解和运动学反解.运动学正解(即已知输入杆长参 运动平 数求出运动平台的位置和姿态)是解决机构速度、 加速度以及其他的受力分析、工作空间分析和机构 综合等问题的基础 .4],而运动学正解却包含非线 性方程组而十分复杂.求解正解通常采用解析法和 数值法,数值法多采用Newton—Raphson法、杆长 修正法、同伦连续法等等 J,但是这种方法不一 定能得到运动学正解的全部解,而且对初值的要求 较高,解析法包括矢量代数法、几何法、矩阵法、对 偶矩阵法、螺旋代数法、四元素代数法等等-l J. 本文对3一RPS型并联机构进行运动学正解 应用几何解析法进行了求解,得到全部的位置解, 并给出对应空间图形,验证实数解的正确性. f支链 固定 1 建立坐标系及约束方程 图1 3一RPS型并联机构 3一RPS型并联机构如图1所示,由三条结构 ① 收稿日期:2014一o2—20 基金项目:St育部科学技术研究重点项目(212042);黑龙江省教育厅科学技术研究项目(面上)(12531671);黑龙江省普通高等 学校新世纪优秀人才培养计划项目(1252一NCET一021). 作者简介:任文博(1991一),男,黑龙江哈尔滨人,硕士研究生,主要从事机器人、复杂系统建模仿真方面研究,通讯作者:颜兵兵 (1976一),黑龙江佳木斯人,副教授,工学博士. 第3期 任文博,等:3一RPS型并联机构运动正解的研究 413 若基座半径为 ,运动平台半径为 ,设定 一2R;+2 ;sin 研sin ̄o傩 (7) fMf=ff, 与0日Bl间夹角为0 ,则B 点在O口 K =一2R口 cos cos 肼一 一2 sintpBisintp傩 一 ), 中的坐标可表示为 +2 BZBjsinq ̄Bjsintp雎+2 2 cos 坷c0s 融 R Be  ̄s ̄ ̄ei]j +2R cos cos m—ZRnli+2 ;sin sin 船 (1) 一 一2R 一2 coseCc0s 雎+2R日 + 一2 口 sin 研sin 融 (8) =8tit (9) 乏二 j =2R sin 巧sin 傩一2‘ sin ̄jsintp i 2R口 (2) +2Rnsin(pcisintp 一2llf ̄cos 坷cos 雎 一2 日 cos cos 一2RB 8ir 毋sin 船 由于几何封闭关系可知, 任意两点间距 +2 +2R cos 巧cos ̄p戤+2R口 costpqcos 雎 离不变,其中下标(_『,k)=(1,2),(2,3),(1,3), 一2 一z + 一 (1o) 即 =2Rsl ̄+2Rnl ̄一2 ;一2R口 cos 巧cos 雎 ( 柳一 胁) +(y 一y ) +( 一 ) = +2R;sin simp 一2R口 cos ̄sic0s 雎 (3) +2 sin 目sin(p肼+2R2 c0s 蟛c0s 雎+ 式中 为 任意两点间距离可表示为 一2R口 sin sin(p +2 cos 厨cDs 戤 一2尺口 sin ̄eisin 船一 一 (11) =2R s( ) (4) 通过解方程组(6)可求得 。, , ,的符号解, 设定 将结果代入式(5)得0 ,02和0,,进一步代入式(2) tan譬 可求得动平台上各球铰在固定坐标系的坐标以及 动坐标系的回转变换矩阵. 则cos =}焉’si的 = ,并将其与式 2 数值实例 (2)一起代人(3)中,得到三个代数方程,即 若3一RPS型并联机构的结构参数如下: = K城 + + 十 + =0(6) 0.1m,RM=0.05m,Z1=0.24m,Z2=0.18m,Z3= 式(6)中的各项系数分别为 O.2m, 肼= =(i-1)丁2 将已知量带人方程 Kl =2尺 cos 巧cos 雎一乎一l 一2R口1 一2R口 +t嚷+2 sin ̄Bjsin ̄ek+2R sin 茸 雠 (5),求得16组解,其中12组实数解,4组复数解, +2R口Z,cos 琦cos 雎+2R口l七cos cosq ̄ek 所得结果如表1. +2RB/jsimpBjsintpB +2 zkcos Bjcos m 表1 非线性方程组的全部解 No. I 2 X3 No. 0.58189254 O.94222572 0.41162344 9 0.39482864 0.95861922 0.5O27871 1 —0.58189204 一O.9422257 —0.41162349 10 一0.95861922 一O.5O27871 1 0.3489O266 O.86253813 O.66o75580 ll O.37431935 O.4985O891 0.86561080 ——0.3489o266 —0.86253813 一0.66O7558O 12 —0.37431935 0.49850891 —0.86561080 0.51944351— O.3485O849— 0.341 1+ O.7506O912 0.69383374 0.80537655 3.232492660・1 0.013172279・I 0.015390624・, 一O.5l944351一 —O.3485O849+ 一0.34192251— 6 —0.75060912 —0.69383374 —0.80537655 14 O.232鹌I2660・I 0.013172279・1 0.01539o624+1 O.51944351+ 0.3485O849+ 0.3419225175—0. 7 0.7O473225 0.48344596 0.86200903 15 O.23249266O・I 0.013172279・1 1539O62435e一1・I 414 佳木斯大学学报(自然科学版) 2014年 一0.51944351一 一0.34850849一 一O.34192251+ 8 —0.70473225 —0.48344596 —0.86200903 16 0.232492660・1 0.013172279・1 0.015390624十1 表2给出了其中l2组实数解对应的机构第i运动支链与0 B 间的夹角0 . 表2 并联机构运动学正解实数解(度) 由表1,表2可知l6组解中有12组实数解,对 下方.前6组实数解对应空间图形,如图2(a)至 应于其中的6组解的运动平台位于固定的上方,而 (f)所示. 对应于另外的6组解的运动平台位于固定平台的 B , (a) (b) B3 (d) (f) 图2部分实数解对应的机构空间图形 3 结 论 解12组,复数解4组,并针对所求得的部分实数解 进行了空间图形验证.结果表明,针对3一RPS型 由几何封闭关系建立了3一RPS型并联机构 并联机构所建立的运动学正解方程组求解方法精 运动学正解方程,对所建立的非线性方程组进行了 确、可靠. 求解,获得运动学正解方程全部16组解,其中实数 (下转423页) 第3期 李敏,等:基于STM32和LABVIEW的电机磁环极对数检测系统设计423 件及周边电路质量,同时通过系统进行参数显示及 线检测要求. 报警,并以文字和图形化方式显示传感器输出的波 形的一系列参数,能保存不合格产品信息,信息数 参考文献: 据能以EXECL表格形式导出,便于企业产品数据 [1] 王金艳.霍尔传感器转速检测系统的设计与研究[D].哈尔 统一管理.系统提高了产品检测效率和管理水平. 滨:黑龙江大学,2o10. [2]汪云.基于霍尔传感器的转速检测装置[J].传感器技术, 整体性能满足了空调整机厂电机抽检或流水线在 2003,22(10):45—47. Design of Magnetic Pole Pairs Detection System Based on STM32 and LABVⅡ W LI Min,QIAN Feng,ZHOU Xian一厂e (Institute of Information Engineering,Wuhu Instiutte of Technology,Wuhu 241006,China) Abstract: STM32F101 T6 processor was used as an internal motor hall sensor signal data’s acquisiiton and processing to test the electrical components and peripheral electronic components’status.The processed da- ta were sent to the display computer via the serial interface.The motor set’s parameters prepared in advance were compared wiht the magnetic pole paisr’parameters in order to achieve the motor magnetic pole paisr’eiTor detection.By using LABVIEW in this system software,through the text and graphics,it can display the frequen— cy,duty cycle and amplitude of square wave singal emitted by an intemal motor hall sensor,along with hte func— tion of the damaged product dam’s record—keeping.The system can be used for motors of on line air—condi— tioners. Key words:LABVIEW;STM32;magnetic pole paisr;hall sensor (上接414页) 杆长逼近法[J].东北大学学报(自然科学版),2001,22 参考文献: (3):285-287. [1]Murthy V,Waldron K J.Position Kinematics of the Generlaized [9]韩方元,赵丁选,李天宇.3一RPS并联机构正解快速数值算 Lobster Ann and Its Seires—Parallel Dual[J].Journal of Me— 法[J].农业机械学报,2011,42(4):229—233. chanieal Design,1992,114:406. [1O]刘宏伟,马质璞.3一PRS并联机构运动分析及仿真[J].机 f2]Stewa ̄D A.Platform with 6一DOE Proc[J].On Institution of 械设计与制造,2012,(1):211—215. Mechanical Engineering.1965,18(1):371—386. [11]Wad&on K J,l ̄#avan M,Ruth B.Kinematics of a Hybrid [3]Bo.nev I.The Tme Orislns ofParallel Robots[J].The Parallel Seires—ParallelManipulation System[J].ASME Joumal ofDr- Mechanisms Information Center.2o02. namic Systems,Measurement and Control,1989,l11(2):2l1 [4]黄真,赵永生,赵铁石.高等空间机构学[M].北京:高等教 —221. 育出版社.20o6. [12]Hashimotu Minom,Imamura Yuichi.Kinematic Anslysi8 nad [5]黄真,丁华锋.机构的结构类型综合综述[J].燕山大学学 Design of a 3 DOF Parallel Mechanism for a Passive Compliant 报,2003,27(3):189—191. wri8t of Manipulatom[J].Transactions of the Japan¥ociety of [6]刘宏伟,马质璞.3一PRS并联机构运动分析及仿真[J].机 Mechanical Engineers,1998,C64:2 116-2123. 械设计与制造,2012,(I):211—215. [13]Pfi'eundschun G H,KhmerV,ThomasG S.Desing nad Control [7]韩先国.陈五一,陈鼎昌.基于路径跟踪原理求解6一SPS并 of a 3 DOF In—parallel Acutated Manipulator[C].Proceedings 联机构位置正解[J].北京航空航天大学学报,20o2(6): of IEEE International Conference on Robotics and Automation。 370—372. 1991。2:1 659—1664. [8] 李树军,王阴,王晓光.3一RP¥并联机器人机构位置正解的 Research on Direct Kinematics f0r 3一RPS Parallel Mechanism 月 lⅣ re厅一60, 4ⅣBing—bing, 删Bao—Z ,l, SHUM Jun一 ng (College of Mechanical ̄gtneeang,Jiamusi University,Jiamusi 154007,China) Abstract:Direct kinematics of parallel mechanism is a complex and nonlinear problem of atittude coupled and posiiton.Generally it is diifcult to obtain closed—form analytical solution.And inverse kinematics equations of the mechanism were derived.The direct kinematics problem of 3一RPS parallel mechanism was solved by ana。 lytical method,positive solution of hte equation formula and coefifcient values were given and obtained in closed —ofrm analytical solution.The reliability of hte method was veriifed based on solve speciifc numerical examples and drew part of hte space agency graphical wit}l all the posiiton solution. Key words: 3一RPS parallel mechanism;direct kinematics;analytical metll0d