CN115335727A - 作业机械的定位系统、作业机械及作业机械的定位方法 - Google Patents
作业机械的定位系统、作业机械及作业机械的定位方法 Download PDFInfo
- Publication number
- CN115335727A CN115335727A CN202180024621.1A CN202180024621A CN115335727A CN 115335727 A CN115335727 A CN 115335727A CN 202180024621 A CN202180024621 A CN 202180024621A CN 115335727 A CN115335727 A CN 115335727A
- Authority
- CN
- China
- Prior art keywords
- positioning system
- antenna
- positioning
- gnss
- work
- 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
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/01—Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/13—Receivers
- G01S19/24—Acquisition or tracking or demodulation of signals transmitted by the system
- G01S19/26—Acquisition or tracking or demodulation of signals transmitted by the system involving a sensor measurement for aiding acquisition or tracking
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/26—Indicating devices
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/26—Indicating devices
- E02F9/264—Sensors and their calibration for indicating the position of the work tool
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/01—Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/13—Receivers
- G01S19/35—Constructional details or hardware or software details of the signal processing chain
- G01S19/36—Constructional details or hardware or software details of the signal processing chain relating to the receiver frond end
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/43—Determining position using carrier phase measurements, e.g. kinematic positioning; using long or short baseline interferometry
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/53—Determining attitude
- G01S19/54—Determining attitude using carrier phase measurements; using long or short baseline interferometry
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/28—Dredgers; 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/30—Dredgers; 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 with a dipper-arm pivoted on a cantilever beam, i.e. boom
- E02F3/32—Dredgers; 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 with a dipper-arm pivoted on a cantilever beam, i.e. boom working downwardly and towards the machine, e.g. with backhoes
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/28—Dredgers; 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/36—Component parts
- E02F3/42—Drives for dippers, buckets, dipper-arms or bucket-arms
- E02F3/43—Control of dipper or bucket position; Control of sequence of drive operations
- E02F3/435—Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Physics & Mathematics (AREA)
- Structural Engineering (AREA)
- General Engineering & Computer Science (AREA)
- Civil Engineering (AREA)
- Mining & Mineral Resources (AREA)
- Signal Processing (AREA)
- Operation Control Of Excavators (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Component Parts Of Construction Machinery (AREA)
Abstract
一种使用了使用卫星的定位系统的RTK定位的作业机械1的定位系统200,其具备:作为计算部的传感器控制器40,其基于与作业现场中已定位的已知的基准点PR位置重合的作业机械1的作业机4的位置,对配置于作业机械1的卫星定位系统的天线的位置进行计算;以及作为初始化控制部的显示器控制器51,其向通过RTK定位来进行定位计算的卫星定位系统的接收机输出控制指令,该控制指令用于使所述接收机使用计算出的卫星定位系统的天线的位置,来执行将各卫星的整数偏差与卫星定位系统的天线的位置作为未知数的、定位计算的初始化处理。
Description
技术领域
本发明涉及作业机械的定位系统、作业机械及作业机械的定位方法。
背景技术
近年来,在液压挖掘机等作业机械中,对ICT(信息与通信技术:Information andCommunication Technology)的运用进行推进。例如,已知有如下的作业机械等,其搭载GNSS(全球导航卫星系统:Global Navigation Satellite Systems)等以检测作业机的位置,并将作业机的位置信息与表示作业现场的现状地形的现状地形数据进行比较,从而通过运算处理而求得作业机的位置或姿态等(例如,参见专利文献1)。
专利文献1:日本特开2014-205955号公报
发明内容
在作业机械中,在进行使用GNSS的实时动态(RTK:Realtime Kinematic)定位(以下,称作“RTK定位”)的情况下,需要进行初始化处理。然而,在固定站与移动台之间的距离较长,或者,移动台的周边存在障碍物等情况下,存在无法将推算并确定各卫星的整数偏差(Integer Value Bias)的计算收敛,从而初始化处理一直不完成的情况。
所公开的技术是鉴于上述问题而提出的,其目的在于提供一种能够在使用了GNSS的RTK定位中,适当地执行初始化处理的作业机械的定位系统、作业机械及作业机械的定位方法。
本发明提供一种使用了实时动态定位的作业机械的定位系统,所述实时动态定位使用卫星定位系统,所述作业机械的定位系统具备:计算部,其基于所述作业机械的作业机的位置,计算配置于所述作业机械的卫星定位系统的天线的位置,所述作业机与作业现场中已定位的已知的基准点位置重合;以及初始化控制部,其向通过实时动态定位来进行定位计算的卫星定位系统的接收机输出控制指令,所述控制指令用于使所述接收机使用所述计算部计算出的所述卫星定位系统的天线的位置,来执行将各卫星的整数偏差与所述卫星定位系统的天线的位置作为未知数的、定位计算的初始化处理。
根据本发明的形态,能够在使用了GNSS的RTK定位中,适当地执行初始化处理。
附图说明
图1是表示本实施方式涉及的作业机械的立体图。
图2是表示本实施方式涉及的作业机械的驾驶室的图。
图3是用于说明作业机械的定位的图。
图4是表示本实施方式涉及的作业机械的定位系统的示意图。
图5是表示本实施方式涉及的作业机械的定位系统的一个示例的框图。
图6是表示本实施方式涉及的计算机系统的框图。
图7是表示本实施方式涉及的作业机械的定位方法的一个示例的流程图。
具体实施方式
下面,基于附图对本发明涉及的作业机械的定位系统、作业机械及作业机械的定位方法的实施方式进行说明。此外,本发明不限于该实施方式。另外,下述实施方式中的结构要素中包含本领域技术人员能够轻易置换的要素,或者实质上相同的要素。
图1是表示本实施方式涉及的作业机械1的立体图。在本实施方式中,设作业机械1为液压挖掘机。在以下的说明中,可将作业机械1称作液压挖掘机1。液压挖掘机1包括:下部行走体2、由下部行走体2所支承的上部回转体3、由上部回转体3所支承的作业机4、以及用于驱动作业机4的液压缸5。
下部行走体2能够以支承着上部回转体3的状态行走。下部行走体2具有一对履带。下部行走体2通过履带的旋转而行走。
上部回转体3能够以支承于下部行走体2的状态,相对于下部行走体2以回转轴RX为中心回转。上部回转体3具有供液压挖掘机1的驾驶员搭乘的驾驶室6。在驾驶室6中,设有供驾驶员就坐的驾驶座椅9。
作业机4包括:连结于上部回转体3的动臂4A、连结于动臂4A的斗杆4B、以及连结于斗杆4B的铲斗4C。液压缸5包括:用于驱动动臂4A的动臂缸5A、用于驱动斗杆4B的斗杆缸5B、以及用于驱动铲斗4C的铲斗缸5C。
动臂4A以能够以动臂旋转轴AX为中心旋转的方式被支承于上部回转体3。斗杆4B以能够以斗杆旋转轴BX为中心旋转的方式被支承于动臂4A。铲斗4C以能够以铲斗旋转轴CX为中心旋转的方式被支承于斗杆4B。
动臂旋转轴AX、斗杆旋转轴BX和铲斗旋转轴CX相互平行。动臂旋转轴AX、斗杆旋转轴BX、及铲斗旋转轴CX,与平行于回转轴RX的轴正交。在以下的说明中,可将与回转轴RX平行的方向称作上下方向;可将与动臂旋转轴AX、斗杆旋转轴BX、及铲斗旋转轴CX平行的方向称作左右方向;可将与动臂旋转轴AX、斗杆旋转轴BX及铲斗旋转轴CX、以及回转轴RX这两个方向正交的方向称作前后方向。以就坐于驾驶座椅9的驾驶员为基准,存在作业机4的方向为前方,与前方相反的方向为后方。以就坐于驾驶座椅9的驾驶员为基准,左右方向中的一方为右方,与右方相反的方向为左方。远离下部行走体2的接地面的方向为上方,与上方相反的方向为下方。
驾驶室6配置于上部回转体3的前方。驾驶室6配置于作业机4的左方。作业机4的动臂4A配置于驾驶室6的右方。
驾驶室
图2是表示实施方式涉及的液压挖掘机1的驾驶室6的图。液压挖掘机1具备配置于驾驶室6的操作部10。为了使液压挖掘机1的至少一部分动作而对操作部10进行操作。操作部10由就坐于驾驶座椅9的驾驶员进行操作。液压挖掘机1的动作包括下部行走体2的动作、上部回转体3的动作、及作业机4的动作中的至少一个。
操作部10包括:用于使上部回转体3及作业机4动作而被操作的左作业杆11及右作业杆12、用于使下部行走体2动作而被操作的左行走杆13及右行走杆14、以及左脚踏板15及右脚踏板16。
左作业杆11配置于驾驶座椅9的左方。通过将左作业杆11沿前后方向进行操作,使斗杆4B进行倾卸动作或挖掘动作。通过将左作业杆11沿左右方向进行操作,使上部回转体3左回转或右回转。右作业杆12配置于驾驶座椅9的右方。通过将右作业杆12沿左右方向进行操作,使铲斗4C进行挖掘动作或倾卸动作。通过将右作业杆12沿前后方向进行操作,使动臂4A进行下降动作或上升动作。
左行走杆13及右行走杆14配置于驾驶座椅9的前方。左行走杆13配置于右行走杆14的左方。通过将左行走杆13沿前后方向进行操作,使下部行走体2的左侧的履带进行前进动作或后退动作。通过将右行走杆14沿前后方向进行操作,使下部行走体2的右侧的履带进行前进动作或后退动作。
左脚踏板15及右脚踏板16配置于驾驶座椅9前方。左脚踏板15配置于右脚踏板16的左方。左脚踏板15与左行走杆13联动。右脚踏板16与右行走杆14联动。也可以通过操作左脚踏板15及右脚踏板16,来使下部行走体2进行前进动作或后退动作。
定位系统
图3是用于说明液压挖掘机1的定位的图。图4是表示本实施方式涉及的液压挖掘机1的定位系统200的示意图。图5是表示本实施方式涉及的液压挖掘机1的定位系统200的一个示例的框图。定位系统200使用RTK定位,对液压挖掘机1的位置进行定位,所述RTK定位使用了作为卫星定位系统的GNSS。
如图3所示,RTK定位为:通过分别搭载于设置在已知点PF的固定站FS和可移动的移动台MS上的卫星定位系统的接收机,即GNSS接收机RC,来测算多个GNSS卫星SV发送的载波相位,以确定移动台MS的位置的方式。在图3中表示了GNSS卫星SV1、GNSS卫星SV2、GNSS卫星SV3、以及GNSS卫星SV4。
载波相位是通过累加各GNSS卫星SV与GNSS接收机RC之间的距离的变动量而得到的。在GNSS接收机RC处于初始状态(刚启动后)时,各GNSS卫星SV与GNSS接收机RC之间包含多少波数(称作“整数偏差”或“模糊数(ambiguity)”)未知。因此,作为初始化处理,搭载于移动台MS的GNSS接收机RC通过对使各卫星的距离误差最小的移动台的位置进行探索(称作迭代计算),来确定高精度的移动台的位置和各GNSS卫星SV的整数偏差。
使用固定台FS的校正信息,对GNSS接收机RC接收到的位置信息进行校正,从而求取移动台的位置。然而,在固定台FS与移动台MS之间的距离较长的情况下,通过校正信息获得的校正效果变差,从而导致GNSS接收机RC测算的位置的误差增大。上述误差增大,会导致初始化处理中的GNSS接收机RC难以探索位置,无法求取移动台MS的高精确度的位置,从而初始化处理一直不完成。
因此,定位系统200首先通过RTK定位以外的方法来计算移动台MS的位置。然后,定位系统200基于计算出的移动台MS的位置,通过搭载于移动台MS的GNSS接收机RC进行初始化处理,使未知的变数减少,并使整数偏差的计算容易收敛。在本实施方式中,定位系统200基于与作业现场中已定位的已知的基准点PR位置重合的、液压挖掘机1的作业机4的齿尖4Cp的位置,来计算配置于液压挖掘机1的卫星定位系统的天线,即GNSS天线61的位置。定位系统200向通过RTK定位来进行定位计算的GNSS接收机60输出控制指令,该控制指令使GNSS接收机60使用计算出的GNSS天线61的位置,来执行将各GNSS卫星的整数偏差与GNSS天线61的位置作为未知数的、定位计算的初始化处理。
定位系统200包括:用于检测作业机4的各个缸的行程长度的缸行程传感器5a、IMU(Inertial Measurement Unit:惯性测量装置)30、传感器控制器(计算部)40、显示器50的显示器控制器(初始化控制部)51、GNSS接收机60、以及GNSS天线61、62。GNSS天线61用于求取液压挖掘机1的位置;GNSS天线62用于求取液压挖掘机1的车身的方位角即横摆角。
缸行程传感器5a用于检测表示作业机4的姿态的信息。缸行程传感器5a包括:动臂缸传感器5Aa、斗杆缸传感器5Ba、以及铲斗缸传感器5Ca。动臂缸传感器5Aa、斗杆缸传感器5Ba以及铲斗缸传感器5Ca配置于作业机4。动臂缸传感器5Aa用于检测表示动臂缸5A的动作量即行程长度的动臂缸长度数据。斗杆缸传感器5Ba用于检测表示斗杆缸传感器5Ba的动作量即行程长度的斗杆缸长度数据。铲斗缸传感器5Ca用于检测表示铲斗缸5C的动作量即行程长度的铲斗缸长度数据。缸行程传感器5a将检测到的各个缸长度数据输出至传感器控制器40。
IMU30为状态检测装置,其用于检测表示液压挖掘机1的动作的动作信息。此外,天线61、62也是状态检测装置的一个示例。在本实施方式中,动作信息也可以包括表示液压挖掘机1的姿态的信息。表示液压挖掘机1的姿态的信息示例有液压挖掘机1的侧倾角、俯仰角及横摆角。IMU30安装于上部回转体3。IMU30例如还可以设置在驾驶室6的下部。
IMU30用于检测液压挖掘机1的角速度及加速度。伴随液压挖掘机1的动作,液压挖掘机1会产生如在行走时产生的加速度、在回转时产生的角加速度及重力加速度这样的各式的加速度,而IMU30至少检测并输出重力加速度。在此,重力加速度为,与对重力的抵抗力对应的加速度。IMU30用于检测:例如在三维全局坐标系(X,Y,Z)中的、X轴方向、Y轴方向及Z轴方向的加速度、以及绕X轴、Y轴及Z轴的角速度(旋转角速度)。
全局坐标系是以固定在地球上的原点为基准的坐标系。全局坐标系由GNSS限定。
传感器控制器40具有:CPU(Central Processing Unit:中央处理器)等处理器,即处理部;以及RAM(Random Access Memory:随机存储器)及ROM(Read Only Memory:只读存储器)等存储装置,即存储部。IMU30的检测值、以及动臂缸传感器5Aa、斗杆缸传感器5Ba和铲斗缸传感器5Ca的检测值被输入至传感器控制器40中。经由显示器控制器51,由GNSS接收机60求取的液压挖掘机1在全局坐标上的位置被输入至传感器控制器40。传感器控制器40作为计算部而发挥功能。
传感器控制器40在GNSS接收机60完成初始化处理后,基于液压挖掘机1的齿尖位置数据、以及表示作业现场的现状地形的现状地形数据,生成表示目标齿尖位置的目标齿尖位置数据。齿尖位置数据是表示液压挖掘机1的齿尖4Cp的当前位置的数据。齿尖位置数据是基于液压挖掘机1在全局坐标中的位置、缸行程传感器5a的检测值、以及IMU30的检测值而生成的。例如生成将由现状地形数据表示的现状地形向下偏移预设距离后的虚拟目标地面,目标齿尖位置数据以使齿尖4Cp贴近该虚拟目标地面的方式生成。传感器控制器40基于齿尖位置数据及目标齿尖位置数据,生成并输出用于控制作业机4的动作的作业机指令値。
传感器控制器40基于作业机4的齿尖4Cp的位置,计算配置于作业机械1的GNSS天线61的位置,所述作业机4的齿尖4Cp的位置与在作业现场中已定位的已知的基准点PR位置重合。传感器控制器40将在车身坐标系中求得的液压挖掘机1的GNSS天线61的位置变换为全局坐标系,并将其输出至显示器50的显示器控制器51。
传感器控制器40还可以基于已知的基准点PR的位置、以及表示作业机4的姿态的角度,来计算GNSS天线61的位置,所述作业机4的姿态为,在将作业机4的齿尖4Cp与基准点PR的位置重合的状态下的姿态。具体来说,传感器控制器40基于在三维的现场坐标系中测算到的基准点PR的位置、以及在将作业机4的齿尖4Cp与基准点PR的位置重合的状态下检测到的缸行程传感器5a的检测值,在车身坐标系(Xm,Ym,Zm)中求取液压挖掘机1的GNSS天线61的位置。
由动臂缸传感器5Aa的检测值表示的动臂缸5A的动作量、斗杆缸传感器5Ba的检测值表示的斗杆缸5B的动作量、以及铲斗缸传感器5Ca的检测值表示的铲斗缸5C的动作量可以得到表示作业机4的姿态的信息。表示作业机4的姿态的信息例如由动臂4A与上部回转体3形成的角度θ1、动臂4A与斗杆4B形成的角度θ2、以及斗杆4B与铲斗4C形成的角度θ3限定。
传感器控制器40还可以基于姿态角来计算GNSS天线61的位置,所述姿态角包括液压挖掘机1的侧倾角、俯仰角及横摆角。具体来说,传感器控制器40还基于在将作业机4的齿尖4Cp与基准点PR的位置重合的状态下检测到的IMU30的检测值,在车身坐标系中求取液压挖掘机1的GNSS天线61的位置。
由作为IMU30的检测值的、液压挖掘机1的角速度及加速度,可得到液压挖掘机1的姿态角(侧倾角及俯仰角)。横摆角可从显示器控制器51获取。
显示器50用于显示规定的显示数据。显示器50具有显示器控制器51、以及显示部52。此外,显示部52也可以分开设置。显示器控制器51具有:CPU等处理器,即处理部;以及RAM及ROM(Read Only Memory)等存储装置,即存储部。显示器控制器51作为初始化控制部发挥功能。显示器控制器51向通过RTK定位来进行定位计算的GNSS接收机60输出控制指令,该控制指令使GNSS接收机60使用由传感器控制器40计算出的GNSS天线61的位置,来执行将各GNSS卫星的整数偏差和GNSS天线61的位置作为未知数的、定位计算的初始化处理。显示器控制器51向GNSS接收机60输出从传感器控制器40获取的、变换为全局坐标系的液压挖掘机1的GNSS天线61的位置。
显示器控制器51由GNSS接收机60求取的天线方位角以及GNSS天线61、62在车身上的配置关系,求取车身的方位角,即横摆角。此外,将求取到的横摆角输出至传感器控制器40。
显示部52包括如平板显示屏(LCD:Liquid Crystal Display)或有机电致发光显示屏(OELD:Organic Electroluminescence Display)这样的平板显示屏。显示部52能够显示GNSS接收机60的初始化处理的进行状态,如:GNSS接收机60正在执行初始化处理、或已完成初始化处理等。显示器50与传感器控制器40及GNSS接收机60可进行数据通信地连接。
GNSS接收机60作为全局坐标运算装置发挥功能。GNSS接收机60具有:CPU等处理器,即处理部;以及RAM及ROM等存储装置,即存储部。GNSS接收机60是利用GNSS来检测液压挖掘机1的当前位置的位置检测装置。GNSS接收机60基于GNSS天线61接收到的与GNSS电波对应的信号,来求取GNSS天线61在图1所示的全局坐标系中的位置。作为GNSS的一个示例,可以例举GPS(Global Positioning System:全球定位系统),但并不限于此。GNSS天线61例如设于液压挖掘机1上。
GNSS天线61配置于上部回转体3。GNSS天线61用于检测液压挖掘机1的当前位置。GNSS天线61与GNSS接收机60连接。GNSS天线61接收到的与GNSS电波对应的信号被输入至GNSS接收机60。
GNSS接收机60在初始化处理中,通过迭代计算来推算并确定各GNSS卫星的整数偏差,以求取作为移动台的GNSS天线61的高精度的位置。GNSS接收机60在执行初始化处理时,获取从显示器50的显示器控制器51获取的、以全局坐标系表示的GNSS天线61的位置。GNSS接收机60使用由全局坐标系表示的GNSS天线61的位置,通过迭代计算来推算并确定各GNSS卫星的整数偏差。
GNSS接收机60在完成初始化处理后,将生成的GNSS天线61的位置输出至显示器50的显示器控制器51。
GNSS接收机60通过基线解算,由GNSS天线61、62的位置接收到的卫星信号来计算方位角,并将该方位角作为以GNSS天线61为轴的GNSS天线62的天线方位角。此外,GNSS接收机60将计算出的天线方位角输出至显示器控制器51。
计算机系统
图6是表示本实施方式涉及的计算机系统1000的框图。上述的定位系统200包括计算机系统1000。计算机系统1000具有:处理器1001,如CPU(Central Processing Unit);主内存1002,其包含如ROM(Read Only Memory)这种非易失性存储器及如RAM(Random AccessMemory)这种易失性存储器;存储器1003;以及接口1004,其包含输入输出电路。上述的定位系统200的功能作为计算机程序被存储于存储器1003中。处理器1001将计算机程序从存储器1003中读取并加载至主内存1002,依照计算机程序来执行上述的处理。此外,计算机程序还可以经由网络传送至计算机系统1000。
计算机程序或计算机系统1000按照上述的实施方式,能够执行以下处理:将作业机4的齿尖4Cp的位置与作业现场中已定位的已知的基准点PR重合;由与作业机4的齿尖4Cp位置重合的基准点的位置,计算配置于作业机械1的GNSS天线61的位置;以及向通过实时动态定位进行定位计算的GNSS接收机60输出控制指令,该控制指令用于使GNSS接收机60使用计算出的GNSS天线61的位置来执行将各GNSS卫星的整数偏差与GNSS天线61的位置作为未知数的、定位计算的初始化处理。
图7是表示本实施方式涉及的液压挖掘机1的定位方法的一个示例的流程图。在作业现场中,基准点PR在三维的现场坐标系中被测算,从而其位置是已知的。使液压挖掘机1启动,则GNSS接收机60执行初始化处理。显示器50中能够显示初始化处理的进行状态,如:GNSS接收机60正在执行初始化处理、或已完成初始化处理等。当GNSS接收机60的初始化处理一直不完成时,例如,通过驾驶员的操作,执行如图7所示的处理。首先,驾驶员对作业机4进行操作,将作业机4的齿尖4Cp的位置与作业现场中已定位的基准点PR重合。
定位系统200在传感器控制器40及显示器50的显示器控制器51中执行步骤SP1至步骤SP5的处理。并且,在GNSS接收机60中执行步骤ST1至步骤ST4。
传感器控制器40计算GNSS天线61的位置(步骤SP1)。具体来说,传感器控制器40基于已知的基准点PR的位置、在将作业机4的齿尖4Cp与基准点PR重合的状态下检测到的缸行程传感器5a的检测值、以及IMU30的检测值中的至少一方,在车身坐标系中计算液压挖掘机1的GNSS天线61的位置。传感器控制器40将计算出的GNSS天线61的位置输出至显示器控制器51。
显示器控制器51将从传感器控制器40获取的GNSS天线61的位置输出至GNSS接收机60(步骤SP2)。
GNSS接收机60从显示器控制器51获取GNSS天线61的位置(步骤ST1)。
显示器控制器51向GNSS接收机60输出控制指令,以使其使用传感器控制器40计算出的GNSS天线61的位置,来执行将各GNSS卫星的整数偏差与GNSS天线61的位置作为未知数的、初始化处理(步骤SP3)。
GNSS接收机60中断正在执行的初始化处理(步骤ST2)。
GNSS接收机60基于获取的GNSS天线61的位置,重新进行初始化处理(步骤ST3)。
显示器控制器51对由GNSS接收机60进行的初始化处理是否完成进行判断(步骤SP4)。在判定由GNSS接收机60进行的初始化处理已完成的情况下(步骤SP4:是),前进至步骤SP5。在没有判定由GNSS接收机60进行的初始化处理已完成的情况下(步骤SP4:否),再次执行步骤SP4的处理。
显示器控制器51向GNSS接收机60输出控制指令,以使其解除GNSS天线61的位置固定模式(步骤SP5)。
GNSS接收机60将GNSS天线61的位置固定模式解除(步骤ST4)。在GNSS接收机60的初始化处理中,模式被设定为固定模式,由此,将GNSS天线61的位置视作固定的位置而进行处理。在设定为固定模式期间,无法通过RTK定位来测定液压挖掘机的位置。通过解除固定模式,能够通过RTK定位来测定可移动的液压挖掘机1的高精度的位置。
由此,由于在GNSS接收机60的初始化处理中,未知的变数减少,使得整数偏差的计算变得容易收敛,因此GNSS接收机60能够适当地完成初始化处理。在GNSS接收机60完成初始化处理后,即使液压挖掘机1移动,也能够求取搭载于液压挖掘机1的GNSS天线61的高精度的位置。
此外,图7的流程图为一个示例,在其他实施方式中,也可以不一定执行所有的步骤。例如,已对GNSS接收机60一直不完成初始化处理的情况的示例进行了说明,但也可以在不处于GNSS接收机60一直不完成初始化处理的情况下执行。这种情况下,例如,可以不执行步骤ST2、步骤SP3。
效果
如上所述,在本实施方式中,使通过RTK定位来进行定位计算的GNSS接收机60,基于由已知的基准点PR的位置计算出的GNSS天线61的位置,执行定位计算的初始化处理。根据本实施方式,在GNSS接收机60中,能够使用GNSS天线61的位置,通过迭代计算来推算并确定各GNSS卫星的整数偏差。根据本实施方式,能够抑制出现GNSS接收机60一直不完成初始化处理的状态。本实施方式能够适当地执行GNSS接收机60的初始化处理。
以上,对实施方式进行了说明,但实施方式并不限于上述的内容。此外,上述的结构要素包括:本领域技术人员能够容易想到的要素、实质上相同的要素以及通常所说的均等范围的要素。进一步地,能够对上述的结构要素进行适当的组合。进一步地,在不脱离实施方式的主旨的范围内,能够对结构要素进行各种省略、替换以及变更中的至少一种。例如,作为由传感器控制器40执行的处理而进行了说明的各个处理,也可以由显示器50的显示器控制器51或这些以外的控制器来执行。例如,作为由显示器50的显示器控制器51执行的处理而进行了说明的各个处理,也可以由传感器控制器40或这些以外的控制器来执行。例如,还可以将传感器控制器40及显示器50的显示器控制器51的功能,安装在一个控制器中。
在本实施方式中进行的、将作业机4的齿尖4Cp与已知的基准点PR进行位置重合的作业,也是以往在作业开始时进行的作业。在本实施方式中,由于驾驶员不进行新的作业,因此能够抑制增加作业负担。
此外,在上述实施方式中,作为作业机械,以液压挖掘机1为例进行了说明,但并不限于此,也可以为推土机或轮式装载机等其他的作业机械。
此外,在上述实施方式中,对将作业机4的齿尖4Cp与已知的基准点PR位置重合的情况进行了说明,但并不限于此,也可以将作业机4的其他部分与已知的基准点PR进行位置重合。
在上述实施方式中,对由显示器控制器51计算得到横摆角的情况进行了说明,但也可以由传感器控制器40计算得到横摆角。具体而言,显示器控制器51将GNSS接收机60求取的天线方位角输出至传感器控制器40,传感器控制器40基于天线方位角以及GNSS天线61、62在车身上的配置关系计算出横摆角即可。
在上述实施方式中,对使GNSS天线61用于求取液压挖掘机1的位置的情况进行了说明,但并不限于此。例如,也可以使GNSS天线62用于求取液压挖掘机1的位置。这种情况下,可以使GNSS天线61用于求取液压挖掘机1的车身的方位角,即横摆角。此外,还可以设置GNSS天线61及GNSS天线62以外的GNSS天线,并用该GNSS天线来求取液压挖掘机1的位置。
在上述实施方式中,对GNSS天线为两根的情况进行了说明,但并不限于此,GNSS天线也可以为一根。例如,在作业机械为推土机的情况下,也可以基于一根GNSS天线检测到的速度矢量,计算车身的方位。
上述实施方式的作业机为一个示例,也能够适用于推土机的推土铲、以及轮式装载机的铲斗等其他的作业机械的作业机。
符号说明
1…液压挖掘机(作业机械),2…下部行走体,3…上部回转体,4…作业机,4A…动臂,4B…斗杆,4C…铲斗,5…液压缸,5A…动臂缸,5Aa…动臂缸传感器,5B…斗杆缸,5Ba…斗杆缸传感器,5C…铲斗缸,5Ca…铲斗缸传感器,6…驾驶室,9…驾驶座椅,10…操作部,11…左作业杆,12…右作业杆,13…左行走杆,14…右行走杆,15…左脚踏板,16…右脚踏板,30…IMU,40…传感器控制器(计算部),50…显示器,51…显示器控制器(初始化控制部),52…显示部,60…GNSS接收机(卫星定位系统的接收机),61…GNSS天线(卫星定位系统的天线),62…GNSS天线(卫星定位系统的天线),200…定位系统,1000…计算机系统,1001…处理器,1002…主内存,1003…存储器,1004…接口,AX…动臂旋转轴,BX…斗杆旋转轴,CX…铲斗旋转轴,RX…回转轴。
权利要求书(按照条约第19条的修改)
1.一种作业机械的定位系统,其使用了实时动态定位,所述实时动态定位使用卫星定位系统,所述作业机械的定位系统的特征在于,具备:
计算部,其基于所述作业机械的作业机的位置,计算配置于所述作业机械的卫星定位系统的天线的位置,所述作业机与作业现场中已定位的已知的基准点位置重合;以及
初始化控制部,其向通过实时动态定位来进行定位计算的卫星定位系统的接收机输出控制指令,所述控制指令用于使所述接收机使用所述计算部计算出的所述卫星定位系统的天线的位置,来执行将各卫星的整数偏差与所述卫星定位系统的天线的位置作为未知数的、定位计算的初始化处理,
所述计算部基于所述基准点的位置、以及表示所述作业机的姿态的角度,计算所述卫星定位系统的天线的位置。
2.根据权利要求1所述的作业机械的定位系统,其特征在于,
所述计算部基于所述作业机的包括侧倾角、俯仰角以及横摆角的姿态角,计算所述卫星定位系统的天线的位置。
3.根据权利要求1或2所述的作业机械的定位系统,其特征在于,
所述计算部基于已与所述基准点位置重合的所述作业机的齿尖的位置,计算所述卫星定位系统的天线的位置。
4.一种作业机械,其特征在于,具备:
行走部,其搭载所述作业机并进行行走;以及
权利要求1至权利要求3中任一项所述的作业机械的定位系统。
5.一种作业机械的定位方法,
其为使用了实时动态定位的作业机械的定位方法,所述实时动态定位使用卫星定位系统,所述作业机械的定位方法的特征在于,包括:
将作业机的一部分的位置与作业现场中已定位的已知的基准点重合;
由与所述作业机的一部分的位置重合后的所述基准点的位置,计算配置于所述作业机械的卫星定位系统的天线的位置;以及
向通过实时动态定位来进行定位计算的卫星定位系统的接收机输出控制指令,所述控制指令用于使所述接收机使用计算出的所述卫星定位系统的天线的位置,来执行将各卫星的整数偏差与所述卫星定位系统的天线的位置作为未知数的、定位计算的初始化处理,
其中,基于所述基准点的位置、以及表示所述作业机的姿态的角度,计算所述卫星定位系统的天线的位置。
Claims (6)
1.一种作业机械的定位系统,其使用了实时动态定位,所述实时动态定位使用卫星定位系统,所述作业机械的定位系统的特征在于,具备:
计算部,其基于所述作业机械的作业机的位置,计算配置于所述作业机械的卫星定位系统的天线的位置,所述作业机与作业现场中已定位的已知的基准点位置重合;以及
初始化控制部,其向通过实时动态定位来进行定位计算的卫星定位系统的接收机输出控制指令,所述控制指令用于使所述接收机使用所述计算部计算出的所述卫星定位系统的天线的位置,来执行将各卫星的整数偏差与所述卫星定位系统的天线的位置作为未知数的、定位计算的初始化处理。
2.根据权利要求1所述的作业机械的定位系统,其特征在于,
所述计算部基于所述基准点的位置、以及表示所述作业机的姿态的角度,计算所述卫星定位系统的天线的位置。
3.根据权利要求1或2所述的作业机械的定位系统,其特征在于,
所述计算部基于所述作业机的包括侧倾角、俯仰角以及横摆角的姿态角,计算所述卫星定位系统的天线的位置。
4.根据权利要求1至3中任一项所述的作业机械的定位系统,其特征在于,
所述计算部基于已与所述基准点位置重合的所述作业机的齿尖的位置,计算所述卫星定位系统的天线的位置。
5.一种作业机械,其特征在于,具备:
行走部,其搭载所述作业机并进行行走;以及
权利要求1至权利要求4中任一项所述的作业机械的定位系统。
6.一种作业机械的定位方法,
其为使用了实时动态定位的作业机械的定位方法,所述实时动态定位使用卫星定位系统,所述作业机械的定位方法的特征在于,包括:
将作业机的一部分的位置与作业现场中已定位的已知的基准点重合;
由与所述作业机的一部分的位置重合后的所述基准点的位置,计算配置于所述作业机械的卫星定位系统的天线的位置;以及
向通过实时动态定位来进行定位计算的卫星定位系统的接收机输出控制指令,所述控制指令用于使所述接收机使用计算出的所述卫星定位系统的天线的位置,来执行将各卫星的整数偏差与所述卫星定位系统的天线的位置作为未知数的、定位计算的初始化处理。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2020-074228 | 2020-04-17 | ||
JP2020074228A JP2021173522A (ja) | 2020-04-17 | 2020-04-17 | 作業機械の測位システム、作業機械及び作業機械の測位方法 |
PCT/JP2021/015466 WO2021210613A1 (ja) | 2020-04-17 | 2021-04-14 | 作業機械の測位システム、作業機械及び作業機械の測位方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN115335727A true CN115335727A (zh) | 2022-11-11 |
Family
ID=78083664
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202180024621.1A Pending CN115335727A (zh) | 2020-04-17 | 2021-04-14 | 作业机械的定位系统、作业机械及作业机械的定位方法 |
Country Status (6)
Country | Link |
---|---|
US (1) | US20230144985A1 (zh) |
JP (1) | JP2021173522A (zh) |
KR (1) | KR20220143762A (zh) |
CN (1) | CN115335727A (zh) |
DE (1) | DE112021001087T5 (zh) |
WO (1) | WO2021210613A1 (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR102651033B1 (ko) * | 2023-05-16 | 2024-03-25 | (주)선운이앤지 | 가옥밀집으로 인한 위성신호수신장애지역에서의 간접측량이 가능한 지엔에스에스 수신장치 |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH11344552A (ja) * | 1998-06-03 | 1999-12-14 | Furuno Electric Co Ltd | 測位装置 |
JP2006214236A (ja) * | 2005-02-07 | 2006-08-17 | Hitachi Constr Mach Co Ltd | 建設機械の計測表示機構 |
US20120059554A1 (en) * | 2010-09-02 | 2012-03-08 | Topcon Positioning Systems, Inc. | Automatic Blade Control System during a Period of a Global Navigation Satellite System ... |
JP3170466U (ja) * | 2011-07-07 | 2011-09-15 | 株式会社バイオスシステム | リアルタイムキネマティック航法衛星測位装置 |
JP5789279B2 (ja) | 2013-04-10 | 2015-10-07 | 株式会社小松製作所 | 掘削機械の施工管理装置、油圧ショベルの施工管理装置、掘削機械及び施工管理システム |
JP5823046B1 (ja) * | 2014-05-14 | 2015-11-25 | 株式会社小松製作所 | 油圧ショベルの較正システム及び較正方法 |
JP6708328B2 (ja) * | 2016-07-05 | 2020-06-10 | 国立研究開発法人宇宙航空研究開発機構 | 衛星測位システム及び衛星測位方法 |
US9943022B1 (en) * | 2017-08-02 | 2018-04-17 | Caterpillar Trimble Control Technologies Llc | Determining yaw and center-of-rotation of a rotating platform using a single position sensor |
-
2020
- 2020-04-17 JP JP2020074228A patent/JP2021173522A/ja active Pending
-
2021
- 2021-04-14 WO PCT/JP2021/015466 patent/WO2021210613A1/ja active Application Filing
- 2021-04-14 KR KR1020227033596A patent/KR20220143762A/ko active IP Right Grant
- 2021-04-14 US US17/914,551 patent/US20230144985A1/en active Pending
- 2021-04-14 DE DE112021001087.5T patent/DE112021001087T5/de active Pending
- 2021-04-14 CN CN202180024621.1A patent/CN115335727A/zh active Pending
Also Published As
Publication number | Publication date |
---|---|
WO2021210613A1 (ja) | 2021-10-21 |
US20230144985A1 (en) | 2023-05-11 |
JP2021173522A (ja) | 2021-11-01 |
KR20220143762A (ko) | 2022-10-25 |
DE112021001087T5 (de) | 2023-01-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107002383B (zh) | 作业机械的控制系统、作业机械及作业机械的控制方法 | |
US8352132B2 (en) | Automatic blade control system with integrated global navigation satellite system and inertial sensors | |
KR101833603B1 (ko) | 작업 기계의 제어 시스템 및 작업 기계 | |
US20170260717A1 (en) | Work machine and correction method of working equipment parameter for work machine | |
JP2007147588A (ja) | 作業機械の位置計測システム | |
US11085169B2 (en) | Work equipment control device and work machine | |
CN114761643A (zh) | 作业机械的控制系统、作业机械、作业机械的控制方法 | |
CN113874862A (zh) | 工程机械 | |
JP7016297B2 (ja) | 作業機械 | |
CN115335727A (zh) | 作业机械的定位系统、作业机械及作业机械的定位方法 | |
JP7227111B2 (ja) | 作業機械 | |
US20230203791A1 (en) | Information obtaining system and information obtaining method | |
WO2021256353A1 (ja) | 建設機械 | |
JP7030149B2 (ja) | 作業機械 | |
CN114729520B (zh) | 用于作业机械的校准的方法以及系统 | |
EP3913146B1 (en) | Work machine with collision mitigation system | |
JP2018112051A (ja) | 作業機械の制御システム、作業機械、作業機械の制御方法及びナビゲーションコントローラ | |
JP7149912B2 (ja) | 作業機械 | |
CN114787455B (zh) | 作业机械的控制系统、作业机械以及作业机械的控制方法 | |
JP7165239B1 (ja) | 電子制御装置 | |
JP2019183636A (ja) | 作業機械の制御システム、作業機械、作業機械の制御方法及びナビゲーションコントローラ | |
US20220090351A1 (en) | Work vehicle, control device for work vehicle, and method for specifying direction of work vehicle | |
JP7039746B1 (ja) | 作業機械 | |
CN115398066B (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 |