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

权利要求书

1.一种履带自走式多功能果树栽植机器人控制系统，其特征在于：包括智能控制系统、液压传动控制系统和检测装置；

所述的智能控制系统包括，控制器、多路继电器、电源、水泵、排肥电机；所述的控制器包括但不限于单片机、PLC、DSP，作为智能控制系统和液压传动控制系统的控制单元，接收作业指令并发出相应指令；所述的多路继电器具备光耦隔离，对控制器干扰较小，通过执行控制器的信号控制电磁阀、水泵、排肥电机的动作；所述的电源采用直流电源，经稳压模块多级调压后为整个控制系统提供电能；所述的水泵和排肥电机采用直流电进行供电，通过继电器控制其电源的通断来实现作业的启停；

所述的液压传动控制系统，包括液压泵、三位四通电磁换向阀、二位四通电磁换向阀、液压马达、同步液压缸、垂直升降液压缸、液压油箱、溢流阀、过滤器、冷却器、调速阀、双向液压锁；所述的液压泵将动力源提供的机械能转换为液体压力能；所述的三位四通电磁换向阀为两个，控制器通过继电器控制电磁线圈的得电与失电实现阀芯的换向，三位四通电磁换向阀一实现了同步液压缸的伸缩，当两侧电磁阀不通电时，换向阀处于中位机能，P口封闭，油液回油箱，液压缸利用双向液压锁保持活塞锁住不动，当左侧电磁阀得电时，P口与B口相通进油，右侧单向阀打开，控制油口打开左侧单向阀，A口与T口相通实现回油，同步液压缸收缩，当右侧电磁阀得电时，P口与A口相通进油，左侧单向阀打开，控制油口打开右侧单向阀，B口与T口相通实现回油，同步液压缸伸展，三位四通电磁换向阀二同理可述；所述的二位四通电磁换向阀为一个，实现了液压马达的单向转动，当右侧电磁阀不通电时，油液经P口至T口回油箱，当右侧电磁阀通电时，油液经P口至A口实现对液压马达的驱动；所述的液压马达在挖坑、混肥、回填时均为单向转动；所述的同步液压缸为两个液压缸，末端固定于机架，首端固定于平行四边形一边，液压缸的同步伸缩实现了平行四边形的角度变化，同步液压缸的进出油口分别为并联，实现了同步运动；所述的垂直升降液压缸竖直上升下降，挖坑时随深度变大阻力变大，采用点动下降的方式配合液压马达完成挖坑作业；所述的液压油箱为油路提供工作介质，采用46号液压油；所述的溢流阀旁接在液压泵的出口处，起到保护油路的作用；所述的过滤器安装在油箱与液压泵之间，过滤油路中的杂质，保护各液压元件；所述的冷却器安装在回油油路，起到降低液压油温度的作用；所述的调速阀安装在液压马达的入口处，可以对其进行调速；所述的双向液压锁对液压缸活塞起到锁定的作用，阻止了外界载荷的干扰；

所述的检测装置，包括运行状态检测装置、行程检测装置；所述的运行状态检测装置包括但不限于编码器、激光对射传感器、红外光电开关传感器，将其布置于履带行走装置的主动轮处，对机器人的运行状态进行判断，当机器人处于移动状态时，向控制器发送运输状态信号，当机器人处于停止状态时，向控制器发送作业状态信号；所述的行程检测装置向控制器反馈各运动部件的行程信息，包括霍尔角度传感器和微动开关传感器；所述的霍尔角度传感器布置于平行四边形装置的回转轴上，当下筒与地面接触以及下筒上升至最高位置时，回转轴分别处于两个极限角度位置，通过检测角度信息反馈信号给控制器实现对同步液压缸运行状态以及水泵的控制；所述的微动开关传感器有四个，其中三个皆布置于滑轨处，滑块触碰微动开关时会给控制器反馈不同的作业信号，从而实现对液压执行元件的不同组合控制，第四个布置于挡板处，当提起挡板时微动开关被触动使液压马达转动实现卸料，放下挡板时微动开关复位使液压马达及水泵停止转动。

2.根据权利要求1所述的一种履带自走式多功能果树栽植机器人控制系统的控制方法，其特征在于，其控制过程如下：

1)操作人员通过控制履带行走装置档位使机器人到达作业位置，并对控制系统进行供电；

2)运行状态检测装置对履带行走装置主动轮的运行状态进行判断，检测到履带行走装置处于静止状态，发送作业信号至控制器；

3)三位四通电磁换向阀一右侧电磁阀得电使同步液压缸伸展，霍尔角度传感器检测极限角度位置使同步液压缸停止伸展，下套筒与地面恰好接触；

4)三位四通电磁换向阀二左侧电磁阀得电使垂直升降液压缸持续收缩，滑块触碰至微动开关传感器二，二位四通电磁换向阀右侧电磁阀通电使液压马达、排肥电机启动，同时垂直升降液压缸由持续收缩改为点动收缩，进行挖坑排肥混肥作业；

5)滑块触碰到微动开关传感器三，排肥电机停止转动，三位四通电磁换向阀二电磁阀失电，垂直升降液压缸停止收缩，液压马达持续转动，进行充分混肥作业。

6)三位四通电磁换向阀二右侧电磁阀得电使垂直升降液压缸持续伸展，当滑块触碰到微动开关传感器一时垂直升降液压缸停止伸展，三位四通电磁换向阀一左侧电磁阀得电使同步液压缸收缩，霍尔角度传感器检测极限角度位置使同步液压缸停止收缩，水泵开启；

7)提升挡板触碰到微动开关传感器四，液压马达旋转使肥土回填至坑穴中，放下挡板，微动开关传感器四复位，液压马达和水泵停止作业；

8)操作人员切换档位使机器人开始行进，向前行进至下一个作业地点，期间运行状态检测装置对履带行走装置的运行状态判断为运输状态，各作业元件不发生动作；

9)完成栽植作业后，关闭机器人电源，通过控制履带行走装置档位使机器人回到原始位置。