3-5R并联微动机构运动分析和控制基础研究
|
摘要
目前，微动机器人研究已成为机器人研究领域的热点课题之一。微动机器人可以实现精细操作，其定位精度可以达到亚微米甚至纳米级，已被广泛应用于生物医疗、航空航天等领域。而在微动机器人的结构设计中，具有刚度大、承载能力强等优点的并联机构得到了很好的应用。
本文在3-5R并联微动机构分析的基础上，不仅对其位置、刚度进行了研究，同时设计了该机构的控制实验系统。
位置分析和刚度分析是并联微动机构分析中比较重要的两个部分。针对微动机构的特点，采用微分法和柔度矩阵法对该机构进行位置分析和刚度分析，建立输入输出关系的特征矩阵和刚度模型，并采用有限元的方法进行验证，为控制该微动机构做了铺垫。
由于PID和神经网络CMAC控制算法有着各自的优点和缺点，所以再对这两者进行分析和研究之后，本文采用神经网络PID的控制方法。通过仿真分析，证明PID和CMAC复合控制具有很好的控制效果，可以满足微动机构应用的要求。
微动机构是比较特殊的机构，其运动是通过材料的柔性变形实现的，所以设计实验系统时，不能采用普通的电机驱动。本文设计了以压电陶瓷驱动电源、压电陶瓷驱动器和测微仪等为硬件结构的实验系统，并通过LabVIEW编程语言对控制系统软件进行了功能开发。
最后对该机构进行轨迹规划分析和控制器实验研究，从而验证了本文设计的控制系统是正确的，为以后的进一步研究打下基础。
In the research field of robotics, micromanipulator has now become one of thehot topics. The micromanipulator can achieve fine operation, positioning precision atsubmicron even to the nanometer level, and has been widely used in biology, medical,aerospace and other fields. Because having the advantages of high rigidity, strongbearing capacity etc, the parallel mechanism has a good application in the structuraldesign of micromanipulator.
On the basis of the analysis of 3-5R parallel micromanipulator, this paper notonly researches its position and stiffness, but also designs the control experimentsystem of the mechanism.
The analysis of position and stiffness are more important two parts of parallelmicromanipulator. According to the characteristics of micromanipulator, this paperanalyses position and stiffness respectively by using differential method and flexibilitymatrix method, establishes the characteristics matrix between input and output andstiffness model, then uses the finite element method for validation, and establishesfoundation for controlling the micromanipulator.
Since the control algorithms of PID and CMAC neural network have their ownadvantages and disadvantages, this paper uses neural network PID control methodafter researching the two control algorithms. Through the simulation analysis, PID andCMAC compound control has a good control effect, and can meet the requirements ofthe application of micromanipulator.
Micromanipulator is a special mechanism, and its movement is implemented bythe flexible deformation of the material, so in the design of experiment system, we cannot adopt ordinary motor drive. This paper designs an experimental system of PZTdrive power, PZT actuators and micrometer etc, they constitute the hardware, and theprogramming of software is accomplished by LabVIEW.
At last, the paper analyses the trajectory planning and the result of controller’sexperiment, which proves the validity of this control system and establishes the foundation for further study.
本文在3-5R并联微动机构分析的基础上，不仅对其位置、刚度进行了研究，同时设计了该机构的控制实验系统。
位置分析和刚度分析是并联微动机构分析中比较重要的两个部分。针对微动机构的特点，采用微分法和柔度矩阵法对该机构进行位置分析和刚度分析，建立输入输出关系的特征矩阵和刚度模型，并采用有限元的方法进行验证，为控制该微动机构做了铺垫。
由于PID和神经网络CMAC控制算法有着各自的优点和缺点，所以再对这两者进行分析和研究之后，本文采用神经网络PID的控制方法。通过仿真分析，证明PID和CMAC复合控制具有很好的控制效果，可以满足微动机构应用的要求。
微动机构是比较特殊的机构，其运动是通过材料的柔性变形实现的，所以设计实验系统时，不能采用普通的电机驱动。本文设计了以压电陶瓷驱动电源、压电陶瓷驱动器和测微仪等为硬件结构的实验系统，并通过LabVIEW编程语言对控制系统软件进行了功能开发。
最后对该机构进行轨迹规划分析和控制器实验研究，从而验证了本文设计的控制系统是正确的，为以后的进一步研究打下基础。
In the research field of robotics, micromanipulator has now become one of thehot topics. The micromanipulator can achieve fine operation, positioning precision atsubmicron even to the nanometer level, and has been widely used in biology, medical,aerospace and other fields. Because having the advantages of high rigidity, strongbearing capacity etc, the parallel mechanism has a good application in the structuraldesign of micromanipulator.
On the basis of the analysis of 3-5R parallel micromanipulator, this paper notonly researches its position and stiffness, but also designs the control experimentsystem of the mechanism.
The analysis of position and stiffness are more important two parts of parallelmicromanipulator. According to the characteristics of micromanipulator, this paperanalyses position and stiffness respectively by using differential method and flexibilitymatrix method, establishes the characteristics matrix between input and output andstiffness model, then uses the finite element method for validation, and establishesfoundation for controlling the micromanipulator.
Since the control algorithms of PID and CMAC neural network have their ownadvantages and disadvantages, this paper uses neural network PID control methodafter researching the two control algorithms. Through the simulation analysis, PID andCMAC compound control has a good control effect, and can meet the requirements ofthe application of micromanipulator.
Micromanipulator is a special mechanism, and its movement is implemented bythe flexible deformation of the material, so in the design of experiment system, we cannot adopt ordinary motor drive. This paper designs an experimental system of PZTdrive power, PZT actuators and micrometer etc, they constitute the hardware, and theprogramming of software is accomplished by LabVIEW.
At last, the paper analyses the trajectory planning and the result of controller’sexperiment, which proves the validity of this control system and establishes the foundation for further study.
引文
[1]贾庆轩，魏秋霜，孙汉旭，等.并联微动机器人的研究现状[J].山东理工大学学报，2003，17(6)：98-102.
[2]赵冉，李艳文，赵铁石.微机器人的研究现状与发展趋势[J].机械设计，2009，26(2)：1-2；54.
[3]郁坤.微操作机器人精确微动移动平台的研究与开发[D].北京：北京工业大学机械制造及其自动化学科硕士学位论文，2009：2-4.
[4] IFToMM. IFToMM terminology[J]. Mechanism and Machine Theory，2003，38(7-10)：821.
[5]黄真，孔令富，方跃法.并联机器人机构学理论及控制[M].北京：机械工业出版社，1997：3-8；18-21；65-78；135-147；179-186.
[6] Nguyen C C. Analysis and experimentation of a stewart platform based force/torque sensor[J].International Journal of Robotics and Automation，1993，7(3)：133-140.
[7]张曙，Heisel. U.并联运动机床[M].北京：机械工业出版社，2003：5-34.
[8]杜铁军.机器人误差补偿器研究[D].秦皇岛：燕山大学机械工程学科硕士学位论文，1994：12-65.
[9]汪劲松，段广洪，杨向东.虚拟轴机床的研究进展－兼谈在清华大学研制成功的VAMT1Y型原型样机[J].科技导报，1998(10)：32-34.
[10]高峰，金振林，刘辛军，等.六自由度虚拟轴机床：中国，CN99122349[P]. 2000-07-26.
[11]李强，闫洪波，张玉宝.并联机床发展的历史、研究现状与展望[J].机床与液压，2007，35(3)：206-209.
[12] Hudgens J C, Tesar D. A fully-parallel six degree of freedom micromanipulator: Kinematicanalysis and dynamic model[C]. Proceedings of 20th Biennal ASME Mechanisms ConferenceTrends and Developments in Mechanisms, Machines, and Robotics, 1988, 15(3): 29-37.
[13] Washizu M. Manipulation of biological objects in micromachined structures[C]. Proceedings ofthe IEEE Micro Electro Mechanical Systems Workshop, 1992: 196-201.
[14]毕树生，王守杰，宗光华.串并联微动机构的运动学分析[J].机器人，1997，19(4)：259-264.
[15] Wang H R, Gao F, Huang Z. Design of 6-axis force/torque sensor based on stewart platformrelated to isotropy[J]. Chinese Journal of Mechanical Engineering, 1998, 11(3): 217-222.
[16]王宣银，尹瑞多.基于Stewart机构的六维力/力矩传感器[J].机械工程学报，2008，44(12)：118-130.
[17]贾振元，褚宏飞，刘威，等.基于Stewart结构六维大力传感器的性能分析及结构优化[J].仪器仪表学报，2010，31(2)：341-346.
[18] Portman V T, Sandler B Z, Zahavi E. Rigid 6-DOF parallel platform for precision 3-Dmicromanipulation[J]. International Journal of Machine Tools & Manufacture, 2001(41):1229-1250.
[19] Zhang W J, Zou J, Watson L G, et al. The constant-Jacobian method for kinematics of athree-DOF planar micro-motion stage[J]. Journal of Robotic Systems, 2002, 19(2): 63-72.
[20] Ouyang P R. Hybrid intelligent machine systems: Design, modeling and control[D]. Canada:University of Saskatchewan, 2005: 183-187.
[21] Beltrami I, Joseph C, Clavel R, et al. Micro-and nanoelectric-discharge machining[J]. Journal ofMaterials Processing Technology, 2004, 149(1/3): 263-265.
[22] Chao D H, Zong G H, Liu R. Design of a 6-DOF compliant manipulator based on serial-parallelarchitecture[C]. Proceedings of the 2005 IEEE/ASME International Conference on AdvancedIntelligent Mechatronics, 2005: 765-770.
[23]安辉.压电陶瓷驱动六自由度并联微动机器人的研究[D].哈尔滨：哈尔滨工业大学机电控制及其自动化学科硕士学位论文，1995：22-50.
[24]金振林，高峰，刘辛军.新型力解耦和各向同性结构的机器人六维力传感器[J].传感器技术，2000，19(4)：26-28.
[25]王振华，钟博文.基于压电陶瓷驱动的并联微动机器人的应用现状[J].压电与声光，2007，29(4)：414-416.
[26]宋海波.基于工控机和DSP的关节机器人控制器研究[D].陕西：陕西科技大学机械制造及其自动化学科硕士学位论文，2009：2-4.
[27]何林，孟宪翠，董砚，等.基于DSP和CPLD的运动控制器简化与应用[J].自动化与仪表，2011，26(1)：36-39.
[28]刘森，慕春棣，赵明国，等.基于ARM嵌入式系统的拟人机器人控制器设计[J].清华大学学报，2008，48(4)：482-485.
[29]高伟.机器人控制器设计与实现[D].天津：南开大学控制理论与控制工程学科硕士学位论文，2007：3-6.
[30]赵东亚，邹涛.并联机器人控制方法研究[J].组合机床与自动化加工技术，2010(5)：8-12.
[31]陈强，黄勇，胡晓娟.并联机器人控制方法研究现状[J].机械工程师，2010(2)：45-46.
[32]丛爽，王杨，尚伟伟.自适应控制策略在并联机构上的应用[J].制造业自动化，2007，29(7)：45-49.
[33]赵杰，杨永刚，刘玉斌，等.一种6-PRRS并联机器人的神经网络控制[J].哈尔滨工程大学学报，2008，29(5)：514-517.
[34]句彦儒.一种新型的3-5RRRRR并联微动机构的设计与分析[D].秦皇岛：燕山大学机械电子学科硕士学位论文，2010：25；29-41；74-76.
[35]高峰，刘辛军，金振林，等.并联6自由度Stewart微动机器人机构设计方法研究[C].第一届并联机器人及机床设计理论与关键技术研讨会论文，1999：44-49.
[36]李嘉，陈恳，董怡，等.并联柔性机器人的静刚度研究[J].清华大学学报，1999，39(8)：16-20.
[37]于靖军，毕树生，宗光华，等. 3自由度柔性微动机器人的静刚度分析[J].机械工程学报，2002，38(4)：7-10.
[38]于靖军，毕树生，宗光华.柔性平行导向机构的静刚度分析[J].机械科学与技术，2003，22(2)：241-244.
[39]胡仁喜，郭军，王仁广. Solidworks 2005中文版机械设计高级应用实例[M].北京：机械工业出版，2005：168-187.
[40]赵冉.四自由度4-RRUR并联微动机器人设计与基础性能研究[D].秦皇岛：燕山大学机械电子学科硕士学位论文，2010：43-44.
[41]周宇.基于子模型的铁路车辆结构强度精细计算[D].大连：大连交通大学机械设计及理论学科硕士学位论文，2008：8-9.
[42]杨川，赵强，张志.基于压电陶瓷器件的微动系统智能控制研究[J].压电与声光，2010，32(1)：55-58.
[43]桑武斌.二维超精工件台及其控制系统的研究[D].杭州：浙江大学机械制造及其自动化学科硕士学位论文，2008：43-45.
[44]黄金永.空间用精密微位移平台的研究[D].杭州：浙江大学机械制造及其自动化学科硕士学位论文，2004：57-59.
[45]薛博文.液压驱动Stewart平台的输出力控制研究[D].秦皇岛：燕山大学机械电子学科硕士学位论文，2010：37-39.
[46]周红莉.基于神经网络的移动机器人控制研究[D].兰州：兰州理工大学检测技术与自动化装置学科硕士学位论文，2006：15-24.
[47]李士勇.模糊控制、神经控制和智能控制论[M].哈尔滨：哈尔滨工业大学出版社，1998：621-622.
[48]王玉松.机器人系统实现及其CMAC控制算法仿真研究[D].天津：中国民用航空学院导航、制导与控制学科硕士学位论文，2004：6-8.
[49]崔博丽.基于MabLVIEW的网络化虚拟仪器技术的研究与应用[D].西安：陕西科技大学计算机应用技术学科硕士学位论文，2011：12-13.
[50]陈锡辉，张银鸿. LabVIEW8.2程序设计从入门到精通[M].北京：清华大学出版社，2007：15-17.
[51]江建军，刘继光. LabVIEW程序设计教程[M].北京：电子工业出版社，2008：50-51.
[52]贺静. 6PUS_UPS并联机器人控制系统开发与实验研究[D].秦皇岛：燕山大学机械电子学科硕士学位论文，2010：36-37.
[53]罗磊，莫锦秋，王石刚，等.并联机构动力学建模和控制方法分析[J].上海交通大学学报，2005，39(1)：75-76.
[54]王伟. 3-RRR并联微动机构工作台研制及误差分析[D].合肥：合肥工业大学精密仪器及机械学科硕士学位论文，2007：27.
[55]臧庆凯，李春贵，闫向磊.基于Matlab的PUMA560机器人运动仿真研究[J].广西科学院学报，2010，26(4)：397-400.
[56] Pieper D and Roth B. The kinematics of manipulators under computer control zapopanPoland[C]. Proceedings of the 2nd International Congress on Theory of Machines andMechanisms, 1969, 2: 159-169.
[2]赵冉，李艳文，赵铁石.微机器人的研究现状与发展趋势[J].机械设计，2009，26(2)：1-2；54.
[3]郁坤.微操作机器人精确微动移动平台的研究与开发[D].北京：北京工业大学机械制造及其自动化学科硕士学位论文，2009：2-4.
[4] IFToMM. IFToMM terminology[J]. Mechanism and Machine Theory，2003，38(7-10)：821.
[5]黄真，孔令富，方跃法.并联机器人机构学理论及控制[M].北京：机械工业出版社，1997：3-8；18-21；65-78；135-147；179-186.
[6] Nguyen C C. Analysis and experimentation of a stewart platform based force/torque sensor[J].International Journal of Robotics and Automation，1993，7(3)：133-140.
[7]张曙，Heisel. U.并联运动机床[M].北京：机械工业出版社，2003：5-34.
[8]杜铁军.机器人误差补偿器研究[D].秦皇岛：燕山大学机械工程学科硕士学位论文，1994：12-65.
[9]汪劲松，段广洪，杨向东.虚拟轴机床的研究进展－兼谈在清华大学研制成功的VAMT1Y型原型样机[J].科技导报，1998(10)：32-34.
[10]高峰，金振林，刘辛军，等.六自由度虚拟轴机床：中国，CN99122349[P]. 2000-07-26.
[11]李强，闫洪波，张玉宝.并联机床发展的历史、研究现状与展望[J].机床与液压，2007，35(3)：206-209.
[12] Hudgens J C, Tesar D. A fully-parallel six degree of freedom micromanipulator: Kinematicanalysis and dynamic model[C]. Proceedings of 20th Biennal ASME Mechanisms ConferenceTrends and Developments in Mechanisms, Machines, and Robotics, 1988, 15(3): 29-37.
[13] Washizu M. Manipulation of biological objects in micromachined structures[C]. Proceedings ofthe IEEE Micro Electro Mechanical Systems Workshop, 1992: 196-201.
[14]毕树生，王守杰，宗光华.串并联微动机构的运动学分析[J].机器人，1997，19(4)：259-264.
[15] Wang H R, Gao F, Huang Z. Design of 6-axis force/torque sensor based on stewart platformrelated to isotropy[J]. Chinese Journal of Mechanical Engineering, 1998, 11(3): 217-222.
[16]王宣银，尹瑞多.基于Stewart机构的六维力/力矩传感器[J].机械工程学报，2008，44(12)：118-130.
[17]贾振元，褚宏飞，刘威，等.基于Stewart结构六维大力传感器的性能分析及结构优化[J].仪器仪表学报，2010，31(2)：341-346.
[18] Portman V T, Sandler B Z, Zahavi E. Rigid 6-DOF parallel platform for precision 3-Dmicromanipulation[J]. International Journal of Machine Tools & Manufacture, 2001(41):1229-1250.
[19] Zhang W J, Zou J, Watson L G, et al. The constant-Jacobian method for kinematics of athree-DOF planar micro-motion stage[J]. Journal of Robotic Systems, 2002, 19(2): 63-72.
[20] Ouyang P R. Hybrid intelligent machine systems: Design, modeling and control[D]. Canada:University of Saskatchewan, 2005: 183-187.
[21] Beltrami I, Joseph C, Clavel R, et al. Micro-and nanoelectric-discharge machining[J]. Journal ofMaterials Processing Technology, 2004, 149(1/3): 263-265.
[22] Chao D H, Zong G H, Liu R. Design of a 6-DOF compliant manipulator based on serial-parallelarchitecture[C]. Proceedings of the 2005 IEEE/ASME International Conference on AdvancedIntelligent Mechatronics, 2005: 765-770.
[23]安辉.压电陶瓷驱动六自由度并联微动机器人的研究[D].哈尔滨：哈尔滨工业大学机电控制及其自动化学科硕士学位论文，1995：22-50.
[24]金振林，高峰，刘辛军.新型力解耦和各向同性结构的机器人六维力传感器[J].传感器技术，2000，19(4)：26-28.
[25]王振华，钟博文.基于压电陶瓷驱动的并联微动机器人的应用现状[J].压电与声光，2007，29(4)：414-416.
[26]宋海波.基于工控机和DSP的关节机器人控制器研究[D].陕西：陕西科技大学机械制造及其自动化学科硕士学位论文，2009：2-4.
[27]何林，孟宪翠，董砚，等.基于DSP和CPLD的运动控制器简化与应用[J].自动化与仪表，2011，26(1)：36-39.
[28]刘森，慕春棣，赵明国，等.基于ARM嵌入式系统的拟人机器人控制器设计[J].清华大学学报，2008，48(4)：482-485.
[29]高伟.机器人控制器设计与实现[D].天津：南开大学控制理论与控制工程学科硕士学位论文，2007：3-6.
[30]赵东亚，邹涛.并联机器人控制方法研究[J].组合机床与自动化加工技术，2010(5)：8-12.
[31]陈强，黄勇，胡晓娟.并联机器人控制方法研究现状[J].机械工程师，2010(2)：45-46.
[32]丛爽，王杨，尚伟伟.自适应控制策略在并联机构上的应用[J].制造业自动化，2007，29(7)：45-49.
[33]赵杰，杨永刚，刘玉斌，等.一种6-PRRS并联机器人的神经网络控制[J].哈尔滨工程大学学报，2008，29(5)：514-517.
[34]句彦儒.一种新型的3-5RRRRR并联微动机构的设计与分析[D].秦皇岛：燕山大学机械电子学科硕士学位论文，2010：25；29-41；74-76.
[35]高峰，刘辛军，金振林，等.并联6自由度Stewart微动机器人机构设计方法研究[C].第一届并联机器人及机床设计理论与关键技术研讨会论文，1999：44-49.
[36]李嘉，陈恳，董怡，等.并联柔性机器人的静刚度研究[J].清华大学学报，1999，39(8)：16-20.
[37]于靖军，毕树生，宗光华，等. 3自由度柔性微动机器人的静刚度分析[J].机械工程学报，2002，38(4)：7-10.
[38]于靖军，毕树生，宗光华.柔性平行导向机构的静刚度分析[J].机械科学与技术，2003，22(2)：241-244.
[39]胡仁喜，郭军，王仁广. Solidworks 2005中文版机械设计高级应用实例[M].北京：机械工业出版，2005：168-187.
[40]赵冉.四自由度4-RRUR并联微动机器人设计与基础性能研究[D].秦皇岛：燕山大学机械电子学科硕士学位论文，2010：43-44.
[41]周宇.基于子模型的铁路车辆结构强度精细计算[D].大连：大连交通大学机械设计及理论学科硕士学位论文，2008：8-9.
[42]杨川，赵强，张志.基于压电陶瓷器件的微动系统智能控制研究[J].压电与声光，2010，32(1)：55-58.
[43]桑武斌.二维超精工件台及其控制系统的研究[D].杭州：浙江大学机械制造及其自动化学科硕士学位论文，2008：43-45.
[44]黄金永.空间用精密微位移平台的研究[D].杭州：浙江大学机械制造及其自动化学科硕士学位论文，2004：57-59.
[45]薛博文.液压驱动Stewart平台的输出力控制研究[D].秦皇岛：燕山大学机械电子学科硕士学位论文，2010：37-39.
[46]周红莉.基于神经网络的移动机器人控制研究[D].兰州：兰州理工大学检测技术与自动化装置学科硕士学位论文，2006：15-24.
[47]李士勇.模糊控制、神经控制和智能控制论[M].哈尔滨：哈尔滨工业大学出版社，1998：621-622.
[48]王玉松.机器人系统实现及其CMAC控制算法仿真研究[D].天津：中国民用航空学院导航、制导与控制学科硕士学位论文，2004：6-8.
[49]崔博丽.基于MabLVIEW的网络化虚拟仪器技术的研究与应用[D].西安：陕西科技大学计算机应用技术学科硕士学位论文，2011：12-13.
[50]陈锡辉，张银鸿. LabVIEW8.2程序设计从入门到精通[M].北京：清华大学出版社，2007：15-17.
[51]江建军，刘继光. LabVIEW程序设计教程[M].北京：电子工业出版社，2008：50-51.
[52]贺静. 6PUS_UPS并联机器人控制系统开发与实验研究[D].秦皇岛：燕山大学机械电子学科硕士学位论文，2010：36-37.
[53]罗磊，莫锦秋，王石刚，等.并联机构动力学建模和控制方法分析[J].上海交通大学学报，2005，39(1)：75-76.
[54]王伟. 3-RRR并联微动机构工作台研制及误差分析[D].合肥：合肥工业大学精密仪器及机械学科硕士学位论文，2007：27.
[55]臧庆凯，李春贵，闫向磊.基于Matlab的PUMA560机器人运动仿真研究[J].广西科学院学报，2010，26(4)：397-400.
[56] Pieper D and Roth B. The kinematics of manipulators under computer control zapopanPoland[C]. Proceedings of the 2nd International Congress on Theory of Machines andMechanisms, 1969, 2: 159-169.