CN114516053A - 一种履带式自动割胶机器人控制系统及其使用方法 - Google Patents
一种履带式自动割胶机器人控制系统及其使用方法 Download PDFInfo
- Publication number
- CN114516053A CN114516053A CN202210293672.0A CN202210293672A CN114516053A CN 114516053 A CN114516053 A CN 114516053A CN 202210293672 A CN202210293672 A CN 202210293672A CN 114516053 A CN114516053 A CN 114516053A
- Authority
- CN
- China
- Prior art keywords
- tapping
- crawler
- rubber
- mechanical arm
- motor
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000010079 rubber tapping Methods 0.000 title claims abstract description 230
- 238000000034 method Methods 0.000 title claims abstract description 34
- 238000012545 processing Methods 0.000 claims abstract description 41
- 230000008569 process Effects 0.000 claims abstract description 18
- 238000013500 data storage Methods 0.000 claims abstract description 16
- 238000005520 cutting process Methods 0.000 claims description 50
- 244000043261 Hevea brasiliensis Species 0.000 claims description 37
- 230000007246 mechanism Effects 0.000 claims description 30
- 229920001971 elastomer Polymers 0.000 claims description 17
- 239000005060 rubber Substances 0.000 claims description 17
- 230000009471 action Effects 0.000 claims description 8
- 238000006243 chemical reaction Methods 0.000 claims description 7
- WHXSMMKQMYFTQS-UHFFFAOYSA-N Lithium Chemical compound [Li] WHXSMMKQMYFTQS-UHFFFAOYSA-N 0.000 claims description 4
- 229910052744 lithium Inorganic materials 0.000 claims description 4
- 229920000642 polymer Polymers 0.000 claims description 4
- 238000002360 preparation method Methods 0.000 claims description 4
- 230000009467 reduction Effects 0.000 claims description 4
- 238000009434 installation Methods 0.000 claims description 3
- 238000013480 data collection Methods 0.000 claims 1
- 229920003052 natural elastomer Polymers 0.000 description 4
- 229920001194 natural rubber Polymers 0.000 description 4
- 238000011161 development Methods 0.000 description 3
- 239000004575 stone Substances 0.000 description 3
- 230000009286 beneficial effect Effects 0.000 description 2
- 238000012937 correction Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 239000010985 leather Substances 0.000 description 2
- 102000008186 Collagen Human genes 0.000 description 1
- 108010035532 Collagen Proteins 0.000 description 1
- 229920001436 collagen Polymers 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000007726 management method Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 239000002994 raw material Substances 0.000 description 1
- 238000012827 research and development Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 238000003860 storage Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 229920003051 synthetic elastomer Polymers 0.000 description 1
- 239000005061 synthetic rubber Substances 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01G—HORTICULTURE; CULTIVATION OF VEGETABLES, FLOWERS, RICE, FRUIT, VINES, HOPS OR SEAWEED; FORESTRY; WATERING
- A01G23/00—Forestry
- A01G23/10—Tapping of tree-juices, e.g. caoutchouc, gum
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J11/00—Manipulators not otherwise provided for
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Life Sciences & Earth Sciences (AREA)
- Biodiversity & Conservation Biology (AREA)
- Ecology (AREA)
- Forests & Forestry (AREA)
- Environmental Sciences (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明提供了一种履带式自动割胶机器人控制系统及其使用方法,该控制系统包括数据采集模块、导航循迹模块、中央控制单元、和割胶机器人,数据采集模块用于采集外界障碍和割胶状态的信息;导航循迹模块用于所述割胶机器人的导航;中央控制单元包括所述数据存储单元和数据处理模块,数据处理模块将数据采集模块采集的信号处理后发送至割胶机器人执行相应避障及割胶作业任务,数据存储单元用于将作业数据存储在数据存储模块中。
Description
技术领域
本发明属于机器人控制技术领域,尤其涉及一种履带式自动割胶机器人控制系统及其使用方法。
背景技术
天然橡胶是一种重要的工业原料和战略资源,在交通、军用工业中尤为重要。天然橡胶的某些性能如高抗冲击、耐穿刺、抗撕裂性能是合成橡胶无法比拟的。目前国内外天然橡胶田间生产机械化程度低,综合机械化水平低于10%,尤其是采胶作业,目前仍属于技术性的纯手工作业,且割胶劳动强度大,愿意从事胶原管理的胶工越来越少。随着未来经济的不断发展,劳动力缺乏将成为常态,橡胶园面临着失管的窘境,已严重制约天然橡胶产业的健康发展。
综上所述,如何提供一种操作简单、响应时间快、控制性能稳定的自动割胶机器人控制系统,实现自动进刀和割胶作业,克服人工割胶的困难,已经成为亟需解决的问题。
发明内容
本发明的目的就在于为了解决问题而提供一种履带式自动割胶机器人控制系统,包括数据采集模块、导航循迹模块、中央控制单元4、和割胶机器人,所述数据采集模块用于采集外界障碍和割胶状态的信息;所述导航循迹模块用于所述割胶机器人的导航;所述中央控制单元4包括所述数据存储单元和数据处理模块,所述数据处理模块将所述数据采集模块采集的信号处理后发送至所述割胶机器人执行相应避障及割胶作业任务,所述数据存储单元用于将作业数据存储在所述数据存储模块中。
优选的,所述割胶机器人包括割胶机械臂、连接平台3、切割机构5和履带式移动底盘,所述割胶机械臂通过连接平台3与所述履带式移动底盘固定连接;所述数据处理模块固定在履带式移动底盘上;所述数据采集模块设置在割胶机械臂上并与所述数据处理模块连接;所述切割机构5设置在所述割胶机械臂末端,由所述割胶机械臂带动所述切割机构5在橡胶树上进行螺旋运动;所述切割机构5与数据处理模块连接,由数据处理模块控制切割机构5的运动。
优选的,所述割胶机械臂包括六自由度机械臂8、步进电机9和机械臂固定平台10,六自由度机械臂8与所述中央控制单元4连接,步进电机9用于调节切割轨迹,机械臂固定平台10用于固定六自由度机械臂8的位置;
所述切割机构5包括仿形割胶轨道501、齿条502、法兰盘503、舵机504、割胶刀505、连接支架508和减速电机509,所述仿形割胶轨道501与齿条502相嵌,法兰盘503与所述六自由度机械臂8非接触面机械连接所述切割机构5,舵机504用于控制割胶刀505与橡胶树树干中心轴线的距离,所述减速电机509设置于连接支架508下方并与所述中央控制单元4连接;减速电机509接受中央控制单元4指令后带动连接支架508沿着仿形割胶轨道501螺旋运动以实现所述割胶刀505沿着橡胶树螺旋形移动割胶;
所述履带式移动底盘包括履带底盘1和直流减速电机14,所述直流减速电机14包括左电机和右电机且分别设置在履带底盘1左右两侧,所述履带式移动底盘的内部安装有供电电池2,
所述中央控制单元4、割胶机器人均与供电电池2连接。
优选的,所述数据采集模块包括压力传感器506、线激光测距传感器507、双目相机6、信号转换电路和激光雷达11,压力传感器506设置在所述割胶刀505下方用于控制割胶耗皮量,线激光测距传感器507设置在所述割胶刀505右侧用于控制割胶深度;所述信号转换电路用于将传感器采集到的信息传输至数据处理模块内;所述激光雷达11和所述双目相机6用于辅助履带式移动底盘在林间行走,所述激光雷达11通过雷达支架12安装履带底盘1上,所述双目相机6通过相机支架7与所述法兰盘503相连。
优选的,所述割胶机器人还包括多个驱动器,直流减速电机14、步进电机9、减速电机509和舵机504由相应的驱动器进行控制;所述履带式移动底盘上设有用于在紧急情况时迅速断电使机器停止工作的急停开关13以保障作业安全。
优选的,所述供电电池2采用2个12V串联的大容量锂聚合物电池组,组成24V供电电源;所述激光雷达11采用砝石激光雷达FSD-10;所述双目相机6采用USB免驱双目摄像头,型号为OV9732。
本发明的目的还在于提供一种履带式自动割胶机器人控制系统的使用方法,其特征在于,包括以下步骤:
步骤1,启动电源,中央控制单元4初始化,各电机开始复位;
步骤2,开启导航循迹模块,割胶机器人在胶林间自主行走并识别橡胶树和切割轨迹;
步骤3,开始割胶,完成一次割胶作业。
优选的,步骤2的具体步骤包括:
步骤21,启动电源,所述履带底盘1自主行走,激光雷达11在行走过程中采集周围信息,并将信息传输给数据处理模块,数据处理模块通过采集的信息控制直流减速电机14的转速和方向,辅助履带底盘1移动和避障,中央控制单元4发出开始指令进行初始化,完成割胶前的准备工作;
步骤22,双目相机6对橡胶树进行识别定位,履带底盘1根据扫描到的橡胶树位置进行移动,移动到橡胶树体前时双目相机6开始对切割轨迹的轮廓进行扫描,各电机根据扫描信息运动到割胶初始位置;
步骤23,完成一次割胶作业后,激光雷达11和双目相机6采集周围信号传输至所述中央控制单元4中,中央控制单元4根据采集信号构建局部三维点云图辅助履带式割胶机器人移动到下一个橡胶树的位置开始进行割胶作业。
优选的,一次割胶作业的过程包括:
步进电机9开始正转,控制六自由度机械臂8带动割胶刀505进行进刀动作,进刀的同时线激光测距传感器507开始工作,实时测量进刀深度的信息,并根据信号实时调整电机运行,当割胶刀505符合进到深度时继续工作,进刀动作完成;
进刀完成后六自由度机械臂8通过控制舵机504带动割胶刀505沿着仿形割胶轨道501进行螺旋运动,开始割胶工作,同时割胶刀505下方的压力传感器506开始工作,实时测量进刀压力的信息,控制割胶耗皮量;
判断割胶刀505是否到达扫描的切割终点,当位于终点时,割胶刀505停止工作,步进电机9反转,割胶刀505进行退刀动作,各电机进行复位,完成一次割胶过程。
优选的,舵机504采用伺服无刷电机,运动角度为0°~180°。
与现有技术相比,本发明具备以下有益效果:
1)本发明在一定程度上克服了人工割胶的困难,系统操作简单,控制稳定;
2)本发明采用激光雷达和双目相机建立局部三维点云图,辅助移动底盘进行胶园间行走、避障以及对橡胶树体割胶轨迹进行预扫描;
3)本发明采用压力传感器和线激光测距传感器对割胶过程进行进刀深度的PID路径修正,有助于割胶机器人控制精细化发展;
4)本发明采用履带式移动平台更加适应橡胶园崎岖的地形环境;
5)本发明能够减少割胶过程对胶工的依赖程度,有利于提高割胶作业效率,为后续研发割胶机器人提供了一种系统设计的方法。
附图说明
图1为本发明控制系统结构示意图;
图2为本发明控制系统的控制功能示意图;
图3为本发明的一种履带式自动割胶机器人的轴测图;
图4为本发明的一种履带式自动割胶机器人中割胶机构的轴测图;
图5为本发明的一种履带式自动割胶机器人的控制方法流程图;
图6为本发明的导航循迹模块的控制方法流程图;
图7为本发明的割胶模块的控制方法流程图。
图中附图标记为:
1-履带底盘,2-供电电池,3-连接平台,4-中央控制单元,5-切割机构,6-双目相机,7-相机支架,8-六自由度机械臂,9-步进电机,10-机械臂固定平台,11-激光雷达,12-雷达支架,13-急停开关,14-直流减速电机,501-仿形割胶轨道,502-齿条,503-法兰盘,504-舵机,505-割胶刀,506-压力传感器,507-线激光测距传感器,508-连接支架,509-减速电机。
具体实施方式
为使本发明实施的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行更加详细的描述。在附图中,自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。所描述的实施例是本发明一部分实施例,而不是全部的实施例。
基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
下面通过参考附图描述的实施例以及方位性的词语均是示例性的,旨在用于解释本发明,而不能理解为对本发明的限制。
在本发明的一个宽泛实施例中,一种履带式自动割胶机器人控制系统,包括数据采集模块、导航循迹模块、中央控制单元4、和割胶机器人,所述数据采集模块用于采集外界障碍和割胶状态的信息;所述导航循迹模块用于所述割胶机器人的导航;所述中央控制单元4包括所述数据存储单元和数据处理模块,所述数据处理模块将所述数据采集模块采集的信号处理后发送至所述割胶机器人执行相应避障及割胶作业任务,所述数据存储单元用于将作业数据存储在所述数据存储模块中。
优选的,所述割胶机器人包括割胶机械臂、连接平台3、切割机构5和履带式移动底盘,所述割胶机械臂通过连接平台3与所述履带式移动底盘固定连接;所述数据处理模块固定在履带式移动底盘上;所述数据采集模块设置在割胶机械臂上并与所述数据处理模块连接;所述切割机构5设置在所述割胶机械臂末端,由所述割胶机械臂带动所述切割机构5在橡胶树上进行螺旋运动;所述切割机构5与数据处理模块连接,由数据处理模块控制切割机构5的运动。
优选的,所述割胶机械臂包括六自由度机械臂8、步进电机9和机械臂固定平台10,六自由度机械臂8与所述中央控制单元4连接,步进电机9用于调节切割轨迹,机械臂固定平台10用于固定六自由度机械臂8的位置;
所述切割机构5包括仿形割胶轨道501、齿条502、法兰盘503、舵机504、割胶刀505、连接支架508和减速电机509,所述仿形割胶轨道501与齿条502相嵌,法兰盘503与所述六自由度机械臂8非接触面机械连接所述切割机构5,舵机504用于控制割胶刀505与橡胶树树干中心轴线的距离,所述减速电机509设置于连接支架508下方并与所述中央控制单元4连接;减速电机509接受中央控制单元4指令后带动连接支架508沿着仿形割胶轨道501螺旋运动以实现所述割胶刀505沿着橡胶树螺旋形移动割胶;
所述履带式移动底盘包括履带底盘1和直流减速电机14,所述直流减速电机14包括左电机和右电机且分别设置在履带底盘1左右两侧,所述履带式移动底盘的内部安装有供电电池2,
所述中央控制单元4、割胶机器人均与供电电池2连接。
优选的,所述数据采集模块包括压力传感器506、线激光测距传感器507、双目相机6、信号转换电路和激光雷达11,压力传感器506设置在所述割胶刀505下方用于控制割胶耗皮量,线激光测距传感器507设置在所述割胶刀505右侧用于控制割胶深度;所述信号转换电路用于将传感器采集到的信息传输至数据处理模块内;所述激光雷达11和所述双目相机6用于辅助履带式移动底盘在林间行走,所述激光雷达11通过雷达支架12安装履带底盘1上,所述双目相机6通过相机支架7与所述法兰盘503相连。
优选的,所述割胶机器人还包括多个驱动器,直流减速电机14、步进电机9、减速电机509和舵机504由相应的驱动器进行控制;所述履带式移动底盘上设有用于在紧急情况时迅速断电使机器停止工作的急停开关13以保障作业安全。
优选的,所述供电电池2采用2个12V串联的大容量锂聚合物电池组,组成24V供电电源;所述激光雷达11采用砝石激光雷达FSD-10;所述双目相机6采用USB免驱双目摄像头,型号为OV9732。
本发明的目的还在于提供一种履带式自动割胶机器人控制系统的使用方法,其特征在于,包括以下步骤:
步骤1,启动电源,中央控制单元4初始化,各电机开始复位;
步骤2,开启导航循迹模块,割胶机器人在胶林间自主行走并识别橡胶树和切割轨迹;
步骤3,开始割胶,完成一次割胶作业。
优选的,步骤2的具体步骤包括:
步骤21,启动电源,所述履带底盘1自主行走,激光雷达11在行走过程中采集周围信息,并将信息传输给数据处理模块,数据处理模块通过采集的信息控制直流减速电机14的转速和方向,辅助履带底盘1移动和避障,中央控制单元4发出开始指令进行初始化,完成割胶前的准备工作;
步骤22,双目相机6对橡胶树进行识别定位,履带底盘1根据扫描到的橡胶树位置进行移动,移动到橡胶树体前时双目相机6开始对切割轨迹的轮廓进行扫描,各电机根据扫描信息运动到割胶初始位置;
步骤23,完成一次割胶作业后,激光雷达11和双目相机6采集周围信号传输至所述中央控制单元4中,中央控制单元4根据采集信号构建局部三维点云图辅助履带式割胶机器人移动到下一个橡胶树的位置开始进行割胶作业。
优选的,一次割胶作业的过程包括:
步进电机9开始正转,控制六自由度机械臂8带动割胶刀505进行进刀动作,进刀的同时线激光测距传感器507开始工作,实时测量进刀深度的信息,并根据信号实时调整电机运行,当割胶刀505符合进到深度时继续工作,进刀动作完成;
进刀完成后六自由度机械臂8通过控制舵机504带动割胶刀505沿着仿形割胶轨道501进行螺旋运动,开始割胶工作,同时割胶刀505下方的压力传感器506开始工作,实时测量进刀压力的信息,控制割胶耗皮量;
判断割胶刀505是否到达扫描的切割终点,当位于终点时,割胶刀505停止工作,步进电机9反转,割胶刀505进行退刀动作,各电机进行复位,完成一次割胶过程。
优选的,舵机504采用伺服无刷电机,运动角度为0°~180°。
下面结合附图,列举本发明的优选实施例,对本发明作进一步的详细说明。
如图1、图2所示,本发明提供一种履带式自动割胶机器人控制系统,其包括数据采集模块、数据处理模块、数据存储单元、执行部件和供电电池2,数据采集模块用于采集外界障碍和割胶状态的信息,数据处理模块将所述数据采集模块采集的信号处理后发送至执行部件执行相应避障及割胶作业任务,并将作业数据存储在数据存储单元中,供电电池2用于给各模块供电。其中:
如图3、图4所示,履带式自动割胶机器人包括割胶机械臂、切割机构5和履带式移动底盘。割胶机械臂和数据处理模块固定在履带式移动底盘上,供电电池2设置在履带式移动底盘内部,数据采集模块设置在割胶机械臂上,并与数据处理模块连接,数据采集模块将接收的信号传输至所述数据处理模块中进行处理,并传输至所述数据存储单元中存储,数据处理模块根据接收到的测量信号控制所述割胶机械臂运动轨迹,切割机构5设置在割胶机械臂末端,由割胶机械臂带动切割机构5在橡胶树上进行螺旋运动,且切割机构5与数据处理模块连接,由数据处理模块控制切割机构5的运动,割胶机械臂包括六自由度机械臂8、步进电机9、和机械臂固定平台10,六自由度机械臂8与所述中央控制单元4连接,通过控制步进电机9调节切割轨迹,机械臂固定平台10用于固定六自由度机械臂8的位置。
切割机构5包括仿形割胶轨道501、齿条502、法兰盘503、舵机504、割胶刀505、连接支架508和减速电机509,仿形割胶轨道501与齿条502相嵌,法兰盘503与六自由度机械臂8非接触面机械连接所述切割机构5,舵机504用于控制割胶刀505与橡胶树树干中心轴线的距离,割胶刀505用于沿着橡胶树螺旋形移动进行割胶,减速电机509设置于连接支架508下方并与中央控制单元4连接;减速电机509接受中央控制单元4指令后带动连接支架508沿着仿形割胶轨道501螺旋运动。
上述各实例中,履带式移动底盘包括履带底盘1、供电电池2、激光雷达11和直流减速电机14,以履带底盘1为主体,激光雷达11通过雷达支架12安装履带底盘1上,减速电机509包括左电机和右电机,设置在履带底盘1左右两侧,供电电池2安装在履带式移动底盘的内部,中央控制单元4、执行部件均与供电电池2连接。
上述各实例中,割胶机械臂和履带式移动底盘通过连接平台3进行固定连接。
上述各实例中,履带式移动底盘上设有急停开关13用于在紧急情况时迅速断电,使机器停止工作,保障作业安全。
数据采集模块包括压力传感器506、线激光测距传感器507、双目相机6和激光雷达11,在割胶刀505下方设置有压力传感器506用于控制割胶耗皮量,在所述割胶刀505右侧设置有线激光测距传感器507用于控制割胶深度,双目相机6安装在相机支架7上并通过法兰盘503与所述六自由度机械臂8接触面机械连接。
上述实例中,数据采集模块还包括信号转换电路,将传感器采集到的信息传输至数据处理模块内。供电电池2采用2个12V串联的大容量锂聚合物电池组,组成24V电压。
上述各实例中,本发明还包括蜂鸣器预警模块,该模块与中央控制单元4连接,中央控制单元4将信号传入蜂鸣器,报警模块根据避障预警指令进行响铃预警。
上述各实例中,本发明还包括终端触摸屏采用AUBOPE型号屏,触摸屏与中央控制单元4连接,由触摸屏向中央控制单元4发送信号指令。触摸屏上设有启动、急停、复位、PID参数修正等按键。
如图5所示,本发明还提供一种自动割胶机器人控制系统的使用方法,其包括以下步骤:
1)启动电源,控制器初始化,电机开始复位;2)割胶机器人开启导航循迹模块,在胶林间自主行走并识别橡胶树和切割轨迹;3)扫描到橡胶切割轨迹后进入割胶模块,开始割胶,完成一次割胶作业;
上述各实例中,控制系统的导航循迹模块功能的执行包括以下步骤:
1)启动电源,履带底盘1能够自主行走,激光雷达11在行走过程中采集周围信息,并将信息传输给数据处理模块,数据处理模块通过采集的信息控制直流减速电机14的转速和方向,辅助履带底盘1移动和避障,直流减速电机14包括左电机和右电机,中央控制单元4发出开始指令,各电机、传感器和数据存储单元进行初始化,完成割胶前的准备工作;
2)电机和初始数据复位后,由安装在相机支架7上的双目相机6对橡胶树进行识别定位,履带底盘1根据扫描到的橡胶树位置进行移动,移动到橡胶树体前时双目相机6开始对切割轨迹的轮廓进行扫描,各电机根据扫描信息运动到割胶初始位置;
3)完成一次割胶作业后,激光雷达11和双目相机6采集周围信号传输至所述中央控制单元4中,中央控制单元4根据采集信号构建局部三维点云图辅助履带式割胶机器人移动到下一个橡胶树的位置开始进行割胶作业;
其中,激光雷达11采用砝石激光雷达FSD-10,双目相机6采用USB免驱双目摄像头,型号为OV9732。
上述各实例中,控制系统的割胶模块的功能包括以下步骤:
1)步进电机9开始正转,控制六自由度机械臂8带动割胶刀505进行进刀动作,进刀的同时割胶刀505右侧的线激光测距传感器507开始工作,实时测量进刀深度的信息,并根据信号实时调整电机运行,当割胶刀505符合进到深度时继续工作,进刀动作完成进入步骤2);
2)进刀完成后六自由度机械臂8通过控制舵机504带动割胶刀505沿着仿形割胶轨道501进行螺旋运动,开始割胶工作,同时割胶刀505下方的压力传感器506开始工作,实时测量进刀压力的信息,控制割胶耗皮量;
3)判断割胶刀505是否到达扫描的切割终点,当位于终点时,割胶刀505停止工作,步进电机9反转,割胶刀505进行退刀动作,各电机进行复位,完成一次割胶过程。
最后需要指出的是:以上实施例仅用以说明本发明的技术方案,而非对其限制。尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。
Claims (10)
1.一种履带式自动割胶机器人控制系统,包括数据采集模块、导航循迹模块、中央控制单元(4)、和割胶机器人,其特征在于,所述数据采集模块用于采集外界障碍和割胶状态的信息;所述导航循迹模块用于所述割胶机器人的导航;所述中央控制单元(4)包括所述数据存储单元和数据处理模块,所述数据处理模块将所述数据采集模块采集的信号处理后发送至所述割胶机器人执行相应避障及割胶作业任务,所述数据存储单元用于将作业数据存储在所述数据存储模块中。
2.根据权利要求1所述的一种履带式自动割胶机器人控制系统,其特征在于,所述割胶机器人包括割胶机械臂、连接平台(3)、切割机构(5)和履带式移动底盘,所述割胶机械臂通过连接平台(3)与所述履带式移动底盘固定连接;所述数据处理模块固定在履带式移动底盘上;所述数据采集模块设置在割胶机械臂上并与所述数据处理模块连接;所述切割机构(5)设置在所述割胶机械臂末端,由所述割胶机械臂带动所述切割机构(5)在橡胶树上进行螺旋运动;所述切割机构(5)与数据处理模块连接,由数据处理模块控制切割机构(5)的运动。
3.根据权利要求2所述的一种履带式自动割胶机器人控制系统,其特征在于,所述割胶机械臂包括六自由度机械臂(8)、步进电机(9)和机械臂固定平台(10),六自由度机械臂(8)与所述中央控制单元(4)连接,步进电机(9)用于调节切割轨迹,机械臂固定平台(10)用于固定六自由度机械臂(8)的位置;
所述切割机构(5)包括仿形割胶轨道(501)、齿条(502)、法兰盘(503)、舵机(504)、割胶刀(505)、连接支架(508)和减速电机(509),所述仿形割胶轨道(501)与齿条(502)相嵌,法兰盘(503)与所述六自由度机械臂(8)非接触面机械连接所述切割机构(5),舵机(504)用于控制割胶刀(505)与橡胶树树干中心轴线的距离,所述减速电机(509)设置于连接支架(508)下方并与所述中央控制单元(4)连接;减速电机(509)接受中央控制单元(4)指令后带动连接支架(508)沿着仿形割胶轨道(501)螺旋运动以实现所述割胶刀(505)沿着橡胶树螺旋形移动割胶;
所述履带式移动底盘包括履带底盘(1)和直流减速电机(14),所述直流减速电机(14)包括左电机和右电机且分别设置在履带底盘(1)左右两侧,所述履带式移动底盘的内部安装有供电电池(2),
所述中央控制单元(4)、割胶机器人均与供电电池(2)连接。
4.根据权利要求3所述的一种履带式自动割胶机器人控制系统,其特征在于,所述数据采集模块包括压力传感器(506)、线激光测距传感器(507)、双目相机(6)、信号转换电路和激光雷达(11),压力传感器(506)设置在所述割胶刀(505)下方用于控制割胶耗皮量,线激光测距传感器(507)设置在所述割胶刀(505)右侧用于控制割胶深度;所述信号转换电路用于将传感器采集到的信息传输至数据处理模块内;所述激光雷达(11)和所述双目相机(6)用于辅助履带式移动底盘在林间行走,所述激光雷达(11)通过雷达支架(12)安装履带底盘(1)上,所述双目相机(6)通过相机支架(7)与所述法兰盘(503)相连。
5.根据权利要求4所述的一种履带式自动割胶机器人控制系统,其特征在于,所述割胶机器人还包括多个驱动器,直流减速电机(14)、步进电机(9)、减速电机(509)和舵机(504)由相应的驱动器进行控制;所述履带式移动底盘上设有用于在紧急情况时迅速断电使机器停止工作的急停开关(13)以保障作业安全。
6.根据权利要求4所述的一种履带式自动割胶机器人控制系统,其特征在于,所述供电电池(2)采用2个12V串联的大容量锂聚合物电池组,组成24V供电电源;所述激光雷达(11)采用砝石激光雷达FSD-10;所述双目相机(6)采用USB免驱双目摄像头,型号为OV9732。
7.根据权利要求1-6任一所述的一种履带式自动割胶机器人控制系统的使用方法,其特征在于,包括以下步骤:
步骤1,启动电源,中央控制单元(4)初始化,各电机开始复位;
步骤2,开启导航循迹模块,割胶机器人在胶林间自主行走并识别橡胶树和切割轨迹;
步骤3,开始割胶,完成一次割胶作业。
8.根据权利要求7所述的一种履带式自动割胶机器人控制系统的使用方法,其特征在于,步骤2的具体步骤包括:
步骤21,启动电源,所述履带底盘(1)自主行走,激光雷达(11)在行走过程中采集周围信息,并将信息传输给数据处理模块,数据处理模块通过采集的信息控制直流减速电机(14)的转速和方向,辅助履带底盘(1)移动和避障,中央控制单元(4)发出开始指令进行初始化,完成割胶前的准备工作;
步骤22,双目相机(6)对橡胶树进行识别定位,履带底盘(1)根据扫描到的橡胶树位置进行移动,移动到橡胶树体前时双目相机(6)开始对切割轨迹的轮廓进行扫描,各电机根据扫描信息运动到割胶初始位置;
步骤23,完成一次割胶作业后,激光雷达(11)和双目相机(6)采集周围信号传输至所述中央控制单元(4)中,中央控制单元(4)根据采集信号构建局部三维点云图辅助履带式割胶机器人移动到下一个橡胶树的位置开始进行割胶作业。
9.根据权利要求8所述的一种履带式自动割胶机器人控制系统的使用方法,其特征在于,一次割胶作业的过程包括:
步进电机(9)开始正转,控制六自由度机械臂(8)带动割胶刀(505)进行进刀动作,进刀的同时线激光测距传感器(507)开始工作,实时测量进刀深度的信息,并根据信号实时调整电机运行,当割胶刀(505)符合进到深度时继续工作,进刀动作完成;
进刀完成后六自由度机械臂(8)通过控制舵机(504)带动割胶刀(505)沿着仿形割胶轨道(501)进行螺旋运动,开始割胶工作,同时割胶刀(505)下方的压力传感器(506)开始工作,实时测量进刀压力的信息,控制割胶耗皮量;
判断割胶刀(505)是否到达扫描的切割终点,当位于终点时,割胶刀(505)停止工作,步进电机(9)反转,割胶刀(505)进行退刀动作,各电机进行复位,完成一次割胶过程。
10.根据权利要求9所述的一种履带式自动割胶机器人控制系统的使用方法,其特征在于,舵机(504)采用伺服无刷电机,运动角度为0°~180°。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210293672.0A CN114516053A (zh) | 2022-03-24 | 2022-03-24 | 一种履带式自动割胶机器人控制系统及其使用方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210293672.0A CN114516053A (zh) | 2022-03-24 | 2022-03-24 | 一种履带式自动割胶机器人控制系统及其使用方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114516053A true CN114516053A (zh) | 2022-05-20 |
Family
ID=81600434
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210293672.0A Pending CN114516053A (zh) | 2022-03-24 | 2022-03-24 | 一种履带式自动割胶机器人控制系统及其使用方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114516053A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114654483A (zh) * | 2022-04-29 | 2022-06-24 | 哈尔滨理工大学 | 一种基于阿里云物联网的智慧割胶机器人系统实现方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108401838A (zh) * | 2018-03-16 | 2018-08-17 | 重庆大学 | 自动割胶机器人 |
CN110122256A (zh) * | 2019-05-21 | 2019-08-16 | 中国农业大学 | 一种割胶机器人系统及割胶方法 |
CN113303196A (zh) * | 2021-06-16 | 2021-08-27 | 海南大学 | 一种履带式割胶机器人 |
CN113758173A (zh) * | 2021-09-25 | 2021-12-07 | 江苏财经职业技术学院 | 粮食翻晒机 |
-
2022
- 2022-03-24 CN CN202210293672.0A patent/CN114516053A/zh active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108401838A (zh) * | 2018-03-16 | 2018-08-17 | 重庆大学 | 自动割胶机器人 |
CN110122256A (zh) * | 2019-05-21 | 2019-08-16 | 中国农业大学 | 一种割胶机器人系统及割胶方法 |
CN113303196A (zh) * | 2021-06-16 | 2021-08-27 | 海南大学 | 一种履带式割胶机器人 |
CN113758173A (zh) * | 2021-09-25 | 2021-12-07 | 江苏财经职业技术学院 | 粮食翻晒机 |
Non-Patent Citations (1)
Title |
---|
范大鹏著: "制造过程的智能传感器技术", 华中科技大学出版社, pages: 9 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114654483A (zh) * | 2022-04-29 | 2022-06-24 | 哈尔滨理工大学 | 一种基于阿里云物联网的智慧割胶机器人系统实现方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108382591B (zh) | 复杂环境中应用的地空巡检侦查机器人系统及操作方法 | |
CN102880175A (zh) | 自动行走设备 | |
CN205408633U (zh) | 一种可自主导航的履带式多机械臂苹果采摘机器人 | |
CN103324197A (zh) | 一种语音控制多用途智能服务机器人 | |
CN107567802A (zh) | 一种太阳能智能绘图割草机器人 | |
CN114516053A (zh) | 一种履带式自动割胶机器人控制系统及其使用方法 | |
US20200100425A1 (en) | Automatic lawn trimmer and automatic lawn trimming method | |
CN209737595U (zh) | 一种可无线充电的移动式机械臂小车 | |
CN104483969A (zh) | 自动巡逻机器人 | |
CN110865638A (zh) | 一种无人驾驶工程作业设备的遥控控制系统 | |
CN113156929B (zh) | 自移动设备 | |
CN114424703A (zh) | 一种新能源割草机器人 | |
CN210823833U (zh) | 智能环卫机器人 | |
CN114937258B (zh) | 割草机器人的控制方法、割草机器人以及计算机存储介质 | |
CN111601497B (zh) | 自动工作系统、自移动设备及其控制方法 | |
CN217533056U (zh) | 一种自主移动工业机器人用控制系统及其机器人 | |
CN112054437A (zh) | 一种二次电缆敷设装置 | |
CN216960804U (zh) | 一种新能源割草机器人 | |
CN112294192A (zh) | 一种机器人的控制方法与机器人 | |
CN112558597B (zh) | 自移动设备 | |
CN108490936A (zh) | 一种两轮驱动高速全天候无人驾驶巡逻车系统 | |
CN112882475A (zh) | 麦克纳姆轮式全方位移动机器人的运动控制方法及装置 | |
CN114868095A (zh) | 自移动设备 | |
CN215302577U (zh) | 多功能清障除草喷药履带机器人 | |
CN215749174U (zh) | 一种考古发掘刮面机器人 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20220520 |