[发明专利]一种可自主导航的履带式多机械臂苹果采摘机器人

摘要

本发明公开了一种可自主导航的履带式多机械臂苹果采摘机器人，包括履带式移动平台、导航系统和采摘系统。其特征是：所述的履带式移动平台包括履带总成、车体机架、实验设备固定机架、横梁、支撑立柱、液压缸体等；所述的导航系统包括机器视觉模块、超声波避障模块、GPS模块和导航控制模块；所述的采摘系统包括采摘机械臂、末端执行器、苹果收集装置等。本发明在履带式移动平台上集成四个苹果采摘机械臂并增加自主导航功能，提高了苹果采摘机器人的工作效率和自动化程度。

主权项

一种可自主导航的履带式多机械臂苹果采摘机器人，主要包括履带式移动平台、导航系统和采摘系统；其特征是：所述的履带式移动平台主要包括履带总成、车体机架[24]、实验设备固定机架[5]、横梁[23]、支撑立柱[18]、液压缸体[21]、控制盒[3]和蓄电池[20]；履带总成包括变速箱[4]、驱动轮[2]、导向轮[19]、承重轮[1]、张紧轮[23]、履带[27]和履带支撑梁[26]；车体机架[25]与四个根横梁[24]之间通过焊接连接，试验设备固定机架[5]和履带式移动平台之间通过四根支撑立柱[18]连接；，履带式移动平台以柴油机为动力机，可通过柴油机带动发电机发电，给蓄电池充电，再由蓄电池给采摘系统供电；液压缸体[22]用来调整机身平衡，可使履带式移动平台在丘陵山地上行走；所述的导航系统由机器视觉模块、超声波避障模块、GPS模块和导航控制模块组成；机器视觉模块由安装在履带式移动平台的最前部双目摄像头[21]实时采集果园道路环境信息，经图像处理器DSP处理，提取出图像中的果园路径与果树的二维信息；超声波避障模块由安装在履带式移动平台前后左右四角的超声波传感器实时采集履带式移动平台周围的障碍物信息；GPS模块用于检测履带式移动平台的当前位置信息以及路面环境信息；以上三种模块的最终信息都传递与导航控制模块的ARM1处理器；导航控制模块的ARM1处理器同时接收采摘控制模块的ARM2处理器的相关信息，当采摘系统检测不到苹果目标信息时，采摘控制模块的ARM2处理器向导航系统控制模块的ARM1处理器发送“行走”指令信息，则ARM1处理器将接收到的机器视觉模块、超声波避障模块、GPS模块的相关信息按照一定规则进行融合计算处理后求出导航参数以及相应的控制信号，对履带式移动平台的驱动电机进行驱动控制实现相关的行走、转向运动；当行走过程中采摘系统检测到苹果目标信息时ARM2处理器向ARM1处理器发送“停止”指令信息，则ARM1处理器对履带式移动平台进行停车控制处理；所述的采摘系统由采摘机械执行模块和采摘控制模块组成；采摘机械执行模块主要包括四个采摘机械臂和末端执行器、苹果收集装置；四个采摘机械臂通过螺栓固定在可调整高度的升降台[17]上，升降台[17]通过螺栓分别固定在实验设备固定机架[5]的前后左右四个位置上；苹果收集装置由连接在机械臂推杆[10]上的柔性管[7]和苹果收集箱[6]组成，苹果收集箱[6]安装在实验设备固定机架[5]的前方和后方；采摘机械臂主要包括推杆[10]、小臂电机[11]、大臂[12]、大臂电机[13]、腰部[14]、腰部电机[15]，采摘机械臂上布置有位置传感器、有限位开关传感器、力敏电阻碰撞传感器，以保证机械臂在安全的工作范围内运动和避免机械臂与机械臂以及机械臂和障碍物发生碰撞；末端执行器的三指中心位置安装有摄像头、红外位置传感器、采摘苹果压力传感器；所述的采摘控制模块有四个采摘控制盒[16]，分别控制对应的四个机械臂和末端执行器，采摘控制盒[16]通过螺栓固定在实验设备固定机架[5]上，每个控制盒内装有ARM2处理器，ARM2处理器与DSP芯片、伺服电机驱动、位置传感器、采摘苹果压力传感器、有限位开关传感器、力敏电阻碰撞传感器以及ARM1相连；DSP芯片与摄像头和红外距离传感器相连，DSP芯片将摄像头采集到的图像信息和红外距离传感器的信息进行处理后传递给ARM1处理器；当检测不到苹果信息时，ARM2处理器将向导航控制模块的ARM1处理器发送“行走”信号指令；当检测到苹果信息时，ARM2处理器向导航控制模块的ARM1处理器发送“停止”信号指令，同时将接收到的DSP芯片传递来的目标苹果的位置信息与有限位开关传感器、力敏电阻碰撞传感器、位置传感器以及采摘苹果压力传感器传递来的信息进行融合处理分析，得出相应的控制信号，对采摘机械臂以及末端执行器上的伺服电机进行相应控制，从而驱动采摘机械臂和末端执行器对苹果进行采摘。