CN108797669A - 一种自主3d挖掘施工机器人 - Google Patents

一种自主3d挖掘施工机器人 Download PDF

Info

Publication number
CN108797669A
CN108797669A CN201810639038.1A CN201810639038A CN108797669A CN 108797669 A CN108797669 A CN 108797669A CN 201810639038 A CN201810639038 A CN 201810639038A CN 108797669 A CN108797669 A CN 108797669A
Authority
CN
China
Prior art keywords
excavator
controller
autonomous
information
traveling
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.)
Granted
Application number
CN201810639038.1A
Other languages
English (en)
Other versions
CN108797669B (zh
Inventor
刘天云
王恩志
张建民
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Tsinghua University
Original Assignee
Tsinghua University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Tsinghua University filed Critical Tsinghua University
Priority to CN201810639038.1A priority Critical patent/CN108797669B/zh
Publication of CN108797669A publication Critical patent/CN108797669A/zh
Application granted granted Critical
Publication of CN108797669B publication Critical patent/CN108797669B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
    • E02F3/36Component parts
    • E02F3/42Drives for dippers, buckets, dipper-arms or bucket-arms
    • E02F3/43Control of dipper or bucket position; Control of sequence of drive operations
    • E02F3/435Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
    • E02F3/437Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like providing automatic sequences of movements, e.g. linear excavation, keeping dipper angle constant
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/2025Particular purposes of control systems not otherwise provided for
    • E02F9/205Remotely operated machines, e.g. unmanned vehicles
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/26Indicating devices
    • E02F9/267Diagnosing or detecting failure of vehicles

Abstract

一种自主3D挖掘施工机器人,利用机器视觉、卫星定位与自动控制装置、3D数字模型等,实现自动化、智能化3D挖掘施工作业,在指定的非结构化区域内,利用卫星定位系统测量位姿信息、利用机器视觉系统感知与认知作业环境信息,自主决策挖掘机器人行驶路线、行驶速度、铲斗作业位姿等。其中卫星定位系统采用卫星定位接收机组实时感知挖掘机器人的位置与姿态;机器视觉系统采用固定基线摄像机对感知挖掘机器人周围环境与AR增强现实能力;自动控制系统基于CAN总线由机载上位控制计算机与下位控制器组成,下位控制器包括发动机控制器、行驶控制器、铲斗作业控制器、故障诊断控制器等。本发明的自主3D挖掘施工机器人也可人工驾驶或遥控操作。

Description

一种自主3D挖掘施工机器人
技术领域
本发明属于建筑工程机械技术领域,特别涉及一种自主3D挖掘施工机器人。
背景技术
我国工程建设机械化已成为一个长期发展趋势,其中挖掘机在土木、水利、采矿、农林、油田及国防等各类建筑工程中担负繁重土石方作业任务,是施工中不可缺少的关键设备。近年来,随着微处理器的不断发展,低成本计算机、传感与通讯等技术的实用性的增加,使工程建设自动化技术,特别是挖掘机器人、推土机器人等变为可能。
工程机械自动化技术是一项先进的机械化技术,它可以使一些重要的循环工作变得程序化,从而提高生产率、降低生产成本。但工程建设不同于机械制造业有固定场所进行批量生产,而是在一个开放的户外场所,进行规模庞大但个性化非批量生产。因此,工程建设机械都是可移动或是可重新定位的系统,要求机动性作为完成工作过程中的必备功能,这不同于大多数工业机器人。
工程建设机器智能化是在工程机械机电液一体化的基础上,与计算机自动化相结合发展起来的。其目之一是以简化驾驶员操作,提高车辆的动力性、经济性、作业效率,以及节省能源为目的;目的之二是提高作业质量。
例如挖掘机上安装数字引导系统,工程人员可远程输入开挖设计边线等指标。在无需现场测量放样的情况下,控制单元实时计算出挖掘机铲斗与设计边线的偏差,并实时显示在驾驶室和集控室,引导操作手准确完成开挖工作,保证开挖尺寸符合设计要求。
建筑工程作业环境具有许多特性,特别是土石方工程。一是施工环境的时变性,工程开始设计3D数字模型,然后施工按照设计模型开展工作,这不同于农业耕作、航空飞行等领域作业环境固定,可以采用事先准备的电子地图规划导航线路,特别是制定的导航路线可以重复使用。二是作业环境填筑的随机性、不均匀性。工程建设的作业面环境随着工程建设进程不断变化,导致规划导航线路需要跟踪建设场地作业面地图,而所需场地工作面地图并不是事先确定的,需要根据施工进度确定。三是挖掘作业的往复性,需要挖土、提升、卸土及倒退几个工序。挖掘机作业需要根据工程建设进度与作业场地不断规划挖土位置与行驶线路,并且需要实时评估挖掘作业质量。
目前,国内外工程建设领域还没有相应的自主挖掘机器人相应技术。
发明内容
为了克服上述现有技术的缺点,本发明的目的在于提供一种自主3D挖掘施工机器人,可自主决策、无人驾驶、智能化挖掘作业,不但可提高作业质量,而且作业过程中不需要人为干预,可实现无人驾驶智能化自主作业。
为了实现上述目的,本发明采用的技术方案是:
一种自主3D挖掘施工机器人,包括挖掘机、挖掘机载自主测控装置、远程调度管理装置和卫星定位装置,其特征在于:
所述挖掘机载自主测控装置包括卫星定位接收机组6、通讯收发天线4、摄像机对5、动臂升降传感器7、斗杆位置传感器8、铲斗位姿传感器9、防撞雷达1、回转传感器2、集成控制器3、发动机调速驱动器和行驶电磁驱动器;
所述远程调度管理装置包括远端收发天线11、调度管理服务器10以及远程监控摄像机;
所述卫星定位装置包括定位导航卫星13、数传电台以及固定的定位基准站 12;
所述集成控制器3包括机载计算机3.1、CAN总线3.2、行驶回转控制器3.3、动臂控制器3.4、斗杆控制器3.5、铲斗控制器3.6、机器视觉计算机3.7、发动机控制器以及故障诊断控制器;
其中,所述机载计算机3.1、通讯收发天线4、远端收发天线11以及调度管理服务器10构成全双工模式的场地无线通讯局域网络,用于调度管理服务器10 与各个挖掘机之间命令与状态信息的传送;
所述机载计算机3.1和行驶回转控制器3.3、动臂控制器3.4、斗杆控制器 3.5、铲斗控制器3.6、机器视觉计算机3.7、发动机控制器以及故障诊断控制器构成机载CAN总线控制器网络,用于挖掘机自主行驶与作业;
所述卫星定位接收机组6、定位导航卫星13、定位基准站12以及调度管理服务器10构成卫星定位网络,用于获取挖掘机当前位姿;
所述卫星定位接收机组6接收定位导航卫星13的信号以及定位基准站12 传递的相位信号,通过RTK模式实现高精度定位;
所述机载计算机3.1结合工程建设进度和调度管理服务器10发送的作业场地的3D数字模型,适时生成施工作业面数字地图,并基于作业面数字地图自主规划作业区域;
所述摄像机对5安装于固定基线位置,与机器视觉计算机3.7构成机器视觉系统,立体视觉测量环境信息,确定作业场地状况,并与3D设计模型融合,形成AR增强现实能力,自主确定作业目标与行驶方向,制定导航路线;
所述机载计算机3.1根据作业区域、任务要求以及基于AR增强现实视觉测量确定的作业目标,自主规划作业区域内行驶路径、遍历模式。
所述多台自主3D挖掘施工机器人互联所述场地无线通讯局域网络、机载 CAN总线控制器网络以及卫星定位网络构成挖掘机器人机群,协同作业。
所述机载计算机3.1接收卫星定位接收机组6的位置信息,并利用该位置信息计算挖掘机姿态信息;依据导航路线和位姿信息,生成行驶回转控制器3.3、动臂控制器3.4、斗杆控制器3.5与铲斗控制器3.6的控制命令,并根据反馈信息实现闭环控制。
具体可采用三角形测量法计算挖掘机器人姿态信息,具体过程是:在至少三个不共线测点位置安装卫星定位接收装置,实时测出测点位置与高程;然后分别计算两两测点之间的相对位置与高差,即可确定出自主3D挖掘施工机器人的位姿。
所述机载计算机3.1根据定位信息与机器视觉测量的环境信息,以及3D设计模型生成AR增强现实能力,自主评估挖掘作业质量,自主决策重新挖掘作业范围,以及所需工作量。
所述发动机控制器通过CAN总线3.2接收机载计算机3.1发送的控制命令,通过控制发动机调速驱动器来控制发动机转速,实现发动机恒速;运行过程中,实时比较行驶速度与目标值之间偏差,经PID调整控制行驶液压马达,实现预期行驶路径;
所述行驶回转控制器3.3通过CAN总线3.2接收机载计算机3.1发送的控制命令,通过行驶电磁驱动器驱动电液阀,再控制行驶液压马达控制挖掘机器人行驶,实现行驶转向自动化;运行过程中,实时比较行驶位置与目标位置之间偏差,经PID调整控制转向;实时检查、判断作业环境信息,自动控制刹车元件实现停车、作业以及紧急事件处理;
所述动臂控制器3.4、斗杆控制器3.5、铲斗控制器3.6通过CAN总线3.2 接收机载计算机3.1发来的控制命令,通过采集动臂升降传感器7、斗杆位置传感器8和铲斗位姿传感器9的当前信息,结合作业场地的3D数字模型,利用 PID方法控制铲刀的电磁液压阀,驱动液压作动器,控制铲刀的作业位姿,实现铲刀自动找平,实现推土作业的自动化;基于作业场地3D数字设计模型,铲斗控制器3.6能够实现铲斗自动找平,实现挖掘作业的自动化。
所述故障诊断控制器接收挖掘机器人状态传感器信息,判断挖掘机器人的健康状况,发出相应控制命令。
本发明设定遥控驾驶、自动驾驶和人工驾驶三种作业模式,如遥控驾驶则屏蔽自动驾驶功能;如人工驾驶介入,则屏蔽自动驾驶与遥控驾驶功能;即自动导航驾驶优先级低于遥控驾驶,遥控驾驶优先级低于人工驾驶。机载计算机 3.1接受防撞雷达1的信号,制定倒车运行方案。
基于所述装备与网络系统,自主挖掘机器人可以实现以下功能:
1、自主挖掘机器人通过无线通讯网络接收作业任务与命令,并向远程调度管理服务器传送机器人运行状态信息。
所述的作业任务与命令包括作业区域参数、区域3D数字设计模型、工艺参数,以及挖掘机器人上电、点火、启动、熄火、休眠与唤醒等。
所述机器人运行状态信息包括发动机状态、机载传感器状态、控制器状态、作业轨迹、作业质量等。
所述区域3D数字设计模型,以按工程建设进度适时进行人机交互操作生成施工作业面数字地图,构成AR增强现实功能,并基于作业面数字地图规划设计挖掘机导航线路。
2、自主挖掘机器人利用机载摄像机对探测作业场地环境,认知并形成需要挖掘作业方位与作业量。
所述的机载摄像机对构成双目机器视觉,立体测量挖掘机器人作业场地环境,形成作业场地地表数据模型;与区域3D数字设计模型对比,确定挖掘机作业范围,估算挖土作业量。
3、自主规划挖掘机器人行驶路线,保证挖掘机器人可在复杂的作业环境实现更精细化的操作。
所述的规划行驶路线是一种计算机算法,规定挖掘机器人遍历作业范围的方式。
4、利用自主挖掘机器人位姿,自主控制行驶轨迹。
基于卫星定位系统网络,所述的挖掘机器人能够在线确定位姿,以规划的行驶路线为目标,自主控制挖掘机器人的行驶轨迹,实现自主导航功能。
所述的卫星定位系统包括RTK-GPS基准站与流动站,用于获取挖掘机当前位置坐标值。具体地,基准站接受GPS卫星信号并实时确定发射载波相位差,流动站根据自己接受的GPS信号以及基准站传送的载波相位差信号高精度确定挖掘机器人的位置。实时比较行驶速度与目标速度值之间偏差,经PID调整控制挖掘机器人油门;实时检查、判断作业环境信息,自动控制电子刹车元件实现停车、作业以及紧急事件处理。
5、基于场地作业量信息,AR增强现实能力,自主控制挖掘机器人工作铲斗位姿。
所述的挖掘机器人针对前进方向上的工作量,考虑行驶速度,自主决策工作铲斗的高低位置、倾斜状态,使机器人发动机处于平稳的工作状态。
所述机载自动作业控制装置实时比较铲斗位置与目标位置之间偏差,经PID 调整控制铲斗位姿,实现预期目标。
6、挖掘作业质量评估。
所述的挖掘机器人能够利用其位姿信息与机器视觉测量的挖掘高程信息,生成AR增强现实,与挖掘工艺参数、标准对比,在线评估作业质量等级,自主决策挖土作业范围与遍历次数。
利用机载自动导航控制装置实时采集挖掘机的各种状态信息并反馈至远程监控装置,远程监控装置根据这些信息向机载自动导航控制装置发出相应的控制指令,实现遥控驾驶;
如若调整的转向轮转角度数、速度超过设定的极限值,则机载自动导航控制装置发出转向错误信息;如发现障碍物距离变化速度大于规定值,则向远程监控装置发出紧急处理请求。
如遥控驾驶则屏蔽自动驾驶功能;如人工驾驶介入,则屏蔽自动驾驶与遥控驾驶功能;即自动导航驾驶优先级低于遥控驾驶,遥控驾驶优先级低于人工驾驶。
与现有技术相比,本发明的有益效果是:
1、自主挖掘机器人可以随意切换自动驾驶、遥控驾驶和人工驾驶三种操作模式。
2、自主挖掘机器人采用了输出信息双重反馈方式,且具有设备间无线通讯、自动启动、调整档位、加速与刹车功能。
3、采用建设工程3D数字模型规划作业区域、机器视觉立体测量、增强现实AR,结合RTK-GPS定位信号实现了精确自主导航、避免了作业面遗漏、交叉重复作业的问题,提高了挖掘作业施工质量。
4、自主挖掘机器人不受距离、光线限制,能够实现24小时昼夜远程连续作业,有效提高了机器使用率。
5、自主挖掘机器人技术除适应普通挖掘机的应用范围,还特别适合于恶劣、危险环境下施工作业。
6、自主挖掘机器人技术与普通挖掘机系统兼容,加装测控器件方便,不影响原挖掘机结构、外观和性能。
因此,本发明的自主挖掘机器人既保证了挖掘机在特殊、紧急作业情况下方便、安全施工,又解决了作业面机群交叉重复的问题。自主挖掘机器人技术与人工驾驶方式兼容,且自动驾驶、远程遥控与人工驾驶可随时随意切换,可以应用于水利、公路、铁路、机场、港口等土石方工程,尤其适合危险环境、极限条件等特殊作业环境。
附图说明
图1为本发明的一个实施例的结构图。
图2为本发明的自主挖掘机器人机载控制系统框图。
图3为本发明自主3D挖掘施工流程图。
具体实施方式
下面结合实施例和附图,对本发明的技术和方法做进一步详细描述。以下实施例和附图用于说明本发明技术构成,但不是用来限定本发明的范围。
图1所示为本发明适用于自主3D挖掘机器人的一个实施例的结构图,其主要包括挖掘机与机载测控设备、远程监控装置以及卫星定位装置。
机载测控装置主要包括:防撞雷达1、回转传感器2、集成控制器3、通讯收发天线4、摄像机对5、卫星定位接收机组6、动臂升降传感器7、斗杆位置传感器8、铲斗位姿传感器9、发动机调速驱动器和行驶电磁驱动器。
远程监控装置主要包括远端收发天线11、调度管理服务器10以及远程监控摄像机。
卫星定位装置主要包括定位导航卫星13、数传电台以及固定的定位基准站 12。
图2为挖掘机器人集成控制器3的控制网络,基于CAN总线通信,集成控制器3包括机载计算机3.1、CAN总线3.2、行驶回转控制器3.3、动臂控制器 3.4、斗杆控制器3.5、铲斗控制器3.6、机器视觉计算机3.7、发动机控制器以及故障诊断控制器等。
图1中,定位导航卫星13、定位基准站12、卫星定位接收机组6以及机载计算机3.1为主要部分,形成实时定位导航网络服务系统。挖掘机器人工作场地以及基站位置需要接受至少4颗卫星信号才能实现卫星定位功能。卫星定位接收机组6同时接收定位导航卫星13信号外,还需要接收定位基准站12传递的相位信号,通过RTK模式实现高精度定位。机载计算机3.1接收卫星定位接收机组的位置信息,并利用位置信息计算挖掘机器人姿态信息。
图1中,机载计算机3.1、机载的通讯收发天线4、远端收发天线11,以及调度管理服务器10为主要部分,构成挖掘机器人作业场地通讯局域网,为全双工模式。机载计算机3.1通过通讯收发天线4接收远端的调度管理服务器10通过收发天线11发送的作业任务与命令;同时计算机3.1将挖掘机器人的运行信息通过通讯收发天线4与远端收发天线11传送至调度管理服务器10。另外,调度管理服务器10还对发送与接收的信息进行显示与存储,分析与预警。
机载计算机3.1除接受上述信息外,还接受防撞雷达1的信号,制定倒车运行方案;控制发动机启动、熄火、加减转速、唤醒、休眠等命令,通过控制发动机转速。
行驶回转控制器3.3通过CAN总线3.2接收机载控制器3.1发来的前进、后退方式,以及相应速度等命令,控制行驶液压马达控制挖掘机器人行驶。当左右驱动器同向时,前进或后退;左右驱动器信号不同时,挖掘机器人以不同转弯半径转向,以致原地转向。
动臂控制器3.4通过CAN总线3.2接收机载控制器3.1发来的升降等命令;通过采集升降传感器7与当前信息,利用PID方法控制动臂的电磁液压阀,驱动液压作动器,控制铲斗的作业位姿。
斗杆控制器3.5接收挖掘机器人斗杆状态传感器信息,判断挖掘机器人的状况,发出相应位姿控制命令。
铲斗控制器3.6控制铲斗位姿,与动臂控制器和斗杆控制器一同调整铲斗位姿。
机器视觉计算机3.7与摄像机对5构成视觉立体测量传感器,感知与认知挖掘机器人环境信息,测量确定作业场地状况。利用3D数字设计模型,增强现实 AR技术,确定作业范围与导航前进方向,评估作业工作量,评估挖掘机器人作业质量,在线指定遍历作业范围的导航路线。
机载计算机3.1作为上位机,具有自主决策、智能化作业的功能。后退遇到障碍物时,利用雷达1的信号判断障碍物位置,决定行驶速度;依据视觉计算机3.7制定的导航路线,以及卫星信号接收机组6的位姿信息,自主生成作业铲斗的控制命令,并根据反馈信息实现闭环控制。
在图3中,显示了挖掘机器人作业流程图。服务器10根据工程进度与计划制定任务目标,并下发机载计算机3.1。机载计算机10将任务目标依据卫星定位GPS与双目视觉结合,形成作业环境模型;对作业进行规划分析,形成一些列自动化流水线目标控制。自主挖掘机器人有效地避免了目前施工作业过程中发生的遗漏、交叉、重复现象,显著地提高了机械作业效率和质量。由单台挖掘机器人可以构成自主挖掘机器人集群,进行协同作业。
另外,人机交互遥控过程为:首先,处理需要紧急处理的请求;根据请求情况,将自动导航模式改为人机遥控模式,分别判断并发送操纵转向命令、操纵发动机调速命令、操纵刹车制动命令,以及相应命令的参数值;其次,根据接收作业面视频、行驶速度等情况,预见性的人机交互调整挖掘机的行驶速度、油门限度、刹车距离等控制参数,仍然应用自动导航过程;第三,对于特殊部位以及多台挖掘机器人协同作业时,可以自动停止自动导航过程,切换到人工遥控转向、油门和制动刹车,完成特殊作业任务。
远程监控程序可以自动导航与人机交互遥控交替驾驶模式,在人机交互遥控转为自动导航时,需要自动修改导航目标,以免发生短时跳跃现象。
挖掘机器人作业时,人工驾驶优先级最高,远程遥控优先级次之,自动导航优先级最低。
本发明将挖掘机器人作业远程监控、自动导航控制以及人工驾驶结合为一个完整的系统,实现了挖掘机器人按照工程建设进度、工程3D数字模型精确作业,在特殊情况时人机交互远程遥控或人工驾驶干预的情况下屏蔽自动导航功能,保证挖掘机器人能安全作业。
特别是挖掘机器人通过自动驾驶与远程人机交互监控作用,可以不需驾驶员操作,减轻或解放了驾驶人员的劳动强度和技能要求。挖掘机器人技术依靠卫星定位与机器视觉测量,可以为全天候工作提供条件,也为有效延长挖掘机器人作业组的作业时间。
以上实施方式仅用于说明本发明,并非对本发明的限制。所有等同的技术方案也属于本发明的范畴,本发明的专利保护范围应有权利要求限定。

Claims (8)

1.一种自主3D挖掘施工机器人,包括挖掘机、挖掘机载自主测控装置、远程调度管理装置和卫星定位装置,其特征在于:
所述挖掘机载自主测控装置包括卫星定位接收机组(6)、通讯收发天线(4)、摄像机对(5)、动臂升降传感器(7)、斗杆位置传感器(8)、铲斗位姿传感器(9)、防撞雷达(1)、回转传感器(2)、集成控制器(3)、发动机调速驱动器和行驶电磁驱动器;
所述远程调度管理装置包括远端收发天线(11)、调度管理服务器(10)以及远程监控摄像机;
所述卫星定位装置包括定位导航卫星(13)、数传电台以及固定的定位基准站(12);
所述集成控制器(3)包括机载计算机(3.1)、CAN总线(3.2)、行驶回转控制器(3.3)、动臂控制器(3.4)、斗杆控制器(3.5)、铲斗控制器(3.6)、机器视觉计算机(3.7)、发动机控制器以及故障诊断控制器;
其中,所述机载计算机(3.1)、通讯收发天线(4)、远端收发天线(11)以及调度管理服务器(10)构成全双工模式的场地无线通讯局域网络,用于调度管理服务器(10)与各个挖掘机之间命令与状态信息的传送;
所述机载计算机(3.1)和行驶回转控制器(3.3)、动臂控制器(3.4)、斗杆控制器(3.5)、铲斗控制器(3.6)、机器视觉计算机(3.7)、发动机控制器以及故障诊断控制器构成机载CAN总线控制器网络,用于挖掘机自主行驶与作业;
所述卫星定位接收机组(6)、定位导航卫星(13)、定位基准站(12)以及调度管理服务器(10)构成卫星定位网络,用于获取挖掘机当前位姿;
所述卫星定位接收机组(6)接收定位导航卫星(13)的信号以及定位基准站(12)传递的相位信号,通过RTK模式实现高精度定位;
所述机载计算机(3.1)结合工程建设进度和调度管理服务器(10)发送的作业场地的3D数字模型,适时生成施工作业面数字地图,并基于作业面数字地图自主规划作业区域;
所述摄像机对(5)安装于固定基线位置,与机器视觉计算机(3.7)构成机器视觉系统,立体视觉测量环境信息,确定作业场地状况,并与其它传感器信息融合,基于机器学习方法,认知信息规律,自主确定作业目标与行驶方向,制定导航路线;
所述机载计算机(3.1)根据作业区域、任务要求以及基于机器视觉测量确定的作业目标,自主规划作业区域内行驶路径、遍历模式。
2.根据权利要求1所述自主3D挖掘施工机器人,其特征在于,所述多台自主3D挖掘施工机器人互联所述场地无线通讯局域网络、机载CAN总线控制器网络以及卫星定位网络构成挖掘机器人机群,协同作业。
3.根据权利要求1所述自主3D挖掘施工机器人,其特征在于,所述机载计算机(3.1)接收卫星定位接收机组(6)的位置信息,并利用该位置信息计算挖掘机姿态信息;依据导航路线和位姿信息,生成行驶回转控制器(3.3)、动臂控制器(3.4)、斗杆控制器(3.5)与铲斗控制器(3.6)的控制命令,并根据反馈信息实现闭环控制。
4.根据权利要求3所述自主3D挖掘施工机器人,其特征在于,采用三角形测量法计算挖掘机器人姿态信息,具体过程是:在至少三个不共线测点位置安装卫星定位接收装置,实时测出测点位置与高程;然后分别计算两两测点之间的相对位置与高差,即可确定出自主3D挖掘施工机器人的位姿。
5.根据权利要求1所述自主3D挖掘施工机器人,其特征在于,所述机载计算机(3.1)根据定位信息与机器视觉测量的环境信息,以及作业3D模型要求,具有AR增强现实能力,即自主评估挖掘作业质量,自主决策重新挖掘作业范围,以及所需工作量。
6.根据权利要求1所述自主3D挖掘施工机器人,其特征在于,
所述发动机控制器通过CAN总线(3.2)接收机载计算机(3.1)发送的控制命令,通过控制发动机调速驱动器来控制发动机转速,实现发动机恒速;运行过程中,实时比较行驶速度与目标值之间偏差,经PID调整控制行驶液压马达,实现预期行驶路径;
所述行驶回转控制器(3.3)通过CAN总线(3.2)接收机载计算机(3.1)发送的控制命令,通过行驶电磁驱动器驱动电液阀,再控制行驶液压马达控制挖掘机器人行驶,实现行驶转向自动化;运行过程中,实时比较行驶位置与目标位置之间偏差,经PID调整控制转向;
所述动臂控制器(3.4)、斗杆控制器(3.5)、铲斗控制器(3.6)通过CAN总线(3.2)接收机载计算机(3.1)发来的控制命令,通过采集动臂升降传感器(7)、斗杆位置传感器(8)和铲斗位姿传感器(9)的当前信息,结合作业场地的3D数字模型,利用PID方法控制铲刀的电磁液压阀,驱动液压作动器,控制铲刀的作业位姿,实现铲刀自动找平,实现推土作业的自动化;
所述故障诊断控制器接收挖掘机器人状态传感器信息,判断挖掘机器人的健康状况,发出相应控制命令。
7.根据权利要求1所述自主3D挖掘施工机器人,其特征在于,设定遥控驾驶、自动驾驶和人工驾驶三种作业模式,如遥控驾驶则屏蔽自动驾驶功能;如人工驾驶介入,则屏蔽自动驾驶与遥控驾驶功能;即自动导航驾驶优先级低于遥控驾驶,遥控驾驶优先级低于人工驾驶。
8.根据权利要求1所述自主3D挖掘施工机器人,其特征在于,机载计算机(3.1)接受防撞雷达(1)的信号,制定倒车运行方案。
CN201810639038.1A 2018-06-20 2018-06-20 一种自主3d挖掘施工机器人 Active CN108797669B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810639038.1A CN108797669B (zh) 2018-06-20 2018-06-20 一种自主3d挖掘施工机器人

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810639038.1A CN108797669B (zh) 2018-06-20 2018-06-20 一种自主3d挖掘施工机器人

Publications (2)

Publication Number Publication Date
CN108797669A true CN108797669A (zh) 2018-11-13
CN108797669B CN108797669B (zh) 2020-12-22

Family

ID=64083874

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810639038.1A Active CN108797669B (zh) 2018-06-20 2018-06-20 一种自主3d挖掘施工机器人

Country Status (1)

Country Link
CN (1) CN108797669B (zh)

Cited By (33)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110453749A (zh) * 2019-07-17 2019-11-15 爱克斯维智能科技(苏州)有限公司 一种液压挖掘机智能挖掘系统及控制方法
CN110485502A (zh) * 2019-07-17 2019-11-22 爱克斯维智能科技(苏州)有限公司 一种挖掘机智能行走系统、挖掘机及控制方法
CN110636126A (zh) * 2019-09-20 2019-12-31 徐州立方机电设备制造有限公司 一种基于5g网络的旋挖钻机远程控制系统
CN110747933A (zh) * 2019-10-25 2020-02-04 广西柳工机械股份有限公司 挖掘机自主移动作业控制方法和系统
CN111021204A (zh) * 2020-01-02 2020-04-17 清华大学 一种道路自动摊铺机器人
CN111021442A (zh) * 2019-12-27 2020-04-17 哈尔滨第一机械集团有限公司 多功能无人清障车
CN111082197A (zh) * 2020-01-04 2020-04-28 单炜 一种航空机载刀型天线
CN111305293A (zh) * 2020-02-25 2020-06-19 深圳冰河导航科技有限公司 一种自动化平地机控制系统及其平地方法
CN111552249A (zh) * 2020-05-12 2020-08-18 三一重机有限公司 一种操作控制系统、操作控制方法及工程机械
CN111576541A (zh) * 2020-06-10 2020-08-25 徐工集团工程机械有限公司 基于5g网络的工程机械自主控制系统及方法
CN111660958A (zh) * 2019-03-06 2020-09-15 卡哥特科专利许可有限公司 车辆配件装置及其方法
CN111708067A (zh) * 2020-08-04 2020-09-25 中国铁道科学研究院集团有限公司铁道建筑研究所 挖掘机自动引导系统
CN111733920A (zh) * 2020-06-30 2020-10-02 北京建工环境修复股份有限公司 一种智能上料控制系统及其控制方法
CN111866464A (zh) * 2020-07-28 2020-10-30 盐城工业职业技术学院 一种基于虚拟现实技术的农用拖拉机远程控制系统
CN112209585A (zh) * 2020-10-27 2021-01-12 河北农业大学 一种可遥控式粪污处理车
CN112411663A (zh) * 2020-11-06 2021-02-26 徐州徐工挖掘机械有限公司 挖掘机的控制方法和控制装置、挖掘机
CN112434912A (zh) * 2020-11-02 2021-03-02 中建三局第二建设工程有限责任公司 一种基于机械自动化的沙漠地带场平固沙方法
CN112572470A (zh) * 2020-12-07 2021-03-30 清华大学 施工机械设备自动驾驶方法及装置
CN113677870A (zh) * 2019-04-03 2021-11-19 蒂森克虏伯工业解决方案股份公司 用于使材料开采设施能够在材料开采地点的工作面处自动地运行的方法和装置
CN113688847A (zh) * 2021-08-25 2021-11-23 徐州徐工矿业机械有限公司 一种挖掘机运行模式切换的控制方法、装置和挖掘机
CN113718867A (zh) * 2021-09-18 2021-11-30 四川鼎鸿智电装备科技有限公司 一种无人挖掘机
WO2022022590A1 (zh) * 2020-07-29 2022-02-03 四川鼎鸿智电装备科技有限公司 工程机械
WO2022022583A1 (zh) * 2020-07-29 2022-02-03 四川鼎鸿智电装备科技有限公司 工程机械
CN114164875A (zh) * 2021-12-06 2022-03-11 山东高速建设管理集团有限公司 一种无人链式开挖装置、无人作业系统及无人作业方法
CN114555894A (zh) * 2019-05-06 2022-05-27 洛基德机器人有限公司 用于施工现场的自主导航的移动平台
CN114592559A (zh) * 2020-12-04 2022-06-07 长安大学 一种特殊环境下的液压挖掘机远程自动控制系统
EP3951077A4 (en) * 2019-03-28 2022-06-08 Sumitomo Construction Machinery Co., Ltd. EXCAVATOR AND CONSTRUCTION SYSTEM
CN114809171A (zh) * 2022-03-11 2022-07-29 上海华兴数字科技有限公司 挖掘机控制方法、装置及挖掘机
CN115398066A (zh) * 2020-04-14 2022-11-25 株式会社小松制作所 施工方法及施工系统
CN115514885A (zh) * 2022-08-26 2022-12-23 燕山大学 基于单双目融合的远程增强现实随动感知系统及方法
US11753795B2 (en) * 2018-11-26 2023-09-12 Baidu Online Network Technology (Bejing) Co., Ltd. Device for detecting rotary angle and excavator
US11920321B2 (en) 2020-03-30 2024-03-05 Cnh Industrial America Llc System and method for automatically performing an earthmoving operation
WO2024060456A1 (zh) * 2022-09-21 2024-03-28 三一重机有限公司 作业机械无人化控制系统及作业机械

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20040158355A1 (en) * 2003-01-02 2004-08-12 Holmqvist Hans Robert Intelligent methods, functions and apparatus for load handling and transportation mobile robots
CN203613580U (zh) * 2013-11-16 2014-05-28 山推工程机械股份有限公司 一种基于gps-rtk技术的推土机自动找平装置
CN104476548A (zh) * 2014-10-24 2015-04-01 四川省绵阳西南自动化研究所 一种挖掘机器人自主作业控制系统及方法
CN105137997A (zh) * 2015-09-22 2015-12-09 清华大学 水利施工振动碾压机自动驾驶系统与方法
CN107740448A (zh) * 2017-11-30 2018-02-27 南京工业大学 一种无人自动化挖掘机智能施工系统

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20040158355A1 (en) * 2003-01-02 2004-08-12 Holmqvist Hans Robert Intelligent methods, functions and apparatus for load handling and transportation mobile robots
CN203613580U (zh) * 2013-11-16 2014-05-28 山推工程机械股份有限公司 一种基于gps-rtk技术的推土机自动找平装置
CN104476548A (zh) * 2014-10-24 2015-04-01 四川省绵阳西南自动化研究所 一种挖掘机器人自主作业控制系统及方法
CN105137997A (zh) * 2015-09-22 2015-12-09 清华大学 水利施工振动碾压机自动驾驶系统与方法
CN107740448A (zh) * 2017-11-30 2018-02-27 南京工业大学 一种无人自动化挖掘机智能施工系统

Cited By (43)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US11753795B2 (en) * 2018-11-26 2023-09-12 Baidu Online Network Technology (Bejing) Co., Ltd. Device for detecting rotary angle and excavator
CN111660958A (zh) * 2019-03-06 2020-09-15 卡哥特科专利许可有限公司 车辆配件装置及其方法
EP3951077A4 (en) * 2019-03-28 2022-06-08 Sumitomo Construction Machinery Co., Ltd. EXCAVATOR AND CONSTRUCTION SYSTEM
CN113677870A (zh) * 2019-04-03 2021-11-19 蒂森克虏伯工业解决方案股份公司 用于使材料开采设施能够在材料开采地点的工作面处自动地运行的方法和装置
CN114555894A (zh) * 2019-05-06 2022-05-27 洛基德机器人有限公司 用于施工现场的自主导航的移动平台
CN114555894B (zh) * 2019-05-06 2024-04-09 洛基德机器人有限公司 用于施工现场的自主导航的移动平台
US11953909B2 (en) 2019-05-06 2024-04-09 Rugged Robotics Inc. Mobility platform for autonomous navigation of construction sites
CN110453749A (zh) * 2019-07-17 2019-11-15 爱克斯维智能科技(苏州)有限公司 一种液压挖掘机智能挖掘系统及控制方法
CN110485502A (zh) * 2019-07-17 2019-11-22 爱克斯维智能科技(苏州)有限公司 一种挖掘机智能行走系统、挖掘机及控制方法
CN110636126A (zh) * 2019-09-20 2019-12-31 徐州立方机电设备制造有限公司 一种基于5g网络的旋挖钻机远程控制系统
CN110747933A (zh) * 2019-10-25 2020-02-04 广西柳工机械股份有限公司 挖掘机自主移动作业控制方法和系统
CN111021442A (zh) * 2019-12-27 2020-04-17 哈尔滨第一机械集团有限公司 多功能无人清障车
CN111021204A (zh) * 2020-01-02 2020-04-17 清华大学 一种道路自动摊铺机器人
CN111082197A (zh) * 2020-01-04 2020-04-28 单炜 一种航空机载刀型天线
CN111305293A (zh) * 2020-02-25 2020-06-19 深圳冰河导航科技有限公司 一种自动化平地机控制系统及其平地方法
US11920321B2 (en) 2020-03-30 2024-03-05 Cnh Industrial America Llc System and method for automatically performing an earthmoving operation
CN115398066A (zh) * 2020-04-14 2022-11-25 株式会社小松制作所 施工方法及施工系统
CN111552249A (zh) * 2020-05-12 2020-08-18 三一重机有限公司 一种操作控制系统、操作控制方法及工程机械
CN111576541A (zh) * 2020-06-10 2020-08-25 徐工集团工程机械有限公司 基于5g网络的工程机械自主控制系统及方法
CN111733920B (zh) * 2020-06-30 2021-03-09 北京建工环境修复股份有限公司 一种智能上料控制系统及其控制方法
CN111733920A (zh) * 2020-06-30 2020-10-02 北京建工环境修复股份有限公司 一种智能上料控制系统及其控制方法
CN111866464B (zh) * 2020-07-28 2021-08-24 盐城工业职业技术学院 一种基于虚拟现实技术的农用拖拉机远程控制系统
CN111866464A (zh) * 2020-07-28 2020-10-30 盐城工业职业技术学院 一种基于虚拟现实技术的农用拖拉机远程控制系统
WO2022022583A1 (zh) * 2020-07-29 2022-02-03 四川鼎鸿智电装备科技有限公司 工程机械
WO2022022590A1 (zh) * 2020-07-29 2022-02-03 四川鼎鸿智电装备科技有限公司 工程机械
CN114035561A (zh) * 2020-07-29 2022-02-11 四川鼎鸿智电装备科技有限公司 工程机械
CN111708067B (zh) * 2020-08-04 2022-04-12 中国铁道科学研究院集团有限公司铁道建筑研究所 挖掘机自动引导系统
CN111708067A (zh) * 2020-08-04 2020-09-25 中国铁道科学研究院集团有限公司铁道建筑研究所 挖掘机自动引导系统
CN112209585A (zh) * 2020-10-27 2021-01-12 河北农业大学 一种可遥控式粪污处理车
CN112434912A (zh) * 2020-11-02 2021-03-02 中建三局第二建设工程有限责任公司 一种基于机械自动化的沙漠地带场平固沙方法
CN112411663A (zh) * 2020-11-06 2021-02-26 徐州徐工挖掘机械有限公司 挖掘机的控制方法和控制装置、挖掘机
CN112411663B (zh) * 2020-11-06 2022-06-03 徐州徐工挖掘机械有限公司 挖掘机的控制方法和控制装置、挖掘机
CN114592559A (zh) * 2020-12-04 2022-06-07 长安大学 一种特殊环境下的液压挖掘机远程自动控制系统
CN112572470B (zh) * 2020-12-07 2022-01-28 清华大学 施工机械设备自动驾驶方法及装置
CN112572470A (zh) * 2020-12-07 2021-03-30 清华大学 施工机械设备自动驾驶方法及装置
CN113688847A (zh) * 2021-08-25 2021-11-23 徐州徐工矿业机械有限公司 一种挖掘机运行模式切换的控制方法、装置和挖掘机
CN113718867A (zh) * 2021-09-18 2021-11-30 四川鼎鸿智电装备科技有限公司 一种无人挖掘机
CN114164875A (zh) * 2021-12-06 2022-03-11 山东高速建设管理集团有限公司 一种无人链式开挖装置、无人作业系统及无人作业方法
CN114809171A (zh) * 2022-03-11 2022-07-29 上海华兴数字科技有限公司 挖掘机控制方法、装置及挖掘机
WO2023169109A1 (zh) * 2022-03-11 2023-09-14 上海华兴数字科技有限公司 挖掘机控制方法、装置及挖掘机
CN115514885A (zh) * 2022-08-26 2022-12-23 燕山大学 基于单双目融合的远程增强现实随动感知系统及方法
CN115514885B (zh) * 2022-08-26 2024-03-01 燕山大学 基于单双目融合的远程增强现实随动感知系统及方法
WO2024060456A1 (zh) * 2022-09-21 2024-03-28 三一重机有限公司 作业机械无人化控制系统及作业机械

Also Published As

Publication number Publication date
CN108797669B (zh) 2020-12-22

Similar Documents

Publication Publication Date Title
CN108797669A (zh) 一种自主3d挖掘施工机器人
CN108222093A (zh) 一种自主推土机器人
AU2008229615B2 (en) Method for planning and executing obstacle-free paths for rotating excavation machinery
CN105137997B (zh) 水利施工振动碾压机自动驾驶系统与方法
AU2016200300B2 (en) Control system having tool tracking
US9828781B2 (en) Fine implement control system using relative positioning
AU2017276225B2 (en) Systems and methods for preparing a worksite for additive construction
CN110453749A (zh) 一种液压挖掘机智能挖掘系统及控制方法
CN213338437U (zh) 一种无人挖掘机及其远程管理监控系统
JP2022159504A (ja) 付加的建設動作のための機械配置を最適化するための制御システムおよび方法
CN109508006A (zh) 一种基于北斗的汽车起重机的自动驾驶系统
CN113002540B (zh) 矿用自卸车控制方法及装置
CN113323068B (zh) 用于工程机械的控制方法、处理器及工程机械
Qi et al. 3D guidance navigation and human-robot shared control for motor graders in field operation
EP4187026A1 (en) Automated work system
CN220352913U (zh) 一种矿用智能装载挖掘机器人
CN116625356A (zh) 悬臂式掘进机位姿感知与智能截割遥控系统
JP2023122748A (ja) 作業位置指示システム
CN117629216A (zh) 一种挖掘机自主作业规划系统及方法
CN113721619A (zh) 一种基于rtk技术的推土机路径规划系统及作业方法
CN106677239A (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
GR01 Patent grant
GR01 Patent grant