[go: up one dir, main page]

CN117306617A - 一种对工程机械工作装置进行定位的装置及其定位方法 - Google Patents

一种对工程机械工作装置进行定位的装置及其定位方法 Download PDF

Info

Publication number
CN117306617A
CN117306617A CN202311594685.2A CN202311594685A CN117306617A CN 117306617 A CN117306617 A CN 117306617A CN 202311594685 A CN202311594685 A CN 202311594685A CN 117306617 A CN117306617 A CN 117306617A
Authority
CN
China
Prior art keywords
positioning
vehicle body
loader
bucket
point
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
CN202311594685.2A
Other languages
English (en)
Other versions
CN117306617B (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.)
Sichuan Dinghong Zhidian Equipment Technology Co ltd
Original Assignee
Sichuan Dinghong Zhidian Equipment Technology Co ltd
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 Sichuan Dinghong Zhidian Equipment Technology Co ltd filed Critical Sichuan Dinghong Zhidian Equipment Technology Co ltd
Priority to CN202311594685.2A priority Critical patent/CN117306617B/zh
Publication of CN117306617A publication Critical patent/CN117306617A/zh
Application granted granted Critical
Publication of CN117306617B publication Critical patent/CN117306617B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • 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/431—Control of dipper or bucket position; Control of sequence of drive operations for bucket-arms, front-end loaders, dumpers or the like
    • E02F3/432—Control of dipper or bucket position; Control of sequence of drive operations for bucket-arms, front-end loaders, dumpers or the like for keeping the bucket in a predetermined position or attitude
    • 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
    • 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
    • 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/422—Drive systems for bucket-arms, front-end loaders, dumpers or the like
    • 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/431—Control of dipper or bucket position; Control of sequence of drive operations for bucket-arms, front-end loaders, dumpers or the like

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Mining & Mineral Resources (AREA)
  • Civil Engineering (AREA)
  • General Engineering & Computer Science (AREA)
  • Structural Engineering (AREA)
  • Operation Control Of Excavators (AREA)

Abstract

本发明提供了一种对工程机械工作装置进行定位的装置及其定位方法，包括装载机后车体、装载机前车体、举升缸、翻转缸和铲斗，所述装载机后车体与所述装载机前车体铰接；所述装载机前车体与所述举升缸连接；所述举升缸用于控制所述铲斗的上升和下降，所述举升缸与所述翻转缸连接；所述翻转缸用于控制所述铲斗的倾斜角度，所述翻转缸与所述铲斗连接；还包括全球定位传感器、陀螺仪、角度传感器、举升电机编码器、翻转电机编码器和工业电脑；以在工程机械作业的同时对铲齿的位置进行高精度定位，指导工程机械的作业过程，真正实现工程机械自动化。

Description

一种对工程机械工作装置进行定位的装置及其定位方法
技术领域
本发明涉及工程机械工作装置技术领域，具体而言，涉及一种对工程机械工作装置进行定位的装置及其定位方法。
背景技术
随着科技的发展，越来越多原有用人工操作的器械进入到了自动化生产阶段。例如，工程机械的自动作业，工程机械可以包括装载机，通过使用自动化技术和控制系统，使用工程机械能够在一定程度上自主执行任务，而无需持续的人工行干预。通过使用自动化的工程机械，可以提高效率、安全性和精确度。现有的自动作业的工程机械一般为涉及工程机械的自动驾驶装置，通过获取工程机械在目标作业场景下的当前环境信息；确定目标应用场景后，基于环境信息与业务场景的对应关系，确定当前环境信息对应的目标业务场景；当目标业务场景与当前业务场景不一致时，查询全局配置文件中目标业务场景的业务运作逻辑，全局配置文件包括目标作业场景下的至少一个业务场景、各个业务场景的业务运作逻辑以及业务场景之间的逻辑关系；基于目标业务场景的业务运作逻辑生成目标业务场景下的目标应用程序；基于目标应用程序对工程机械进行自动驾驶控制。然而现有技术仅对工程机械的整体自动化定位进行了设计，但并不能将工程机械用于具体的作业中。
有鉴于此，本发明提供了一种对工程机械工作装置进行定位的装置及其定位方法，以在工程机械作业的同时对铲齿的位置进行高精度定位，指导工程机械的作业过程，真正实现工程机械自动化。
发明内容
本发明的目的在于提供一种对工程机械工作装置进行定位的装置，包括装载机后车体、装载机前车体、举升缸、翻转缸和铲斗，所述装载机后车体与所述装载机前车体铰接；所述装载机前车体与所述举升缸连接；所述举升缸用于控制所述铲斗的上升和下降，所述举升缸与所述翻转缸连接；所述翻转缸用于控制所述铲斗的倾斜角度，所述翻转缸与所述铲斗连接；还包括全球定位传感器、陀螺仪、角度传感器、举升电机编码器、翻转电机编码器和工业电脑；所述全球定位传感器包括车载全球定位接收站和本地全球定位基站；所述全球定位传感器用于获取全球RTK定位信号，以获取装载机后车体的朝向信息及全球定位信号；所述车载全球定位接收站用于接收卫星定位信号和本地全球定位基站RTK信号，以获取装载机后车体的朝向信号；所述本地全球定位基站用于向各个所述全球定位传感器和所述车载全球定位接收站发送基站RTK信号；所述陀螺仪用于获取装载机的横滚角度和俯仰角度；所述角度传感器用于获取所述装载机后车体和所述装载机前车体的夹角；所述举升电机编码器用于计算举升电缸的伸缩长度；所述翻转电机编码器用于计算翻转电缸的伸缩长度；所述工业电脑用于采集所述全球定位传感器、所述车载全球定位接收站、所述本地全球定位基站、所述陀螺仪、所述角度传感器、所述举升电机编码器和所述翻转电机编码器的数据信号，并实时计算出装载机的各个部位的位置。
进一步，所述车载全球定位接收站设置在所述装载机上；所述本地全球定位基站设置在所述装载机工作环境附近；所述陀螺仪设置在所述装载机后车体；所述角度传感器设置在所述装载机后车体与所述装载机前车体的铰接点处；所述举升电机编码器设置在举升电动机内部；所述翻转电机编码器设置在翻转电动机内部。
本发明的目的还在于提供一种应用于上述任一项所述的对工程机械工作装置进行定位的装置的定位方法，包括：通过车载全球定位接收站获取后车体定位点o处的后车体定位信息O和第一后车体朝向信息；通过陀螺仪获取后车体旋转量；获取后车体定位点o与前后车体铰接点a之间的第一位置平移量OA，基于所述后车体旋转量/>、所述后车体定位信息O和所述第一位置平移量OA，通过第一公式a，计算得到所述前后车体铰接点a处的铰接点定位信息A；通过角度传感器获取装载机后车体和装载机前车体的车体夹角θ；基于所述后车体旋转量/>和所述车体夹角θ，通过第二公式，计算前车体旋转量/>；获取所述前后车体铰接点a与所述装载机前车体定位点b处之间的第二位置平移量AB，并基于所述前车体旋转量/>、所述铰接点定位信息A和所述第二位置平移量AB，通过所述第一公式b，计算前车体定位信息B；获取举升缸的伸缩长度L1和翻转缸的伸缩长度L2；基于所述伸缩长度L1，计算得到举升缸的举升高度H，并基于所述举升高度H、铲斗和举升缸的连接点c与装载机前车体定位点b之间的测量长度L，通过第三公式，计算铲斗与所述举升缸的连接点c处的铲斗旋转量/>；获取所述装载机前车体定位点b与所述连接点c点之间的第三位置平移量BC，并基于所述铲斗旋转量/>、所述前车体定位信息B和所述第三位置平移量BC，通过所述第一公式c，计算所述连接点c处的铲斗定位信息C；基于所述伸缩长度L1和所述伸缩长度L2，确定所述连接点c处相对于装载机所在平面的铲斗角度/>，并基于第四公式，计算铲斗斗齿定位点d处的铲齿旋转量/>；获取所述连接点c与所述铲斗斗齿定位点d之间的第四位置平移量CD，并基于所述铲齿旋转量/>、所述铲斗定位信息C和所述第四位置平移量CD，通过所述第一公式d，计算铲齿定位信息D。
进一步，所述第一公式a的表达式为：
其中，、/>、/>分别表示前后车体铰接点a的X、Y、Z坐标；/>、/>、/>分别表示前后车体铰接点a的横滚角、俯仰角、朝向角；/>、/>、/>分别表示前后车体铰接点a的X坐标平移量、Y坐标平移量、Z坐标平移量；/>、/>、/>分别表示后车体定位点o的X、Y、Z坐标；
所述第一公式b的表达式为：
其中，、/>、/>分别表示装载机前车体定位点b的X、Y、Z坐标；/>、/>、/>分别表示装载机前车体定位点b的横滚角、俯仰角、朝向角；/>、/>、/>分别表示装载机前车体定位点b的X坐标平移量、Y坐标平移量、Z坐标平移量；
所述第一公式c的表达式为：
其中，、/>、/>分别表示举升缸的连接点c的X、Y、Z坐标；/>、/>、/>分别表示举升缸的连接点c的横滚角、俯仰角、朝向角；/>、/>、/>分别表示举升缸的连接点c的X坐标平移量、Y坐标平移量、Z坐标平移量；
所述第一公式d的表达式为：
其中，、/>、/>分别表示铲斗斗齿定位点d的X、Y、Z坐标；/>、/>、/>分别表示铲斗斗齿定位点d的横滚角、俯仰角、朝向角；/>、/>、/>分别表示铲斗斗齿定位点d的X坐标平移量、Y坐标平移量、Z坐标平移量。
进一步，所述第二公式的表达式为：
其中，表示前车体旋转量/>；θ表示装载机后车体和装载机前车体的车体夹角；/>表示后车体旋转量/>。
进一步，所述第三公式的表达式为：
其中，表示铲斗旋转量/>；/>；/>表示测量长度，H表示举升高度；/>表示前车体旋转量/>。
进一步，所述第四公式的表达式为：
其中，表示铲齿旋转量/>；/>表示连接点c处相对于装载机所在平面的铲斗角度；/>表示铲斗旋转量/>。
进一步，所述后车体旋转量包括第二后车体朝向信息，还包括将所述第一后车体朝向信息和所述第二后车体朝向信息中精度更高的朝向信息作为新的后车体旋转量中的后车体朝向信息/>。
进一步，分别基于举升电机编码器和翻转电机编码器获取的电机圈数位置、连接电缸与电机轴承的齿轮的减速比以及电缸导程，计算得到所述举升缸的伸缩长度L1和所述翻转缸的伸缩长度L2。
进一步，通过车载全球定位接收站获取后车体定位点o处的后车体定位信息O和第一后车体朝向信息，包括：本地全球定位基站向所述车载全球定位接收站发送基站RTK信号；所述车载全球定位接收站接收所述基站RTK信号，并基于所述基站RTK信号获取所述后车体定位信息O和所述第一后车体朝向信息。
本发明实施例的技术方案至少具有如下优点和有益效果：
本发明可以对工程机械的部件实现高精度的定位，使得可以实现自动化操作工程机械的部件，以完成工程作业；提高了作业精度，降低了作业风险。
附图说明
图1为本发明一些实施例提供的一种对工程机械工作装置进行定位的装置的示例性模块图；
图2为本发明一些实施例提供的一种对工程机械工作装置进行定位的装置的示例性示意图。
图中，a-前后车体铰接点，b-装载机前车体定位点，c-连接点，d-铲斗斗齿定位点，o-后车体定位点。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚，下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例是本发明一部分实施例，而不是全部的实施例。通常在此处附图中描述和示出的本发明实施例的组件可以以各种不同的配置来布置和设计。
如图1和图2所示，对工程机械工作装置进行定位的装置包括装载机后车体、装载机前车体、举升缸、翻转缸和铲斗。
所述装载机后车体与所述装载机前车体铰接；所述装载机前车体与所述举升缸连接；所述举升缸用于控制所述铲斗的上升和下降，所述举升缸与所述翻转缸连接；所述翻转缸用于控制所述铲斗的倾斜角度，所述翻转缸与所述铲斗连接。
还包括传感器模组100和工业电脑200。其中，传感器模组100包括全球定位传感器110、陀螺仪120、角度传感器130、举升电机编码器140、翻转电机编码器150。所述全球定位传感器110包括车载全球定位接收站111和本地全球定位基站112。所述全球定位传感器用于获取全球RTK定位信号，以获取装载机后车体的朝向信息及全球定位信号；所述车载全球定位接收站用于接收卫星定位信号和本地全球定位基站RTK信号，以获取装载机后车体的朝向信号；所述本地全球定位基站用于向各个所述全球定位传感器和所述车载全球定位接收站发送基站RTK信号；所述陀螺仪用于获取装载机的横滚角度和俯仰角度；所述角度传感器用于获取所述装载机后车体和所述装载机前车体的夹角；所述举升电机编码器用于计算举升电缸的伸缩长度；所述翻转电机编码器用于计算翻转电缸的伸缩长度；所述工业电脑用于采集所述全球定位传感器、所述车载全球定位接收站、所述本地全球定位基站、所述陀螺仪、所述角度传感器、所述举升电机编码器和所述翻转电机编码器的数据信号，并实时计算出装载机的各个部位的位置。
其中，所述车载全球定位接收站设置在所述装载机上（例如，装载机后车体处）；所述本地全球定位基站设置在所述装载机工作环境附近；所述陀螺仪设置在所述装载机后车体；所述角度传感器设置在所述装载机后车体与所述装载机前车体的铰接点处；所述举升电机编码器设置在举升电动机内部；所述翻转电机编码器设置在翻转电动机内部。
本发明还提出了应用于上述所述的对工程机械工作装置进行定位的装置的定位方法，包括以下内容：
通过车载全球定位接收站获取后车体定位点o处的后车体定位信息O和第一后车体朝向信息。其中，通过车载全球定位接收站获取后车体定位点o处的后车体定位信息O和第一后车体朝向信息，包括：本地全球定位基站向所述车载全球定位接收站发送基站RTK信号；所述车载全球定位接收站接收所述基站RTK信号，并基于所述基站RTK信号获取所述后车体定位信息O和所述第一后车体朝向信息。
通过陀螺仪获取后车体旋转量。
在一些实施例中，所述后车体旋转量包括第二后车体朝向信息，还包括将所述第一后车体朝向信息和所述第二后车体朝向信息中精度更高的朝向信息作为新的后车体旋转量中的后车体朝向信息/>。
获取后车体定位点o与前后车体铰接点a之间的第一位置平移量OA，基于所述后车体旋转量、所述后车体定位信息O和所述第一位置平移量OA，通过第一公式a，计算得到所述前后车体铰接点a处的铰接点定位信息A。其中，所述第一公式a的表达式为：
其中，、/>、/>分别表示前后车体铰接点a的X、Y、Z坐标；/>、/>、/>分别表示前后车体铰接点a的横滚角、俯仰角、朝向角；/>、/>、/>分别表示前后车体铰接点a的X坐标平移量、Y坐标平移量、Z坐标平移量；/>、/>、/>分别表示后车体定位点o的X、Y、Z坐标。
需要说明的是，如图2中的坐标系，本申请中的横滚角即经过对应点位的X轴方向与水平面的夹角，俯仰角即经过对应点位的Y轴方向与水平面的夹角；朝向角即经过对应点位的Z轴方向与水平面的夹角。
通过角度传感器获取装载机后车体和装载机前车体的车体夹角θ。
基于所述后车体旋转量和所述车体夹角θ，通过第二公式，计算前车体旋转量。其中，所述第二公式的表达式为：
其中，表示前车体旋转量/>；θ表示装载机后车体和装载机前车体的车体夹角；/>表示后车体旋转量/>。
获取所述前后车体铰接点a与所述装载机前车体定位点b处之间的第二位置平移量AB，并基于所述前车体旋转量、所述铰接点定位信息A和所述第二位置平移量AB，通过所述第一公式b，计算前车体定位信息B。其中，所述第一公式b的表达式为：
其中，、/>、/>分别表示装载机前车体定位点b的X、Y、Z坐标；/>、/>、/>分别表示装载机前车体定位点b的横滚角、俯仰角、朝向角；/>、/>、/>分别表示装载机前车体定位点b的X坐标平移量、Y坐标平移量、Z坐标平移量。
获取举升缸的伸缩长度L1和翻转缸的伸缩长度L2。其中，分别基于举升电机编码器和翻转电机编码器获取的电机圈数位置、连接电缸与电机轴承的齿轮的减速比以及电缸导程，计算得到所述举升缸的伸缩长度L1和所述翻转缸的伸缩长度L2。
基于所述伸缩长度L1，计算得到举升缸的举升高度H，并基于所述举升高度H、铲斗和举升缸的连接点c与装载机前车体定位点b之间的测量长度L，通过第三公式，计算铲斗与所述举升缸的连接点c处的铲斗旋转量。其中，所述第三公式的表达式为：
其中，表示铲斗旋转量/>；/>；/>表示测量长度，H表示举升高度；/>表示前车体旋转量/>。
获取所述装载机前车体定位点b与所述连接点c点之间的第三位置平移量BC，并基于所述铲斗旋转量、所述前车体定位信息B和所述第三位置平移量BC，通过所述第一公式c，计算所述连接点c处的铲斗定位信息C。其中，所述第一公式c的表达式为：
其中，、/>、/>分别表示举升缸的连接点c的X、Y、Z坐标；/>、/>、/>分别表示举升缸的连接点c的横滚角、俯仰角、朝向角；/>、/>、/>分别表示举升缸的连接点c的X坐标平移量、Y坐标平移量、Z坐标平移量。
基于所述伸缩长度L1和所述伸缩长度L2，确定所述连接点c处相对于装载机所在平面的铲斗角度，并基于第四公式，计算铲斗斗齿定位点d处的铲齿旋转量/>。其中，所述第四公式的表达式为：
其中，表示铲齿旋转量/>；/>表示连接点c处相对于装载机所在平面的铲斗角度；/>表示铲斗旋转量/>。
获取所述连接点c与所述铲斗斗齿定位点d之间的第四位置平移量CD，并基于所述铲齿旋转量、所述铲斗定位信息C和所述第四位置平移量CD，通过所述第一公式d，计算铲齿定位信息D。其中，所述第一公式d的表达式为：
其中，、/>、/>分别表示铲斗斗齿定位点d的X、Y、Z坐标；/>、/>、/>分别表示铲斗斗齿定位点d的横滚角、俯仰角、朝向角；/>、/>、/>分别表示铲斗斗齿定位点d的X坐标平移量、Y坐标平移量、Z坐标平移量。
以上仅为本发明的优选实施例而已，并不用于限制本发明，对于本领域的技术人员来说，本发明可以有各种更改和变化。凡在本发明的精神和原则之内，所作的任何修改、等同替换（例如，等同替换的算法或通过增加传感器实现等）、改进等，均应包含在本发明的保护范围之内。

Claims (10)

1.一种对工程机械工作装置进行定位的装置，包括装载机后车体、装载机前车体、举升缸、翻转缸和铲斗，其特征在于，
所述装载机后车体与所述装载机前车体铰接；
所述装载机前车体与所述举升缸连接；
所述举升缸用于控制所述铲斗的上升和下降，所述举升缸与所述翻转缸连接；
所述翻转缸用于控制所述铲斗的倾斜角度，所述翻转缸与所述铲斗连接；
还包括全球定位传感器、陀螺仪、角度传感器、举升电机编码器、翻转电机编码器和工业电脑；所述全球定位传感器包括车载全球定位接收站和本地全球定位基站；
所述全球定位传感器用于获取全球RTK定位信号，以获取装载机后车体的朝向信息及全球定位信号；所述车载全球定位接收站用于接收卫星定位信号和本地全球定位基站RTK信号，以获取装载机后车体的朝向信号；所述本地全球定位基站用于向各个所述全球定位传感器和所述车载全球定位接收站发送基站RTK信号；
所述陀螺仪用于获取装载机的横滚角度和俯仰角度；
所述角度传感器用于获取所述装载机后车体和所述装载机前车体的夹角；
所述举升电机编码器用于计算举升电缸的伸缩长度；
所述翻转电机编码器用于计算翻转电缸的伸缩长度；
所述工业电脑用于采集所述全球定位传感器、所述车载全球定位接收站、所述本地全球定位基站、所述陀螺仪、所述角度传感器、所述举升电机编码器和所述翻转电机编码器的数据信号，并实时计算出装载机的各个部位的位置。
2.根据权利要求1所述的对工程机械工作装置进行定位的装置，其特征在于，所述车载全球定位接收站设置在所述装载机上；所述本地全球定位基站设置在所述装载机工作环境附近；所述陀螺仪设置在所述装载机后车体；所述角度传感器设置在所述装载机后车体与所述装载机前车体的铰接点处；所述举升电机编码器设置在举升电动机内部；所述翻转电机编码器设置在翻转电动机内部。
3.一种应用于如权利要求1-2任一项所述的对工程机械工作装置进行定位的装置的定位方法，其特征在于，包括：
通过车载全球定位接收站获取后车体定位点o处的后车体定位信息O和第一后车体朝向信息；
通过陀螺仪获取后车体旋转量；
获取后车体定位点o与前后车体铰接点a之间的第一位置平移量OA，基于所述后车体旋转量、所述后车体定位信息O和所述第一位置平移量OA，通过第一公式a，计算得到所述前后车体铰接点a处的铰接点定位信息A；
通过角度传感器获取装载机后车体和装载机前车体的车体夹角θ；
基于所述后车体旋转量和所述车体夹角θ，通过第二公式，计算前车体旋转量/>；
获取所述前后车体铰接点a与所述装载机前车体定位点b处之间的第二位置平移量AB，并基于所述前车体旋转量、所述铰接点定位信息A和所述第二位置平移量AB，通过所述第一公式b，计算前车体定位信息B；
获取举升缸的伸缩长度L1和翻转缸的伸缩长度L2；
基于所述伸缩长度L1，计算得到举升缸的举升高度H，并基于所述举升高度H、铲斗和举升缸的连接点c与装载机前车体定位点b之间的测量长度L，通过第三公式，计算铲斗与所述举升缸的连接点c处的铲斗旋转量；
获取所述装载机前车体定位点b与所述连接点c点之间的第三位置平移量BC，并基于所述铲斗旋转量、所述前车体定位信息B和所述第三位置平移量BC，通过所述第一公式c，计算所述连接点c处的铲斗定位信息C；
基于所述伸缩长度L1和所述伸缩长度L2，确定所述连接点c处相对于装载机所在平面的铲斗角度，并基于第四公式，计算铲斗斗齿定位点d处的铲齿旋转量/>；
获取所述连接点c与所述铲斗斗齿定位点d之间的第四位置平移量CD，并基于所述铲齿旋转量、所述铲斗定位信息C和所述第四位置平移量CD，通过所述第一公式d，计算铲齿定位信息D。
4. 根据权利要求3所述的对工程机械工作装置进行定位的装置的定位方法，其特征在于，所述第一公式a的表达式为：
其中，、/>、/>分别表示前后车体铰接点a的X、Y、Z坐标；/>、/>、/>分别表示前后车体铰接点a的横滚角、俯仰角、朝向角；/>、/>、/>分别表示前后车体铰接点a的X坐标平移量、Y坐标平移量、Z坐标平移量；/>、/>、/>分别表示后车体定位点o的X、Y、Z坐标；
所述第一公式b的表达式为：
其中，、/>、/>分别表示装载机前车体定位点b的X、Y、Z坐标；/>、/>、/>分别表示装载机前车体定位点b的横滚角、俯仰角、朝向角；/>、/>、/>分别表示装载机前车体定位点b的X坐标平移量、Y坐标平移量、Z坐标平移量；
所述第一公式c的表达式为：
其中，、/>、/>分别表示举升缸的连接点c的X、Y、Z坐标；/>、/>、/>分别表示举升缸的连接点c的横滚角、俯仰角、朝向角；/>、/>、/>分别表示举升缸的连接点c的X坐标平移量、Y坐标平移量、Z坐标平移量；
所述第一公式d的表达式为：
其中，、/>、/>分别表示铲斗斗齿定位点d的X、Y、Z坐标；/>、/>、/>分别表示铲斗斗齿定位点d的横滚角、俯仰角、朝向角；/>、/>、/>分别表示铲斗斗齿定位点d的X坐标平移量、Y坐标平移量、Z坐标平移量。
5.根据权利要求3所述的对工程机械工作装置进行定位的装置的定位方法，其特征在于，所述第二公式的表达式为：
其中，表示前车体旋转量/>；θ表示装载机后车体和装载机前车体的车体夹角；/>表示后车体旋转量/>。
6.根据权利要求3所述的对工程机械工作装置进行定位的装置的定位方法，其特征在于，所述第三公式的表达式为：
其中，表示铲斗旋转量/>；/>；/>表示测量长度，H表示举升高度；/>表示前车体旋转量/>。
7.根据权利要求3所述的对工程机械工作装置进行定位的装置的定位方法，其特征在于，所述第四公式的表达式为：
其中，表示铲齿旋转量/>；/>表示连接点c处相对于装载机所在平面的铲斗角度；/>表示铲斗旋转量/>。
8.根据权利要求3所述的对工程机械工作装置进行定位的装置的定位方法，其特征在于，所述后车体旋转量包括第二后车体朝向信息，还包括将所述第一后车体朝向信息和所述第二后车体朝向信息中精度更高的朝向信息作为新的后车体旋转量中的后车体朝向信息/>。
9.根据权利要求3所述的对工程机械工作装置进行定位的装置的定位方法，其特征在于，分别基于举升电机编码器和翻转电机编码器获取的电机圈数位置、连接电缸与电机轴承的齿轮的减速比以及电缸导程，计算得到所述举升缸的伸缩长度L1和所述翻转缸的伸缩长度L2。
10.根据权利要求3所述的对工程机械工作装置进行定位的装置的定位方法，其特征在于，通过车载全球定位接收站获取后车体定位点o处的后车体定位信息O和第一后车体朝向信息，包括：
本地全球定位基站向所述车载全球定位接收站发送基站RTK信号；
所述车载全球定位接收站接收所述基站RTK信号，并基于所述基站RTK信号获取所述后车体定位信息O和所述第一后车体朝向信息。
CN202311594685.2A 2023-11-28 2023-11-28 一种对工程机械工作装置进行定位的装置及其定位方法 Active CN117306617B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202311594685.2A CN117306617B (zh) 2023-11-28 2023-11-28 一种对工程机械工作装置进行定位的装置及其定位方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202311594685.2A CN117306617B (zh) 2023-11-28 2023-11-28 一种对工程机械工作装置进行定位的装置及其定位方法

Publications (2)

Publication Number Publication Date
CN117306617A true CN117306617A (zh) 2023-12-29
CN117306617B CN117306617B (zh) 2024-03-12

Family

ID=89273893

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202311594685.2A Active CN117306617B (zh) 2023-11-28 2023-11-28 一种对工程机械工作装置进行定位的装置及其定位方法

Country Status (1)

Country Link
CN (1) CN117306617B (zh)

Citations (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP2377993A2 (en) * 2010-04-14 2011-10-19 EPT Kone Ja Laite Oy A spreading device for a road-construction mass substance
US20160312434A1 (en) * 2015-02-02 2016-10-27 Komatsu Ltd. Work vehicle and method of controlling work vehicle
CN106568430A (zh) * 2015-10-09 2017-04-19 张琳俐 运土系统的定位方法及装置
US20190049973A1 (en) * 2017-08-08 2019-02-14 Komatsu Ltd. Control system for work vehicle, method, and work vehicle
US20200131739A1 (en) * 2017-09-29 2020-04-30 Hitachi Construction Machinery Co., Ltd. Wheel loader and bucket load calculation method
CN112523286A (zh) * 2020-11-24 2021-03-19 徐工集团工程机械股份有限公司科技分公司 一种装载机水平举升自动调节控制方法及系统
CN112567101A (zh) * 2018-08-06 2021-03-26 克拉克设备公司 增广式装载机控制
CN113266046A (zh) * 2021-05-24 2021-08-17 江苏徐工工程机械研究院有限公司 挖掘装载机
CN215669832U (zh) * 2021-05-08 2022-01-28 上海三一重机股份有限公司 装载机
CN114032990A (zh) * 2020-07-29 2022-02-11 四川鼎鸿智电装备科技有限公司 工程机械
CN218367541U (zh) * 2022-10-24 2023-01-24 中铁工程装备集团有限公司 新能源铰接u型框架式自卸运输车
US20230243127A1 (en) * 2020-08-07 2023-08-03 Komatsu Ltd. Excavation information processing device, work machine, excavation support device, and excavation information processing method
CN116623734A (zh) * 2023-05-22 2023-08-22 江苏徐工国重实验室科技有限公司 一种装载机的铲斗自适应调节系统及方法
CN116927267A (zh) * 2023-08-14 2023-10-24 福建晋工新能源科技有限公司 自主换电式装载机和换电方法

Patent Citations (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP2377993A2 (en) * 2010-04-14 2011-10-19 EPT Kone Ja Laite Oy A spreading device for a road-construction mass substance
US20160312434A1 (en) * 2015-02-02 2016-10-27 Komatsu Ltd. Work vehicle and method of controlling work vehicle
CN106568430A (zh) * 2015-10-09 2017-04-19 张琳俐 运土系统的定位方法及装置
US20190049973A1 (en) * 2017-08-08 2019-02-14 Komatsu Ltd. Control system for work vehicle, method, and work vehicle
US20200131739A1 (en) * 2017-09-29 2020-04-30 Hitachi Construction Machinery Co., Ltd. Wheel loader and bucket load calculation method
CN112567101A (zh) * 2018-08-06 2021-03-26 克拉克设备公司 增广式装载机控制
CN114032990A (zh) * 2020-07-29 2022-02-11 四川鼎鸿智电装备科技有限公司 工程机械
US20230243127A1 (en) * 2020-08-07 2023-08-03 Komatsu Ltd. Excavation information processing device, work machine, excavation support device, and excavation information processing method
CN112523286A (zh) * 2020-11-24 2021-03-19 徐工集团工程机械股份有限公司科技分公司 一种装载机水平举升自动调节控制方法及系统
CN215669832U (zh) * 2021-05-08 2022-01-28 上海三一重机股份有限公司 装载机
CN113266046A (zh) * 2021-05-24 2021-08-17 江苏徐工工程机械研究院有限公司 挖掘装载机
CN218367541U (zh) * 2022-10-24 2023-01-24 中铁工程装备集团有限公司 新能源铰接u型框架式自卸运输车
CN116623734A (zh) * 2023-05-22 2023-08-22 江苏徐工国重实验室科技有限公司 一种装载机的铲斗自适应调节系统及方法
CN116927267A (zh) * 2023-08-14 2023-10-24 福建晋工新能源科技有限公司 自主换电式装载机和换电方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
李松;董雯雯;侯卓磊;: "基于伺服电动缸的新型装载机工作系统研究", 中小企业管理与科技(上旬刊), no. 09 *
江长青;: "挖掘装载机托架连杆装载工作装置自动调平的方法", 工程机械, no. 07 *

Also Published As

Publication number Publication date
CN117306617B (zh) 2024-03-12

Similar Documents

Publication Publication Date Title
CN114045893B (zh) 挖掘机铲斗齿尖定位方法、装置和挖掘机
CN110827358B (zh) 一种应用于自动驾驶汽车的相机标定方法
CN107002383B (zh) 作业机械的控制系统、作业机械及作业机械的控制方法
CN111338342B (zh) 一种轮式工程机械自动循迹行驶控制系统及方法
CN113047353A (zh) 一种挖掘机智能施工引导系统及方法
EP4411077A1 (en) Establishment method for electronic enclosure for excavator
CN107002384A (zh) 作业机械的控制系统及作业机械的控制方法
CN112214014A (zh) 农机自动驾驶控制方法及系统
CN110579754A (zh) 用于确定车辆的激光雷达与车辆其他的传感器的外参数的方法
CN115188098B (zh) 数字钥匙自动化标定及测试的方法及其系统
WO2020248210A1 (en) Roadmodel manifold for 2d trajectory planner
CN117306617B (zh) 一种对工程机械工作装置进行定位的装置及其定位方法
CN118485719A (zh) 挖掘机铲斗位置确定方法、装置及挖掘机
CN111006706B (zh) 一种基于线激光视觉传感器的旋转轴标定方法
CN108253929A (zh) 一种四轮定位仪、系统及其实现方法
CN116437016B (zh) 物体扫描方法、装置、电子设备及存储介质
CN111912403B (zh) 一种叉车的定位方法及叉车
CN115578519A (zh) 作业环境三维重建方法、装置、电子设备及车辆
CN119546821A (zh) 包括作业机械的系统、作业机械的控制器及作业机械的控制方法
US12078490B2 (en) 3D odometry in 6D space with roadmodel 2D manifold
JPH047806B2 (zh)
CN118332833B (zh) 转向节的参数化建模方法、系统、电子设备及介质
CN113070887A (zh) 天花作业机器人以及作业方法
CN118905805B (zh) 三维曲面磨削建立工件坐标系与砂轮磨损补偿装置及方法
CN114954434B (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