[发明专利]一种履带自走式多功能果树栽植机器人控制系统及方法

摘要

本发明涉及一种履带自走式多功能果树栽植机器人控制系统及方法，包括智能控制系统、液压传动控制系统和检测装置。所述的智能控制系统，处理检测装置的反馈作业信号控制机器人进行挖坑、排肥、混肥、回填和浇灌的流程化作业；所述的液压传动控制系统，一方面处理动力源传递的机械能，另一方面接收智能控制系统下达的电信号指令控制执行元件完成栽植作业各阶段任务；所述的检测装置用于检测机器人的行走状态以及栽植作业中各运动部件的行程位置。本发明实现了果树栽植过程中挖坑、排肥、混肥、回填、浇灌的智能化作业模式，操作方法简便，执行效率高。

主权项

1.一种履带自走式多功能果树栽植机器人控制系统，其特征在于：包括智能控制系统、液压传动控制系统和检测装置；所述的智能控制系统包括，控制器、多路继电器、电源、水泵、排肥电机；所述的控制器包括但不限于单片机、PLC、DSP，作为智能控制系统和液压传动控制系统的控制单元，接收作业指令并发出相应指令；所述的多路继电器具备光耦隔离，对控制器干扰较小，通过执行控制器的信号控制电磁阀、水泵、排肥电机的动作；所述的电源采用直流电源，经稳压模块多级调压后为整个控制系统提供电能；所述的水泵和排肥电机采用直流电进行供电，通过继电器控制其电源的通断来实现作业的启停；所述的液压传动控制系统，包括液压泵、三位四通电磁换向阀、二位四通电磁换向阀、液压马达、同步液压缸、垂直升降液压缸、液压油箱、溢流阀、过滤器、冷却器、调速阀、双向液压锁；所述的液压泵将动力源提供的机械能转换为液体压力能；所述的三位四通电磁换向阀为两个，控制器通过继电器控制电磁线圈的得电与失电实现阀芯的换向，三位四通电磁换向阀一实现了同步液压缸的伸缩，当两侧电磁阀不通电时，换向阀处于中位机能，P口封闭，油液回油箱，液压缸利用双向液压锁保持活塞锁住不动，当左侧电磁阀得电时，P口与B口相通进油，右侧单向阀打开，控制油口打开左侧单向阀，A口与T口相通实现回油，同步液压缸收缩，当右侧电磁阀得电时，P口与A口相通进油，左侧单向阀打开，控制油口打开右侧单向阀，B口与T口相通实现回油，同步液压缸伸展，三位四通电磁换向阀二同理可述；所述的二位四通电磁换向阀为一个，实现了液压马达的单向转动，当右侧电磁阀不通电时，油液经P口至T口回油箱，当右侧电磁阀通电时，油液经P口至A口实现对液压马达的驱动；所述的液压马达在挖坑、混肥、回填时均为单向转动；所述的同步液压缸为两个液压缸，末端固定于机架，首端固定于平行四边形一边，液压缸的同步伸缩实现了平行四边形的角度变化，同步液压缸的进出油口分别为并联，实现了同步运动；所述的垂直升降液压缸竖直上升下降，挖坑时随深度变大阻力变大，采用点动下降的方式配合液压马达完成挖坑作业；所述的液压油箱为油路提供工作介质，采用46号液压油；所述的溢流阀旁接在液压泵的出口处，起到保护油路的作用；所述的过滤器安装在油箱与液压泵之间，过滤油路中的杂质，保护各液压元件；所述的冷却器安装在回油油路，起到降低液压油温度的作用；所述的调速阀安装在液压马达的入口处，可以对其进行调速；所述的双向液压锁对液压缸活塞起到锁定的作用，阻止了外界载荷的干扰；所述的检测装置，包括运行状态检测装置、行程检测装置；所述的运行状态检测装置包括但不限于编码器、激光对射传感器、红外光电开关传感器，将其布置于履带行走装置的主动轮处，对机器人的运行状态进行判断，当机器人处于移动状态时，向控制器发送运输状态信号，当机器人处于停止状态时，向控制器发送作业状态信号；所述的行程检测装置向控制器反馈各运动部件的行程信息，包括霍尔角度传感器和微动开关传感器；所述的霍尔角度传感器布置于平行四边形装置的回转轴上，当下筒与地面接触以及下筒上升至最高位置时，回转轴分别处于两个极限角度位置，通过检测角度信息反馈信号给控制器实现对同步液压缸运行状态以及水泵的控制；所述的微动开关传感器有四个，其中三个皆布置于滑轨处，滑块触碰微动开关时会给控制器反馈不同的作业信号，从而实现对液压执行元件的不同组合控制，第四个布置于挡板处，当提起挡板时微动开关被触动使液压马达转动实现卸料，放下挡板时微动开关复位使液压马达及水泵停止转动。