采摘机器人运动控制系统的设计与实现-专业论文-自动化应用案例

采摘机器人运动控制系统的设计与实现

发布日期：2017-10-19 来源：《智能机器人》3期作者：曾小玲浏览次数：29820

分享到：

【摘　要】：机器人运动控制系统的分析与设计部分立足于采摘机器人的工作环境，并结合采摘机器人自身运动方面的需求和其它机械部分的需求来设计。主要包括：电源模块、电机控制模块、电机驱动模块、显示模块等。并对运动控制系统的避障部分进行了设计。最后，通过仿真验证了运动控制系统设计的准确性，达到了实验预期目的。

关键词：采摘机器人；电机驱动；避障

1 引言

随着电子技术和计算机技术的发展，智能机器人已在许多领域得到日益广泛的应用。在农业生产中，由于作业对象的复杂、多样，以及当前我国正面临人口老年化的趋势^[1]，使得新型农业机械——农业机器人的开发具有巨大经济效益和广阔的市场前景，符合社会发展的需求^[2]。采摘机器人是针对水果和蔬菜，可以通过编程来完成这些作物的采摘、转运、打包等相关作业任务的具有感知能力的自动化机械收获系统，是集机械、电子、信息、智能技术、计算机科学、农业和生物等学科于一体的交叉边缘性科学^[3]。

采摘机器人是基于人工采摘果实作业中耗时、费力等因素而应运而生的智能农业装备^[4]。运动控制系统作为采摘机器人控制系统中不可或缺的部分为机器人实现连续、稳定的采摘工作提供了必要的保证。

2 采摘机器人整体机械结构的分析

通常采摘机器人的结构是由机械手臂、末端执行机构、运动行走机构、视觉识别装置、控制模块、能源组块组成。图1是采摘机器人的整体结构示意图。图中采摘机器人为四轮式的采摘机器人，其由机械手臂、末端执行机构、运动行走机构、视觉识别装置、控制模块、电源模块组成。采用5个电机控制，使机器人能够多自由度工作。

3 运动控制系统的总框图

鉴于采摘机器人的本职工作是顺利完成采摘工作，运动控制系统处于辅助的地位而并不需要像抢险救灾机器人等机器人精于路况处理的智能机器人那样处理复杂的实时环境问题。同时为了提高运动系统的稳定性能，避免设备的不必要的效率消耗以及降低投入成本和达到灵活的避险要求。设计的运动控制系统的总框图如图2所示。

4 运动控制系统硬件设计

4.1 主控器模块设计

根据设计要求，控制器主要用于各种信号的处理、控制算法实现、底盘电动机的控制和声光报警等，控制器选择ATMEL公司生产的AT89C52单片机作为系统控制器。

4.2 电机控制模块电路设计

本设计中电机的控制方式是PWM波控制方式。控制两个电机：前轮控制车体转向的步进电机；后轮控制电机前进后退的直流电机。图3是前轮步进电机的电路图，图4为直流电机用H桥驱动的电路图。

（1）前轮控制电机转向的步进电机的电路设计

前轮电机用ULN2003A作为电机驱动器，用于完成电机的正反转。

（2）后轮控制车体的前进后退的电机的电路设计

4.3 报警模块电路设计

本模块硬件分为两个部分：光报警和声报警电路。LED灯与电阻组成光报警；蜂鸣器与驱动电路组成的声报警。声报警部分的驱动是由8050构成的放大电路。报警模块是依据避障部分提供的信号而动作的。当机器人正常运行时，报警模块不产生动作；当检测系统检测到障碍物时，报警模块动作，LED等闪光，同时蜂鸣器发出报警，起到提示作用。

4.4显示模块电路设计

本设计的显示模块目标是能够显示出电机的正反转停等信息。采用的是带中文字库的128X64LCD屏幕。128X64LCD是一种具有4位/8位并行、2线或3线串行多种接口方式，内部含有国标一级、二级简体中文字库的点阵图形液晶显示模块；其显示分辨率为128×64, 内置8192个16*16点汉字，和128个16*8点ASCII字符集.利用该模块灵活的接口方式和简单、方便的操作指令，可构成全中文人机交互图形界面^[5]。可以显示8×4行16×16点阵的汉字. 也可完成图形显示.低电压低功耗是其又一显著特点^[6]。由该模块构成的液晶显示方案与同类型的图形点阵液晶显示模块相比，不论硬件电路结构或显示程序都要简洁得多，且该模块的价格也略低于相同点阵的图形液晶模块。

4.5 超声波模块电路设计

采摘机器人中传感器主要应用于果实的识别、系统的导航、以及避障。果实识别与采摘采用视觉传感器、位置传感器、力传感器，系统导航采用电磁传感器，运动系统避障采用超声波传感器。本设计中的传感器主要是应用于运动控制系统的避障设计，避障系统所要达到的要求是准确判断车体前后方有无障碍物。若有则执行避障任务，即急停、报警提示。

本设计采用T/R-40-12小型超声波传感器作为探测前方障碍物体的检测元件，其中心频率为40Hz，由89C52发出的40KHz脉冲信号驱动超声波传感器发送器发出40KHz的脉冲超声波，如机器人运动时前方遇到有障碍物时，此超声波信号被障碍物反射回来，由接收器接收，经LM318两级放大，再经带有锁相环的音频解码芯片LM567解码，当LM567的输入信号大于25mV时，输出端由高电平变为低电平，送单片机处理。

5 运动控制系统总程序流程图

首先小车进行上电初始化程序，屏幕显示小车初始状态，后小车开始前进，前进过程中单片机通过超声波模块不断检测距前方障碍物。当检测距离小于程序设定的避障安全距离时判定前方有障碍物，此时小车停止前进，与此同时声光报警器动作，发光 LED不断闪烁与此同时单片机控制电机驱动模块驱动电机完成避障操作完，避障动作完成后小车继续前进并检测前方障碍物。图5为系统总程序流程图。

6 系统仿真

仿真采用按键代替采摘机器人采摘结构提供的信号，用于控制后轮电机的转动，并将电机的状态信息显示出去。前轮电机的转动，也是通过按键来模拟采摘机构提供的信号来完成。图6所示，显示的是后轮电机处于停止状态，显示屏显示为“停止”。此时LED点亮，蜂鸣器发出警报，车体停止运动。如图7所示，显示的是后轮电机处在正转的状态，在显示屏中显示为“前进”。此时无采摘任务，且前方无障碍物，机器人处于前进状态。