仿生机器蟹控制系统及驱动技术研究
|
摘要
由于机器人具有可靠性高、适应性强、功能强大的特点使其成为执行高危险军事任务的理想平台，具有两栖活动能力的军用机器人更是该领域研究的前沿课题。本课题来源于国家自然科学基金项目“两栖仿生机器蟹基础技术研究”，主要研究内容是机器蟹样机总体方案设计和控制系统、驱动技术研究。本论文主要包括以下内容：
借鉴国内外典型多足步行机器人和仿生机器人研究项目的经验，提出了机器蟹的总体方案设计，并对多环并联结构机器人运动学及动力学分析方法、微型伺服驱动技术、机械仿生技术、DSP实时控制等关键技术开展了研究。
通过对海蟹的模仿，并借助运动学和动力学优化分析的手段，以灵活性和稳定性为研究对象，获得了机器蟹机体结构优化参数模型。设计了机器蟹原理样机，同时开展机器蟹关节驱动技术的研究。
作为机器蟹原理样机设计和本论文的主要内容之一，开展了机器蟹嵌入式控制系统研究。设计了具有可扩展性和模块化特点的机器蟹多层多目标递阶式实时控制系统。开发了基于DSP的嵌入式步行足控制器，进行硬件电路及相关软件包设计，并对控制算法进行了研究。
建立了机器蟹步行足控制实验平台，进行了步行足递阶控制器性能测试，并结合多关节协调运动控制算法研究，对步行足在不同步态情况下的控制性能进行了对比实验和分析。
The robots now is regarded as a kind of ideal platform for performing dangerous military mission, which have advantages of high dependability, good adaptability, powerful function. In addition, the research on amphibious military robot has become the focus in this area all over the world. The research of this paper is supported by project of 'Amphibious Crab-liked Robot Study', which is funded by NSFC (National Natural Science Foundation of China). The main research of this paper includes scheme design of crab-liked robot, control system, driving technology.
After studying of related research on multi-legged and bionics robot over the world, the macro-scheme design of the crab-liked robot is deeply researched. The feasibility of relating technology has been demonstrated such as kinematics and dynamics of multi-loop parallel manipulator, micro servo driving method, bionic mechanics, DSP real-time control.
With the researching on flexibility and stability of the crab-liked robot movement, we get the optimized structure parameter module. The study methods such as bionic structure design and function imitating, the optimizing analyze of kinematics and dynamics are widely used. At the same time the scheme design of DSP real-time control system is given.
As the main point of the paper, we give a detail discuss on control system study of robot walking leg, the same as software and hardware design for DSP based controller. This part is including research on sensors and components selecting, design of main-controller, peripheral interface and application software. In addition, the control arithmetic is also studied.
At last, we build the test platform of crab-liked robot walking leg. Through the experiment on the test platform the above technologies have been widely testified. The performance of the angle driver of robot leg, DSP controller is proved to be effective. At the same time arithmetic of harmonize control is also be test to analyzing the control performance in different walking status.
借鉴国内外典型多足步行机器人和仿生机器人研究项目的经验，提出了机器蟹的总体方案设计，并对多环并联结构机器人运动学及动力学分析方法、微型伺服驱动技术、机械仿生技术、DSP实时控制等关键技术开展了研究。
通过对海蟹的模仿，并借助运动学和动力学优化分析的手段，以灵活性和稳定性为研究对象，获得了机器蟹机体结构优化参数模型。设计了机器蟹原理样机，同时开展机器蟹关节驱动技术的研究。
作为机器蟹原理样机设计和本论文的主要内容之一，开展了机器蟹嵌入式控制系统研究。设计了具有可扩展性和模块化特点的机器蟹多层多目标递阶式实时控制系统。开发了基于DSP的嵌入式步行足控制器，进行硬件电路及相关软件包设计，并对控制算法进行了研究。
建立了机器蟹步行足控制实验平台，进行了步行足递阶控制器性能测试，并结合多关节协调运动控制算法研究，对步行足在不同步态情况下的控制性能进行了对比实验和分析。
The robots now is regarded as a kind of ideal platform for performing dangerous military mission, which have advantages of high dependability, good adaptability, powerful function. In addition, the research on amphibious military robot has become the focus in this area all over the world. The research of this paper is supported by project of 'Amphibious Crab-liked Robot Study', which is funded by NSFC (National Natural Science Foundation of China). The main research of this paper includes scheme design of crab-liked robot, control system, driving technology.
After studying of related research on multi-legged and bionics robot over the world, the macro-scheme design of the crab-liked robot is deeply researched. The feasibility of relating technology has been demonstrated such as kinematics and dynamics of multi-loop parallel manipulator, micro servo driving method, bionic mechanics, DSP real-time control.
With the researching on flexibility and stability of the crab-liked robot movement, we get the optimized structure parameter module. The study methods such as bionic structure design and function imitating, the optimizing analyze of kinematics and dynamics are widely used. At the same time the scheme design of DSP real-time control system is given.
As the main point of the paper, we give a detail discuss on control system study of robot walking leg, the same as software and hardware design for DSP based controller. This part is including research on sensors and components selecting, design of main-controller, peripheral interface and application software. In addition, the control arithmetic is also studied.
At last, we build the test platform of crab-liked robot walking leg. Through the experiment on the test platform the above technologies have been widely testified. The performance of the angle driver of robot leg, DSP controller is proved to be effective. At the same time arithmetic of harmonize control is also be test to analyzing the control performance in different walking status.
引文
[1] 李体然，竹如，国外军用机器人发展综述．机器人情报．1991，(3)：1-5页
[2] 刘宁，于甜虎．初露端倪的无人化作战平．海峡科技．2002，(8)：23-23
[3] 林良明．仿尘机械学．上海交通大学出版社．1991．4
[4] 迟科祥，颜国正．仿生机器人的研究状况及其未来发展．机器人．2001，23(5)：476-480页
[5] Jacobsen S, Wood J, Biger K, Iverson E. The Utah/MIT Hand: Work in Progress. International Journal of Robotics Research, 1984.4(3): 21-50
[6] Okada T. Computer Control of Multi-jointed Finger System for Precise Object-Handing. IEEE Transactions on System Man and Cybernetics. 1982, SMC-12(3): 289-299P
[7] H. Liu J, Butterfass S, Knoch P, Meusel G. Hirzinger. A New Control Strategy for DLR's Multisensory Articulated Hand. http://www.robotic.dlr.de/
[8] http://world.honda.com/robot/
[9] Shigo Hirose, Kasn Yoneda, Hideyuki Tsukagoshi. TITAN-Ⅷ, Quadruped Walking and Manipulating Robot on a Steep Slope. Proc Int Conf On Robotics and Automation, Albuquerque. New Mexico. 1997. 494-500 P
[10] Keisuke Arikawa, Shigeo Hirose. Development of Quadruped Walking Robot TITAN-Ⅷ. Proc IROS'96, 1996: 208-214P
[11] 沈家瑞，戴爱云．中国动物图谱，甲壳动物(第二册)．北京：科学出版社，1964
[12] 熊有伦．机器人技术基础．华中理工大学出版社，1996．8
[13] (美)理查德·摩雷，(中)李泽湘，(美)夏恩卡·萨思特里(著)，徐卫良，钱瑞明(译)．机器人操作的数学导论．机械工业出版社，1998．6
[14] M J Randall. Adaptive Neural Control of Walking Robots. Professional Engineering Publishing Limited, London, UK. 2001
[15] Michael R Fielding, Reg Dunlop. Hamlet:Force/Position Controlled Hexapod Walker Design and System. www.hamlet.canterburv.ac.nz
[16] 黄真，孔令富，方跃法．并联机器人机构学理论及控制．机械工业出版社，1997．12：12-186，278-302页
[17] 赵铁石，赵永生，黄真．仿蟹步行机构模型灵活度分析．中国机械工程．1998，(3)：52-53页
[18] 赵铁石，赵永生．海蟹足系仿生机构模型及位置反解．东北重型机械学院学报．1996，(3)：10-14页
[19] Foruya Y , Shimads. Engineering Aspects of Shape Memory Alloys. Butterworth—Heinemann Ltd. 1990: 228-355
[20] 杨大智．智能材料与智能系统．天津大学出版社，2000．12
[21] 赵连城，蔡伟，郑玉峰．合金的形状记忆效应与超弹性．国防工业出版社，2002．1
[22] 李明东，奚汉达，储金荻，马培逊．一种形状记忆合金丝驱动的微小型六足机器人．上海交通大学学报．2002．10(34)：1426-1429页
[23] Richard M. Murreey. Control Primitives for Robot Systems. IEEE Transactions on systems, man, and cybernetics. Vol.22, No. 1, 1992
[24] 齐晓慧．机器人的一种大系统递阶协调的自适应控制方法．华东工学院硕士论文．1987
[25] 李士勇．模糊控制和智能控制理论及应用．哈尔滨工业大学出版社，1996．10
[26] 蔡自兴．智能控制．国防工业出版社，1998
[27] Michael R Fielding, Christopher J. Damaren. Hamlet: Force/Position Controlled Hexapod Walker-Design and Systems. http://www.mech.canterbury.ac.nz/research/hamlet/index.html
[28] http ://www.tarry.de/
[29] 张卫宁．TMS320C2000系列DSPs原理及应用．国防工业出版社，2002．4
[30] 褚振勇，翁木云．FPGA设计及应用．西安电子科技大学出版社，2002．7
[31] 宋万杰，罗丰，吴顺君．CPLD技术及其应用．西安电子科技大学出版社，1999．9
[32] 秦继荣，沈安俊等．现代直流伺服控制技术及其系统设计．机械工业出版社，1993
[33] 李铁才，杜坤梅．电机控制技术．哈尔滨工业大学出版社，2002．12：7-55页
[34] National Semiconductor Inc. National Power ICs Databook. 1995
[35] Maxon 2001 The Leading Manufacture of High Precision Drives and Systems. Maxon Motor ag. 2001
[36] 韩壮志，李伟，王田苗．方便易用的功放集成电路LMD18245．电子技术应用．2000．4：58-61
[37] 王念旭．DSP基础与应用系统设计．北京航空航天大学出版社，2001．8：99-178页
[38] 王学敏，程群实．分层模糊控制器在四足步行机器人中的应用．模糊系统与数学．1998，12(2)：83-88页
[39] 郑伟红，马培荪，陈佳品．模糊神经网络在四足步行机器人控制中的应用．上海交通大学学报．1996，30(1)：42-48页
[40] 马培荪，郑伟红．四足步行机器人模糊神经网络控制．机器人．1997，19(1)：56-60页
[41] 张克，傅佩琛，强文义．小波神经网络在两足步行机器人爬斜坡中的应用．机器人．2002，22(2)：384-389页
[42] 孙虎章．自动控制原理．中央广播电视大学出版社，1994
[43] 汪国梁．电机学．机械工业出版社，1999．5：74-119，263-265页
[44] TMS320LF/LC240xA DSP Controllers System and Peripherals．Texas Instruments.2001
[45] TMS320LF/LC240xA DSP Controllers CPU and Instruction Set.Texas Instruments. 2001
[46] 殷跃红，尉忠信，黄晓曦．智能机器系统力觉及力控制技术．国防工业出版社，2001．4：40-150页
[47] 王福瑞．单片微机测控系统设计大全．北京航空航天大学出版社，1998．4：279-299页
[48] 李朝青．PC机及单片机数据通信技术．北京航空航天大学出版
社，2000．12：94-70页
[49] 王晓明．电动机的单片机控制．北京航空航天大学出版社，2002．5：6-149页
[50] 王幸之，王雷，翟成，王闪．单片机应用系统抗干扰技术．北京航空航天大学出版社，2000．2
[51] 韩壮志．基于DSP的新型灵巧手控制器设计与研制．北京航空航天大学硕士论文，1999
[52] 曾繁泰，陈美金．VHDL程序设计．清华大学出版社，2001．1
[53] 李刚．数字信号微处理器的原理及其开发应用．天津大学出版社，2000．4
[2] 刘宁，于甜虎．初露端倪的无人化作战平．海峡科技．2002，(8)：23-23
[3] 林良明．仿尘机械学．上海交通大学出版社．1991．4
[4] 迟科祥，颜国正．仿生机器人的研究状况及其未来发展．机器人．2001，23(5)：476-480页
[5] Jacobsen S, Wood J, Biger K, Iverson E. The Utah/MIT Hand: Work in Progress. International Journal of Robotics Research, 1984.4(3): 21-50
[6] Okada T. Computer Control of Multi-jointed Finger System for Precise Object-Handing. IEEE Transactions on System Man and Cybernetics. 1982, SMC-12(3): 289-299P
[7] H. Liu J, Butterfass S, Knoch P, Meusel G. Hirzinger. A New Control Strategy for DLR's Multisensory Articulated Hand. http://www.robotic.dlr.de/
[8] http://world.honda.com/robot/
[9] Shigo Hirose, Kasn Yoneda, Hideyuki Tsukagoshi. TITAN-Ⅷ, Quadruped Walking and Manipulating Robot on a Steep Slope. Proc Int Conf On Robotics and Automation, Albuquerque. New Mexico. 1997. 494-500 P
[10] Keisuke Arikawa, Shigeo Hirose. Development of Quadruped Walking Robot TITAN-Ⅷ. Proc IROS'96, 1996: 208-214P
[11] 沈家瑞，戴爱云．中国动物图谱，甲壳动物(第二册)．北京：科学出版社，1964
[12] 熊有伦．机器人技术基础．华中理工大学出版社，1996．8
[13] (美)理查德·摩雷，(中)李泽湘，(美)夏恩卡·萨思特里(著)，徐卫良，钱瑞明(译)．机器人操作的数学导论．机械工业出版社，1998．6
[14] M J Randall. Adaptive Neural Control of Walking Robots. Professional Engineering Publishing Limited, London, UK. 2001
[15] Michael R Fielding, Reg Dunlop. Hamlet:Force/Position Controlled Hexapod Walker Design and System. www.hamlet.canterburv.ac.nz
[16] 黄真，孔令富，方跃法．并联机器人机构学理论及控制．机械工业出版社，1997．12：12-186，278-302页
[17] 赵铁石，赵永生，黄真．仿蟹步行机构模型灵活度分析．中国机械工程．1998，(3)：52-53页
[18] 赵铁石，赵永生．海蟹足系仿生机构模型及位置反解．东北重型机械学院学报．1996，(3)：10-14页
[19] Foruya Y , Shimads. Engineering Aspects of Shape Memory Alloys. Butterworth—Heinemann Ltd. 1990: 228-355
[20] 杨大智．智能材料与智能系统．天津大学出版社，2000．12
[21] 赵连城，蔡伟，郑玉峰．合金的形状记忆效应与超弹性．国防工业出版社，2002．1
[22] 李明东，奚汉达，储金荻，马培逊．一种形状记忆合金丝驱动的微小型六足机器人．上海交通大学学报．2002．10(34)：1426-1429页
[23] Richard M. Murreey. Control Primitives for Robot Systems. IEEE Transactions on systems, man, and cybernetics. Vol.22, No. 1, 1992
[24] 齐晓慧．机器人的一种大系统递阶协调的自适应控制方法．华东工学院硕士论文．1987
[25] 李士勇．模糊控制和智能控制理论及应用．哈尔滨工业大学出版社，1996．10
[26] 蔡自兴．智能控制．国防工业出版社，1998
[27] Michael R Fielding, Christopher J. Damaren. Hamlet: Force/Position Controlled Hexapod Walker-Design and Systems. http://www.mech.canterbury.ac.nz/research/hamlet/index.html
[28] http ://www.tarry.de/
[29] 张卫宁．TMS320C2000系列DSPs原理及应用．国防工业出版社，2002．4
[30] 褚振勇，翁木云．FPGA设计及应用．西安电子科技大学出版社，2002．7
[31] 宋万杰，罗丰，吴顺君．CPLD技术及其应用．西安电子科技大学出版社，1999．9
[32] 秦继荣，沈安俊等．现代直流伺服控制技术及其系统设计．机械工业出版社，1993
[33] 李铁才，杜坤梅．电机控制技术．哈尔滨工业大学出版社，2002．12：7-55页
[34] National Semiconductor Inc. National Power ICs Databook. 1995
[35] Maxon 2001 The Leading Manufacture of High Precision Drives and Systems. Maxon Motor ag. 2001
[36] 韩壮志，李伟，王田苗．方便易用的功放集成电路LMD18245．电子技术应用．2000．4：58-61
[37] 王念旭．DSP基础与应用系统设计．北京航空航天大学出版社，2001．8：99-178页
[38] 王学敏，程群实．分层模糊控制器在四足步行机器人中的应用．模糊系统与数学．1998，12(2)：83-88页
[39] 郑伟红，马培荪，陈佳品．模糊神经网络在四足步行机器人控制中的应用．上海交通大学学报．1996，30(1)：42-48页
[40] 马培荪，郑伟红．四足步行机器人模糊神经网络控制．机器人．1997，19(1)：56-60页
[41] 张克，傅佩琛，强文义．小波神经网络在两足步行机器人爬斜坡中的应用．机器人．2002，22(2)：384-389页
[42] 孙虎章．自动控制原理．中央广播电视大学出版社，1994
[43] 汪国梁．电机学．机械工业出版社，1999．5：74-119，263-265页
[44] TMS320LF/LC240xA DSP Controllers System and Peripherals．Texas Instruments.2001
[45] TMS320LF/LC240xA DSP Controllers CPU and Instruction Set.Texas Instruments. 2001
[46] 殷跃红，尉忠信，黄晓曦．智能机器系统力觉及力控制技术．国防工业出版社，2001．4：40-150页
[47] 王福瑞．单片微机测控系统设计大全．北京航空航天大学出版社，1998．4：279-299页
[48] 李朝青．PC机及单片机数据通信技术．北京航空航天大学出版
社，2000．12：94-70页
[49] 王晓明．电动机的单片机控制．北京航空航天大学出版社，2002．5：6-149页
[50] 王幸之，王雷，翟成，王闪．单片机应用系统抗干扰技术．北京航空航天大学出版社，2000．2
[51] 韩壮志．基于DSP的新型灵巧手控制器设计与研制．北京航空航天大学硕士论文，1999
[52] 曾繁泰，陈美金．VHDL程序设计．清华大学出版社，2001．1
[53] 李刚．数字信号微处理器的原理及其开发应用．天津大学出版社，2000．4