深海机械手关节电机伺服控制
|
摘要
深海机器人是机器人家族的重要成员,在海底勘探,海底能源开发和海底打捞等方面应用广泛。对于电驱动的深海机器人,其关节伺服控制一直是研究的热点。本文以深海机械手为背景,对电机驱动的关节伺服控制进行了研究。全文主要包括以下几个方面的内容:
首先,介绍了深海机械手伺服系统概况和深海伺服控制电机的选型,对深海直流无刷电机做了详细论述,包括其组成、工作原理、数学模型和深海密封技术。
其次,针对深海机械手关节电机伺服控制,本文讨论了两种控制方案,速度模拟伺服控制和速度数字伺服控制。在速度模拟伺服控制系统中,分析了系统的静特性、动特性和稳定性;介绍了系统的硬件设计,其中包括三相全桥斩波电路、隔离门驱动电路、专用控制芯片接口电路、绝对值电路和比较电路。在速度数字伺服控制系统中,重点介绍了控制算法和微处理器控制电路设计。控制算法是采用Bang-Bang结合PID控制。
最后,介绍了速度模拟伺服控制系统和速度数字伺服控制系统的调试过程,并根据实验结果对速度模拟伺服控制和速度数字伺服控制各自所表现出的性能进行了比较和分析。
Deep-sea Robot is widely used in numerous fields, such as exploration, exploitation and salvage on seabed. It is hot point for servo control system of deep-sea robot joint driven by motor. This paper discussed servo control system of deep-sea manipulator joint driven by motor.
Firstly, it explains the general situation of the deep-sea manipulator servo system and the deep-sea motor’s characteristic in servo system. Brushless DC motor in deep sea is deeply discussed including its composing, operation principle, modeling and waterproof technique.
Secondly, there are two projects on servo system of deep-sea manipulator joint driven by motor. One is analog speed servo system, the other is digital speed servo system. In analog speed servo system, This paper analyzes its static performance, dynamic performance and stability. Hardware design is detailed such as three-phase unipolar inverter, gate driving circuit, special IC control circuit, absolute value circuit and comparator circuit. In digital speed servo system, the control arithmetic and the design of microprocessor circuit is mainly discussed. The control arithmetic is combination of Bang-Bang and PID.
Finally, the testing of analog speed servo system and digital speed servo system was introduced. The performance which was in the testing of analog speed servo system and digital speed servo system is compared and analyzed.
首先,介绍了深海机械手伺服系统概况和深海伺服控制电机的选型,对深海直流无刷电机做了详细论述,包括其组成、工作原理、数学模型和深海密封技术。
其次,针对深海机械手关节电机伺服控制,本文讨论了两种控制方案,速度模拟伺服控制和速度数字伺服控制。在速度模拟伺服控制系统中,分析了系统的静特性、动特性和稳定性;介绍了系统的硬件设计,其中包括三相全桥斩波电路、隔离门驱动电路、专用控制芯片接口电路、绝对值电路和比较电路。在速度数字伺服控制系统中,重点介绍了控制算法和微处理器控制电路设计。控制算法是采用Bang-Bang结合PID控制。
最后,介绍了速度模拟伺服控制系统和速度数字伺服控制系统的调试过程,并根据实验结果对速度模拟伺服控制和速度数字伺服控制各自所表现出的性能进行了比较和分析。
Deep-sea Robot is widely used in numerous fields, such as exploration, exploitation and salvage on seabed. It is hot point for servo control system of deep-sea robot joint driven by motor. This paper discussed servo control system of deep-sea manipulator joint driven by motor.
Firstly, it explains the general situation of the deep-sea manipulator servo system and the deep-sea motor’s characteristic in servo system. Brushless DC motor in deep sea is deeply discussed including its composing, operation principle, modeling and waterproof technique.
Secondly, there are two projects on servo system of deep-sea manipulator joint driven by motor. One is analog speed servo system, the other is digital speed servo system. In analog speed servo system, This paper analyzes its static performance, dynamic performance and stability. Hardware design is detailed such as three-phase unipolar inverter, gate driving circuit, special IC control circuit, absolute value circuit and comparator circuit. In digital speed servo system, the control arithmetic and the design of microprocessor circuit is mainly discussed. The control arithmetic is combination of Bang-Bang and PID.
Finally, the testing of analog speed servo system and digital speed servo system was introduced. The performance which was in the testing of analog speed servo system and digital speed servo system is compared and analyzed.
引文
[1] 李一平. 水下机器人——过去、现在和未来. 自动化博览,2002,3:56～58
[2] Dana R.Yoerger,Hagen Schempf , David M. Dipietro. Design and Performance Evaluation of an Actively Compliant Underwater Manipulator for Full-Ocean Depth,Journal of Robotic System,1991,3 (25):371～392
[3] Aboulnaga, A.A.; Desai, P.C.; Rodriguez, F.; Cooke, T.R.; Emadi, A. A Novel, Low-Cost, High-Performance Single-Phase Adjustable-Speed Motor Drive Using PM Brush-Less DC Machine: IIT’sDesign for 2003 Future Energy Challenge. Nineteenth Annual IEEEVolume , 2004, 3 (15): 1595 - 1603
[4] Rober A George, Jih-Ping Shuy, Eric Cauquil. Deepwater AUV Logs 25,000 Kilometers Under the Sea. Sea Technology, 2003, 1 (13):10～13
[5] 白恩元,王俊元,孙爱国. 现代数控机床伺服及检测技术. 北京:国防工业出版社,2002. 1～5
[6] 诸静. 机器人与遥控技术. 浙江:浙江大学出版社,1991. 126～141
[7] 高松海. 遥控机器人. 北京:原子能出版社,1981. 102～110
[8] 蒋新松. 机器人学导论. 辽宁:辽宁科学技术出版社,1994. 2～10
[9] 毕承恩. 数控技术. 北京:机械工业出版社,1986. 101～148
[10] 唐介. 控制微电机. 北京:高等教育出版社,1987. 25～30
[11] 陈隆昌,陈莜艳. 控制电机. 西安:西北电讯工程学院出版社,1984. 20～50
[12] 杨渝钦. 控制电机. 北京:机械工业出版社,1981. 85～90
[13] 刘子俊,崔皆凡. 海洋机器人用水下电机的深水密封研究[J]. 机器人, 1997 年 1 月, 第 19 卷第 1 期:62-64.
[14] 叶金虎. 无刷直流电动机. 北京:科学出版社, 1982. 20～35
[15] 张琛. 直流无刷电动机原理及应用. 北京:机械工业出版社,1996. 60～80
[16] 任立立. 基于全桥变换器的电磁式双凸极电机调速系统的建模与控制:[硕士论文]南京:南京航空航天大学图书馆,2004
[17] 胡伟. 电动汽车永磁无刷直流电动机全数字化控制:[硕士论文]广州:广东工业大学图书馆,2004.
[18] 袁飞雄. 多相永磁无刷直流电机控制系统研究:[硕士论文]武汉:华中科技大学图书馆,2004
[19] 刘彬.舵机用无刷直流电机控制系统研究:[硕士论文] 西安:西北工业大学图书馆,2003
[20] 史雪冰. 基于 DSP 的无刷直流电动机伺服控制系统:[硕士论文]杭州:浙江工业大学图书馆,2002.
[21] 陈伯时. 电力拖动自动控制系统. 北京:机械工业出版社,2000. 153～154
[22] 段文泽,童明俶. 电气传动控制系统及其工程设计. 重庆:重庆大学出版社,1989. 157～166
[23] 徐国华,张军胜. 直流无刷电机驱动的水下电缆绞车系统. 海洋工程. 2006. 6 已录用(署名单位:华中科技大学)
[24] 孙笛生,王炎. 机器人控制技术. 北京:机械工业出版社,1997. 230～232
[25] Dana R.Yoerger,Hagen Schempf and David M. Dipietro. Design and Performance Evaluation of an Actively Compliant Underwater Manipulator for Full-Ocean Depth. Journal of Robotic System. 1991,2 (15):371～392
[26] Richard Blidberg D. The Impact of Communication Strategy on the Cooperative Behavior of Multiple Autonomous Underwater Vehicles (AUVS). In:6th Inter Symposium on Untethered Unmanned Submersible. Maryland,USA. 1989,6 (9):331～348
[27] 胡寿松. 自动控制原理. 北京:国防工业出版社,2000. 239～290
[28] D.M.Lane, J.B.C Davies, G.Casalino et al. AMADEUS Advanced Manipulation for Deep Underwater Sampling. IEEE Robotics &Automation Magazine. 1997,4 (13):34～47
[29] Jong-Bae Lee; Tae-Bin Im; Ha-Kyong Sung; Young-Ouk Kim; A low costspeed control system of brushless DC motor using fuzzy logic. Information, Decision and Control. 1999, 2 (10):433 - 437
[30] Lee, C.K.; Pang, W.H.; A brushless DC motor speed control system using fuzzy rules. Power Electronics and Variable-Speed Drives, 1994,3 (21):101 – 106
[31] 张玉平. 通用电路模拟技术. 北京:机械工业出版社,1999. 25～33
[32] 蔡涛. 水下智能机械手控制研究. 硕士学位论文. 武汉:华中科技大学图书馆, 2000.
[33] 陈坚. 电力电子学:电力电子变换和控制技术. 北京:高等教育出版社,2002. 211～228
[34] 王兆安,黄俊. 电力电子技术. 北京:机械工业出版社,2000. 34～38
[35] 贾正春,马志源. 电力电子学. 武汉:华中科技大学出版社,2000. 52～56
[36] Tomita, M.; Senjyu, T.; Doki, S.; Okuma, S.; New sensorless control for brushless DC motors using disturbance observers and adaptive velocity estimations. Industrial Electronics, 1998, 2 (45):274 - 282
[37] Crnosija, P.; Bjazic, T.; Krishnan, R.; Optimization of PM brushless DC motor drive. Industrial Technology,2003 , 1 (10):566 – 569
[38] 谭茀娃. 大功率电子学和电机控制. 上海:上海交通大学出版社,1999. 231~235
[39] 谭建成. 电机控制专用集成电路. 北京:机械工业出版社,1997.111～125
[40] 高文焕. 模拟电路的计算机分析与设计——Pspice 程序应用. 北京:清华大学出版社,1999. 112～132
[41] David M.Alter. Using PWM Output as a Digital-to-Analog Converter on a TMS320C240 DSP. Texas Instruments, 1998,11(7):1～11
[42] 赖寿宏. 微型计算机控制技术. 北京:机械工业出版社,1999. 4～6
[43] Hanselmann,H.,and Schwarte,A. Generation of Fast Target Processor Code from High Level Controller Descriptions.In:Proceedings of 10th IFAC World Congress. Munich. 1987,100～108
[44] 刘金琨. 先进 PID 控制及其 MATLAB 仿真. 北京:电子工业出版社, 2003: 3～48
[45] A.Aliphas and J.A.Feldman. The versatility of Digital Signal Proceesing Chips. IEEE Spectrum,1987,2 (6):40～45
[46] 熊有伦,丁汉,刘恩沧. 机器人学. 北京:机械工业出版社,1993. 139～143
[47] [日]白井良明编著,机器人工程(第 1 版),王棣棠译,北京:科学出版社,2001. 40～42
[48] 刘和平,黄开长,严利平,潘伟峰. PIC16F87x 数据手册. 北京:北京航空航天大学出版社,2001. 1～136
[49] PIC16F87x DATA SHEET. Microchip Technology Incorporated.2001:1~156
[50] 窦振中. PIC 系列单片机和程序设计. 北京:北京航空航天大学出版社,2001. 110～209
[51] 沈德金, 陈粤初. MCS-51 系列单片机接口电路与应用程序实例. 北京:北京航空航天大学出版社,1990. 267～283
[52] K.H.Gurubasavaraj. Implementation of a Self-tuning Controller using Digital Signal Processor Chips. IEEE Control Systems Magazine,1989,6(14):38～42
[53] LM331 datasheet:Precision Voltage-to-Frequency Converters. June 1999:1~6
[54] 王幸之,王雷,翟成. 单片机应用系统抗干扰技术. 北京:北京航空航天大学出版社,2000. 1～4
[2] Dana R.Yoerger,Hagen Schempf , David M. Dipietro. Design and Performance Evaluation of an Actively Compliant Underwater Manipulator for Full-Ocean Depth,Journal of Robotic System,1991,3 (25):371～392
[3] Aboulnaga, A.A.; Desai, P.C.; Rodriguez, F.; Cooke, T.R.; Emadi, A. A Novel, Low-Cost, High-Performance Single-Phase Adjustable-Speed Motor Drive Using PM Brush-Less DC Machine: IIT’sDesign for 2003 Future Energy Challenge. Nineteenth Annual IEEEVolume , 2004, 3 (15): 1595 - 1603
[4] Rober A George, Jih-Ping Shuy, Eric Cauquil. Deepwater AUV Logs 25,000 Kilometers Under the Sea. Sea Technology, 2003, 1 (13):10～13
[5] 白恩元,王俊元,孙爱国. 现代数控机床伺服及检测技术. 北京:国防工业出版社,2002. 1～5
[6] 诸静. 机器人与遥控技术. 浙江:浙江大学出版社,1991. 126～141
[7] 高松海. 遥控机器人. 北京:原子能出版社,1981. 102～110
[8] 蒋新松. 机器人学导论. 辽宁:辽宁科学技术出版社,1994. 2～10
[9] 毕承恩. 数控技术. 北京:机械工业出版社,1986. 101～148
[10] 唐介. 控制微电机. 北京:高等教育出版社,1987. 25～30
[11] 陈隆昌,陈莜艳. 控制电机. 西安:西北电讯工程学院出版社,1984. 20～50
[12] 杨渝钦. 控制电机. 北京:机械工业出版社,1981. 85～90
[13] 刘子俊,崔皆凡. 海洋机器人用水下电机的深水密封研究[J]. 机器人, 1997 年 1 月, 第 19 卷第 1 期:62-64.
[14] 叶金虎. 无刷直流电动机. 北京:科学出版社, 1982. 20～35
[15] 张琛. 直流无刷电动机原理及应用. 北京:机械工业出版社,1996. 60～80
[16] 任立立. 基于全桥变换器的电磁式双凸极电机调速系统的建模与控制:[硕士论文]南京:南京航空航天大学图书馆,2004
[17] 胡伟. 电动汽车永磁无刷直流电动机全数字化控制:[硕士论文]广州:广东工业大学图书馆,2004.
[18] 袁飞雄. 多相永磁无刷直流电机控制系统研究:[硕士论文]武汉:华中科技大学图书馆,2004
[19] 刘彬.舵机用无刷直流电机控制系统研究:[硕士论文] 西安:西北工业大学图书馆,2003
[20] 史雪冰. 基于 DSP 的无刷直流电动机伺服控制系统:[硕士论文]杭州:浙江工业大学图书馆,2002.
[21] 陈伯时. 电力拖动自动控制系统. 北京:机械工业出版社,2000. 153～154
[22] 段文泽,童明俶. 电气传动控制系统及其工程设计. 重庆:重庆大学出版社,1989. 157～166
[23] 徐国华,张军胜. 直流无刷电机驱动的水下电缆绞车系统. 海洋工程. 2006. 6 已录用(署名单位:华中科技大学)
[24] 孙笛生,王炎. 机器人控制技术. 北京:机械工业出版社,1997. 230～232
[25] Dana R.Yoerger,Hagen Schempf and David M. Dipietro. Design and Performance Evaluation of an Actively Compliant Underwater Manipulator for Full-Ocean Depth. Journal of Robotic System. 1991,2 (15):371～392
[26] Richard Blidberg D. The Impact of Communication Strategy on the Cooperative Behavior of Multiple Autonomous Underwater Vehicles (AUVS). In:6th Inter Symposium on Untethered Unmanned Submersible. Maryland,USA. 1989,6 (9):331～348
[27] 胡寿松. 自动控制原理. 北京:国防工业出版社,2000. 239～290
[28] D.M.Lane, J.B.C Davies, G.Casalino et al. AMADEUS Advanced Manipulation for Deep Underwater Sampling. IEEE Robotics &Automation Magazine. 1997,4 (13):34～47
[29] Jong-Bae Lee; Tae-Bin Im; Ha-Kyong Sung; Young-Ouk Kim; A low costspeed control system of brushless DC motor using fuzzy logic. Information, Decision and Control. 1999, 2 (10):433 - 437
[30] Lee, C.K.; Pang, W.H.; A brushless DC motor speed control system using fuzzy rules. Power Electronics and Variable-Speed Drives, 1994,3 (21):101 – 106
[31] 张玉平. 通用电路模拟技术. 北京:机械工业出版社,1999. 25～33
[32] 蔡涛. 水下智能机械手控制研究. 硕士学位论文. 武汉:华中科技大学图书馆, 2000.
[33] 陈坚. 电力电子学:电力电子变换和控制技术. 北京:高等教育出版社,2002. 211～228
[34] 王兆安,黄俊. 电力电子技术. 北京:机械工业出版社,2000. 34～38
[35] 贾正春,马志源. 电力电子学. 武汉:华中科技大学出版社,2000. 52～56
[36] Tomita, M.; Senjyu, T.; Doki, S.; Okuma, S.; New sensorless control for brushless DC motors using disturbance observers and adaptive velocity estimations. Industrial Electronics, 1998, 2 (45):274 - 282
[37] Crnosija, P.; Bjazic, T.; Krishnan, R.; Optimization of PM brushless DC motor drive. Industrial Technology,2003 , 1 (10):566 – 569
[38] 谭茀娃. 大功率电子学和电机控制. 上海:上海交通大学出版社,1999. 231~235
[39] 谭建成. 电机控制专用集成电路. 北京:机械工业出版社,1997.111～125
[40] 高文焕. 模拟电路的计算机分析与设计——Pspice 程序应用. 北京:清华大学出版社,1999. 112～132
[41] David M.Alter. Using PWM Output as a Digital-to-Analog Converter on a TMS320C240 DSP. Texas Instruments, 1998,11(7):1～11
[42] 赖寿宏. 微型计算机控制技术. 北京:机械工业出版社,1999. 4～6
[43] Hanselmann,H.,and Schwarte,A. Generation of Fast Target Processor Code from High Level Controller Descriptions.In:Proceedings of 10th IFAC World Congress. Munich. 1987,100～108
[44] 刘金琨. 先进 PID 控制及其 MATLAB 仿真. 北京:电子工业出版社, 2003: 3～48
[45] A.Aliphas and J.A.Feldman. The versatility of Digital Signal Proceesing Chips. IEEE Spectrum,1987,2 (6):40～45
[46] 熊有伦,丁汉,刘恩沧. 机器人学. 北京:机械工业出版社,1993. 139～143
[47] [日]白井良明编著,机器人工程(第 1 版),王棣棠译,北京:科学出版社,2001. 40～42
[48] 刘和平,黄开长,严利平,潘伟峰. PIC16F87x 数据手册. 北京:北京航空航天大学出版社,2001. 1～136
[49] PIC16F87x DATA SHEET. Microchip Technology Incorporated.2001:1~156
[50] 窦振中. PIC 系列单片机和程序设计. 北京:北京航空航天大学出版社,2001. 110～209
[51] 沈德金, 陈粤初. MCS-51 系列单片机接口电路与应用程序实例. 北京:北京航空航天大学出版社,1990. 267～283
[52] K.H.Gurubasavaraj. Implementation of a Self-tuning Controller using Digital Signal Processor Chips. IEEE Control Systems Magazine,1989,6(14):38～42
[53] LM331 datasheet:Precision Voltage-to-Frequency Converters. June 1999:1~6
[54] 王幸之,王雷,翟成. 单片机应用系统抗干扰技术. 北京:北京航空航天大学出版社,2000. 1～4