果园管理机器人平台的自动导航系统研究
详细信息    本馆镜像全文|  推荐本文 |  |   获取CNKI官网全文
摘要
为了提高果园精细作业的自动化程度、降低作业成本、推动机器人产品的应用,本研究开发了一种果园用履带式移动机器人,作为进行果园喷药和果实采摘等果园精细化作业的移动平台,所设计的果园机器人由机器人本体和机器人导航机构两部分组成。本研究采用基于曲柄滑块机构的导航方式,用直径4cm的胶皮管按预定轨迹铺设轨道,机器人工作时导向轮与轨道啮合,机器人本体、轨道及机器人导向机构共同构成曲柄滑块机构。主要取得的结论归纳如下:
     (1)提出一种基于曲柄滑块机构的机器人自动导航方式,建立了机器人运动学模型,计算分析了机器人导航系统各构件的运动特性。对机器人的行驶总阻力进行计算分析,确定机器人需要的驱动功率。
     (2)搭建了果园机器人移动平台,在机器人移动平台安装姿态角传感器、位置角传感器、电机驱动控制系统、单片机控制系统等。开发了基于VC++6.0和Keil uVision2软件的跟踪控制器。对位置角传感器和姿态角传感器进行标定,分析传感器标定结果,在控制器中对传感器采集信号进行处理,以提高传感器所采集信号的精度。
     (3)设计了基于单片机的控制系统硬件电路,包括电源电路部分和微控制器电路部分。详细介绍了各个部分的设计思想、电路原理图。
     (4)对机器人行驶性能进行一系列测试,标定了机器人直线行驶速度,分析了机器人在水泥地面直线匀速行驶时产生前滑移现象的原因。
     (5)在分析果园管理机器人行驶路径特点的基础上,对机器人行驶路径进行规划,设计了模糊PID控制器,进行了机器人直线跟踪和曲线跟踪试验。试验结果表明,机器人以0.15m/s的速度直线行走时,最大跟踪误差小于0.02m;机器人转弯半径为2m时,最大跟踪误差小于0.05m。所设计的模糊PID控制器能够满足机器人作业路径跟踪控制的要求。
For raising automation level of orchard precision management, decreasing the management cost, and promoting the application of robot products, an orchard tracked mobile robot is designed in this paper. The orchard robot is composed of robot body and robot guiding mechanism. A method based on the principle of slider-crank mechanism is used in this paper. A rubber pipeline whose diameter is 4 centimeters is laid down in the orchard as the path of the robot, robot body, rubber pipeline and robot guiding mechanism will constitute a slider-crank mechanism after the robot guiding wheel contacts with the rubber pipeline. In the slider-crank mechanism, the robot body is the crank, the shaft is the linkage and the guide wheel is the slide. This robot will be used in orchard management, such as variable spraying and fruit picking. The main result of this paper is as the following:
     (1) A method based on the principle of slider-crank mechanism is presented in this paper, and kinematics model of the robot is built, analyses the dynamical characteristics of the robots and presents the dynamical differential equations of the system. The driving drag and driving power are calculated for the robot.
     (2) Putting up the robot mobile platform, including the installation of attitude angle sensor, position angle sensor, DC servo driven system and MCU control system. The software controller is realized with VC++ 6.0 and Keil uVision2.
     (3) The detailed hardware circuit of control system based on AT89S52 is designed, including power circuit part and the microcontroller circuit part.
     (4) A series of experimental and analytical research on the riding performance of the robot are conducted. The robot velocity calibrated, the reasons of the robot slip forward during the straight driving is analyzed.
     (5)Based on the analysis of the path characteristics, the article performs the path planning and designs the Fuzzy-PID controller of the robot. Lines and curve tracking were carried out, the experiments showed that the maximum tracking error was less than 0.02 when the robot moved straight at the speed of 0.15m/s, and the maximum tracking error was less than 0.05m when the turning radius was 2m.
引文
安秋,李志臣,姬长英,周俊. 2009.基于光照无关图的农业机器人视觉导航算法.农业工程学报, 25(11): 208~212
    蔡健荣,赵杰文, Thomas R, Macco K. 2007.水果收获机器人避障路径规划.农业机械学报, 38(3): 102~105
    蔡健荣,周小军,王锋,吕强. 2009.柑橘采摘机器人障碍物识别技术.农业机械学报, 40(11): 171~175
    蔡卫国,马莉莎,李莉. 2007.电磁诱导式喷雾机器人导航控制设计.机械设计与制造, 4: 136~138
    曹其新,吕恬生,永田雅辉,王红永. 1999.草莓拣选机器人的开发.上海交通大学学报, 33(7): 880~884
    曹倩,王库,杨永辉,史小磊. 2009.基于TMS320DM642的农业机器人视觉导航路径检测.农业机械学报, 40(7): 171~175
    陈军,韩冰,朱忠祥,武田纯一. 2008.拖拉机半挂车机组自动直线倒车控制器设计与实验.农业机械学报, 39(1): 102~105
    陈军,鸟巢谅,武田纯一. 2005.带单轴拖车拖拉机自动倒车行驶的研究.农业工程学报, 21(10): 82~85
    陈军,鸟巢谅,朱忠祥. 2005.拖拉机在牧草地上自动引导行走的控制.农业机械学报, 36(7): 104~107
    陈军,鸟巢谅. 2005.拖拉机行驶路线的自动变更研究.农业工程学报, 21(1): 83~86
    陈军,朱忠祥,鸟巢谅,武田纯一. 2006.拖拉机沿曲线路径的跟踪控制.农业工程学报. 22(11): 108~111
    陈军,朱忠祥,鸟巢谅,武田纯一. 2007.基于神经网络的农用车辆自动跟踪控制.农业机械学报, 38(5): 131~133
    陈丽,王越超,李斌. 2002.蛇形机器人研究现况与进展.机器人, 24(6): 559~563
    陈淑艳,陈文家. 2007.履带式移动机器人研究综述.机电工程, 24(12): 109~112
    陈勇,桂卫华,阳春华. 2009.深海采矿机器人的行走鲁棒控制.控制与决策, 24(5): 794~800
    戴刘江,张铁中,杨丽. 2007.基于DSP的草莓采摘机器人关节控制器的研究.中国科技论文在线, 2(3): 231~234
    范路桥,蒋梁中,汪伟,姚锡凡,何春彬. 2007.排爆机器人双目立体视觉系统的研究和开发.计算机工程, 33(7): 207~209
    范路桥,姚锡凡,蒋梁中,汪伟. 2008.半智能排爆机器人的单手双目手眼系统.华南理工大学学报(自然科学版), 36(4): 40~44
    方建军. 2004.移动式采摘机器人研究现状与进展.农业工程学报, 20(2): 273~278
    付西光,颜国正. 2005. 7-DOF核工业机器人的轨迹规划与仿真.系统仿真学报, 17(8): 1948~1950
    韩俊峰,李玉惠等. 2003.重庆:重庆大学出版社: 6-49
    何卿,高焕文,李洪文,王晓燕. 2007.机械式拖拉机导向探测装置.机械工程学报, 43(8): 159~164
    何卿,高焕文,李洪文. 2008.接触式拖拉机导航控制系统.农业机械学报, 39(1): 97~101
    侯小鹏,唐永哲. 2005.一种高速伺服系统的精确控制策略.微电机, 38(3): 58~60
    胡冰山,王立文,付庄,赵言正. 2009.带仿生吸盘的微型爬壁机器人设计及其吸附特性.哈尔滨工程大学学报, 30(9): 1012~1017
    胡明,邓宗全,王少纯,高海波. 2003.月球探测车移动系统的关键技术分析.哈尔滨工业大学学报, 35(7): 795~798
    黄志华,屠大维,赵其杰. 2009.基于人机交互的移动服务机器人导航系统.机器人, 31(3): 248~253
    李白云,赵春霞,张浩峰. 2009.自主机器人的快速激光雷达仿真算法研究.系统仿真学报, 21(16): 5075~5079
    李保江,朱剑英. 2005.弹跳式机器人研究综述.机械科学与技术, 24(7): 803~807
    李竞驰. 2007.果园多作业辅佐机器人系统研究与设计. [硕士学位论文].沈阳:沈阳工业大学
    连世江,陈军,贾海政,张伟华. 2009.基于模糊控制的拖拉机转向跟踪控制研究.西北农林科技大学学报, 37(9): 224~228
    刘景鹏. 2005.排土(岩)机履带行走装置驱动功率的确定及电机选型.机械研究与应用, 18(5): 73~74
    刘静,赵晓光,谭民. 2006.腿式机器人的研究综述.机器人, 28(1): 81~88
    刘兆祥,刘刚,乔军. 2010.苹果采摘机器人三维视觉传感器设计.农业机械学报, 41(2): 171~175
    刘壮志,席文明,朱剑英,吴洪涛. 2003.弹跳式机器人研究.机器人, 25(6): 568~573
    陆新华,张桂林. 2003.室内服务机器人导航方法研究.机器人, 25(1): 80~87
    马履中,杨文亮,王成军,陈修祥,薛城,林钰珍,刘爱荣. 2009.苹果采摘机器人末端执行器的结构设计与试验.农机化研究, 12: 65~67
    彭建平. 2000.双履带斗轮挖掘机行走阻力分析及应用.煤矿设计, 2000(5): 29~31
    钱堃,马旭东,戴先中,房芳. 2010.预测行人运动的服务机器人POMDP导航.机器人, 32(1): 18~24
    任永杰,郑继贵,杨学友,叶声华. 2007.利用激光跟踪仪对机器人进行标定的方法.机械工程学报, 43(9): 195~199
    宋健,张宾,张铁中. 2005.电磁诱导式喷雾机器人导航系统.农业机械学报, 36(12): 91~94
    宋健,张铁中,徐丽明,汤修映. 2006.果蔬采摘机器人研究进展与展望.农业机械学报, 37(5): 158~162
    孙玉山,王建国,万磊,王波. 2009.基于VxWorks的水下机器人嵌入式导航系统的研究.应用基础与工程科学学报, 17(6): 899~909
    唐粲,贠超,栾胜. 2005.一种新型医疗机器人运动学及灵活性分析.北京航空航天大学学报, 31(7): 748~752
    田国会,李晓磊,卜范骞. 2008.基于智能空间的家庭服务机器人SLAM.华中科技大学学报(自然科学版), 36(z1): 189~192
    王洪建,曹彤,刘达,唐粲. 2009.基于外摩擦的医疗机器人关节锁紧结构实验研究.机器人, 31(3): 193~196
    王津京,赵德安,姬伟,张超. 2009.采摘机器人基于支持向量机苹果识别方法.农业机械学报,40: 148~151
    王鹏飞,孙立宁,黄博. 2006.地面移动机器人系统的研究现状与关键技术.机械设计, 23(7): 1~ 4
    魏承,赵阳,田浩. 2010.空间机器人捕获漂浮目标的抓取控制.航空学报, 31(3): 632~637
    武二永,项志宇,沈敏一,刘济林. 2007.大规模环境下基于激光雷达的机器人SLAM算法.浙江大学学报, 41(12): 1982~1986
    闫树兵,姬长英. 2007.农业机器人移动平台的研究现状与发展趋势.拖拉机与农用运输车, 4(5): 13~15
    阎勤劳,孙莉莉,冯涛,郭红利. 2006.温室移动机器人驱动与控制系统的硬件设计.农业机械学报, 37(3): 87~90
    杨放琼,谭青,徐海良, Willgoss R A. 2007.利用红外和激光导向实现移动机器人的精确对接.光电工程, 34(11): 14~18
    于莲芝,颜国正,丁国清,梁卫冲. 2004.核工业机器人现场分布式控制.仪器仪表学报, 25(4): 849~850
    于曙风. 2005.电磁诱导式喷雾机器人控制系统的研究. [硕士学位论文].北京:中国农业大学
    贠超,唐粲. 2008. CT导航混联医疗机器人灵活性研究.北京航空航天大学学报, 34(7): 857~860
    张国良,曾静,柯熙政,邓方林. 2002.西安:西安交通大学出版社: 24-27
    张凯良,杨丽,张铁中. 2009.草莓收获机器人末端执行器的设计.农机化研究, 4: 54~56
    张铁中,陈利兵,宋健. 2005.草莓采摘机器人的研究:Ⅱ.基于图像的草莓重心位置和采摘点的确定.中国农业大学学报, 10(1): 48~51
    张铁中,林宝龙,高锐. 2004.水果采摘机器人视觉系统的目标提取.中国农业大学学报, 9(2): 68~72
    张铁中,周天娟. 2004.草莓采摘机器人的研究:Ⅰ.基于BP神经网络的草莓图像分割.中国农业大学学报, 9(4): 65~68
    张伟华,陈军. 2009. CCD摄像机标定.传感器与微系统, 28(2): 107~109
    赵登峰,王国强,许纯新,陈向东. 2003.基于模糊神经网络的智能履带车路径跟踪系统.农业工程学报, 19(2): 149~152
    赵小川,罗庆生,韩宝玲,肖伟. 2009.基于GPS的仿生六足机器人实时导航定位.计算机工程, 35(12): 166~168
    周俊,姬长英,刘成良. 2005.农用轮式移动机器人视觉导航系统.农业机械学报, 36(3): 91~94
    周俊,刘成良,姬长英. 2004.农业机器人视觉导航的预测跟踪控制方法研究.农业工程学报, 20(6): 106~110
    周天娟,张铁中,杨丽. 2007.草莓采摘机器人的研究:Ⅲ.扫描线填充算法在草莓图像孔洞填充中的应用.中国农业大学学报, 12(2): 67~71
    朱忠祥,陈军,鸟巢谅. 2006.基于PD控制的拖拉机半挂车机组自动直线倒车系统.农业机械学报, 37(7): 98~100
    朱忠祥,宋正河,谢斌,陈军,武田纯一,毛恩荣. 2009.拖拉机队列自动控制系统.农业机械学报, 40(8): 149~154
    Barawid Jr O C, Mizushima A, Ishii K, Noguchi N. 2007. Development of an Autonomous Navigation System using a Two-dimensional Laser Scanner in an Orchard Application. Biosystems Engineering, 96(2): 139~149
    Chapelle F, Bidaud P. 2006. Evaluation functions synthesis for optimal design of hyper-redundant robotic systems. Mechanism and Machine Theory, 41: 1196~1212
    Chernousko F L. 2005. Modelling of snake-like locomotion. Applied Mathematics and Computation, 164:415~434
    Choi H R, Ryew S M. 2002. Robotic system with active steering capability for internal inspection of urban gas pipelines. Mechatronics, 12: 713~736
    Crespi A, Badertscher A, Guignard A, Ijspeert A J. 2005. AmphiBot I: an amphibious snake-like robot.Robotics and Autonomous Systems, 50: 163~175
    Erden M S, Leblebicioglu K. 2008. Free gait generation with reinforcement learning for a six-legged robot.Robotics and Autonomous Systems, 56: 199~212
    Guo F, Cao Q, Cui Y, Nagata M. 2008. Fruit location and stem detection method for strawberry harvesting robot. Transactions of the CSAE, 24(10): 89~94
    Halloran D O, Wolf A, Choset H. 2005. Design of a high-impact survivable robot. Mechanism and Machine Theory, 40: 1345~1366
    Hayashi S, Shigematsu K, Yamamoto S, Kobayashi K, Kohno Y, Kamata J, Kurita M. 2010. Evaluation of a strawberry-harvesting robot in a field test. Biosystems engineering, 105: 160~171
    He G P, Tan X L, Zhang X H, Lu Z. 2008. Modeling, motion planning, and control of one-legged hopping robot actuated by two arms. Mechanism and Machine Theory, 43: 33~49
    Hirzinger G, Brunner B, Landzette K, Schott J. 1998. Preparing a new generation of space robots-A survey of research at DLR. Robotics and Autonomous Systems, 23: 99~106
    Kabe T, Tanaka K, Ikeda H, Sugimoto N. 2010. Consideration on safety for emerging technology-Case studies of seven service robots. Safety Science, 48: 296~301
    Keicher R, Seufert H. 2000. Automatic guidance for agricultural vehicles in Europe. Computers and Electronics in Agriculture, 25: 169~194
    
    Kise M, Zhang Q, Rovira Ma F. 2005. A Stereovision-based Crop Row Detection Method for Tractor-automated Guidance. Biosystems Engineering, 90(4): 357~367
    Lacagnina M, Muscato G, Sinatra R. 2003. Kinematics, dynamics and control of a hybrid robot Wheeleg. Robotics and Autonomous Systems, 45: 161~180
    Linker R, Blass T. 2008. Path-planning algorithm for vehicles operating in orchards. Biosystems Engineering, 101: 152~160
    Liu S, Wu L, Lu Z. 2007. Impact dynamics and control of a flexible dual-arm space robot capturing an object. Applied Mathematics and Computation, 185:1149~1159
    Lund H H. 2001. Adaptive robotics in entertainment. Applied Soft Computing, 1: 3~20
    Nagasaka Y, Umeda N, Kanetai Y, Taniwaki K, Sasaki Y. 2004. Autonomous guidance for rice transplanting using global positioning and gyroscopes. Computers and Electronics in Agriculture, 43: 223~234
    Qiao J, Sasao A, Shibusawa S, Kondo N, Morimoto E. 2005. Mapping Yield and Quality using the Mobile Fruit Grading Robot. Biosystems Engineering, 90(2): 135~142
    Rai L, Kang S J. 2008. Rule-based modular software and hardware architecture for multi-shaped robots using real-time dynamic behavior identification and selection. Knowledge-Based Systems, 21: 273~283
    Reid J F, 2000. Agricultural automatic guidance research in North America. Computers and Electronics in Agriculture, 25: 133~153
    Severinson-Eklundh K, Green A, Hüttenrauch H. 2003. Social and collaborative aspects of interaction with a service robot. Robotics and Autonomous Systems, 42: 223~234
    Shammas E, Wolf A, Choset H. 2006. Three degrees-of-freedom joint for spatial hyper-redundant robots. Mechanism and Machine Theory, 41: 170~190
    Shi C, Wang Y, Yang J. 2010. A local obstacle avoidance method for mobile robots in partially known environment. Robotics and Autonomous Systems, 58: 425~434
    Subramanian V, Burks T F, Arroyo A A. 2006. Development of machine vision and laser radar based autonomous vehicle guidance systems for citrus grove navigation. Computers and Electronics in Agriculture, 53: 130~143
    Tanigaki K, Fujiura T, Akase A, Imagawa J. 2008. Cherry-harvesting robot. Computers and Electronics in Agriculture, 63: 65~72
    Tanner H G, Kyriakopoulos K J, Krikelis N I. 2001. agricultural robots: kinematics and dynamics of multiple mobile manipulators handling non-rigid material. Computers and Electronics in AgricultureAdvanced, 31: 91~105
    Torii T. 2000. Research in autonomous agriculture vehicles in Japan. Computers and Electronics in Agriculture, 25: 155~167
    Tschichold-Gürman N, Vestli S J, Schweitzer G. 2001. The service robot MOPS: First operating experiences. Robotics and Autonomous Systems, 34: 165~173
    Yoshimitsua T, Kubota T, Nakatani I, Adachi T, Saito H. 2003. Micro-hopping robot for asteroid exploration. Acta Astronautica, 52: 441~446

© 2004-2018 中国地质图书馆版权所有 京ICP备05064691号 京公网安备11010802017129号

地址:北京市海淀区学院路29号 邮编:100083

电话:办公室:(+86 10)66554848;文献借阅、咨询服务、科技查新:66554700