2PRC-PRS并联平台运动学分析与控制系统开发

韩博; 许允斗; 姚建涛; 苏弘良; 平立发; 赵永生

doi:10.11975/j.issn.1002-6819.2016.14.005

2PRC-PRS并联平台运动学分析与控制系统开发

1.
燕山大学河北省并联机器人与机电系统实验室，秦皇岛 066004
2.
燕山大学先进锻压成形技术与科学教育部重点实验室，秦皇岛 066004

基金项目: 国家自然科学基金资助项目（51275439和51405425）；河北省重点基础研究项目（15961805D）；燕山大学青年教师自主研究计划课题（13LGA001）。

计量
- 文章访问数: 2524
- HTML全文浏览量: 0
- PDF下载量: 883
出版历程
- 收稿日期: 2015-11-05
- 修回日期: 2016-05-21
- 发布日期: 2016-07-14

Kinematic analysis of 2PRC-PRS parallel platform and development of control system

1.
Parallel Robot Mechatronic System Laboratory of Hebei Province, Yanshan University, Qinhuangdao 066004, China
2.
Key Laboratory of Advanced Forging & Stamping Technology and Science of Ministry of Education, Yanshan University, Qinhuangdao 066004, China

摘要

摘要: 为拓展少自由度并联机器人在农业工程中的应用，提出一种具有两转一移（2R1T）3自由度的2PRC-PRS并联机构，基于反螺旋理论对机构的自由度及运动特性进行了分析，并推导出了机构的位置反解；设计制造了2PRC-PRS并联平台样机，结合贝加莱公司生产的伺服运动控制器，添加相应外围设备，对并联平台设计了一套基于POWERLINK总线的网络化运动控制系统，组装了电控柜，并以Automation Studio 3.0为软件开发平台，基于ST编程语言开发了控制软件；在并联平台和电控柜以及控制软件的基础上，完成了伺服电机三环参数整定、电子齿轮试验、平台综合运动控制试验以及无线网络远程控制试验。为深入研究此类少自由度并联机器人奠定了理论和试验基础，丰富了工业网络实时控制系统的实践经验，也为此类机电一体化设备的研发提供了参考。
- 并联 /
- 机构 /
- 软件开发 /
- 螺旋理论 /
- 位置反解 /
- 控制系统 /
- 网络远程控制
Abstract: Abstract: Agricultural engineering operations are often conducted in complex ground conditions such as fields on a hill, forest land, and hilly land. Compared with 6 degrees of freedom (DOFs) parallel robot, lower-mobility parallel robot is especially suitable for picking, planting and transporting crops in complex ground conditions with the advantages of fewer actuators, fewer components, easy control, easy fabrication, low cost, and so on. One translational and two rotational DOFs parallel mechanism is a representative of lower-mobility parallel robot. In order to expand the application of lower-mobility parallel robot in agriculture, this paper presented a novel 2PRC-PRS parallel mechanism, which has one translational DOF and two rotational DOFs. The motion characteristics of the mechanism and its number of DOFs were analyzed based on the theory of reciprocal screw, and through establishing the moving coordinate system and the fixed coordinate system of the parallel platform, the kinematic screw system of each branch and the corresponding constraint wrenches were calculated, the reciprocal kinematic screws of the constraint wrenches of each branch were solved, and then the DOF nature of the moving platform was analyzed based on the kinematic screws of the moving platform. It concluded that the moving platform had 3 DOFs, which were respectively the movement along the vertical direction and the rotations along the two directions which are perpendicular in the horizontal plane. After analyzing the number of DOFs and the motion characteristics of the 2PRC-PRS parallel mechanism, whether the DOF of the moving platform was instantaneous or not was checked. The results showed that the DOF of the 2PRC-PRS parallel mechanism was not instantaneous, and it was continuous. By adopting Z-X-Y Euler angle to describe posture and position of the parallel platform, the inverse position of the parallel platform was calculated. The model machine of the 2PRC-PRS parallel platform was designed and manufactured; combined with the servo motion controller produced by the Bernecker&Rainer industrial automation company, add the appropriate peripherals, design and set up a network motion control system based on Powerlinks bus for the 2PRC-PRS parallel platform, and assemble the electric control cabinet, the control system included human-computer interaction module, master display module, servo-driven module, sensing module and security module. Adopt modularization approach, and based on the ST programming language, develop the 2PRC-PRS parallel platform control software on Automation Studio 3.0 software development platform. It included interactive interface, security alarm, calibration by returning to zero, uniaxial control, multi-axis control, I/O control, spindle control, and so on, which satisfied the basic demands of the experiment. Then the relevant experiments were carried out based on parallel platform, cabinet and control software. Through the regulation of the speed loop and the position loop of the servo motor, the servo motor parameters tuning was completed, and the electronic gear test was completed by writing electronic gear control program under the position control mode. When the electronic gear ratio was 4:1, and the driving shaft speed was set to 2000, the actual value of the driven shaft speed was 500, and the displacement change of the driving shaft and the driven shaft were also in line with expectations, so the electronic gear experiment was successful, and the control system of high precision met the design requirements. The trajectory planning of the moving platform was carried out and the inverse data were calculated, then the interpolation calculation was conducted. And the interpolation moving data point was carried out by inputting the parallel platform inverse data into the control software. The moving platform moved in accordance with the moving data point after it came back to the initial position and it achieved the expected effect. Finally, combined with the network communication technology, the wireless network remote control experiment was performed separately on IOS mobile terminal under the intranet and PC (personal computer) under extranet, which basically achieved the expected target, and also found the signal transmission delay phenomenon, especially under the condition of wide-area the internet image delay was more obvious. This issue will be further researched. This paper is aimed to provide the theoretical and experimental foundation for the agricultural lower-mobility parallel robot and provide the reference for the researching of this mechatronics equipment.
- parallel /
- mechanisms /
- software development /
- screw theory /
- inverse position /
- control systems /
- network remote control

HTML全文

参考文献(28)

[1]	Van Henten E J, Schenk E J, van Willigenburg L G, et al. Collision-free inverse kinematics of the redundant seven-link manipulator used in a cucumber picking robot[J]. Biosystems Engineering, 2010, 106(2): 112－124.
[2]	Tanner H G, Kyriakopoulos K J, Krikelis N I. Advanced agricultural robots: kinematics and dynamics of multiple mobile manipulators handling non-rigid material[J]. Computers and Electronics in Agriculture, 2001, 31(1): 91－105.
[3]	Van Henten E J, Van't Slot D A, Hol C W J, et al. Optimal manipulator design for a cucumber harvesting robot[J]. Computers and Electronics in Agriculture, 2009, 65(2): 247－257.
[4]	高国琴，王威，丁琴琴. 农业并联机器人同步滑模控制[J]. 农业机械学报，2012，43(9)：173－178，196.Gao Guoqin, Wang Wei, Ding Qinqin. Synchronization Sliding mode control for agricultural parallel robot[J]. Transactions of the Chinese Society for Agricultural Machinery, 2012, 43(9): 173－178, 196. (in Chinese with English abstract)
[5]	Geng Changxing, Zhang Kai, Zhang Erpeng, et al. Assessment on spraying effect of intelligent spraying robot by experiment[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2012, 28(2): 114－117.
[6]	姜凯，郑文刚，张骞，等. 蔬菜嫁接机器人研制与试验[J]. 农业工程学报，2012，28(4)：8－14.Jiang Kai, Zheng Wengang, Zhang Qian, et al. Development and experiment of vegetable grafting robot[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2012, 28(4): 8－14. (in Chinese with English abstract)
[7]	荣誉，金振林，曲梦可. 三自由度并联机械腿静力学分析与优化[J]. 农业工程学报，2012，28(20)：41－49.Rong Yu, Jin Zhenlin, Qu Mengke. Statics analysis and optimal design of 3-DOF parallel mechanical leg[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2012, 28(20): 41－49. (in Chinese with English abstract)
[8]	Hunt K H. Structural kinematics of in-parallel-actuated robot arms[J]. Journal of Mechanisms, Transmissions and Automation In Design, Transactions of the ASME, 1983, 105: 705－712.
[9]	路懿，胡波. 少自由度并联机构研究进展[J]. 燕山大学学报，2011，35(5)：377－384.Lu Yi, Hu Bo. Development evaluation of limited-DOF parallel manipulators[J]. Journal of Yanshan University, 2011, 35(5): 377－384. (in Chinese with English abstract)
[10]	王飞博，吴伟峰，陈祥，等. 基于运动/力传递特性的1T2R并联机构构型优选[J]. 机械工程学报，2014，50(23)：20－28.Wang Feibo, Wu Weifeng, Chen Xiang, et al. Optimal type selection of 1T2R parallel mechanisms based on motion/force transmissibility[J]. Journal of Mechanical engineering, 2014, 50(23): 20－28. (in Chinese with English abstract)
[11]	李秦川，孙晓东，陈巧红，等. 2-PRS-PRRU并联机构运动学与奇异分析[J]. 机械工程学报，2011，47(3)：21－27.Li Qinchuan, Sun Xiaodong, Chen Qiaohong, et al. Kinematics and singularity analysis of 2-PRS-PRRU parallel mechanism[J]. Journal of Mechanical Engineering, 2011, 47(3): 21－27. (in Chinese with English abstract)
[12]	曾达幸，胡志涛，侯雨雷，等. 基于螺旋理论的两转一移解耦并联机构型综合[J]. 燕山大学学报，2014，38(1)：22－28.Zeng Daxing, Hu Zhitao, Hou Yulei, et al. Type synthesis of 2R1T decoupled parallel mechanism based on screw theory[J]. Journal of Yanshan University, 2014, 38(1): 22－28. (in Chinese with English abstract)
[13]	王庚祥，刘宏昭，原大宁. 空间4-SPS/CU并联机构的受力分析[J]. 农业工程学报，2012，28(22)：30－38.Wang Gengxiang, Liu Hongzhao, Yuan Daning. Force analysis of spatial 4-SPS/CU parallel mechanism[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2012, 28(22): 30－38. (in Chinese with English abstract)
[14]	柴馨雪，项济南，李秦川. 2-UPR-RPU并联机构奇异分析[J]. 机械工程学报，2015，51(13)：144－151.Chai Xinxue, Xiang Jinan, Li Qinchuan. Singularity analysis of a 2-UPR-RPU parallel mechanism[J]. Journal of Mechanical engineering, 2015, 51(13): 144－151. (in Chinese with English abstract)
[15]	牛雪梅，高国琴，刘辛军，等. 三自由度驱动冗余并联机构动力学建模与试验[J]. 农业工程学报，2013，29(16)：31－41.Niu Xuemei, Gao Guoqin, Liu Xinjun, et al. Dynamics modeling and experimental of 3-DOF parallel mechanism with actuation redundancy[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2013, 29(16): 31－41. (in Chinese with English abstract)
[16]	李秦川，陈志，陈巧红，等. [PP]S类并联机构无伴随运动的结构条件[J]. 机械工程学报，2010，46(15)：31－35.Li Qinchuan, Chen Zhi, Chen Qiaohong, et al. Structural condition for [PP]S parallel mechanism without parasitic motion[J]. Journal of Mechanical engineering, 2010, 46(15): 31－35. (in Chinese with English abstract)
[17]	Bi Z M，Jin Y. Kinematic modeling of Exechon parallel kinematic machine[J]. Robotics and Computer-Integrated Manufacturing, 2011, 27(1): 186－193.
[18]	赵永生，平立发，许允斗，等. 一种三自由度并联式主轴头结构[P]. 中国专利：201410465305，2015-01-07.Zhao Yongsheng, Ping Lifa, Xu Yundou, et al. A three-DOF parallel spindle head structure[P]. Chinese patent: 201410465305, 2015-01-07. (in Chinese with English abstract)
[19]	黄真，刘婧芳，李艳文. 论机构自由度：寻找了150年的自由度通用公式[M]. 北京：科学出版社，2011：1－56.
[20]	荣誉，金振林，崔冰艳. 六足农业机器人并联腿构型分析与结构参数设计[J]. 农业工程学报，2012，28(15)：9－14.Rong Yu, Jin Zhenlin, Cui Bingyan. Configuration analysis and structure parameter design of six-leg agricultural robot with parallel-leg mechanisms[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2012, 28(15): 9－14. (in Chinese with English abstract)
[21]	黄真，赵永生，赵铁石. 高等空间机构学（第二版）[M]. 北京：高等教育出版社，2014：86－229.
[22]	王学林，肖永飞，毕淑慧，等. 机器人柔性抓取试验平台的设计与抓持力跟踪阻抗控制[J]. 农业工程学报，2015，31(1)：58－63.Wang Xuelin, Xiao Yongfei, Bi Shuhui, et al. Design of test platform for robot flexible grasping and grasping force tracking impedance control[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2015, 31(1): 58－63. (in Chinese with English abstract)
[23]	郎需林，靳东，张承瑞，等. 基于实时以太网的DELTA并联机械手控制系统设计[J]. 机器人，2013，35(5)：576－581.Lang Xulin, Jin Dong, Zhang Chengrui, et al. Control system design of DELTA parallel manipulator based on real-time Ethernet[J]. Robot, 2013, 35(5): 576－581. (in Chinese with English abstract)
[24]	宋慧欣. 贝加莱：平台级软件将赢得未来[J]. 自动化博览，2014(10)：44－45.Song Huixin. B & R: platform-level software will win the future[J]. Automation Expo, 2014(10): 44－45. (in Chinese with English abstract)
[25]	胡书立，王清理. POWERLINK总线技术的研究与实现[J]. 计算机工程与设计，2012，33(10)：3821－3828.Hu Shuli, Wang Qingli. POWERLINK field bus controller research and realization based on FPGA[J]. Computer Engineering And Design, 2012, 33(10): 3821－3828. (in Chinese with English abstract)
[26]	滕福林，李宏胜，温秀兰，等. 电子齿轮比对轮廓误差及加工效率影响的研究[J]. 中国机械工程，2012，23(13)：1607－1610.Teng Fulin, Li Hongsheng, Wen Xiulan, et al. Research on influences on contour error and cutting efficiency from electrical gear-ratio[J]. China Mechanical Engineering, 2012, 23(13): 1607－1610. (in Chinese with English abstract)
[27]	陈波，高秀娥，隋广洲. 无线远程控制系统研究与实现[J]. 仪器仪表学报，2006，27(6)：573－574.Chen Bo, Gao Xiue, Sui Guangzhou. Research and realization on wireless remote control system[J]. Chinese Journal of Scientific Instrument, 2006, 27(6): 573－574. (in Chinese with English abstract)
[28]	许宏，张怡，陈锡爱，等. 远程半自主机器人监控系统的设计及实验[J]. 机器人，2010，32(1)：125－131.Xu Hong, Zhang Yi, Chen Xiai, et al. Design and experiment of remote semi-autonomous robot monitoring system[J]. Robot, 2010, 32(1): 125－131. (in Chinese with English abstract)